?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
iommu/msm: Add iommu_group support
[linux/fpc-iii.git] / arch / sparc / kernel / pci_schizo.c
blobc664d3e3aa8da138ee3fa5234762a217401a5f13
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
78 static 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. */
92 enum schizo_error_type {
93 UE_ERR, CE_ERR, PCI_ERR, SAFARI_ERR
94 };
95
96 static DEFINE_SPINLOCK(stc_buf_lock);
97 static unsigned long stc_error_buf[128];
98 static unsigned long stc_tag_buf[16];
99 static 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
126 static 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
234 static 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
344 static 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
371 static 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
459 static 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
580 static 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
634 static 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 */
788 static 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
822 static 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 */
846 static 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
941 static 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
1050 static 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
1067 static 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
1088 static 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
1131 static 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
1256 static 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
1309 static 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
1392 static 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
1402 static 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
1413 static 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
1450 out_free_iommu:
1451 kfree(pbm->iommu);
1452
1453 out_free_pbm:
1454 kfree(pbm);
1455
1456 out_err:
1457 return err;
1458 }
1459
1460 static const struct of_device_id schizo_match[];
1461 static 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 */
1476 static 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
1495 static struct platform_driver schizo_driver = {
1496 .driver = {
1497 .name = DRIVER_NAME,
1498 .of_match_table = schizo_match,
1499 },
1500 .probe = schizo_probe,
1501 };
1502
1503 static int __init schizo_init(void)
1504 {
1505 return platform_driver_register(&schizo_driver);
1506 }
1507
1508 subsys_initcall(schizo_init);
Linux with added FPC-III support