arch/sparc64/kernel/pci_common.c

   1 /* $Id: pci_common.c,v 1.29 2002/02/01 00:56:03 davem Exp $
   2  * pci_common.c: PCI controller common support.
   3  *
   4  * Copyright (C) 1999 David S. Miller (davem@redhat.com)
   5  */
   6
   7 #include <linux/string.h>
   8 #include <linux/slab.h>
   9 #include <linux/init.h>
  10
  11 #include <asm/pbm.h>
  12
  13 /* Fix self device of BUS and hook it into BUS->self.
  14  * The pci_scan_bus does not do this for the host bridge.
  15  */
  16 void __init pci_fixup_host_bridge_self(struct pci_bus *pbus)
  17 {
  18         struct pci_dev *pdev;
  19
  20         list_for_each_entry(pdev, &pbus->devices, bus_list) {
  21                 if (pdev->class >> 8 == PCI_CLASS_BRIDGE_HOST) {
  22                         pbus->self = pdev;
  23                         return;
  24                 }
  25         }
  26
  27         prom_printf("PCI: Critical error, cannot find host bridge PDEV.\n");
  28         prom_halt();
  29 }
  30
  31 /* Find the OBP PROM device tree node for a PCI device.
  32  * Return zero if not found.
  33  */
  34 static int __init find_device_prom_node(struct pci_pbm_info *pbm,
  35                                         struct pci_dev *pdev,
  36                                         int bus_prom_node,
  37                                         struct linux_prom_pci_registers *pregs,
  38                                         int *nregs)
  39 {
  40         int node;
  41
  42         *nregs = 0;
  43
  44         /*
  45          * Return the PBM's PROM node in case we are it's PCI device,
  46          * as the PBM's reg property is different to standard PCI reg
  47          * properties. We would delete this device entry otherwise,
  48          * which confuses XFree86's device probing...
  49          */
  50         if ((pdev->bus->number == pbm->pci_bus->number) && (pdev->devfn == 0) &&
  51             (pdev->vendor == PCI_VENDOR_ID_SUN) &&
  52             (pdev->device == PCI_DEVICE_ID_SUN_PBM ||
  53              pdev->device == PCI_DEVICE_ID_SUN_SCHIZO ||
  54              pdev->device == PCI_DEVICE_ID_SUN_TOMATILLO ||
  55              pdev->device == PCI_DEVICE_ID_SUN_SABRE ||
  56              pdev->device == PCI_DEVICE_ID_SUN_HUMMINGBIRD))
  57                 return bus_prom_node;
  58
  59         node = prom_getchild(bus_prom_node);
  60         while (node != 0) {
  61                 int err = prom_getproperty(node, "reg",
  62                                            (char *)pregs,
  63                                            sizeof(*pregs) * PROMREG_MAX);
  64                 if (err == 0 || err == -1)
  65                         goto do_next_sibling;
  66                 if (((pregs[0].phys_hi >> 8) & 0xff) == pdev->devfn) {
  67                         *nregs = err / sizeof(*pregs);
  68                         return node;
  69                 }
  70
  71         do_next_sibling:
  72                 node = prom_getsibling(node);
  73         }
  74         return 0;
  75 }
  76
  77 /* Older versions of OBP on PCI systems encode 64-bit MEM
  78  * space assignments incorrectly, this fixes them up.  We also
  79  * take the opportunity here to hide other kinds of bogus
  80  * assignments.
  81  */
  82 static void __init fixup_obp_assignments(struct pci_dev *pdev,
  83                                          struct pcidev_cookie *pcp)
  84 {
  85         int i;
  86
  87         if (pdev->vendor == PCI_VENDOR_ID_AL &&
  88             (pdev->device == PCI_DEVICE_ID_AL_M7101 ||
  89              pdev->device == PCI_DEVICE_ID_AL_M1533)) {
  90                 int i;
  91
  92                 /* Zap all of the normal resources, they are
  93                  * meaningless and generate bogus resource collision
  94                  * messages.  This is OpenBoot's ill-fated attempt to
  95                  * represent the implicit resources that these devices
  96                  * have.
  97                  */
  98                 pcp->num_prom_assignments = 0;
  99                 for (i = 0; i < 6; i++) {
 100                         pdev->resource[i].start =
 101                                 pdev->resource[i].end =
 102                                 pdev->resource[i].flags = 0;
 103                 }
 104                 pdev->resource[PCI_ROM_RESOURCE].start =
 105                         pdev->resource[PCI_ROM_RESOURCE].end =
 106                         pdev->resource[PCI_ROM_RESOURCE].flags = 0;
 107                 return;
 108         }
 109
 110         for (i = 0; i < pcp->num_prom_assignments; i++) {
 111                 struct linux_prom_pci_registers *ap;
 112                 int space;
 113
 114                 ap = &pcp->prom_assignments[i];
 115                 space = ap->phys_hi >> 24;
 116                 if ((space & 0x3) == 2 &&
 117                     (space & 0x4) != 0) {
 118                         ap->phys_hi &= ~(0x7 << 24);
 119                         ap->phys_hi |= 0x3 << 24;
 120                 }
 121         }
 122 }
 123
 124 /* Fill in the PCI device cookie sysdata for the given
 125  * PCI device.  This cookie is the means by which one
 126  * can get to OBP and PCI controller specific information
 127  * for a PCI device.
 128  */
 129 static void __init pdev_cookie_fillin(struct pci_pbm_info *pbm,
 130                                       struct pci_dev *pdev,
 131                                       int bus_prom_node)
 132 {
 133         struct linux_prom_pci_registers pregs[PROMREG_MAX];
 134         struct pcidev_cookie *pcp;
 135         int device_prom_node, nregs, err;
 136
 137         device_prom_node = find_device_prom_node(pbm, pdev, bus_prom_node,
 138                                                  pregs, &nregs);
 139         if (device_prom_node == 0) {
 140                 /* If it is not in the OBP device tree then
 141                  * there must be a damn good reason for it.
 142                  *
 143                  * So what we do is delete the device from the
 144                  * PCI device tree completely.  This scenario
 145                  * is seen, for example, on CP1500 for the
 146                  * second EBUS/HappyMeal pair if the external
 147                  * connector for it is not present.
 148                  */
 149                 pci_remove_bus_device(pdev);
 150                 return;
 151         }
 152
 153         pcp = kmalloc(sizeof(*pcp), GFP_ATOMIC);
 154         if (pcp == NULL) {
 155                 prom_printf("PCI_COOKIE: Fatal malloc error, aborting...\n");
 156                 prom_halt();
 157         }
 158         pcp->pbm = pbm;
 159         pcp->prom_node = device_prom_node;
 160         memcpy(pcp->prom_regs, pregs, sizeof(pcp->prom_regs));
 161         pcp->num_prom_regs = nregs;
 162         err = prom_getproperty(device_prom_node, "name",
 163                                pcp->prom_name, sizeof(pcp->prom_name));
 164         if (err > 0)
 165                 pcp->prom_name[err] = 0;
 166         else
 167                 pcp->prom_name[0] = 0;
 168
 169         err = prom_getproperty(device_prom_node,
 170                                "assigned-addresses",
 171                                (char *)pcp->prom_assignments,
 172                                sizeof(pcp->prom_assignments));
 173         if (err == 0 || err == -1)
 174                 pcp->num_prom_assignments = 0;
 175         else
 176                 pcp->num_prom_assignments =
 177                         (err / sizeof(pcp->prom_assignments[0]));
 178
 179         if (strcmp(pcp->prom_name, "ebus") == 0) {
 180                 struct linux_prom_ebus_ranges erng[PROM_PCIRNG_MAX];
 181                 int iter;
 182
 183                 /* EBUS is special... */
 184                 err = prom_getproperty(device_prom_node, "ranges",
 185                                        (char *)&erng[0], sizeof(erng));
 186                 if (err == 0 || err == -1) {
 187                         prom_printf("EBUS: Fatal error, no range property\n");
 188                         prom_halt();
 189                 }
 190                 err = (err / sizeof(erng[0]));
 191                 for(iter = 0; iter < err; iter++) {
 192                         struct linux_prom_ebus_ranges *ep = &erng[iter];
 193                         struct linux_prom_pci_registers *ap;
 194
 195                         ap = &pcp->prom_assignments[iter];
 196
 197                         ap->phys_hi = ep->parent_phys_hi;
 198                         ap->phys_mid = ep->parent_phys_mid;
 199                         ap->phys_lo = ep->parent_phys_lo;
 200                         ap->size_hi = 0;
 201                         ap->size_lo = ep->size;
 202                 }
 203                 pcp->num_prom_assignments = err;
 204         }
 205
 206         fixup_obp_assignments(pdev, pcp);
 207
 208         pdev->sysdata = pcp;
 209 }
 210
 211 void __init pci_fill_in_pbm_cookies(struct pci_bus *pbus,
 212                                     struct pci_pbm_info *pbm,
 213                                     int prom_node)
 214 {
 215         struct pci_dev *pdev, *pdev_next;
 216         struct pci_bus *this_pbus, *pbus_next;
 217
 218         /* This must be _safe because the cookie fillin
 219            routine can delete devices from the tree.  */
 220         list_for_each_entry_safe(pdev, pdev_next, &pbus->devices, bus_list)
 221                 pdev_cookie_fillin(pbm, pdev, prom_node);
 222
 223         list_for_each_entry_safe(this_pbus, pbus_next, &pbus->children, node) {
 224                 struct pcidev_cookie *pcp = this_pbus->self->sysdata;
 225
 226                 pci_fill_in_pbm_cookies(this_pbus, pbm, pcp->prom_node);
 227         }
 228 }
 229
 230 static void __init bad_assignment(struct pci_dev *pdev,
 231                                   struct linux_prom_pci_registers *ap,
 232                                   struct resource *res,
 233                                   int do_prom_halt)
 234 {
 235         prom_printf("PCI: Bogus PROM assignment. BUS[%02x] DEVFN[%x]\n",
 236                     pdev->bus->number, pdev->devfn);
 237         if (ap)
 238                 prom_printf("PCI: phys[%08x:%08x:%08x] size[%08x:%08x]\n",
 239                             ap->phys_hi, ap->phys_mid, ap->phys_lo,
 240                             ap->size_hi, ap->size_lo);
 241         if (res)
 242                 prom_printf("PCI: RES[%016lx-->%016lx:(%lx)]\n",
 243                             res->start, res->end, res->flags);
 244         prom_printf("Please email this information to davem@redhat.com\n");
 245         if (do_prom_halt)
 246                 prom_halt();
 247 }
 248
 249 static struct resource *
 250 __init get_root_resource(struct linux_prom_pci_registers *ap,
 251                          struct pci_pbm_info *pbm)
 252 {
 253         int space = (ap->phys_hi >> 24) & 3;
 254
 255         switch (space) {
 256         case 0:
 257                 /* Configuration space, silently ignore it. */
 258                 return NULL;
 259
 260         case 1:
 261                 /* 16-bit IO space */
 262                 return &pbm->io_space;
 263
 264         case 2:
 265                 /* 32-bit MEM space */
 266                 return &pbm->mem_space;
 267
 268         case 3:
 269                 /* 64-bit MEM space, these are allocated out of
 270                  * the 32-bit mem_space range for the PBM, ie.
 271                  * we just zero out the upper 32-bits.
 272                  */
 273                 return &pbm->mem_space;
 274
 275         default:
 276                 printk("PCI: What is resource space %x? "
 277                        "Tell davem@redhat.com about it!\n", space);
 278                 return NULL;
 279         };
 280 }
 281
 282 static struct resource *
 283 __init get_device_resource(struct linux_prom_pci_registers *ap,
 284                            struct pci_dev *pdev)
 285 {
 286         struct resource *res;
 287         int breg = (ap->phys_hi & 0xff);
 288
 289         switch (breg) {
 290         case  PCI_ROM_ADDRESS:
 291                 /* Unfortunately I have seen several cases where
 292                  * buggy FCODE uses a space value of '1' (I/O space)
 293                  * in the register property for the ROM address
 294                  * so disable this sanity check for now.
 295                  */
 296 #if 0
 297         {
 298                 int space = (ap->phys_hi >> 24) & 3;
 299
 300                 /* It had better be MEM space. */
 301                 if (space != 2)
 302                         bad_assignment(pdev, ap, NULL, 0);
 303         }
 304 #endif
 305                 res = &pdev->resource[PCI_ROM_RESOURCE];
 306                 break;
 307
 308         case PCI_BASE_ADDRESS_0:
 309         case PCI_BASE_ADDRESS_1:
 310         case PCI_BASE_ADDRESS_2:
 311         case PCI_BASE_ADDRESS_3:
 312         case PCI_BASE_ADDRESS_4:
 313         case PCI_BASE_ADDRESS_5:
 314                 res = &pdev->resource[(breg - PCI_BASE_ADDRESS_0) / 4];
 315                 break;
 316
 317         default:
 318                 bad_assignment(pdev, ap, NULL, 0);
 319                 res = NULL;
 320                 break;
 321         };
 322
 323         return res;
 324 }
 325
 326 static int __init pdev_resource_collisions_expected(struct pci_dev *pdev)
 327 {
 328         if (pdev->vendor != PCI_VENDOR_ID_SUN)
 329                 return 0;
 330
 331         if (pdev->device == PCI_DEVICE_ID_SUN_RIO_EBUS ||
 332             pdev->device == PCI_DEVICE_ID_SUN_RIO_1394 ||
 333             pdev->device == PCI_DEVICE_ID_SUN_RIO_USB)
 334                 return 1;
 335
 336         return 0;
 337 }
 338
 339 static void __init pdev_record_assignments(struct pci_pbm_info *pbm,
 340                                            struct pci_dev *pdev)
 341 {
 342         struct pcidev_cookie *pcp = pdev->sysdata;
 343         int i;
 344
 345         for (i = 0; i < pcp->num_prom_assignments; i++) {
 346                 struct linux_prom_pci_registers *ap;
 347                 struct resource *root, *res;
 348
 349                 /* The format of this property is specified in
 350                  * the PCI Bus Binding to IEEE1275-1994.
 351                  */
 352                 ap = &pcp->prom_assignments[i];
 353                 root = get_root_resource(ap, pbm);
 354                 res = get_device_resource(ap, pdev);
 355                 if (root == NULL || res == NULL ||
 356                     res->flags == 0)
 357                         continue;
 358
 359                 /* Ok we know which resource this PROM assignment is
 360                  * for, sanity check it.
 361                  */
 362                 if ((res->start & 0xffffffffUL) != ap->phys_lo)
 363                         bad_assignment(pdev, ap, res, 1);
 364
 365                 /* If it is a 64-bit MEM space assignment, verify that
 366                  * the resource is too and that the upper 32-bits match.
 367                  */
 368                 if (((ap->phys_hi >> 24) & 3) == 3) {
 369                         if (((res->flags & IORESOURCE_MEM) == 0) ||
 370                             ((res->flags & PCI_BASE_ADDRESS_MEM_TYPE_MASK)
 371                              != PCI_BASE_ADDRESS_MEM_TYPE_64))
 372                                 bad_assignment(pdev, ap, res, 1);
 373                         if ((res->start >> 32) != ap->phys_mid)
 374                                 bad_assignment(pdev, ap, res, 1);
 375
 376                         /* PBM cannot generate cpu initiated PIOs
 377                          * to the full 64-bit space.  Therefore the
 378                          * upper 32-bits better be zero.  If it is
 379                          * not, just skip it and we will assign it
 380                          * properly ourselves.
 381                          */
 382                         if ((res->start >> 32) != 0UL) {
 383                                 printk(KERN_ERR "PCI: OBP assigns out of range MEM address "
 384                                        "%016lx for region %ld on device %s\n",
 385                                        res->start, (res - &pdev->resource[0]), pci_name(pdev));
 386                                 continue;
 387                         }
 388                 }
 389
 390                 /* Adjust the resource into the physical address space
 391                  * of this PBM.
 392                  */
 393                 pbm->parent->resource_adjust(pdev, res, root);
 394
 395                 if (request_resource(root, res) < 0) {
 396                         /* OK, there is some conflict.  But this is fine
 397                          * since we'll reassign it in the fixup pass.
 398                          *
 399                          * We notify the user that OBP made an error if it
 400                          * is a case we don't expect.
 401                          */
 402                         if (!pdev_resource_collisions_expected(pdev)) {
 403                                 printk(KERN_ERR "PCI: Address space collision on region %ld "
 404                                        "[%016lx:%016lx] of device %s\n",
 405                                        (res - &pdev->resource[0]),
 406                                        res->start, res->end,
 407                                        pci_name(pdev));
 408                         }
 409                 }
 410         }
 411 }
 412
 413 void __init pci_record_assignments(struct pci_pbm_info *pbm,
 414                                    struct pci_bus *pbus)
 415 {
 416         struct pci_dev *dev;
 417         struct pci_bus *bus;
 418
 419         list_for_each_entry(dev, &pbus->devices, bus_list)
 420                 pdev_record_assignments(pbm, dev);
 421
 422         list_for_each_entry(bus, &pbus->children, node)
 423                 pci_record_assignments(pbm, bus);
 424 }
 425
 426 /* Return non-zero if PDEV has implicit I/O resources even
 427  * though it may not have an I/O base address register
 428  * active.
 429  */
 430 static int __init has_implicit_io(struct pci_dev *pdev)
 431 {
 432         int class = pdev->class >> 8;
 433
 434         if (class == PCI_CLASS_NOT_DEFINED ||
 435             class == PCI_CLASS_NOT_DEFINED_VGA ||
 436             class == PCI_CLASS_STORAGE_IDE ||
 437             (pdev->class >> 16) == PCI_BASE_CLASS_DISPLAY)
 438                 return 1;
 439
 440         return 0;
 441 }
 442
 443 static void __init pdev_assign_unassigned(struct pci_pbm_info *pbm,
 444                                           struct pci_dev *pdev)
 445 {
 446         u32 reg;
 447         u16 cmd;
 448         int i, io_seen, mem_seen;
 449
 450         io_seen = mem_seen = 0;
 451         for (i = 0; i < PCI_NUM_RESOURCES; i++) {
 452                 struct resource *root, *res;
 453                 unsigned long size, min, max, align;
 454
 455                 res = &pdev->resource[i];
 456
 457                 if (res->flags & IORESOURCE_IO)
 458                         io_seen++;
 459                 else if (res->flags & IORESOURCE_MEM)
 460                         mem_seen++;
 461
 462                 /* If it is already assigned or the resource does
 463                  * not exist, there is nothing to do.
 464                  */
 465                 if (res->parent != NULL || res->flags == 0UL)
 466                         continue;
 467
 468                 /* Determine the root we allocate from. */
 469                 if (res->flags & IORESOURCE_IO) {
 470                         root = &pbm->io_space;
 471                         min = root->start + 0x400UL;
 472                         max = root->end;
 473                 } else {
 474                         root = &pbm->mem_space;
 475                         min = root->start;
 476                         max = min + 0x80000000UL;
 477                 }
 478
 479                 size = res->end - res->start;
 480                 align = size + 1;
 481                 if (allocate_resource(root, res, size + 1, min, max, align, NULL, NULL) < 0) {
 482                         /* uh oh */
 483                         prom_printf("PCI: Failed to allocate resource %d for %s\n",
 484                                     i, pci_name(pdev));
 485                         prom_halt();
 486                 }
 487
 488                 /* Update PCI config space. */
 489                 pbm->parent->base_address_update(pdev, i);
 490         }
 491
 492         /* Special case, disable the ROM.  Several devices
 493          * act funny (ie. do not respond to memory space writes)
 494          * when it is left enabled.  A good example are Qlogic,ISP
 495          * adapters.
 496          */
 497         pci_read_config_dword(pdev, PCI_ROM_ADDRESS, &reg);
 498         reg &= ~PCI_ROM_ADDRESS_ENABLE;
 499         pci_write_config_dword(pdev, PCI_ROM_ADDRESS, reg);
 500
 501         /* If we saw I/O or MEM resources, enable appropriate
 502          * bits in PCI command register.
 503          */
 504         if (io_seen || mem_seen) {
 505                 pci_read_config_word(pdev, PCI_COMMAND, &cmd);
 506                 if (io_seen || has_implicit_io(pdev))
 507                         cmd |= PCI_COMMAND_IO;
 508                 if (mem_seen)
 509                         cmd |= PCI_COMMAND_MEMORY;
 510                 pci_write_config_word(pdev, PCI_COMMAND, cmd);
 511         }
 512
 513         /* If this is a PCI bridge or an IDE controller,
 514          * enable bus mastering.  In the former case also
 515          * set the cache line size correctly.
 516          */
 517         if (((pdev->class >> 8) == PCI_CLASS_BRIDGE_PCI) ||
 518             (((pdev->class >> 8) == PCI_CLASS_STORAGE_IDE) &&
 519              ((pdev->class & 0x80) != 0))) {
 520                 pci_read_config_word(pdev, PCI_COMMAND, &cmd);
 521                 cmd |= PCI_COMMAND_MASTER;
 522                 pci_write_config_word(pdev, PCI_COMMAND, cmd);
 523
 524                 if ((pdev->class >> 8) == PCI_CLASS_BRIDGE_PCI)
 525                         pci_write_config_byte(pdev,
 526                                               PCI_CACHE_LINE_SIZE,
 527                                               (64 / sizeof(u32)));
 528         }
 529 }
 530
 531 void __init pci_assign_unassigned(struct pci_pbm_info *pbm,
 532                                   struct pci_bus *pbus)
 533 {
 534         struct pci_dev *dev;
 535         struct pci_bus *bus;
 536
 537         list_for_each_entry(dev, &pbus->devices, bus_list)
 538                 pdev_assign_unassigned(pbm, dev);
 539
 540         list_for_each_entry(bus, &pbus->children, node)
 541                 pci_assign_unassigned(pbm, bus);
 542 }
 543
 544 static inline unsigned int pci_slot_swivel(struct pci_pbm_info *pbm,
 545                                            struct pci_dev *toplevel_pdev,
 546                                            struct pci_dev *pdev,
 547                                            unsigned int interrupt)
 548 {
 549         unsigned int ret;
 550
 551         if (unlikely(interrupt < 1 || interrupt > 4)) {
 552                 printk("%s: Device %s interrupt value of %u is strange.\n",
 553                        pbm->name, pci_name(pdev), interrupt);
 554                 return interrupt;
 555         }
 556
 557         ret = ((interrupt - 1 + (PCI_SLOT(pdev->devfn) & 3)) & 3) + 1;
 558
 559         printk("%s: %s IRQ Swivel %s [%x:%x] -> [%x]\n",
 560                pbm->name, pci_name(toplevel_pdev), pci_name(pdev),
 561                interrupt, PCI_SLOT(pdev->devfn), ret);
 562
 563         return ret;
 564 }
 565
 566 static inline unsigned int pci_apply_intmap(struct pci_pbm_info *pbm,
 567                                             struct pci_dev *toplevel_pdev,
 568                                             struct pci_dev *pbus,
 569                                             struct pci_dev *pdev,
 570                                             unsigned int interrupt,
 571                                             unsigned int *cnode)
 572 {
 573         struct linux_prom_pci_intmap imap[PROM_PCIIMAP_MAX];
 574         struct linux_prom_pci_intmask imask;
 575         struct pcidev_cookie *pbus_pcp = pbus->sysdata;
 576         struct pcidev_cookie *pdev_pcp = pdev->sysdata;
 577         struct linux_prom_pci_registers *pregs = pdev_pcp->prom_regs;
 578         int plen, num_imap, i;
 579         unsigned int hi, mid, lo, irq, orig_interrupt;
 580
 581         *cnode = pbus_pcp->prom_node;
 582
 583         plen = prom_getproperty(pbus_pcp->prom_node, "interrupt-map",
 584                                 (char *) &imap[0], sizeof(imap));
 585         if (plen <= 0 ||
 586             (plen % sizeof(struct linux_prom_pci_intmap)) != 0) {
 587                 printk("%s: Device %s interrupt-map has bad len %d\n",
 588                        pbm->name, pci_name(pbus), plen);
 589                 goto no_intmap;
 590         }
 591         num_imap = plen / sizeof(struct linux_prom_pci_intmap);
 592
 593         plen = prom_getproperty(pbus_pcp->prom_node, "interrupt-map-mask",
 594                                 (char *) &imask, sizeof(imask));
 595         if (plen <= 0 ||
 596             (plen % sizeof(struct linux_prom_pci_intmask)) != 0) {
 597                 printk("%s: Device %s interrupt-map-mask has bad len %d\n",
 598                        pbm->name, pci_name(pbus), plen);
 599                 goto no_intmap;
 600         }
 601
 602         orig_interrupt = interrupt;
 603
 604         hi   = pregs->phys_hi & imask.phys_hi;
 605         mid  = pregs->phys_mid & imask.phys_mid;
 606         lo   = pregs->phys_lo & imask.phys_lo;
 607         irq  = interrupt & imask.interrupt;
 608
 609         for (i = 0; i < num_imap; i++) {
 610                 if (imap[i].phys_hi  == hi   &&
 611                     imap[i].phys_mid == mid  &&
 612                     imap[i].phys_lo  == lo   &&
 613                     imap[i].interrupt == irq) {
 614                         *cnode = imap[i].cnode;
 615                         interrupt = imap[i].cinterrupt;
 616                 }
 617         }
 618
 619         printk("%s: %s MAP BUS %s DEV %s [%x] -> [%x]\n",
 620                pbm->name, pci_name(toplevel_pdev),
 621                pci_name(pbus), pci_name(pdev),
 622                orig_interrupt, interrupt);
 623
 624 no_intmap:
 625         return interrupt;
 626 }
 627
 628 /* For each PCI bus on the way to the root:
 629  * 1) If it has an interrupt-map property, apply it.
 630  * 2) Else, swivel the interrupt number based upon the PCI device number.
 631  *
 632  * Return the "IRQ controller" node.  If this is the PBM's device node,
 633  * all interrupt translations are complete, else we should use that node's
 634  * "reg" property to apply the PBM's "interrupt-{map,mask}" to the interrupt.
 635  */
 636 static unsigned int __init pci_intmap_match_to_root(struct pci_pbm_info *pbm,
 637                                                     struct pci_dev *pdev,
 638                                                     unsigned int *interrupt)
 639 {
 640         struct pci_dev *toplevel_pdev = pdev;
 641         struct pcidev_cookie *toplevel_pcp = toplevel_pdev->sysdata;
 642         unsigned int cnode = toplevel_pcp->prom_node;
 643
 644         while (pdev->bus->number != pbm->pci_first_busno) {
 645                 struct pci_dev *pbus = pdev->bus->self;
 646                 struct pcidev_cookie *pcp = pbus->sysdata;
 647                 int plen;
 648
 649                 plen = prom_getproplen(pcp->prom_node, "interrupt-map");
 650                 if (plen <= 0) {
 651                         *interrupt = pci_slot_swivel(pbm, toplevel_pdev,
 652                                                      pdev, *interrupt);
 653                         cnode = pcp->prom_node;
 654                 } else {
 655                         *interrupt = pci_apply_intmap(pbm, toplevel_pdev,
 656                                                       pbus, pdev,
 657                                                       *interrupt, &cnode);
 658
 659                         while (pcp->prom_node != cnode &&
 660                                pbus->bus->number != pbm->pci_first_busno) {
 661                                 pbus = pbus->bus->self;
 662                                 pcp = pbus->sysdata;
 663                         }
 664                 }
 665                 pdev = pbus;
 666
 667                 if (cnode == pbm->prom_node)
 668                         break;
 669         }
 670
 671         return cnode;
 672 }
 673
 674 static int __init pci_intmap_match(struct pci_dev *pdev, unsigned int *interrupt)
 675 {
 676         struct pcidev_cookie *dev_pcp = pdev->sysdata;
 677         struct pci_pbm_info *pbm = dev_pcp->pbm;
 678         struct linux_prom_pci_registers reg[PROMREG_MAX];
 679         unsigned int hi, mid, lo, irq;
 680         int i, cnode, plen;
 681
 682         cnode = pci_intmap_match_to_root(pbm, pdev, interrupt);
 683         if (cnode == pbm->prom_node)
 684                 goto success;
 685
 686         plen = prom_getproperty(cnode, "reg", (char *) reg, sizeof(reg));
 687         if (plen <= 0 ||
 688             (plen % sizeof(struct linux_prom_pci_registers)) != 0) {
 689                 printk("%s: OBP node %x reg property has bad len %d\n",
 690                        pbm->name, cnode, plen);
 691                 goto fail;
 692         }
 693
 694         hi   = reg[0].phys_hi & pbm->pbm_intmask.phys_hi;
 695         mid  = reg[0].phys_mid & pbm->pbm_intmask.phys_mid;
 696         lo   = reg[0].phys_lo & pbm->pbm_intmask.phys_lo;
 697         irq  = *interrupt & pbm->pbm_intmask.interrupt;
 698
 699         for (i = 0; i < pbm->num_pbm_intmap; i++) {
 700                 struct linux_prom_pci_intmap *intmap;
 701
 702                 intmap = &pbm->pbm_intmap[i];
 703
 704                 if (intmap->phys_hi  == hi  &&
 705                     intmap->phys_mid == mid &&
 706                     intmap->phys_lo  == lo  &&
 707                     intmap->interrupt == irq) {
 708                         *interrupt = intmap->cinterrupt;
 709                         goto success;
 710                 }
 711         }
 712
 713 fail:
 714         return 0;
 715
 716 success:
 717         printk("PCI-IRQ: Routing bus[%2x] slot[%2x] to INO[%02x]\n",
 718                pdev->bus->number, PCI_SLOT(pdev->devfn),
 719                *interrupt);
 720         return 1;
 721 }
 722
 723 static void __init pdev_fixup_irq(struct pci_dev *pdev)
 724 {
 725         struct pcidev_cookie *pcp = pdev->sysdata;
 726         struct pci_pbm_info *pbm = pcp->pbm;
 727         struct pci_controller_info *p = pbm->parent;
 728         unsigned int portid = pbm->portid;
 729         unsigned int prom_irq;
 730         int prom_node = pcp->prom_node;
 731         int err;
 732
 733         /* If this is an empty EBUS device, sometimes OBP fails to
 734          * give it a valid fully specified interrupts property.
 735          * The EBUS hooked up to SunHME on PCI I/O boards of
 736          * Ex000 systems is one such case.
 737          *
 738          * The interrupt is not important so just ignore it.
 739          */
 740         if (pdev->vendor == PCI_VENDOR_ID_SUN &&
 741             pdev->device == PCI_DEVICE_ID_SUN_EBUS &&
 742             !prom_getchild(prom_node)) {
 743                 pdev->irq = 0;
 744                 return;
 745         }
 746
 747         err = prom_getproperty(prom_node, "interrupts",
 748                                (char *)&prom_irq, sizeof(prom_irq));
 749         if (err == 0 || err == -1) {
 750                 pdev->irq = 0;
 751                 return;
 752         }
 753
 754         if (tlb_type != hypervisor) {
 755                 /* Fully specified already? */
 756                 if (((prom_irq & PCI_IRQ_IGN) >> 6) == portid) {
 757                         pdev->irq = p->irq_build(pbm, pdev, prom_irq);
 758                         goto have_irq;
 759                 }
 760
 761                 /* An onboard device? (bit 5 set) */
 762                 if ((prom_irq & PCI_IRQ_INO) & 0x20) {
 763                         pdev->irq = p->irq_build(pbm, pdev, (portid << 6 | prom_irq));
 764                         goto have_irq;
 765                 }
 766         }
 767
 768         /* Can we find a matching entry in the interrupt-map? */
 769         if (pci_intmap_match(pdev, &prom_irq)) {
 770                 pdev->irq = p->irq_build(pbm, pdev, (portid << 6) | prom_irq);
 771                 goto have_irq;
 772         }
 773
 774         /* Ok, we have to do it the hard way. */
 775         {
 776                 unsigned int bus, slot, line;
 777
 778                 bus = (pbm == &pbm->parent->pbm_B) ? (1 << 4) : 0;
 779
 780                 /* If we have a legal interrupt property, use it as
 781                  * the IRQ line.
 782                  */
 783                 if (prom_irq > 0 && prom_irq < 5) {
 784                         line = ((prom_irq - 1) & 3);
 785                 } else {
 786                         u8 pci_irq_line;
 787
 788                         /* Else just directly consult PCI config space. */
 789                         pci_read_config_byte(pdev, PCI_INTERRUPT_PIN, &pci_irq_line);
 790                         line = ((pci_irq_line - 1) & 3);
 791                 }
 792
 793                 /* Now figure out the slot.
 794                  *
 795                  * Basically, device number zero on the top-level bus is
 796                  * always the PCI host controller.  Slot 0 is then device 1.
 797                  * PBM A supports two external slots (0 and 1), and PBM B
 798                  * supports 4 external slots (0, 1, 2, and 3).  On-board PCI
 799                  * devices are wired to device numbers outside of these
 800                  * ranges. -DaveM
 801                  */
 802                 if (pdev->bus->number == pbm->pci_first_busno) {
 803                         slot = PCI_SLOT(pdev->devfn) - pbm->pci_first_slot;
 804                 } else {
 805                         struct pci_dev *bus_dev;
 806
 807                         /* Underneath a bridge, use slot number of parent
 808                          * bridge which is closest to the PBM.
 809                          */
 810                         bus_dev = pdev->bus->self;
 811                         while (bus_dev->bus &&
 812                                bus_dev->bus->number != pbm->pci_first_busno)
 813                                 bus_dev = bus_dev->bus->self;
 814
 815                         slot = PCI_SLOT(bus_dev->devfn) - pbm->pci_first_slot;
 816                 }
 817                 slot = slot << 2;
 818
 819                 pdev->irq = p->irq_build(pbm, pdev,
 820                                          ((portid << 6) & PCI_IRQ_IGN) |
 821                                          (bus | slot | line));
 822         }
 823
 824 have_irq:
 825         pci_write_config_byte(pdev, PCI_INTERRUPT_LINE,
 826                               pdev->irq & PCI_IRQ_INO);
 827 }
 828
 829 void __init pci_fixup_irq(struct pci_pbm_info *pbm,
 830                           struct pci_bus *pbus)
 831 {
 832         struct pci_dev *dev;
 833         struct pci_bus *bus;
 834
 835         list_for_each_entry(dev, &pbus->devices, bus_list)
 836                 pdev_fixup_irq(dev);
 837
 838         list_for_each_entry(bus, &pbus->children, node)
 839                 pci_fixup_irq(pbm, bus);
 840 }
 841
 842 static void pdev_setup_busmastering(struct pci_dev *pdev, int is_66mhz)
 843 {
 844         u16 cmd;
 845         u8 hdr_type, min_gnt, ltimer;
 846
 847         pci_read_config_word(pdev, PCI_COMMAND, &cmd);
 848         cmd |= PCI_COMMAND_MASTER;
 849         pci_write_config_word(pdev, PCI_COMMAND, cmd);
 850
 851         /* Read it back, if the mastering bit did not
 852          * get set, the device does not support bus
 853          * mastering so we have nothing to do here.
 854          */
 855         pci_read_config_word(pdev, PCI_COMMAND, &cmd);
 856         if ((cmd & PCI_COMMAND_MASTER) == 0)
 857                 return;
 858
 859         /* Set correct cache line size, 64-byte on all
 860          * Sparc64 PCI systems.  Note that the value is
 861          * measured in 32-bit words.
 862          */
 863         pci_write_config_byte(pdev, PCI_CACHE_LINE_SIZE,
 864                               64 / sizeof(u32));
 865
 866         pci_read_config_byte(pdev, PCI_HEADER_TYPE, &hdr_type);
 867         hdr_type &= ~0x80;
 868         if (hdr_type != PCI_HEADER_TYPE_NORMAL)
 869                 return;
 870
 871         /* If the latency timer is already programmed with a non-zero
 872          * value, assume whoever set it (OBP or whoever) knows what
 873          * they are doing.
 874          */
 875         pci_read_config_byte(pdev, PCI_LATENCY_TIMER, &ltimer);
 876         if (ltimer != 0)
 877                 return;
 878
 879         /* XXX Since I'm tipping off the min grant value to
 880          * XXX choose a suitable latency timer value, I also
 881          * XXX considered making use of the max latency value
 882          * XXX as well.  Unfortunately I've seen too many bogusly
 883          * XXX low settings for it to the point where it lacks
 884          * XXX any usefulness.  In one case, an ethernet card
 885          * XXX claimed a min grant of 10 and a max latency of 5.
 886          * XXX Now, if I had two such cards on the same bus I
 887          * XXX could not set the desired burst period (calculated
 888          * XXX from min grant) without violating the max latency
 889          * XXX bound.  Duh...
 890          * XXX
 891          * XXX I blame dumb PC bios implementors for stuff like
 892          * XXX this, most of them don't even try to do something
 893          * XXX sensible with latency timer values and just set some
 894          * XXX default value (usually 32) into every device.
 895          */
 896
 897         pci_read_config_byte(pdev, PCI_MIN_GNT, &min_gnt);
 898
 899         if (min_gnt == 0) {
 900                 /* If no min_gnt setting then use a default
 901                  * value.
 902                  */
 903                 if (is_66mhz)
 904                         ltimer = 16;
 905                 else
 906                         ltimer = 32;
 907         } else {
 908                 int shift_factor;
 909
 910                 if (is_66mhz)
 911                         shift_factor = 2;
 912                 else
 913                         shift_factor = 3;
 914
 915                 /* Use a default value when the min_gnt value
 916                  * is erroneously high.
 917                  */
 918                 if (((unsigned int) min_gnt << shift_factor) > 512 ||
 919                     ((min_gnt << shift_factor) & 0xff) == 0) {
 920                         ltimer = 8 << shift_factor;
 921                 } else {
 922                         ltimer = min_gnt << shift_factor;
 923                 }
 924         }
 925
 926         pci_write_config_byte(pdev, PCI_LATENCY_TIMER, ltimer);
 927 }
 928
 929 void pci_determine_66mhz_disposition(struct pci_pbm_info *pbm,
 930                                      struct pci_bus *pbus)
 931 {
 932         struct pci_dev *pdev;
 933         int all_are_66mhz;
 934         u16 status;
 935
 936         if (pbm->is_66mhz_capable == 0) {
 937                 all_are_66mhz = 0;
 938                 goto out;
 939         }
 940
 941         all_are_66mhz = 1;
 942         list_for_each_entry(pdev, &pbus->devices, bus_list) {
 943                 pci_read_config_word(pdev, PCI_STATUS, &status);
 944                 if (!(status & PCI_STATUS_66MHZ)) {
 945                         all_are_66mhz = 0;
 946                         break;
 947                 }
 948         }
 949 out:
 950         pbm->all_devs_66mhz = all_are_66mhz;
 951
 952         printk("PCI%d(PBM%c): Bus running at %dMHz\n",
 953                pbm->parent->index,
 954                (pbm == &pbm->parent->pbm_A) ? 'A' : 'B',
 955                (all_are_66mhz ? 66 : 33));
 956 }
 957
 958 void pci_setup_busmastering(struct pci_pbm_info *pbm,
 959                             struct pci_bus *pbus)
 960 {
 961         struct pci_dev *dev;
 962         struct pci_bus *bus;
 963         int is_66mhz;
 964
 965         is_66mhz = pbm->is_66mhz_capable && pbm->all_devs_66mhz;
 966
 967         list_for_each_entry(dev, &pbus->devices, bus_list)
 968                 pdev_setup_busmastering(dev, is_66mhz);
 969
 970         list_for_each_entry(bus, &pbus->children, node)
 971                 pci_setup_busmastering(pbm, bus);
 972 }
 973
 974 void pci_register_legacy_regions(struct resource *io_res,
 975                                  struct resource *mem_res)
 976 {
 977         struct resource *p;
 978
 979         /* VGA Video RAM. */
 980         p = kzalloc(sizeof(*p), GFP_KERNEL);
 981         if (!p)
 982                 return;
 983
 984         p->name = "Video RAM area";
 985         p->start = mem_res->start + 0xa0000UL;
 986         p->end = p->start + 0x1ffffUL;
 987         p->flags = IORESOURCE_BUSY;
 988         request_resource(mem_res, p);
 989
 990         p = kzalloc(sizeof(*p), GFP_KERNEL);
 991         if (!p)
 992                 return;
 993
 994         p->name = "System ROM";
 995         p->start = mem_res->start + 0xf0000UL;
 996         p->end = p->start + 0xffffUL;
 997         p->flags = IORESOURCE_BUSY;
 998         request_resource(mem_res, p);
 999
1000         p = kzalloc(sizeof(*p), GFP_KERNEL);
1001         if (!p)
1002                 return;
1003
1004         p->name = "Video ROM";
1005         p->start = mem_res->start + 0xc0000UL;
1006         p->end = p->start + 0x7fffUL;
1007         p->flags = IORESOURCE_BUSY;
1008         request_resource(mem_res, p);
1009 }
1010
1011 /* Generic helper routines for PCI error reporting. */
1012 void pci_scan_for_target_abort(struct pci_controller_info *p,
1013                                struct pci_pbm_info *pbm,
1014                                struct pci_bus *pbus)
1015 {
1016         struct pci_dev *pdev;
1017         struct pci_bus *bus;
1018
1019         list_for_each_entry(pdev, &pbus->devices, bus_list) {
1020                 u16 status, error_bits;
1021
1022                 pci_read_config_word(pdev, PCI_STATUS, &status);
1023                 error_bits =
1024                         (status & (PCI_STATUS_SIG_TARGET_ABORT |
1025                                    PCI_STATUS_REC_TARGET_ABORT));
1026                 if (error_bits) {
1027                         pci_write_config_word(pdev, PCI_STATUS, error_bits);
1028                         printk("PCI%d(PBM%c): Device [%s] saw Target Abort [%016x]\n",
1029                                p->index, ((pbm == &p->pbm_A) ? 'A' : 'B'),
1030                                pci_name(pdev), status);
1031                 }
1032         }
1033
1034         list_for_each_entry(bus, &pbus->children, node)
1035                 pci_scan_for_target_abort(p, pbm, bus);
1036 }
1037
1038 void pci_scan_for_master_abort(struct pci_controller_info *p,
1039                                struct pci_pbm_info *pbm,
1040                                struct pci_bus *pbus)
1041 {
1042         struct pci_dev *pdev;
1043         struct pci_bus *bus;
1044
1045         list_for_each_entry(pdev, &pbus->devices, bus_list) {
1046                 u16 status, error_bits;
1047
1048                 pci_read_config_word(pdev, PCI_STATUS, &status);
1049                 error_bits =
1050                         (status & (PCI_STATUS_REC_MASTER_ABORT));
1051                 if (error_bits) {
1052                         pci_write_config_word(pdev, PCI_STATUS, error_bits);
1053                         printk("PCI%d(PBM%c): Device [%s] received Master Abort [%016x]\n",
1054                                p->index, ((pbm == &p->pbm_A) ? 'A' : 'B'),
1055                                pci_name(pdev), status);
1056                 }
1057         }
1058
1059         list_for_each_entry(bus, &pbus->children, node)
1060                 pci_scan_for_master_abort(p, pbm, bus);
1061 }
1062
1063 void pci_scan_for_parity_error(struct pci_controller_info *p,
1064                                struct pci_pbm_info *pbm,
1065                                struct pci_bus *pbus)
1066 {
1067         struct pci_dev *pdev;
1068         struct pci_bus *bus;
1069
1070         list_for_each_entry(pdev, &pbus->devices, bus_list) {
1071                 u16 status, error_bits;
1072
1073                 pci_read_config_word(pdev, PCI_STATUS, &status);
1074                 error_bits =
1075                         (status & (PCI_STATUS_PARITY |
1076                                    PCI_STATUS_DETECTED_PARITY));
1077                 if (error_bits) {
1078                         pci_write_config_word(pdev, PCI_STATUS, error_bits);
1079                         printk("PCI%d(PBM%c): Device [%s] saw Parity Error [%016x]\n",
1080                                p->index, ((pbm == &p->pbm_A) ? 'A' : 'B'),
1081                                pci_name(pdev), status);
1082                 }
1083         }
1084
1085         list_for_each_entry(bus, &pbus->children, node)
1086                 pci_scan_for_parity_error(p, pbm, bus);
1087 }