bus.c 7.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332
  1. /*
  2. * drivers/pci/bus.c
  3. *
  4. * From setup-res.c, by:
  5. * Dave Rusling (david.rusling@reo.mts.dec.com)
  6. * David Mosberger (davidm@cs.arizona.edu)
  7. * David Miller (davem@redhat.com)
  8. * Ivan Kokshaysky (ink@jurassic.park.msu.ru)
  9. */
  10. #include <linux/module.h>
  11. #include <linux/kernel.h>
  12. #include <linux/pci.h>
  13. #include <linux/errno.h>
  14. #include <linux/ioport.h>
  15. #include <linux/proc_fs.h>
  16. #include <linux/init.h>
  17. #include <linux/slab.h>
  18. #include "pci.h"
  19. void pci_add_resource_offset(struct list_head *resources, struct resource *res,
  20. resource_size_t offset)
  21. {
  22. struct pci_host_bridge_window *window;
  23. window = kzalloc(sizeof(struct pci_host_bridge_window), GFP_KERNEL);
  24. if (!window) {
  25. printk(KERN_ERR "PCI: can't add host bridge window %pR\n", res);
  26. return;
  27. }
  28. window->res = res;
  29. window->offset = offset;
  30. list_add_tail(&window->list, resources);
  31. }
  32. EXPORT_SYMBOL(pci_add_resource_offset);
  33. void pci_add_resource(struct list_head *resources, struct resource *res)
  34. {
  35. pci_add_resource_offset(resources, res, 0);
  36. }
  37. EXPORT_SYMBOL(pci_add_resource);
  38. void pci_free_resource_list(struct list_head *resources)
  39. {
  40. struct pci_host_bridge_window *window, *tmp;
  41. list_for_each_entry_safe(window, tmp, resources, list) {
  42. list_del(&window->list);
  43. kfree(window);
  44. }
  45. }
  46. EXPORT_SYMBOL(pci_free_resource_list);
  47. void pci_bus_add_resource(struct pci_bus *bus, struct resource *res,
  48. unsigned int flags)
  49. {
  50. struct pci_bus_resource *bus_res;
  51. bus_res = kzalloc(sizeof(struct pci_bus_resource), GFP_KERNEL);
  52. if (!bus_res) {
  53. dev_err(&bus->dev, "can't add %pR resource\n", res);
  54. return;
  55. }
  56. bus_res->res = res;
  57. bus_res->flags = flags;
  58. list_add_tail(&bus_res->list, &bus->resources);
  59. }
  60. struct resource *pci_bus_resource_n(const struct pci_bus *bus, int n)
  61. {
  62. struct pci_bus_resource *bus_res;
  63. if (n < PCI_BRIDGE_RESOURCE_NUM)
  64. return bus->resource[n];
  65. n -= PCI_BRIDGE_RESOURCE_NUM;
  66. list_for_each_entry(bus_res, &bus->resources, list) {
  67. if (n-- == 0)
  68. return bus_res->res;
  69. }
  70. return NULL;
  71. }
  72. EXPORT_SYMBOL_GPL(pci_bus_resource_n);
  73. void pci_bus_remove_resources(struct pci_bus *bus)
  74. {
  75. int i;
  76. for (i = 0; i < PCI_BRIDGE_RESOURCE_NUM; i++)
  77. bus->resource[i] = NULL;
  78. pci_free_resource_list(&bus->resources);
  79. }
  80. /**
  81. * pci_bus_alloc_resource - allocate a resource from a parent bus
  82. * @bus: PCI bus
  83. * @res: resource to allocate
  84. * @size: size of resource to allocate
  85. * @align: alignment of resource to allocate
  86. * @min: minimum /proc/iomem address to allocate
  87. * @type_mask: IORESOURCE_* type flags
  88. * @alignf: resource alignment function
  89. * @alignf_data: data argument for resource alignment function
  90. *
  91. * Given the PCI bus a device resides on, the size, minimum address,
  92. * alignment and type, try to find an acceptable resource allocation
  93. * for a specific device resource.
  94. */
  95. int
  96. pci_bus_alloc_resource(struct pci_bus *bus, struct resource *res,
  97. resource_size_t size, resource_size_t align,
  98. resource_size_t min, unsigned int type_mask,
  99. resource_size_t (*alignf)(void *,
  100. const struct resource *,
  101. resource_size_t,
  102. resource_size_t),
  103. void *alignf_data)
  104. {
  105. int i, ret = -ENOMEM;
  106. struct resource *r;
  107. resource_size_t max = -1;
  108. type_mask |= IORESOURCE_IO | IORESOURCE_MEM;
  109. /* don't allocate too high if the pref mem doesn't support 64bit*/
  110. if (!(res->flags & IORESOURCE_MEM_64))
  111. max = PCIBIOS_MAX_MEM_32;
  112. pci_bus_for_each_resource(bus, r, i) {
  113. if (!r)
  114. continue;
  115. /* type_mask must match */
  116. if ((res->flags ^ r->flags) & type_mask)
  117. continue;
  118. /* We cannot allocate a non-prefetching resource
  119. from a pre-fetching area */
  120. if ((r->flags & IORESOURCE_PREFETCH) &&
  121. !(res->flags & IORESOURCE_PREFETCH))
  122. continue;
  123. /* Ok, try it out.. */
  124. ret = allocate_resource(r, res, size,
  125. r->start ? : min,
  126. max, align,
  127. alignf, alignf_data);
  128. if (ret == 0)
  129. break;
  130. }
  131. return ret;
  132. }
  133. /**
  134. * pci_bus_add_device - add a single device
  135. * @dev: device to add
  136. *
  137. * This adds a single pci device to the global
  138. * device list and adds sysfs and procfs entries
  139. */
  140. int pci_bus_add_device(struct pci_dev *dev)
  141. {
  142. int retval;
  143. retval = device_add(&dev->dev);
  144. if (retval)
  145. return retval;
  146. dev->is_added = 1;
  147. pci_proc_attach_device(dev);
  148. pci_create_sysfs_dev_files(dev);
  149. return 0;
  150. }
  151. /**
  152. * pci_bus_add_child - add a child bus
  153. * @bus: bus to add
  154. *
  155. * This adds sysfs entries for a single bus
  156. */
  157. int pci_bus_add_child(struct pci_bus *bus)
  158. {
  159. int retval;
  160. if (bus->bridge)
  161. bus->dev.parent = bus->bridge;
  162. retval = device_register(&bus->dev);
  163. if (retval)
  164. return retval;
  165. bus->is_added = 1;
  166. /* Create legacy_io and legacy_mem files for this bus */
  167. pci_create_legacy_files(bus);
  168. return retval;
  169. }
  170. /**
  171. * pci_bus_add_devices - insert newly discovered PCI devices
  172. * @bus: bus to check for new devices
  173. *
  174. * Add newly discovered PCI devices (which are on the bus->devices
  175. * list) to the global PCI device list, add the sysfs and procfs
  176. * entries. Where a bridge is found, add the discovered bus to
  177. * the parents list of child buses, and recurse (breadth-first
  178. * to be compatible with 2.4)
  179. *
  180. * Call hotplug for each new devices.
  181. */
  182. void pci_bus_add_devices(const struct pci_bus *bus)
  183. {
  184. struct pci_dev *dev;
  185. struct pci_bus *child;
  186. int retval;
  187. list_for_each_entry(dev, &bus->devices, bus_list) {
  188. /* Skip already-added devices */
  189. if (dev->is_added)
  190. continue;
  191. retval = pci_bus_add_device(dev);
  192. if (retval)
  193. dev_err(&dev->dev, "Error adding device, continuing\n");
  194. }
  195. list_for_each_entry(dev, &bus->devices, bus_list) {
  196. BUG_ON(!dev->is_added);
  197. child = dev->subordinate;
  198. /*
  199. * If there is an unattached subordinate bus, attach
  200. * it and then scan for unattached PCI devices.
  201. */
  202. if (!child)
  203. continue;
  204. if (list_empty(&child->node)) {
  205. down_write(&pci_bus_sem);
  206. list_add_tail(&child->node, &dev->bus->children);
  207. up_write(&pci_bus_sem);
  208. }
  209. pci_bus_add_devices(child);
  210. /*
  211. * register the bus with sysfs as the parent is now
  212. * properly registered.
  213. */
  214. if (child->is_added)
  215. continue;
  216. retval = pci_bus_add_child(child);
  217. if (retval)
  218. dev_err(&dev->dev, "Error adding bus, continuing\n");
  219. }
  220. }
  221. void pci_enable_bridges(struct pci_bus *bus)
  222. {
  223. struct pci_dev *dev;
  224. int retval;
  225. list_for_each_entry(dev, &bus->devices, bus_list) {
  226. if (dev->subordinate) {
  227. if (!pci_is_enabled(dev)) {
  228. retval = pci_enable_device(dev);
  229. if (retval)
  230. dev_err(&dev->dev, "Error enabling bridge (%d), continuing\n", retval);
  231. pci_set_master(dev);
  232. }
  233. pci_enable_bridges(dev->subordinate);
  234. }
  235. }
  236. }
  237. /** pci_walk_bus - walk devices on/under bus, calling callback.
  238. * @top bus whose devices should be walked
  239. * @cb callback to be called for each device found
  240. * @userdata arbitrary pointer to be passed to callback.
  241. *
  242. * Walk the given bus, including any bridged devices
  243. * on buses under this bus. Call the provided callback
  244. * on each device found.
  245. *
  246. * We check the return of @cb each time. If it returns anything
  247. * other than 0, we break out.
  248. *
  249. */
  250. void pci_walk_bus(struct pci_bus *top, int (*cb)(struct pci_dev *, void *),
  251. void *userdata)
  252. {
  253. struct pci_dev *dev;
  254. struct pci_bus *bus;
  255. struct list_head *next;
  256. int retval;
  257. bus = top;
  258. down_read(&pci_bus_sem);
  259. next = top->devices.next;
  260. for (;;) {
  261. if (next == &bus->devices) {
  262. /* end of this bus, go up or finish */
  263. if (bus == top)
  264. break;
  265. next = bus->self->bus_list.next;
  266. bus = bus->self->bus;
  267. continue;
  268. }
  269. dev = list_entry(next, struct pci_dev, bus_list);
  270. if (dev->subordinate) {
  271. /* this is a pci-pci bridge, do its devices next */
  272. next = dev->subordinate->devices.next;
  273. bus = dev->subordinate;
  274. } else
  275. next = dev->bus_list.next;
  276. /* Run device routines with the device locked */
  277. device_lock(&dev->dev);
  278. retval = cb(dev, userdata);
  279. device_unlock(&dev->dev);
  280. if (retval)
  281. break;
  282. }
  283. up_read(&pci_bus_sem);
  284. }
  285. EXPORT_SYMBOL_GPL(pci_walk_bus);
  286. EXPORT_SYMBOL(pci_bus_alloc_resource);
  287. EXPORT_SYMBOL_GPL(pci_bus_add_device);
  288. EXPORT_SYMBOL(pci_bus_add_devices);
  289. EXPORT_SYMBOL(pci_enable_bridges);