Linux Audio

Check our new training course

Loading...
v3.1
  1/*
  2 * Carsten Langgaard, carstenl@mips.com
  3 * Copyright (C) 2000, 2001, 2004 MIPS Technologies, Inc.
  4 * Copyright (C) 2001 Ralf Baechle
  5 *
  6 *  This program is free software; you can distribute it and/or modify it
  7 *  under the terms of the GNU General Public License (Version 2) as
  8 *  published by the Free Software Foundation.
  9 *
 10 *  This program is distributed in the hope it will be useful, but WITHOUT
 11 *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 12 *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
 13 *  for more details.
 14 *
 15 *  You should have received a copy of the GNU General Public License along
 16 *  with this program; if not, write to the Free Software Foundation, Inc.,
 17 *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
 18 *
 19 * Routines for generic manipulation of the interrupts found on the MIPS
 20 * Malta board.
 21 * The interrupt controller is located in the South Bridge a PIIX4 device
 22 * with two internal 82C95 interrupt controllers.
 23 */
 24#include <linux/init.h>
 25#include <linux/irq.h>
 26#include <linux/sched.h>
 27#include <linux/smp.h>
 28#include <linux/interrupt.h>
 29#include <linux/io.h>
 30#include <linux/kernel_stat.h>
 31#include <linux/kernel.h>
 32#include <linux/random.h>
 33
 34#include <asm/traps.h>
 35#include <asm/i8259.h>
 36#include <asm/irq_cpu.h>
 37#include <asm/irq_regs.h>
 38#include <asm/mips-boards/malta.h>
 39#include <asm/mips-boards/maltaint.h>
 40#include <asm/mips-boards/piix4.h>
 41#include <asm/gt64120.h>
 42#include <asm/mips-boards/generic.h>
 43#include <asm/mips-boards/msc01_pci.h>
 44#include <asm/msc01_ic.h>
 45#include <asm/gic.h>
 46#include <asm/gcmpregs.h>
 
 47
 48int gcmp_present = -1;
 49int gic_present;
 50static unsigned long _msc01_biu_base;
 51static unsigned long _gcmp_base;
 52static unsigned int ipi_map[NR_CPUS];
 53
 54static DEFINE_RAW_SPINLOCK(mips_irq_lock);
 55
 56static inline int mips_pcibios_iack(void)
 57{
 58	int irq;
 59
 60	/*
 61	 * Determine highest priority pending interrupt by performing
 62	 * a PCI Interrupt Acknowledge cycle.
 63	 */
 64	switch (mips_revision_sconid) {
 65	case MIPS_REVISION_SCON_SOCIT:
 66	case MIPS_REVISION_SCON_ROCIT:
 67	case MIPS_REVISION_SCON_SOCITSC:
 68	case MIPS_REVISION_SCON_SOCITSCP:
 69		MSC_READ(MSC01_PCI_IACK, irq);
 70		irq &= 0xff;
 71		break;
 72	case MIPS_REVISION_SCON_GT64120:
 73		irq = GT_READ(GT_PCI0_IACK_OFS);
 74		irq &= 0xff;
 75		break;
 76	case MIPS_REVISION_SCON_BONITO:
 77		/* The following will generate a PCI IACK cycle on the
 78		 * Bonito controller. It's a little bit kludgy, but it
 79		 * was the easiest way to implement it in hardware at
 80		 * the given time.
 81		 */
 82		BONITO_PCIMAP_CFG = 0x20000;
 83
 84		/* Flush Bonito register block */
 85		(void) BONITO_PCIMAP_CFG;
 86		iob();    /* sync */
 87
 88		irq = __raw_readl((u32 *)_pcictrl_bonito_pcicfg);
 89		iob();    /* sync */
 90		irq &= 0xff;
 91		BONITO_PCIMAP_CFG = 0;
 92		break;
 93	default:
 94		printk(KERN_WARNING "Unknown system controller.\n");
 95		return -1;
 96	}
 97	return irq;
 98}
 99
100static inline int get_int(void)
101{
102	unsigned long flags;
103	int irq;
104	raw_spin_lock_irqsave(&mips_irq_lock, flags);
105
106	irq = mips_pcibios_iack();
107
108	/*
109	 * The only way we can decide if an interrupt is spurious
110	 * is by checking the 8259 registers.  This needs a spinlock
111	 * on an SMP system,  so leave it up to the generic code...
112	 */
113
114	raw_spin_unlock_irqrestore(&mips_irq_lock, flags);
115
116	return irq;
117}
118
119static void malta_hw0_irqdispatch(void)
120{
121	int irq;
122
123	irq = get_int();
124	if (irq < 0) {
125		/* interrupt has already been cleared */
126		return;
127	}
128
129	do_IRQ(MALTA_INT_BASE + irq);
130}
131
132static void malta_ipi_irqdispatch(void)
133{
134	int irq;
135
136	irq = gic_get_int();
137	if (irq < 0)
138		return;  /* interrupt has already been cleared */
139
140	do_IRQ(MIPS_GIC_IRQ_BASE + irq);
141}
142
143static void corehi_irqdispatch(void)
144{
145	unsigned int intedge, intsteer, pcicmd, pcibadaddr;
146	unsigned int pcimstat, intisr, inten, intpol;
147	unsigned int intrcause, datalo, datahi;
148	struct pt_regs *regs = get_irq_regs();
149
150	printk(KERN_EMERG "CoreHI interrupt, shouldn't happen, we die here!\n");
151	printk(KERN_EMERG "epc   : %08lx\nStatus: %08lx\n"
152			"Cause : %08lx\nbadVaddr : %08lx\n",
153			regs->cp0_epc, regs->cp0_status,
154			regs->cp0_cause, regs->cp0_badvaddr);
155
156	/* Read all the registers and then print them as there is a
157	   problem with interspersed printk's upsetting the Bonito controller.
158	   Do it for the others too.
159	*/
160
161	switch (mips_revision_sconid) {
162	case MIPS_REVISION_SCON_SOCIT:
163	case MIPS_REVISION_SCON_ROCIT:
164	case MIPS_REVISION_SCON_SOCITSC:
165	case MIPS_REVISION_SCON_SOCITSCP:
166		ll_msc_irq();
167		break;
168	case MIPS_REVISION_SCON_GT64120:
169		intrcause = GT_READ(GT_INTRCAUSE_OFS);
170		datalo = GT_READ(GT_CPUERR_ADDRLO_OFS);
171		datahi = GT_READ(GT_CPUERR_ADDRHI_OFS);
172		printk(KERN_EMERG "GT_INTRCAUSE = %08x\n", intrcause);
173		printk(KERN_EMERG "GT_CPUERR_ADDR = %02x%08x\n",
174				datahi, datalo);
175		break;
176	case MIPS_REVISION_SCON_BONITO:
177		pcibadaddr = BONITO_PCIBADADDR;
178		pcimstat = BONITO_PCIMSTAT;
179		intisr = BONITO_INTISR;
180		inten = BONITO_INTEN;
181		intpol = BONITO_INTPOL;
182		intedge = BONITO_INTEDGE;
183		intsteer = BONITO_INTSTEER;
184		pcicmd = BONITO_PCICMD;
185		printk(KERN_EMERG "BONITO_INTISR = %08x\n", intisr);
186		printk(KERN_EMERG "BONITO_INTEN = %08x\n", inten);
187		printk(KERN_EMERG "BONITO_INTPOL = %08x\n", intpol);
188		printk(KERN_EMERG "BONITO_INTEDGE = %08x\n", intedge);
189		printk(KERN_EMERG "BONITO_INTSTEER = %08x\n", intsteer);
190		printk(KERN_EMERG "BONITO_PCICMD = %08x\n", pcicmd);
191		printk(KERN_EMERG "BONITO_PCIBADADDR = %08x\n", pcibadaddr);
192		printk(KERN_EMERG "BONITO_PCIMSTAT = %08x\n", pcimstat);
193		break;
194	}
195
196	die("CoreHi interrupt", regs);
197}
198
199static inline int clz(unsigned long x)
200{
201	__asm__(
202	"	.set	push					\n"
203	"	.set	mips32					\n"
204	"	clz	%0, %1					\n"
205	"	.set	pop					\n"
206	: "=r" (x)
207	: "r" (x));
208
209	return x;
210}
211
212/*
213 * Version of ffs that only looks at bits 12..15.
214 */
215static inline unsigned int irq_ffs(unsigned int pending)
216{
217#if defined(CONFIG_CPU_MIPS32) || defined(CONFIG_CPU_MIPS64)
218	return -clz(pending) + 31 - CAUSEB_IP;
219#else
220	unsigned int a0 = 7;
221	unsigned int t0;
222
223	t0 = pending & 0xf000;
224	t0 = t0 < 1;
225	t0 = t0 << 2;
226	a0 = a0 - t0;
227	pending = pending << t0;
228
229	t0 = pending & 0xc000;
230	t0 = t0 < 1;
231	t0 = t0 << 1;
232	a0 = a0 - t0;
233	pending = pending << t0;
234
235	t0 = pending & 0x8000;
236	t0 = t0 < 1;
237	/* t0 = t0 << 2; */
238	a0 = a0 - t0;
239	/* pending = pending << t0; */
240
241	return a0;
242#endif
243}
244
245/*
246 * IRQs on the Malta board look basically (barring software IRQs which we
247 * don't use at all and all external interrupt sources are combined together
248 * on hardware interrupt 0 (MIPS IRQ 2)) like:
249 *
250 *	MIPS IRQ	Source
251 *      --------        ------
252 *             0	Software (ignored)
253 *             1        Software (ignored)
254 *             2        Combined hardware interrupt (hw0)
255 *             3        Hardware (ignored)
256 *             4        Hardware (ignored)
257 *             5        Hardware (ignored)
258 *             6        Hardware (ignored)
259 *             7        R4k timer (what we use)
260 *
261 * We handle the IRQ according to _our_ priority which is:
262 *
263 * Highest ----     R4k Timer
264 * Lowest  ----     Combined hardware interrupt
265 *
266 * then we just return, if multiple IRQs are pending then we will just take
267 * another exception, big deal.
268 */
269
270asmlinkage void plat_irq_dispatch(void)
271{
272	unsigned int pending = read_c0_cause() & read_c0_status() & ST0_IM;
273	int irq;
274
275	irq = irq_ffs(pending);
276
277	if (irq == MIPSCPU_INT_I8259A)
278		malta_hw0_irqdispatch();
279	else if (gic_present && ((1 << irq) & ipi_map[smp_processor_id()]))
280		malta_ipi_irqdispatch();
281	else if (irq >= 0)
282		do_IRQ(MIPS_CPU_IRQ_BASE + irq);
283	else
284		spurious_interrupt();
285}
286
287#ifdef CONFIG_MIPS_MT_SMP
288
289
290#define GIC_MIPS_CPU_IPI_RESCHED_IRQ	3
291#define GIC_MIPS_CPU_IPI_CALL_IRQ	4
292
293#define MIPS_CPU_IPI_RESCHED_IRQ 0	/* SW int 0 for resched */
294#define C_RESCHED C_SW0
295#define MIPS_CPU_IPI_CALL_IRQ 1		/* SW int 1 for resched */
296#define C_CALL C_SW1
297static int cpu_ipi_resched_irq, cpu_ipi_call_irq;
298
299static void ipi_resched_dispatch(void)
300{
301	do_IRQ(MIPS_CPU_IRQ_BASE + MIPS_CPU_IPI_RESCHED_IRQ);
302}
303
304static void ipi_call_dispatch(void)
305{
306	do_IRQ(MIPS_CPU_IRQ_BASE + MIPS_CPU_IPI_CALL_IRQ);
307}
308
309static irqreturn_t ipi_resched_interrupt(int irq, void *dev_id)
310{
311	scheduler_ipi();
312
313	return IRQ_HANDLED;
314}
315
316static irqreturn_t ipi_call_interrupt(int irq, void *dev_id)
317{
318	smp_call_function_interrupt();
319
320	return IRQ_HANDLED;
321}
322
323static struct irqaction irq_resched = {
324	.handler	= ipi_resched_interrupt,
325	.flags		= IRQF_DISABLED|IRQF_PERCPU,
326	.name		= "IPI_resched"
327};
328
329static struct irqaction irq_call = {
330	.handler	= ipi_call_interrupt,
331	.flags		= IRQF_DISABLED|IRQF_PERCPU,
332	.name		= "IPI_call"
333};
334#endif /* CONFIG_MIPS_MT_SMP */
335
336static int gic_resched_int_base;
337static int gic_call_int_base;
338#define GIC_RESCHED_INT(cpu) (gic_resched_int_base+(cpu))
339#define GIC_CALL_INT(cpu) (gic_call_int_base+(cpu))
340
341unsigned int plat_ipi_call_int_xlate(unsigned int cpu)
342{
343	return GIC_CALL_INT(cpu);
344}
345
346unsigned int plat_ipi_resched_int_xlate(unsigned int cpu)
347{
348	return GIC_RESCHED_INT(cpu);
349}
350
351static struct irqaction i8259irq = {
352	.handler = no_action,
353	.name = "XT-PIC cascade",
354	.flags = IRQF_NO_THREAD,
355};
356
357static struct irqaction corehi_irqaction = {
358	.handler = no_action,
359	.name = "CoreHi",
360	.flags = IRQF_NO_THREAD,
361};
362
363static msc_irqmap_t __initdata msc_irqmap[] = {
364	{MSC01C_INT_TMR,		MSC01_IRQ_EDGE, 0},
365	{MSC01C_INT_PCI,		MSC01_IRQ_LEVEL, 0},
366};
367static int __initdata msc_nr_irqs = ARRAY_SIZE(msc_irqmap);
368
369static msc_irqmap_t __initdata msc_eicirqmap[] = {
370	{MSC01E_INT_SW0,		MSC01_IRQ_LEVEL, 0},
371	{MSC01E_INT_SW1,		MSC01_IRQ_LEVEL, 0},
372	{MSC01E_INT_I8259A,		MSC01_IRQ_LEVEL, 0},
373	{MSC01E_INT_SMI,		MSC01_IRQ_LEVEL, 0},
374	{MSC01E_INT_COREHI,		MSC01_IRQ_LEVEL, 0},
375	{MSC01E_INT_CORELO,		MSC01_IRQ_LEVEL, 0},
376	{MSC01E_INT_TMR,		MSC01_IRQ_EDGE, 0},
377	{MSC01E_INT_PCI,		MSC01_IRQ_LEVEL, 0},
378	{MSC01E_INT_PERFCTR,		MSC01_IRQ_LEVEL, 0},
379	{MSC01E_INT_CPUCTR,		MSC01_IRQ_LEVEL, 0}
380};
381
382static int __initdata msc_nr_eicirqs = ARRAY_SIZE(msc_eicirqmap);
383
384/*
385 * This GIC specific tabular array defines the association between External
386 * Interrupts and CPUs/Core Interrupts. The nature of the External
387 * Interrupts is also defined here - polarity/trigger.
388 */
389
390#define GIC_CPU_NMI GIC_MAP_TO_NMI_MSK
391#define X GIC_UNUSED
392
393static struct gic_intr_map gic_intr_map[GIC_NUM_INTRS] = {
394	{ X, X,		   X,		X,		0 },
395	{ X, X,		   X,	 	X,		0 },
396	{ X, X,		   X,		X,		0 },
397	{ 0, GIC_CPU_INT0, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
398	{ 0, GIC_CPU_INT1, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
399	{ 0, GIC_CPU_INT2, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
400	{ 0, GIC_CPU_INT3, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
401	{ 0, GIC_CPU_INT4, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
402	{ 0, GIC_CPU_INT3, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
403	{ 0, GIC_CPU_INT3, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
404	{ X, X,		   X,		X,		0 },
405	{ X, X,		   X,		X,		0 },
406	{ 0, GIC_CPU_INT3, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
407	{ 0, GIC_CPU_NMI,  GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
408	{ 0, GIC_CPU_NMI,  GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
409	{ X, X,		   X,		X,	        0 },
410	/* The remainder of this table is initialised by fill_ipi_map */
411};
412#undef X
413
414/*
415 * GCMP needs to be detected before any SMP initialisation
416 */
417int __init gcmp_probe(unsigned long addr, unsigned long size)
418{
419	if (mips_revision_sconid != MIPS_REVISION_SCON_ROCIT) {
420		gcmp_present = 0;
421		return gcmp_present;
422	}
423
424	if (gcmp_present >= 0)
425		return gcmp_present;
426
427	_gcmp_base = (unsigned long) ioremap_nocache(GCMP_BASE_ADDR, GCMP_ADDRSPACE_SZ);
428	_msc01_biu_base = (unsigned long) ioremap_nocache(MSC01_BIU_REG_BASE, MSC01_BIU_ADDRSPACE_SZ);
429	gcmp_present = (GCMPGCB(GCMPB) & GCMP_GCB_GCMPB_GCMPBASE_MSK) == GCMP_BASE_ADDR;
430
431	if (gcmp_present)
432		pr_debug("GCMP present\n");
433	return gcmp_present;
434}
435
436/* Return the number of IOCU's present */
437int __init gcmp_niocu(void)
438{
439  return gcmp_present ?
440    (GCMPGCB(GC) & GCMP_GCB_GC_NUMIOCU_MSK) >> GCMP_GCB_GC_NUMIOCU_SHF :
441    0;
442}
443
444/* Set GCMP region attributes */
445void __init gcmp_setregion(int region, unsigned long base,
446			   unsigned long mask, int type)
447{
448	GCMPGCBn(CMxBASE, region) = base;
449	GCMPGCBn(CMxMASK, region) = mask | type;
450}
451
452#if defined(CONFIG_MIPS_MT_SMP)
453static void __init fill_ipi_map1(int baseintr, int cpu, int cpupin)
454{
455	int intr = baseintr + cpu;
456	gic_intr_map[intr].cpunum = cpu;
457	gic_intr_map[intr].pin = cpupin;
458	gic_intr_map[intr].polarity = GIC_POL_POS;
459	gic_intr_map[intr].trigtype = GIC_TRIG_EDGE;
460	gic_intr_map[intr].flags = GIC_FLAG_IPI;
461	ipi_map[cpu] |= (1 << (cpupin + 2));
462}
463
464static void __init fill_ipi_map(void)
465{
466	int cpu;
467
468	for (cpu = 0; cpu < NR_CPUS; cpu++) {
469		fill_ipi_map1(gic_resched_int_base, cpu, GIC_CPU_INT1);
470		fill_ipi_map1(gic_call_int_base, cpu, GIC_CPU_INT2);
471	}
472}
473#endif
474
475void __init arch_init_ipiirq(int irq, struct irqaction *action)
476{
477	setup_irq(irq, action);
478	irq_set_handler(irq, handle_percpu_irq);
479}
480
481void __init arch_init_irq(void)
482{
483	init_i8259_irqs();
484
485	if (!cpu_has_veic)
486		mips_cpu_irq_init();
487
488	if (gcmp_present)  {
489		GCMPGCB(GICBA) = GIC_BASE_ADDR | GCMP_GCB_GICBA_EN_MSK;
490		gic_present = 1;
491	} else {
492		if (mips_revision_sconid == MIPS_REVISION_SCON_ROCIT) {
493			_msc01_biu_base = (unsigned long)
494					ioremap_nocache(MSC01_BIU_REG_BASE,
495						MSC01_BIU_ADDRSPACE_SZ);
496			gic_present = (REG(_msc01_biu_base, MSC01_SC_CFG) &
497					MSC01_SC_CFG_GICPRES_MSK) >>
498					MSC01_SC_CFG_GICPRES_SHF;
499		}
500	}
501	if (gic_present)
502		pr_debug("GIC present\n");
503
504	switch (mips_revision_sconid) {
505	case MIPS_REVISION_SCON_SOCIT:
506	case MIPS_REVISION_SCON_ROCIT:
507		if (cpu_has_veic)
508			init_msc_irqs(MIPS_MSC01_IC_REG_BASE,
509					MSC01E_INT_BASE, msc_eicirqmap,
510					msc_nr_eicirqs);
511		else
512			init_msc_irqs(MIPS_MSC01_IC_REG_BASE,
513					MSC01C_INT_BASE, msc_irqmap,
514					msc_nr_irqs);
515		break;
516
517	case MIPS_REVISION_SCON_SOCITSC:
518	case MIPS_REVISION_SCON_SOCITSCP:
519		if (cpu_has_veic)
520			init_msc_irqs(MIPS_SOCITSC_IC_REG_BASE,
521					MSC01E_INT_BASE, msc_eicirqmap,
522					msc_nr_eicirqs);
523		else
524			init_msc_irqs(MIPS_SOCITSC_IC_REG_BASE,
525					MSC01C_INT_BASE, msc_irqmap,
526					msc_nr_irqs);
527	}
528
529	if (cpu_has_veic) {
530		set_vi_handler(MSC01E_INT_I8259A, malta_hw0_irqdispatch);
531		set_vi_handler(MSC01E_INT_COREHI, corehi_irqdispatch);
532		setup_irq(MSC01E_INT_BASE+MSC01E_INT_I8259A, &i8259irq);
533		setup_irq(MSC01E_INT_BASE+MSC01E_INT_COREHI, &corehi_irqaction);
534	} else if (cpu_has_vint) {
535		set_vi_handler(MIPSCPU_INT_I8259A, malta_hw0_irqdispatch);
536		set_vi_handler(MIPSCPU_INT_COREHI, corehi_irqdispatch);
537#ifdef CONFIG_MIPS_MT_SMTC
538		setup_irq_smtc(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_I8259A, &i8259irq,
539			(0x100 << MIPSCPU_INT_I8259A));
540		setup_irq_smtc(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_COREHI,
541			&corehi_irqaction, (0x100 << MIPSCPU_INT_COREHI));
542		/*
543		 * Temporary hack to ensure that the subsidiary device
544		 * interrupts coing in via the i8259A, but associated
545		 * with low IRQ numbers, will restore the Status.IM
546		 * value associated with the i8259A.
547		 */
548		{
549			int i;
550
551			for (i = 0; i < 16; i++)
552				irq_hwmask[i] = (0x100 << MIPSCPU_INT_I8259A);
553		}
554#else /* Not SMTC */
555		setup_irq(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_I8259A, &i8259irq);
556		setup_irq(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_COREHI,
557						&corehi_irqaction);
558#endif /* CONFIG_MIPS_MT_SMTC */
559	} else {
560		setup_irq(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_I8259A, &i8259irq);
561		setup_irq(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_COREHI,
562						&corehi_irqaction);
563	}
564
565	if (gic_present) {
566		/* FIXME */
567		int i;
568#if defined(CONFIG_MIPS_MT_SMP)
569		gic_call_int_base = GIC_NUM_INTRS - NR_CPUS;
570		gic_resched_int_base = gic_call_int_base - NR_CPUS;
571		fill_ipi_map();
572#endif
573		gic_init(GIC_BASE_ADDR, GIC_ADDRSPACE_SZ, gic_intr_map,
574				ARRAY_SIZE(gic_intr_map), MIPS_GIC_IRQ_BASE);
575		if (!gcmp_present) {
576			/* Enable the GIC */
577			i = REG(_msc01_biu_base, MSC01_SC_CFG);
578			REG(_msc01_biu_base, MSC01_SC_CFG) =
579				(i | (0x1 << MSC01_SC_CFG_GICENA_SHF));
580			pr_debug("GIC Enabled\n");
581		}
582#if defined(CONFIG_MIPS_MT_SMP)
583		/* set up ipi interrupts */
584		if (cpu_has_vint) {
585			set_vi_handler(MIPSCPU_INT_IPI0, malta_ipi_irqdispatch);
586			set_vi_handler(MIPSCPU_INT_IPI1, malta_ipi_irqdispatch);
587		}
588		/* Argh.. this really needs sorting out.. */
589		printk("CPU%d: status register was %08x\n", smp_processor_id(), read_c0_status());
590		write_c0_status(read_c0_status() | STATUSF_IP3 | STATUSF_IP4);
591		printk("CPU%d: status register now %08x\n", smp_processor_id(), read_c0_status());
592		write_c0_status(0x1100dc00);
593		printk("CPU%d: status register frc %08x\n", smp_processor_id(), read_c0_status());
594		for (i = 0; i < NR_CPUS; i++) {
595			arch_init_ipiirq(MIPS_GIC_IRQ_BASE +
596					 GIC_RESCHED_INT(i), &irq_resched);
597			arch_init_ipiirq(MIPS_GIC_IRQ_BASE +
598					 GIC_CALL_INT(i), &irq_call);
599		}
600#endif
601	} else {
602#if defined(CONFIG_MIPS_MT_SMP)
603		/* set up ipi interrupts */
604		if (cpu_has_veic) {
605			set_vi_handler (MSC01E_INT_SW0, ipi_resched_dispatch);
606			set_vi_handler (MSC01E_INT_SW1, ipi_call_dispatch);
607			cpu_ipi_resched_irq = MSC01E_INT_SW0;
608			cpu_ipi_call_irq = MSC01E_INT_SW1;
609		} else {
610			if (cpu_has_vint) {
611				set_vi_handler (MIPS_CPU_IPI_RESCHED_IRQ, ipi_resched_dispatch);
612				set_vi_handler (MIPS_CPU_IPI_CALL_IRQ, ipi_call_dispatch);
613			}
614			cpu_ipi_resched_irq = MIPS_CPU_IRQ_BASE + MIPS_CPU_IPI_RESCHED_IRQ;
615			cpu_ipi_call_irq = MIPS_CPU_IRQ_BASE + MIPS_CPU_IPI_CALL_IRQ;
616		}
617		arch_init_ipiirq(cpu_ipi_resched_irq, &irq_resched);
618		arch_init_ipiirq(cpu_ipi_call_irq, &irq_call);
619#endif
620	}
621}
622
623void malta_be_init(void)
624{
625	if (gcmp_present) {
626		/* Could change CM error mask register */
627	}
628}
629
630
631static char *tr[8] = {
632	"mem",	"gcr",	"gic",	"mmio",
633	"0x04",	"0x05",	"0x06",	"0x07"
634};
635
636static char *mcmd[32] = {
637	[0x00] = "0x00",
638	[0x01] = "Legacy Write",
639	[0x02] = "Legacy Read",
640	[0x03] = "0x03",
641	[0x04] = "0x04",
642	[0x05] = "0x05",
643	[0x06] = "0x06",
644	[0x07] = "0x07",
645	[0x08] = "Coherent Read Own",
646	[0x09] = "Coherent Read Share",
647	[0x0a] = "Coherent Read Discard",
648	[0x0b] = "Coherent Ready Share Always",
649	[0x0c] = "Coherent Upgrade",
650	[0x0d] = "Coherent Writeback",
651	[0x0e] = "0x0e",
652	[0x0f] = "0x0f",
653	[0x10] = "Coherent Copyback",
654	[0x11] = "Coherent Copyback Invalidate",
655	[0x12] = "Coherent Invalidate",
656	[0x13] = "Coherent Write Invalidate",
657	[0x14] = "Coherent Completion Sync",
658	[0x15] = "0x15",
659	[0x16] = "0x16",
660	[0x17] = "0x17",
661	[0x18] = "0x18",
662	[0x19] = "0x19",
663	[0x1a] = "0x1a",
664	[0x1b] = "0x1b",
665	[0x1c] = "0x1c",
666	[0x1d] = "0x1d",
667	[0x1e] = "0x1e",
668	[0x1f] = "0x1f"
669};
670
671static char *core[8] = {
672	"Invalid/OK", 	"Invalid/Data",
673	"Shared/OK",	"Shared/Data",
674	"Modified/OK",	"Modified/Data",
675	"Exclusive/OK",	"Exclusive/Data"
676};
677
678static char *causes[32] = {
679	"None", "GC_WR_ERR", "GC_RD_ERR", "COH_WR_ERR",
680	"COH_RD_ERR", "MMIO_WR_ERR", "MMIO_RD_ERR", "0x07",
681	"0x08", "0x09", "0x0a", "0x0b",
682	"0x0c", "0x0d", "0x0e", "0x0f",
683	"0x10", "0x11", "0x12", "0x13",
684	"0x14", "0x15", "0x16", "INTVN_WR_ERR",
685	"INTVN_RD_ERR", "0x19", "0x1a", "0x1b",
686	"0x1c", "0x1d", "0x1e", "0x1f"
687};
688
689int malta_be_handler(struct pt_regs *regs, int is_fixup)
690{
691	/* This duplicates the handling in do_be which seems wrong */
692	int retval = is_fixup ? MIPS_BE_FIXUP : MIPS_BE_FATAL;
693
694	if (gcmp_present) {
695		unsigned long cm_error = GCMPGCB(GCMEC);
696		unsigned long cm_addr = GCMPGCB(GCMEA);
697		unsigned long cm_other = GCMPGCB(GCMEO);
698		unsigned long cause, ocause;
699		char buf[256];
700
701		cause = (cm_error & GCMP_GCB_GMEC_ERROR_TYPE_MSK);
702		if (cause != 0) {
703			cause >>= GCMP_GCB_GMEC_ERROR_TYPE_SHF;
704			if (cause < 16) {
705				unsigned long cca_bits = (cm_error >> 15) & 7;
706				unsigned long tr_bits = (cm_error >> 12) & 7;
707				unsigned long mcmd_bits = (cm_error >> 7) & 0x1f;
708				unsigned long stag_bits = (cm_error >> 3) & 15;
709				unsigned long sport_bits = (cm_error >> 0) & 7;
710
711				snprintf(buf, sizeof(buf),
712					 "CCA=%lu TR=%s MCmd=%s STag=%lu "
713					 "SPort=%lu\n",
714					 cca_bits, tr[tr_bits], mcmd[mcmd_bits],
715					 stag_bits, sport_bits);
716			} else {
717				/* glob state & sresp together */
718				unsigned long c3_bits = (cm_error >> 18) & 7;
719				unsigned long c2_bits = (cm_error >> 15) & 7;
720				unsigned long c1_bits = (cm_error >> 12) & 7;
721				unsigned long c0_bits = (cm_error >> 9) & 7;
722				unsigned long sc_bit = (cm_error >> 8) & 1;
723				unsigned long mcmd_bits = (cm_error >> 3) & 0x1f;
724				unsigned long sport_bits = (cm_error >> 0) & 7;
725				snprintf(buf, sizeof(buf),
726					 "C3=%s C2=%s C1=%s C0=%s SC=%s "
727					 "MCmd=%s SPort=%lu\n",
728					 core[c3_bits], core[c2_bits],
729					 core[c1_bits], core[c0_bits],
730					 sc_bit ? "True" : "False",
731					 mcmd[mcmd_bits], sport_bits);
732			}
733
734			ocause = (cm_other & GCMP_GCB_GMEO_ERROR_2ND_MSK) >>
735				 GCMP_GCB_GMEO_ERROR_2ND_SHF;
736
737			printk("CM_ERROR=%08lx %s <%s>\n", cm_error,
738			       causes[cause], buf);
739			printk("CM_ADDR =%08lx\n", cm_addr);
740			printk("CM_OTHER=%08lx %s\n", cm_other, causes[ocause]);
741
742			/* reprime cause register */
743			GCMPGCB(GCMEC) = 0;
744		}
745	}
746
747	return retval;
748}
v3.5.6
  1/*
  2 * Carsten Langgaard, carstenl@mips.com
  3 * Copyright (C) 2000, 2001, 2004 MIPS Technologies, Inc.
  4 * Copyright (C) 2001 Ralf Baechle
  5 *
  6 *  This program is free software; you can distribute it and/or modify it
  7 *  under the terms of the GNU General Public License (Version 2) as
  8 *  published by the Free Software Foundation.
  9 *
 10 *  This program is distributed in the hope it will be useful, but WITHOUT
 11 *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 12 *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
 13 *  for more details.
 14 *
 15 *  You should have received a copy of the GNU General Public License along
 16 *  with this program; if not, write to the Free Software Foundation, Inc.,
 17 *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
 18 *
 19 * Routines for generic manipulation of the interrupts found on the MIPS
 20 * Malta board.
 21 * The interrupt controller is located in the South Bridge a PIIX4 device
 22 * with two internal 82C95 interrupt controllers.
 23 */
 24#include <linux/init.h>
 25#include <linux/irq.h>
 26#include <linux/sched.h>
 27#include <linux/smp.h>
 28#include <linux/interrupt.h>
 29#include <linux/io.h>
 30#include <linux/kernel_stat.h>
 31#include <linux/kernel.h>
 32#include <linux/random.h>
 33
 34#include <asm/traps.h>
 35#include <asm/i8259.h>
 36#include <asm/irq_cpu.h>
 37#include <asm/irq_regs.h>
 38#include <asm/mips-boards/malta.h>
 39#include <asm/mips-boards/maltaint.h>
 40#include <asm/mips-boards/piix4.h>
 41#include <asm/gt64120.h>
 42#include <asm/mips-boards/generic.h>
 43#include <asm/mips-boards/msc01_pci.h>
 44#include <asm/msc01_ic.h>
 45#include <asm/gic.h>
 46#include <asm/gcmpregs.h>
 47#include <asm/setup.h>
 48
 49int gcmp_present = -1;
 50int gic_present;
 51static unsigned long _msc01_biu_base;
 52static unsigned long _gcmp_base;
 53static unsigned int ipi_map[NR_CPUS];
 54
 55static DEFINE_RAW_SPINLOCK(mips_irq_lock);
 56
 57static inline int mips_pcibios_iack(void)
 58{
 59	int irq;
 60
 61	/*
 62	 * Determine highest priority pending interrupt by performing
 63	 * a PCI Interrupt Acknowledge cycle.
 64	 */
 65	switch (mips_revision_sconid) {
 66	case MIPS_REVISION_SCON_SOCIT:
 67	case MIPS_REVISION_SCON_ROCIT:
 68	case MIPS_REVISION_SCON_SOCITSC:
 69	case MIPS_REVISION_SCON_SOCITSCP:
 70		MSC_READ(MSC01_PCI_IACK, irq);
 71		irq &= 0xff;
 72		break;
 73	case MIPS_REVISION_SCON_GT64120:
 74		irq = GT_READ(GT_PCI0_IACK_OFS);
 75		irq &= 0xff;
 76		break;
 77	case MIPS_REVISION_SCON_BONITO:
 78		/* The following will generate a PCI IACK cycle on the
 79		 * Bonito controller. It's a little bit kludgy, but it
 80		 * was the easiest way to implement it in hardware at
 81		 * the given time.
 82		 */
 83		BONITO_PCIMAP_CFG = 0x20000;
 84
 85		/* Flush Bonito register block */
 86		(void) BONITO_PCIMAP_CFG;
 87		iob();    /* sync */
 88
 89		irq = __raw_readl((u32 *)_pcictrl_bonito_pcicfg);
 90		iob();    /* sync */
 91		irq &= 0xff;
 92		BONITO_PCIMAP_CFG = 0;
 93		break;
 94	default:
 95		printk(KERN_WARNING "Unknown system controller.\n");
 96		return -1;
 97	}
 98	return irq;
 99}
100
101static inline int get_int(void)
102{
103	unsigned long flags;
104	int irq;
105	raw_spin_lock_irqsave(&mips_irq_lock, flags);
106
107	irq = mips_pcibios_iack();
108
109	/*
110	 * The only way we can decide if an interrupt is spurious
111	 * is by checking the 8259 registers.  This needs a spinlock
112	 * on an SMP system,  so leave it up to the generic code...
113	 */
114
115	raw_spin_unlock_irqrestore(&mips_irq_lock, flags);
116
117	return irq;
118}
119
120static void malta_hw0_irqdispatch(void)
121{
122	int irq;
123
124	irq = get_int();
125	if (irq < 0) {
126		/* interrupt has already been cleared */
127		return;
128	}
129
130	do_IRQ(MALTA_INT_BASE + irq);
131}
132
133static void malta_ipi_irqdispatch(void)
134{
135	int irq;
136
137	irq = gic_get_int();
138	if (irq < 0)
139		return;  /* interrupt has already been cleared */
140
141	do_IRQ(MIPS_GIC_IRQ_BASE + irq);
142}
143
144static void corehi_irqdispatch(void)
145{
146	unsigned int intedge, intsteer, pcicmd, pcibadaddr;
147	unsigned int pcimstat, intisr, inten, intpol;
148	unsigned int intrcause, datalo, datahi;
149	struct pt_regs *regs = get_irq_regs();
150
151	printk(KERN_EMERG "CoreHI interrupt, shouldn't happen, we die here!\n");
152	printk(KERN_EMERG "epc   : %08lx\nStatus: %08lx\n"
153			"Cause : %08lx\nbadVaddr : %08lx\n",
154			regs->cp0_epc, regs->cp0_status,
155			regs->cp0_cause, regs->cp0_badvaddr);
156
157	/* Read all the registers and then print them as there is a
158	   problem with interspersed printk's upsetting the Bonito controller.
159	   Do it for the others too.
160	*/
161
162	switch (mips_revision_sconid) {
163	case MIPS_REVISION_SCON_SOCIT:
164	case MIPS_REVISION_SCON_ROCIT:
165	case MIPS_REVISION_SCON_SOCITSC:
166	case MIPS_REVISION_SCON_SOCITSCP:
167		ll_msc_irq();
168		break;
169	case MIPS_REVISION_SCON_GT64120:
170		intrcause = GT_READ(GT_INTRCAUSE_OFS);
171		datalo = GT_READ(GT_CPUERR_ADDRLO_OFS);
172		datahi = GT_READ(GT_CPUERR_ADDRHI_OFS);
173		printk(KERN_EMERG "GT_INTRCAUSE = %08x\n", intrcause);
174		printk(KERN_EMERG "GT_CPUERR_ADDR = %02x%08x\n",
175				datahi, datalo);
176		break;
177	case MIPS_REVISION_SCON_BONITO:
178		pcibadaddr = BONITO_PCIBADADDR;
179		pcimstat = BONITO_PCIMSTAT;
180		intisr = BONITO_INTISR;
181		inten = BONITO_INTEN;
182		intpol = BONITO_INTPOL;
183		intedge = BONITO_INTEDGE;
184		intsteer = BONITO_INTSTEER;
185		pcicmd = BONITO_PCICMD;
186		printk(KERN_EMERG "BONITO_INTISR = %08x\n", intisr);
187		printk(KERN_EMERG "BONITO_INTEN = %08x\n", inten);
188		printk(KERN_EMERG "BONITO_INTPOL = %08x\n", intpol);
189		printk(KERN_EMERG "BONITO_INTEDGE = %08x\n", intedge);
190		printk(KERN_EMERG "BONITO_INTSTEER = %08x\n", intsteer);
191		printk(KERN_EMERG "BONITO_PCICMD = %08x\n", pcicmd);
192		printk(KERN_EMERG "BONITO_PCIBADADDR = %08x\n", pcibadaddr);
193		printk(KERN_EMERG "BONITO_PCIMSTAT = %08x\n", pcimstat);
194		break;
195	}
196
197	die("CoreHi interrupt", regs);
198}
199
200static inline int clz(unsigned long x)
201{
202	__asm__(
203	"	.set	push					\n"
204	"	.set	mips32					\n"
205	"	clz	%0, %1					\n"
206	"	.set	pop					\n"
207	: "=r" (x)
208	: "r" (x));
209
210	return x;
211}
212
213/*
214 * Version of ffs that only looks at bits 12..15.
215 */
216static inline unsigned int irq_ffs(unsigned int pending)
217{
218#if defined(CONFIG_CPU_MIPS32) || defined(CONFIG_CPU_MIPS64)
219	return -clz(pending) + 31 - CAUSEB_IP;
220#else
221	unsigned int a0 = 7;
222	unsigned int t0;
223
224	t0 = pending & 0xf000;
225	t0 = t0 < 1;
226	t0 = t0 << 2;
227	a0 = a0 - t0;
228	pending = pending << t0;
229
230	t0 = pending & 0xc000;
231	t0 = t0 < 1;
232	t0 = t0 << 1;
233	a0 = a0 - t0;
234	pending = pending << t0;
235
236	t0 = pending & 0x8000;
237	t0 = t0 < 1;
238	/* t0 = t0 << 2; */
239	a0 = a0 - t0;
240	/* pending = pending << t0; */
241
242	return a0;
243#endif
244}
245
246/*
247 * IRQs on the Malta board look basically (barring software IRQs which we
248 * don't use at all and all external interrupt sources are combined together
249 * on hardware interrupt 0 (MIPS IRQ 2)) like:
250 *
251 *	MIPS IRQ	Source
252 *      --------        ------
253 *             0	Software (ignored)
254 *             1        Software (ignored)
255 *             2        Combined hardware interrupt (hw0)
256 *             3        Hardware (ignored)
257 *             4        Hardware (ignored)
258 *             5        Hardware (ignored)
259 *             6        Hardware (ignored)
260 *             7        R4k timer (what we use)
261 *
262 * We handle the IRQ according to _our_ priority which is:
263 *
264 * Highest ----     R4k Timer
265 * Lowest  ----     Combined hardware interrupt
266 *
267 * then we just return, if multiple IRQs are pending then we will just take
268 * another exception, big deal.
269 */
270
271asmlinkage void plat_irq_dispatch(void)
272{
273	unsigned int pending = read_c0_cause() & read_c0_status() & ST0_IM;
274	int irq;
275
276	irq = irq_ffs(pending);
277
278	if (irq == MIPSCPU_INT_I8259A)
279		malta_hw0_irqdispatch();
280	else if (gic_present && ((1 << irq) & ipi_map[smp_processor_id()]))
281		malta_ipi_irqdispatch();
282	else if (irq >= 0)
283		do_IRQ(MIPS_CPU_IRQ_BASE + irq);
284	else
285		spurious_interrupt();
286}
287
288#ifdef CONFIG_MIPS_MT_SMP
289
290
291#define GIC_MIPS_CPU_IPI_RESCHED_IRQ	3
292#define GIC_MIPS_CPU_IPI_CALL_IRQ	4
293
294#define MIPS_CPU_IPI_RESCHED_IRQ 0	/* SW int 0 for resched */
295#define C_RESCHED C_SW0
296#define MIPS_CPU_IPI_CALL_IRQ 1		/* SW int 1 for resched */
297#define C_CALL C_SW1
298static int cpu_ipi_resched_irq, cpu_ipi_call_irq;
299
300static void ipi_resched_dispatch(void)
301{
302	do_IRQ(MIPS_CPU_IRQ_BASE + MIPS_CPU_IPI_RESCHED_IRQ);
303}
304
305static void ipi_call_dispatch(void)
306{
307	do_IRQ(MIPS_CPU_IRQ_BASE + MIPS_CPU_IPI_CALL_IRQ);
308}
309
310static irqreturn_t ipi_resched_interrupt(int irq, void *dev_id)
311{
312	scheduler_ipi();
313
314	return IRQ_HANDLED;
315}
316
317static irqreturn_t ipi_call_interrupt(int irq, void *dev_id)
318{
319	smp_call_function_interrupt();
320
321	return IRQ_HANDLED;
322}
323
324static struct irqaction irq_resched = {
325	.handler	= ipi_resched_interrupt,
326	.flags		= IRQF_PERCPU,
327	.name		= "IPI_resched"
328};
329
330static struct irqaction irq_call = {
331	.handler	= ipi_call_interrupt,
332	.flags		= IRQF_PERCPU,
333	.name		= "IPI_call"
334};
335#endif /* CONFIG_MIPS_MT_SMP */
336
337static int gic_resched_int_base;
338static int gic_call_int_base;
339#define GIC_RESCHED_INT(cpu) (gic_resched_int_base+(cpu))
340#define GIC_CALL_INT(cpu) (gic_call_int_base+(cpu))
341
342unsigned int plat_ipi_call_int_xlate(unsigned int cpu)
343{
344	return GIC_CALL_INT(cpu);
345}
346
347unsigned int plat_ipi_resched_int_xlate(unsigned int cpu)
348{
349	return GIC_RESCHED_INT(cpu);
350}
351
352static struct irqaction i8259irq = {
353	.handler = no_action,
354	.name = "XT-PIC cascade",
355	.flags = IRQF_NO_THREAD,
356};
357
358static struct irqaction corehi_irqaction = {
359	.handler = no_action,
360	.name = "CoreHi",
361	.flags = IRQF_NO_THREAD,
362};
363
364static msc_irqmap_t __initdata msc_irqmap[] = {
365	{MSC01C_INT_TMR,		MSC01_IRQ_EDGE, 0},
366	{MSC01C_INT_PCI,		MSC01_IRQ_LEVEL, 0},
367};
368static int __initdata msc_nr_irqs = ARRAY_SIZE(msc_irqmap);
369
370static msc_irqmap_t __initdata msc_eicirqmap[] = {
371	{MSC01E_INT_SW0,		MSC01_IRQ_LEVEL, 0},
372	{MSC01E_INT_SW1,		MSC01_IRQ_LEVEL, 0},
373	{MSC01E_INT_I8259A,		MSC01_IRQ_LEVEL, 0},
374	{MSC01E_INT_SMI,		MSC01_IRQ_LEVEL, 0},
375	{MSC01E_INT_COREHI,		MSC01_IRQ_LEVEL, 0},
376	{MSC01E_INT_CORELO,		MSC01_IRQ_LEVEL, 0},
377	{MSC01E_INT_TMR,		MSC01_IRQ_EDGE, 0},
378	{MSC01E_INT_PCI,		MSC01_IRQ_LEVEL, 0},
379	{MSC01E_INT_PERFCTR,		MSC01_IRQ_LEVEL, 0},
380	{MSC01E_INT_CPUCTR,		MSC01_IRQ_LEVEL, 0}
381};
382
383static int __initdata msc_nr_eicirqs = ARRAY_SIZE(msc_eicirqmap);
384
385/*
386 * This GIC specific tabular array defines the association between External
387 * Interrupts and CPUs/Core Interrupts. The nature of the External
388 * Interrupts is also defined here - polarity/trigger.
389 */
390
391#define GIC_CPU_NMI GIC_MAP_TO_NMI_MSK
392#define X GIC_UNUSED
393
394static struct gic_intr_map gic_intr_map[GIC_NUM_INTRS] = {
395	{ X, X,		   X,		X,		0 },
396	{ X, X,		   X,	 	X,		0 },
397	{ X, X,		   X,		X,		0 },
398	{ 0, GIC_CPU_INT0, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
399	{ 0, GIC_CPU_INT1, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
400	{ 0, GIC_CPU_INT2, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
401	{ 0, GIC_CPU_INT3, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
402	{ 0, GIC_CPU_INT4, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
403	{ 0, GIC_CPU_INT3, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
404	{ 0, GIC_CPU_INT3, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
405	{ X, X,		   X,		X,		0 },
406	{ X, X,		   X,		X,		0 },
407	{ 0, GIC_CPU_INT3, GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
408	{ 0, GIC_CPU_NMI,  GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
409	{ 0, GIC_CPU_NMI,  GIC_POL_POS, GIC_TRIG_LEVEL, GIC_FLAG_TRANSPARENT },
410	{ X, X,		   X,		X,	        0 },
411	/* The remainder of this table is initialised by fill_ipi_map */
412};
413#undef X
414
415/*
416 * GCMP needs to be detected before any SMP initialisation
417 */
418int __init gcmp_probe(unsigned long addr, unsigned long size)
419{
420	if (mips_revision_sconid != MIPS_REVISION_SCON_ROCIT) {
421		gcmp_present = 0;
422		return gcmp_present;
423	}
424
425	if (gcmp_present >= 0)
426		return gcmp_present;
427
428	_gcmp_base = (unsigned long) ioremap_nocache(GCMP_BASE_ADDR, GCMP_ADDRSPACE_SZ);
429	_msc01_biu_base = (unsigned long) ioremap_nocache(MSC01_BIU_REG_BASE, MSC01_BIU_ADDRSPACE_SZ);
430	gcmp_present = (GCMPGCB(GCMPB) & GCMP_GCB_GCMPB_GCMPBASE_MSK) == GCMP_BASE_ADDR;
431
432	if (gcmp_present)
433		pr_debug("GCMP present\n");
434	return gcmp_present;
435}
436
437/* Return the number of IOCU's present */
438int __init gcmp_niocu(void)
439{
440  return gcmp_present ?
441    (GCMPGCB(GC) & GCMP_GCB_GC_NUMIOCU_MSK) >> GCMP_GCB_GC_NUMIOCU_SHF :
442    0;
443}
444
445/* Set GCMP region attributes */
446void __init gcmp_setregion(int region, unsigned long base,
447			   unsigned long mask, int type)
448{
449	GCMPGCBn(CMxBASE, region) = base;
450	GCMPGCBn(CMxMASK, region) = mask | type;
451}
452
453#if defined(CONFIG_MIPS_MT_SMP)
454static void __init fill_ipi_map1(int baseintr, int cpu, int cpupin)
455{
456	int intr = baseintr + cpu;
457	gic_intr_map[intr].cpunum = cpu;
458	gic_intr_map[intr].pin = cpupin;
459	gic_intr_map[intr].polarity = GIC_POL_POS;
460	gic_intr_map[intr].trigtype = GIC_TRIG_EDGE;
461	gic_intr_map[intr].flags = GIC_FLAG_IPI;
462	ipi_map[cpu] |= (1 << (cpupin + 2));
463}
464
465static void __init fill_ipi_map(void)
466{
467	int cpu;
468
469	for (cpu = 0; cpu < NR_CPUS; cpu++) {
470		fill_ipi_map1(gic_resched_int_base, cpu, GIC_CPU_INT1);
471		fill_ipi_map1(gic_call_int_base, cpu, GIC_CPU_INT2);
472	}
473}
474#endif
475
476void __init arch_init_ipiirq(int irq, struct irqaction *action)
477{
478	setup_irq(irq, action);
479	irq_set_handler(irq, handle_percpu_irq);
480}
481
482void __init arch_init_irq(void)
483{
484	init_i8259_irqs();
485
486	if (!cpu_has_veic)
487		mips_cpu_irq_init();
488
489	if (gcmp_present)  {
490		GCMPGCB(GICBA) = GIC_BASE_ADDR | GCMP_GCB_GICBA_EN_MSK;
491		gic_present = 1;
492	} else {
493		if (mips_revision_sconid == MIPS_REVISION_SCON_ROCIT) {
494			_msc01_biu_base = (unsigned long)
495					ioremap_nocache(MSC01_BIU_REG_BASE,
496						MSC01_BIU_ADDRSPACE_SZ);
497			gic_present = (REG(_msc01_biu_base, MSC01_SC_CFG) &
498					MSC01_SC_CFG_GICPRES_MSK) >>
499					MSC01_SC_CFG_GICPRES_SHF;
500		}
501	}
502	if (gic_present)
503		pr_debug("GIC present\n");
504
505	switch (mips_revision_sconid) {
506	case MIPS_REVISION_SCON_SOCIT:
507	case MIPS_REVISION_SCON_ROCIT:
508		if (cpu_has_veic)
509			init_msc_irqs(MIPS_MSC01_IC_REG_BASE,
510					MSC01E_INT_BASE, msc_eicirqmap,
511					msc_nr_eicirqs);
512		else
513			init_msc_irqs(MIPS_MSC01_IC_REG_BASE,
514					MSC01C_INT_BASE, msc_irqmap,
515					msc_nr_irqs);
516		break;
517
518	case MIPS_REVISION_SCON_SOCITSC:
519	case MIPS_REVISION_SCON_SOCITSCP:
520		if (cpu_has_veic)
521			init_msc_irqs(MIPS_SOCITSC_IC_REG_BASE,
522					MSC01E_INT_BASE, msc_eicirqmap,
523					msc_nr_eicirqs);
524		else
525			init_msc_irqs(MIPS_SOCITSC_IC_REG_BASE,
526					MSC01C_INT_BASE, msc_irqmap,
527					msc_nr_irqs);
528	}
529
530	if (cpu_has_veic) {
531		set_vi_handler(MSC01E_INT_I8259A, malta_hw0_irqdispatch);
532		set_vi_handler(MSC01E_INT_COREHI, corehi_irqdispatch);
533		setup_irq(MSC01E_INT_BASE+MSC01E_INT_I8259A, &i8259irq);
534		setup_irq(MSC01E_INT_BASE+MSC01E_INT_COREHI, &corehi_irqaction);
535	} else if (cpu_has_vint) {
536		set_vi_handler(MIPSCPU_INT_I8259A, malta_hw0_irqdispatch);
537		set_vi_handler(MIPSCPU_INT_COREHI, corehi_irqdispatch);
538#ifdef CONFIG_MIPS_MT_SMTC
539		setup_irq_smtc(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_I8259A, &i8259irq,
540			(0x100 << MIPSCPU_INT_I8259A));
541		setup_irq_smtc(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_COREHI,
542			&corehi_irqaction, (0x100 << MIPSCPU_INT_COREHI));
543		/*
544		 * Temporary hack to ensure that the subsidiary device
545		 * interrupts coing in via the i8259A, but associated
546		 * with low IRQ numbers, will restore the Status.IM
547		 * value associated with the i8259A.
548		 */
549		{
550			int i;
551
552			for (i = 0; i < 16; i++)
553				irq_hwmask[i] = (0x100 << MIPSCPU_INT_I8259A);
554		}
555#else /* Not SMTC */
556		setup_irq(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_I8259A, &i8259irq);
557		setup_irq(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_COREHI,
558						&corehi_irqaction);
559#endif /* CONFIG_MIPS_MT_SMTC */
560	} else {
561		setup_irq(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_I8259A, &i8259irq);
562		setup_irq(MIPS_CPU_IRQ_BASE+MIPSCPU_INT_COREHI,
563						&corehi_irqaction);
564	}
565
566	if (gic_present) {
567		/* FIXME */
568		int i;
569#if defined(CONFIG_MIPS_MT_SMP)
570		gic_call_int_base = GIC_NUM_INTRS - NR_CPUS;
571		gic_resched_int_base = gic_call_int_base - NR_CPUS;
572		fill_ipi_map();
573#endif
574		gic_init(GIC_BASE_ADDR, GIC_ADDRSPACE_SZ, gic_intr_map,
575				ARRAY_SIZE(gic_intr_map), MIPS_GIC_IRQ_BASE);
576		if (!gcmp_present) {
577			/* Enable the GIC */
578			i = REG(_msc01_biu_base, MSC01_SC_CFG);
579			REG(_msc01_biu_base, MSC01_SC_CFG) =
580				(i | (0x1 << MSC01_SC_CFG_GICENA_SHF));
581			pr_debug("GIC Enabled\n");
582		}
583#if defined(CONFIG_MIPS_MT_SMP)
584		/* set up ipi interrupts */
585		if (cpu_has_vint) {
586			set_vi_handler(MIPSCPU_INT_IPI0, malta_ipi_irqdispatch);
587			set_vi_handler(MIPSCPU_INT_IPI1, malta_ipi_irqdispatch);
588		}
589		/* Argh.. this really needs sorting out.. */
590		printk("CPU%d: status register was %08x\n", smp_processor_id(), read_c0_status());
591		write_c0_status(read_c0_status() | STATUSF_IP3 | STATUSF_IP4);
592		printk("CPU%d: status register now %08x\n", smp_processor_id(), read_c0_status());
593		write_c0_status(0x1100dc00);
594		printk("CPU%d: status register frc %08x\n", smp_processor_id(), read_c0_status());
595		for (i = 0; i < NR_CPUS; i++) {
596			arch_init_ipiirq(MIPS_GIC_IRQ_BASE +
597					 GIC_RESCHED_INT(i), &irq_resched);
598			arch_init_ipiirq(MIPS_GIC_IRQ_BASE +
599					 GIC_CALL_INT(i), &irq_call);
600		}
601#endif
602	} else {
603#if defined(CONFIG_MIPS_MT_SMP)
604		/* set up ipi interrupts */
605		if (cpu_has_veic) {
606			set_vi_handler (MSC01E_INT_SW0, ipi_resched_dispatch);
607			set_vi_handler (MSC01E_INT_SW1, ipi_call_dispatch);
608			cpu_ipi_resched_irq = MSC01E_INT_SW0;
609			cpu_ipi_call_irq = MSC01E_INT_SW1;
610		} else {
611			if (cpu_has_vint) {
612				set_vi_handler (MIPS_CPU_IPI_RESCHED_IRQ, ipi_resched_dispatch);
613				set_vi_handler (MIPS_CPU_IPI_CALL_IRQ, ipi_call_dispatch);
614			}
615			cpu_ipi_resched_irq = MIPS_CPU_IRQ_BASE + MIPS_CPU_IPI_RESCHED_IRQ;
616			cpu_ipi_call_irq = MIPS_CPU_IRQ_BASE + MIPS_CPU_IPI_CALL_IRQ;
617		}
618		arch_init_ipiirq(cpu_ipi_resched_irq, &irq_resched);
619		arch_init_ipiirq(cpu_ipi_call_irq, &irq_call);
620#endif
621	}
622}
623
624void malta_be_init(void)
625{
626	if (gcmp_present) {
627		/* Could change CM error mask register */
628	}
629}
630
631
632static char *tr[8] = {
633	"mem",	"gcr",	"gic",	"mmio",
634	"0x04",	"0x05",	"0x06",	"0x07"
635};
636
637static char *mcmd[32] = {
638	[0x00] = "0x00",
639	[0x01] = "Legacy Write",
640	[0x02] = "Legacy Read",
641	[0x03] = "0x03",
642	[0x04] = "0x04",
643	[0x05] = "0x05",
644	[0x06] = "0x06",
645	[0x07] = "0x07",
646	[0x08] = "Coherent Read Own",
647	[0x09] = "Coherent Read Share",
648	[0x0a] = "Coherent Read Discard",
649	[0x0b] = "Coherent Ready Share Always",
650	[0x0c] = "Coherent Upgrade",
651	[0x0d] = "Coherent Writeback",
652	[0x0e] = "0x0e",
653	[0x0f] = "0x0f",
654	[0x10] = "Coherent Copyback",
655	[0x11] = "Coherent Copyback Invalidate",
656	[0x12] = "Coherent Invalidate",
657	[0x13] = "Coherent Write Invalidate",
658	[0x14] = "Coherent Completion Sync",
659	[0x15] = "0x15",
660	[0x16] = "0x16",
661	[0x17] = "0x17",
662	[0x18] = "0x18",
663	[0x19] = "0x19",
664	[0x1a] = "0x1a",
665	[0x1b] = "0x1b",
666	[0x1c] = "0x1c",
667	[0x1d] = "0x1d",
668	[0x1e] = "0x1e",
669	[0x1f] = "0x1f"
670};
671
672static char *core[8] = {
673	"Invalid/OK", 	"Invalid/Data",
674	"Shared/OK",	"Shared/Data",
675	"Modified/OK",	"Modified/Data",
676	"Exclusive/OK",	"Exclusive/Data"
677};
678
679static char *causes[32] = {
680	"None", "GC_WR_ERR", "GC_RD_ERR", "COH_WR_ERR",
681	"COH_RD_ERR", "MMIO_WR_ERR", "MMIO_RD_ERR", "0x07",
682	"0x08", "0x09", "0x0a", "0x0b",
683	"0x0c", "0x0d", "0x0e", "0x0f",
684	"0x10", "0x11", "0x12", "0x13",
685	"0x14", "0x15", "0x16", "INTVN_WR_ERR",
686	"INTVN_RD_ERR", "0x19", "0x1a", "0x1b",
687	"0x1c", "0x1d", "0x1e", "0x1f"
688};
689
690int malta_be_handler(struct pt_regs *regs, int is_fixup)
691{
692	/* This duplicates the handling in do_be which seems wrong */
693	int retval = is_fixup ? MIPS_BE_FIXUP : MIPS_BE_FATAL;
694
695	if (gcmp_present) {
696		unsigned long cm_error = GCMPGCB(GCMEC);
697		unsigned long cm_addr = GCMPGCB(GCMEA);
698		unsigned long cm_other = GCMPGCB(GCMEO);
699		unsigned long cause, ocause;
700		char buf[256];
701
702		cause = (cm_error & GCMP_GCB_GMEC_ERROR_TYPE_MSK);
703		if (cause != 0) {
704			cause >>= GCMP_GCB_GMEC_ERROR_TYPE_SHF;
705			if (cause < 16) {
706				unsigned long cca_bits = (cm_error >> 15) & 7;
707				unsigned long tr_bits = (cm_error >> 12) & 7;
708				unsigned long mcmd_bits = (cm_error >> 7) & 0x1f;
709				unsigned long stag_bits = (cm_error >> 3) & 15;
710				unsigned long sport_bits = (cm_error >> 0) & 7;
711
712				snprintf(buf, sizeof(buf),
713					 "CCA=%lu TR=%s MCmd=%s STag=%lu "
714					 "SPort=%lu\n",
715					 cca_bits, tr[tr_bits], mcmd[mcmd_bits],
716					 stag_bits, sport_bits);
717			} else {
718				/* glob state & sresp together */
719				unsigned long c3_bits = (cm_error >> 18) & 7;
720				unsigned long c2_bits = (cm_error >> 15) & 7;
721				unsigned long c1_bits = (cm_error >> 12) & 7;
722				unsigned long c0_bits = (cm_error >> 9) & 7;
723				unsigned long sc_bit = (cm_error >> 8) & 1;
724				unsigned long mcmd_bits = (cm_error >> 3) & 0x1f;
725				unsigned long sport_bits = (cm_error >> 0) & 7;
726				snprintf(buf, sizeof(buf),
727					 "C3=%s C2=%s C1=%s C0=%s SC=%s "
728					 "MCmd=%s SPort=%lu\n",
729					 core[c3_bits], core[c2_bits],
730					 core[c1_bits], core[c0_bits],
731					 sc_bit ? "True" : "False",
732					 mcmd[mcmd_bits], sport_bits);
733			}
734
735			ocause = (cm_other & GCMP_GCB_GMEO_ERROR_2ND_MSK) >>
736				 GCMP_GCB_GMEO_ERROR_2ND_SHF;
737
738			printk("CM_ERROR=%08lx %s <%s>\n", cm_error,
739			       causes[cause], buf);
740			printk("CM_ADDR =%08lx\n", cm_addr);
741			printk("CM_OTHER=%08lx %s\n", cm_other, causes[ocause]);
742
743			/* reprime cause register */
744			GCMPGCB(GCMEC) = 0;
745		}
746	}
747
748	return retval;
749}