|
@@ -1,5 +1,5 @@
|
|
/*
|
|
/*
|
|
- * Copyright (c) 2006-2023, RT-Thread Development Team
|
|
|
|
|
|
+ * Copyright (c) 2006-2024, RT-Thread Development Team
|
|
*
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
*
|
|
@@ -10,7 +10,6 @@
|
|
*/
|
|
*/
|
|
|
|
|
|
#include <rtthread.h>
|
|
#include <rtthread.h>
|
|
-#include <rtdevice.h>
|
|
|
|
|
|
|
|
#include <string.h>
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include <stdlib.h>
|
|
@@ -19,16 +18,6 @@
|
|
#define DBG_LVL DBG_INFO
|
|
#define DBG_LVL DBG_INFO
|
|
#include <rtdbg.h>
|
|
#include <rtdbg.h>
|
|
|
|
|
|
-#ifdef RT_USING_DM
|
|
|
|
-#include <drivers/core/bus.h>
|
|
|
|
-
|
|
|
|
-static struct rt_bus bus_root =
|
|
|
|
-{
|
|
|
|
- .name = "root",
|
|
|
|
- .children = RT_LIST_OBJECT_INIT(bus_root.children),
|
|
|
|
-};
|
|
|
|
-#endif
|
|
|
|
-
|
|
|
|
#ifdef RT_USING_DEV_BUS
|
|
#ifdef RT_USING_DEV_BUS
|
|
|
|
|
|
#if defined(RT_USING_POSIX_DEVIO)
|
|
#if defined(RT_USING_POSIX_DEVIO)
|
|
@@ -95,12 +84,19 @@ rt_err_t rt_device_bus_destroy(rt_device_t dev)
|
|
#endif
|
|
#endif
|
|
|
|
|
|
#ifdef RT_USING_DM
|
|
#ifdef RT_USING_DM
|
|
-/**
|
|
|
|
- * @brief This function get the root bus
|
|
|
|
- */
|
|
|
|
-rt_bus_t rt_bus_root(void)
|
|
|
|
|
|
+#include <drivers/core/bus.h>
|
|
|
|
+
|
|
|
|
+static struct rt_spinlock bus_lock = {};
|
|
|
|
+static rt_list_t bus_nodes = RT_LIST_OBJECT_INIT(bus_nodes);
|
|
|
|
+
|
|
|
|
+static void _dm_bus_lock(struct rt_spinlock *spinlock)
|
|
|
|
+{
|
|
|
|
+ rt_hw_spin_lock(&spinlock->lock);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void _dm_bus_unlock(struct rt_spinlock *spinlock)
|
|
{
|
|
{
|
|
- return &bus_root;
|
|
|
|
|
|
+ rt_hw_spin_unlock(&spinlock->lock);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -108,30 +104,43 @@ rt_bus_t rt_bus_root(void)
|
|
*
|
|
*
|
|
* @param bus the target bus
|
|
* @param bus the target bus
|
|
*
|
|
*
|
|
- * @param drv the target drv to be matched
|
|
|
|
|
|
+ * @param data the data push when call fn
|
|
*
|
|
*
|
|
* @param fn the function callback in each loop
|
|
* @param fn the function callback in each loop
|
|
*
|
|
*
|
|
* @return the error code, RT_EOK on added successfully.
|
|
* @return the error code, RT_EOK on added successfully.
|
|
*/
|
|
*/
|
|
-rt_err_t rt_bus_for_each_dev(rt_bus_t bus, rt_driver_t drv, int (*fn)(rt_driver_t drv, rt_device_t dev))
|
|
|
|
|
|
+rt_err_t rt_bus_for_each_dev(rt_bus_t bus, void *data, int (*fn)(rt_device_t dev, void *))
|
|
{
|
|
{
|
|
- rt_base_t level;
|
|
|
|
rt_device_t dev;
|
|
rt_device_t dev;
|
|
|
|
+ rt_err_t err = -RT_EEMPTY;
|
|
|
|
+ rt_list_t *dev_list;
|
|
|
|
+ struct rt_spinlock *dev_lock;
|
|
|
|
|
|
RT_ASSERT(bus != RT_NULL);
|
|
RT_ASSERT(bus != RT_NULL);
|
|
- RT_ASSERT(drv != RT_NULL);
|
|
|
|
|
|
|
|
- level = rt_spin_lock_irqsave(&bus->spinlock);
|
|
|
|
|
|
+ dev_list = &bus->dev_list;
|
|
|
|
+ dev_lock = &bus->dev_lock;
|
|
|
|
+
|
|
|
|
+ _dm_bus_lock(dev_lock);
|
|
|
|
+ dev = rt_list_entry(dev_list->next, struct rt_device, node);
|
|
|
|
+ _dm_bus_unlock(dev_lock);
|
|
|
|
|
|
- rt_list_for_each_entry(dev, &bus->dev_list, node)
|
|
|
|
|
|
+ while (&dev->node != dev_list)
|
|
{
|
|
{
|
|
- fn(drv, dev);
|
|
|
|
- }
|
|
|
|
|
|
+ if (!fn(dev, data))
|
|
|
|
+ {
|
|
|
|
+ err = RT_EOK;
|
|
|
|
|
|
- rt_spin_unlock_irqrestore(&bus->spinlock, level);
|
|
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
|
|
- return RT_EOK;
|
|
|
|
|
|
+ _dm_bus_lock(dev_lock);
|
|
|
|
+ dev = rt_list_entry(dev->node.next, struct rt_device, node);
|
|
|
|
+ _dm_bus_unlock(dev_lock);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return err;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -139,104 +148,97 @@ rt_err_t rt_bus_for_each_dev(rt_bus_t bus, rt_driver_t drv, int (*fn)(rt_driver_
|
|
*
|
|
*
|
|
* @param bus the target bus
|
|
* @param bus the target bus
|
|
*
|
|
*
|
|
- * @param dev the target dev to be matched
|
|
|
|
|
|
+ * @param data the data push when call fn
|
|
*
|
|
*
|
|
* @param fn the function callback in each loop
|
|
* @param fn the function callback in each loop
|
|
*
|
|
*
|
|
* @return the error code, RT_EOK on added successfully.
|
|
* @return the error code, RT_EOK on added successfully.
|
|
*/
|
|
*/
|
|
-rt_err_t rt_bus_for_each_drv(rt_bus_t bus, rt_device_t dev, int (*fn)(rt_driver_t drv, rt_device_t dev))
|
|
|
|
|
|
+rt_err_t rt_bus_for_each_drv(rt_bus_t bus, void *data, int (*fn)(rt_driver_t drv, void *))
|
|
{
|
|
{
|
|
- rt_err_t err;
|
|
|
|
- rt_base_t level;
|
|
|
|
rt_driver_t drv;
|
|
rt_driver_t drv;
|
|
|
|
+ rt_err_t err = -RT_EEMPTY;
|
|
|
|
+ rt_list_t *drv_list;
|
|
|
|
+ struct rt_spinlock *drv_lock;
|
|
|
|
|
|
RT_ASSERT(bus != RT_NULL);
|
|
RT_ASSERT(bus != RT_NULL);
|
|
- RT_ASSERT(dev != RT_NULL);
|
|
|
|
-
|
|
|
|
- if (rt_list_isempty(&bus->drv_list))
|
|
|
|
- {
|
|
|
|
- return RT_EOK;
|
|
|
|
- }
|
|
|
|
|
|
|
|
- err = -RT_ERROR;
|
|
|
|
|
|
+ drv_list = &bus->drv_list;
|
|
|
|
+ drv_lock = &bus->drv_lock;
|
|
|
|
|
|
- level = rt_spin_lock_irqsave(&bus->spinlock);
|
|
|
|
|
|
+ _dm_bus_lock(drv_lock);
|
|
|
|
+ drv = rt_list_entry(drv_list->next, struct rt_driver, node);
|
|
|
|
+ _dm_bus_unlock(drv_lock);
|
|
|
|
|
|
- rt_list_for_each_entry(drv, &bus->drv_list, node)
|
|
|
|
|
|
+ while (&drv->node != drv_list)
|
|
{
|
|
{
|
|
- if (fn(drv, dev))
|
|
|
|
|
|
+ if (!fn(drv, data))
|
|
{
|
|
{
|
|
- err = -RT_EOK;
|
|
|
|
|
|
+ err = RT_EOK;
|
|
|
|
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
- }
|
|
|
|
|
|
|
|
- rt_spin_unlock_irqrestore(&bus->spinlock, level);
|
|
|
|
|
|
+ _dm_bus_lock(drv_lock);
|
|
|
|
+ drv = rt_list_entry(drv->node.next, struct rt_driver, node);
|
|
|
|
+ _dm_bus_unlock(drv_lock);
|
|
|
|
+ }
|
|
|
|
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-/**
|
|
|
|
- * @brief This function add a bus to the root
|
|
|
|
- *
|
|
|
|
- * @param bus_node the bus to be added
|
|
|
|
- *
|
|
|
|
- * @return the error code, RT_EOK on added successfully.
|
|
|
|
- */
|
|
|
|
-rt_err_t rt_bus_add(rt_bus_t bus_node)
|
|
|
|
-{
|
|
|
|
- rt_base_t level;
|
|
|
|
-
|
|
|
|
- RT_ASSERT(bus_node != RT_NULL);
|
|
|
|
-
|
|
|
|
- bus_node->bus = &bus_root;
|
|
|
|
- rt_list_init(&bus_node->list);
|
|
|
|
-
|
|
|
|
- level = rt_spin_lock_irqsave(&bus_node->spinlock);
|
|
|
|
-
|
|
|
|
- rt_list_insert_before(&bus_root.children, &bus_node->list);
|
|
|
|
-
|
|
|
|
- rt_spin_unlock_irqrestore(&bus_node->spinlock, level);
|
|
|
|
-
|
|
|
|
- return RT_EOK;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-/**
|
|
|
|
- * @brief This function match the device and driver, probe them if match successed
|
|
|
|
- *
|
|
|
|
- * @param drv the drv to match/probe
|
|
|
|
- *
|
|
|
|
- * @param dev the dev to match/probe
|
|
|
|
- *
|
|
|
|
- * @return the result of probe, 1 on added successfully.
|
|
|
|
- */
|
|
|
|
-static int rt_bus_probe(rt_driver_t drv, rt_device_t dev)
|
|
|
|
|
|
+static rt_err_t bus_probe(rt_driver_t drv, rt_device_t dev)
|
|
{
|
|
{
|
|
- int ret = 0;
|
|
|
|
rt_bus_t bus = drv->bus;
|
|
rt_bus_t bus = drv->bus;
|
|
|
|
+ rt_err_t err = -RT_EEMPTY;
|
|
|
|
|
|
if (!bus)
|
|
if (!bus)
|
|
{
|
|
{
|
|
bus = dev->bus;
|
|
bus = dev->bus;
|
|
}
|
|
}
|
|
|
|
|
|
- RT_ASSERT(bus != RT_NULL);
|
|
|
|
-
|
|
|
|
if (!dev->drv && bus->match(drv, dev))
|
|
if (!dev->drv && bus->match(drv, dev))
|
|
{
|
|
{
|
|
dev->drv = drv;
|
|
dev->drv = drv;
|
|
|
|
|
|
- ret = bus->probe(dev);
|
|
|
|
|
|
+ err = bus->probe(dev);
|
|
|
|
|
|
- if (ret)
|
|
|
|
|
|
+ if (err)
|
|
{
|
|
{
|
|
dev->drv = RT_NULL;
|
|
dev->drv = RT_NULL;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
- return ret;
|
|
|
|
|
|
+ return err;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int bus_probe_driver(rt_device_t dev, void *drv_ptr)
|
|
|
|
+{
|
|
|
|
+ bus_probe(drv_ptr, dev);
|
|
|
|
+
|
|
|
|
+ /*
|
|
|
|
+ * The driver is shared by multiple devices,
|
|
|
|
+ * so we always return the '1' to enumerate all devices.
|
|
|
|
+ */
|
|
|
|
+ return 1;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int bus_probe_device(rt_driver_t drv, void *dev_ptr)
|
|
|
|
+{
|
|
|
|
+ rt_err_t err;
|
|
|
|
+
|
|
|
|
+ err = bus_probe(drv, dev_ptr);
|
|
|
|
+
|
|
|
|
+ if (!err)
|
|
|
|
+ {
|
|
|
|
+ rt_bus_t bus = drv->bus;
|
|
|
|
+
|
|
|
|
+ _dm_bus_lock(&bus->drv_lock);
|
|
|
|
+ ++drv->ref_count;
|
|
|
|
+ _dm_bus_unlock(&bus->drv_lock);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return err;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -250,20 +252,17 @@ static int rt_bus_probe(rt_driver_t drv, rt_device_t dev)
|
|
*/
|
|
*/
|
|
rt_err_t rt_bus_add_driver(rt_bus_t bus, rt_driver_t drv)
|
|
rt_err_t rt_bus_add_driver(rt_bus_t bus, rt_driver_t drv)
|
|
{
|
|
{
|
|
- rt_base_t level;
|
|
|
|
-
|
|
|
|
RT_ASSERT(bus != RT_NULL);
|
|
RT_ASSERT(bus != RT_NULL);
|
|
RT_ASSERT(drv != RT_NULL);
|
|
RT_ASSERT(drv != RT_NULL);
|
|
|
|
|
|
drv->bus = bus;
|
|
drv->bus = bus;
|
|
|
|
+ rt_list_init(&drv->node);
|
|
|
|
|
|
- level = rt_spin_lock_irqsave(&bus->spinlock);
|
|
|
|
-
|
|
|
|
|
|
+ _dm_bus_lock(&bus->drv_lock);
|
|
rt_list_insert_before(&bus->drv_list, &drv->node);
|
|
rt_list_insert_before(&bus->drv_list, &drv->node);
|
|
|
|
+ _dm_bus_unlock(&bus->drv_lock);
|
|
|
|
|
|
- rt_spin_unlock_irqrestore(&bus->spinlock, level);
|
|
|
|
-
|
|
|
|
- rt_bus_for_each_dev(drv->bus, drv, rt_bus_probe);
|
|
|
|
|
|
+ rt_bus_for_each_dev(bus, drv, bus_probe_driver);
|
|
|
|
|
|
return RT_EOK;
|
|
return RT_EOK;
|
|
}
|
|
}
|
|
@@ -279,20 +278,17 @@ rt_err_t rt_bus_add_driver(rt_bus_t bus, rt_driver_t drv)
|
|
*/
|
|
*/
|
|
rt_err_t rt_bus_add_device(rt_bus_t bus, rt_device_t dev)
|
|
rt_err_t rt_bus_add_device(rt_bus_t bus, rt_device_t dev)
|
|
{
|
|
{
|
|
- rt_base_t level;
|
|
|
|
-
|
|
|
|
RT_ASSERT(bus != RT_NULL);
|
|
RT_ASSERT(bus != RT_NULL);
|
|
RT_ASSERT(dev != RT_NULL);
|
|
RT_ASSERT(dev != RT_NULL);
|
|
|
|
|
|
dev->bus = bus;
|
|
dev->bus = bus;
|
|
|
|
+ rt_list_init(&dev->node);
|
|
|
|
|
|
- level = rt_spin_lock_irqsave(&bus->spinlock);
|
|
|
|
-
|
|
|
|
|
|
+ _dm_bus_lock(&bus->dev_lock);
|
|
rt_list_insert_before(&bus->dev_list, &dev->node);
|
|
rt_list_insert_before(&bus->dev_list, &dev->node);
|
|
|
|
+ _dm_bus_unlock(&bus->dev_lock);
|
|
|
|
|
|
- rt_spin_unlock_irqrestore(&bus->spinlock, level);
|
|
|
|
-
|
|
|
|
- rt_bus_for_each_drv(dev->bus, dev, rt_bus_probe);
|
|
|
|
|
|
+ rt_bus_for_each_drv(bus, dev, bus_probe_device);
|
|
|
|
|
|
return RT_EOK;
|
|
return RT_EOK;
|
|
}
|
|
}
|
|
@@ -306,13 +302,31 @@ rt_err_t rt_bus_add_device(rt_bus_t bus, rt_device_t dev)
|
|
*/
|
|
*/
|
|
rt_err_t rt_bus_remove_driver(rt_driver_t drv)
|
|
rt_err_t rt_bus_remove_driver(rt_driver_t drv)
|
|
{
|
|
{
|
|
|
|
+ rt_err_t err;
|
|
|
|
+ rt_bus_t bus;
|
|
|
|
+
|
|
|
|
+ RT_ASSERT(drv != RT_NULL);
|
|
RT_ASSERT(drv->bus != RT_NULL);
|
|
RT_ASSERT(drv->bus != RT_NULL);
|
|
|
|
|
|
- LOG_D("Bus(%s) remove driver %s", drv->bus->name, drv->name);
|
|
|
|
|
|
+ bus = drv->bus;
|
|
|
|
|
|
- rt_list_remove(&drv->node);
|
|
|
|
|
|
+ LOG_D("Bus(%s) remove driver %s", bus->name, drv->parent.name);
|
|
|
|
|
|
- return RT_EOK;
|
|
|
|
|
|
+ _dm_bus_lock(&bus->drv_lock);
|
|
|
|
+
|
|
|
|
+ if (drv->ref_count)
|
|
|
|
+ {
|
|
|
|
+ err = -RT_EBUSY;
|
|
|
|
+ }
|
|
|
|
+ else
|
|
|
|
+ {
|
|
|
|
+ rt_list_remove(&drv->node);
|
|
|
|
+ err = RT_EOK;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ _dm_bus_unlock(&bus->drv_lock);
|
|
|
|
+
|
|
|
|
+ return err;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -324,13 +338,104 @@ rt_err_t rt_bus_remove_driver(rt_driver_t drv)
|
|
*/
|
|
*/
|
|
rt_err_t rt_bus_remove_device(rt_device_t dev)
|
|
rt_err_t rt_bus_remove_device(rt_device_t dev)
|
|
{
|
|
{
|
|
|
|
+ rt_bus_t bus;
|
|
|
|
+ rt_driver_t drv;
|
|
|
|
+ rt_err_t err = RT_EOK;
|
|
|
|
+
|
|
|
|
+ RT_ASSERT(dev != RT_NULL);
|
|
RT_ASSERT(dev->bus != RT_NULL);
|
|
RT_ASSERT(dev->bus != RT_NULL);
|
|
|
|
|
|
- LOG_D("Bus(%s) remove device %s", dev->bus->name, dev->name);
|
|
|
|
|
|
+ bus = dev->bus;
|
|
|
|
+ drv = dev->drv;
|
|
|
|
|
|
|
|
+ LOG_D("Bus(%s) remove device %s", bus->name, dev->parent.name);
|
|
|
|
+
|
|
|
|
+ _dm_bus_lock(&bus->dev_lock);
|
|
rt_list_remove(&dev->node);
|
|
rt_list_remove(&dev->node);
|
|
|
|
+ _dm_bus_unlock(&bus->dev_lock);
|
|
|
|
|
|
- return RT_EOK;
|
|
|
|
|
|
+ if (dev->bus->remove)
|
|
|
|
+ {
|
|
|
|
+ err = dev->bus->remove(dev);
|
|
|
|
+ }
|
|
|
|
+ else if (drv)
|
|
|
|
+ {
|
|
|
|
+ if (drv->shutdown)
|
|
|
|
+ {
|
|
|
|
+ err = drv->shutdown(dev);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* device and driver are in the same bus */
|
|
|
|
+ _dm_bus_lock(&bus->drv_lock);
|
|
|
|
+ --drv->ref_count;
|
|
|
|
+ _dm_bus_unlock(&bus->drv_lock);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return err;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+struct bus_shutdown_info
|
|
|
|
+{
|
|
|
|
+ rt_bus_t bus;
|
|
|
|
+
|
|
|
|
+ rt_err_t err;
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static int device_shutdown(rt_device_t dev, void *info_ptr)
|
|
|
|
+{
|
|
|
|
+ rt_bus_t bus;
|
|
|
|
+ rt_err_t err = RT_EOK;
|
|
|
|
+ struct bus_shutdown_info *info = info_ptr;
|
|
|
|
+
|
|
|
|
+ bus = info->bus;
|
|
|
|
+
|
|
|
|
+ if (bus->shutdown)
|
|
|
|
+ {
|
|
|
|
+ LOG_D("Device(%s) shutdown", dev->parent.name);
|
|
|
|
+ err = bus->shutdown(dev);
|
|
|
|
+ LOG_D(" Result: %s", rt_strerror(err));
|
|
|
|
+ }
|
|
|
|
+ else if (dev->drv && dev->drv->shutdown)
|
|
|
|
+ {
|
|
|
|
+ LOG_D("Device(%s) shutdown", dev->parent.name);
|
|
|
|
+ err = dev->drv->shutdown(dev);
|
|
|
|
+ LOG_D(" Result: %s", rt_strerror(err));
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (err)
|
|
|
|
+ {
|
|
|
|
+ /* Only get the last one while system not crash */
|
|
|
|
+ info->err = err;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* Go on, we want to ask all devices to shutdown */
|
|
|
|
+ return 1;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * @brief This function call all buses' shutdown
|
|
|
|
+ *
|
|
|
|
+ * @return the error code, RT_EOK on shutdown successfully.
|
|
|
|
+ */
|
|
|
|
+rt_err_t rt_bus_shutdown(void)
|
|
|
|
+{
|
|
|
|
+ rt_bus_t bus = RT_NULL;
|
|
|
|
+ struct bus_shutdown_info info =
|
|
|
|
+ {
|
|
|
|
+ .err = RT_EOK,
|
|
|
|
+ };
|
|
|
|
+
|
|
|
|
+ _dm_bus_lock(&bus_lock);
|
|
|
|
+
|
|
|
|
+ rt_list_for_each_entry(bus, &bus_nodes, list)
|
|
|
|
+ {
|
|
|
|
+ info.bus = bus;
|
|
|
|
+ rt_bus_for_each_dev(bus, &info, device_shutdown);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ _dm_bus_unlock(&bus_lock);
|
|
|
|
+
|
|
|
|
+ return info.err;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -339,24 +444,24 @@ rt_err_t rt_bus_remove_device(rt_device_t dev)
|
|
*
|
|
*
|
|
* @return the bus finded by name.
|
|
* @return the bus finded by name.
|
|
*/
|
|
*/
|
|
-rt_bus_t rt_bus_find_by_name(char *name)
|
|
|
|
|
|
+rt_bus_t rt_bus_find_by_name(const char *name)
|
|
{
|
|
{
|
|
rt_bus_t bus = RT_NULL;
|
|
rt_bus_t bus = RT_NULL;
|
|
- struct rt_list_node *node = RT_NULL;
|
|
|
|
|
|
|
|
- if (!rt_list_isempty(&bus_root.children))
|
|
|
|
|
|
+ RT_ASSERT(name != RT_NULL);
|
|
|
|
+
|
|
|
|
+ _dm_bus_lock(&bus_lock);
|
|
|
|
+
|
|
|
|
+ rt_list_for_each_entry(bus, &bus_nodes, list)
|
|
{
|
|
{
|
|
- rt_list_for_each(node, &bus_root.children)
|
|
|
|
|
|
+ if (!rt_strncmp(bus->name, name, RT_NAME_MAX))
|
|
{
|
|
{
|
|
- bus = rt_list_entry(node, struct rt_bus, list);
|
|
|
|
-
|
|
|
|
- if (!rt_strncmp(bus->name, name, RT_NAME_MAX))
|
|
|
|
- {
|
|
|
|
- return bus;
|
|
|
|
- }
|
|
|
|
|
|
+ break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+ _dm_bus_unlock(&bus_lock);
|
|
|
|
+
|
|
return bus;
|
|
return bus;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -371,22 +476,20 @@ rt_bus_t rt_bus_find_by_name(char *name)
|
|
*/
|
|
*/
|
|
rt_err_t rt_bus_reload_driver_device(rt_bus_t new_bus, rt_device_t dev)
|
|
rt_err_t rt_bus_reload_driver_device(rt_bus_t new_bus, rt_device_t dev)
|
|
{
|
|
{
|
|
- rt_base_t level;
|
|
|
|
|
|
+ rt_bus_t old_bus;
|
|
|
|
|
|
RT_ASSERT(new_bus != RT_NULL);
|
|
RT_ASSERT(new_bus != RT_NULL);
|
|
RT_ASSERT(dev != RT_NULL);
|
|
RT_ASSERT(dev != RT_NULL);
|
|
|
|
+ RT_ASSERT(dev->bus != RT_NULL);
|
|
|
|
+ RT_ASSERT(dev->bus != new_bus);
|
|
|
|
|
|
- level = rt_spin_lock_irqsave(&new_bus->spinlock);
|
|
|
|
|
|
+ old_bus = dev->bus;
|
|
|
|
|
|
|
|
+ _dm_bus_lock(&old_bus->dev_lock);
|
|
rt_list_remove(&dev->node);
|
|
rt_list_remove(&dev->node);
|
|
- rt_list_insert_before(&new_bus->dev_list, &dev->node);
|
|
|
|
-
|
|
|
|
- rt_list_remove(&dev->drv->node);
|
|
|
|
- rt_list_insert_before(&new_bus->drv_list, &dev->drv->node);
|
|
|
|
|
|
+ _dm_bus_unlock(&old_bus->dev_lock);
|
|
|
|
|
|
- rt_spin_unlock_irqrestore(&new_bus->spinlock, level);
|
|
|
|
-
|
|
|
|
- return RT_EOK;
|
|
|
|
|
|
+ return rt_bus_add_device(new_bus, dev);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -397,13 +500,20 @@ rt_err_t rt_bus_reload_driver_device(rt_bus_t new_bus, rt_device_t dev)
|
|
*/
|
|
*/
|
|
rt_err_t rt_bus_register(rt_bus_t bus)
|
|
rt_err_t rt_bus_register(rt_bus_t bus)
|
|
{
|
|
{
|
|
- rt_list_init(&bus->children);
|
|
|
|
|
|
+ RT_ASSERT(bus != RT_NULL);
|
|
|
|
+
|
|
|
|
+ rt_list_init(&bus->list);
|
|
rt_list_init(&bus->dev_list);
|
|
rt_list_init(&bus->dev_list);
|
|
rt_list_init(&bus->drv_list);
|
|
rt_list_init(&bus->drv_list);
|
|
|
|
|
|
- rt_spin_lock_init(&bus->spinlock);
|
|
|
|
|
|
+ rt_spin_lock_init(&bus->dev_lock);
|
|
|
|
+ rt_spin_lock_init(&bus->drv_lock);
|
|
|
|
+
|
|
|
|
+ _dm_bus_lock(&bus_lock);
|
|
|
|
+
|
|
|
|
+ rt_list_insert_before(&bus_nodes, &bus->list);
|
|
|
|
|
|
- rt_bus_add(bus);
|
|
|
|
|
|
+ _dm_bus_unlock(&bus_lock);
|
|
|
|
|
|
return RT_EOK;
|
|
return RT_EOK;
|
|
}
|
|
}
|