dev_i2c_bus.c 4.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188
  1. /*
  2. * Copyright (c) 2006-2022, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2022-12-06 GuEe-GUI first version
  9. * 2025-12-25 lhxj mark OFW node as taken to prevent platform bus duplication
  10. */
  11. #include <rtdevice.h>
  12. #define DBG_TAG "dev.i2c.bus"
  13. #define DBG_LVL DBG_INFO
  14. #include <rtdbg.h>
  15. static struct rt_bus i2c_bus;
  16. void i2c_bus_scan_clients(struct rt_i2c_bus_device *bus)
  17. {
  18. #ifdef RT_USING_OFW
  19. if (bus->parent.ofw_node)
  20. {
  21. struct rt_ofw_node *np = bus->parent.ofw_node, *child_np, *i2c_client_np;
  22. rt_ofw_foreach_available_child_node(np, child_np)
  23. {
  24. rt_uint32_t client_addr;
  25. struct rt_i2c_client *client;
  26. if (rt_ofw_prop_read_bool(child_np, "compatible"))
  27. {
  28. i2c_client_np = child_np;
  29. }
  30. else
  31. {
  32. /* Maybe in i2c-mux */
  33. i2c_client_np = rt_ofw_get_next_child(child_np, RT_NULL);
  34. if (!rt_ofw_prop_read_bool(i2c_client_np, "compatible"))
  35. {
  36. continue;
  37. }
  38. }
  39. client = rt_calloc(1, sizeof(*client));
  40. if (!client)
  41. {
  42. rt_ofw_node_put(i2c_client_np);
  43. LOG_E("Not memory to create i2c client: %s",
  44. rt_ofw_node_full_name(i2c_client_np));
  45. return;
  46. }
  47. rt_ofw_prop_read_u32(i2c_client_np, "reg", &client_addr);
  48. client->parent.ofw_node = i2c_client_np;
  49. client->name = rt_ofw_node_name(i2c_client_np);
  50. client->bus = bus;
  51. client->client_addr = client_addr;
  52. rt_dm_dev_set_name(&client->parent, "%s", client->name);
  53. /* Mark this OFW node as taken to prevent platform bus from creating duplicate device */
  54. i2c_client_np->dev = &client->parent;
  55. rt_i2c_device_register(client);
  56. if (i2c_client_np != child_np)
  57. {
  58. rt_ofw_node_put(i2c_client_np);
  59. }
  60. }
  61. }
  62. #endif /* RT_USING_OFW */
  63. }
  64. rt_err_t rt_i2c_driver_register(struct rt_i2c_driver *driver)
  65. {
  66. RT_ASSERT(driver != RT_NULL);
  67. driver->parent.bus = &i2c_bus;
  68. return rt_driver_register(&driver->parent);
  69. }
  70. rt_err_t rt_i2c_device_register(struct rt_i2c_client *client)
  71. {
  72. RT_ASSERT(client != RT_NULL);
  73. return rt_bus_add_device(&i2c_bus, &client->parent);
  74. }
  75. static rt_bool_t i2c_match(rt_driver_t drv, rt_device_t dev)
  76. {
  77. const struct rt_i2c_device_id *id;
  78. struct rt_i2c_driver *driver = rt_container_of(drv, struct rt_i2c_driver, parent);
  79. struct rt_i2c_client *client = rt_container_of(dev, struct rt_i2c_client, parent);
  80. if ((id = driver->ids))
  81. {
  82. for (; id->name[0]; ++id)
  83. {
  84. if (!rt_strcmp(id->name, client->name))
  85. {
  86. client->id = id;
  87. client->ofw_id = RT_NULL;
  88. return RT_TRUE;
  89. }
  90. }
  91. }
  92. #ifdef RT_USING_OFW
  93. client->ofw_id = rt_ofw_node_match(client->parent.ofw_node, driver->ofw_ids);
  94. if (client->ofw_id)
  95. {
  96. client->id = RT_NULL;
  97. return RT_TRUE;
  98. }
  99. #endif
  100. return RT_FALSE;
  101. }
  102. static rt_err_t i2c_probe(rt_device_t dev)
  103. {
  104. rt_err_t err;
  105. struct rt_i2c_driver *driver = rt_container_of(dev->drv, struct rt_i2c_driver, parent);
  106. struct rt_i2c_client *client = rt_container_of(dev, struct rt_i2c_client, parent);
  107. if (!client->bus)
  108. {
  109. return -RT_EINVAL;
  110. }
  111. err = driver->probe(client);
  112. return err;
  113. }
  114. static rt_err_t i2c_remove(rt_device_t dev)
  115. {
  116. struct rt_i2c_driver *driver = rt_container_of(dev->drv, struct rt_i2c_driver, parent);
  117. struct rt_i2c_client *client = rt_container_of(dev, struct rt_i2c_client, parent);
  118. if (driver && driver->remove)
  119. {
  120. driver->remove(client);
  121. }
  122. return RT_EOK;
  123. }
  124. static rt_err_t i2c_shutdown(rt_device_t dev)
  125. {
  126. struct rt_i2c_driver *driver = rt_container_of(dev->drv, struct rt_i2c_driver, parent);
  127. struct rt_i2c_client *client = rt_container_of(dev, struct rt_i2c_client, parent);
  128. if (driver && driver->shutdown)
  129. {
  130. driver->shutdown(client);
  131. }
  132. return RT_EOK;
  133. }
  134. static struct rt_bus i2c_bus =
  135. {
  136. .name = "i2c",
  137. .match = i2c_match,
  138. .probe = i2c_probe,
  139. .remove = i2c_remove,
  140. .shutdown = i2c_shutdown,
  141. };
  142. static int i2c_bus_init(void)
  143. {
  144. rt_bus_register(&i2c_bus);
  145. return 0;
  146. }
  147. INIT_CORE_EXPORT(i2c_bus_init);