|
|
@@ -0,0 +1,182 @@
|
|
|
+/*
|
|
|
+ * Copyright (c) 2006-2022, RT-Thread Development Team
|
|
|
+ *
|
|
|
+ * SPDX-License-Identifier: Apache-2.0
|
|
|
+ *
|
|
|
+ * Change Logs:
|
|
|
+ * Date Author Notes
|
|
|
+ * 2022-12-06 GuEe-GUI first version
|
|
|
+ */
|
|
|
+
|
|
|
+#include <rtdevice.h>
|
|
|
+
|
|
|
+#define DBG_TAG "i2c.bus"
|
|
|
+#define DBG_LVL DBG_INFO
|
|
|
+#include <rtdbg.h>
|
|
|
+
|
|
|
+static struct rt_bus i2c_bus;
|
|
|
+
|
|
|
+void i2c_bus_scan_clients(struct rt_i2c_bus_device *bus)
|
|
|
+{
|
|
|
+#ifdef RT_USING_OFW
|
|
|
+ if (bus->parent.ofw_node)
|
|
|
+ {
|
|
|
+ struct rt_ofw_node *np = bus->parent.ofw_node, *child_np, *i2c_client_np;
|
|
|
+
|
|
|
+ rt_ofw_foreach_available_child_node(np, child_np)
|
|
|
+ {
|
|
|
+ rt_uint32_t client_addr;
|
|
|
+ struct rt_i2c_client *client;
|
|
|
+
|
|
|
+ if (rt_ofw_prop_read_bool(child_np, "compatible"))
|
|
|
+ {
|
|
|
+ i2c_client_np = child_np;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* Maybe in i2c-mux */
|
|
|
+ i2c_client_np = rt_ofw_get_next_child(child_np, RT_NULL);
|
|
|
+
|
|
|
+ if (!rt_ofw_prop_read_bool(i2c_client_np, "compatible"))
|
|
|
+ {
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ client = rt_calloc(1, sizeof(*client));
|
|
|
+
|
|
|
+ if (!client)
|
|
|
+ {
|
|
|
+ rt_ofw_node_put(i2c_client_np);
|
|
|
+ LOG_E("Not memory to create i2c client: %s",
|
|
|
+ rt_ofw_node_full_name(i2c_client_np));
|
|
|
+
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ rt_ofw_prop_read_u32(i2c_client_np, "reg", &client_addr);
|
|
|
+
|
|
|
+ client->parent.ofw_node = i2c_client_np;
|
|
|
+ client->name = rt_ofw_node_name(i2c_client_np);
|
|
|
+ client->bus = bus;
|
|
|
+ client->client_addr = client_addr;
|
|
|
+
|
|
|
+ rt_i2c_device_register(client);
|
|
|
+
|
|
|
+ if (i2c_client_np != child_np)
|
|
|
+ {
|
|
|
+ rt_ofw_node_put(i2c_client_np);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+#endif /* RT_USING_OFW */
|
|
|
+}
|
|
|
+
|
|
|
+rt_err_t rt_i2c_driver_register(struct rt_i2c_driver *driver)
|
|
|
+{
|
|
|
+ RT_ASSERT(driver != RT_NULL);
|
|
|
+
|
|
|
+ driver->parent.bus = &i2c_bus;
|
|
|
+
|
|
|
+ return rt_driver_register(&driver->parent);
|
|
|
+}
|
|
|
+
|
|
|
+rt_err_t rt_i2c_device_register(struct rt_i2c_client *client)
|
|
|
+{
|
|
|
+ RT_ASSERT(client != RT_NULL);
|
|
|
+
|
|
|
+ return rt_bus_add_device(&i2c_bus, &client->parent);
|
|
|
+}
|
|
|
+
|
|
|
+static rt_bool_t i2c_match(rt_driver_t drv, rt_device_t dev)
|
|
|
+{
|
|
|
+ const struct rt_i2c_device_id *id;
|
|
|
+ struct rt_i2c_driver *driver = rt_container_of(drv, struct rt_i2c_driver, parent);
|
|
|
+ struct rt_i2c_client *client = rt_container_of(dev, struct rt_i2c_client, parent);
|
|
|
+
|
|
|
+ if ((id = driver->ids))
|
|
|
+ {
|
|
|
+ for (; id->name[0]; ++id)
|
|
|
+ {
|
|
|
+ if (!rt_strcmp(id->name, client->name))
|
|
|
+ {
|
|
|
+ client->id = id;
|
|
|
+ client->ofw_id = RT_NULL;
|
|
|
+
|
|
|
+ return RT_TRUE;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+#ifdef RT_USING_OFW
|
|
|
+ client->ofw_id = rt_ofw_node_match(client->parent.ofw_node, driver->ofw_ids);
|
|
|
+
|
|
|
+ if (client->ofw_id)
|
|
|
+ {
|
|
|
+ client->id = RT_NULL;
|
|
|
+
|
|
|
+ return RT_TRUE;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ return RT_FALSE;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t i2c_probe(rt_device_t dev)
|
|
|
+{
|
|
|
+ rt_err_t err;
|
|
|
+ struct rt_i2c_driver *driver = rt_container_of(dev->drv, struct rt_i2c_driver, parent);
|
|
|
+ struct rt_i2c_client *client = rt_container_of(dev, struct rt_i2c_client, parent);
|
|
|
+
|
|
|
+ if (!client->bus)
|
|
|
+ {
|
|
|
+ return -RT_EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ err = driver->probe(client);
|
|
|
+
|
|
|
+ return err;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t i2c_remove(rt_device_t dev)
|
|
|
+{
|
|
|
+ struct rt_i2c_driver *driver = rt_container_of(dev->drv, struct rt_i2c_driver, parent);
|
|
|
+ struct rt_i2c_client *client = rt_container_of(dev, struct rt_i2c_client, parent);
|
|
|
+
|
|
|
+ if (driver && driver->remove)
|
|
|
+ {
|
|
|
+ driver->remove(client);
|
|
|
+ }
|
|
|
+
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t i2c_shutdown(rt_device_t dev)
|
|
|
+{
|
|
|
+ struct rt_i2c_driver *driver = rt_container_of(dev->drv, struct rt_i2c_driver, parent);
|
|
|
+ struct rt_i2c_client *client = rt_container_of(dev, struct rt_i2c_client, parent);
|
|
|
+
|
|
|
+ if (driver && driver->shutdown)
|
|
|
+ {
|
|
|
+ driver->shutdown(client);
|
|
|
+ }
|
|
|
+
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static struct rt_bus i2c_bus =
|
|
|
+{
|
|
|
+ .name = "i2c",
|
|
|
+ .match = i2c_match,
|
|
|
+ .probe = i2c_probe,
|
|
|
+ .remove = i2c_remove,
|
|
|
+ .shutdown = i2c_shutdown,
|
|
|
+};
|
|
|
+
|
|
|
+static int i2c_bus_init(void)
|
|
|
+{
|
|
|
+ rt_bus_register(&i2c_bus);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+INIT_CORE_EXPORT(i2c_bus_init);
|
zms123456