xref: /OK3568_Linux_fs/kernel/arch/mips/sni/rm200.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * RM200 specific code
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * This file is subject to the terms and conditions of the GNU General Public
5*4882a593Smuzhiyun  * License.  See the file "COPYING" in the main directory of this archive
6*4882a593Smuzhiyun  * for more details.
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  * Copyright (C) 2006,2007 Thomas Bogendoerfer (tsbogend@alpha.franken.de)
9*4882a593Smuzhiyun  *
10*4882a593Smuzhiyun  * i8259 parts ripped out of arch/mips/kernel/i8259.c
11*4882a593Smuzhiyun  */
12*4882a593Smuzhiyun 
13*4882a593Smuzhiyun #include <linux/delay.h>
14*4882a593Smuzhiyun #include <linux/init.h>
15*4882a593Smuzhiyun #include <linux/interrupt.h>
16*4882a593Smuzhiyun #include <linux/irq.h>
17*4882a593Smuzhiyun #include <linux/platform_device.h>
18*4882a593Smuzhiyun #include <linux/serial_8250.h>
19*4882a593Smuzhiyun #include <linux/io.h>
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun #include <asm/sni.h>
22*4882a593Smuzhiyun #include <asm/time.h>
23*4882a593Smuzhiyun #include <asm/irq_cpu.h>
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun #define RM200_I8259A_IRQ_BASE 32
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun #define MEMPORT(_base,_irq)				\
28*4882a593Smuzhiyun 	{						\
29*4882a593Smuzhiyun 		.mapbase	= _base,		\
30*4882a593Smuzhiyun 		.irq		= _irq,			\
31*4882a593Smuzhiyun 		.uartclk	= 1843200,		\
32*4882a593Smuzhiyun 		.iotype		= UPIO_MEM,		\
33*4882a593Smuzhiyun 		.flags		= UPF_BOOT_AUTOCONF|UPF_IOREMAP, \
34*4882a593Smuzhiyun 	}
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun static struct plat_serial8250_port rm200_data[] = {
37*4882a593Smuzhiyun 	MEMPORT(0x160003f8, RM200_I8259A_IRQ_BASE + 4),
38*4882a593Smuzhiyun 	MEMPORT(0x160002f8, RM200_I8259A_IRQ_BASE + 3),
39*4882a593Smuzhiyun 	{ },
40*4882a593Smuzhiyun };
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun static struct platform_device rm200_serial8250_device = {
43*4882a593Smuzhiyun 	.name			= "serial8250",
44*4882a593Smuzhiyun 	.id			= PLAT8250_DEV_PLATFORM,
45*4882a593Smuzhiyun 	.dev			= {
46*4882a593Smuzhiyun 		.platform_data	= rm200_data,
47*4882a593Smuzhiyun 	},
48*4882a593Smuzhiyun };
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun static struct resource rm200_ds1216_rsrc[] = {
51*4882a593Smuzhiyun 	{
52*4882a593Smuzhiyun 		.start = 0x1cd41ffc,
53*4882a593Smuzhiyun 		.end   = 0x1cd41fff,
54*4882a593Smuzhiyun 		.flags = IORESOURCE_MEM
55*4882a593Smuzhiyun 	}
56*4882a593Smuzhiyun };
57*4882a593Smuzhiyun 
58*4882a593Smuzhiyun static struct platform_device rm200_ds1216_device = {
59*4882a593Smuzhiyun 	.name		= "rtc-ds1216",
60*4882a593Smuzhiyun 	.num_resources	= ARRAY_SIZE(rm200_ds1216_rsrc),
61*4882a593Smuzhiyun 	.resource	= rm200_ds1216_rsrc
62*4882a593Smuzhiyun };
63*4882a593Smuzhiyun 
64*4882a593Smuzhiyun static struct resource snirm_82596_rm200_rsrc[] = {
65*4882a593Smuzhiyun 	{
66*4882a593Smuzhiyun 		.start = 0x18000000,
67*4882a593Smuzhiyun 		.end   = 0x180fffff,
68*4882a593Smuzhiyun 		.flags = IORESOURCE_MEM
69*4882a593Smuzhiyun 	},
70*4882a593Smuzhiyun 	{
71*4882a593Smuzhiyun 		.start = 0x1b000000,
72*4882a593Smuzhiyun 		.end   = 0x1b000004,
73*4882a593Smuzhiyun 		.flags = IORESOURCE_MEM
74*4882a593Smuzhiyun 	},
75*4882a593Smuzhiyun 	{
76*4882a593Smuzhiyun 		.start = 0x1ff00000,
77*4882a593Smuzhiyun 		.end   = 0x1ff00020,
78*4882a593Smuzhiyun 		.flags = IORESOURCE_MEM
79*4882a593Smuzhiyun 	},
80*4882a593Smuzhiyun 	{
81*4882a593Smuzhiyun 		.start = 27,
82*4882a593Smuzhiyun 		.end   = 27,
83*4882a593Smuzhiyun 		.flags = IORESOURCE_IRQ
84*4882a593Smuzhiyun 	},
85*4882a593Smuzhiyun 	{
86*4882a593Smuzhiyun 		.flags = 0x00
87*4882a593Smuzhiyun 	}
88*4882a593Smuzhiyun };
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun static struct platform_device snirm_82596_rm200_pdev = {
91*4882a593Smuzhiyun 	.name		= "snirm_82596",
92*4882a593Smuzhiyun 	.num_resources	= ARRAY_SIZE(snirm_82596_rm200_rsrc),
93*4882a593Smuzhiyun 	.resource	= snirm_82596_rm200_rsrc
94*4882a593Smuzhiyun };
95*4882a593Smuzhiyun 
96*4882a593Smuzhiyun static struct resource snirm_53c710_rm200_rsrc[] = {
97*4882a593Smuzhiyun 	{
98*4882a593Smuzhiyun 		.start = 0x19000000,
99*4882a593Smuzhiyun 		.end   = 0x190fffff,
100*4882a593Smuzhiyun 		.flags = IORESOURCE_MEM
101*4882a593Smuzhiyun 	},
102*4882a593Smuzhiyun 	{
103*4882a593Smuzhiyun 		.start = 26,
104*4882a593Smuzhiyun 		.end   = 26,
105*4882a593Smuzhiyun 		.flags = IORESOURCE_IRQ
106*4882a593Smuzhiyun 	}
107*4882a593Smuzhiyun };
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun static struct platform_device snirm_53c710_rm200_pdev = {
110*4882a593Smuzhiyun 	.name		= "snirm_53c710",
111*4882a593Smuzhiyun 	.num_resources	= ARRAY_SIZE(snirm_53c710_rm200_rsrc),
112*4882a593Smuzhiyun 	.resource	= snirm_53c710_rm200_rsrc
113*4882a593Smuzhiyun };
114*4882a593Smuzhiyun 
snirm_setup_devinit(void)115*4882a593Smuzhiyun static int __init snirm_setup_devinit(void)
116*4882a593Smuzhiyun {
117*4882a593Smuzhiyun 	if (sni_brd_type == SNI_BRD_RM200) {
118*4882a593Smuzhiyun 		platform_device_register(&rm200_serial8250_device);
119*4882a593Smuzhiyun 		platform_device_register(&rm200_ds1216_device);
120*4882a593Smuzhiyun 		platform_device_register(&snirm_82596_rm200_pdev);
121*4882a593Smuzhiyun 		platform_device_register(&snirm_53c710_rm200_pdev);
122*4882a593Smuzhiyun 		sni_eisa_root_init();
123*4882a593Smuzhiyun 	}
124*4882a593Smuzhiyun 	return 0;
125*4882a593Smuzhiyun }
126*4882a593Smuzhiyun 
127*4882a593Smuzhiyun device_initcall(snirm_setup_devinit);
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun /*
130*4882a593Smuzhiyun  * RM200 has an ISA and an EISA bus. The iSA bus is only used
131*4882a593Smuzhiyun  * for onboard devices and also has twi i8259 PICs. Since these
132*4882a593Smuzhiyun  * PICs are no accessible via inb/outb the following code uses
133*4882a593Smuzhiyun  * readb/writeb to access them
134*4882a593Smuzhiyun  */
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun static DEFINE_RAW_SPINLOCK(sni_rm200_i8259A_lock);
137*4882a593Smuzhiyun #define PIC_CMD	   0x00
138*4882a593Smuzhiyun #define PIC_IMR	   0x01
139*4882a593Smuzhiyun #define PIC_ISR	   PIC_CMD
140*4882a593Smuzhiyun #define PIC_POLL   PIC_ISR
141*4882a593Smuzhiyun #define PIC_OCW3   PIC_ISR
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun /* i8259A PIC related value */
144*4882a593Smuzhiyun #define PIC_CASCADE_IR		2
145*4882a593Smuzhiyun #define MASTER_ICW4_DEFAULT	0x01
146*4882a593Smuzhiyun #define SLAVE_ICW4_DEFAULT	0x01
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun /*
149*4882a593Smuzhiyun  * This contains the irq mask for both 8259A irq controllers,
150*4882a593Smuzhiyun  */
151*4882a593Smuzhiyun static unsigned int rm200_cached_irq_mask = 0xffff;
152*4882a593Smuzhiyun static __iomem u8 *rm200_pic_master;
153*4882a593Smuzhiyun static __iomem u8 *rm200_pic_slave;
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun #define cached_master_mask	(rm200_cached_irq_mask)
156*4882a593Smuzhiyun #define cached_slave_mask	(rm200_cached_irq_mask >> 8)
157*4882a593Smuzhiyun 
sni_rm200_disable_8259A_irq(struct irq_data * d)158*4882a593Smuzhiyun static void sni_rm200_disable_8259A_irq(struct irq_data *d)
159*4882a593Smuzhiyun {
160*4882a593Smuzhiyun 	unsigned int mask, irq = d->irq - RM200_I8259A_IRQ_BASE;
161*4882a593Smuzhiyun 	unsigned long flags;
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun 	mask = 1 << irq;
164*4882a593Smuzhiyun 	raw_spin_lock_irqsave(&sni_rm200_i8259A_lock, flags);
165*4882a593Smuzhiyun 	rm200_cached_irq_mask |= mask;
166*4882a593Smuzhiyun 	if (irq & 8)
167*4882a593Smuzhiyun 		writeb(cached_slave_mask, rm200_pic_slave + PIC_IMR);
168*4882a593Smuzhiyun 	else
169*4882a593Smuzhiyun 		writeb(cached_master_mask, rm200_pic_master + PIC_IMR);
170*4882a593Smuzhiyun 	raw_spin_unlock_irqrestore(&sni_rm200_i8259A_lock, flags);
171*4882a593Smuzhiyun }
172*4882a593Smuzhiyun 
sni_rm200_enable_8259A_irq(struct irq_data * d)173*4882a593Smuzhiyun static void sni_rm200_enable_8259A_irq(struct irq_data *d)
174*4882a593Smuzhiyun {
175*4882a593Smuzhiyun 	unsigned int mask, irq = d->irq - RM200_I8259A_IRQ_BASE;
176*4882a593Smuzhiyun 	unsigned long flags;
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 	mask = ~(1 << irq);
179*4882a593Smuzhiyun 	raw_spin_lock_irqsave(&sni_rm200_i8259A_lock, flags);
180*4882a593Smuzhiyun 	rm200_cached_irq_mask &= mask;
181*4882a593Smuzhiyun 	if (irq & 8)
182*4882a593Smuzhiyun 		writeb(cached_slave_mask, rm200_pic_slave + PIC_IMR);
183*4882a593Smuzhiyun 	else
184*4882a593Smuzhiyun 		writeb(cached_master_mask, rm200_pic_master + PIC_IMR);
185*4882a593Smuzhiyun 	raw_spin_unlock_irqrestore(&sni_rm200_i8259A_lock, flags);
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun 
sni_rm200_i8259A_irq_real(unsigned int irq)188*4882a593Smuzhiyun static inline int sni_rm200_i8259A_irq_real(unsigned int irq)
189*4882a593Smuzhiyun {
190*4882a593Smuzhiyun 	int value;
191*4882a593Smuzhiyun 	int irqmask = 1 << irq;
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 	if (irq < 8) {
194*4882a593Smuzhiyun 		writeb(0x0B, rm200_pic_master + PIC_CMD);
195*4882a593Smuzhiyun 		value = readb(rm200_pic_master + PIC_CMD) & irqmask;
196*4882a593Smuzhiyun 		writeb(0x0A, rm200_pic_master + PIC_CMD);
197*4882a593Smuzhiyun 		return value;
198*4882a593Smuzhiyun 	}
199*4882a593Smuzhiyun 	writeb(0x0B, rm200_pic_slave + PIC_CMD); /* ISR register */
200*4882a593Smuzhiyun 	value = readb(rm200_pic_slave + PIC_CMD) & (irqmask >> 8);
201*4882a593Smuzhiyun 	writeb(0x0A, rm200_pic_slave + PIC_CMD);
202*4882a593Smuzhiyun 	return value;
203*4882a593Smuzhiyun }
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun /*
206*4882a593Smuzhiyun  * Careful! The 8259A is a fragile beast, it pretty
207*4882a593Smuzhiyun  * much _has_ to be done exactly like this (mask it
208*4882a593Smuzhiyun  * first, _then_ send the EOI, and the order of EOI
209*4882a593Smuzhiyun  * to the two 8259s is important!
210*4882a593Smuzhiyun  */
sni_rm200_mask_and_ack_8259A(struct irq_data * d)211*4882a593Smuzhiyun void sni_rm200_mask_and_ack_8259A(struct irq_data *d)
212*4882a593Smuzhiyun {
213*4882a593Smuzhiyun 	unsigned int irqmask, irq = d->irq - RM200_I8259A_IRQ_BASE;
214*4882a593Smuzhiyun 	unsigned long flags;
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	irqmask = 1 << irq;
217*4882a593Smuzhiyun 	raw_spin_lock_irqsave(&sni_rm200_i8259A_lock, flags);
218*4882a593Smuzhiyun 	/*
219*4882a593Smuzhiyun 	 * Lightweight spurious IRQ detection. We do not want
220*4882a593Smuzhiyun 	 * to overdo spurious IRQ handling - it's usually a sign
221*4882a593Smuzhiyun 	 * of hardware problems, so we only do the checks we can
222*4882a593Smuzhiyun 	 * do without slowing down good hardware unnecessarily.
223*4882a593Smuzhiyun 	 *
224*4882a593Smuzhiyun 	 * Note that IRQ7 and IRQ15 (the two spurious IRQs
225*4882a593Smuzhiyun 	 * usually resulting from the 8259A-1|2 PICs) occur
226*4882a593Smuzhiyun 	 * even if the IRQ is masked in the 8259A. Thus we
227*4882a593Smuzhiyun 	 * can check spurious 8259A IRQs without doing the
228*4882a593Smuzhiyun 	 * quite slow i8259A_irq_real() call for every IRQ.
229*4882a593Smuzhiyun 	 * This does not cover 100% of spurious interrupts,
230*4882a593Smuzhiyun 	 * but should be enough to warn the user that there
231*4882a593Smuzhiyun 	 * is something bad going on ...
232*4882a593Smuzhiyun 	 */
233*4882a593Smuzhiyun 	if (rm200_cached_irq_mask & irqmask)
234*4882a593Smuzhiyun 		goto spurious_8259A_irq;
235*4882a593Smuzhiyun 	rm200_cached_irq_mask |= irqmask;
236*4882a593Smuzhiyun 
237*4882a593Smuzhiyun handle_real_irq:
238*4882a593Smuzhiyun 	if (irq & 8) {
239*4882a593Smuzhiyun 		readb(rm200_pic_slave + PIC_IMR);
240*4882a593Smuzhiyun 		writeb(cached_slave_mask, rm200_pic_slave + PIC_IMR);
241*4882a593Smuzhiyun 		writeb(0x60+(irq & 7), rm200_pic_slave + PIC_CMD);
242*4882a593Smuzhiyun 		writeb(0x60+PIC_CASCADE_IR, rm200_pic_master + PIC_CMD);
243*4882a593Smuzhiyun 	} else {
244*4882a593Smuzhiyun 		readb(rm200_pic_master + PIC_IMR);
245*4882a593Smuzhiyun 		writeb(cached_master_mask, rm200_pic_master + PIC_IMR);
246*4882a593Smuzhiyun 		writeb(0x60+irq, rm200_pic_master + PIC_CMD);
247*4882a593Smuzhiyun 	}
248*4882a593Smuzhiyun 	raw_spin_unlock_irqrestore(&sni_rm200_i8259A_lock, flags);
249*4882a593Smuzhiyun 	return;
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun spurious_8259A_irq:
252*4882a593Smuzhiyun 	/*
253*4882a593Smuzhiyun 	 * this is the slow path - should happen rarely.
254*4882a593Smuzhiyun 	 */
255*4882a593Smuzhiyun 	if (sni_rm200_i8259A_irq_real(irq))
256*4882a593Smuzhiyun 		/*
257*4882a593Smuzhiyun 		 * oops, the IRQ _is_ in service according to the
258*4882a593Smuzhiyun 		 * 8259A - not spurious, go handle it.
259*4882a593Smuzhiyun 		 */
260*4882a593Smuzhiyun 		goto handle_real_irq;
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 	{
263*4882a593Smuzhiyun 		static int spurious_irq_mask;
264*4882a593Smuzhiyun 		/*
265*4882a593Smuzhiyun 		 * At this point we can be sure the IRQ is spurious,
266*4882a593Smuzhiyun 		 * let's ACK and report it. [once per IRQ]
267*4882a593Smuzhiyun 		 */
268*4882a593Smuzhiyun 		if (!(spurious_irq_mask & irqmask)) {
269*4882a593Smuzhiyun 			printk(KERN_DEBUG
270*4882a593Smuzhiyun 			       "spurious RM200 8259A interrupt: IRQ%d.\n", irq);
271*4882a593Smuzhiyun 			spurious_irq_mask |= irqmask;
272*4882a593Smuzhiyun 		}
273*4882a593Smuzhiyun 		atomic_inc(&irq_err_count);
274*4882a593Smuzhiyun 		/*
275*4882a593Smuzhiyun 		 * Theoretically we do not have to handle this IRQ,
276*4882a593Smuzhiyun 		 * but in Linux this does not cause problems and is
277*4882a593Smuzhiyun 		 * simpler for us.
278*4882a593Smuzhiyun 		 */
279*4882a593Smuzhiyun 		goto handle_real_irq;
280*4882a593Smuzhiyun 	}
281*4882a593Smuzhiyun }
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun static struct irq_chip sni_rm200_i8259A_chip = {
284*4882a593Smuzhiyun 	.name		= "RM200-XT-PIC",
285*4882a593Smuzhiyun 	.irq_mask	= sni_rm200_disable_8259A_irq,
286*4882a593Smuzhiyun 	.irq_unmask	= sni_rm200_enable_8259A_irq,
287*4882a593Smuzhiyun 	.irq_mask_ack	= sni_rm200_mask_and_ack_8259A,
288*4882a593Smuzhiyun };
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun /*
291*4882a593Smuzhiyun  * Do the traditional i8259 interrupt polling thing.  This is for the few
292*4882a593Smuzhiyun  * cases where no better interrupt acknowledge method is available and we
293*4882a593Smuzhiyun  * absolutely must touch the i8259.
294*4882a593Smuzhiyun  */
sni_rm200_i8259_irq(void)295*4882a593Smuzhiyun static inline int sni_rm200_i8259_irq(void)
296*4882a593Smuzhiyun {
297*4882a593Smuzhiyun 	int irq;
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 	raw_spin_lock(&sni_rm200_i8259A_lock);
300*4882a593Smuzhiyun 
301*4882a593Smuzhiyun 	/* Perform an interrupt acknowledge cycle on controller 1. */
302*4882a593Smuzhiyun 	writeb(0x0C, rm200_pic_master + PIC_CMD);	/* prepare for poll */
303*4882a593Smuzhiyun 	irq = readb(rm200_pic_master + PIC_CMD) & 7;
304*4882a593Smuzhiyun 	if (irq == PIC_CASCADE_IR) {
305*4882a593Smuzhiyun 		/*
306*4882a593Smuzhiyun 		 * Interrupt is cascaded so perform interrupt
307*4882a593Smuzhiyun 		 * acknowledge on controller 2.
308*4882a593Smuzhiyun 		 */
309*4882a593Smuzhiyun 		writeb(0x0C, rm200_pic_slave + PIC_CMD); /* prepare for poll */
310*4882a593Smuzhiyun 		irq = (readb(rm200_pic_slave + PIC_CMD) & 7) + 8;
311*4882a593Smuzhiyun 	}
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	if (unlikely(irq == 7)) {
314*4882a593Smuzhiyun 		/*
315*4882a593Smuzhiyun 		 * This may be a spurious interrupt.
316*4882a593Smuzhiyun 		 *
317*4882a593Smuzhiyun 		 * Read the interrupt status register (ISR). If the most
318*4882a593Smuzhiyun 		 * significant bit is not set then there is no valid
319*4882a593Smuzhiyun 		 * interrupt.
320*4882a593Smuzhiyun 		 */
321*4882a593Smuzhiyun 		writeb(0x0B, rm200_pic_master + PIC_ISR); /* ISR register */
322*4882a593Smuzhiyun 		if (~readb(rm200_pic_master + PIC_ISR) & 0x80)
323*4882a593Smuzhiyun 			irq = -1;
324*4882a593Smuzhiyun 	}
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun 	raw_spin_unlock(&sni_rm200_i8259A_lock);
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 	return likely(irq >= 0) ? irq + RM200_I8259A_IRQ_BASE : irq;
329*4882a593Smuzhiyun }
330*4882a593Smuzhiyun 
sni_rm200_init_8259A(void)331*4882a593Smuzhiyun void sni_rm200_init_8259A(void)
332*4882a593Smuzhiyun {
333*4882a593Smuzhiyun 	unsigned long flags;
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun 	raw_spin_lock_irqsave(&sni_rm200_i8259A_lock, flags);
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 	writeb(0xff, rm200_pic_master + PIC_IMR);
338*4882a593Smuzhiyun 	writeb(0xff, rm200_pic_slave + PIC_IMR);
339*4882a593Smuzhiyun 
340*4882a593Smuzhiyun 	writeb(0x11, rm200_pic_master + PIC_CMD);
341*4882a593Smuzhiyun 	writeb(0, rm200_pic_master + PIC_IMR);
342*4882a593Smuzhiyun 	writeb(1U << PIC_CASCADE_IR, rm200_pic_master + PIC_IMR);
343*4882a593Smuzhiyun 	writeb(MASTER_ICW4_DEFAULT, rm200_pic_master + PIC_IMR);
344*4882a593Smuzhiyun 	writeb(0x11, rm200_pic_slave + PIC_CMD);
345*4882a593Smuzhiyun 	writeb(8, rm200_pic_slave + PIC_IMR);
346*4882a593Smuzhiyun 	writeb(PIC_CASCADE_IR, rm200_pic_slave + PIC_IMR);
347*4882a593Smuzhiyun 	writeb(SLAVE_ICW4_DEFAULT, rm200_pic_slave + PIC_IMR);
348*4882a593Smuzhiyun 	udelay(100);		/* wait for 8259A to initialize */
349*4882a593Smuzhiyun 
350*4882a593Smuzhiyun 	writeb(cached_master_mask, rm200_pic_master + PIC_IMR);
351*4882a593Smuzhiyun 	writeb(cached_slave_mask, rm200_pic_slave + PIC_IMR);
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun 	raw_spin_unlock_irqrestore(&sni_rm200_i8259A_lock, flags);
354*4882a593Smuzhiyun }
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun /*
357*4882a593Smuzhiyun  * IRQ2 is cascade interrupt to second interrupt controller
358*4882a593Smuzhiyun  */
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun static struct resource sni_rm200_pic1_resource = {
361*4882a593Smuzhiyun 	.name = "onboard ISA pic1",
362*4882a593Smuzhiyun 	.start = 0x16000020,
363*4882a593Smuzhiyun 	.end = 0x16000023,
364*4882a593Smuzhiyun 	.flags = IORESOURCE_BUSY
365*4882a593Smuzhiyun };
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun static struct resource sni_rm200_pic2_resource = {
368*4882a593Smuzhiyun 	.name = "onboard ISA pic2",
369*4882a593Smuzhiyun 	.start = 0x160000a0,
370*4882a593Smuzhiyun 	.end = 0x160000a3,
371*4882a593Smuzhiyun 	.flags = IORESOURCE_BUSY
372*4882a593Smuzhiyun };
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun /* ISA irq handler */
sni_rm200_i8259A_irq_handler(int dummy,void * p)375*4882a593Smuzhiyun static irqreturn_t sni_rm200_i8259A_irq_handler(int dummy, void *p)
376*4882a593Smuzhiyun {
377*4882a593Smuzhiyun 	int irq;
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun 	irq = sni_rm200_i8259_irq();
380*4882a593Smuzhiyun 	if (unlikely(irq < 0))
381*4882a593Smuzhiyun 		return IRQ_NONE;
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun 	do_IRQ(irq);
384*4882a593Smuzhiyun 	return IRQ_HANDLED;
385*4882a593Smuzhiyun }
386*4882a593Smuzhiyun 
sni_rm200_i8259_irqs(void)387*4882a593Smuzhiyun void __init sni_rm200_i8259_irqs(void)
388*4882a593Smuzhiyun {
389*4882a593Smuzhiyun 	int i;
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	rm200_pic_master = ioremap(0x16000020, 4);
392*4882a593Smuzhiyun 	if (!rm200_pic_master)
393*4882a593Smuzhiyun 		return;
394*4882a593Smuzhiyun 	rm200_pic_slave = ioremap(0x160000a0, 4);
395*4882a593Smuzhiyun 	if (!rm200_pic_slave) {
396*4882a593Smuzhiyun 		iounmap(rm200_pic_master);
397*4882a593Smuzhiyun 		return;
398*4882a593Smuzhiyun 	}
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 	insert_resource(&iomem_resource, &sni_rm200_pic1_resource);
401*4882a593Smuzhiyun 	insert_resource(&iomem_resource, &sni_rm200_pic2_resource);
402*4882a593Smuzhiyun 
403*4882a593Smuzhiyun 	sni_rm200_init_8259A();
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun 	for (i = RM200_I8259A_IRQ_BASE; i < RM200_I8259A_IRQ_BASE + 16; i++)
406*4882a593Smuzhiyun 		irq_set_chip_and_handler(i, &sni_rm200_i8259A_chip,
407*4882a593Smuzhiyun 					 handle_level_irq);
408*4882a593Smuzhiyun 
409*4882a593Smuzhiyun 	if (request_irq(RM200_I8259A_IRQ_BASE + PIC_CASCADE_IR, no_action,
410*4882a593Smuzhiyun 			IRQF_NO_THREAD, "cascade", NULL))
411*4882a593Smuzhiyun 		pr_err("Failed to register cascade interrupt\n");
412*4882a593Smuzhiyun }
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun #define SNI_RM200_INT_STAT_REG	CKSEG1ADDR(0xbc000000)
416*4882a593Smuzhiyun #define SNI_RM200_INT_ENA_REG	CKSEG1ADDR(0xbc080000)
417*4882a593Smuzhiyun 
418*4882a593Smuzhiyun #define SNI_RM200_INT_START  24
419*4882a593Smuzhiyun #define SNI_RM200_INT_END    28
420*4882a593Smuzhiyun 
enable_rm200_irq(struct irq_data * d)421*4882a593Smuzhiyun static void enable_rm200_irq(struct irq_data *d)
422*4882a593Smuzhiyun {
423*4882a593Smuzhiyun 	unsigned int mask = 1 << (d->irq - SNI_RM200_INT_START);
424*4882a593Smuzhiyun 
425*4882a593Smuzhiyun 	*(volatile u8 *)SNI_RM200_INT_ENA_REG &= ~mask;
426*4882a593Smuzhiyun }
427*4882a593Smuzhiyun 
disable_rm200_irq(struct irq_data * d)428*4882a593Smuzhiyun void disable_rm200_irq(struct irq_data *d)
429*4882a593Smuzhiyun {
430*4882a593Smuzhiyun 	unsigned int mask = 1 << (d->irq - SNI_RM200_INT_START);
431*4882a593Smuzhiyun 
432*4882a593Smuzhiyun 	*(volatile u8 *)SNI_RM200_INT_ENA_REG |= mask;
433*4882a593Smuzhiyun }
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun static struct irq_chip rm200_irq_type = {
436*4882a593Smuzhiyun 	.name = "RM200",
437*4882a593Smuzhiyun 	.irq_mask = disable_rm200_irq,
438*4882a593Smuzhiyun 	.irq_unmask = enable_rm200_irq,
439*4882a593Smuzhiyun };
440*4882a593Smuzhiyun 
sni_rm200_hwint(void)441*4882a593Smuzhiyun static void sni_rm200_hwint(void)
442*4882a593Smuzhiyun {
443*4882a593Smuzhiyun 	u32 pending = read_c0_cause() & read_c0_status();
444*4882a593Smuzhiyun 	u8 mask;
445*4882a593Smuzhiyun 	u8 stat;
446*4882a593Smuzhiyun 	int irq;
447*4882a593Smuzhiyun 
448*4882a593Smuzhiyun 	if (pending & C_IRQ5)
449*4882a593Smuzhiyun 		do_IRQ(MIPS_CPU_IRQ_BASE + 7);
450*4882a593Smuzhiyun 	else if (pending & C_IRQ0) {
451*4882a593Smuzhiyun 		clear_c0_status(IE_IRQ0);
452*4882a593Smuzhiyun 		mask = *(volatile u8 *)SNI_RM200_INT_ENA_REG ^ 0x1f;
453*4882a593Smuzhiyun 		stat = *(volatile u8 *)SNI_RM200_INT_STAT_REG ^ 0x14;
454*4882a593Smuzhiyun 		irq = ffs(stat & mask & 0x1f);
455*4882a593Smuzhiyun 
456*4882a593Smuzhiyun 		if (likely(irq > 0))
457*4882a593Smuzhiyun 			do_IRQ(irq + SNI_RM200_INT_START - 1);
458*4882a593Smuzhiyun 		set_c0_status(IE_IRQ0);
459*4882a593Smuzhiyun 	}
460*4882a593Smuzhiyun }
461*4882a593Smuzhiyun 
sni_rm200_irq_init(void)462*4882a593Smuzhiyun void __init sni_rm200_irq_init(void)
463*4882a593Smuzhiyun {
464*4882a593Smuzhiyun 	int i;
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 	* (volatile u8 *)SNI_RM200_INT_ENA_REG = 0x1f;
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	sni_rm200_i8259_irqs();
469*4882a593Smuzhiyun 	mips_cpu_irq_init();
470*4882a593Smuzhiyun 	/* Actually we've got more interrupts to handle ...  */
471*4882a593Smuzhiyun 	for (i = SNI_RM200_INT_START; i <= SNI_RM200_INT_END; i++)
472*4882a593Smuzhiyun 		irq_set_chip_and_handler(i, &rm200_irq_type, handle_level_irq);
473*4882a593Smuzhiyun 	sni_hwint = sni_rm200_hwint;
474*4882a593Smuzhiyun 	change_c0_status(ST0_IM, IE_IRQ0);
475*4882a593Smuzhiyun 	if (request_irq(SNI_RM200_INT_START + 0, sni_rm200_i8259A_irq_handler,
476*4882a593Smuzhiyun 			0, "onboard ISA", NULL))
477*4882a593Smuzhiyun 		pr_err("Failed to register onboard ISA interrupt\n");
478*4882a593Smuzhiyun 	if (request_irq(SNI_RM200_INT_START + 1, sni_isa_irq_handler, 0, "ISA",
479*4882a593Smuzhiyun 			NULL))
480*4882a593Smuzhiyun 		pr_err("Failed to register ISA interrupt\n");
481*4882a593Smuzhiyun }
482*4882a593Smuzhiyun 
sni_rm200_init(void)483*4882a593Smuzhiyun void __init sni_rm200_init(void)
484*4882a593Smuzhiyun {
485*4882a593Smuzhiyun }
486