linux/arch/sparc/kernel/pci_schizo.c
<<
>>
Prefs
   1/* pci_schizo.c: SCHIZO/TOMATILLO specific PCI controller support.
   2 *
   3 * Copyright (C) 2001, 2002, 2003, 2007, 2008 David S. Miller (davem@davemloft.net)
   4 */
   5
   6#include <linux/kernel.h>
   7#include <linux/types.h>
   8#include <linux/pci.h>
   9#include <linux/init.h>
  10#include <linux/slab.h>
  11#include <linux/export.h>
  12#include <linux/interrupt.h>
  13#include <linux/of_device.h>
  14
  15#include <asm/iommu.h>
  16#include <asm/irq.h>
  17#include <asm/pstate.h>
  18#include <asm/prom.h>
  19#include <asm/upa.h>
  20
  21#include "pci_impl.h"
  22#include "iommu_common.h"
  23
  24#define DRIVER_NAME     "schizo"
  25#define PFX             DRIVER_NAME ": "
  26
  27/* This is a convention that at least Excalibur and Merlin
  28 * follow.  I suppose the SCHIZO used in Starcat and friends
  29 * will do similar.
  30 *
  31 * The only way I could see this changing is if the newlink
  32 * block requires more space in Schizo's address space than
  33 * they predicted, thus requiring an address space reorg when
  34 * the newer Schizo is taped out.
  35 */
  36
  37/* Streaming buffer control register. */
  38#define SCHIZO_STRBUF_CTRL_LPTR    0x00000000000000f0UL /* LRU Lock Pointer */
  39#define SCHIZO_STRBUF_CTRL_LENAB   0x0000000000000008UL /* LRU Lock Enable */
  40#define SCHIZO_STRBUF_CTRL_RRDIS   0x0000000000000004UL /* Rerun Disable */
  41#define SCHIZO_STRBUF_CTRL_DENAB   0x0000000000000002UL /* Diagnostic Mode Enable */
  42#define SCHIZO_STRBUF_CTRL_ENAB    0x0000000000000001UL /* Streaming Buffer Enable */
  43
  44/* IOMMU control register. */
  45#define SCHIZO_IOMMU_CTRL_RESV     0xfffffffff9000000UL /* Reserved                      */
  46#define SCHIZO_IOMMU_CTRL_XLTESTAT 0x0000000006000000UL /* Translation Error Status      */
  47#define SCHIZO_IOMMU_CTRL_XLTEERR  0x0000000001000000UL /* Translation Error encountered */
  48#define SCHIZO_IOMMU_CTRL_LCKEN    0x0000000000800000UL /* Enable translation locking    */
  49#define SCHIZO_IOMMU_CTRL_LCKPTR   0x0000000000780000UL /* Translation lock pointer      */
  50#define SCHIZO_IOMMU_CTRL_TSBSZ    0x0000000000070000UL /* TSB Size                      */
  51#define SCHIZO_IOMMU_TSBSZ_1K      0x0000000000000000UL /* TSB Table 1024 8-byte entries */
  52#define SCHIZO_IOMMU_TSBSZ_2K      0x0000000000010000UL /* TSB Table 2048 8-byte entries */
  53#define SCHIZO_IOMMU_TSBSZ_4K      0x0000000000020000UL /* TSB Table 4096 8-byte entries */
  54#define SCHIZO_IOMMU_TSBSZ_8K      0x0000000000030000UL /* TSB Table 8192 8-byte entries */
  55#define SCHIZO_IOMMU_TSBSZ_16K     0x0000000000040000UL /* TSB Table 16k 8-byte entries  */
  56#define SCHIZO_IOMMU_TSBSZ_32K     0x0000000000050000UL /* TSB Table 32k 8-byte entries  */
  57#define SCHIZO_IOMMU_TSBSZ_64K     0x0000000000060000UL /* TSB Table 64k 8-byte entries  */
  58#define SCHIZO_IOMMU_TSBSZ_128K    0x0000000000070000UL /* TSB Table 128k 8-byte entries */
  59#define SCHIZO_IOMMU_CTRL_RESV2    0x000000000000fff8UL /* Reserved                      */
  60#define SCHIZO_IOMMU_CTRL_TBWSZ    0x0000000000000004UL /* Assumed page size, 0=8k 1=64k */
  61#define SCHIZO_IOMMU_CTRL_DENAB    0x0000000000000002UL /* Diagnostic mode enable        */
  62#define SCHIZO_IOMMU_CTRL_ENAB     0x0000000000000001UL /* IOMMU Enable                  */
  63
  64/* Schizo config space address format is nearly identical to
  65 * that of PSYCHO:
  66 *
  67 *  32             24 23 16 15    11 10       8 7   2  1 0
  68 * ---------------------------------------------------------
  69 * |0 0 0 0 0 0 0 0 0| bus | device | function | reg | 0 0 |
  70 * ---------------------------------------------------------
  71 */
  72#define SCHIZO_CONFIG_BASE(PBM) ((PBM)->config_space)
  73#define SCHIZO_CONFIG_ENCODE(BUS, DEVFN, REG)   \
  74        (((unsigned long)(BUS)   << 16) |       \
  75         ((unsigned long)(DEVFN) << 8)  |       \
  76         ((unsigned long)(REG)))
  77
  78static void *schizo_pci_config_mkaddr(struct pci_pbm_info *pbm,
  79                                      unsigned char bus,
  80                                      unsigned int devfn,
  81                                      int where)
  82{
  83        if (!pbm)
  84                return NULL;
  85        bus -= pbm->pci_first_busno;
  86        return (void *)
  87                (SCHIZO_CONFIG_BASE(pbm) |
  88                 SCHIZO_CONFIG_ENCODE(bus, devfn, where));
  89}
  90
  91/* SCHIZO error handling support. */
  92enum schizo_error_type {
  93        UE_ERR, CE_ERR, PCI_ERR, SAFARI_ERR
  94};
  95
  96static DEFINE_SPINLOCK(stc_buf_lock);
  97static unsigned long stc_error_buf[128];
  98static unsigned long stc_tag_buf[16];
  99static unsigned long stc_line_buf[16];
 100
 101#define SCHIZO_UE_INO           0x30 /* Uncorrectable ECC error */
 102#define SCHIZO_CE_INO           0x31 /* Correctable ECC error */
 103#define SCHIZO_PCIERR_A_INO     0x32 /* PBM A PCI bus error */
 104#define SCHIZO_PCIERR_B_INO     0x33 /* PBM B PCI bus error */
 105#define SCHIZO_SERR_INO         0x34 /* Safari interface error */
 106
 107#define SCHIZO_STC_ERR  0xb800UL /* --> 0xba00 */
 108#define SCHIZO_STC_TAG  0xba00UL /* --> 0xba80 */
 109#define SCHIZO_STC_LINE 0xbb00UL /* --> 0xbb80 */
 110
 111#define SCHIZO_STCERR_WRITE     0x2UL
 112#define SCHIZO_STCERR_READ      0x1UL
 113
 114#define SCHIZO_STCTAG_PPN       0x3fffffff00000000UL
 115#define SCHIZO_STCTAG_VPN       0x00000000ffffe000UL
 116#define SCHIZO_STCTAG_VALID     0x8000000000000000UL
 117#define SCHIZO_STCTAG_READ      0x4000000000000000UL
 118
 119#define SCHIZO_STCLINE_LINDX    0x0000000007800000UL
 120#define SCHIZO_STCLINE_SPTR     0x000000000007e000UL
 121#define SCHIZO_STCLINE_LADDR    0x0000000000001fc0UL
 122#define SCHIZO_STCLINE_EPTR     0x000000000000003fUL
 123#define SCHIZO_STCLINE_VALID    0x0000000000600000UL
 124#define SCHIZO_STCLINE_FOFN     0x0000000000180000UL
 125
 126static void __schizo_check_stc_error_pbm(struct pci_pbm_info *pbm,
 127                                         enum schizo_error_type type)
 128{
 129        struct strbuf *strbuf = &pbm->stc;
 130        unsigned long regbase = pbm->pbm_regs;
 131        unsigned long err_base, tag_base, line_base;
 132        u64 control;
 133        int i;
 134
 135        err_base = regbase + SCHIZO_STC_ERR;
 136        tag_base = regbase + SCHIZO_STC_TAG;
 137        line_base = regbase + SCHIZO_STC_LINE;
 138
 139        spin_lock(&stc_buf_lock);
 140
 141        /* This is __REALLY__ dangerous.  When we put the
 142         * streaming buffer into diagnostic mode to probe
 143         * it's tags and error status, we _must_ clear all
 144         * of the line tag valid bits before re-enabling
 145         * the streaming buffer.  If any dirty data lives
 146         * in the STC when we do this, we will end up
 147         * invalidating it before it has a chance to reach
 148         * main memory.
 149         */
 150        control = upa_readq(strbuf->strbuf_control);
 151        upa_writeq((control | SCHIZO_STRBUF_CTRL_DENAB),
 152                   strbuf->strbuf_control);
 153        for (i = 0; i < 128; i++) {
 154                unsigned long val;
 155
 156                val = upa_readq(err_base + (i * 8UL));
 157                upa_writeq(0UL, err_base + (i * 8UL));
 158                stc_error_buf[i] = val;
 159        }
 160        for (i = 0; i < 16; i++) {
 161                stc_tag_buf[i] = upa_readq(tag_base + (i * 8UL));
 162                stc_line_buf[i] = upa_readq(line_base + (i * 8UL));
 163                upa_writeq(0UL, tag_base + (i * 8UL));
 164                upa_writeq(0UL, line_base + (i * 8UL));
 165        }
 166
 167        /* OK, state is logged, exit diagnostic mode. */
 168        upa_writeq(control, strbuf->strbuf_control);
 169
 170        for (i = 0; i < 16; i++) {
 171                int j, saw_error, first, last;
 172
 173                saw_error = 0;
 174                first = i * 8;
 175                last = first + 8;
 176                for (j = first; j < last; j++) {
 177                        unsigned long errval = stc_error_buf[j];
 178                        if (errval != 0) {
 179                                saw_error++;
 180                                printk("%s: STC_ERR(%d)[wr(%d)rd(%d)]\n",
 181                                       pbm->name,
 182                                       j,
 183                                       (errval & SCHIZO_STCERR_WRITE) ? 1 : 0,
 184                                       (errval & SCHIZO_STCERR_READ) ? 1 : 0);
 185                        }
 186                }
 187                if (saw_error != 0) {
 188                        unsigned long tagval = stc_tag_buf[i];
 189                        unsigned long lineval = stc_line_buf[i];
 190                        printk("%s: STC_TAG(%d)[PA(%016lx)VA(%08lx)V(%d)R(%d)]\n",
 191                               pbm->name,
 192                               i,
 193                               ((tagval & SCHIZO_STCTAG_PPN) >> 19UL),
 194                               (tagval & SCHIZO_STCTAG_VPN),
 195                               ((tagval & SCHIZO_STCTAG_VALID) ? 1 : 0),
 196                               ((tagval & SCHIZO_STCTAG_READ) ? 1 : 0));
 197
 198                        /* XXX Should spit out per-bank error information... -DaveM */
 199                        printk("%s: STC_LINE(%d)[LIDX(%lx)SP(%lx)LADDR(%lx)EP(%lx)"
 200                               "V(%d)FOFN(%d)]\n",
 201                               pbm->name,
 202                               i,
 203                               ((lineval & SCHIZO_STCLINE_LINDX) >> 23UL),
 204                               ((lineval & SCHIZO_STCLINE_SPTR) >> 13UL),
 205                               ((lineval & SCHIZO_STCLINE_LADDR) >> 6UL),
 206                               ((lineval & SCHIZO_STCLINE_EPTR) >> 0UL),
 207                               ((lineval & SCHIZO_STCLINE_VALID) ? 1 : 0),
 208                               ((lineval & SCHIZO_STCLINE_FOFN) ? 1 : 0));
 209                }
 210        }
 211
 212        spin_unlock(&stc_buf_lock);
 213}
 214
 215/* IOMMU is per-PBM in Schizo, so interrogate both for anonymous
 216 * controller level errors.
 217 */
 218
 219#define SCHIZO_IOMMU_TAG        0xa580UL
 220#define SCHIZO_IOMMU_DATA       0xa600UL
 221
 222#define SCHIZO_IOMMU_TAG_CTXT   0x0000001ffe000000UL
 223#define SCHIZO_IOMMU_TAG_ERRSTS 0x0000000001800000UL
 224#define SCHIZO_IOMMU_TAG_ERR    0x0000000000400000UL
 225#define SCHIZO_IOMMU_TAG_WRITE  0x0000000000200000UL
 226#define SCHIZO_IOMMU_TAG_STREAM 0x0000000000100000UL
 227#define SCHIZO_IOMMU_TAG_SIZE   0x0000000000080000UL
 228#define SCHIZO_IOMMU_TAG_VPAGE  0x000000000007ffffUL
 229
 230#define SCHIZO_IOMMU_DATA_VALID 0x0000000100000000UL
 231#define SCHIZO_IOMMU_DATA_CACHE 0x0000000040000000UL
 232#define SCHIZO_IOMMU_DATA_PPAGE 0x000000003fffffffUL
 233
 234static void schizo_check_iommu_error_pbm(struct pci_pbm_info *pbm,
 235                                         enum schizo_error_type type)
 236{
 237        struct iommu *iommu = pbm->iommu;
 238        unsigned long iommu_tag[16];
 239        unsigned long iommu_data[16];
 240        unsigned long flags;
 241        u64 control;
 242        int i;
 243
 244        spin_lock_irqsave(&iommu->lock, flags);
 245        control = upa_readq(iommu->iommu_control);
 246        if (control & SCHIZO_IOMMU_CTRL_XLTEERR) {
 247                unsigned long base;
 248                char *type_string;
 249
 250                /* Clear the error encountered bit. */
 251                control &= ~SCHIZO_IOMMU_CTRL_XLTEERR;
 252                upa_writeq(control, iommu->iommu_control);
 253
 254                switch((control & SCHIZO_IOMMU_CTRL_XLTESTAT) >> 25UL) {
 255                case 0:
 256                        type_string = "Protection Error";
 257                        break;
 258                case 1:
 259                        type_string = "Invalid Error";
 260                        break;
 261                case 2:
 262                        type_string = "TimeOut Error";
 263                        break;
 264                case 3:
 265                default:
 266                        type_string = "ECC Error";
 267                        break;
 268                }
 269                printk("%s: IOMMU Error, type[%s]\n",
 270                       pbm->name, type_string);
 271
 272                /* Put the IOMMU into diagnostic mode and probe
 273                 * it's TLB for entries with error status.
 274                 *
 275                 * It is very possible for another DVMA to occur
 276                 * while we do this probe, and corrupt the system
 277                 * further.  But we are so screwed at this point
 278                 * that we are likely to crash hard anyways, so
 279                 * get as much diagnostic information to the
 280                 * console as we can.
 281                 */
 282                upa_writeq(control | SCHIZO_IOMMU_CTRL_DENAB,
 283                           iommu->iommu_control);
 284
 285                base = pbm->pbm_regs;
 286
 287                for (i = 0; i < 16; i++) {
 288                        iommu_tag[i] =
 289                                upa_readq(base + SCHIZO_IOMMU_TAG + (i * 8UL));
 290                        iommu_data[i] =
 291                                upa_readq(base + SCHIZO_IOMMU_DATA + (i * 8UL));
 292
 293                        /* Now clear out the entry. */
 294                        upa_writeq(0, base + SCHIZO_IOMMU_TAG + (i * 8UL));
 295                        upa_writeq(0, base + SCHIZO_IOMMU_DATA + (i * 8UL));
 296                }
 297
 298                /* Leave diagnostic mode. */
 299                upa_writeq(control, iommu->iommu_control);
 300
 301                for (i = 0; i < 16; i++) {
 302                        unsigned long tag, data;
 303
 304                        tag = iommu_tag[i];
 305                        if (!(tag & SCHIZO_IOMMU_TAG_ERR))
 306                                continue;
 307
 308                        data = iommu_data[i];
 309                        switch((tag & SCHIZO_IOMMU_TAG_ERRSTS) >> 23UL) {
 310                        case 0:
 311                                type_string = "Protection Error";
 312                                break;
 313                        case 1:
 314                                type_string = "Invalid Error";
 315                                break;
 316                        case 2:
 317                                type_string = "TimeOut Error";
 318                                break;
 319                        case 3:
 320                        default:
 321                                type_string = "ECC Error";
 322                                break;
 323                        }
 324                        printk("%s: IOMMU TAG(%d)[error(%s) ctx(%x) wr(%d) str(%d) "
 325                               "sz(%dK) vpg(%08lx)]\n",
 326                               pbm->name, i, type_string,
 327                               (int)((tag & SCHIZO_IOMMU_TAG_CTXT) >> 25UL),
 328                               ((tag & SCHIZO_IOMMU_TAG_WRITE) ? 1 : 0),
 329                               ((tag & SCHIZO_IOMMU_TAG_STREAM) ? 1 : 0),
 330                               ((tag & SCHIZO_IOMMU_TAG_SIZE) ? 64 : 8),
 331                               (tag & SCHIZO_IOMMU_TAG_VPAGE) << IOMMU_PAGE_SHIFT);
 332                        printk("%s: IOMMU DATA(%d)[valid(%d) cache(%d) ppg(%016lx)]\n",
 333                               pbm->name, i,
 334                               ((data & SCHIZO_IOMMU_DATA_VALID) ? 1 : 0),
 335                               ((data & SCHIZO_IOMMU_DATA_CACHE) ? 1 : 0),
 336                               (data & SCHIZO_IOMMU_DATA_PPAGE) << IOMMU_PAGE_SHIFT);
 337                }
 338        }
 339        if (pbm->stc.strbuf_enabled)
 340                __schizo_check_stc_error_pbm(pbm, type);
 341        spin_unlock_irqrestore(&iommu->lock, flags);
 342}
 343
 344static void schizo_check_iommu_error(struct pci_pbm_info *pbm,
 345                                     enum schizo_error_type type)
 346{
 347        schizo_check_iommu_error_pbm(pbm, type);
 348        if (pbm->sibling)
 349                schizo_check_iommu_error_pbm(pbm->sibling, type);
 350}
 351
 352/* Uncorrectable ECC error status gathering. */
 353#define SCHIZO_UE_AFSR  0x10030UL
 354#define SCHIZO_UE_AFAR  0x10038UL
 355
 356#define SCHIZO_UEAFSR_PPIO      0x8000000000000000UL /* Safari */
 357#define SCHIZO_UEAFSR_PDRD      0x4000000000000000UL /* Safari/Tomatillo */
 358#define SCHIZO_UEAFSR_PDWR      0x2000000000000000UL /* Safari */
 359#define SCHIZO_UEAFSR_SPIO      0x1000000000000000UL /* Safari */
 360#define SCHIZO_UEAFSR_SDMA      0x0800000000000000UL /* Safari/Tomatillo */
 361#define SCHIZO_UEAFSR_ERRPNDG   0x0300000000000000UL /* Safari */
 362#define SCHIZO_UEAFSR_BMSK      0x000003ff00000000UL /* Safari */
 363#define SCHIZO_UEAFSR_QOFF      0x00000000c0000000UL /* Safari/Tomatillo */
 364#define SCHIZO_UEAFSR_AID       0x000000001f000000UL /* Safari/Tomatillo */
 365#define SCHIZO_UEAFSR_PARTIAL   0x0000000000800000UL /* Safari */
 366#define SCHIZO_UEAFSR_OWNEDIN   0x0000000000400000UL /* Safari */
 367#define SCHIZO_UEAFSR_MTAGSYND  0x00000000000f0000UL /* Safari */
 368#define SCHIZO_UEAFSR_MTAG      0x000000000000e000UL /* Safari */
 369#define SCHIZO_UEAFSR_ECCSYND   0x00000000000001ffUL /* Safari */
 370
 371static irqreturn_t schizo_ue_intr(int irq, void *dev_id)
 372{
 373        struct pci_pbm_info *pbm = dev_id;
 374        unsigned long afsr_reg = pbm->controller_regs + SCHIZO_UE_AFSR;
 375        unsigned long afar_reg = pbm->controller_regs + SCHIZO_UE_AFAR;
 376        unsigned long afsr, afar, error_bits;
 377        int reported, limit;
 378
 379        /* Latch uncorrectable error status. */
 380        afar = upa_readq(afar_reg);
 381
 382        /* If either of the error pending bits are set in the
 383         * AFSR, the error status is being actively updated by
 384         * the hardware and we must re-read to get a clean value.
 385         */
 386        limit = 1000;
 387        do {
 388                afsr = upa_readq(afsr_reg);
 389        } while ((afsr & SCHIZO_UEAFSR_ERRPNDG) != 0 && --limit);
 390
 391        /* Clear the primary/secondary error status bits. */
 392        error_bits = afsr &
 393                (SCHIZO_UEAFSR_PPIO | SCHIZO_UEAFSR_PDRD | SCHIZO_UEAFSR_PDWR |
 394                 SCHIZO_UEAFSR_SPIO | SCHIZO_UEAFSR_SDMA);
 395        if (!error_bits)
 396                return IRQ_NONE;
 397        upa_writeq(error_bits, afsr_reg);
 398
 399        /* Log the error. */
 400        printk("%s: Uncorrectable Error, primary error type[%s]\n",
 401               pbm->name,
 402               (((error_bits & SCHIZO_UEAFSR_PPIO) ?
 403                 "PIO" :
 404                 ((error_bits & SCHIZO_UEAFSR_PDRD) ?
 405                  "DMA Read" :
 406                  ((error_bits & SCHIZO_UEAFSR_PDWR) ?
 407                   "DMA Write" : "???")))));
 408        printk("%s: bytemask[%04lx] qword_offset[%lx] SAFARI_AID[%02lx]\n",
 409               pbm->name,
 410               (afsr & SCHIZO_UEAFSR_BMSK) >> 32UL,
 411               (afsr & SCHIZO_UEAFSR_QOFF) >> 30UL,
 412               (afsr & SCHIZO_UEAFSR_AID) >> 24UL);
 413        printk("%s: partial[%d] owned_in[%d] mtag[%lx] mtag_synd[%lx] ecc_sync[%lx]\n",
 414               pbm->name,
 415               (afsr & SCHIZO_UEAFSR_PARTIAL) ? 1 : 0,
 416               (afsr & SCHIZO_UEAFSR_OWNEDIN) ? 1 : 0,
 417               (afsr & SCHIZO_UEAFSR_MTAG) >> 13UL,
 418               (afsr & SCHIZO_UEAFSR_MTAGSYND) >> 16UL,
 419               (afsr & SCHIZO_UEAFSR_ECCSYND) >> 0UL);
 420        printk("%s: UE AFAR [%016lx]\n", pbm->name, afar);
 421        printk("%s: UE Secondary errors [", pbm->name);
 422        reported = 0;
 423        if (afsr & SCHIZO_UEAFSR_SPIO) {
 424                reported++;
 425                printk("(PIO)");
 426        }
 427        if (afsr & SCHIZO_UEAFSR_SDMA) {
 428                reported++;
 429                printk("(DMA)");
 430        }
 431        if (!reported)
 432                printk("(none)");
 433        printk("]\n");
 434
 435        /* Interrogate IOMMU for error status. */
 436        schizo_check_iommu_error(pbm, UE_ERR);
 437
 438        return IRQ_HANDLED;
 439}
 440
 441#define SCHIZO_CE_AFSR  0x10040UL
 442#define SCHIZO_CE_AFAR  0x10048UL
 443
 444#define SCHIZO_CEAFSR_PPIO      0x8000000000000000UL
 445#define SCHIZO_CEAFSR_PDRD      0x4000000000000000UL
 446#define SCHIZO_CEAFSR_PDWR      0x2000000000000000UL
 447#define SCHIZO_CEAFSR_SPIO      0x1000000000000000UL
 448#define SCHIZO_CEAFSR_SDMA      0x0800000000000000UL
 449#define SCHIZO_CEAFSR_ERRPNDG   0x0300000000000000UL
 450#define SCHIZO_CEAFSR_BMSK      0x000003ff00000000UL
 451#define SCHIZO_CEAFSR_QOFF      0x00000000c0000000UL
 452#define SCHIZO_CEAFSR_AID       0x000000001f000000UL
 453#define SCHIZO_CEAFSR_PARTIAL   0x0000000000800000UL
 454#define SCHIZO_CEAFSR_OWNEDIN   0x0000000000400000UL
 455#define SCHIZO_CEAFSR_MTAGSYND  0x00000000000f0000UL
 456#define SCHIZO_CEAFSR_MTAG      0x000000000000e000UL
 457#define SCHIZO_CEAFSR_ECCSYND   0x00000000000001ffUL
 458
 459static irqreturn_t schizo_ce_intr(int irq, void *dev_id)
 460{
 461        struct pci_pbm_info *pbm = dev_id;
 462        unsigned long afsr_reg = pbm->controller_regs + SCHIZO_CE_AFSR;
 463        unsigned long afar_reg = pbm->controller_regs + SCHIZO_CE_AFAR;
 464        unsigned long afsr, afar, error_bits;
 465        int reported, limit;
 466
 467        /* Latch error status. */
 468        afar = upa_readq(afar_reg);
 469
 470        /* If either of the error pending bits are set in the
 471         * AFSR, the error status is being actively updated by
 472         * the hardware and we must re-read to get a clean value.
 473         */
 474        limit = 1000;
 475        do {
 476                afsr = upa_readq(afsr_reg);
 477        } while ((afsr & SCHIZO_UEAFSR_ERRPNDG) != 0 && --limit);
 478
 479        /* Clear primary/secondary error status bits. */
 480        error_bits = afsr &
 481                (SCHIZO_CEAFSR_PPIO | SCHIZO_CEAFSR_PDRD | SCHIZO_CEAFSR_PDWR |
 482                 SCHIZO_CEAFSR_SPIO | SCHIZO_CEAFSR_SDMA);
 483        if (!error_bits)
 484                return IRQ_NONE;
 485        upa_writeq(error_bits, afsr_reg);
 486
 487        /* Log the error. */
 488        printk("%s: Correctable Error, primary error type[%s]\n",
 489               pbm->name,
 490               (((error_bits & SCHIZO_CEAFSR_PPIO) ?
 491                 "PIO" :
 492                 ((error_bits & SCHIZO_CEAFSR_PDRD) ?
 493                  "DMA Read" :
 494                  ((error_bits & SCHIZO_CEAFSR_PDWR) ?
 495                   "DMA Write" : "???")))));
 496
 497        /* XXX Use syndrome and afar to print out module string just like
 498         * XXX UDB CE trap handler does... -DaveM
 499         */
 500        printk("%s: bytemask[%04lx] qword_offset[%lx] SAFARI_AID[%02lx]\n",
 501               pbm->name,
 502               (afsr & SCHIZO_UEAFSR_BMSK) >> 32UL,
 503               (afsr & SCHIZO_UEAFSR_QOFF) >> 30UL,
 504               (afsr & SCHIZO_UEAFSR_AID) >> 24UL);
 505        printk("%s: partial[%d] owned_in[%d] mtag[%lx] mtag_synd[%lx] ecc_sync[%lx]\n",
 506               pbm->name,
 507               (afsr & SCHIZO_UEAFSR_PARTIAL) ? 1 : 0,
 508               (afsr & SCHIZO_UEAFSR_OWNEDIN) ? 1 : 0,
 509               (afsr & SCHIZO_UEAFSR_MTAG) >> 13UL,
 510               (afsr & SCHIZO_UEAFSR_MTAGSYND) >> 16UL,
 511               (afsr & SCHIZO_UEAFSR_ECCSYND) >> 0UL);
 512        printk("%s: CE AFAR [%016lx]\n", pbm->name, afar);
 513        printk("%s: CE Secondary errors [", pbm->name);
 514        reported = 0;
 515        if (afsr & SCHIZO_CEAFSR_SPIO) {
 516                reported++;
 517                printk("(PIO)");
 518        }
 519        if (afsr & SCHIZO_CEAFSR_SDMA) {
 520                reported++;
 521                printk("(DMA)");
 522        }
 523        if (!reported)
 524                printk("(none)");
 525        printk("]\n");
 526
 527        return IRQ_HANDLED;
 528}
 529
 530#define SCHIZO_PCI_AFSR 0x2010UL
 531#define SCHIZO_PCI_AFAR 0x2018UL
 532
 533#define SCHIZO_PCIAFSR_PMA      0x8000000000000000UL /* Schizo/Tomatillo */
 534#define SCHIZO_PCIAFSR_PTA      0x4000000000000000UL /* Schizo/Tomatillo */
 535#define SCHIZO_PCIAFSR_PRTRY    0x2000000000000000UL /* Schizo/Tomatillo */
 536#define SCHIZO_PCIAFSR_PPERR    0x1000000000000000UL /* Schizo/Tomatillo */
 537#define SCHIZO_PCIAFSR_PTTO     0x0800000000000000UL /* Schizo/Tomatillo */
 538#define SCHIZO_PCIAFSR_PUNUS    0x0400000000000000UL /* Schizo */
 539#define SCHIZO_PCIAFSR_SMA      0x0200000000000000UL /* Schizo/Tomatillo */
 540#define SCHIZO_PCIAFSR_STA      0x0100000000000000UL /* Schizo/Tomatillo */
 541#define SCHIZO_PCIAFSR_SRTRY    0x0080000000000000UL /* Schizo/Tomatillo */
 542#define SCHIZO_PCIAFSR_SPERR    0x0040000000000000UL /* Schizo/Tomatillo */
 543#define SCHIZO_PCIAFSR_STTO     0x0020000000000000UL /* Schizo/Tomatillo */
 544#define SCHIZO_PCIAFSR_SUNUS    0x0010000000000000UL /* Schizo */
 545#define SCHIZO_PCIAFSR_BMSK     0x000003ff00000000UL /* Schizo/Tomatillo */
 546#define SCHIZO_PCIAFSR_BLK      0x0000000080000000UL /* Schizo/Tomatillo */
 547#define SCHIZO_PCIAFSR_CFG      0x0000000040000000UL /* Schizo/Tomatillo */
 548#define SCHIZO_PCIAFSR_MEM      0x0000000020000000UL /* Schizo/Tomatillo */
 549#define SCHIZO_PCIAFSR_IO       0x0000000010000000UL /* Schizo/Tomatillo */
 550
 551#define SCHIZO_PCI_CTRL         (0x2000UL)
 552#define SCHIZO_PCICTRL_BUS_UNUS (1UL << 63UL) /* Safari */
 553#define SCHIZO_PCICTRL_DTO_INT  (1UL << 61UL) /* Tomatillo */
 554#define SCHIZO_PCICTRL_ARB_PRIO (0x1ff << 52UL) /* Tomatillo */
 555#define SCHIZO_PCICTRL_ESLCK    (1UL << 51UL) /* Safari */
 556#define SCHIZO_PCICTRL_ERRSLOT  (7UL << 48UL) /* Safari */
 557#define SCHIZO_PCICTRL_TTO_ERR  (1UL << 38UL) /* Safari/Tomatillo */
 558#define SCHIZO_PCICTRL_RTRY_ERR (1UL << 37UL) /* Safari/Tomatillo */
 559#define SCHIZO_PCICTRL_DTO_ERR  (1UL << 36UL) /* Safari/Tomatillo */
 560#define SCHIZO_PCICTRL_SBH_ERR  (1UL << 35UL) /* Safari */
 561#define SCHIZO_PCICTRL_SERR     (1UL << 34UL) /* Safari/Tomatillo */
 562#define SCHIZO_PCICTRL_PCISPD   (1UL << 33UL) /* Safari */
 563#define SCHIZO_PCICTRL_MRM_PREF (1UL << 30UL) /* Tomatillo */
 564#define SCHIZO_PCICTRL_RDO_PREF (1UL << 29UL) /* Tomatillo */
 565#define SCHIZO_PCICTRL_RDL_PREF (1UL << 28UL) /* Tomatillo */
 566#define SCHIZO_PCICTRL_PTO      (3UL << 24UL) /* Safari/Tomatillo */
 567#define SCHIZO_PCICTRL_PTO_SHIFT 24UL
 568#define SCHIZO_PCICTRL_TRWSW    (7UL << 21UL) /* Tomatillo */
 569#define SCHIZO_PCICTRL_F_TGT_A  (1UL << 20UL) /* Tomatillo */
 570#define SCHIZO_PCICTRL_S_DTO_INT (1UL << 19UL) /* Safari */
 571#define SCHIZO_PCICTRL_F_TGT_RT (1UL << 19UL) /* Tomatillo */
 572#define SCHIZO_PCICTRL_SBH_INT  (1UL << 18UL) /* Safari */
 573#define SCHIZO_PCICTRL_T_DTO_INT (1UL << 18UL) /* Tomatillo */
 574#define SCHIZO_PCICTRL_EEN      (1UL << 17UL) /* Safari/Tomatillo */
 575#define SCHIZO_PCICTRL_PARK     (1UL << 16UL) /* Safari/Tomatillo */
 576#define SCHIZO_PCICTRL_PCIRST   (1UL <<  8UL) /* Safari */
 577#define SCHIZO_PCICTRL_ARB_S    (0x3fUL << 0UL) /* Safari */
 578#define SCHIZO_PCICTRL_ARB_T    (0xffUL << 0UL) /* Tomatillo */
 579
 580static irqreturn_t schizo_pcierr_intr_other(struct pci_pbm_info *pbm)
 581{
 582        unsigned long csr_reg, csr, csr_error_bits;
 583        irqreturn_t ret = IRQ_NONE;
 584        u32 stat;
 585
 586        csr_reg = pbm->pbm_regs + SCHIZO_PCI_CTRL;
 587        csr = upa_readq(csr_reg);
 588        csr_error_bits =
 589                csr & (SCHIZO_PCICTRL_BUS_UNUS |
 590                       SCHIZO_PCICTRL_TTO_ERR |
 591                       SCHIZO_PCICTRL_RTRY_ERR |
 592                       SCHIZO_PCICTRL_DTO_ERR |
 593                       SCHIZO_PCICTRL_SBH_ERR |
 594                       SCHIZO_PCICTRL_SERR);
 595        if (csr_error_bits) {
 596                /* Clear the errors.  */
 597                upa_writeq(csr, csr_reg);
 598
 599                /* Log 'em.  */
 600                if (csr_error_bits & SCHIZO_PCICTRL_BUS_UNUS)
 601                        printk("%s: Bus unusable error asserted.\n",
 602                               pbm->name);
 603                if (csr_error_bits & SCHIZO_PCICTRL_TTO_ERR)
 604                        printk("%s: PCI TRDY# timeout error asserted.\n",
 605                               pbm->name);
 606                if (csr_error_bits & SCHIZO_PCICTRL_RTRY_ERR)
 607                        printk("%s: PCI excessive retry error asserted.\n",
 608                               pbm->name);
 609                if (csr_error_bits & SCHIZO_PCICTRL_DTO_ERR)
 610                        printk("%s: PCI discard timeout error asserted.\n",
 611                               pbm->name);
 612                if (csr_error_bits & SCHIZO_PCICTRL_SBH_ERR)
 613                        printk("%s: PCI streaming byte hole error asserted.\n",
 614                               pbm->name);
 615                if (csr_error_bits & SCHIZO_PCICTRL_SERR)
 616                        printk("%s: PCI SERR signal asserted.\n",
 617                               pbm->name);
 618                ret = IRQ_HANDLED;
 619        }
 620        pbm->pci_ops->read(pbm->pci_bus, 0, PCI_STATUS, 2, &stat);
 621        if (stat & (PCI_STATUS_PARITY |
 622                    PCI_STATUS_SIG_TARGET_ABORT |
 623                    PCI_STATUS_REC_TARGET_ABORT |
 624                    PCI_STATUS_REC_MASTER_ABORT |
 625                    PCI_STATUS_SIG_SYSTEM_ERROR)) {
 626                printk("%s: PCI bus error, PCI_STATUS[%04x]\n",
 627                       pbm->name, stat);
 628                pbm->pci_ops->write(pbm->pci_bus, 0, PCI_STATUS, 2, 0xffff);
 629                ret = IRQ_HANDLED;
 630        }
 631        return ret;
 632}
 633
 634static irqreturn_t schizo_pcierr_intr(int irq, void *dev_id)
 635{
 636        struct pci_pbm_info *pbm = dev_id;
 637        unsigned long afsr_reg, afar_reg, base;
 638        unsigned long afsr, afar, error_bits;
 639        int reported;
 640
 641        base = pbm->pbm_regs;
 642
 643        afsr_reg = base + SCHIZO_PCI_AFSR;
 644        afar_reg = base + SCHIZO_PCI_AFAR;
 645
 646        /* Latch error status. */
 647        afar = upa_readq(afar_reg);
 648        afsr = upa_readq(afsr_reg);
 649
 650        /* Clear primary/secondary error status bits. */
 651        error_bits = afsr &
 652                (SCHIZO_PCIAFSR_PMA | SCHIZO_PCIAFSR_PTA |
 653                 SCHIZO_PCIAFSR_PRTRY | SCHIZO_PCIAFSR_PPERR |
 654                 SCHIZO_PCIAFSR_PTTO | SCHIZO_PCIAFSR_PUNUS |
 655                 SCHIZO_PCIAFSR_SMA | SCHIZO_PCIAFSR_STA |
 656                 SCHIZO_PCIAFSR_SRTRY | SCHIZO_PCIAFSR_SPERR |
 657                 SCHIZO_PCIAFSR_STTO | SCHIZO_PCIAFSR_SUNUS);
 658        if (!error_bits)
 659                return schizo_pcierr_intr_other(pbm);
 660        upa_writeq(error_bits, afsr_reg);
 661
 662        /* Log the error. */
 663        printk("%s: PCI Error, primary error type[%s]\n",
 664               pbm->name,
 665               (((error_bits & SCHIZO_PCIAFSR_PMA) ?
 666                 "Master Abort" :
 667                 ((error_bits & SCHIZO_PCIAFSR_PTA) ?
 668                  "Target Abort" :
 669                  ((error_bits & SCHIZO_PCIAFSR_PRTRY) ?
 670                   "Excessive Retries" :
 671                   ((error_bits & SCHIZO_PCIAFSR_PPERR) ?
 672                    "Parity Error" :
 673                    ((error_bits & SCHIZO_PCIAFSR_PTTO) ?
 674                     "Timeout" :
 675                     ((error_bits & SCHIZO_PCIAFSR_PUNUS) ?
 676                      "Bus Unusable" : "???"))))))));
 677        printk("%s: bytemask[%04lx] was_block(%d) space(%s)\n",
 678               pbm->name,
 679               (afsr & SCHIZO_PCIAFSR_BMSK) >> 32UL,
 680               (afsr & SCHIZO_PCIAFSR_BLK) ? 1 : 0,
 681               ((afsr & SCHIZO_PCIAFSR_CFG) ?
 682                "Config" :
 683                ((afsr & SCHIZO_PCIAFSR_MEM) ?
 684                 "Memory" :
 685                 ((afsr & SCHIZO_PCIAFSR_IO) ?
 686                  "I/O" : "???"))));
 687        printk("%s: PCI AFAR [%016lx]\n",
 688               pbm->name, afar);
 689        printk("%s: PCI Secondary errors [",
 690               pbm->name);
 691        reported = 0;
 692        if (afsr & SCHIZO_PCIAFSR_SMA) {
 693                reported++;
 694                printk("(Master Abort)");
 695        }
 696        if (afsr & SCHIZO_PCIAFSR_STA) {
 697                reported++;
 698                printk("(Target Abort)");
 699        }
 700        if (afsr & SCHIZO_PCIAFSR_SRTRY) {
 701                reported++;
 702                printk("(Excessive Retries)");
 703        }
 704        if (afsr & SCHIZO_PCIAFSR_SPERR) {
 705                reported++;
 706                printk("(Parity Error)");
 707        }
 708        if (afsr & SCHIZO_PCIAFSR_STTO) {
 709                reported++;
 710                printk("(Timeout)");
 711        }
 712        if (afsr & SCHIZO_PCIAFSR_SUNUS) {
 713                reported++;
 714                printk("(Bus Unusable)");
 715        }
 716        if (!reported)
 717                printk("(none)");
 718        printk("]\n");
 719
 720        /* For the error types shown, scan PBM's PCI bus for devices
 721         * which have logged that error type.
 722         */
 723
 724        /* If we see a Target Abort, this could be the result of an
 725         * IOMMU translation error of some sort.  It is extremely
 726         * useful to log this information as usually it indicates
 727         * a bug in the IOMMU support code or a PCI device driver.
 728         */
 729        if (error_bits & (SCHIZO_PCIAFSR_PTA | SCHIZO_PCIAFSR_STA)) {
 730                schizo_check_iommu_error(pbm, PCI_ERR);
 731                pci_scan_for_target_abort(pbm, pbm->pci_bus);
 732        }
 733        if (error_bits & (SCHIZO_PCIAFSR_PMA | SCHIZO_PCIAFSR_SMA))
 734                pci_scan_for_master_abort(pbm, pbm->pci_bus);
 735
 736        /* For excessive retries, PSYCHO/PBM will abort the device
 737         * and there is no way to specifically check for excessive
 738         * retries in the config space status registers.  So what
 739         * we hope is that we'll catch it via the master/target
 740         * abort events.
 741         */
 742
 743        if (error_bits & (SCHIZO_PCIAFSR_PPERR | SCHIZO_PCIAFSR_SPERR))
 744                pci_scan_for_parity_error(pbm, pbm->pci_bus);
 745
 746        return IRQ_HANDLED;
 747}
 748
 749#define SCHIZO_SAFARI_ERRLOG    0x10018UL
 750
 751#define SAFARI_ERRLOG_ERROUT    0x8000000000000000UL
 752
 753#define BUS_ERROR_BADCMD        0x4000000000000000UL /* Schizo/Tomatillo */
 754#define BUS_ERROR_SSMDIS        0x2000000000000000UL /* Safari */
 755#define BUS_ERROR_BADMA         0x1000000000000000UL /* Safari */
 756#define BUS_ERROR_BADMB         0x0800000000000000UL /* Safari */
 757#define BUS_ERROR_BADMC         0x0400000000000000UL /* Safari */
 758#define BUS_ERROR_SNOOP_GR      0x0000000000200000UL /* Tomatillo */
 759#define BUS_ERROR_SNOOP_PCI     0x0000000000100000UL /* Tomatillo */
 760#define BUS_ERROR_SNOOP_RD      0x0000000000080000UL /* Tomatillo */
 761#define BUS_ERROR_SNOOP_RDS     0x0000000000020000UL /* Tomatillo */
 762#define BUS_ERROR_SNOOP_RDSA    0x0000000000010000UL /* Tomatillo */
 763#define BUS_ERROR_SNOOP_OWN     0x0000000000008000UL /* Tomatillo */
 764#define BUS_ERROR_SNOOP_RDO     0x0000000000004000UL /* Tomatillo */
 765#define BUS_ERROR_CPU1PS        0x0000000000002000UL /* Safari */
 766#define BUS_ERROR_WDATA_PERR    0x0000000000002000UL /* Tomatillo */
 767#define BUS_ERROR_CPU1PB        0x0000000000001000UL /* Safari */
 768#define BUS_ERROR_CTRL_PERR     0x0000000000001000UL /* Tomatillo */
 769#define BUS_ERROR_CPU0PS        0x0000000000000800UL /* Safari */
 770#define BUS_ERROR_SNOOP_ERR     0x0000000000000800UL /* Tomatillo */
 771#define BUS_ERROR_CPU0PB        0x0000000000000400UL /* Safari */
 772#define BUS_ERROR_JBUS_ILL_B    0x0000000000000400UL /* Tomatillo */
 773#define BUS_ERROR_CIQTO         0x0000000000000200UL /* Safari */
 774#define BUS_ERROR_LPQTO         0x0000000000000100UL /* Safari */
 775#define BUS_ERROR_JBUS_ILL_C    0x0000000000000100UL /* Tomatillo */
 776#define BUS_ERROR_SFPQTO        0x0000000000000080UL /* Safari */
 777#define BUS_ERROR_UFPQTO        0x0000000000000040UL /* Safari */
 778#define BUS_ERROR_RD_PERR       0x0000000000000040UL /* Tomatillo */
 779#define BUS_ERROR_APERR         0x0000000000000020UL /* Safari/Tomatillo */
 780#define BUS_ERROR_UNMAP         0x0000000000000010UL /* Safari/Tomatillo */
 781#define BUS_ERROR_BUSERR        0x0000000000000004UL /* Safari/Tomatillo */
 782#define BUS_ERROR_TIMEOUT       0x0000000000000002UL /* Safari/Tomatillo */
 783#define BUS_ERROR_ILL           0x0000000000000001UL /* Safari */
 784
 785/* We only expect UNMAP errors here.  The rest of the Safari errors
 786 * are marked fatal and thus cause a system reset.
 787 */
 788static irqreturn_t schizo_safarierr_intr(int irq, void *dev_id)
 789{
 790        struct pci_pbm_info *pbm = dev_id;
 791        u64 errlog;
 792
 793        errlog = upa_readq(pbm->controller_regs + SCHIZO_SAFARI_ERRLOG);
 794        upa_writeq(errlog & ~(SAFARI_ERRLOG_ERROUT),
 795                   pbm->controller_regs + SCHIZO_SAFARI_ERRLOG);
 796
 797        if (!(errlog & BUS_ERROR_UNMAP)) {
 798                printk("%s: Unexpected Safari/JBUS error interrupt, errlog[%016llx]\n",
 799                       pbm->name, errlog);
 800
 801                return IRQ_HANDLED;
 802        }
 803
 804        printk("%s: Safari/JBUS interrupt, UNMAPPED error, interrogating IOMMUs.\n",
 805               pbm->name);
 806        schizo_check_iommu_error(pbm, SAFARI_ERR);
 807
 808        return IRQ_HANDLED;
 809}
 810
 811/* Nearly identical to PSYCHO equivalents... */
 812#define SCHIZO_ECC_CTRL         0x10020UL
 813#define  SCHIZO_ECCCTRL_EE       0x8000000000000000UL /* Enable ECC Checking */
 814#define  SCHIZO_ECCCTRL_UE       0x4000000000000000UL /* Enable UE Interrupts */
 815#define  SCHIZO_ECCCTRL_CE       0x2000000000000000UL /* Enable CE INterrupts */
 816
 817#define SCHIZO_SAFARI_ERRCTRL   0x10008UL
 818#define  SCHIZO_SAFERRCTRL_EN    0x8000000000000000UL
 819#define SCHIZO_SAFARI_IRQCTRL   0x10010UL
 820#define  SCHIZO_SAFIRQCTRL_EN    0x8000000000000000UL
 821
 822static int pbm_routes_this_ino(struct pci_pbm_info *pbm, u32 ino)
 823{
 824        ino &= IMAP_INO;
 825
 826        if (pbm->ino_bitmap & (1UL << ino))
 827                return 1;
 828
 829        return 0;
 830}
 831
 832/* How the Tomatillo IRQs are routed around is pure guesswork here.
 833 *
 834 * All the Tomatillo devices I see in prtconf dumps seem to have only
 835 * a single PCI bus unit attached to it.  It would seem they are separate
 836 * devices because their PortID (ie. JBUS ID) values are all different
 837 * and thus the registers are mapped to totally different locations.
 838 *
 839 * However, two Tomatillo's look "similar" in that the only difference
 840 * in their PortID is the lowest bit.
 841 *
 842 * So if we were to ignore this lower bit, it certainly looks like two
 843 * PCI bus units of the same Tomatillo.  I still have not really
 844 * figured this out...
 845 */
 846static void tomatillo_register_error_handlers(struct pci_pbm_info *pbm)
 847{
 848        struct platform_device *op = of_find_device_by_node(pbm->op->dev.of_node);
 849        u64 tmp, err_mask, err_no_mask;
 850        int err;
 851
 852        /* Tomatillo IRQ property layout is:
 853         * 0: PCIERR
 854         * 1: UE ERR
 855         * 2: CE ERR
 856         * 3: SERR
 857         * 4: POWER FAIL?
 858         */
 859
 860        if (pbm_routes_this_ino(pbm, SCHIZO_UE_INO)) {
 861                err = request_irq(op->archdata.irqs[1], schizo_ue_intr, 0,
 862                                  "TOMATILLO_UE", pbm);
 863                if (err)
 864                        printk(KERN_WARNING "%s: Could not register UE, "
 865                               "err=%d\n", pbm->name, err);
 866        }
 867        if (pbm_routes_this_ino(pbm, SCHIZO_CE_INO)) {
 868                err = request_irq(op->archdata.irqs[2], schizo_ce_intr, 0,
 869                                  "TOMATILLO_CE", pbm);
 870                if (err)
 871                        printk(KERN_WARNING "%s: Could not register CE, "
 872                               "err=%d\n", pbm->name, err);
 873        }
 874        err = 0;
 875        if (pbm_routes_this_ino(pbm, SCHIZO_PCIERR_A_INO)) {
 876                err = request_irq(op->archdata.irqs[0], schizo_pcierr_intr, 0,
 877                                  "TOMATILLO_PCIERR", pbm);
 878        } else if (pbm_routes_this_ino(pbm, SCHIZO_PCIERR_B_INO)) {
 879                err = request_irq(op->archdata.irqs[0], schizo_pcierr_intr, 0,
 880                                  "TOMATILLO_PCIERR", pbm);
 881        }
 882        if (err)
 883                printk(KERN_WARNING "%s: Could not register PCIERR, "
 884                       "err=%d\n", pbm->name, err);
 885
 886        if (pbm_routes_this_ino(pbm, SCHIZO_SERR_INO)) {
 887                err = request_irq(op->archdata.irqs[3], schizo_safarierr_intr, 0,
 888                                  "TOMATILLO_SERR", pbm);
 889                if (err)
 890                        printk(KERN_WARNING "%s: Could not register SERR, "
 891                               "err=%d\n", pbm->name, err);
 892        }
 893
 894        /* Enable UE and CE interrupts for controller. */
 895        upa_writeq((SCHIZO_ECCCTRL_EE |
 896                    SCHIZO_ECCCTRL_UE |
 897                    SCHIZO_ECCCTRL_CE), pbm->controller_regs + SCHIZO_ECC_CTRL);
 898
 899        /* Enable PCI Error interrupts and clear error
 900         * bits.
 901         */
 902        err_mask = (SCHIZO_PCICTRL_BUS_UNUS |
 903                    SCHIZO_PCICTRL_TTO_ERR |
 904                    SCHIZO_PCICTRL_RTRY_ERR |
 905                    SCHIZO_PCICTRL_SERR |
 906                    SCHIZO_PCICTRL_EEN);
 907
 908        err_no_mask = SCHIZO_PCICTRL_DTO_ERR;
 909
 910        tmp = upa_readq(pbm->pbm_regs + SCHIZO_PCI_CTRL);
 911        tmp |= err_mask;
 912        tmp &= ~err_no_mask;
 913        upa_writeq(tmp, pbm->pbm_regs + SCHIZO_PCI_CTRL);
 914
 915        err_mask = (SCHIZO_PCIAFSR_PMA | SCHIZO_PCIAFSR_PTA |
 916                    SCHIZO_PCIAFSR_PRTRY | SCHIZO_PCIAFSR_PPERR |
 917                    SCHIZO_PCIAFSR_PTTO |
 918                    SCHIZO_PCIAFSR_SMA | SCHIZO_PCIAFSR_STA |
 919                    SCHIZO_PCIAFSR_SRTRY | SCHIZO_PCIAFSR_SPERR |
 920                    SCHIZO_PCIAFSR_STTO);
 921
 922        upa_writeq(err_mask, pbm->pbm_regs + SCHIZO_PCI_AFSR);
 923
 924        err_mask = (BUS_ERROR_BADCMD | BUS_ERROR_SNOOP_GR |
 925                    BUS_ERROR_SNOOP_PCI | BUS_ERROR_SNOOP_RD |
 926                    BUS_ERROR_SNOOP_RDS | BUS_ERROR_SNOOP_RDSA |
 927                    BUS_ERROR_SNOOP_OWN | BUS_ERROR_SNOOP_RDO |
 928                    BUS_ERROR_WDATA_PERR | BUS_ERROR_CTRL_PERR |
 929                    BUS_ERROR_SNOOP_ERR | BUS_ERROR_JBUS_ILL_B |
 930                    BUS_ERROR_JBUS_ILL_C | BUS_ERROR_RD_PERR |
 931                    BUS_ERROR_APERR | BUS_ERROR_UNMAP |
 932                    BUS_ERROR_BUSERR | BUS_ERROR_TIMEOUT);
 933
 934        upa_writeq((SCHIZO_SAFERRCTRL_EN | err_mask),
 935                   pbm->controller_regs + SCHIZO_SAFARI_ERRCTRL);
 936
 937        upa_writeq((SCHIZO_SAFIRQCTRL_EN | (BUS_ERROR_UNMAP)),
 938                   pbm->controller_regs + SCHIZO_SAFARI_IRQCTRL);
 939}
 940
 941static void schizo_register_error_handlers(struct pci_pbm_info *pbm)
 942{
 943        struct platform_device *op = of_find_device_by_node(pbm->op->dev.of_node);
 944        u64 tmp, err_mask, err_no_mask;
 945        int err;
 946
 947        /* Schizo IRQ property layout is:
 948         * 0: PCIERR
 949         * 1: UE ERR
 950         * 2: CE ERR
 951         * 3: SERR
 952         * 4: POWER FAIL?
 953         */
 954
 955        if (pbm_routes_this_ino(pbm, SCHIZO_UE_INO)) {
 956                err = request_irq(op->archdata.irqs[1], schizo_ue_intr, 0,
 957                                  "SCHIZO_UE", pbm);
 958                if (err)
 959                        printk(KERN_WARNING "%s: Could not register UE, "
 960                               "err=%d\n", pbm->name, err);
 961        }
 962        if (pbm_routes_this_ino(pbm, SCHIZO_CE_INO)) {
 963                err = request_irq(op->archdata.irqs[2], schizo_ce_intr, 0,
 964                                  "SCHIZO_CE", pbm);
 965                if (err)
 966                        printk(KERN_WARNING "%s: Could not register CE, "
 967                               "err=%d\n", pbm->name, err);
 968        }
 969        err = 0;
 970        if (pbm_routes_this_ino(pbm, SCHIZO_PCIERR_A_INO)) {
 971                err = request_irq(op->archdata.irqs[0], schizo_pcierr_intr, 0,
 972                                  "SCHIZO_PCIERR", pbm);
 973        } else if (pbm_routes_this_ino(pbm, SCHIZO_PCIERR_B_INO)) {
 974                err = request_irq(op->archdata.irqs[0], schizo_pcierr_intr, 0,
 975                                  "SCHIZO_PCIERR", pbm);
 976        }
 977        if (err)
 978                printk(KERN_WARNING "%s: Could not register PCIERR, "
 979                       "err=%d\n", pbm->name, err);
 980
 981        if (pbm_routes_this_ino(pbm, SCHIZO_SERR_INO)) {
 982                err = request_irq(op->archdata.irqs[3], schizo_safarierr_intr, 0,
 983                                  "SCHIZO_SERR", pbm);
 984                if (err)
 985                        printk(KERN_WARNING "%s: Could not register SERR, "
 986                               "err=%d\n", pbm->name, err);
 987        }
 988
 989        /* Enable UE and CE interrupts for controller. */
 990        upa_writeq((SCHIZO_ECCCTRL_EE |
 991                    SCHIZO_ECCCTRL_UE |
 992                    SCHIZO_ECCCTRL_CE), pbm->controller_regs + SCHIZO_ECC_CTRL);
 993
 994        err_mask = (SCHIZO_PCICTRL_BUS_UNUS |
 995                    SCHIZO_PCICTRL_ESLCK |
 996                    SCHIZO_PCICTRL_TTO_ERR |
 997                    SCHIZO_PCICTRL_RTRY_ERR |
 998                    SCHIZO_PCICTRL_SBH_ERR |
 999                    SCHIZO_PCICTRL_SERR |
1000                    SCHIZO_PCICTRL_EEN);
1001
1002        err_no_mask = (SCHIZO_PCICTRL_DTO_ERR |
1003                       SCHIZO_PCICTRL_SBH_INT);
1004
1005        /* Enable PCI Error interrupts and clear error
1006         * bits for each PBM.
1007         */
1008        tmp = upa_readq(pbm->pbm_regs + SCHIZO_PCI_CTRL);
1009        tmp |= err_mask;
1010        tmp &= ~err_no_mask;
1011        upa_writeq(tmp, pbm->pbm_regs + SCHIZO_PCI_CTRL);
1012
1013        upa_writeq((SCHIZO_PCIAFSR_PMA | SCHIZO_PCIAFSR_PTA |
1014                    SCHIZO_PCIAFSR_PRTRY | SCHIZO_PCIAFSR_PPERR |
1015                    SCHIZO_PCIAFSR_PTTO | SCHIZO_PCIAFSR_PUNUS |
1016                    SCHIZO_PCIAFSR_SMA | SCHIZO_PCIAFSR_STA |
1017                    SCHIZO_PCIAFSR_SRTRY | SCHIZO_PCIAFSR_SPERR |
1018                    SCHIZO_PCIAFSR_STTO | SCHIZO_PCIAFSR_SUNUS),
1019                   pbm->pbm_regs + SCHIZO_PCI_AFSR);
1020
1021        /* Make all Safari error conditions fatal except unmapped
1022         * errors which we make generate interrupts.
1023         */
1024        err_mask = (BUS_ERROR_BADCMD | BUS_ERROR_SSMDIS |
1025                    BUS_ERROR_BADMA | BUS_ERROR_BADMB |
1026                    BUS_ERROR_BADMC |
1027                    BUS_ERROR_CPU1PS | BUS_ERROR_CPU1PB |
1028                    BUS_ERROR_CPU0PS | BUS_ERROR_CPU0PB |
1029                    BUS_ERROR_CIQTO |
1030                    BUS_ERROR_LPQTO | BUS_ERROR_SFPQTO |
1031                    BUS_ERROR_UFPQTO | BUS_ERROR_APERR |
1032                    BUS_ERROR_BUSERR | BUS_ERROR_TIMEOUT |
1033                    BUS_ERROR_ILL);
1034#if 1
1035        /* XXX Something wrong with some Excalibur systems
1036         * XXX Sun is shipping.  The behavior on a 2-cpu
1037         * XXX machine is that both CPU1 parity error bits
1038         * XXX are set and are immediately set again when
1039         * XXX their error status bits are cleared.  Just
1040         * XXX ignore them for now.  -DaveM
1041         */
1042        err_mask &= ~(BUS_ERROR_CPU1PS | BUS_ERROR_CPU1PB |
1043                      BUS_ERROR_CPU0PS | BUS_ERROR_CPU0PB);
1044#endif
1045
1046        upa_writeq((SCHIZO_SAFERRCTRL_EN | err_mask),
1047                   pbm->controller_regs + SCHIZO_SAFARI_ERRCTRL);
1048}
1049
1050static void pbm_config_busmastering(struct pci_pbm_info *pbm)
1051{
1052        u8 *addr;
1053
1054        /* Set cache-line size to 64 bytes, this is actually
1055         * a nop but I do it for completeness.
1056         */
1057        addr = schizo_pci_config_mkaddr(pbm, pbm->pci_first_busno,
1058                                        0, PCI_CACHE_LINE_SIZE);
1059        pci_config_write8(addr, 64 / sizeof(u32));
1060
1061        /* Set PBM latency timer to 64 PCI clocks. */
1062        addr = schizo_pci_config_mkaddr(pbm, pbm->pci_first_busno,
1063                                        0, PCI_LATENCY_TIMER);
1064        pci_config_write8(addr, 64);
1065}
1066
1067static void schizo_scan_bus(struct pci_pbm_info *pbm, struct device *parent)
1068{
1069        pbm_config_busmastering(pbm);
1070        pbm->is_66mhz_capable =
1071                (of_find_property(pbm->op->dev.of_node, "66mhz-capable", NULL)
1072                 != NULL);
1073
1074        pbm->pci_bus = pci_scan_one_pbm(pbm, parent);
1075
1076        if (pbm->chip_type == PBM_CHIP_TYPE_TOMATILLO)
1077                tomatillo_register_error_handlers(pbm);
1078        else
1079                schizo_register_error_handlers(pbm);
1080}
1081
1082#define SCHIZO_STRBUF_CONTROL           (0x02800UL)
1083#define SCHIZO_STRBUF_FLUSH             (0x02808UL)
1084#define SCHIZO_STRBUF_FSYNC             (0x02810UL)
1085#define SCHIZO_STRBUF_CTXFLUSH          (0x02818UL)
1086#define SCHIZO_STRBUF_CTXMATCH          (0x10000UL)
1087
1088static void schizo_pbm_strbuf_init(struct pci_pbm_info *pbm)
1089{
1090        unsigned long base = pbm->pbm_regs;
1091        u64 control;
1092
1093        if (pbm->chip_type == PBM_CHIP_TYPE_TOMATILLO) {
1094                /* TOMATILLO lacks streaming cache.  */
1095                return;
1096        }
1097
1098        /* SCHIZO has context flushing. */
1099        pbm->stc.strbuf_control         = base + SCHIZO_STRBUF_CONTROL;
1100        pbm->stc.strbuf_pflush          = base + SCHIZO_STRBUF_FLUSH;
1101        pbm->stc.strbuf_fsync           = base + SCHIZO_STRBUF_FSYNC;
1102        pbm->stc.strbuf_ctxflush        = base + SCHIZO_STRBUF_CTXFLUSH;
1103        pbm->stc.strbuf_ctxmatch_base   = base + SCHIZO_STRBUF_CTXMATCH;
1104
1105        pbm->stc.strbuf_flushflag = (volatile unsigned long *)
1106                ((((unsigned long)&pbm->stc.__flushflag_buf[0])
1107                  + 63UL)
1108                 & ~63UL);
1109        pbm->stc.strbuf_flushflag_pa = (unsigned long)
1110                __pa(pbm->stc.strbuf_flushflag);
1111
1112        /* Turn off LRU locking and diag mode, enable the
1113         * streaming buffer and leave the rerun-disable
1114         * setting however OBP set it.
1115         */
1116        control = upa_readq(pbm->stc.strbuf_control);
1117        control &= ~(SCHIZO_STRBUF_CTRL_LPTR |
1118                     SCHIZO_STRBUF_CTRL_LENAB |
1119                     SCHIZO_STRBUF_CTRL_DENAB);
1120        control |= SCHIZO_STRBUF_CTRL_ENAB;
1121        upa_writeq(control, pbm->stc.strbuf_control);
1122
1123        pbm->stc.strbuf_enabled = 1;
1124}
1125
1126#define SCHIZO_IOMMU_CONTROL            (0x00200UL)
1127#define SCHIZO_IOMMU_TSBBASE            (0x00208UL)
1128#define SCHIZO_IOMMU_FLUSH              (0x00210UL)
1129#define SCHIZO_IOMMU_CTXFLUSH           (0x00218UL)
1130
1131static int schizo_pbm_iommu_init(struct pci_pbm_info *pbm)
1132{
1133        static const u32 vdma_default[] = { 0xc0000000, 0x40000000 };
1134        unsigned long i, tagbase, database;
1135        struct iommu *iommu = pbm->iommu;
1136        int tsbsize, err;
1137        const u32 *vdma;
1138        u32 dma_mask;
1139        u64 control;
1140
1141        vdma = of_get_property(pbm->op->dev.of_node, "virtual-dma", NULL);
1142        if (!vdma)
1143                vdma = vdma_default;
1144
1145        dma_mask = vdma[0];
1146        switch (vdma[1]) {
1147                case 0x20000000:
1148                        dma_mask |= 0x1fffffff;
1149                        tsbsize = 64;
1150                        break;
1151
1152                case 0x40000000:
1153                        dma_mask |= 0x3fffffff;
1154                        tsbsize = 128;
1155                        break;
1156
1157                case 0x80000000:
1158                        dma_mask |= 0x7fffffff;
1159                        tsbsize = 128;
1160                        break;
1161
1162                default:
1163                        printk(KERN_ERR PFX "Strange virtual-dma size.\n");
1164                        return -EINVAL;
1165        }
1166
1167        /* Register addresses, SCHIZO has iommu ctx flushing. */
1168        iommu->iommu_control  = pbm->pbm_regs + SCHIZO_IOMMU_CONTROL;
1169        iommu->iommu_tsbbase  = pbm->pbm_regs + SCHIZO_IOMMU_TSBBASE;
1170        iommu->iommu_flush    = pbm->pbm_regs + SCHIZO_IOMMU_FLUSH;
1171        iommu->iommu_tags     = iommu->iommu_flush + (0xa580UL - 0x0210UL);
1172        iommu->iommu_ctxflush = pbm->pbm_regs + SCHIZO_IOMMU_CTXFLUSH;
1173
1174        /* We use the main control/status register of SCHIZO as the write
1175         * completion register.
1176         */
1177        iommu->write_complete_reg = pbm->controller_regs + 0x10000UL;
1178
1179        /*
1180         * Invalidate TLB Entries.
1181         */
1182        control = upa_readq(iommu->iommu_control);
1183        control |= SCHIZO_IOMMU_CTRL_DENAB;
1184        upa_writeq(control, iommu->iommu_control);
1185
1186        tagbase = SCHIZO_IOMMU_TAG, database = SCHIZO_IOMMU_DATA;
1187
1188        for (i = 0; i < 16; i++) {
1189                upa_writeq(0, pbm->pbm_regs + tagbase + (i * 8UL));
1190                upa_writeq(0, pbm->pbm_regs + database + (i * 8UL));
1191        }
1192
1193        /* Leave diag mode enabled for full-flushing done
1194         * in pci_iommu.c
1195         */
1196        err = iommu_table_init(iommu, tsbsize * 8 * 1024, vdma[0], dma_mask,
1197                               pbm->numa_node);
1198        if (err) {
1199                printk(KERN_ERR PFX "iommu_table_init() fails with %d\n", err);
1200                return err;
1201        }
1202
1203        upa_writeq(__pa(iommu->page_table), iommu->iommu_tsbbase);
1204
1205        control = upa_readq(iommu->iommu_control);
1206        control &= ~(SCHIZO_IOMMU_CTRL_TSBSZ | SCHIZO_IOMMU_CTRL_TBWSZ);
1207        switch (tsbsize) {
1208        case 64:
1209                control |= SCHIZO_IOMMU_TSBSZ_64K;
1210                break;
1211        case 128:
1212                control |= SCHIZO_IOMMU_TSBSZ_128K;
1213                break;
1214        }
1215
1216        control |= SCHIZO_IOMMU_CTRL_ENAB;
1217        upa_writeq(control, iommu->iommu_control);
1218
1219        return 0;
1220}
1221
1222#define SCHIZO_PCI_IRQ_RETRY    (0x1a00UL)
1223#define  SCHIZO_IRQ_RETRY_INF    0xffUL
1224
1225#define SCHIZO_PCI_DIAG                 (0x2020UL)
1226#define  SCHIZO_PCIDIAG_D_BADECC        (1UL << 10UL) /* Disable BAD ECC errors (Schizo) */
1227#define  SCHIZO_PCIDIAG_D_BYPASS        (1UL <<  9UL) /* Disable MMU bypass mode (Schizo/Tomatillo) */
1228#define  SCHIZO_PCIDIAG_D_TTO           (1UL <<  8UL) /* Disable TTO errors (Schizo/Tomatillo) */
1229#define  SCHIZO_PCIDIAG_D_RTRYARB       (1UL <<  7UL) /* Disable retry arbitration (Schizo) */
1230#define  SCHIZO_PCIDIAG_D_RETRY         (1UL <<  6UL) /* Disable retry limit (Schizo/Tomatillo) */
1231#define  SCHIZO_PCIDIAG_D_INTSYNC       (1UL <<  5UL) /* Disable interrupt/DMA synch (Schizo/Tomatillo) */
1232#define  SCHIZO_PCIDIAG_I_DMA_PARITY    (1UL <<  3UL) /* Invert DMA parity (Schizo/Tomatillo) */
1233#define  SCHIZO_PCIDIAG_I_PIOD_PARITY   (1UL <<  2UL) /* Invert PIO data parity (Schizo/Tomatillo) */
1234#define  SCHIZO_PCIDIAG_I_PIOA_PARITY   (1UL <<  1UL) /* Invert PIO address parity (Schizo/Tomatillo) */
1235
1236#define TOMATILLO_PCI_IOC_CSR           (0x2248UL)
1237#define TOMATILLO_IOC_PART_WPENAB       0x0000000000080000UL
1238#define TOMATILLO_IOC_RDMULT_PENAB      0x0000000000040000UL
1239#define TOMATILLO_IOC_RDONE_PENAB       0x0000000000020000UL
1240#define TOMATILLO_IOC_RDLINE_PENAB      0x0000000000010000UL
1241#define TOMATILLO_IOC_RDMULT_PLEN       0x000000000000c000UL
1242#define TOMATILLO_IOC_RDMULT_PLEN_SHIFT 14UL
1243#define TOMATILLO_IOC_RDONE_PLEN        0x0000000000003000UL
1244#define TOMATILLO_IOC_RDONE_PLEN_SHIFT  12UL
1245#define TOMATILLO_IOC_RDLINE_PLEN       0x0000000000000c00UL
1246#define TOMATILLO_IOC_RDLINE_PLEN_SHIFT 10UL
1247#define TOMATILLO_IOC_PREF_OFF          0x00000000000003f8UL
1248#define TOMATILLO_IOC_PREF_OFF_SHIFT    3UL
1249#define TOMATILLO_IOC_RDMULT_CPENAB     0x0000000000000004UL
1250#define TOMATILLO_IOC_RDONE_CPENAB      0x0000000000000002UL
1251#define TOMATILLO_IOC_RDLINE_CPENAB     0x0000000000000001UL
1252
1253#define TOMATILLO_PCI_IOC_TDIAG         (0x2250UL)
1254#define TOMATILLO_PCI_IOC_DDIAG         (0x2290UL)
1255
1256static void schizo_pbm_hw_init(struct pci_pbm_info *pbm)
1257{
1258        u64 tmp;
1259
1260        upa_writeq(5, pbm->pbm_regs + SCHIZO_PCI_IRQ_RETRY);
1261
1262        tmp = upa_readq(pbm->pbm_regs + SCHIZO_PCI_CTRL);
1263
1264        /* Enable arbiter for all PCI slots.  */
1265        tmp |= 0xff;
1266
1267        if (pbm->chip_type == PBM_CHIP_TYPE_TOMATILLO &&
1268            pbm->chip_version >= 0x2)
1269                tmp |= 0x3UL << SCHIZO_PCICTRL_PTO_SHIFT;
1270
1271        if (!of_find_property(pbm->op->dev.of_node, "no-bus-parking", NULL))
1272                tmp |= SCHIZO_PCICTRL_PARK;
1273        else
1274                tmp &= ~SCHIZO_PCICTRL_PARK;
1275
1276        if (pbm->chip_type == PBM_CHIP_TYPE_TOMATILLO &&
1277            pbm->chip_version <= 0x1)
1278                tmp |= SCHIZO_PCICTRL_DTO_INT;
1279        else
1280                tmp &= ~SCHIZO_PCICTRL_DTO_INT;
1281
1282        if (pbm->chip_type == PBM_CHIP_TYPE_TOMATILLO)
1283                tmp |= (SCHIZO_PCICTRL_MRM_PREF |
1284                        SCHIZO_PCICTRL_RDO_PREF |
1285                        SCHIZO_PCICTRL_RDL_PREF);
1286
1287        upa_writeq(tmp, pbm->pbm_regs + SCHIZO_PCI_CTRL);
1288
1289        tmp = upa_readq(pbm->pbm_regs + SCHIZO_PCI_DIAG);
1290        tmp &= ~(SCHIZO_PCIDIAG_D_RTRYARB |
1291                 SCHIZO_PCIDIAG_D_RETRY |
1292                 SCHIZO_PCIDIAG_D_INTSYNC);
1293        upa_writeq(tmp, pbm->pbm_regs + SCHIZO_PCI_DIAG);
1294
1295        if (pbm->chip_type == PBM_CHIP_TYPE_TOMATILLO) {
1296                /* Clear prefetch lengths to workaround a bug in
1297                 * Jalapeno...
1298                 */
1299                tmp = (TOMATILLO_IOC_PART_WPENAB |
1300                       (1 << TOMATILLO_IOC_PREF_OFF_SHIFT) |
1301                       TOMATILLO_IOC_RDMULT_CPENAB |
1302                       TOMATILLO_IOC_RDONE_CPENAB |
1303                       TOMATILLO_IOC_RDLINE_CPENAB);
1304
1305                upa_writeq(tmp, pbm->pbm_regs + TOMATILLO_PCI_IOC_CSR);
1306        }
1307}
1308
1309static int schizo_pbm_init(struct pci_pbm_info *pbm,
1310                           struct platform_device *op, u32 portid,
1311                           int chip_type)
1312{
1313        const struct linux_prom64_registers *regs;
1314        struct device_node *dp = op->dev.of_node;
1315        const char *chipset_name;
1316        int err;
1317
1318        switch (chip_type) {
1319        case PBM_CHIP_TYPE_TOMATILLO:
1320                chipset_name = "TOMATILLO";
1321                break;
1322
1323        case PBM_CHIP_TYPE_SCHIZO_PLUS:
1324                chipset_name = "SCHIZO+";
1325                break;
1326
1327        case PBM_CHIP_TYPE_SCHIZO:
1328        default:
1329                chipset_name = "SCHIZO";
1330                break;
1331        }
1332
1333        /* For SCHIZO, three OBP regs:
1334         * 1) PBM controller regs
1335         * 2) Schizo front-end controller regs (same for both PBMs)
1336         * 3) PBM PCI config space
1337         *
1338         * For TOMATILLO, four OBP regs:
1339         * 1) PBM controller regs
1340         * 2) Tomatillo front-end controller regs
1341         * 3) PBM PCI config space
1342         * 4) Ichip regs
1343         */
1344        regs = of_get_property(dp, "reg", NULL);
1345
1346        pbm->next = pci_pbm_root;
1347        pci_pbm_root = pbm;
1348
1349        pbm->numa_node = -1;
1350
1351        pbm->pci_ops = &sun4u_pci_ops;
1352        pbm->config_space_reg_bits = 8;
1353
1354        pbm->index = pci_num_pbms++;
1355
1356        pbm->portid = portid;
1357        pbm->op = op;
1358
1359        pbm->chip_type = chip_type;
1360        pbm->chip_version = of_getintprop_default(dp, "version#", 0);
1361        pbm->chip_revision = of_getintprop_default(dp, "module-version#", 0);
1362
1363        pbm->pbm_regs = regs[0].phys_addr;
1364        pbm->controller_regs = regs[1].phys_addr - 0x10000UL;
1365
1366        if (chip_type == PBM_CHIP_TYPE_TOMATILLO)
1367                pbm->sync_reg = regs[3].phys_addr + 0x1a18UL;
1368
1369        pbm->name = dp->full_name;
1370
1371        printk("%s: %s PCI Bus Module ver[%x:%x]\n",
1372               pbm->name, chipset_name,
1373               pbm->chip_version, pbm->chip_revision);
1374
1375        schizo_pbm_hw_init(pbm);
1376
1377        pci_determine_mem_io_space(pbm);
1378
1379        pci_get_pbm_props(pbm);
1380
1381        err = schizo_pbm_iommu_init(pbm);
1382        if (err)
1383                return err;
1384
1385        schizo_pbm_strbuf_init(pbm);
1386
1387        schizo_scan_bus(pbm, &op->dev);
1388
1389        return 0;
1390}
1391
1392static inline int portid_compare(u32 x, u32 y, int chip_type)
1393{
1394        if (chip_type == PBM_CHIP_TYPE_TOMATILLO) {
1395                if (x == (y ^ 1))
1396                        return 1;
1397                return 0;
1398        }
1399        return (x == y);
1400}
1401
1402static struct pci_pbm_info *schizo_find_sibling(u32 portid, int chip_type)
1403{
1404        struct pci_pbm_info *pbm;
1405
1406        for (pbm = pci_pbm_root; pbm; pbm = pbm->next) {
1407                if (portid_compare(pbm->portid, portid, chip_type))
1408                        return pbm;
1409        }
1410        return NULL;
1411}
1412
1413static int __schizo_init(struct platform_device *op, unsigned long chip_type)
1414{
1415        struct device_node *dp = op->dev.of_node;
1416        struct pci_pbm_info *pbm;
1417        struct iommu *iommu;
1418        u32 portid;
1419        int err;
1420
1421        portid = of_getintprop_default(dp, "portid", 0xff);
1422
1423        err = -ENOMEM;
1424        pbm = kzalloc(sizeof(*pbm), GFP_KERNEL);
1425        if (!pbm) {
1426                printk(KERN_ERR PFX "Cannot allocate pci_pbm_info.\n");
1427                goto out_err;
1428        }
1429
1430        pbm->sibling = schizo_find_sibling(portid, chip_type);
1431
1432        iommu = kzalloc(sizeof(struct iommu), GFP_KERNEL);
1433        if (!iommu) {
1434                printk(KERN_ERR PFX "Cannot allocate PBM A iommu.\n");
1435                goto out_free_pbm;
1436        }
1437
1438        pbm->iommu = iommu;
1439
1440        if (schizo_pbm_init(pbm, op, portid, chip_type))
1441                goto out_free_iommu;
1442
1443        if (pbm->sibling)
1444                pbm->sibling->sibling = pbm;
1445
1446        dev_set_drvdata(&op->dev, pbm);
1447
1448        return 0;
1449
1450out_free_iommu:
1451        kfree(pbm->iommu);
1452
1453out_free_pbm:
1454        kfree(pbm);
1455
1456out_err:
1457        return err;
1458}
1459
1460static const struct of_device_id schizo_match[];
1461static int schizo_probe(struct platform_device *op)
1462{
1463        const struct of_device_id *match;
1464
1465        match = of_match_device(schizo_match, &op->dev);
1466        if (!match)
1467                return -EINVAL;
1468        return __schizo_init(op, (unsigned long)match->data);
1469}
1470
1471/* The ordering of this table is very important.  Some Tomatillo
1472 * nodes announce that they are compatible with both pci108e,a801
1473 * and pci108e,8001.  So list the chips in reverse chronological
1474 * order.
1475 */
1476static const struct of_device_id schizo_match[] = {
1477        {
1478                .name = "pci",
1479                .compatible = "pci108e,a801",
1480                .data = (void *) PBM_CHIP_TYPE_TOMATILLO,
1481        },
1482        {
1483                .name = "pci",
1484                .compatible = "pci108e,8002",
1485                .data = (void *) PBM_CHIP_TYPE_SCHIZO_PLUS,
1486        },
1487        {
1488                .name = "pci",
1489                .compatible = "pci108e,8001",
1490                .data = (void *) PBM_CHIP_TYPE_SCHIZO,
1491        },
1492        {},
1493};
1494
1495static struct platform_driver schizo_driver = {
1496        .driver = {
1497                .name = DRIVER_NAME,
1498                .of_match_table = schizo_match,
1499        },
1500        .probe          = schizo_probe,
1501};
1502
1503static int __init schizo_init(void)
1504{
1505        return platform_driver_register(&schizo_driver);
1506}
1507
1508subsys_initcall(schizo_init);
1509