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