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