setup-res.c 6.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266
  1. /*
  2. * drivers/pci/setup-res.c
  3. *
  4. * Extruded from code written by
  5. * Dave Rusling (david.rusling@reo.mts.dec.com)
  6. * David Mosberger (davidm@cs.arizona.edu)
  7. * David Miller (davem@redhat.com)
  8. *
  9. * Support routines for initializing a PCI subsystem.
  10. */
  11. /* fixed for multiple pci buses, 1999 Andrea Arcangeli <andrea@suse.de> */
  12. /*
  13. * Nov 2000, Ivan Kokshaysky <ink@jurassic.park.msu.ru>
  14. * Resource sorting
  15. */
  16. #include <linux/init.h>
  17. #include <linux/kernel.h>
  18. #include <linux/pci.h>
  19. #include <linux/errno.h>
  20. #include <linux/ioport.h>
  21. #include <linux/cache.h>
  22. #include <linux/slab.h>
  23. #include "pci.h"
  24. void
  25. pci_update_resource(struct pci_dev *dev, struct resource *res, int resno)
  26. {
  27. struct pci_bus_region region;
  28. u32 new, check, mask;
  29. int reg;
  30. /*
  31. * Ignore resources for unimplemented BARs and unused resource slots
  32. * for 64 bit BARs.
  33. */
  34. if (!res->flags)
  35. return;
  36. /*
  37. * Ignore non-moveable resources. This might be legacy resources for
  38. * which no functional BAR register exists or another important
  39. * system resource we should better not move around in system address
  40. * space.
  41. */
  42. if (res->flags & IORESOURCE_PCI_FIXED)
  43. return;
  44. pcibios_resource_to_bus(dev, &region, res);
  45. pr_debug(" got res [%llx:%llx] bus [%lx:%lx] flags %lx for "
  46. "BAR %d of %s\n", (unsigned long long)res->start,
  47. (unsigned long long)res->end,
  48. region.start, region.end, res->flags, resno, pci_name(dev));
  49. new = region.start | (res->flags & PCI_REGION_FLAG_MASK);
  50. if (res->flags & IORESOURCE_IO)
  51. mask = (u32)PCI_BASE_ADDRESS_IO_MASK;
  52. else
  53. mask = (u32)PCI_BASE_ADDRESS_MEM_MASK;
  54. if (resno < 6) {
  55. reg = PCI_BASE_ADDRESS_0 + 4 * resno;
  56. } else if (resno == PCI_ROM_RESOURCE) {
  57. if (!(res->flags & IORESOURCE_ROM_ENABLE))
  58. return;
  59. new |= PCI_ROM_ADDRESS_ENABLE;
  60. reg = dev->rom_base_reg;
  61. } else {
  62. /* Hmm, non-standard resource. */
  63. return; /* kill uninitialised var warning */
  64. }
  65. pci_write_config_dword(dev, reg, new);
  66. pci_read_config_dword(dev, reg, &check);
  67. if ((new ^ check) & mask) {
  68. printk(KERN_ERR "PCI: Error while updating region "
  69. "%s/%d (%08x != %08x)\n", pci_name(dev), resno,
  70. new, check);
  71. }
  72. if ((new & (PCI_BASE_ADDRESS_SPACE|PCI_BASE_ADDRESS_MEM_TYPE_MASK)) ==
  73. (PCI_BASE_ADDRESS_SPACE_MEMORY|PCI_BASE_ADDRESS_MEM_TYPE_64)) {
  74. new = region.start >> 16 >> 16;
  75. pci_write_config_dword(dev, reg + 4, new);
  76. pci_read_config_dword(dev, reg + 4, &check);
  77. if (check != new) {
  78. printk(KERN_ERR "PCI: Error updating region "
  79. "%s/%d (high %08x != %08x)\n",
  80. pci_name(dev), resno, new, check);
  81. }
  82. }
  83. res->flags &= ~IORESOURCE_UNSET;
  84. pr_debug("PCI: moved device %s resource %d (%lx) to %x\n",
  85. pci_name(dev), resno, res->flags,
  86. new & ~PCI_REGION_FLAG_MASK);
  87. }
  88. int __devinit
  89. pci_claim_resource(struct pci_dev *dev, int resource)
  90. {
  91. struct resource *res = &dev->resource[resource];
  92. struct resource *root = NULL;
  93. char *dtype = resource < PCI_BRIDGE_RESOURCES ? "device" : "bridge";
  94. int err;
  95. root = pcibios_select_root(dev, res);
  96. err = -EINVAL;
  97. if (root != NULL)
  98. err = insert_resource(root, res);
  99. if (err) {
  100. printk(KERN_ERR "PCI: %s region %d of %s %s [%llx:%llx]\n",
  101. root ? "Address space collision on" :
  102. "No parent found for",
  103. resource, dtype, pci_name(dev),
  104. (unsigned long long)res->start,
  105. (unsigned long long)res->end);
  106. }
  107. return err;
  108. }
  109. EXPORT_SYMBOL_GPL(pci_claim_resource);
  110. int pci_assign_resource(struct pci_dev *dev, int resno)
  111. {
  112. struct pci_bus *bus = dev->bus;
  113. struct resource *res = dev->resource + resno;
  114. resource_size_t size, min, align;
  115. int ret;
  116. size = res->end - res->start + 1;
  117. min = (res->flags & IORESOURCE_IO) ? PCIBIOS_MIN_IO : PCIBIOS_MIN_MEM;
  118. /* The bridge resources are special, as their
  119. size != alignment. Sizing routines return
  120. required alignment in the "start" field. */
  121. align = (resno < PCI_BRIDGE_RESOURCES) ? size : res->start;
  122. /* First, try exact prefetching match.. */
  123. ret = pci_bus_alloc_resource(bus, res, size, align, min,
  124. IORESOURCE_PREFETCH,
  125. pcibios_align_resource, dev);
  126. if (ret < 0 && (res->flags & IORESOURCE_PREFETCH)) {
  127. /*
  128. * That failed.
  129. *
  130. * But a prefetching area can handle a non-prefetching
  131. * window (it will just not perform as well).
  132. */
  133. ret = pci_bus_alloc_resource(bus, res, size, align, min, 0,
  134. pcibios_align_resource, dev);
  135. }
  136. if (ret) {
  137. printk(KERN_ERR "PCI: Failed to allocate %s resource "
  138. "#%d:%llx@%llx for %s\n",
  139. res->flags & IORESOURCE_IO ? "I/O" : "mem",
  140. resno, (unsigned long long)size,
  141. (unsigned long long)res->start, pci_name(dev));
  142. } else if (resno < PCI_BRIDGE_RESOURCES) {
  143. pci_update_resource(dev, res, resno);
  144. }
  145. return ret;
  146. }
  147. #ifdef CONFIG_EMBEDDED
  148. int pci_assign_resource_fixed(struct pci_dev *dev, int resno)
  149. {
  150. struct pci_bus *bus = dev->bus;
  151. struct resource *res = dev->resource + resno;
  152. unsigned int type_mask;
  153. int i, ret = -EBUSY;
  154. type_mask = IORESOURCE_IO | IORESOURCE_MEM | IORESOURCE_PREFETCH;
  155. for (i = 0; i < PCI_BUS_NUM_RESOURCES; i++) {
  156. struct resource *r = bus->resource[i];
  157. if (!r)
  158. continue;
  159. /* type_mask must match */
  160. if ((res->flags ^ r->flags) & type_mask)
  161. continue;
  162. ret = request_resource(r, res);
  163. if (ret == 0)
  164. break;
  165. }
  166. if (ret) {
  167. printk(KERN_ERR "PCI: Failed to allocate %s resource "
  168. "#%d:%llx@%llx for %s\n",
  169. res->flags & IORESOURCE_IO ? "I/O" : "mem",
  170. resno, (unsigned long long)(res->end - res->start + 1),
  171. (unsigned long long)res->start, pci_name(dev));
  172. } else if (resno < PCI_BRIDGE_RESOURCES) {
  173. pci_update_resource(dev, res, resno);
  174. }
  175. return ret;
  176. }
  177. EXPORT_SYMBOL_GPL(pci_assign_resource_fixed);
  178. #endif
  179. /* Sort resources by alignment */
  180. void __devinit
  181. pdev_sort_resources(struct pci_dev *dev, struct resource_list *head)
  182. {
  183. int i;
  184. for (i = 0; i < PCI_NUM_RESOURCES; i++) {
  185. struct resource *r;
  186. struct resource_list *list, *tmp;
  187. resource_size_t r_align;
  188. r = &dev->resource[i];
  189. if (r->flags & IORESOURCE_PCI_FIXED)
  190. continue;
  191. r_align = r->end - r->start;
  192. if (!(r->flags) || r->parent)
  193. continue;
  194. if (!r_align) {
  195. printk(KERN_WARNING "PCI: Ignore bogus resource %d "
  196. "[%llx:%llx] of %s\n",
  197. i, (unsigned long long)r->start,
  198. (unsigned long long)r->end, pci_name(dev));
  199. continue;
  200. }
  201. r_align = (i < PCI_BRIDGE_RESOURCES) ? r_align + 1 : r->start;
  202. for (list = head; ; list = list->next) {
  203. resource_size_t align = 0;
  204. struct resource_list *ln = list->next;
  205. int idx;
  206. if (ln) {
  207. idx = ln->res - &ln->dev->resource[0];
  208. align = (idx < PCI_BRIDGE_RESOURCES) ?
  209. ln->res->end - ln->res->start + 1 :
  210. ln->res->start;
  211. }
  212. if (r_align > align) {
  213. tmp = kmalloc(sizeof(*tmp), GFP_KERNEL);
  214. if (!tmp)
  215. panic("pdev_sort_resources(): "
  216. "kmalloc() failed!\n");
  217. tmp->next = ln;
  218. tmp->res = r;
  219. tmp->dev = dev;
  220. list->next = tmp;
  221. break;
  222. }
  223. }
  224. }
  225. }