blob: c3165f0fef6359faeea88e9553f1661c71eb6a24 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/arch/arm/kernel/bios32.c
3 *
4 * PCI bios-type initialisation for PCI machines
5 *
6 * Bits taken from various places.
7 */
Paul Gortmakerecea4ab2011-07-22 10:58:34 -04008#include <linux/export.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -07009#include <linux/kernel.h>
10#include <linux/pci.h>
11#include <linux/slab.h>
12#include <linux/init.h>
Russell Kingfced80c2008-09-06 12:10:45 +010013#include <linux/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <asm/mach-types.h>
Rob Herringc2794432012-02-29 18:10:58 -060016#include <asm/mach/map.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070017#include <asm/mach/pci.h>
18
19static int debug_pci;
Linus Torvalds1da177e2005-04-16 15:20:36 -070020
21/*
22 * We can't use pci_find_device() here since we are
23 * called from interrupt context.
24 */
25static void pcibios_bus_report_status(struct pci_bus *bus, u_int status_mask, int warn)
26{
27 struct pci_dev *dev;
28
29 list_for_each_entry(dev, &bus->devices, bus_list) {
30 u16 status;
31
32 /*
33 * ignore host bridge - we handle
34 * that separately
35 */
36 if (dev->bus->number == 0 && dev->devfn == 0)
37 continue;
38
39 pci_read_config_word(dev, PCI_STATUS, &status);
40 if (status == 0xffff)
41 continue;
42
43 if ((status & status_mask) == 0)
44 continue;
45
46 /* clear the status errors */
47 pci_write_config_word(dev, PCI_STATUS, status & status_mask);
48
49 if (warn)
50 printk("(%s: %04X) ", pci_name(dev), status);
51 }
52
53 list_for_each_entry(dev, &bus->devices, bus_list)
54 if (dev->subordinate)
55 pcibios_bus_report_status(dev->subordinate, status_mask, warn);
56}
57
58void pcibios_report_status(u_int status_mask, int warn)
59{
60 struct list_head *l;
61
62 list_for_each(l, &pci_root_buses) {
63 struct pci_bus *bus = pci_bus_b(l);
64
65 pcibios_bus_report_status(bus, status_mask, warn);
66 }
67}
68
69/*
70 * We don't use this to fix the device, but initialisation of it.
71 * It's not the correct use for this, but it works.
72 * Note that the arbiter/ISA bridge appears to be buggy, specifically in
73 * the following area:
74 * 1. park on CPU
75 * 2. ISA bridge ping-pong
76 * 3. ISA bridge master handling of target RETRY
77 *
78 * Bug 3 is responsible for the sound DMA grinding to a halt. We now
79 * live with bug 2.
80 */
81static void __devinit pci_fixup_83c553(struct pci_dev *dev)
82{
83 /*
84 * Set memory region to start at address 0, and enable IO
85 */
86 pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, PCI_BASE_ADDRESS_SPACE_MEMORY);
87 pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_IO);
88
89 dev->resource[0].end -= dev->resource[0].start;
90 dev->resource[0].start = 0;
91
92 /*
93 * All memory requests from ISA to be channelled to PCI
94 */
95 pci_write_config_byte(dev, 0x48, 0xff);
96
97 /*
98 * Enable ping-pong on bus master to ISA bridge transactions.
99 * This improves the sound DMA substantially. The fixed
100 * priority arbiter also helps (see below).
101 */
102 pci_write_config_byte(dev, 0x42, 0x01);
103
104 /*
105 * Enable PCI retry
106 */
107 pci_write_config_byte(dev, 0x40, 0x22);
108
109 /*
110 * We used to set the arbiter to "park on last master" (bit
111 * 1 set), but unfortunately the CyberPro does not park the
112 * bus. We must therefore park on CPU. Unfortunately, this
113 * may trigger yet another bug in the 553.
114 */
115 pci_write_config_byte(dev, 0x83, 0x02);
116
117 /*
118 * Make the ISA DMA request lowest priority, and disable
119 * rotating priorities completely.
120 */
121 pci_write_config_byte(dev, 0x80, 0x11);
122 pci_write_config_byte(dev, 0x81, 0x00);
123
124 /*
125 * Route INTA input to IRQ 11, and set IRQ11 to be level
126 * sensitive.
127 */
128 pci_write_config_word(dev, 0x44, 0xb000);
129 outb(0x08, 0x4d1);
130}
131DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_WINBOND, PCI_DEVICE_ID_WINBOND_83C553, pci_fixup_83c553);
132
133static void __devinit pci_fixup_unassign(struct pci_dev *dev)
134{
135 dev->resource[0].end -= dev->resource[0].start;
136 dev->resource[0].start = 0;
137}
138DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_WINBOND2, PCI_DEVICE_ID_WINBOND2_89C940F, pci_fixup_unassign);
139
140/*
141 * Prevent the PCI layer from seeing the resources allocated to this device
142 * if it is the host bridge by marking it as such. These resources are of
143 * no consequence to the PCI layer (they are handled elsewhere).
144 */
145static void __devinit pci_fixup_dec21285(struct pci_dev *dev)
146{
147 int i;
148
149 if (dev->devfn == 0) {
150 dev->class &= 0xff;
151 dev->class |= PCI_CLASS_BRIDGE_HOST << 8;
152 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
153 dev->resource[i].start = 0;
154 dev->resource[i].end = 0;
155 dev->resource[i].flags = 0;
156 }
157 }
158}
159DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_DEC_21285, pci_fixup_dec21285);
160
161/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162 * PCI IDE controllers use non-standard I/O port decoding, respect it.
163 */
164static void __devinit pci_fixup_ide_bases(struct pci_dev *dev)
165{
166 struct resource *r;
167 int i;
168
169 if ((dev->class >> 8) != PCI_CLASS_STORAGE_IDE)
170 return;
171
172 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
173 r = dev->resource + i;
174 if ((r->start & ~0x80) == 0x374) {
175 r->start |= 2;
176 r->end = r->start;
177 }
178 }
179}
180DECLARE_PCI_FIXUP_HEADER(PCI_ANY_ID, PCI_ANY_ID, pci_fixup_ide_bases);
181
182/*
183 * Put the DEC21142 to sleep
184 */
185static void __devinit pci_fixup_dec21142(struct pci_dev *dev)
186{
187 pci_write_config_dword(dev, 0x40, 0x80000000);
188}
189DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_DEC_21142, pci_fixup_dec21142);
190
191/*
192 * The CY82C693 needs some rather major fixups to ensure that it does
193 * the right thing. Idea from the Alpha people, with a few additions.
194 *
195 * We ensure that the IDE base registers are set to 1f0/3f4 for the
196 * primary bus, and 170/374 for the secondary bus. Also, hide them
197 * from the PCI subsystem view as well so we won't try to perform
198 * our own auto-configuration on them.
199 *
200 * In addition, we ensure that the PCI IDE interrupts are routed to
201 * IRQ 14 and IRQ 15 respectively.
202 *
203 * The above gets us to a point where the IDE on this device is
204 * functional. However, The CY82C693U _does not work_ in bus
205 * master mode without locking the PCI bus solid.
206 */
207static void __devinit pci_fixup_cy82c693(struct pci_dev *dev)
208{
209 if ((dev->class >> 8) == PCI_CLASS_STORAGE_IDE) {
210 u32 base0, base1;
211
212 if (dev->class & 0x80) { /* primary */
213 base0 = 0x1f0;
214 base1 = 0x3f4;
215 } else { /* secondary */
216 base0 = 0x170;
217 base1 = 0x374;
218 }
219
220 pci_write_config_dword(dev, PCI_BASE_ADDRESS_0,
221 base0 | PCI_BASE_ADDRESS_SPACE_IO);
222 pci_write_config_dword(dev, PCI_BASE_ADDRESS_1,
223 base1 | PCI_BASE_ADDRESS_SPACE_IO);
224
225 dev->resource[0].start = 0;
226 dev->resource[0].end = 0;
227 dev->resource[0].flags = 0;
228
229 dev->resource[1].start = 0;
230 dev->resource[1].end = 0;
231 dev->resource[1].flags = 0;
232 } else if (PCI_FUNC(dev->devfn) == 0) {
233 /*
234 * Setup IDE IRQ routing.
235 */
236 pci_write_config_byte(dev, 0x4b, 14);
237 pci_write_config_byte(dev, 0x4c, 15);
238
239 /*
240 * Disable FREQACK handshake, enable USB.
241 */
242 pci_write_config_byte(dev, 0x4d, 0x41);
243
244 /*
245 * Enable PCI retry, and PCI post-write buffer.
246 */
247 pci_write_config_byte(dev, 0x44, 0x17);
248
249 /*
250 * Enable ISA master and DMA post write buffering.
251 */
252 pci_write_config_byte(dev, 0x45, 0x03);
253 }
254}
255DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_CONTAQ, PCI_DEVICE_ID_CONTAQ_82C693, pci_fixup_cy82c693);
256
Mike Rapoporta8fc0782007-09-23 15:59:52 +0100257static void __init pci_fixup_it8152(struct pci_dev *dev)
258{
259 int i;
260 /* fixup for ITE 8152 devices */
261 /* FIXME: add defines for class 0x68000 and 0x80103 */
262 if ((dev->class >> 8) == PCI_CLASS_BRIDGE_HOST ||
263 dev->class == 0x68000 ||
264 dev->class == 0x80103) {
265 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
266 dev->resource[i].start = 0;
267 dev->resource[i].end = 0;
268 dev->resource[i].flags = 0;
269 }
270 }
271}
272DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_ITE, PCI_DEVICE_ID_ITE_8152, pci_fixup_it8152);
273
274
275
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276void __devinit pcibios_update_irq(struct pci_dev *dev, int irq)
277{
278 if (debug_pci)
279 printk("PCI: Assigning IRQ %02d to %s\n", irq, pci_name(dev));
280 pci_write_config_byte(dev, PCI_INTERRUPT_LINE, irq);
281}
282
283/*
284 * If the bus contains any of these devices, then we must not turn on
285 * parity checking of any kind. Currently this is CyberPro 20x0 only.
286 */
287static inline int pdev_bad_for_parity(struct pci_dev *dev)
288{
Mike Rapoporta8fc0782007-09-23 15:59:52 +0100289 return ((dev->vendor == PCI_VENDOR_ID_INTERG &&
290 (dev->device == PCI_DEVICE_ID_INTERG_2000 ||
291 dev->device == PCI_DEVICE_ID_INTERG_2010)) ||
292 (dev->vendor == PCI_VENDOR_ID_ITE &&
293 dev->device == PCI_DEVICE_ID_ITE_8152));
294
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295}
296
297/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 * pcibios_fixup_bus - Called after each bus is probed,
299 * but before its children are examined.
300 */
Russell King46edfc52007-09-30 17:36:22 +0100301void pcibios_fixup_bus(struct pci_bus *bus)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700302{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303 struct pci_dev *dev;
304 u16 features = PCI_COMMAND_SERR | PCI_COMMAND_PARITY | PCI_COMMAND_FAST_BACK;
305
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306 /*
307 * Walk the devices on this bus, working out what we can
308 * and can't support.
309 */
310 list_for_each_entry(dev, &bus->devices, bus_list) {
311 u16 status;
312
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313 pci_read_config_word(dev, PCI_STATUS, &status);
314
315 /*
316 * If any device on this bus does not support fast back
317 * to back transfers, then the bus as a whole is not able
318 * to support them. Having fast back to back transfers
319 * on saves us one PCI cycle per transaction.
320 */
321 if (!(status & PCI_STATUS_FAST_BACK))
322 features &= ~PCI_COMMAND_FAST_BACK;
323
324 if (pdev_bad_for_parity(dev))
325 features &= ~(PCI_COMMAND_SERR | PCI_COMMAND_PARITY);
326
327 switch (dev->class >> 8) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700328 case PCI_CLASS_BRIDGE_PCI:
329 pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &status);
330 status |= PCI_BRIDGE_CTL_PARITY|PCI_BRIDGE_CTL_MASTER_ABORT;
331 status &= ~(PCI_BRIDGE_CTL_BUS_RESET|PCI_BRIDGE_CTL_FAST_BACK);
332 pci_write_config_word(dev, PCI_BRIDGE_CONTROL, status);
333 break;
334
335 case PCI_CLASS_BRIDGE_CARDBUS:
336 pci_read_config_word(dev, PCI_CB_BRIDGE_CONTROL, &status);
337 status |= PCI_CB_BRIDGE_CTL_PARITY|PCI_CB_BRIDGE_CTL_MASTER_ABORT;
338 pci_write_config_word(dev, PCI_CB_BRIDGE_CONTROL, status);
339 break;
340 }
341 }
342
343 /*
344 * Now walk the devices again, this time setting them up.
345 */
346 list_for_each_entry(dev, &bus->devices, bus_list) {
347 u16 cmd;
348
349 pci_read_config_word(dev, PCI_COMMAND, &cmd);
350 cmd |= features;
351 pci_write_config_word(dev, PCI_COMMAND, cmd);
352
353 pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE,
354 L1_CACHE_BYTES >> 2);
355 }
356
357 /*
358 * Propagate the flags to the PCI bridge.
359 */
360 if (bus->self && bus->self->hdr_type == PCI_HEADER_TYPE_BRIDGE) {
361 if (features & PCI_COMMAND_FAST_BACK)
362 bus->bridge_ctl |= PCI_BRIDGE_CTL_FAST_BACK;
363 if (features & PCI_COMMAND_PARITY)
364 bus->bridge_ctl |= PCI_BRIDGE_CTL_PARITY;
365 }
366
367 /*
368 * Report what we did for this bus
369 */
370 printk(KERN_INFO "PCI: bus%d: Fast back to back transfers %sabled\n",
371 bus->number, (features & PCI_COMMAND_FAST_BACK) ? "en" : "dis");
372}
Arnd Bergmannb214bea2011-09-04 22:30:06 +0200373#ifdef CONFIG_HOTPLUG
374EXPORT_SYMBOL(pcibios_fixup_bus);
375#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376
377/*
Russell Kingdaeb4c02012-03-10 11:39:33 +0000378 * Swizzle the device pin each time we cross a bridge. If a platform does
379 * not provide a swizzle function, we perform the standard PCI swizzling.
380 *
381 * The default swizzling walks up the bus tree one level at a time, applying
382 * the standard swizzle function at each step, stopping when it finds the PCI
383 * root bus. This will return the slot number of the bridge device on the
384 * root bus and the interrupt pin on that device which should correspond
385 * with the downstream device interrupt.
386 *
387 * Platforms may override this, in which case the slot and pin returned
388 * depend entirely on the platform code. However, please note that the
389 * PCI standard swizzle is implemented on plug-in cards and Cardbus based
390 * PCI extenders, so it can not be ignored.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391 */
392static u8 __devinit pcibios_swizzle(struct pci_dev *dev, u8 *pin)
393{
394 struct pci_sys_data *sys = dev->sysdata;
Russell Kingdaeb4c02012-03-10 11:39:33 +0000395 int slot, oldpin = *pin;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
397 if (sys->swizzle)
398 slot = sys->swizzle(dev, pin);
Russell Kingdaeb4c02012-03-10 11:39:33 +0000399 else
400 slot = pci_common_swizzle(dev, pin);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401
402 if (debug_pci)
403 printk("PCI: %s swizzling pin %d => pin %d slot %d\n",
404 pci_name(dev), oldpin, *pin, slot);
405
406 return slot;
407}
408
409/*
410 * Map a slot/pin to an IRQ.
411 */
Ralf Baechled5341942011-06-10 15:30:21 +0100412static int pcibios_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413{
414 struct pci_sys_data *sys = dev->sysdata;
415 int irq = -1;
416
417 if (sys->map_irq)
418 irq = sys->map_irq(dev, slot, pin);
419
420 if (debug_pci)
421 printk("PCI: %s mapping slot %d pin %d => irq %d\n",
422 pci_name(dev), slot, pin, irq);
423
424 return irq;
425}
426
Russell King90cf2412012-03-10 14:21:06 +0000427static void __init pcibios_init_hw(struct hw_pci *hw, struct list_head *head)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700428{
429 struct pci_sys_data *sys = NULL;
430 int ret;
431 int nr, busnr;
432
433 for (nr = busnr = 0; nr < hw->nr_controllers; nr++) {
Russell Kingd2a02b92006-03-20 19:46:41 +0000434 sys = kzalloc(sizeof(struct pci_sys_data), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700435 if (!sys)
436 panic("PCI: unable to allocate sys data!");
437
Anton Vorontsov52882172010-04-19 13:20:49 +0100438#ifdef CONFIG_PCI_DOMAINS
439 sys->domain = hw->domain;
440#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700441 sys->busnr = busnr;
442 sys->swizzle = hw->swizzle;
443 sys->map_irq = hw->map_irq;
Bjorn Helgaas37d15902011-10-28 16:26:16 -0600444 INIT_LIST_HEAD(&sys->resources);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700445
446 ret = hw->setup(nr, sys);
447
448 if (ret > 0) {
Bjorn Helgaas37d15902011-10-28 16:26:16 -0600449 if (list_empty(&sys->resources)) {
Bjorn Helgaas9f786d02012-02-23 20:19:01 -0700450 pci_add_resource_offset(&sys->resources,
451 &ioport_resource, sys->io_offset);
452 pci_add_resource_offset(&sys->resources,
453 &iomem_resource, sys->mem_offset);
Bjorn Helgaas37d15902011-10-28 16:26:16 -0600454 }
455
Russell Kingc23bfc32012-03-10 12:49:16 +0000456 if (hw->scan)
457 sys->bus = hw->scan(nr, sys);
458 else
459 sys->bus = pci_scan_root_bus(NULL, sys->busnr,
460 hw->ops, sys, &sys->resources);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461
462 if (!sys->bus)
463 panic("PCI: unable to scan bus!");
464
465 busnr = sys->bus->subordinate + 1;
466
Russell King90cf2412012-03-10 14:21:06 +0000467 list_add(&sys->node, head);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468 } else {
469 kfree(sys);
470 if (ret < 0)
471 break;
472 }
473 }
474}
475
476void __init pci_common_init(struct hw_pci *hw)
477{
478 struct pci_sys_data *sys;
Russell King90cf2412012-03-10 14:21:06 +0000479 LIST_HEAD(head);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480
Bjorn Helgaas6696cbc2012-02-23 20:18:56 -0700481 pci_add_flags(PCI_REASSIGN_ALL_RSRC);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700482 if (hw->preinit)
483 hw->preinit();
Russell King90cf2412012-03-10 14:21:06 +0000484 pcibios_init_hw(hw, &head);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 if (hw->postinit)
486 hw->postinit();
487
488 pci_fixup_irqs(pcibios_swizzle, pcibios_map_irq);
489
Russell King90cf2412012-03-10 14:21:06 +0000490 list_for_each_entry(sys, &head, node) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491 struct pci_bus *bus = sys->bus;
492
Bjorn Helgaasa4fab042012-02-23 20:18:57 -0700493 if (!pci_has_flag(PCI_PROBE_ONLY)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700494 /*
495 * Size the bridge windows.
496 */
497 pci_bus_size_bridges(bus);
498
499 /*
500 * Assign resources.
501 */
502 pci_bus_assign_resources(bus);
Colin Tuckleya9f43c12011-01-06 11:16:49 +0100503
504 /*
505 * Enable bridges
506 */
507 pci_enable_bridges(bus);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 }
509
510 /*
511 * Tell drivers about devices found.
512 */
513 pci_bus_add_devices(bus);
514 }
515}
516
Myron Stowe168c8612011-10-28 15:47:42 -0600517#ifndef CONFIG_PCI_HOST_ITE8152
518void pcibios_set_master(struct pci_dev *dev)
519{
520 /* No special bus mastering setup handling */
521}
522#endif
523
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524char * __init pcibios_setup(char *str)
525{
526 if (!strcmp(str, "debug")) {
527 debug_pci = 1;
528 return NULL;
529 } else if (!strcmp(str, "firmware")) {
Bjorn Helgaasa4fab042012-02-23 20:18:57 -0700530 pci_add_flags(PCI_PROBE_ONLY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531 return NULL;
532 }
533 return str;
534}
535
536/*
537 * From arch/i386/kernel/pci-i386.c:
538 *
539 * We need to avoid collisions with `mirrored' VGA ports
540 * and other strange ISA hardware, so we always want the
541 * addresses to be allocated in the 0x000-0x0ff region
542 * modulo 0x400.
543 *
544 * Why? Because some silly external IO cards only decode
545 * the low 10 bits of the IO address. The 0x00-0xff region
546 * is reserved for motherboard devices that decode all 16
547 * bits, so it's ok to allocate at, say, 0x2800-0x28ff,
548 * but we want to try to avoid allocating at 0x2900-0x2bff
549 * which might be mirrored at 0x0100-0x03ff..
550 */
Dominik Brodowski3b7a17f2010-01-01 17:40:50 +0100551resource_size_t pcibios_align_resource(void *data, const struct resource *res,
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100552 resource_size_t size, resource_size_t align)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553{
Greg Kroah-Hartmane31dd6e2006-06-12 17:06:02 -0700554 resource_size_t start = res->start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700555
556 if (res->flags & IORESOURCE_IO && start & 0x300)
557 start = (start + 0x3ff) & ~0x3ff;
558
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100559 start = (start + align - 1) & ~(align - 1);
560
561 return start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700562}
563
564/**
565 * pcibios_enable_device - Enable I/O and memory.
566 * @dev: PCI device to be enabled
567 */
568int pcibios_enable_device(struct pci_dev *dev, int mask)
569{
570 u16 cmd, old_cmd;
571 int idx;
572 struct resource *r;
573
574 pci_read_config_word(dev, PCI_COMMAND, &cmd);
575 old_cmd = cmd;
576 for (idx = 0; idx < 6; idx++) {
577 /* Only set up the requested stuff */
578 if (!(mask & (1 << idx)))
579 continue;
580
581 r = dev->resource + idx;
582 if (!r->start && r->end) {
583 printk(KERN_ERR "PCI: Device %s not available because"
584 " of resource collisions\n", pci_name(dev));
585 return -EINVAL;
586 }
587 if (r->flags & IORESOURCE_IO)
588 cmd |= PCI_COMMAND_IO;
589 if (r->flags & IORESOURCE_MEM)
590 cmd |= PCI_COMMAND_MEMORY;
591 }
592
593 /*
594 * Bridges (eg, cardbus bridges) need to be fully enabled
595 */
596 if ((dev->class >> 16) == PCI_BASE_CLASS_BRIDGE)
597 cmd |= PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
598
599 if (cmd != old_cmd) {
600 printk("PCI: enabling device %s (%04x -> %04x)\n",
601 pci_name(dev), old_cmd, cmd);
602 pci_write_config_word(dev, PCI_COMMAND, cmd);
603 }
604 return 0;
605}
606
607int pci_mmap_page_range(struct pci_dev *dev, struct vm_area_struct *vma,
608 enum pci_mmap_state mmap_state, int write_combine)
609{
610 struct pci_sys_data *root = dev->sysdata;
611 unsigned long phys;
612
613 if (mmap_state == pci_mmap_io) {
614 return -EINVAL;
615 } else {
616 phys = vma->vm_pgoff + (root->mem_offset >> PAGE_SHIFT);
617 }
618
619 /*
620 * Mark this as IO
621 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700622 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
623
624 if (remap_pfn_range(vma, vma->vm_start, phys,
625 vma->vm_end - vma->vm_start,
626 vma->vm_page_prot))
627 return -EAGAIN;
628
629 return 0;
630}
Rob Herringc2794432012-02-29 18:10:58 -0600631
632void __init pci_map_io_early(unsigned long pfn)
633{
634 struct map_desc pci_io_desc = {
635 .virtual = PCI_IO_VIRT_BASE,
636 .type = MT_DEVICE,
637 .length = SZ_64K,
638 };
639
640 pci_io_desc.pfn = pfn;
641 iotable_init(&pci_io_desc, 1);
642}