pci.c 49 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881
  1. /*
  2. * Common pmac/prep/chrp pci routines. -- Cort
  3. */
  4. #include <linux/config.h>
  5. #include <linux/kernel.h>
  6. #include <linux/pci.h>
  7. #include <linux/delay.h>
  8. #include <linux/string.h>
  9. #include <linux/init.h>
  10. #include <linux/capability.h>
  11. #include <linux/sched.h>
  12. #include <linux/errno.h>
  13. #include <linux/bootmem.h>
  14. #include <asm/processor.h>
  15. #include <asm/io.h>
  16. #include <asm/prom.h>
  17. #include <asm/sections.h>
  18. #include <asm/pci-bridge.h>
  19. #include <asm/byteorder.h>
  20. #include <asm/irq.h>
  21. #include <asm/uaccess.h>
  22. #undef DEBUG
  23. #ifdef DEBUG
  24. #define DBG(x...) printk(x)
  25. #else
  26. #define DBG(x...)
  27. #endif
  28. unsigned long isa_io_base = 0;
  29. unsigned long isa_mem_base = 0;
  30. unsigned long pci_dram_offset = 0;
  31. int pcibios_assign_bus_offset = 1;
  32. void pcibios_make_OF_bus_map(void);
  33. static int pci_relocate_bridge_resource(struct pci_bus *bus, int i);
  34. static int probe_resource(struct pci_bus *parent, struct resource *pr,
  35. struct resource *res, struct resource **conflict);
  36. static void update_bridge_base(struct pci_bus *bus, int i);
  37. static void pcibios_fixup_resources(struct pci_dev* dev);
  38. static void fixup_broken_pcnet32(struct pci_dev* dev);
  39. static int reparent_resources(struct resource *parent, struct resource *res);
  40. static void fixup_rev1_53c810(struct pci_dev* dev);
  41. static void fixup_cpc710_pci64(struct pci_dev* dev);
  42. #ifdef CONFIG_PPC_OF
  43. static u8* pci_to_OF_bus_map;
  44. #endif
  45. /* By default, we don't re-assign bus numbers. We do this only on
  46. * some pmacs
  47. */
  48. int pci_assign_all_busses;
  49. struct pci_controller* hose_head;
  50. struct pci_controller** hose_tail = &hose_head;
  51. static int pci_bus_count;
  52. static void
  53. fixup_rev1_53c810(struct pci_dev* dev)
  54. {
  55. /* rev 1 ncr53c810 chips don't set the class at all which means
  56. * they don't get their resources remapped. Fix that here.
  57. */
  58. if ((dev->class == PCI_CLASS_NOT_DEFINED)) {
  59. printk("NCR 53c810 rev 1 detected, setting PCI class.\n");
  60. dev->class = PCI_CLASS_STORAGE_SCSI;
  61. }
  62. }
  63. DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_NCR, PCI_DEVICE_ID_NCR_53C810, fixup_rev1_53c810);
  64. static void
  65. fixup_broken_pcnet32(struct pci_dev* dev)
  66. {
  67. if ((dev->class>>8 == PCI_CLASS_NETWORK_ETHERNET)) {
  68. dev->vendor = PCI_VENDOR_ID_AMD;
  69. pci_write_config_word(dev, PCI_VENDOR_ID, PCI_VENDOR_ID_AMD);
  70. pci_name_device(dev);
  71. }
  72. }
  73. DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_TRIDENT, PCI_ANY_ID, fixup_broken_pcnet32);
  74. static void
  75. fixup_cpc710_pci64(struct pci_dev* dev)
  76. {
  77. /* Hide the PCI64 BARs from the kernel as their content doesn't
  78. * fit well in the resource management
  79. */
  80. dev->resource[0].start = dev->resource[0].end = 0;
  81. dev->resource[0].flags = 0;
  82. dev->resource[1].start = dev->resource[1].end = 0;
  83. dev->resource[1].flags = 0;
  84. }
  85. DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CPC710_PCI64, fixup_cpc710_pci64);
  86. static void
  87. pcibios_fixup_resources(struct pci_dev *dev)
  88. {
  89. struct pci_controller* hose = (struct pci_controller *)dev->sysdata;
  90. int i;
  91. unsigned long offset;
  92. if (!hose) {
  93. printk(KERN_ERR "No hose for PCI dev %s!\n", pci_name(dev));
  94. return;
  95. }
  96. for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
  97. struct resource *res = dev->resource + i;
  98. if (!res->flags)
  99. continue;
  100. if (res->end == 0xffffffff) {
  101. DBG("PCI:%s Resource %d [%08lx-%08lx] is unassigned\n",
  102. pci_name(dev), i, res->start, res->end);
  103. res->end -= res->start;
  104. res->start = 0;
  105. res->flags |= IORESOURCE_UNSET;
  106. continue;
  107. }
  108. offset = 0;
  109. if (res->flags & IORESOURCE_MEM) {
  110. offset = hose->pci_mem_offset;
  111. } else if (res->flags & IORESOURCE_IO) {
  112. offset = (unsigned long) hose->io_base_virt
  113. - isa_io_base;
  114. }
  115. if (offset != 0) {
  116. res->start += offset;
  117. res->end += offset;
  118. #ifdef DEBUG
  119. printk("Fixup res %d (%lx) of dev %s: %lx -> %lx\n",
  120. i, res->flags, pci_name(dev),
  121. res->start - offset, res->start);
  122. #endif
  123. }
  124. }
  125. /* Call machine specific resource fixup */
  126. if (ppc_md.pcibios_fixup_resources)
  127. ppc_md.pcibios_fixup_resources(dev);
  128. }
  129. DECLARE_PCI_FIXUP_HEADER(PCI_ANY_ID, PCI_ANY_ID, pcibios_fixup_resources);
  130. void pcibios_resource_to_bus(struct pci_dev *dev, struct pci_bus_region *region,
  131. struct resource *res)
  132. {
  133. unsigned long offset = 0;
  134. struct pci_controller *hose = dev->sysdata;
  135. if (hose && res->flags & IORESOURCE_IO)
  136. offset = (unsigned long)hose->io_base_virt - isa_io_base;
  137. else if (hose && res->flags & IORESOURCE_MEM)
  138. offset = hose->pci_mem_offset;
  139. region->start = res->start - offset;
  140. region->end = res->end - offset;
  141. }
  142. EXPORT_SYMBOL(pcibios_resource_to_bus);
  143. void pcibios_bus_to_resource(struct pci_dev *dev, struct resource *res,
  144. struct pci_bus_region *region)
  145. {
  146. unsigned long offset = 0;
  147. struct pci_controller *hose = dev->sysdata;
  148. if (hose && res->flags & IORESOURCE_IO)
  149. offset = (unsigned long)hose->io_base_virt - isa_io_base;
  150. else if (hose && res->flags & IORESOURCE_MEM)
  151. offset = hose->pci_mem_offset;
  152. res->start = region->start + offset;
  153. res->end = region->end + offset;
  154. }
  155. EXPORT_SYMBOL(pcibios_bus_to_resource);
  156. /*
  157. * We need to avoid collisions with `mirrored' VGA ports
  158. * and other strange ISA hardware, so we always want the
  159. * addresses to be allocated in the 0x000-0x0ff region
  160. * modulo 0x400.
  161. *
  162. * Why? Because some silly external IO cards only decode
  163. * the low 10 bits of the IO address. The 0x00-0xff region
  164. * is reserved for motherboard devices that decode all 16
  165. * bits, so it's ok to allocate at, say, 0x2800-0x28ff,
  166. * but we want to try to avoid allocating at 0x2900-0x2bff
  167. * which might have be mirrored at 0x0100-0x03ff..
  168. */
  169. void pcibios_align_resource(void *data, struct resource *res, unsigned long size,
  170. unsigned long align)
  171. {
  172. struct pci_dev *dev = data;
  173. if (res->flags & IORESOURCE_IO) {
  174. unsigned long start = res->start;
  175. if (size > 0x100) {
  176. printk(KERN_ERR "PCI: I/O Region %s/%d too large"
  177. " (%ld bytes)\n", pci_name(dev),
  178. dev->resource - res, size);
  179. }
  180. if (start & 0x300) {
  181. start = (start + 0x3ff) & ~0x3ff;
  182. res->start = start;
  183. }
  184. }
  185. }
  186. EXPORT_SYMBOL(pcibios_align_resource);
  187. /*
  188. * Handle resources of PCI devices. If the world were perfect, we could
  189. * just allocate all the resource regions and do nothing more. It isn't.
  190. * On the other hand, we cannot just re-allocate all devices, as it would
  191. * require us to know lots of host bridge internals. So we attempt to
  192. * keep as much of the original configuration as possible, but tweak it
  193. * when it's found to be wrong.
  194. *
  195. * Known BIOS problems we have to work around:
  196. * - I/O or memory regions not configured
  197. * - regions configured, but not enabled in the command register
  198. * - bogus I/O addresses above 64K used
  199. * - expansion ROMs left enabled (this may sound harmless, but given
  200. * the fact the PCI specs explicitly allow address decoders to be
  201. * shared between expansion ROMs and other resource regions, it's
  202. * at least dangerous)
  203. *
  204. * Our solution:
  205. * (1) Allocate resources for all buses behind PCI-to-PCI bridges.
  206. * This gives us fixed barriers on where we can allocate.
  207. * (2) Allocate resources for all enabled devices. If there is
  208. * a collision, just mark the resource as unallocated. Also
  209. * disable expansion ROMs during this step.
  210. * (3) Try to allocate resources for disabled devices. If the
  211. * resources were assigned correctly, everything goes well,
  212. * if they weren't, they won't disturb allocation of other
  213. * resources.
  214. * (4) Assign new addresses to resources which were either
  215. * not configured at all or misconfigured. If explicitly
  216. * requested by the user, configure expansion ROM address
  217. * as well.
  218. */
  219. static void __init
  220. pcibios_allocate_bus_resources(struct list_head *bus_list)
  221. {
  222. struct pci_bus *bus;
  223. int i;
  224. struct resource *res, *pr;
  225. /* Depth-First Search on bus tree */
  226. list_for_each_entry(bus, bus_list, node) {
  227. for (i = 0; i < 4; ++i) {
  228. if ((res = bus->resource[i]) == NULL || !res->flags
  229. || res->start > res->end)
  230. continue;
  231. if (bus->parent == NULL)
  232. pr = (res->flags & IORESOURCE_IO)?
  233. &ioport_resource: &iomem_resource;
  234. else {
  235. pr = pci_find_parent_resource(bus->self, res);
  236. if (pr == res) {
  237. /* this happens when the generic PCI
  238. * code (wrongly) decides that this
  239. * bridge is transparent -- paulus
  240. */
  241. continue;
  242. }
  243. }
  244. DBG("PCI: bridge rsrc %lx..%lx (%lx), parent %p\n",
  245. res->start, res->end, res->flags, pr);
  246. if (pr) {
  247. if (request_resource(pr, res) == 0)
  248. continue;
  249. /*
  250. * Must be a conflict with an existing entry.
  251. * Move that entry (or entries) under the
  252. * bridge resource and try again.
  253. */
  254. if (reparent_resources(pr, res) == 0)
  255. continue;
  256. }
  257. printk(KERN_ERR "PCI: Cannot allocate resource region "
  258. "%d of PCI bridge %d\n", i, bus->number);
  259. if (pci_relocate_bridge_resource(bus, i))
  260. bus->resource[i] = NULL;
  261. }
  262. pcibios_allocate_bus_resources(&bus->children);
  263. }
  264. }
  265. /*
  266. * Reparent resource children of pr that conflict with res
  267. * under res, and make res replace those children.
  268. */
  269. static int __init
  270. reparent_resources(struct resource *parent, struct resource *res)
  271. {
  272. struct resource *p, **pp;
  273. struct resource **firstpp = NULL;
  274. for (pp = &parent->child; (p = *pp) != NULL; pp = &p->sibling) {
  275. if (p->end < res->start)
  276. continue;
  277. if (res->end < p->start)
  278. break;
  279. if (p->start < res->start || p->end > res->end)
  280. return -1; /* not completely contained */
  281. if (firstpp == NULL)
  282. firstpp = pp;
  283. }
  284. if (firstpp == NULL)
  285. return -1; /* didn't find any conflicting entries? */
  286. res->parent = parent;
  287. res->child = *firstpp;
  288. res->sibling = *pp;
  289. *firstpp = res;
  290. *pp = NULL;
  291. for (p = res->child; p != NULL; p = p->sibling) {
  292. p->parent = res;
  293. DBG(KERN_INFO "PCI: reparented %s [%lx..%lx] under %s\n",
  294. p->name, p->start, p->end, res->name);
  295. }
  296. return 0;
  297. }
  298. /*
  299. * A bridge has been allocated a range which is outside the range
  300. * of its parent bridge, so it needs to be moved.
  301. */
  302. static int __init
  303. pci_relocate_bridge_resource(struct pci_bus *bus, int i)
  304. {
  305. struct resource *res, *pr, *conflict;
  306. unsigned long try, size;
  307. int j;
  308. struct pci_bus *parent = bus->parent;
  309. if (parent == NULL) {
  310. /* shouldn't ever happen */
  311. printk(KERN_ERR "PCI: can't move host bridge resource\n");
  312. return -1;
  313. }
  314. res = bus->resource[i];
  315. if (res == NULL)
  316. return -1;
  317. pr = NULL;
  318. for (j = 0; j < 4; j++) {
  319. struct resource *r = parent->resource[j];
  320. if (!r)
  321. continue;
  322. if ((res->flags ^ r->flags) & (IORESOURCE_IO | IORESOURCE_MEM))
  323. continue;
  324. if (!((res->flags ^ r->flags) & IORESOURCE_PREFETCH)) {
  325. pr = r;
  326. break;
  327. }
  328. if (res->flags & IORESOURCE_PREFETCH)
  329. pr = r;
  330. }
  331. if (pr == NULL)
  332. return -1;
  333. size = res->end - res->start;
  334. if (pr->start > pr->end || size > pr->end - pr->start)
  335. return -1;
  336. try = pr->end;
  337. for (;;) {
  338. res->start = try - size;
  339. res->end = try;
  340. if (probe_resource(bus->parent, pr, res, &conflict) == 0)
  341. break;
  342. if (conflict->start <= pr->start + size)
  343. return -1;
  344. try = conflict->start - 1;
  345. }
  346. if (request_resource(pr, res)) {
  347. DBG(KERN_ERR "PCI: huh? couldn't move to %lx..%lx\n",
  348. res->start, res->end);
  349. return -1; /* "can't happen" */
  350. }
  351. update_bridge_base(bus, i);
  352. printk(KERN_INFO "PCI: bridge %d resource %d moved to %lx..%lx\n",
  353. bus->number, i, res->start, res->end);
  354. return 0;
  355. }
  356. static int __init
  357. probe_resource(struct pci_bus *parent, struct resource *pr,
  358. struct resource *res, struct resource **conflict)
  359. {
  360. struct pci_bus *bus;
  361. struct pci_dev *dev;
  362. struct resource *r;
  363. int i;
  364. for (r = pr->child; r != NULL; r = r->sibling) {
  365. if (r->end >= res->start && res->end >= r->start) {
  366. *conflict = r;
  367. return 1;
  368. }
  369. }
  370. list_for_each_entry(bus, &parent->children, node) {
  371. for (i = 0; i < 4; ++i) {
  372. if ((r = bus->resource[i]) == NULL)
  373. continue;
  374. if (!r->flags || r->start > r->end || r == res)
  375. continue;
  376. if (pci_find_parent_resource(bus->self, r) != pr)
  377. continue;
  378. if (r->end >= res->start && res->end >= r->start) {
  379. *conflict = r;
  380. return 1;
  381. }
  382. }
  383. }
  384. list_for_each_entry(dev, &parent->devices, bus_list) {
  385. for (i = 0; i < 6; ++i) {
  386. r = &dev->resource[i];
  387. if (!r->flags || (r->flags & IORESOURCE_UNSET))
  388. continue;
  389. if (pci_find_parent_resource(dev, r) != pr)
  390. continue;
  391. if (r->end >= res->start && res->end >= r->start) {
  392. *conflict = r;
  393. return 1;
  394. }
  395. }
  396. }
  397. return 0;
  398. }
  399. static void __init
  400. update_bridge_base(struct pci_bus *bus, int i)
  401. {
  402. struct resource *res = bus->resource[i];
  403. u8 io_base_lo, io_limit_lo;
  404. u16 mem_base, mem_limit;
  405. u16 cmd;
  406. unsigned long start, end, off;
  407. struct pci_dev *dev = bus->self;
  408. struct pci_controller *hose = dev->sysdata;
  409. if (!hose) {
  410. printk("update_bridge_base: no hose?\n");
  411. return;
  412. }
  413. pci_read_config_word(dev, PCI_COMMAND, &cmd);
  414. pci_write_config_word(dev, PCI_COMMAND,
  415. cmd & ~(PCI_COMMAND_IO | PCI_COMMAND_MEMORY));
  416. if (res->flags & IORESOURCE_IO) {
  417. off = (unsigned long) hose->io_base_virt - isa_io_base;
  418. start = res->start - off;
  419. end = res->end - off;
  420. io_base_lo = (start >> 8) & PCI_IO_RANGE_MASK;
  421. io_limit_lo = (end >> 8) & PCI_IO_RANGE_MASK;
  422. if (end > 0xffff) {
  423. pci_write_config_word(dev, PCI_IO_BASE_UPPER16,
  424. start >> 16);
  425. pci_write_config_word(dev, PCI_IO_LIMIT_UPPER16,
  426. end >> 16);
  427. io_base_lo |= PCI_IO_RANGE_TYPE_32;
  428. } else
  429. io_base_lo |= PCI_IO_RANGE_TYPE_16;
  430. pci_write_config_byte(dev, PCI_IO_BASE, io_base_lo);
  431. pci_write_config_byte(dev, PCI_IO_LIMIT, io_limit_lo);
  432. } else if ((res->flags & (IORESOURCE_MEM | IORESOURCE_PREFETCH))
  433. == IORESOURCE_MEM) {
  434. off = hose->pci_mem_offset;
  435. mem_base = ((res->start - off) >> 16) & PCI_MEMORY_RANGE_MASK;
  436. mem_limit = ((res->end - off) >> 16) & PCI_MEMORY_RANGE_MASK;
  437. pci_write_config_word(dev, PCI_MEMORY_BASE, mem_base);
  438. pci_write_config_word(dev, PCI_MEMORY_LIMIT, mem_limit);
  439. } else if ((res->flags & (IORESOURCE_MEM | IORESOURCE_PREFETCH))
  440. == (IORESOURCE_MEM | IORESOURCE_PREFETCH)) {
  441. off = hose->pci_mem_offset;
  442. mem_base = ((res->start - off) >> 16) & PCI_PREF_RANGE_MASK;
  443. mem_limit = ((res->end - off) >> 16) & PCI_PREF_RANGE_MASK;
  444. pci_write_config_word(dev, PCI_PREF_MEMORY_BASE, mem_base);
  445. pci_write_config_word(dev, PCI_PREF_MEMORY_LIMIT, mem_limit);
  446. } else {
  447. DBG(KERN_ERR "PCI: ugh, bridge %s res %d has flags=%lx\n",
  448. pci_name(dev), i, res->flags);
  449. }
  450. pci_write_config_word(dev, PCI_COMMAND, cmd);
  451. }
  452. static inline void alloc_resource(struct pci_dev *dev, int idx)
  453. {
  454. struct resource *pr, *r = &dev->resource[idx];
  455. DBG("PCI:%s: Resource %d: %08lx-%08lx (f=%lx)\n",
  456. pci_name(dev), idx, r->start, r->end, r->flags);
  457. pr = pci_find_parent_resource(dev, r);
  458. if (!pr || request_resource(pr, r) < 0) {
  459. printk(KERN_ERR "PCI: Cannot allocate resource region %d"
  460. " of device %s\n", idx, pci_name(dev));
  461. if (pr)
  462. DBG("PCI: parent is %p: %08lx-%08lx (f=%lx)\n",
  463. pr, pr->start, pr->end, pr->flags);
  464. /* We'll assign a new address later */
  465. r->flags |= IORESOURCE_UNSET;
  466. r->end -= r->start;
  467. r->start = 0;
  468. }
  469. }
  470. static void __init
  471. pcibios_allocate_resources(int pass)
  472. {
  473. struct pci_dev *dev = NULL;
  474. int idx, disabled;
  475. u16 command;
  476. struct resource *r;
  477. while ((dev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, dev)) != NULL) {
  478. pci_read_config_word(dev, PCI_COMMAND, &command);
  479. for (idx = 0; idx < 6; idx++) {
  480. r = &dev->resource[idx];
  481. if (r->parent) /* Already allocated */
  482. continue;
  483. if (!r->flags || (r->flags & IORESOURCE_UNSET))
  484. continue; /* Not assigned at all */
  485. if (r->flags & IORESOURCE_IO)
  486. disabled = !(command & PCI_COMMAND_IO);
  487. else
  488. disabled = !(command & PCI_COMMAND_MEMORY);
  489. if (pass == disabled)
  490. alloc_resource(dev, idx);
  491. }
  492. if (pass)
  493. continue;
  494. r = &dev->resource[PCI_ROM_RESOURCE];
  495. if (r->flags & IORESOURCE_ROM_ENABLE) {
  496. /* Turn the ROM off, leave the resource region, but keep it unregistered. */
  497. u32 reg;
  498. DBG("PCI: Switching off ROM of %s\n", pci_name(dev));
  499. r->flags &= ~IORESOURCE_ROM_ENABLE;
  500. pci_read_config_dword(dev, dev->rom_base_reg, &reg);
  501. pci_write_config_dword(dev, dev->rom_base_reg,
  502. reg & ~PCI_ROM_ADDRESS_ENABLE);
  503. }
  504. }
  505. }
  506. static void __init
  507. pcibios_assign_resources(void)
  508. {
  509. struct pci_dev *dev = NULL;
  510. int idx;
  511. struct resource *r;
  512. while ((dev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, dev)) != NULL) {
  513. int class = dev->class >> 8;
  514. /* Don't touch classless devices and host bridges */
  515. if (!class || class == PCI_CLASS_BRIDGE_HOST)
  516. continue;
  517. for (idx = 0; idx < 6; idx++) {
  518. r = &dev->resource[idx];
  519. /*
  520. * We shall assign a new address to this resource,
  521. * either because the BIOS (sic) forgot to do so
  522. * or because we have decided the old address was
  523. * unusable for some reason.
  524. */
  525. if ((r->flags & IORESOURCE_UNSET) && r->end &&
  526. (!ppc_md.pcibios_enable_device_hook ||
  527. !ppc_md.pcibios_enable_device_hook(dev, 1))) {
  528. r->flags &= ~IORESOURCE_UNSET;
  529. pci_assign_resource(dev, idx);
  530. }
  531. }
  532. #if 0 /* don't assign ROMs */
  533. r = &dev->resource[PCI_ROM_RESOURCE];
  534. r->end -= r->start;
  535. r->start = 0;
  536. if (r->end)
  537. pci_assign_resource(dev, PCI_ROM_RESOURCE);
  538. #endif
  539. }
  540. }
  541. int
  542. pcibios_enable_resources(struct pci_dev *dev, int mask)
  543. {
  544. u16 cmd, old_cmd;
  545. int idx;
  546. struct resource *r;
  547. pci_read_config_word(dev, PCI_COMMAND, &cmd);
  548. old_cmd = cmd;
  549. for (idx=0; idx<6; idx++) {
  550. /* Only set up the requested stuff */
  551. if (!(mask & (1<<idx)))
  552. continue;
  553. r = &dev->resource[idx];
  554. if (r->flags & IORESOURCE_UNSET) {
  555. printk(KERN_ERR "PCI: Device %s not available because of resource collisions\n", pci_name(dev));
  556. return -EINVAL;
  557. }
  558. if (r->flags & IORESOURCE_IO)
  559. cmd |= PCI_COMMAND_IO;
  560. if (r->flags & IORESOURCE_MEM)
  561. cmd |= PCI_COMMAND_MEMORY;
  562. }
  563. if (dev->resource[PCI_ROM_RESOURCE].start)
  564. cmd |= PCI_COMMAND_MEMORY;
  565. if (cmd != old_cmd) {
  566. printk("PCI: Enabling device %s (%04x -> %04x)\n", pci_name(dev), old_cmd, cmd);
  567. pci_write_config_word(dev, PCI_COMMAND, cmd);
  568. }
  569. return 0;
  570. }
  571. static int next_controller_index;
  572. struct pci_controller * __init
  573. pcibios_alloc_controller(void)
  574. {
  575. struct pci_controller *hose;
  576. hose = (struct pci_controller *)alloc_bootmem(sizeof(*hose));
  577. memset(hose, 0, sizeof(struct pci_controller));
  578. *hose_tail = hose;
  579. hose_tail = &hose->next;
  580. hose->index = next_controller_index++;
  581. return hose;
  582. }
  583. #ifdef CONFIG_PPC_OF
  584. /*
  585. * Functions below are used on OpenFirmware machines.
  586. */
  587. static void __openfirmware
  588. make_one_node_map(struct device_node* node, u8 pci_bus)
  589. {
  590. int *bus_range;
  591. int len;
  592. if (pci_bus >= pci_bus_count)
  593. return;
  594. bus_range = (int *) get_property(node, "bus-range", &len);
  595. if (bus_range == NULL || len < 2 * sizeof(int)) {
  596. printk(KERN_WARNING "Can't get bus-range for %s, "
  597. "assuming it starts at 0\n", node->full_name);
  598. pci_to_OF_bus_map[pci_bus] = 0;
  599. } else
  600. pci_to_OF_bus_map[pci_bus] = bus_range[0];
  601. for (node=node->child; node != 0;node = node->sibling) {
  602. struct pci_dev* dev;
  603. unsigned int *class_code, *reg;
  604. class_code = (unsigned int *) get_property(node, "class-code", NULL);
  605. if (!class_code || ((*class_code >> 8) != PCI_CLASS_BRIDGE_PCI &&
  606. (*class_code >> 8) != PCI_CLASS_BRIDGE_CARDBUS))
  607. continue;
  608. reg = (unsigned int *)get_property(node, "reg", NULL);
  609. if (!reg)
  610. continue;
  611. dev = pci_find_slot(pci_bus, ((reg[0] >> 8) & 0xff));
  612. if (!dev || !dev->subordinate)
  613. continue;
  614. make_one_node_map(node, dev->subordinate->number);
  615. }
  616. }
  617. void __openfirmware
  618. pcibios_make_OF_bus_map(void)
  619. {
  620. int i;
  621. struct pci_controller* hose;
  622. u8* of_prop_map;
  623. pci_to_OF_bus_map = (u8*)kmalloc(pci_bus_count, GFP_KERNEL);
  624. if (!pci_to_OF_bus_map) {
  625. printk(KERN_ERR "Can't allocate OF bus map !\n");
  626. return;
  627. }
  628. /* We fill the bus map with invalid values, that helps
  629. * debugging.
  630. */
  631. for (i=0; i<pci_bus_count; i++)
  632. pci_to_OF_bus_map[i] = 0xff;
  633. /* For each hose, we begin searching bridges */
  634. for(hose=hose_head; hose; hose=hose->next) {
  635. struct device_node* node;
  636. node = (struct device_node *)hose->arch_data;
  637. if (!node)
  638. continue;
  639. make_one_node_map(node, hose->first_busno);
  640. }
  641. of_prop_map = get_property(find_path_device("/"), "pci-OF-bus-map", NULL);
  642. if (of_prop_map)
  643. memcpy(of_prop_map, pci_to_OF_bus_map, pci_bus_count);
  644. #ifdef DEBUG
  645. printk("PCI->OF bus map:\n");
  646. for (i=0; i<pci_bus_count; i++) {
  647. if (pci_to_OF_bus_map[i] == 0xff)
  648. continue;
  649. printk("%d -> %d\n", i, pci_to_OF_bus_map[i]);
  650. }
  651. #endif
  652. }
  653. typedef int (*pci_OF_scan_iterator)(struct device_node* node, void* data);
  654. static struct device_node* __openfirmware
  655. scan_OF_pci_childs(struct device_node* node, pci_OF_scan_iterator filter, void* data)
  656. {
  657. struct device_node* sub_node;
  658. for (; node != 0;node = node->sibling) {
  659. unsigned int *class_code;
  660. if (filter(node, data))
  661. return node;
  662. /* For PCI<->PCI bridges or CardBus bridges, we go down
  663. * Note: some OFs create a parent node "multifunc-device" as
  664. * a fake root for all functions of a multi-function device,
  665. * we go down them as well.
  666. */
  667. class_code = (unsigned int *) get_property(node, "class-code", NULL);
  668. if ((!class_code || ((*class_code >> 8) != PCI_CLASS_BRIDGE_PCI &&
  669. (*class_code >> 8) != PCI_CLASS_BRIDGE_CARDBUS)) &&
  670. strcmp(node->name, "multifunc-device"))
  671. continue;
  672. sub_node = scan_OF_pci_childs(node->child, filter, data);
  673. if (sub_node)
  674. return sub_node;
  675. }
  676. return NULL;
  677. }
  678. static int
  679. scan_OF_pci_childs_iterator(struct device_node* node, void* data)
  680. {
  681. unsigned int *reg;
  682. u8* fdata = (u8*)data;
  683. reg = (unsigned int *) get_property(node, "reg", NULL);
  684. if (reg && ((reg[0] >> 8) & 0xff) == fdata[1]
  685. && ((reg[0] >> 16) & 0xff) == fdata[0])
  686. return 1;
  687. return 0;
  688. }
  689. static struct device_node* __openfirmware
  690. scan_OF_childs_for_device(struct device_node* node, u8 bus, u8 dev_fn)
  691. {
  692. u8 filter_data[2] = {bus, dev_fn};
  693. return scan_OF_pci_childs(node, scan_OF_pci_childs_iterator, filter_data);
  694. }
  695. /*
  696. * Scans the OF tree for a device node matching a PCI device
  697. */
  698. struct device_node *
  699. pci_busdev_to_OF_node(struct pci_bus *bus, int devfn)
  700. {
  701. struct pci_controller *hose;
  702. struct device_node *node;
  703. int busnr;
  704. if (!have_of)
  705. return NULL;
  706. /* Lookup the hose */
  707. busnr = bus->number;
  708. hose = pci_bus_to_hose(busnr);
  709. if (!hose)
  710. return NULL;
  711. /* Check it has an OF node associated */
  712. node = (struct device_node *) hose->arch_data;
  713. if (!node)
  714. return NULL;
  715. /* Fixup bus number according to what OF think it is. */
  716. #ifdef CONFIG_PPC_PMAC
  717. /* The G5 need a special case here. Basically, we don't remap all
  718. * busses on it so we don't create the pci-OF-map. However, we do
  719. * remap the AGP bus and so have to deal with it. A future better
  720. * fix has to be done by making the remapping per-host and always
  721. * filling the pci_to_OF map. --BenH
  722. */
  723. if (_machine == _MACH_Pmac && busnr >= 0xf0)
  724. busnr -= 0xf0;
  725. else
  726. #endif
  727. if (pci_to_OF_bus_map)
  728. busnr = pci_to_OF_bus_map[busnr];
  729. if (busnr == 0xff)
  730. return NULL;
  731. /* Now, lookup childs of the hose */
  732. return scan_OF_childs_for_device(node->child, busnr, devfn);
  733. }
  734. struct device_node*
  735. pci_device_to_OF_node(struct pci_dev *dev)
  736. {
  737. return pci_busdev_to_OF_node(dev->bus, dev->devfn);
  738. }
  739. /* This routine is meant to be used early during boot, when the
  740. * PCI bus numbers have not yet been assigned, and you need to
  741. * issue PCI config cycles to an OF device.
  742. * It could also be used to "fix" RTAS config cycles if you want
  743. * to set pci_assign_all_busses to 1 and still use RTAS for PCI
  744. * config cycles.
  745. */
  746. struct pci_controller*
  747. pci_find_hose_for_OF_device(struct device_node* node)
  748. {
  749. if (!have_of)
  750. return NULL;
  751. while(node) {
  752. struct pci_controller* hose;
  753. for (hose=hose_head;hose;hose=hose->next)
  754. if (hose->arch_data == node)
  755. return hose;
  756. node=node->parent;
  757. }
  758. return NULL;
  759. }
  760. static int __openfirmware
  761. find_OF_pci_device_filter(struct device_node* node, void* data)
  762. {
  763. return ((void *)node == data);
  764. }
  765. /*
  766. * Returns the PCI device matching a given OF node
  767. */
  768. int
  769. pci_device_from_OF_node(struct device_node* node, u8* bus, u8* devfn)
  770. {
  771. unsigned int *reg;
  772. struct pci_controller* hose;
  773. struct pci_dev* dev = NULL;
  774. if (!have_of)
  775. return -ENODEV;
  776. /* Make sure it's really a PCI device */
  777. hose = pci_find_hose_for_OF_device(node);
  778. if (!hose || !hose->arch_data)
  779. return -ENODEV;
  780. if (!scan_OF_pci_childs(((struct device_node*)hose->arch_data)->child,
  781. find_OF_pci_device_filter, (void *)node))
  782. return -ENODEV;
  783. reg = (unsigned int *) get_property(node, "reg", NULL);
  784. if (!reg)
  785. return -ENODEV;
  786. *bus = (reg[0] >> 16) & 0xff;
  787. *devfn = ((reg[0] >> 8) & 0xff);
  788. /* Ok, here we need some tweak. If we have already renumbered
  789. * all busses, we can't rely on the OF bus number any more.
  790. * the pci_to_OF_bus_map is not enough as several PCI busses
  791. * may match the same OF bus number.
  792. */
  793. if (!pci_to_OF_bus_map)
  794. return 0;
  795. while ((dev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, dev)) != NULL) {
  796. if (pci_to_OF_bus_map[dev->bus->number] != *bus)
  797. continue;
  798. if (dev->devfn != *devfn)
  799. continue;
  800. *bus = dev->bus->number;
  801. return 0;
  802. }
  803. return -ENODEV;
  804. }
  805. void __init
  806. pci_process_bridge_OF_ranges(struct pci_controller *hose,
  807. struct device_node *dev, int primary)
  808. {
  809. static unsigned int static_lc_ranges[256] __initdata;
  810. unsigned int *dt_ranges, *lc_ranges, *ranges, *prev;
  811. unsigned int size;
  812. int rlen = 0, orig_rlen;
  813. int memno = 0;
  814. struct resource *res;
  815. int np, na = prom_n_addr_cells(dev);
  816. np = na + 5;
  817. /* First we try to merge ranges to fix a problem with some pmacs
  818. * that can have more than 3 ranges, fortunately using contiguous
  819. * addresses -- BenH
  820. */
  821. dt_ranges = (unsigned int *) get_property(dev, "ranges", &rlen);
  822. if (!dt_ranges)
  823. return;
  824. /* Sanity check, though hopefully that never happens */
  825. if (rlen > sizeof(static_lc_ranges)) {
  826. printk(KERN_WARNING "OF ranges property too large !\n");
  827. rlen = sizeof(static_lc_ranges);
  828. }
  829. lc_ranges = static_lc_ranges;
  830. memcpy(lc_ranges, dt_ranges, rlen);
  831. orig_rlen = rlen;
  832. /* Let's work on a copy of the "ranges" property instead of damaging
  833. * the device-tree image in memory
  834. */
  835. ranges = lc_ranges;
  836. prev = NULL;
  837. while ((rlen -= np * sizeof(unsigned int)) >= 0) {
  838. if (prev) {
  839. if (prev[0] == ranges[0] && prev[1] == ranges[1] &&
  840. (prev[2] + prev[na+4]) == ranges[2] &&
  841. (prev[na+2] + prev[na+4]) == ranges[na+2]) {
  842. prev[na+4] += ranges[na+4];
  843. ranges[0] = 0;
  844. ranges += np;
  845. continue;
  846. }
  847. }
  848. prev = ranges;
  849. ranges += np;
  850. }
  851. /*
  852. * The ranges property is laid out as an array of elements,
  853. * each of which comprises:
  854. * cells 0 - 2: a PCI address
  855. * cells 3 or 3+4: a CPU physical address
  856. * (size depending on dev->n_addr_cells)
  857. * cells 4+5 or 5+6: the size of the range
  858. */
  859. ranges = lc_ranges;
  860. rlen = orig_rlen;
  861. while (ranges && (rlen -= np * sizeof(unsigned int)) >= 0) {
  862. res = NULL;
  863. size = ranges[na+4];
  864. switch (ranges[0] >> 24) {
  865. case 1: /* I/O space */
  866. if (ranges[2] != 0)
  867. break;
  868. hose->io_base_phys = ranges[na+2];
  869. /* limit I/O space to 16MB */
  870. if (size > 0x01000000)
  871. size = 0x01000000;
  872. hose->io_base_virt = ioremap(ranges[na+2], size);
  873. if (primary)
  874. isa_io_base = (unsigned long) hose->io_base_virt;
  875. res = &hose->io_resource;
  876. res->flags = IORESOURCE_IO;
  877. res->start = ranges[2];
  878. break;
  879. case 2: /* memory space */
  880. memno = 0;
  881. if (ranges[1] == 0 && ranges[2] == 0
  882. && ranges[na+4] <= (16 << 20)) {
  883. /* 1st 16MB, i.e. ISA memory area */
  884. if (primary)
  885. isa_mem_base = ranges[na+2];
  886. memno = 1;
  887. }
  888. while (memno < 3 && hose->mem_resources[memno].flags)
  889. ++memno;
  890. if (memno == 0)
  891. hose->pci_mem_offset = ranges[na+2] - ranges[2];
  892. if (memno < 3) {
  893. res = &hose->mem_resources[memno];
  894. res->flags = IORESOURCE_MEM;
  895. res->start = ranges[na+2];
  896. }
  897. break;
  898. }
  899. if (res != NULL) {
  900. res->name = dev->full_name;
  901. res->end = res->start + size - 1;
  902. res->parent = NULL;
  903. res->sibling = NULL;
  904. res->child = NULL;
  905. }
  906. ranges += np;
  907. }
  908. }
  909. /* We create the "pci-OF-bus-map" property now so it appears in the
  910. * /proc device tree
  911. */
  912. void __init
  913. pci_create_OF_bus_map(void)
  914. {
  915. struct property* of_prop;
  916. of_prop = (struct property*) alloc_bootmem(sizeof(struct property) + 256);
  917. if (of_prop && find_path_device("/")) {
  918. memset(of_prop, -1, sizeof(struct property) + 256);
  919. of_prop->name = "pci-OF-bus-map";
  920. of_prop->length = 256;
  921. of_prop->value = (unsigned char *)&of_prop[1];
  922. prom_add_property(find_path_device("/"), of_prop);
  923. }
  924. }
  925. static ssize_t pci_show_devspec(struct device *dev, struct device_attribute *attr, char *buf)
  926. {
  927. struct pci_dev *pdev;
  928. struct device_node *np;
  929. pdev = to_pci_dev (dev);
  930. np = pci_device_to_OF_node(pdev);
  931. if (np == NULL || np->full_name == NULL)
  932. return 0;
  933. return sprintf(buf, "%s", np->full_name);
  934. }
  935. static DEVICE_ATTR(devspec, S_IRUGO, pci_show_devspec, NULL);
  936. #endif /* CONFIG_PPC_OF */
  937. /* Add sysfs properties */
  938. void pcibios_add_platform_entries(struct pci_dev *pdev)
  939. {
  940. #ifdef CONFIG_PPC_OF
  941. device_create_file(&pdev->dev, &dev_attr_devspec);
  942. #endif /* CONFIG_PPC_OF */
  943. }
  944. #ifdef CONFIG_PPC_PMAC
  945. /*
  946. * This set of routines checks for PCI<->PCI bridges that have closed
  947. * IO resources and have child devices. It tries to re-open an IO
  948. * window on them.
  949. *
  950. * This is a _temporary_ fix to workaround a problem with Apple's OF
  951. * closing IO windows on P2P bridges when the OF drivers of cards
  952. * below this bridge don't claim any IO range (typically ATI or
  953. * Adaptec).
  954. *
  955. * A more complete fix would be to use drivers/pci/setup-bus.c, which
  956. * involves a working pcibios_fixup_pbus_ranges(), some more care about
  957. * ordering when creating the host bus resources, and maybe a few more
  958. * minor tweaks
  959. */
  960. /* Initialize bridges with base/limit values we have collected */
  961. static void __init
  962. do_update_p2p_io_resource(struct pci_bus *bus, int enable_vga)
  963. {
  964. struct pci_dev *bridge = bus->self;
  965. struct pci_controller* hose = (struct pci_controller *)bridge->sysdata;
  966. u32 l;
  967. u16 w;
  968. struct resource res;
  969. if (bus->resource[0] == NULL)
  970. return;
  971. res = *(bus->resource[0]);
  972. DBG("Remapping Bus %d, bridge: %s\n", bus->number, pci_name(bridge));
  973. res.start -= ((unsigned long) hose->io_base_virt - isa_io_base);
  974. res.end -= ((unsigned long) hose->io_base_virt - isa_io_base);
  975. DBG(" IO window: %08lx-%08lx\n", res.start, res.end);
  976. /* Set up the top and bottom of the PCI I/O segment for this bus. */
  977. pci_read_config_dword(bridge, PCI_IO_BASE, &l);
  978. l &= 0xffff000f;
  979. l |= (res.start >> 8) & 0x00f0;
  980. l |= res.end & 0xf000;
  981. pci_write_config_dword(bridge, PCI_IO_BASE, l);
  982. if ((l & PCI_IO_RANGE_TYPE_MASK) == PCI_IO_RANGE_TYPE_32) {
  983. l = (res.start >> 16) | (res.end & 0xffff0000);
  984. pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, l);
  985. }
  986. pci_read_config_word(bridge, PCI_COMMAND, &w);
  987. w |= PCI_COMMAND_IO;
  988. pci_write_config_word(bridge, PCI_COMMAND, w);
  989. #if 0 /* Enabling this causes XFree 4.2.0 to hang during PCI probe */
  990. if (enable_vga) {
  991. pci_read_config_word(bridge, PCI_BRIDGE_CONTROL, &w);
  992. w |= PCI_BRIDGE_CTL_VGA;
  993. pci_write_config_word(bridge, PCI_BRIDGE_CONTROL, w);
  994. }
  995. #endif
  996. }
  997. /* This function is pretty basic and actually quite broken for the
  998. * general case, it's enough for us right now though. It's supposed
  999. * to tell us if we need to open an IO range at all or not and what
  1000. * size.
  1001. */
  1002. static int __init
  1003. check_for_io_childs(struct pci_bus *bus, struct resource* res, int *found_vga)
  1004. {
  1005. struct pci_dev *dev;
  1006. int i;
  1007. int rc = 0;
  1008. #define push_end(res, size) do { unsigned long __sz = (size) ; \
  1009. res->end = ((res->end + __sz) / (__sz + 1)) * (__sz + 1) + __sz; \
  1010. } while (0)
  1011. list_for_each_entry(dev, &bus->devices, bus_list) {
  1012. u16 class = dev->class >> 8;
  1013. if (class == PCI_CLASS_DISPLAY_VGA ||
  1014. class == PCI_CLASS_NOT_DEFINED_VGA)
  1015. *found_vga = 1;
  1016. if (class >> 8 == PCI_BASE_CLASS_BRIDGE && dev->subordinate)
  1017. rc |= check_for_io_childs(dev->subordinate, res, found_vga);
  1018. if (class == PCI_CLASS_BRIDGE_CARDBUS)
  1019. push_end(res, 0xfff);
  1020. for (i=0; i<PCI_NUM_RESOURCES; i++) {
  1021. struct resource *r;
  1022. unsigned long r_size;
  1023. if (dev->class >> 8 == PCI_CLASS_BRIDGE_PCI
  1024. && i >= PCI_BRIDGE_RESOURCES)
  1025. continue;
  1026. r = &dev->resource[i];
  1027. r_size = r->end - r->start;
  1028. if (r_size < 0xfff)
  1029. r_size = 0xfff;
  1030. if (r->flags & IORESOURCE_IO && (r_size) != 0) {
  1031. rc = 1;
  1032. push_end(res, r_size);
  1033. }
  1034. }
  1035. }
  1036. return rc;
  1037. }
  1038. /* Here we scan all P2P bridges of a given level that have a closed
  1039. * IO window. Note that the test for the presence of a VGA card should
  1040. * be improved to take into account already configured P2P bridges,
  1041. * currently, we don't see them and might end up configuring 2 bridges
  1042. * with VGA pass through enabled
  1043. */
  1044. static void __init
  1045. do_fixup_p2p_level(struct pci_bus *bus)
  1046. {
  1047. struct pci_bus *b;
  1048. int i, parent_io;
  1049. int has_vga = 0;
  1050. for (parent_io=0; parent_io<4; parent_io++)
  1051. if (bus->resource[parent_io]
  1052. && bus->resource[parent_io]->flags & IORESOURCE_IO)
  1053. break;
  1054. if (parent_io >= 4)
  1055. return;
  1056. list_for_each_entry(b, &bus->children, node) {
  1057. struct pci_dev *d = b->self;
  1058. struct pci_controller* hose = (struct pci_controller *)d->sysdata;
  1059. struct resource *res = b->resource[0];
  1060. struct resource tmp_res;
  1061. unsigned long max;
  1062. int found_vga = 0;
  1063. memset(&tmp_res, 0, sizeof(tmp_res));
  1064. tmp_res.start = bus->resource[parent_io]->start;
  1065. /* We don't let low addresses go through that closed P2P bridge, well,
  1066. * that may not be necessary but I feel safer that way
  1067. */
  1068. if (tmp_res.start == 0)
  1069. tmp_res.start = 0x1000;
  1070. if (!list_empty(&b->devices) && res && res->flags == 0 &&
  1071. res != bus->resource[parent_io] &&
  1072. (d->class >> 8) == PCI_CLASS_BRIDGE_PCI &&
  1073. check_for_io_childs(b, &tmp_res, &found_vga)) {
  1074. u8 io_base_lo;
  1075. printk(KERN_INFO "Fixing up IO bus %s\n", b->name);
  1076. if (found_vga) {
  1077. if (has_vga) {
  1078. printk(KERN_WARNING "Skipping VGA, already active"
  1079. " on bus segment\n");
  1080. found_vga = 0;
  1081. } else
  1082. has_vga = 1;
  1083. }
  1084. pci_read_config_byte(d, PCI_IO_BASE, &io_base_lo);
  1085. if ((io_base_lo & PCI_IO_RANGE_TYPE_MASK) == PCI_IO_RANGE_TYPE_32)
  1086. max = ((unsigned long) hose->io_base_virt
  1087. - isa_io_base) + 0xffffffff;
  1088. else
  1089. max = ((unsigned long) hose->io_base_virt
  1090. - isa_io_base) + 0xffff;
  1091. *res = tmp_res;
  1092. res->flags = IORESOURCE_IO;
  1093. res->name = b->name;
  1094. /* Find a resource in the parent where we can allocate */
  1095. for (i = 0 ; i < 4; i++) {
  1096. struct resource *r = bus->resource[i];
  1097. if (!r)
  1098. continue;
  1099. if ((r->flags & IORESOURCE_IO) == 0)
  1100. continue;
  1101. DBG("Trying to allocate from %08lx, size %08lx from parent"
  1102. " res %d: %08lx -> %08lx\n",
  1103. res->start, res->end, i, r->start, r->end);
  1104. if (allocate_resource(r, res, res->end + 1, res->start, max,
  1105. res->end + 1, NULL, NULL) < 0) {
  1106. DBG("Failed !\n");
  1107. continue;
  1108. }
  1109. do_update_p2p_io_resource(b, found_vga);
  1110. break;
  1111. }
  1112. }
  1113. do_fixup_p2p_level(b);
  1114. }
  1115. }
  1116. static void
  1117. pcibios_fixup_p2p_bridges(void)
  1118. {
  1119. struct pci_bus *b;
  1120. list_for_each_entry(b, &pci_root_buses, node)
  1121. do_fixup_p2p_level(b);
  1122. }
  1123. #endif /* CONFIG_PPC_PMAC */
  1124. static int __init
  1125. pcibios_init(void)
  1126. {
  1127. struct pci_controller *hose;
  1128. struct pci_bus *bus;
  1129. int next_busno;
  1130. printk(KERN_INFO "PCI: Probing PCI hardware\n");
  1131. /* Scan all of the recorded PCI controllers. */
  1132. for (next_busno = 0, hose = hose_head; hose; hose = hose->next) {
  1133. if (pci_assign_all_busses)
  1134. hose->first_busno = next_busno;
  1135. hose->last_busno = 0xff;
  1136. bus = pci_scan_bus(hose->first_busno, hose->ops, hose);
  1137. hose->last_busno = bus->subordinate;
  1138. if (pci_assign_all_busses || next_busno <= hose->last_busno)
  1139. next_busno = hose->last_busno + pcibios_assign_bus_offset;
  1140. }
  1141. pci_bus_count = next_busno;
  1142. /* OpenFirmware based machines need a map of OF bus
  1143. * numbers vs. kernel bus numbers since we may have to
  1144. * remap them.
  1145. */
  1146. if (pci_assign_all_busses && have_of)
  1147. pcibios_make_OF_bus_map();
  1148. /* Do machine dependent PCI interrupt routing */
  1149. if (ppc_md.pci_swizzle && ppc_md.pci_map_irq)
  1150. pci_fixup_irqs(ppc_md.pci_swizzle, ppc_md.pci_map_irq);
  1151. /* Call machine dependent fixup */
  1152. if (ppc_md.pcibios_fixup)
  1153. ppc_md.pcibios_fixup();
  1154. /* Allocate and assign resources */
  1155. pcibios_allocate_bus_resources(&pci_root_buses);
  1156. pcibios_allocate_resources(0);
  1157. pcibios_allocate_resources(1);
  1158. #ifdef CONFIG_PPC_PMAC
  1159. pcibios_fixup_p2p_bridges();
  1160. #endif /* CONFIG_PPC_PMAC */
  1161. pcibios_assign_resources();
  1162. /* Call machine dependent post-init code */
  1163. if (ppc_md.pcibios_after_init)
  1164. ppc_md.pcibios_after_init();
  1165. return 0;
  1166. }
  1167. subsys_initcall(pcibios_init);
  1168. unsigned char __init
  1169. common_swizzle(struct pci_dev *dev, unsigned char *pinp)
  1170. {
  1171. struct pci_controller *hose = dev->sysdata;
  1172. if (dev->bus->number != hose->first_busno) {
  1173. u8 pin = *pinp;
  1174. do {
  1175. pin = bridge_swizzle(pin, PCI_SLOT(dev->devfn));
  1176. /* Move up the chain of bridges. */
  1177. dev = dev->bus->self;
  1178. } while (dev->bus->self);
  1179. *pinp = pin;
  1180. /* The slot is the idsel of the last bridge. */
  1181. }
  1182. return PCI_SLOT(dev->devfn);
  1183. }
  1184. unsigned long resource_fixup(struct pci_dev * dev, struct resource * res,
  1185. unsigned long start, unsigned long size)
  1186. {
  1187. return start;
  1188. }
  1189. void __init pcibios_fixup_bus(struct pci_bus *bus)
  1190. {
  1191. struct pci_controller *hose = (struct pci_controller *) bus->sysdata;
  1192. unsigned long io_offset;
  1193. struct resource *res;
  1194. int i;
  1195. io_offset = (unsigned long)hose->io_base_virt - isa_io_base;
  1196. if (bus->parent == NULL) {
  1197. /* This is a host bridge - fill in its resources */
  1198. hose->bus = bus;
  1199. bus->resource[0] = res = &hose->io_resource;
  1200. if (!res->flags) {
  1201. if (io_offset)
  1202. printk(KERN_ERR "I/O resource not set for host"
  1203. " bridge %d\n", hose->index);
  1204. res->start = 0;
  1205. res->end = IO_SPACE_LIMIT;
  1206. res->flags = IORESOURCE_IO;
  1207. }
  1208. res->start += io_offset;
  1209. res->end += io_offset;
  1210. for (i = 0; i < 3; ++i) {
  1211. res = &hose->mem_resources[i];
  1212. if (!res->flags) {
  1213. if (i > 0)
  1214. continue;
  1215. printk(KERN_ERR "Memory resource not set for "
  1216. "host bridge %d\n", hose->index);
  1217. res->start = hose->pci_mem_offset;
  1218. res->end = ~0U;
  1219. res->flags = IORESOURCE_MEM;
  1220. }
  1221. bus->resource[i+1] = res;
  1222. }
  1223. } else {
  1224. /* This is a subordinate bridge */
  1225. pci_read_bridge_bases(bus);
  1226. for (i = 0; i < 4; ++i) {
  1227. if ((res = bus->resource[i]) == NULL)
  1228. continue;
  1229. if (!res->flags)
  1230. continue;
  1231. if (io_offset && (res->flags & IORESOURCE_IO)) {
  1232. res->start += io_offset;
  1233. res->end += io_offset;
  1234. } else if (hose->pci_mem_offset
  1235. && (res->flags & IORESOURCE_MEM)) {
  1236. res->start += hose->pci_mem_offset;
  1237. res->end += hose->pci_mem_offset;
  1238. }
  1239. }
  1240. }
  1241. if (ppc_md.pcibios_fixup_bus)
  1242. ppc_md.pcibios_fixup_bus(bus);
  1243. }
  1244. char __init *pcibios_setup(char *str)
  1245. {
  1246. return str;
  1247. }
  1248. /* the next one is stolen from the alpha port... */
  1249. void __init
  1250. pcibios_update_irq(struct pci_dev *dev, int irq)
  1251. {
  1252. pci_write_config_byte(dev, PCI_INTERRUPT_LINE, irq);
  1253. /* XXX FIXME - update OF device tree node interrupt property */
  1254. }
  1255. int pcibios_enable_device(struct pci_dev *dev, int mask)
  1256. {
  1257. u16 cmd, old_cmd;
  1258. int idx;
  1259. struct resource *r;
  1260. if (ppc_md.pcibios_enable_device_hook)
  1261. if (ppc_md.pcibios_enable_device_hook(dev, 0))
  1262. return -EINVAL;
  1263. pci_read_config_word(dev, PCI_COMMAND, &cmd);
  1264. old_cmd = cmd;
  1265. for (idx=0; idx<6; idx++) {
  1266. r = &dev->resource[idx];
  1267. if (r->flags & IORESOURCE_UNSET) {
  1268. printk(KERN_ERR "PCI: Device %s not available because of resource collisions\n", pci_name(dev));
  1269. return -EINVAL;
  1270. }
  1271. if (r->flags & IORESOURCE_IO)
  1272. cmd |= PCI_COMMAND_IO;
  1273. if (r->flags & IORESOURCE_MEM)
  1274. cmd |= PCI_COMMAND_MEMORY;
  1275. }
  1276. if (cmd != old_cmd) {
  1277. printk("PCI: Enabling device %s (%04x -> %04x)\n",
  1278. pci_name(dev), old_cmd, cmd);
  1279. pci_write_config_word(dev, PCI_COMMAND, cmd);
  1280. }
  1281. return 0;
  1282. }
  1283. struct pci_controller*
  1284. pci_bus_to_hose(int bus)
  1285. {
  1286. struct pci_controller* hose = hose_head;
  1287. for (; hose; hose = hose->next)
  1288. if (bus >= hose->first_busno && bus <= hose->last_busno)
  1289. return hose;
  1290. return NULL;
  1291. }
  1292. void __iomem *
  1293. pci_bus_io_base(unsigned int bus)
  1294. {
  1295. struct pci_controller *hose;
  1296. hose = pci_bus_to_hose(bus);
  1297. if (!hose)
  1298. return NULL;
  1299. return hose->io_base_virt;
  1300. }
  1301. unsigned long
  1302. pci_bus_io_base_phys(unsigned int bus)
  1303. {
  1304. struct pci_controller *hose;
  1305. hose = pci_bus_to_hose(bus);
  1306. if (!hose)
  1307. return 0;
  1308. return hose->io_base_phys;
  1309. }
  1310. unsigned long
  1311. pci_bus_mem_base_phys(unsigned int bus)
  1312. {
  1313. struct pci_controller *hose;
  1314. hose = pci_bus_to_hose(bus);
  1315. if (!hose)
  1316. return 0;
  1317. return hose->pci_mem_offset;
  1318. }
  1319. unsigned long
  1320. pci_resource_to_bus(struct pci_dev *pdev, struct resource *res)
  1321. {
  1322. /* Hack alert again ! See comments in chrp_pci.c
  1323. */
  1324. struct pci_controller* hose =
  1325. (struct pci_controller *)pdev->sysdata;
  1326. if (hose && res->flags & IORESOURCE_MEM)
  1327. return res->start - hose->pci_mem_offset;
  1328. /* We may want to do something with IOs here... */
  1329. return res->start;
  1330. }
  1331. static struct resource *__pci_mmap_make_offset(struct pci_dev *dev,
  1332. unsigned long *offset,
  1333. enum pci_mmap_state mmap_state)
  1334. {
  1335. struct pci_controller *hose = pci_bus_to_hose(dev->bus->number);
  1336. unsigned long io_offset = 0;
  1337. int i, res_bit;
  1338. if (hose == 0)
  1339. return NULL; /* should never happen */
  1340. /* If memory, add on the PCI bridge address offset */
  1341. if (mmap_state == pci_mmap_mem) {
  1342. *offset += hose->pci_mem_offset;
  1343. res_bit = IORESOURCE_MEM;
  1344. } else {
  1345. io_offset = hose->io_base_virt - ___IO_BASE;
  1346. *offset += io_offset;
  1347. res_bit = IORESOURCE_IO;
  1348. }
  1349. /*
  1350. * Check that the offset requested corresponds to one of the
  1351. * resources of the device.
  1352. */
  1353. for (i = 0; i <= PCI_ROM_RESOURCE; i++) {
  1354. struct resource *rp = &dev->resource[i];
  1355. int flags = rp->flags;
  1356. /* treat ROM as memory (should be already) */
  1357. if (i == PCI_ROM_RESOURCE)
  1358. flags |= IORESOURCE_MEM;
  1359. /* Active and same type? */
  1360. if ((flags & res_bit) == 0)
  1361. continue;
  1362. /* In the range of this resource? */
  1363. if (*offset < (rp->start & PAGE_MASK) || *offset > rp->end)
  1364. continue;
  1365. /* found it! construct the final physical address */
  1366. if (mmap_state == pci_mmap_io)
  1367. *offset += hose->io_base_phys - io_offset;
  1368. return rp;
  1369. }
  1370. return NULL;
  1371. }
  1372. /*
  1373. * Set vm_page_prot of VMA, as appropriate for this architecture, for a pci
  1374. * device mapping.
  1375. */
  1376. static pgprot_t __pci_mmap_set_pgprot(struct pci_dev *dev, struct resource *rp,
  1377. pgprot_t protection,
  1378. enum pci_mmap_state mmap_state,
  1379. int write_combine)
  1380. {
  1381. unsigned long prot = pgprot_val(protection);
  1382. /* Write combine is always 0 on non-memory space mappings. On
  1383. * memory space, if the user didn't pass 1, we check for a
  1384. * "prefetchable" resource. This is a bit hackish, but we use
  1385. * this to workaround the inability of /sysfs to provide a write
  1386. * combine bit
  1387. */
  1388. if (mmap_state != pci_mmap_mem)
  1389. write_combine = 0;
  1390. else if (write_combine == 0) {
  1391. if (rp->flags & IORESOURCE_PREFETCH)
  1392. write_combine = 1;
  1393. }
  1394. /* XXX would be nice to have a way to ask for write-through */
  1395. prot |= _PAGE_NO_CACHE;
  1396. if (write_combine)
  1397. prot &= ~_PAGE_GUARDED;
  1398. else
  1399. prot |= _PAGE_GUARDED;
  1400. printk("PCI map for %s:%lx, prot: %lx\n", pci_name(dev), rp->start,
  1401. prot);
  1402. return __pgprot(prot);
  1403. }
  1404. /*
  1405. * This one is used by /dev/mem and fbdev who have no clue about the
  1406. * PCI device, it tries to find the PCI device first and calls the
  1407. * above routine
  1408. */
  1409. pgprot_t pci_phys_mem_access_prot(struct file *file,
  1410. unsigned long offset,
  1411. unsigned long size,
  1412. pgprot_t protection)
  1413. {
  1414. struct pci_dev *pdev = NULL;
  1415. struct resource *found = NULL;
  1416. unsigned long prot = pgprot_val(protection);
  1417. int i;
  1418. if (page_is_ram(offset >> PAGE_SHIFT))
  1419. return prot;
  1420. prot |= _PAGE_NO_CACHE | _PAGE_GUARDED;
  1421. for_each_pci_dev(pdev) {
  1422. for (i = 0; i <= PCI_ROM_RESOURCE; i++) {
  1423. struct resource *rp = &pdev->resource[i];
  1424. int flags = rp->flags;
  1425. /* Active and same type? */
  1426. if ((flags & IORESOURCE_MEM) == 0)
  1427. continue;
  1428. /* In the range of this resource? */
  1429. if (offset < (rp->start & PAGE_MASK) ||
  1430. offset > rp->end)
  1431. continue;
  1432. found = rp;
  1433. break;
  1434. }
  1435. if (found)
  1436. break;
  1437. }
  1438. if (found) {
  1439. if (found->flags & IORESOURCE_PREFETCH)
  1440. prot &= ~_PAGE_GUARDED;
  1441. pci_dev_put(pdev);
  1442. }
  1443. DBG("non-PCI map for %lx, prot: %lx\n", offset, prot);
  1444. return __pgprot(prot);
  1445. }
  1446. /*
  1447. * Perform the actual remap of the pages for a PCI device mapping, as
  1448. * appropriate for this architecture. The region in the process to map
  1449. * is described by vm_start and vm_end members of VMA, the base physical
  1450. * address is found in vm_pgoff.
  1451. * The pci device structure is provided so that architectures may make mapping
  1452. * decisions on a per-device or per-bus basis.
  1453. *
  1454. * Returns a negative error code on failure, zero on success.
  1455. */
  1456. int pci_mmap_page_range(struct pci_dev *dev, struct vm_area_struct *vma,
  1457. enum pci_mmap_state mmap_state,
  1458. int write_combine)
  1459. {
  1460. unsigned long offset = vma->vm_pgoff << PAGE_SHIFT;
  1461. struct resource *rp;
  1462. int ret;
  1463. rp = __pci_mmap_make_offset(dev, &offset, mmap_state);
  1464. if (rp == NULL)
  1465. return -EINVAL;
  1466. vma->vm_pgoff = offset >> PAGE_SHIFT;
  1467. vma->vm_flags |= VM_SHM | VM_LOCKED | VM_IO;
  1468. vma->vm_page_prot = __pci_mmap_set_pgprot(dev, rp,
  1469. vma->vm_page_prot,
  1470. mmap_state, write_combine);
  1471. ret = remap_pfn_range(vma, vma->vm_start, vma->vm_pgoff,
  1472. vma->vm_end - vma->vm_start, vma->vm_page_prot);
  1473. return ret;
  1474. }
  1475. /* Obsolete functions. Should be removed once the symbios driver
  1476. * is fixed
  1477. */
  1478. unsigned long
  1479. phys_to_bus(unsigned long pa)
  1480. {
  1481. struct pci_controller *hose;
  1482. int i;
  1483. for (hose = hose_head; hose; hose = hose->next) {
  1484. for (i = 0; i < 3; ++i) {
  1485. if (pa >= hose->mem_resources[i].start
  1486. && pa <= hose->mem_resources[i].end) {
  1487. /*
  1488. * XXX the hose->pci_mem_offset really
  1489. * only applies to mem_resources[0].
  1490. * We need a way to store an offset for
  1491. * the others. -- paulus
  1492. */
  1493. if (i == 0)
  1494. pa -= hose->pci_mem_offset;
  1495. return pa;
  1496. }
  1497. }
  1498. }
  1499. /* hmmm, didn't find it */
  1500. return 0;
  1501. }
  1502. unsigned long
  1503. pci_phys_to_bus(unsigned long pa, int busnr)
  1504. {
  1505. struct pci_controller* hose = pci_bus_to_hose(busnr);
  1506. if (!hose)
  1507. return pa;
  1508. return pa - hose->pci_mem_offset;
  1509. }
  1510. unsigned long
  1511. pci_bus_to_phys(unsigned int ba, int busnr)
  1512. {
  1513. struct pci_controller* hose = pci_bus_to_hose(busnr);
  1514. if (!hose)
  1515. return ba;
  1516. return ba + hose->pci_mem_offset;
  1517. }
  1518. /* Provide information on locations of various I/O regions in physical
  1519. * memory. Do this on a per-card basis so that we choose the right
  1520. * root bridge.
  1521. * Note that the returned IO or memory base is a physical address
  1522. */
  1523. long sys_pciconfig_iobase(long which, unsigned long bus, unsigned long devfn)
  1524. {
  1525. struct pci_controller* hose;
  1526. long result = -EOPNOTSUPP;
  1527. /* Argh ! Please forgive me for that hack, but that's the
  1528. * simplest way to get existing XFree to not lockup on some
  1529. * G5 machines... So when something asks for bus 0 io base
  1530. * (bus 0 is HT root), we return the AGP one instead.
  1531. */
  1532. #ifdef CONFIG_PPC_PMAC
  1533. if (_machine == _MACH_Pmac && machine_is_compatible("MacRISC4"))
  1534. if (bus == 0)
  1535. bus = 0xf0;
  1536. #endif /* CONFIG_PPC_PMAC */
  1537. hose = pci_bus_to_hose(bus);
  1538. if (!hose)
  1539. return -ENODEV;
  1540. switch (which) {
  1541. case IOBASE_BRIDGE_NUMBER:
  1542. return (long)hose->first_busno;
  1543. case IOBASE_MEMORY:
  1544. return (long)hose->pci_mem_offset;
  1545. case IOBASE_IO:
  1546. return (long)hose->io_base_phys;
  1547. case IOBASE_ISA_IO:
  1548. return (long)isa_io_base;
  1549. case IOBASE_ISA_MEM:
  1550. return (long)isa_mem_base;
  1551. }
  1552. return result;
  1553. }
  1554. void pci_resource_to_user(const struct pci_dev *dev, int bar,
  1555. const struct resource *rsrc,
  1556. u64 *start, u64 *end)
  1557. {
  1558. struct pci_controller *hose = pci_bus_to_hose(dev->bus->number);
  1559. unsigned long offset = 0;
  1560. if (hose == NULL)
  1561. return;
  1562. if (rsrc->flags & IORESOURCE_IO)
  1563. offset = ___IO_BASE - hose->io_base_virt + hose->io_base_phys;
  1564. *start = rsrc->start + offset;
  1565. *end = rsrc->end + offset;
  1566. }
  1567. void __init
  1568. pci_init_resource(struct resource *res, unsigned long start, unsigned long end,
  1569. int flags, char *name)
  1570. {
  1571. res->start = start;
  1572. res->end = end;
  1573. res->flags = flags;
  1574. res->name = name;
  1575. res->parent = NULL;
  1576. res->sibling = NULL;
  1577. res->child = NULL;
  1578. }
  1579. void __iomem *pci_iomap(struct pci_dev *dev, int bar, unsigned long max)
  1580. {
  1581. unsigned long start = pci_resource_start(dev, bar);
  1582. unsigned long len = pci_resource_len(dev, bar);
  1583. unsigned long flags = pci_resource_flags(dev, bar);
  1584. if (!len)
  1585. return NULL;
  1586. if (max && len > max)
  1587. len = max;
  1588. if (flags & IORESOURCE_IO)
  1589. return ioport_map(start, len);
  1590. if (flags & IORESOURCE_MEM)
  1591. /* Not checking IORESOURCE_CACHEABLE because PPC does
  1592. * not currently distinguish between ioremap and
  1593. * ioremap_nocache.
  1594. */
  1595. return ioremap(start, len);
  1596. /* What? */
  1597. return NULL;
  1598. }
  1599. void pci_iounmap(struct pci_dev *dev, void __iomem *addr)
  1600. {
  1601. /* Nothing to do */
  1602. }
  1603. EXPORT_SYMBOL(pci_iomap);
  1604. EXPORT_SYMBOL(pci_iounmap);
  1605. /*
  1606. * Null PCI config access functions, for the case when we can't
  1607. * find a hose.
  1608. */
  1609. #define NULL_PCI_OP(rw, size, type) \
  1610. static int \
  1611. null_##rw##_config_##size(struct pci_dev *dev, int offset, type val) \
  1612. { \
  1613. return PCIBIOS_DEVICE_NOT_FOUND; \
  1614. }
  1615. static int
  1616. null_read_config(struct pci_bus *bus, unsigned int devfn, int offset,
  1617. int len, u32 *val)
  1618. {
  1619. return PCIBIOS_DEVICE_NOT_FOUND;
  1620. }
  1621. static int
  1622. null_write_config(struct pci_bus *bus, unsigned int devfn, int offset,
  1623. int len, u32 val)
  1624. {
  1625. return PCIBIOS_DEVICE_NOT_FOUND;
  1626. }
  1627. static struct pci_ops null_pci_ops =
  1628. {
  1629. null_read_config,
  1630. null_write_config
  1631. };
  1632. /*
  1633. * These functions are used early on before PCI scanning is done
  1634. * and all of the pci_dev and pci_bus structures have been created.
  1635. */
  1636. static struct pci_bus *
  1637. fake_pci_bus(struct pci_controller *hose, int busnr)
  1638. {
  1639. static struct pci_bus bus;
  1640. if (hose == 0) {
  1641. hose = pci_bus_to_hose(busnr);
  1642. if (hose == 0)
  1643. printk(KERN_ERR "Can't find hose for PCI bus %d!\n", busnr);
  1644. }
  1645. bus.number = busnr;
  1646. bus.sysdata = hose;
  1647. bus.ops = hose? hose->ops: &null_pci_ops;
  1648. return &bus;
  1649. }
  1650. #define EARLY_PCI_OP(rw, size, type) \
  1651. int early_##rw##_config_##size(struct pci_controller *hose, int bus, \
  1652. int devfn, int offset, type value) \
  1653. { \
  1654. return pci_bus_##rw##_config_##size(fake_pci_bus(hose, bus), \
  1655. devfn, offset, value); \
  1656. }
  1657. EARLY_PCI_OP(read, byte, u8 *)
  1658. EARLY_PCI_OP(read, word, u16 *)
  1659. EARLY_PCI_OP(read, dword, u32 *)
  1660. EARLY_PCI_OP(write, byte, u8)
  1661. EARLY_PCI_OP(write, word, u16)
  1662. EARLY_PCI_OP(write, dword, u32)