slave.c 5.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243
  1. // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
  2. // Copyright(c) 2015-17 Intel Corporation.
  3. #include <linux/acpi.h>
  4. #include <linux/of.h>
  5. #include <linux/soundwire/sdw.h>
  6. #include <linux/soundwire/sdw_type.h>
  7. #include "bus.h"
  8. #include "sysfs_local.h"
  9. static void sdw_slave_release(struct device *dev)
  10. {
  11. struct sdw_slave *slave = dev_to_sdw_dev(dev);
  12. kfree(slave);
  13. }
  14. struct device_type sdw_slave_type = {
  15. .name = "sdw_slave",
  16. .release = sdw_slave_release,
  17. .uevent = sdw_slave_uevent,
  18. };
  19. int sdw_slave_add(struct sdw_bus *bus,
  20. struct sdw_slave_id *id, struct fwnode_handle *fwnode)
  21. {
  22. struct sdw_slave *slave;
  23. int ret;
  24. int i;
  25. slave = kzalloc(sizeof(*slave), GFP_KERNEL);
  26. if (!slave)
  27. return -ENOMEM;
  28. /* Initialize data structure */
  29. memcpy(&slave->id, id, sizeof(*id));
  30. slave->dev.parent = bus->dev;
  31. slave->dev.fwnode = fwnode;
  32. if (id->unique_id == SDW_IGNORED_UNIQUE_ID) {
  33. /* name shall be sdw:link:mfg:part:class */
  34. dev_set_name(&slave->dev, "sdw:%x:%x:%x:%x",
  35. bus->link_id, id->mfg_id, id->part_id,
  36. id->class_id);
  37. } else {
  38. /* name shall be sdw:link:mfg:part:class:unique */
  39. dev_set_name(&slave->dev, "sdw:%x:%x:%x:%x:%x",
  40. bus->link_id, id->mfg_id, id->part_id,
  41. id->class_id, id->unique_id);
  42. }
  43. slave->dev.bus = &sdw_bus_type;
  44. slave->dev.of_node = of_node_get(to_of_node(fwnode));
  45. slave->dev.type = &sdw_slave_type;
  46. slave->dev.groups = sdw_slave_status_attr_groups;
  47. slave->bus = bus;
  48. slave->status = SDW_SLAVE_UNATTACHED;
  49. init_completion(&slave->enumeration_complete);
  50. init_completion(&slave->initialization_complete);
  51. slave->dev_num = 0;
  52. init_completion(&slave->probe_complete);
  53. slave->probed = false;
  54. slave->first_interrupt_done = false;
  55. for (i = 0; i < SDW_MAX_PORTS; i++)
  56. init_completion(&slave->port_ready[i]);
  57. mutex_lock(&bus->bus_lock);
  58. list_add_tail(&slave->node, &bus->slaves);
  59. mutex_unlock(&bus->bus_lock);
  60. ret = device_register(&slave->dev);
  61. if (ret) {
  62. dev_err(bus->dev, "Failed to add slave: ret %d\n", ret);
  63. /*
  64. * On err, don't free but drop ref as this will be freed
  65. * when release method is invoked.
  66. */
  67. mutex_lock(&bus->bus_lock);
  68. list_del(&slave->node);
  69. mutex_unlock(&bus->bus_lock);
  70. put_device(&slave->dev);
  71. return ret;
  72. }
  73. sdw_slave_debugfs_init(slave);
  74. return ret;
  75. }
  76. #if IS_ENABLED(CONFIG_ACPI)
  77. static bool find_slave(struct sdw_bus *bus,
  78. struct acpi_device *adev,
  79. struct sdw_slave_id *id)
  80. {
  81. unsigned long long addr;
  82. unsigned int link_id;
  83. acpi_status status;
  84. status = acpi_evaluate_integer(adev->handle,
  85. METHOD_NAME__ADR, NULL, &addr);
  86. if (ACPI_FAILURE(status)) {
  87. dev_err(bus->dev, "_ADR resolution failed: %x\n",
  88. status);
  89. return false;
  90. }
  91. /* Extract link id from ADR, Bit 51 to 48 (included) */
  92. link_id = SDW_DISCO_LINK_ID(addr);
  93. /* Check for link_id match */
  94. if (link_id != bus->link_id)
  95. return false;
  96. sdw_extract_slave_id(bus, addr, id);
  97. return true;
  98. }
  99. /*
  100. * sdw_acpi_find_slaves() - Find Slave devices in Master ACPI node
  101. * @bus: SDW bus instance
  102. *
  103. * Scans Master ACPI node for SDW child Slave devices and registers it.
  104. */
  105. int sdw_acpi_find_slaves(struct sdw_bus *bus)
  106. {
  107. struct acpi_device *adev, *parent;
  108. struct acpi_device *adev2, *parent2;
  109. parent = ACPI_COMPANION(bus->dev);
  110. if (!parent) {
  111. dev_err(bus->dev, "Can't find parent for acpi bind\n");
  112. return -ENODEV;
  113. }
  114. list_for_each_entry(adev, &parent->children, node) {
  115. struct sdw_slave_id id;
  116. struct sdw_slave_id id2;
  117. bool ignore_unique_id = true;
  118. if (!find_slave(bus, adev, &id))
  119. continue;
  120. /* brute-force O(N^2) search for duplicates */
  121. parent2 = parent;
  122. list_for_each_entry(adev2, &parent2->children, node) {
  123. if (adev == adev2)
  124. continue;
  125. if (!find_slave(bus, adev2, &id2))
  126. continue;
  127. if (id.sdw_version != id2.sdw_version ||
  128. id.mfg_id != id2.mfg_id ||
  129. id.part_id != id2.part_id ||
  130. id.class_id != id2.class_id)
  131. continue;
  132. if (id.unique_id != id2.unique_id) {
  133. dev_dbg(bus->dev,
  134. "Valid unique IDs %x %x for Slave mfg %x part %d\n",
  135. id.unique_id, id2.unique_id,
  136. id.mfg_id, id.part_id);
  137. ignore_unique_id = false;
  138. } else {
  139. dev_err(bus->dev,
  140. "Invalid unique IDs %x %x for Slave mfg %x part %d\n",
  141. id.unique_id, id2.unique_id,
  142. id.mfg_id, id.part_id);
  143. return -ENODEV;
  144. }
  145. }
  146. if (ignore_unique_id)
  147. id.unique_id = SDW_IGNORED_UNIQUE_ID;
  148. /*
  149. * don't error check for sdw_slave_add as we want to continue
  150. * adding Slaves
  151. */
  152. sdw_slave_add(bus, &id, acpi_fwnode_handle(adev));
  153. }
  154. return 0;
  155. }
  156. #endif
  157. /*
  158. * sdw_of_find_slaves() - Find Slave devices in master device tree node
  159. * @bus: SDW bus instance
  160. *
  161. * Scans Master DT node for SDW child Slave devices and registers it.
  162. */
  163. int sdw_of_find_slaves(struct sdw_bus *bus)
  164. {
  165. struct device *dev = bus->dev;
  166. struct device_node *node;
  167. for_each_child_of_node(bus->dev->of_node, node) {
  168. int link_id, ret, len;
  169. unsigned int sdw_version;
  170. const char *compat = NULL;
  171. struct sdw_slave_id id;
  172. const __be32 *addr;
  173. compat = of_get_property(node, "compatible", NULL);
  174. if (!compat)
  175. continue;
  176. ret = sscanf(compat, "sdw%01x%04hx%04hx%02hhx", &sdw_version,
  177. &id.mfg_id, &id.part_id, &id.class_id);
  178. if (ret != 4) {
  179. dev_err(dev, "Invalid compatible string found %s\n",
  180. compat);
  181. continue;
  182. }
  183. addr = of_get_property(node, "reg", &len);
  184. if (!addr || (len < 2 * sizeof(u32))) {
  185. dev_err(dev, "Invalid Link and Instance ID\n");
  186. continue;
  187. }
  188. link_id = be32_to_cpup(addr++);
  189. id.unique_id = be32_to_cpup(addr);
  190. id.sdw_version = sdw_version;
  191. /* Check for link_id match */
  192. if (link_id != bus->link_id)
  193. continue;
  194. sdw_slave_add(bus, &id, of_fwnode_handle(node));
  195. }
  196. return 0;
  197. }