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