]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - arch/powerpc/platforms/powermac/pci.c
Merge branch 'release' of git://git.kernel.org/pub/scm/linux/kernel/git/lenb/linux...
[mirror_ubuntu-bionic-kernel.git] / arch / powerpc / platforms / powermac / pci.c
1 /*
2 * Support for PCI bridges found on Power Macintoshes.
3 *
4 * Copyright (C) 2003-2005 Benjamin Herrenschmuidt (benh@kernel.crashing.org)
5 * Copyright (C) 1997 Paul Mackerras (paulus@samba.org)
6 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * as published by the Free Software Foundation; either version
10 * 2 of the License, or (at your option) any later version.
11 */
12
13 #include <linux/kernel.h>
14 #include <linux/pci.h>
15 #include <linux/delay.h>
16 #include <linux/string.h>
17 #include <linux/init.h>
18 #include <linux/bootmem.h>
19
20 #include <asm/sections.h>
21 #include <asm/io.h>
22 #include <asm/prom.h>
23 #include <asm/pci-bridge.h>
24 #include <asm/machdep.h>
25 #include <asm/pmac_feature.h>
26 #include <asm/grackle.h>
27 #ifdef CONFIG_PPC64
28 //#include <asm/iommu.h>
29 #include <asm/ppc-pci.h>
30 #endif
31
32 #undef DEBUG
33
34 #ifdef DEBUG
35 #define DBG(x...) printk(x)
36 #else
37 #define DBG(x...)
38 #endif
39
40 static int add_bridge(struct device_node *dev);
41
42 /* XXX Could be per-controller, but I don't think we risk anything by
43 * assuming we won't have both UniNorth and Bandit */
44 static int has_uninorth;
45 #ifdef CONFIG_PPC64
46 static struct pci_controller *u3_agp;
47 static struct pci_controller *u4_pcie;
48 static struct pci_controller *u3_ht;
49 #define has_second_ohare 0
50 #else
51 static int has_second_ohare;
52 #endif /* CONFIG_PPC64 */
53
54 extern u8 pci_cache_line_size;
55 extern int pcibios_assign_bus_offset;
56
57 struct device_node *k2_skiplist[2];
58
59 /*
60 * Magic constants for enabling cache coherency in the bandit/PSX bridge.
61 */
62 #define BANDIT_DEVID_2 8
63 #define BANDIT_REVID 3
64
65 #define BANDIT_DEVNUM 11
66 #define BANDIT_MAGIC 0x50
67 #define BANDIT_COHERENT 0x40
68
69 static int __init fixup_one_level_bus_range(struct device_node *node, int higher)
70 {
71 for (; node != 0;node = node->sibling) {
72 int * bus_range;
73 unsigned int *class_code;
74 int len;
75
76 /* For PCI<->PCI bridges or CardBus bridges, we go down */
77 class_code = (unsigned int *) get_property(node, "class-code", NULL);
78 if (!class_code || ((*class_code >> 8) != PCI_CLASS_BRIDGE_PCI &&
79 (*class_code >> 8) != PCI_CLASS_BRIDGE_CARDBUS))
80 continue;
81 bus_range = (int *) get_property(node, "bus-range", &len);
82 if (bus_range != NULL && len > 2 * sizeof(int)) {
83 if (bus_range[1] > higher)
84 higher = bus_range[1];
85 }
86 higher = fixup_one_level_bus_range(node->child, higher);
87 }
88 return higher;
89 }
90
91 /* This routine fixes the "bus-range" property of all bridges in the
92 * system since they tend to have their "last" member wrong on macs
93 *
94 * Note that the bus numbers manipulated here are OF bus numbers, they
95 * are not Linux bus numbers.
96 */
97 static void __init fixup_bus_range(struct device_node *bridge)
98 {
99 int * bus_range;
100 int len;
101
102 /* Lookup the "bus-range" property for the hose */
103 bus_range = (int *) get_property(bridge, "bus-range", &len);
104 if (bus_range == NULL || len < 2 * sizeof(int))
105 return;
106 bus_range[1] = fixup_one_level_bus_range(bridge->child, bus_range[1]);
107 }
108
109 /*
110 * Apple MacRISC (U3, UniNorth, Bandit, Chaos) PCI controllers.
111 *
112 * The "Bandit" version is present in all early PCI PowerMacs,
113 * and up to the first ones using Grackle. Some machines may
114 * have 2 bandit controllers (2 PCI busses).
115 *
116 * "Chaos" is used in some "Bandit"-type machines as a bridge
117 * for the separate display bus. It is accessed the same
118 * way as bandit, but cannot be probed for devices. It therefore
119 * has its own config access functions.
120 *
121 * The "UniNorth" version is present in all Core99 machines
122 * (iBook, G4, new IMacs, and all the recent Apple machines).
123 * It contains 3 controllers in one ASIC.
124 *
125 * The U3 is the bridge used on G5 machines. It contains an
126 * AGP bus which is dealt with the old UniNorth access routines
127 * and a HyperTransport bus which uses its own set of access
128 * functions.
129 */
130
131 #define MACRISC_CFA0(devfn, off) \
132 ((1 << (unsigned int)PCI_SLOT(dev_fn)) \
133 | (((unsigned int)PCI_FUNC(dev_fn)) << 8) \
134 | (((unsigned int)(off)) & 0xFCUL))
135
136 #define MACRISC_CFA1(bus, devfn, off) \
137 ((((unsigned int)(bus)) << 16) \
138 |(((unsigned int)(devfn)) << 8) \
139 |(((unsigned int)(off)) & 0xFCUL) \
140 |1UL)
141
142 static volatile void __iomem *macrisc_cfg_access(struct pci_controller* hose,
143 u8 bus, u8 dev_fn, u8 offset)
144 {
145 unsigned int caddr;
146
147 if (bus == hose->first_busno) {
148 if (dev_fn < (11 << 3))
149 return NULL;
150 caddr = MACRISC_CFA0(dev_fn, offset);
151 } else
152 caddr = MACRISC_CFA1(bus, dev_fn, offset);
153
154 /* Uninorth will return garbage if we don't read back the value ! */
155 do {
156 out_le32(hose->cfg_addr, caddr);
157 } while (in_le32(hose->cfg_addr) != caddr);
158
159 offset &= has_uninorth ? 0x07 : 0x03;
160 return hose->cfg_data + offset;
161 }
162
163 static int macrisc_read_config(struct pci_bus *bus, unsigned int devfn,
164 int offset, int len, u32 *val)
165 {
166 struct pci_controller *hose;
167 volatile void __iomem *addr;
168
169 hose = pci_bus_to_host(bus);
170 if (hose == NULL)
171 return PCIBIOS_DEVICE_NOT_FOUND;
172 if (offset >= 0x100)
173 return PCIBIOS_BAD_REGISTER_NUMBER;
174 addr = macrisc_cfg_access(hose, bus->number, devfn, offset);
175 if (!addr)
176 return PCIBIOS_DEVICE_NOT_FOUND;
177 /*
178 * Note: the caller has already checked that offset is
179 * suitably aligned and that len is 1, 2 or 4.
180 */
181 switch (len) {
182 case 1:
183 *val = in_8(addr);
184 break;
185 case 2:
186 *val = in_le16(addr);
187 break;
188 default:
189 *val = in_le32(addr);
190 break;
191 }
192 return PCIBIOS_SUCCESSFUL;
193 }
194
195 static int macrisc_write_config(struct pci_bus *bus, unsigned int devfn,
196 int offset, int len, u32 val)
197 {
198 struct pci_controller *hose;
199 volatile void __iomem *addr;
200
201 hose = pci_bus_to_host(bus);
202 if (hose == NULL)
203 return PCIBIOS_DEVICE_NOT_FOUND;
204 if (offset >= 0x100)
205 return PCIBIOS_BAD_REGISTER_NUMBER;
206 addr = macrisc_cfg_access(hose, bus->number, devfn, offset);
207 if (!addr)
208 return PCIBIOS_DEVICE_NOT_FOUND;
209 /*
210 * Note: the caller has already checked that offset is
211 * suitably aligned and that len is 1, 2 or 4.
212 */
213 switch (len) {
214 case 1:
215 out_8(addr, val);
216 (void) in_8(addr);
217 break;
218 case 2:
219 out_le16(addr, val);
220 (void) in_le16(addr);
221 break;
222 default:
223 out_le32(addr, val);
224 (void) in_le32(addr);
225 break;
226 }
227 return PCIBIOS_SUCCESSFUL;
228 }
229
230 static struct pci_ops macrisc_pci_ops =
231 {
232 macrisc_read_config,
233 macrisc_write_config
234 };
235
236 #ifdef CONFIG_PPC32
237 /*
238 * Verify that a specific (bus, dev_fn) exists on chaos
239 */
240 static int chaos_validate_dev(struct pci_bus *bus, int devfn, int offset)
241 {
242 struct device_node *np;
243 u32 *vendor, *device;
244
245 if (offset >= 0x100)
246 return PCIBIOS_BAD_REGISTER_NUMBER;
247 np = pci_busdev_to_OF_node(bus, devfn);
248 if (np == NULL)
249 return PCIBIOS_DEVICE_NOT_FOUND;
250
251 vendor = (u32 *)get_property(np, "vendor-id", NULL);
252 device = (u32 *)get_property(np, "device-id", NULL);
253 if (vendor == NULL || device == NULL)
254 return PCIBIOS_DEVICE_NOT_FOUND;
255
256 if ((*vendor == 0x106b) && (*device == 3) && (offset >= 0x10)
257 && (offset != 0x14) && (offset != 0x18) && (offset <= 0x24))
258 return PCIBIOS_BAD_REGISTER_NUMBER;
259
260 return PCIBIOS_SUCCESSFUL;
261 }
262
263 static int
264 chaos_read_config(struct pci_bus *bus, unsigned int devfn, int offset,
265 int len, u32 *val)
266 {
267 int result = chaos_validate_dev(bus, devfn, offset);
268 if (result == PCIBIOS_BAD_REGISTER_NUMBER)
269 *val = ~0U;
270 if (result != PCIBIOS_SUCCESSFUL)
271 return result;
272 return macrisc_read_config(bus, devfn, offset, len, val);
273 }
274
275 static int
276 chaos_write_config(struct pci_bus *bus, unsigned int devfn, int offset,
277 int len, u32 val)
278 {
279 int result = chaos_validate_dev(bus, devfn, offset);
280 if (result != PCIBIOS_SUCCESSFUL)
281 return result;
282 return macrisc_write_config(bus, devfn, offset, len, val);
283 }
284
285 static struct pci_ops chaos_pci_ops =
286 {
287 chaos_read_config,
288 chaos_write_config
289 };
290
291 static void __init setup_chaos(struct pci_controller *hose,
292 struct resource *addr)
293 {
294 /* assume a `chaos' bridge */
295 hose->ops = &chaos_pci_ops;
296 hose->cfg_addr = ioremap(addr->start + 0x800000, 0x1000);
297 hose->cfg_data = ioremap(addr->start + 0xc00000, 0x1000);
298 }
299 #endif /* CONFIG_PPC32 */
300
301 #ifdef CONFIG_PPC64
302 /*
303 * These versions of U3 HyperTransport config space access ops do not
304 * implement self-view of the HT host yet
305 */
306
307 /*
308 * This function deals with some "special cases" devices.
309 *
310 * 0 -> No special case
311 * 1 -> Skip the device but act as if the access was successfull
312 * (return 0xff's on reads, eventually, cache config space
313 * accesses in a later version)
314 * -1 -> Hide the device (unsuccessful acess)
315 */
316 static int u3_ht_skip_device(struct pci_controller *hose,
317 struct pci_bus *bus, unsigned int devfn)
318 {
319 struct device_node *busdn, *dn;
320 int i;
321
322 /* We only allow config cycles to devices that are in OF device-tree
323 * as we are apparently having some weird things going on with some
324 * revs of K2 on recent G5s
325 */
326 if (bus->self)
327 busdn = pci_device_to_OF_node(bus->self);
328 else
329 busdn = hose->arch_data;
330 for (dn = busdn->child; dn; dn = dn->sibling)
331 if (PCI_DN(dn) && PCI_DN(dn)->devfn == devfn)
332 break;
333 if (dn == NULL)
334 return -1;
335
336 /*
337 * When a device in K2 is powered down, we die on config
338 * cycle accesses. Fix that here.
339 */
340 for (i=0; i<2; i++)
341 if (k2_skiplist[i] == dn)
342 return 1;
343
344 return 0;
345 }
346
347 #define U3_HT_CFA0(devfn, off) \
348 ((((unsigned int)devfn) << 8) | offset)
349 #define U3_HT_CFA1(bus, devfn, off) \
350 (U3_HT_CFA0(devfn, off) \
351 + (((unsigned int)bus) << 16) \
352 + 0x01000000UL)
353
354 static volatile void __iomem *u3_ht_cfg_access(struct pci_controller* hose,
355 u8 bus, u8 devfn, u8 offset)
356 {
357 if (bus == hose->first_busno) {
358 /* For now, we don't self probe U3 HT bridge */
359 if (PCI_SLOT(devfn) == 0)
360 return NULL;
361 return hose->cfg_data + U3_HT_CFA0(devfn, offset);
362 } else
363 return hose->cfg_data + U3_HT_CFA1(bus, devfn, offset);
364 }
365
366 static int u3_ht_read_config(struct pci_bus *bus, unsigned int devfn,
367 int offset, int len, u32 *val)
368 {
369 struct pci_controller *hose;
370 volatile void __iomem *addr;
371
372 hose = pci_bus_to_host(bus);
373 if (hose == NULL)
374 return PCIBIOS_DEVICE_NOT_FOUND;
375 if (offset >= 0x100)
376 return PCIBIOS_BAD_REGISTER_NUMBER;
377 addr = u3_ht_cfg_access(hose, bus->number, devfn, offset);
378 if (!addr)
379 return PCIBIOS_DEVICE_NOT_FOUND;
380
381 switch (u3_ht_skip_device(hose, bus, devfn)) {
382 case 0:
383 break;
384 case 1:
385 switch (len) {
386 case 1:
387 *val = 0xff; break;
388 case 2:
389 *val = 0xffff; break;
390 default:
391 *val = 0xfffffffful; break;
392 }
393 return PCIBIOS_SUCCESSFUL;
394 default:
395 return PCIBIOS_DEVICE_NOT_FOUND;
396 }
397
398 /*
399 * Note: the caller has already checked that offset is
400 * suitably aligned and that len is 1, 2 or 4.
401 */
402 switch (len) {
403 case 1:
404 *val = in_8(addr);
405 break;
406 case 2:
407 *val = in_le16(addr);
408 break;
409 default:
410 *val = in_le32(addr);
411 break;
412 }
413 return PCIBIOS_SUCCESSFUL;
414 }
415
416 static int u3_ht_write_config(struct pci_bus *bus, unsigned int devfn,
417 int offset, int len, u32 val)
418 {
419 struct pci_controller *hose;
420 volatile void __iomem *addr;
421
422 hose = pci_bus_to_host(bus);
423 if (hose == NULL)
424 return PCIBIOS_DEVICE_NOT_FOUND;
425 if (offset >= 0x100)
426 return PCIBIOS_BAD_REGISTER_NUMBER;
427 addr = u3_ht_cfg_access(hose, bus->number, devfn, offset);
428 if (!addr)
429 return PCIBIOS_DEVICE_NOT_FOUND;
430
431 switch (u3_ht_skip_device(hose, bus, devfn)) {
432 case 0:
433 break;
434 case 1:
435 return PCIBIOS_SUCCESSFUL;
436 default:
437 return PCIBIOS_DEVICE_NOT_FOUND;
438 }
439
440 /*
441 * Note: the caller has already checked that offset is
442 * suitably aligned and that len is 1, 2 or 4.
443 */
444 switch (len) {
445 case 1:
446 out_8(addr, val);
447 (void) in_8(addr);
448 break;
449 case 2:
450 out_le16(addr, val);
451 (void) in_le16(addr);
452 break;
453 default:
454 out_le32((u32 __iomem *)addr, val);
455 (void) in_le32(addr);
456 break;
457 }
458 return PCIBIOS_SUCCESSFUL;
459 }
460
461 static struct pci_ops u3_ht_pci_ops =
462 {
463 u3_ht_read_config,
464 u3_ht_write_config
465 };
466
467 #define U4_PCIE_CFA0(devfn, off) \
468 ((1 << ((unsigned int)PCI_SLOT(dev_fn))) \
469 | (((unsigned int)PCI_FUNC(dev_fn)) << 8) \
470 | ((((unsigned int)(off)) >> 8) << 28) \
471 | (((unsigned int)(off)) & 0xfcU))
472
473 #define U4_PCIE_CFA1(bus, devfn, off) \
474 ((((unsigned int)(bus)) << 16) \
475 |(((unsigned int)(devfn)) << 8) \
476 | ((((unsigned int)(off)) >> 8) << 28) \
477 |(((unsigned int)(off)) & 0xfcU) \
478 |1UL)
479
480 static volatile void __iomem *u4_pcie_cfg_access(struct pci_controller* hose,
481 u8 bus, u8 dev_fn, int offset)
482 {
483 unsigned int caddr;
484
485 if (bus == hose->first_busno) {
486 caddr = U4_PCIE_CFA0(dev_fn, offset);
487 } else
488 caddr = U4_PCIE_CFA1(bus, dev_fn, offset);
489
490 /* Uninorth will return garbage if we don't read back the value ! */
491 do {
492 out_le32(hose->cfg_addr, caddr);
493 } while (in_le32(hose->cfg_addr) != caddr);
494
495 offset &= 0x03;
496 return hose->cfg_data + offset;
497 }
498
499 static int u4_pcie_read_config(struct pci_bus *bus, unsigned int devfn,
500 int offset, int len, u32 *val)
501 {
502 struct pci_controller *hose;
503 volatile void __iomem *addr;
504
505 hose = pci_bus_to_host(bus);
506 if (hose == NULL)
507 return PCIBIOS_DEVICE_NOT_FOUND;
508 if (offset >= 0x1000)
509 return PCIBIOS_BAD_REGISTER_NUMBER;
510 addr = u4_pcie_cfg_access(hose, bus->number, devfn, offset);
511 if (!addr)
512 return PCIBIOS_DEVICE_NOT_FOUND;
513 /*
514 * Note: the caller has already checked that offset is
515 * suitably aligned and that len is 1, 2 or 4.
516 */
517 switch (len) {
518 case 1:
519 *val = in_8(addr);
520 break;
521 case 2:
522 *val = in_le16(addr);
523 break;
524 default:
525 *val = in_le32(addr);
526 break;
527 }
528 return PCIBIOS_SUCCESSFUL;
529 }
530
531 static int u4_pcie_write_config(struct pci_bus *bus, unsigned int devfn,
532 int offset, int len, u32 val)
533 {
534 struct pci_controller *hose;
535 volatile void __iomem *addr;
536
537 hose = pci_bus_to_host(bus);
538 if (hose == NULL)
539 return PCIBIOS_DEVICE_NOT_FOUND;
540 if (offset >= 0x1000)
541 return PCIBIOS_BAD_REGISTER_NUMBER;
542 addr = u4_pcie_cfg_access(hose, bus->number, devfn, offset);
543 if (!addr)
544 return PCIBIOS_DEVICE_NOT_FOUND;
545 /*
546 * Note: the caller has already checked that offset is
547 * suitably aligned and that len is 1, 2 or 4.
548 */
549 switch (len) {
550 case 1:
551 out_8(addr, val);
552 (void) in_8(addr);
553 break;
554 case 2:
555 out_le16(addr, val);
556 (void) in_le16(addr);
557 break;
558 default:
559 out_le32(addr, val);
560 (void) in_le32(addr);
561 break;
562 }
563 return PCIBIOS_SUCCESSFUL;
564 }
565
566 static struct pci_ops u4_pcie_pci_ops =
567 {
568 u4_pcie_read_config,
569 u4_pcie_write_config
570 };
571
572 #endif /* CONFIG_PPC64 */
573
574 #ifdef CONFIG_PPC32
575 /*
576 * For a bandit bridge, turn on cache coherency if necessary.
577 * N.B. we could clean this up using the hose ops directly.
578 */
579 static void __init init_bandit(struct pci_controller *bp)
580 {
581 unsigned int vendev, magic;
582 int rev;
583
584 /* read the word at offset 0 in config space for device 11 */
585 out_le32(bp->cfg_addr, (1UL << BANDIT_DEVNUM) + PCI_VENDOR_ID);
586 udelay(2);
587 vendev = in_le32(bp->cfg_data);
588 if (vendev == (PCI_DEVICE_ID_APPLE_BANDIT << 16) +
589 PCI_VENDOR_ID_APPLE) {
590 /* read the revision id */
591 out_le32(bp->cfg_addr,
592 (1UL << BANDIT_DEVNUM) + PCI_REVISION_ID);
593 udelay(2);
594 rev = in_8(bp->cfg_data);
595 if (rev != BANDIT_REVID)
596 printk(KERN_WARNING
597 "Unknown revision %d for bandit\n", rev);
598 } else if (vendev != (BANDIT_DEVID_2 << 16) + PCI_VENDOR_ID_APPLE) {
599 printk(KERN_WARNING "bandit isn't? (%x)\n", vendev);
600 return;
601 }
602
603 /* read the word at offset 0x50 */
604 out_le32(bp->cfg_addr, (1UL << BANDIT_DEVNUM) + BANDIT_MAGIC);
605 udelay(2);
606 magic = in_le32(bp->cfg_data);
607 if ((magic & BANDIT_COHERENT) != 0)
608 return;
609 magic |= BANDIT_COHERENT;
610 udelay(2);
611 out_le32(bp->cfg_data, magic);
612 printk(KERN_INFO "Cache coherency enabled for bandit/PSX\n");
613 }
614
615 /*
616 * Tweak the PCI-PCI bridge chip on the blue & white G3s.
617 */
618 static void __init init_p2pbridge(void)
619 {
620 struct device_node *p2pbridge;
621 struct pci_controller* hose;
622 u8 bus, devfn;
623 u16 val;
624
625 /* XXX it would be better here to identify the specific
626 PCI-PCI bridge chip we have. */
627 if ((p2pbridge = find_devices("pci-bridge")) == 0
628 || p2pbridge->parent == NULL
629 || strcmp(p2pbridge->parent->name, "pci") != 0)
630 return;
631 if (pci_device_from_OF_node(p2pbridge, &bus, &devfn) < 0) {
632 DBG("Can't find PCI infos for PCI<->PCI bridge\n");
633 return;
634 }
635 /* Warning: At this point, we have not yet renumbered all busses.
636 * So we must use OF walking to find out hose
637 */
638 hose = pci_find_hose_for_OF_device(p2pbridge);
639 if (!hose) {
640 DBG("Can't find hose for PCI<->PCI bridge\n");
641 return;
642 }
643 if (early_read_config_word(hose, bus, devfn,
644 PCI_BRIDGE_CONTROL, &val) < 0) {
645 printk(KERN_ERR "init_p2pbridge: couldn't read bridge"
646 " control\n");
647 return;
648 }
649 val &= ~PCI_BRIDGE_CTL_MASTER_ABORT;
650 early_write_config_word(hose, bus, devfn, PCI_BRIDGE_CONTROL, val);
651 }
652
653 static void __init init_second_ohare(void)
654 {
655 struct device_node *np = of_find_node_by_name(NULL, "pci106b,7");
656 unsigned char bus, devfn;
657 unsigned short cmd;
658
659 if (np == NULL)
660 return;
661
662 /* This must run before we initialize the PICs since the second
663 * ohare hosts a PIC that will be accessed there.
664 */
665 if (pci_device_from_OF_node(np, &bus, &devfn) == 0) {
666 struct pci_controller* hose =
667 pci_find_hose_for_OF_device(np);
668 if (!hose) {
669 printk(KERN_ERR "Can't find PCI hose for OHare2 !\n");
670 return;
671 }
672 early_read_config_word(hose, bus, devfn, PCI_COMMAND, &cmd);
673 cmd |= PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER;
674 cmd &= ~PCI_COMMAND_IO;
675 early_write_config_word(hose, bus, devfn, PCI_COMMAND, cmd);
676 }
677 has_second_ohare = 1;
678 }
679
680 /*
681 * Some Apple desktop machines have a NEC PD720100A USB2 controller
682 * on the motherboard. Open Firmware, on these, will disable the
683 * EHCI part of it so it behaves like a pair of OHCI's. This fixup
684 * code re-enables it ;)
685 */
686 static void __init fixup_nec_usb2(void)
687 {
688 struct device_node *nec;
689
690 for (nec = NULL; (nec = of_find_node_by_name(nec, "usb")) != NULL;) {
691 struct pci_controller *hose;
692 u32 data, *prop;
693 u8 bus, devfn;
694
695 prop = (u32 *)get_property(nec, "vendor-id", NULL);
696 if (prop == NULL)
697 continue;
698 if (0x1033 != *prop)
699 continue;
700 prop = (u32 *)get_property(nec, "device-id", NULL);
701 if (prop == NULL)
702 continue;
703 if (0x0035 != *prop)
704 continue;
705 prop = (u32 *)get_property(nec, "reg", NULL);
706 if (prop == NULL)
707 continue;
708 devfn = (prop[0] >> 8) & 0xff;
709 bus = (prop[0] >> 16) & 0xff;
710 if (PCI_FUNC(devfn) != 0)
711 continue;
712 hose = pci_find_hose_for_OF_device(nec);
713 if (!hose)
714 continue;
715 early_read_config_dword(hose, bus, devfn, 0xe4, &data);
716 if (data & 1UL) {
717 printk("Found NEC PD720100A USB2 chip with disabled"
718 " EHCI, fixing up...\n");
719 data &= ~1UL;
720 early_write_config_dword(hose, bus, devfn, 0xe4, data);
721 }
722 }
723 }
724
725 static void __init setup_bandit(struct pci_controller *hose,
726 struct resource *addr)
727 {
728 hose->ops = &macrisc_pci_ops;
729 hose->cfg_addr = ioremap(addr->start + 0x800000, 0x1000);
730 hose->cfg_data = ioremap(addr->start + 0xc00000, 0x1000);
731 init_bandit(hose);
732 }
733
734 static int __init setup_uninorth(struct pci_controller *hose,
735 struct resource *addr)
736 {
737 pci_assign_all_buses = 1;
738 has_uninorth = 1;
739 hose->ops = &macrisc_pci_ops;
740 hose->cfg_addr = ioremap(addr->start + 0x800000, 0x1000);
741 hose->cfg_data = ioremap(addr->start + 0xc00000, 0x1000);
742 /* We "know" that the bridge at f2000000 has the PCI slots. */
743 return addr->start == 0xf2000000;
744 }
745 #endif /* CONFIG_PPC32 */
746
747 #ifdef CONFIG_PPC64
748 static void __init setup_u3_agp(struct pci_controller* hose)
749 {
750 /* On G5, we move AGP up to high bus number so we don't need
751 * to reassign bus numbers for HT. If we ever have P2P bridges
752 * on AGP, we'll have to move pci_assign_all_busses to the
753 * pci_controller structure so we enable it for AGP and not for
754 * HT childs.
755 * We hard code the address because of the different size of
756 * the reg address cell, we shall fix that by killing struct
757 * reg_property and using some accessor functions instead
758 */
759 hose->first_busno = 0xf0;
760 hose->last_busno = 0xff;
761 has_uninorth = 1;
762 hose->ops = &macrisc_pci_ops;
763 hose->cfg_addr = ioremap(0xf0000000 + 0x800000, 0x1000);
764 hose->cfg_data = ioremap(0xf0000000 + 0xc00000, 0x1000);
765 u3_agp = hose;
766 }
767
768 static void __init setup_u4_pcie(struct pci_controller* hose)
769 {
770 /* We currently only implement the "non-atomic" config space, to
771 * be optimised later.
772 */
773 hose->ops = &u4_pcie_pci_ops;
774 hose->cfg_addr = ioremap(0xf0000000 + 0x800000, 0x1000);
775 hose->cfg_data = ioremap(0xf0000000 + 0xc00000, 0x1000);
776
777 /* The bus contains a bridge from root -> device, we need to
778 * make it visible on bus 0 so that we pick the right type
779 * of config cycles. If we didn't, we would have to force all
780 * config cycles to be type 1. So we override the "bus-range"
781 * property here
782 */
783 hose->first_busno = 0x00;
784 hose->last_busno = 0xff;
785 u4_pcie = hose;
786 }
787
788 static void __init setup_u3_ht(struct pci_controller* hose)
789 {
790 struct device_node *np = (struct device_node *)hose->arch_data;
791 struct pci_controller *other = NULL;
792 int i, cur;
793
794
795 hose->ops = &u3_ht_pci_ops;
796
797 /* We hard code the address because of the different size of
798 * the reg address cell, we shall fix that by killing struct
799 * reg_property and using some accessor functions instead
800 */
801 hose->cfg_data = ioremap(0xf2000000, 0x02000000);
802
803 /*
804 * /ht node doesn't expose a "ranges" property, so we "remove"
805 * regions that have been allocated to AGP. So far, this version of
806 * the code doesn't assign any of the 0xfxxxxxxx "fine" memory regions
807 * to /ht. We need to fix that sooner or later by either parsing all
808 * child "ranges" properties or figuring out the U3 address space
809 * decoding logic and then read its configuration register (if any).
810 */
811 hose->io_base_phys = 0xf4000000;
812 hose->pci_io_size = 0x00400000;
813 hose->io_resource.name = np->full_name;
814 hose->io_resource.start = 0;
815 hose->io_resource.end = 0x003fffff;
816 hose->io_resource.flags = IORESOURCE_IO;
817 hose->pci_mem_offset = 0;
818 hose->first_busno = 0;
819 hose->last_busno = 0xef;
820 hose->mem_resources[0].name = np->full_name;
821 hose->mem_resources[0].start = 0x80000000;
822 hose->mem_resources[0].end = 0xefffffff;
823 hose->mem_resources[0].flags = IORESOURCE_MEM;
824
825 u3_ht = hose;
826
827 if (u3_agp != NULL)
828 other = u3_agp;
829 else if (u4_pcie != NULL)
830 other = u4_pcie;
831
832 if (other == NULL) {
833 DBG("U3/4 has no AGP/PCIE, using full resource range\n");
834 return;
835 }
836
837 /* Fixup bus range vs. PCIE */
838 if (u4_pcie)
839 hose->last_busno = u4_pcie->first_busno - 1;
840
841 /* We "remove" the AGP resources from the resources allocated to HT,
842 * that is we create "holes". However, that code does assumptions
843 * that so far happen to be true (cross fingers...), typically that
844 * resources in the AGP node are properly ordered
845 */
846 cur = 0;
847 for (i=0; i<3; i++) {
848 struct resource *res = &other->mem_resources[i];
849 if (res->flags != IORESOURCE_MEM)
850 continue;
851 /* We don't care about "fine" resources */
852 if (res->start >= 0xf0000000)
853 continue;
854 /* Check if it's just a matter of "shrinking" us in one
855 * direction
856 */
857 if (hose->mem_resources[cur].start == res->start) {
858 DBG("U3/HT: shrink start of %d, %08lx -> %08lx\n",
859 cur, hose->mem_resources[cur].start,
860 res->end + 1);
861 hose->mem_resources[cur].start = res->end + 1;
862 continue;
863 }
864 if (hose->mem_resources[cur].end == res->end) {
865 DBG("U3/HT: shrink end of %d, %08lx -> %08lx\n",
866 cur, hose->mem_resources[cur].end,
867 res->start - 1);
868 hose->mem_resources[cur].end = res->start - 1;
869 continue;
870 }
871 /* No, it's not the case, we need a hole */
872 if (cur == 2) {
873 /* not enough resources for a hole, we drop part
874 * of the range
875 */
876 printk(KERN_WARNING "Running out of resources"
877 " for /ht host !\n");
878 hose->mem_resources[cur].end = res->start - 1;
879 continue;
880 }
881 cur++;
882 DBG("U3/HT: hole, %d end at %08lx, %d start at %08lx\n",
883 cur-1, res->start - 1, cur, res->end + 1);
884 hose->mem_resources[cur].name = np->full_name;
885 hose->mem_resources[cur].flags = IORESOURCE_MEM;
886 hose->mem_resources[cur].start = res->end + 1;
887 hose->mem_resources[cur].end = hose->mem_resources[cur-1].end;
888 hose->mem_resources[cur-1].end = res->start - 1;
889 }
890 }
891 #endif /* CONFIG_PPC64 */
892
893 /*
894 * We assume that if we have a G3 powermac, we have one bridge called
895 * "pci" (a MPC106) and no bandit or chaos bridges, and contrariwise,
896 * if we have one or more bandit or chaos bridges, we don't have a MPC106.
897 */
898 static int __init add_bridge(struct device_node *dev)
899 {
900 int len;
901 struct pci_controller *hose;
902 struct resource rsrc;
903 char *disp_name;
904 int *bus_range;
905 int primary = 1, has_address = 0;
906
907 DBG("Adding PCI host bridge %s\n", dev->full_name);
908
909 /* Fetch host bridge registers address */
910 has_address = (of_address_to_resource(dev, 0, &rsrc) == 0);
911
912 /* Get bus range if any */
913 bus_range = (int *) get_property(dev, "bus-range", &len);
914 if (bus_range == NULL || len < 2 * sizeof(int)) {
915 printk(KERN_WARNING "Can't get bus-range for %s, assume"
916 " bus 0\n", dev->full_name);
917 }
918
919 /* XXX Different prototypes, to be merged */
920 #ifdef CONFIG_PPC64
921 hose = pcibios_alloc_controller(dev);
922 #else
923 hose = pcibios_alloc_controller();
924 #endif
925 if (!hose)
926 return -ENOMEM;
927 hose->arch_data = dev;
928 hose->first_busno = bus_range ? bus_range[0] : 0;
929 hose->last_busno = bus_range ? bus_range[1] : 0xff;
930
931 disp_name = NULL;
932
933 /* 64 bits only bridges */
934 #ifdef CONFIG_PPC64
935 if (device_is_compatible(dev, "u3-agp")) {
936 setup_u3_agp(hose);
937 disp_name = "U3-AGP";
938 primary = 0;
939 } else if (device_is_compatible(dev, "u3-ht")) {
940 setup_u3_ht(hose);
941 disp_name = "U3-HT";
942 primary = 1;
943 } else if (device_is_compatible(dev, "u4-pcie")) {
944 setup_u4_pcie(hose);
945 disp_name = "U4-PCIE";
946 primary = 0;
947 }
948 printk(KERN_INFO "Found %s PCI host bridge. Firmware bus number:"
949 " %d->%d\n", disp_name, hose->first_busno, hose->last_busno);
950 #endif /* CONFIG_PPC64 */
951
952 /* 32 bits only bridges */
953 #ifdef CONFIG_PPC32
954 if (device_is_compatible(dev, "uni-north")) {
955 primary = setup_uninorth(hose, &rsrc);
956 disp_name = "UniNorth";
957 } else if (strcmp(dev->name, "pci") == 0) {
958 /* XXX assume this is a mpc106 (grackle) */
959 setup_grackle(hose);
960 disp_name = "Grackle (MPC106)";
961 } else if (strcmp(dev->name, "bandit") == 0) {
962 setup_bandit(hose, &rsrc);
963 disp_name = "Bandit";
964 } else if (strcmp(dev->name, "chaos") == 0) {
965 setup_chaos(hose, &rsrc);
966 disp_name = "Chaos";
967 primary = 0;
968 }
969 printk(KERN_INFO "Found %s PCI host bridge at 0x%016llx. "
970 "Firmware bus number: %d->%d\n",
971 disp_name, (unsigned long long)rsrc.start, hose->first_busno,
972 hose->last_busno);
973 #endif /* CONFIG_PPC32 */
974
975 DBG(" ->Hose at 0x%p, cfg_addr=0x%p,cfg_data=0x%p\n",
976 hose, hose->cfg_addr, hose->cfg_data);
977
978 /* Interpret the "ranges" property */
979 /* This also maps the I/O region and sets isa_io/mem_base */
980 pci_process_bridge_OF_ranges(hose, dev, primary);
981
982 /* Fixup "bus-range" OF property */
983 fixup_bus_range(dev);
984
985 return 0;
986 }
987
988 void __init pmac_pcibios_fixup(void)
989 {
990 struct pci_dev* dev = NULL;
991
992 for_each_pci_dev(dev) {
993 /* Read interrupt from the device-tree */
994 pci_read_irq_line(dev);
995
996 /* Fixup interrupt for the modem/ethernet combo controller.
997 * on machines with a second ohare chip.
998 * The number in the device tree (27) is bogus (correct for
999 * the ethernet-only board but not the combo ethernet/modem
1000 * board). The real interrupt is 28 on the second controller
1001 * -> 28+32 = 60.
1002 */
1003 if (has_second_ohare &&
1004 dev->vendor == PCI_VENDOR_ID_DEC &&
1005 dev->device == PCI_DEVICE_ID_DEC_TULIP_PLUS)
1006 dev->irq = irq_create_mapping(NULL, 60, 0);
1007 }
1008 }
1009
1010 #ifdef CONFIG_PPC64
1011 static void __init pmac_fixup_phb_resources(void)
1012 {
1013 struct pci_controller *hose, *tmp;
1014
1015 list_for_each_entry_safe(hose, tmp, &hose_list, list_node) {
1016 printk(KERN_INFO "PCI Host %d, io start: %lx; io end: %lx\n",
1017 hose->global_number,
1018 hose->io_resource.start, hose->io_resource.end);
1019 }
1020 }
1021 #endif
1022
1023 void __init pmac_pci_init(void)
1024 {
1025 struct device_node *np, *root;
1026 struct device_node *ht = NULL;
1027
1028 root = of_find_node_by_path("/");
1029 if (root == NULL) {
1030 printk(KERN_CRIT "pmac_pci_init: can't find root "
1031 "of device tree\n");
1032 return;
1033 }
1034 for (np = NULL; (np = of_get_next_child(root, np)) != NULL;) {
1035 if (np->name == NULL)
1036 continue;
1037 if (strcmp(np->name, "bandit") == 0
1038 || strcmp(np->name, "chaos") == 0
1039 || strcmp(np->name, "pci") == 0) {
1040 if (add_bridge(np) == 0)
1041 of_node_get(np);
1042 }
1043 if (strcmp(np->name, "ht") == 0) {
1044 of_node_get(np);
1045 ht = np;
1046 }
1047 }
1048 of_node_put(root);
1049
1050 #ifdef CONFIG_PPC64
1051 /* Probe HT last as it relies on the agp resources to be already
1052 * setup
1053 */
1054 if (ht && add_bridge(ht) != 0)
1055 of_node_put(ht);
1056
1057 /*
1058 * We need to call pci_setup_phb_io for the HT bridge first
1059 * so it gets the I/O port numbers starting at 0, and we
1060 * need to call it for the AGP bridge after that so it gets
1061 * small positive I/O port numbers.
1062 */
1063 if (u3_ht)
1064 pci_setup_phb_io(u3_ht, 1);
1065 if (u3_agp)
1066 pci_setup_phb_io(u3_agp, 0);
1067 if (u4_pcie)
1068 pci_setup_phb_io(u4_pcie, 0);
1069
1070 /*
1071 * On ppc64, fixup the IO resources on our host bridges as
1072 * the common code does it only for children of the host bridges
1073 */
1074 pmac_fixup_phb_resources();
1075
1076 /* Setup the linkage between OF nodes and PHBs */
1077 pci_devs_phb_init();
1078
1079 /* Fixup the PCI<->OF mapping for U3 AGP due to bus renumbering. We
1080 * assume there is no P2P bridge on the AGP bus, which should be a
1081 * safe assumptions for now. We should do something better in the
1082 * future though
1083 */
1084 if (u3_agp) {
1085 struct device_node *np = u3_agp->arch_data;
1086 PCI_DN(np)->busno = 0xf0;
1087 for (np = np->child; np; np = np->sibling)
1088 PCI_DN(np)->busno = 0xf0;
1089 }
1090 /* pmac_check_ht_link(); */
1091
1092 /* Tell pci.c to not use the common resource allocation mechanism */
1093 pci_probe_only = 1;
1094
1095 #else /* CONFIG_PPC64 */
1096 init_p2pbridge();
1097 init_second_ohare();
1098 fixup_nec_usb2();
1099
1100 /* We are still having some issues with the Xserve G4, enabling
1101 * some offset between bus number and domains for now when we
1102 * assign all busses should help for now
1103 */
1104 if (pci_assign_all_buses)
1105 pcibios_assign_bus_offset = 0x10;
1106 #endif
1107 }
1108
1109 int
1110 pmac_pci_enable_device_hook(struct pci_dev *dev, int initial)
1111 {
1112 struct device_node* node;
1113 int updatecfg = 0;
1114 int uninorth_child;
1115
1116 node = pci_device_to_OF_node(dev);
1117
1118 /* We don't want to enable USB controllers absent from the OF tree
1119 * (iBook second controller)
1120 */
1121 if (dev->vendor == PCI_VENDOR_ID_APPLE
1122 && dev->class == PCI_CLASS_SERIAL_USB_OHCI
1123 && !node) {
1124 printk(KERN_INFO "Apple USB OHCI %s disabled by firmware\n",
1125 pci_name(dev));
1126 return -EINVAL;
1127 }
1128
1129 if (!node)
1130 return 0;
1131
1132 uninorth_child = node->parent &&
1133 device_is_compatible(node->parent, "uni-north");
1134
1135 /* Firewire & GMAC were disabled after PCI probe, the driver is
1136 * claiming them, we must re-enable them now.
1137 */
1138 if (uninorth_child && !strcmp(node->name, "firewire") &&
1139 (device_is_compatible(node, "pci106b,18") ||
1140 device_is_compatible(node, "pci106b,30") ||
1141 device_is_compatible(node, "pci11c1,5811"))) {
1142 pmac_call_feature(PMAC_FTR_1394_CABLE_POWER, node, 0, 1);
1143 pmac_call_feature(PMAC_FTR_1394_ENABLE, node, 0, 1);
1144 updatecfg = 1;
1145 }
1146 if (uninorth_child && !strcmp(node->name, "ethernet") &&
1147 device_is_compatible(node, "gmac")) {
1148 pmac_call_feature(PMAC_FTR_GMAC_ENABLE, node, 0, 1);
1149 updatecfg = 1;
1150 }
1151
1152 if (updatecfg) {
1153 u16 cmd;
1154
1155 /*
1156 * Make sure PCI is correctly configured
1157 *
1158 * We use old pci_bios versions of the function since, by
1159 * default, gmac is not powered up, and so will be absent
1160 * from the kernel initial PCI lookup.
1161 *
1162 * Should be replaced by 2.4 new PCI mechanisms and really
1163 * register the device.
1164 */
1165 pci_read_config_word(dev, PCI_COMMAND, &cmd);
1166 cmd |= PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER
1167 | PCI_COMMAND_INVALIDATE;
1168 pci_write_config_word(dev, PCI_COMMAND, cmd);
1169 pci_write_config_byte(dev, PCI_LATENCY_TIMER, 16);
1170 pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE,
1171 L1_CACHE_BYTES >> 2);
1172 }
1173
1174 return 0;
1175 }
1176
1177 /* We power down some devices after they have been probed. They'll
1178 * be powered back on later on
1179 */
1180 void __init pmac_pcibios_after_init(void)
1181 {
1182 struct device_node* nd;
1183
1184 #ifdef CONFIG_BLK_DEV_IDE
1185 struct pci_dev *dev = NULL;
1186
1187 /* OF fails to initialize IDE controllers on macs
1188 * (and maybe other machines)
1189 *
1190 * Ideally, this should be moved to the IDE layer, but we need
1191 * to check specifically with Andre Hedrick how to do it cleanly
1192 * since the common IDE code seem to care about the fact that the
1193 * BIOS may have disabled a controller.
1194 *
1195 * -- BenH
1196 */
1197 for_each_pci_dev(dev) {
1198 if ((dev->class >> 16) == PCI_BASE_CLASS_STORAGE)
1199 pci_enable_device(dev);
1200 }
1201 #endif /* CONFIG_BLK_DEV_IDE */
1202
1203 nd = find_devices("firewire");
1204 while (nd) {
1205 if (nd->parent && (device_is_compatible(nd, "pci106b,18") ||
1206 device_is_compatible(nd, "pci106b,30") ||
1207 device_is_compatible(nd, "pci11c1,5811"))
1208 && device_is_compatible(nd->parent, "uni-north")) {
1209 pmac_call_feature(PMAC_FTR_1394_ENABLE, nd, 0, 0);
1210 pmac_call_feature(PMAC_FTR_1394_CABLE_POWER, nd, 0, 0);
1211 }
1212 nd = nd->next;
1213 }
1214 nd = find_devices("ethernet");
1215 while (nd) {
1216 if (nd->parent && device_is_compatible(nd, "gmac")
1217 && device_is_compatible(nd->parent, "uni-north"))
1218 pmac_call_feature(PMAC_FTR_GMAC_ENABLE, nd, 0, 0);
1219 nd = nd->next;
1220 }
1221 }
1222
1223 #ifdef CONFIG_PPC32
1224 void pmac_pci_fixup_cardbus(struct pci_dev* dev)
1225 {
1226 if (!machine_is(powermac))
1227 return;
1228 /*
1229 * Fix the interrupt routing on the various cardbus bridges
1230 * used on powerbooks
1231 */
1232 if (dev->vendor != PCI_VENDOR_ID_TI)
1233 return;
1234 if (dev->device == PCI_DEVICE_ID_TI_1130 ||
1235 dev->device == PCI_DEVICE_ID_TI_1131) {
1236 u8 val;
1237 /* Enable PCI interrupt */
1238 if (pci_read_config_byte(dev, 0x91, &val) == 0)
1239 pci_write_config_byte(dev, 0x91, val | 0x30);
1240 /* Disable ISA interrupt mode */
1241 if (pci_read_config_byte(dev, 0x92, &val) == 0)
1242 pci_write_config_byte(dev, 0x92, val & ~0x06);
1243 }
1244 if (dev->device == PCI_DEVICE_ID_TI_1210 ||
1245 dev->device == PCI_DEVICE_ID_TI_1211 ||
1246 dev->device == PCI_DEVICE_ID_TI_1410 ||
1247 dev->device == PCI_DEVICE_ID_TI_1510) {
1248 u8 val;
1249 /* 0x8c == TI122X_IRQMUX, 2 says to route the INTA
1250 signal out the MFUNC0 pin */
1251 if (pci_read_config_byte(dev, 0x8c, &val) == 0)
1252 pci_write_config_byte(dev, 0x8c, (val & ~0x0f) | 2);
1253 /* Disable ISA interrupt mode */
1254 if (pci_read_config_byte(dev, 0x92, &val) == 0)
1255 pci_write_config_byte(dev, 0x92, val & ~0x06);
1256 }
1257 }
1258
1259 DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_TI, PCI_ANY_ID, pmac_pci_fixup_cardbus);
1260
1261 void pmac_pci_fixup_pciata(struct pci_dev* dev)
1262 {
1263 u8 progif = 0;
1264
1265 /*
1266 * On PowerMacs, we try to switch any PCI ATA controller to
1267 * fully native mode
1268 */
1269 if (!machine_is(powermac))
1270 return;
1271
1272 /* Some controllers don't have the class IDE */
1273 if (dev->vendor == PCI_VENDOR_ID_PROMISE)
1274 switch(dev->device) {
1275 case PCI_DEVICE_ID_PROMISE_20246:
1276 case PCI_DEVICE_ID_PROMISE_20262:
1277 case PCI_DEVICE_ID_PROMISE_20263:
1278 case PCI_DEVICE_ID_PROMISE_20265:
1279 case PCI_DEVICE_ID_PROMISE_20267:
1280 case PCI_DEVICE_ID_PROMISE_20268:
1281 case PCI_DEVICE_ID_PROMISE_20269:
1282 case PCI_DEVICE_ID_PROMISE_20270:
1283 case PCI_DEVICE_ID_PROMISE_20271:
1284 case PCI_DEVICE_ID_PROMISE_20275:
1285 case PCI_DEVICE_ID_PROMISE_20276:
1286 case PCI_DEVICE_ID_PROMISE_20277:
1287 goto good;
1288 }
1289 /* Others, check PCI class */
1290 if ((dev->class >> 8) != PCI_CLASS_STORAGE_IDE)
1291 return;
1292 good:
1293 pci_read_config_byte(dev, PCI_CLASS_PROG, &progif);
1294 if ((progif & 5) != 5) {
1295 printk(KERN_INFO "Forcing PCI IDE into native mode: %s\n",
1296 pci_name(dev));
1297 (void) pci_write_config_byte(dev, PCI_CLASS_PROG, progif|5);
1298 if (pci_read_config_byte(dev, PCI_CLASS_PROG, &progif) ||
1299 (progif & 5) != 5)
1300 printk(KERN_ERR "Rewrite of PROGIF failed !\n");
1301 }
1302 }
1303 DECLARE_PCI_FIXUP_FINAL(PCI_ANY_ID, PCI_ANY_ID, pmac_pci_fixup_pciata);
1304 #endif
1305
1306 /*
1307 * Disable second function on K2-SATA, it's broken
1308 * and disable IO BARs on first one
1309 */
1310 static void fixup_k2_sata(struct pci_dev* dev)
1311 {
1312 int i;
1313 u16 cmd;
1314
1315 if (PCI_FUNC(dev->devfn) > 0) {
1316 pci_read_config_word(dev, PCI_COMMAND, &cmd);
1317 cmd &= ~(PCI_COMMAND_IO | PCI_COMMAND_MEMORY);
1318 pci_write_config_word(dev, PCI_COMMAND, cmd);
1319 for (i = 0; i < 6; i++) {
1320 dev->resource[i].start = dev->resource[i].end = 0;
1321 dev->resource[i].flags = 0;
1322 pci_write_config_dword(dev, PCI_BASE_ADDRESS_0 + 4 * i,
1323 0);
1324 }
1325 } else {
1326 pci_read_config_word(dev, PCI_COMMAND, &cmd);
1327 cmd &= ~PCI_COMMAND_IO;
1328 pci_write_config_word(dev, PCI_COMMAND, cmd);
1329 for (i = 0; i < 5; i++) {
1330 dev->resource[i].start = dev->resource[i].end = 0;
1331 dev->resource[i].flags = 0;
1332 pci_write_config_dword(dev, PCI_BASE_ADDRESS_0 + 4 * i,
1333 0);
1334 }
1335 }
1336 }
1337 DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_SERVERWORKS, 0x0240, fixup_k2_sata);
1338