diff options
Diffstat (limited to 'arch/arm/kernel/bios32.c')
-rw-r--r-- | arch/arm/kernel/bios32.c | 699 |
1 files changed, 699 insertions, 0 deletions
diff --git a/arch/arm/kernel/bios32.c b/arch/arm/kernel/bios32.c new file mode 100644 index 000000000000..ad26e98f1e62 --- /dev/null +++ b/arch/arm/kernel/bios32.c | |||
@@ -0,0 +1,699 @@ | |||
1 | /* | ||
2 | * linux/arch/arm/kernel/bios32.c | ||
3 | * | ||
4 | * PCI bios-type initialisation for PCI machines | ||
5 | * | ||
6 | * Bits taken from various places. | ||
7 | */ | ||
8 | #include <linux/config.h> | ||
9 | #include <linux/module.h> | ||
10 | #include <linux/kernel.h> | ||
11 | #include <linux/pci.h> | ||
12 | #include <linux/slab.h> | ||
13 | #include <linux/init.h> | ||
14 | |||
15 | #include <asm/io.h> | ||
16 | #include <asm/mach-types.h> | ||
17 | #include <asm/mach/pci.h> | ||
18 | |||
19 | static int debug_pci; | ||
20 | static int use_firmware; | ||
21 | |||
22 | /* | ||
23 | * We can't use pci_find_device() here since we are | ||
24 | * called from interrupt context. | ||
25 | */ | ||
26 | static void pcibios_bus_report_status(struct pci_bus *bus, u_int status_mask, int warn) | ||
27 | { | ||
28 | struct pci_dev *dev; | ||
29 | |||
30 | list_for_each_entry(dev, &bus->devices, bus_list) { | ||
31 | u16 status; | ||
32 | |||
33 | /* | ||
34 | * ignore host bridge - we handle | ||
35 | * that separately | ||
36 | */ | ||
37 | if (dev->bus->number == 0 && dev->devfn == 0) | ||
38 | continue; | ||
39 | |||
40 | pci_read_config_word(dev, PCI_STATUS, &status); | ||
41 | if (status == 0xffff) | ||
42 | continue; | ||
43 | |||
44 | if ((status & status_mask) == 0) | ||
45 | continue; | ||
46 | |||
47 | /* clear the status errors */ | ||
48 | pci_write_config_word(dev, PCI_STATUS, status & status_mask); | ||
49 | |||
50 | if (warn) | ||
51 | printk("(%s: %04X) ", pci_name(dev), status); | ||
52 | } | ||
53 | |||
54 | list_for_each_entry(dev, &bus->devices, bus_list) | ||
55 | if (dev->subordinate) | ||
56 | pcibios_bus_report_status(dev->subordinate, status_mask, warn); | ||
57 | } | ||
58 | |||
59 | void pcibios_report_status(u_int status_mask, int warn) | ||
60 | { | ||
61 | struct list_head *l; | ||
62 | |||
63 | list_for_each(l, &pci_root_buses) { | ||
64 | struct pci_bus *bus = pci_bus_b(l); | ||
65 | |||
66 | pcibios_bus_report_status(bus, status_mask, warn); | ||
67 | } | ||
68 | } | ||
69 | |||
70 | /* | ||
71 | * We don't use this to fix the device, but initialisation of it. | ||
72 | * It's not the correct use for this, but it works. | ||
73 | * Note that the arbiter/ISA bridge appears to be buggy, specifically in | ||
74 | * the following area: | ||
75 | * 1. park on CPU | ||
76 | * 2. ISA bridge ping-pong | ||
77 | * 3. ISA bridge master handling of target RETRY | ||
78 | * | ||
79 | * Bug 3 is responsible for the sound DMA grinding to a halt. We now | ||
80 | * live with bug 2. | ||
81 | */ | ||
82 | static void __devinit pci_fixup_83c553(struct pci_dev *dev) | ||
83 | { | ||
84 | /* | ||
85 | * Set memory region to start at address 0, and enable IO | ||
86 | */ | ||
87 | pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, PCI_BASE_ADDRESS_SPACE_MEMORY); | ||
88 | pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_IO); | ||
89 | |||
90 | dev->resource[0].end -= dev->resource[0].start; | ||
91 | dev->resource[0].start = 0; | ||
92 | |||
93 | /* | ||
94 | * All memory requests from ISA to be channelled to PCI | ||
95 | */ | ||
96 | pci_write_config_byte(dev, 0x48, 0xff); | ||
97 | |||
98 | /* | ||
99 | * Enable ping-pong on bus master to ISA bridge transactions. | ||
100 | * This improves the sound DMA substantially. The fixed | ||
101 | * priority arbiter also helps (see below). | ||
102 | */ | ||
103 | pci_write_config_byte(dev, 0x42, 0x01); | ||
104 | |||
105 | /* | ||
106 | * Enable PCI retry | ||
107 | */ | ||
108 | pci_write_config_byte(dev, 0x40, 0x22); | ||
109 | |||
110 | /* | ||
111 | * We used to set the arbiter to "park on last master" (bit | ||
112 | * 1 set), but unfortunately the CyberPro does not park the | ||
113 | * bus. We must therefore park on CPU. Unfortunately, this | ||
114 | * may trigger yet another bug in the 553. | ||
115 | */ | ||
116 | pci_write_config_byte(dev, 0x83, 0x02); | ||
117 | |||
118 | /* | ||
119 | * Make the ISA DMA request lowest priority, and disable | ||
120 | * rotating priorities completely. | ||
121 | */ | ||
122 | pci_write_config_byte(dev, 0x80, 0x11); | ||
123 | pci_write_config_byte(dev, 0x81, 0x00); | ||
124 | |||
125 | /* | ||
126 | * Route INTA input to IRQ 11, and set IRQ11 to be level | ||
127 | * sensitive. | ||
128 | */ | ||
129 | pci_write_config_word(dev, 0x44, 0xb000); | ||
130 | outb(0x08, 0x4d1); | ||
131 | } | ||
132 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_WINBOND, PCI_DEVICE_ID_WINBOND_83C553, pci_fixup_83c553); | ||
133 | |||
134 | static void __devinit pci_fixup_unassign(struct pci_dev *dev) | ||
135 | { | ||
136 | dev->resource[0].end -= dev->resource[0].start; | ||
137 | dev->resource[0].start = 0; | ||
138 | } | ||
139 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_WINBOND2, PCI_DEVICE_ID_WINBOND2_89C940F, pci_fixup_unassign); | ||
140 | |||
141 | /* | ||
142 | * Prevent the PCI layer from seeing the resources allocated to this device | ||
143 | * if it is the host bridge by marking it as such. These resources are of | ||
144 | * no consequence to the PCI layer (they are handled elsewhere). | ||
145 | */ | ||
146 | static void __devinit pci_fixup_dec21285(struct pci_dev *dev) | ||
147 | { | ||
148 | int i; | ||
149 | |||
150 | if (dev->devfn == 0) { | ||
151 | dev->class &= 0xff; | ||
152 | dev->class |= PCI_CLASS_BRIDGE_HOST << 8; | ||
153 | for (i = 0; i < PCI_NUM_RESOURCES; i++) { | ||
154 | dev->resource[i].start = 0; | ||
155 | dev->resource[i].end = 0; | ||
156 | dev->resource[i].flags = 0; | ||
157 | } | ||
158 | } | ||
159 | } | ||
160 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_DEC_21285, pci_fixup_dec21285); | ||
161 | |||
162 | /* | ||
163 | * Same as above. The PrPMC800 carrier board for the PrPMC1100 | ||
164 | * card maps the host-bridge @ 00:01:00 for some reason and it | ||
165 | * ends up getting scanned. Note that we only want to do this | ||
166 | * fixup when we find the IXP4xx on a PrPMC system, which is why | ||
167 | * we check the machine type. We could be running on a board | ||
168 | * with an IXP4xx target device and we don't want to kill the | ||
169 | * resources in that case. | ||
170 | */ | ||
171 | static void __devinit pci_fixup_prpmc1100(struct pci_dev *dev) | ||
172 | { | ||
173 | int i; | ||
174 | |||
175 | if (machine_is_prpmc1100()) { | ||
176 | dev->class &= 0xff; | ||
177 | dev->class |= PCI_CLASS_BRIDGE_HOST << 8; | ||
178 | for (i = 0; i < PCI_NUM_RESOURCES; i++) { | ||
179 | dev->resource[i].start = 0; | ||
180 | dev->resource[i].end = 0; | ||
181 | dev->resource[i].flags = 0; | ||
182 | } | ||
183 | } | ||
184 | } | ||
185 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_IXP4XX, pci_fixup_prpmc1100); | ||
186 | |||
187 | /* | ||
188 | * PCI IDE controllers use non-standard I/O port decoding, respect it. | ||
189 | */ | ||
190 | static void __devinit pci_fixup_ide_bases(struct pci_dev *dev) | ||
191 | { | ||
192 | struct resource *r; | ||
193 | int i; | ||
194 | |||
195 | if ((dev->class >> 8) != PCI_CLASS_STORAGE_IDE) | ||
196 | return; | ||
197 | |||
198 | for (i = 0; i < PCI_NUM_RESOURCES; i++) { | ||
199 | r = dev->resource + i; | ||
200 | if ((r->start & ~0x80) == 0x374) { | ||
201 | r->start |= 2; | ||
202 | r->end = r->start; | ||
203 | } | ||
204 | } | ||
205 | } | ||
206 | DECLARE_PCI_FIXUP_HEADER(PCI_ANY_ID, PCI_ANY_ID, pci_fixup_ide_bases); | ||
207 | |||
208 | /* | ||
209 | * Put the DEC21142 to sleep | ||
210 | */ | ||
211 | static void __devinit pci_fixup_dec21142(struct pci_dev *dev) | ||
212 | { | ||
213 | pci_write_config_dword(dev, 0x40, 0x80000000); | ||
214 | } | ||
215 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_DEC_21142, pci_fixup_dec21142); | ||
216 | |||
217 | /* | ||
218 | * The CY82C693 needs some rather major fixups to ensure that it does | ||
219 | * the right thing. Idea from the Alpha people, with a few additions. | ||
220 | * | ||
221 | * We ensure that the IDE base registers are set to 1f0/3f4 for the | ||
222 | * primary bus, and 170/374 for the secondary bus. Also, hide them | ||
223 | * from the PCI subsystem view as well so we won't try to perform | ||
224 | * our own auto-configuration on them. | ||
225 | * | ||
226 | * In addition, we ensure that the PCI IDE interrupts are routed to | ||
227 | * IRQ 14 and IRQ 15 respectively. | ||
228 | * | ||
229 | * The above gets us to a point where the IDE on this device is | ||
230 | * functional. However, The CY82C693U _does not work_ in bus | ||
231 | * master mode without locking the PCI bus solid. | ||
232 | */ | ||
233 | static void __devinit pci_fixup_cy82c693(struct pci_dev *dev) | ||
234 | { | ||
235 | if ((dev->class >> 8) == PCI_CLASS_STORAGE_IDE) { | ||
236 | u32 base0, base1; | ||
237 | |||
238 | if (dev->class & 0x80) { /* primary */ | ||
239 | base0 = 0x1f0; | ||
240 | base1 = 0x3f4; | ||
241 | } else { /* secondary */ | ||
242 | base0 = 0x170; | ||
243 | base1 = 0x374; | ||
244 | } | ||
245 | |||
246 | pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, | ||
247 | base0 | PCI_BASE_ADDRESS_SPACE_IO); | ||
248 | pci_write_config_dword(dev, PCI_BASE_ADDRESS_1, | ||
249 | base1 | PCI_BASE_ADDRESS_SPACE_IO); | ||
250 | |||
251 | dev->resource[0].start = 0; | ||
252 | dev->resource[0].end = 0; | ||
253 | dev->resource[0].flags = 0; | ||
254 | |||
255 | dev->resource[1].start = 0; | ||
256 | dev->resource[1].end = 0; | ||
257 | dev->resource[1].flags = 0; | ||
258 | } else if (PCI_FUNC(dev->devfn) == 0) { | ||
259 | /* | ||
260 | * Setup IDE IRQ routing. | ||
261 | */ | ||
262 | pci_write_config_byte(dev, 0x4b, 14); | ||
263 | pci_write_config_byte(dev, 0x4c, 15); | ||
264 | |||
265 | /* | ||
266 | * Disable FREQACK handshake, enable USB. | ||
267 | */ | ||
268 | pci_write_config_byte(dev, 0x4d, 0x41); | ||
269 | |||
270 | /* | ||
271 | * Enable PCI retry, and PCI post-write buffer. | ||
272 | */ | ||
273 | pci_write_config_byte(dev, 0x44, 0x17); | ||
274 | |||
275 | /* | ||
276 | * Enable ISA master and DMA post write buffering. | ||
277 | */ | ||
278 | pci_write_config_byte(dev, 0x45, 0x03); | ||
279 | } | ||
280 | } | ||
281 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_CONTAQ, PCI_DEVICE_ID_CONTAQ_82C693, pci_fixup_cy82c693); | ||
282 | |||
283 | void __devinit pcibios_update_irq(struct pci_dev *dev, int irq) | ||
284 | { | ||
285 | if (debug_pci) | ||
286 | printk("PCI: Assigning IRQ %02d to %s\n", irq, pci_name(dev)); | ||
287 | pci_write_config_byte(dev, PCI_INTERRUPT_LINE, irq); | ||
288 | } | ||
289 | |||
290 | /* | ||
291 | * If the bus contains any of these devices, then we must not turn on | ||
292 | * parity checking of any kind. Currently this is CyberPro 20x0 only. | ||
293 | */ | ||
294 | static inline int pdev_bad_for_parity(struct pci_dev *dev) | ||
295 | { | ||
296 | return (dev->vendor == PCI_VENDOR_ID_INTERG && | ||
297 | (dev->device == PCI_DEVICE_ID_INTERG_2000 || | ||
298 | dev->device == PCI_DEVICE_ID_INTERG_2010)); | ||
299 | } | ||
300 | |||
301 | /* | ||
302 | * Adjust the device resources from bus-centric to Linux-centric. | ||
303 | */ | ||
304 | static void __devinit | ||
305 | pdev_fixup_device_resources(struct pci_sys_data *root, struct pci_dev *dev) | ||
306 | { | ||
307 | unsigned long offset; | ||
308 | int i; | ||
309 | |||
310 | for (i = 0; i < PCI_NUM_RESOURCES; i++) { | ||
311 | if (dev->resource[i].start == 0) | ||
312 | continue; | ||
313 | if (dev->resource[i].flags & IORESOURCE_MEM) | ||
314 | offset = root->mem_offset; | ||
315 | else | ||
316 | offset = root->io_offset; | ||
317 | |||
318 | dev->resource[i].start += offset; | ||
319 | dev->resource[i].end += offset; | ||
320 | } | ||
321 | } | ||
322 | |||
323 | static void __devinit | ||
324 | pbus_assign_bus_resources(struct pci_bus *bus, struct pci_sys_data *root) | ||
325 | { | ||
326 | struct pci_dev *dev = bus->self; | ||
327 | int i; | ||
328 | |||
329 | if (!dev) { | ||
330 | /* | ||
331 | * Assign root bus resources. | ||
332 | */ | ||
333 | for (i = 0; i < 3; i++) | ||
334 | bus->resource[i] = root->resource[i]; | ||
335 | } | ||
336 | } | ||
337 | |||
338 | /* | ||
339 | * pcibios_fixup_bus - Called after each bus is probed, | ||
340 | * but before its children are examined. | ||
341 | */ | ||
342 | void __devinit pcibios_fixup_bus(struct pci_bus *bus) | ||
343 | { | ||
344 | struct pci_sys_data *root = bus->sysdata; | ||
345 | struct pci_dev *dev; | ||
346 | u16 features = PCI_COMMAND_SERR | PCI_COMMAND_PARITY | PCI_COMMAND_FAST_BACK; | ||
347 | |||
348 | pbus_assign_bus_resources(bus, root); | ||
349 | |||
350 | /* | ||
351 | * Walk the devices on this bus, working out what we can | ||
352 | * and can't support. | ||
353 | */ | ||
354 | list_for_each_entry(dev, &bus->devices, bus_list) { | ||
355 | u16 status; | ||
356 | |||
357 | pdev_fixup_device_resources(root, dev); | ||
358 | |||
359 | pci_read_config_word(dev, PCI_STATUS, &status); | ||
360 | |||
361 | /* | ||
362 | * If any device on this bus does not support fast back | ||
363 | * to back transfers, then the bus as a whole is not able | ||
364 | * to support them. Having fast back to back transfers | ||
365 | * on saves us one PCI cycle per transaction. | ||
366 | */ | ||
367 | if (!(status & PCI_STATUS_FAST_BACK)) | ||
368 | features &= ~PCI_COMMAND_FAST_BACK; | ||
369 | |||
370 | if (pdev_bad_for_parity(dev)) | ||
371 | features &= ~(PCI_COMMAND_SERR | PCI_COMMAND_PARITY); | ||
372 | |||
373 | switch (dev->class >> 8) { | ||
374 | #if defined(CONFIG_ISA) || defined(CONFIG_EISA) | ||
375 | case PCI_CLASS_BRIDGE_ISA: | ||
376 | case PCI_CLASS_BRIDGE_EISA: | ||
377 | /* | ||
378 | * If this device is an ISA bridge, set isa_bridge | ||
379 | * to point at this device. We will then go looking | ||
380 | * for things like keyboard, etc. | ||
381 | */ | ||
382 | isa_bridge = dev; | ||
383 | break; | ||
384 | #endif | ||
385 | case PCI_CLASS_BRIDGE_PCI: | ||
386 | pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &status); | ||
387 | status |= PCI_BRIDGE_CTL_PARITY|PCI_BRIDGE_CTL_MASTER_ABORT; | ||
388 | status &= ~(PCI_BRIDGE_CTL_BUS_RESET|PCI_BRIDGE_CTL_FAST_BACK); | ||
389 | pci_write_config_word(dev, PCI_BRIDGE_CONTROL, status); | ||
390 | break; | ||
391 | |||
392 | case PCI_CLASS_BRIDGE_CARDBUS: | ||
393 | pci_read_config_word(dev, PCI_CB_BRIDGE_CONTROL, &status); | ||
394 | status |= PCI_CB_BRIDGE_CTL_PARITY|PCI_CB_BRIDGE_CTL_MASTER_ABORT; | ||
395 | pci_write_config_word(dev, PCI_CB_BRIDGE_CONTROL, status); | ||
396 | break; | ||
397 | } | ||
398 | } | ||
399 | |||
400 | /* | ||
401 | * Now walk the devices again, this time setting them up. | ||
402 | */ | ||
403 | list_for_each_entry(dev, &bus->devices, bus_list) { | ||
404 | u16 cmd; | ||
405 | |||
406 | pci_read_config_word(dev, PCI_COMMAND, &cmd); | ||
407 | cmd |= features; | ||
408 | pci_write_config_word(dev, PCI_COMMAND, cmd); | ||
409 | |||
410 | pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, | ||
411 | L1_CACHE_BYTES >> 2); | ||
412 | } | ||
413 | |||
414 | /* | ||
415 | * Propagate the flags to the PCI bridge. | ||
416 | */ | ||
417 | if (bus->self && bus->self->hdr_type == PCI_HEADER_TYPE_BRIDGE) { | ||
418 | if (features & PCI_COMMAND_FAST_BACK) | ||
419 | bus->bridge_ctl |= PCI_BRIDGE_CTL_FAST_BACK; | ||
420 | if (features & PCI_COMMAND_PARITY) | ||
421 | bus->bridge_ctl |= PCI_BRIDGE_CTL_PARITY; | ||
422 | } | ||
423 | |||
424 | /* | ||
425 | * Report what we did for this bus | ||
426 | */ | ||
427 | printk(KERN_INFO "PCI: bus%d: Fast back to back transfers %sabled\n", | ||
428 | bus->number, (features & PCI_COMMAND_FAST_BACK) ? "en" : "dis"); | ||
429 | } | ||
430 | |||
431 | /* | ||
432 | * Convert from Linux-centric to bus-centric addresses for bridge devices. | ||
433 | */ | ||
434 | void __devinit | ||
435 | pcibios_resource_to_bus(struct pci_dev *dev, struct pci_bus_region *region, | ||
436 | struct resource *res) | ||
437 | { | ||
438 | struct pci_sys_data *root = dev->sysdata; | ||
439 | unsigned long offset = 0; | ||
440 | |||
441 | if (res->flags & IORESOURCE_IO) | ||
442 | offset = root->io_offset; | ||
443 | if (res->flags & IORESOURCE_MEM) | ||
444 | offset = root->mem_offset; | ||
445 | |||
446 | region->start = res->start - offset; | ||
447 | region->end = res->end - offset; | ||
448 | } | ||
449 | |||
450 | #ifdef CONFIG_HOTPLUG | ||
451 | EXPORT_SYMBOL(pcibios_fixup_bus); | ||
452 | EXPORT_SYMBOL(pcibios_resource_to_bus); | ||
453 | #endif | ||
454 | |||
455 | /* | ||
456 | * This is the standard PCI-PCI bridge swizzling algorithm: | ||
457 | * | ||
458 | * Dev: 0 1 2 3 | ||
459 | * A A B C D | ||
460 | * B B C D A | ||
461 | * C C D A B | ||
462 | * D D A B C | ||
463 | * ^^^^^^^^^^ irq pin on bridge | ||
464 | */ | ||
465 | u8 __devinit pci_std_swizzle(struct pci_dev *dev, u8 *pinp) | ||
466 | { | ||
467 | int pin = *pinp - 1; | ||
468 | |||
469 | while (dev->bus->self) { | ||
470 | pin = (pin + PCI_SLOT(dev->devfn)) & 3; | ||
471 | /* | ||
472 | * move up the chain of bridges, | ||
473 | * swizzling as we go. | ||
474 | */ | ||
475 | dev = dev->bus->self; | ||
476 | } | ||
477 | *pinp = pin + 1; | ||
478 | |||
479 | return PCI_SLOT(dev->devfn); | ||
480 | } | ||
481 | |||
482 | /* | ||
483 | * Swizzle the device pin each time we cross a bridge. | ||
484 | * This might update pin and returns the slot number. | ||
485 | */ | ||
486 | static u8 __devinit pcibios_swizzle(struct pci_dev *dev, u8 *pin) | ||
487 | { | ||
488 | struct pci_sys_data *sys = dev->sysdata; | ||
489 | int slot = 0, oldpin = *pin; | ||
490 | |||
491 | if (sys->swizzle) | ||
492 | slot = sys->swizzle(dev, pin); | ||
493 | |||
494 | if (debug_pci) | ||
495 | printk("PCI: %s swizzling pin %d => pin %d slot %d\n", | ||
496 | pci_name(dev), oldpin, *pin, slot); | ||
497 | |||
498 | return slot; | ||
499 | } | ||
500 | |||
501 | /* | ||
502 | * Map a slot/pin to an IRQ. | ||
503 | */ | ||
504 | static int pcibios_map_irq(struct pci_dev *dev, u8 slot, u8 pin) | ||
505 | { | ||
506 | struct pci_sys_data *sys = dev->sysdata; | ||
507 | int irq = -1; | ||
508 | |||
509 | if (sys->map_irq) | ||
510 | irq = sys->map_irq(dev, slot, pin); | ||
511 | |||
512 | if (debug_pci) | ||
513 | printk("PCI: %s mapping slot %d pin %d => irq %d\n", | ||
514 | pci_name(dev), slot, pin, irq); | ||
515 | |||
516 | return irq; | ||
517 | } | ||
518 | |||
519 | static void __init pcibios_init_hw(struct hw_pci *hw) | ||
520 | { | ||
521 | struct pci_sys_data *sys = NULL; | ||
522 | int ret; | ||
523 | int nr, busnr; | ||
524 | |||
525 | for (nr = busnr = 0; nr < hw->nr_controllers; nr++) { | ||
526 | sys = kmalloc(sizeof(struct pci_sys_data), GFP_KERNEL); | ||
527 | if (!sys) | ||
528 | panic("PCI: unable to allocate sys data!"); | ||
529 | |||
530 | memset(sys, 0, sizeof(struct pci_sys_data)); | ||
531 | |||
532 | sys->hw = hw; | ||
533 | sys->busnr = busnr; | ||
534 | sys->swizzle = hw->swizzle; | ||
535 | sys->map_irq = hw->map_irq; | ||
536 | sys->resource[0] = &ioport_resource; | ||
537 | sys->resource[1] = &iomem_resource; | ||
538 | |||
539 | ret = hw->setup(nr, sys); | ||
540 | |||
541 | if (ret > 0) { | ||
542 | sys->bus = hw->scan(nr, sys); | ||
543 | |||
544 | if (!sys->bus) | ||
545 | panic("PCI: unable to scan bus!"); | ||
546 | |||
547 | busnr = sys->bus->subordinate + 1; | ||
548 | |||
549 | list_add(&sys->node, &hw->buses); | ||
550 | } else { | ||
551 | kfree(sys); | ||
552 | if (ret < 0) | ||
553 | break; | ||
554 | } | ||
555 | } | ||
556 | } | ||
557 | |||
558 | void __init pci_common_init(struct hw_pci *hw) | ||
559 | { | ||
560 | struct pci_sys_data *sys; | ||
561 | |||
562 | INIT_LIST_HEAD(&hw->buses); | ||
563 | |||
564 | if (hw->preinit) | ||
565 | hw->preinit(); | ||
566 | pcibios_init_hw(hw); | ||
567 | if (hw->postinit) | ||
568 | hw->postinit(); | ||
569 | |||
570 | pci_fixup_irqs(pcibios_swizzle, pcibios_map_irq); | ||
571 | |||
572 | list_for_each_entry(sys, &hw->buses, node) { | ||
573 | struct pci_bus *bus = sys->bus; | ||
574 | |||
575 | if (!use_firmware) { | ||
576 | /* | ||
577 | * Size the bridge windows. | ||
578 | */ | ||
579 | pci_bus_size_bridges(bus); | ||
580 | |||
581 | /* | ||
582 | * Assign resources. | ||
583 | */ | ||
584 | pci_bus_assign_resources(bus); | ||
585 | } | ||
586 | |||
587 | /* | ||
588 | * Tell drivers about devices found. | ||
589 | */ | ||
590 | pci_bus_add_devices(bus); | ||
591 | } | ||
592 | } | ||
593 | |||
594 | char * __init pcibios_setup(char *str) | ||
595 | { | ||
596 | if (!strcmp(str, "debug")) { | ||
597 | debug_pci = 1; | ||
598 | return NULL; | ||
599 | } else if (!strcmp(str, "firmware")) { | ||
600 | use_firmware = 1; | ||
601 | return NULL; | ||
602 | } | ||
603 | return str; | ||
604 | } | ||
605 | |||
606 | /* | ||
607 | * From arch/i386/kernel/pci-i386.c: | ||
608 | * | ||
609 | * We need to avoid collisions with `mirrored' VGA ports | ||
610 | * and other strange ISA hardware, so we always want the | ||
611 | * addresses to be allocated in the 0x000-0x0ff region | ||
612 | * modulo 0x400. | ||
613 | * | ||
614 | * Why? Because some silly external IO cards only decode | ||
615 | * the low 10 bits of the IO address. The 0x00-0xff region | ||
616 | * is reserved for motherboard devices that decode all 16 | ||
617 | * bits, so it's ok to allocate at, say, 0x2800-0x28ff, | ||
618 | * but we want to try to avoid allocating at 0x2900-0x2bff | ||
619 | * which might be mirrored at 0x0100-0x03ff.. | ||
620 | */ | ||
621 | void pcibios_align_resource(void *data, struct resource *res, | ||
622 | unsigned long size, unsigned long align) | ||
623 | { | ||
624 | unsigned long start = res->start; | ||
625 | |||
626 | if (res->flags & IORESOURCE_IO && start & 0x300) | ||
627 | start = (start + 0x3ff) & ~0x3ff; | ||
628 | |||
629 | res->start = (start + align - 1) & ~(align - 1); | ||
630 | } | ||
631 | |||
632 | /** | ||
633 | * pcibios_enable_device - Enable I/O and memory. | ||
634 | * @dev: PCI device to be enabled | ||
635 | */ | ||
636 | int pcibios_enable_device(struct pci_dev *dev, int mask) | ||
637 | { | ||
638 | u16 cmd, old_cmd; | ||
639 | int idx; | ||
640 | struct resource *r; | ||
641 | |||
642 | pci_read_config_word(dev, PCI_COMMAND, &cmd); | ||
643 | old_cmd = cmd; | ||
644 | for (idx = 0; idx < 6; idx++) { | ||
645 | /* Only set up the requested stuff */ | ||
646 | if (!(mask & (1 << idx))) | ||
647 | continue; | ||
648 | |||
649 | r = dev->resource + idx; | ||
650 | if (!r->start && r->end) { | ||
651 | printk(KERN_ERR "PCI: Device %s not available because" | ||
652 | " of resource collisions\n", pci_name(dev)); | ||
653 | return -EINVAL; | ||
654 | } | ||
655 | if (r->flags & IORESOURCE_IO) | ||
656 | cmd |= PCI_COMMAND_IO; | ||
657 | if (r->flags & IORESOURCE_MEM) | ||
658 | cmd |= PCI_COMMAND_MEMORY; | ||
659 | } | ||
660 | |||
661 | /* | ||
662 | * Bridges (eg, cardbus bridges) need to be fully enabled | ||
663 | */ | ||
664 | if ((dev->class >> 16) == PCI_BASE_CLASS_BRIDGE) | ||
665 | cmd |= PCI_COMMAND_IO | PCI_COMMAND_MEMORY; | ||
666 | |||
667 | if (cmd != old_cmd) { | ||
668 | printk("PCI: enabling device %s (%04x -> %04x)\n", | ||
669 | pci_name(dev), old_cmd, cmd); | ||
670 | pci_write_config_word(dev, PCI_COMMAND, cmd); | ||
671 | } | ||
672 | return 0; | ||
673 | } | ||
674 | |||
675 | int pci_mmap_page_range(struct pci_dev *dev, struct vm_area_struct *vma, | ||
676 | enum pci_mmap_state mmap_state, int write_combine) | ||
677 | { | ||
678 | struct pci_sys_data *root = dev->sysdata; | ||
679 | unsigned long phys; | ||
680 | |||
681 | if (mmap_state == pci_mmap_io) { | ||
682 | return -EINVAL; | ||
683 | } else { | ||
684 | phys = vma->vm_pgoff + (root->mem_offset >> PAGE_SHIFT); | ||
685 | } | ||
686 | |||
687 | /* | ||
688 | * Mark this as IO | ||
689 | */ | ||
690 | vma->vm_flags |= VM_SHM | VM_LOCKED | VM_IO; | ||
691 | vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); | ||
692 | |||
693 | if (remap_pfn_range(vma, vma->vm_start, phys, | ||
694 | vma->vm_end - vma->vm_start, | ||
695 | vma->vm_page_prot)) | ||
696 | return -EAGAIN; | ||
697 | |||
698 | return 0; | ||
699 | } | ||