xref: /OK3568_Linux_fs/kernel/drivers/irqchip/irq-i8259.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * This file is subject to the terms and conditions of the GNU General Public
3*4882a593Smuzhiyun  * License.  See the file "COPYING" in the main directory of this archive
4*4882a593Smuzhiyun  * for more details.
5*4882a593Smuzhiyun  *
6*4882a593Smuzhiyun  * Code to handle x86 style IRQs plus some generic interrupt stuff.
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  * Copyright (C) 1992 Linus Torvalds
9*4882a593Smuzhiyun  * Copyright (C) 1994 - 2000 Ralf Baechle
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun #include <linux/delay.h>
12*4882a593Smuzhiyun #include <linux/init.h>
13*4882a593Smuzhiyun #include <linux/ioport.h>
14*4882a593Smuzhiyun #include <linux/interrupt.h>
15*4882a593Smuzhiyun #include <linux/irqchip.h>
16*4882a593Smuzhiyun #include <linux/irqdomain.h>
17*4882a593Smuzhiyun #include <linux/kernel.h>
18*4882a593Smuzhiyun #include <linux/of_irq.h>
19*4882a593Smuzhiyun #include <linux/spinlock.h>
20*4882a593Smuzhiyun #include <linux/syscore_ops.h>
21*4882a593Smuzhiyun #include <linux/irq.h>
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun #include <asm/i8259.h>
24*4882a593Smuzhiyun #include <asm/io.h>
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun /*
27*4882a593Smuzhiyun  * This is the 'legacy' 8259A Programmable Interrupt Controller,
28*4882a593Smuzhiyun  * present in the majority of PC/AT boxes.
29*4882a593Smuzhiyun  * plus some generic x86 specific things if generic specifics makes
30*4882a593Smuzhiyun  * any sense at all.
31*4882a593Smuzhiyun  * this file should become arch/i386/kernel/irq.c when the old irq.c
32*4882a593Smuzhiyun  * moves to arch independent land
33*4882a593Smuzhiyun  */
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun static int i8259A_auto_eoi = -1;
36*4882a593Smuzhiyun DEFINE_RAW_SPINLOCK(i8259A_lock);
37*4882a593Smuzhiyun static void disable_8259A_irq(struct irq_data *d);
38*4882a593Smuzhiyun static void enable_8259A_irq(struct irq_data *d);
39*4882a593Smuzhiyun static void mask_and_ack_8259A(struct irq_data *d);
40*4882a593Smuzhiyun static void init_8259A(int auto_eoi);
41*4882a593Smuzhiyun static int (*i8259_poll)(void) = i8259_irq;
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun static struct irq_chip i8259A_chip = {
44*4882a593Smuzhiyun 	.name			= "XT-PIC",
45*4882a593Smuzhiyun 	.irq_mask		= disable_8259A_irq,
46*4882a593Smuzhiyun 	.irq_disable		= disable_8259A_irq,
47*4882a593Smuzhiyun 	.irq_unmask		= enable_8259A_irq,
48*4882a593Smuzhiyun 	.irq_mask_ack		= mask_and_ack_8259A,
49*4882a593Smuzhiyun };
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun /*
52*4882a593Smuzhiyun  * 8259A PIC functions to handle ISA devices:
53*4882a593Smuzhiyun  */
54*4882a593Smuzhiyun 
i8259_set_poll(int (* poll)(void))55*4882a593Smuzhiyun void i8259_set_poll(int (*poll)(void))
56*4882a593Smuzhiyun {
57*4882a593Smuzhiyun 	i8259_poll = poll;
58*4882a593Smuzhiyun }
59*4882a593Smuzhiyun 
60*4882a593Smuzhiyun /*
61*4882a593Smuzhiyun  * This contains the irq mask for both 8259A irq controllers,
62*4882a593Smuzhiyun  */
63*4882a593Smuzhiyun static unsigned int cached_irq_mask = 0xffff;
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun #define cached_master_mask	(cached_irq_mask)
66*4882a593Smuzhiyun #define cached_slave_mask	(cached_irq_mask >> 8)
67*4882a593Smuzhiyun 
disable_8259A_irq(struct irq_data * d)68*4882a593Smuzhiyun static void disable_8259A_irq(struct irq_data *d)
69*4882a593Smuzhiyun {
70*4882a593Smuzhiyun 	unsigned int mask, irq = d->irq - I8259A_IRQ_BASE;
71*4882a593Smuzhiyun 	unsigned long flags;
72*4882a593Smuzhiyun 
73*4882a593Smuzhiyun 	mask = 1 << irq;
74*4882a593Smuzhiyun 	raw_spin_lock_irqsave(&i8259A_lock, flags);
75*4882a593Smuzhiyun 	cached_irq_mask |= mask;
76*4882a593Smuzhiyun 	if (irq & 8)
77*4882a593Smuzhiyun 		outb(cached_slave_mask, PIC_SLAVE_IMR);
78*4882a593Smuzhiyun 	else
79*4882a593Smuzhiyun 		outb(cached_master_mask, PIC_MASTER_IMR);
80*4882a593Smuzhiyun 	raw_spin_unlock_irqrestore(&i8259A_lock, flags);
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun 
enable_8259A_irq(struct irq_data * d)83*4882a593Smuzhiyun static void enable_8259A_irq(struct irq_data *d)
84*4882a593Smuzhiyun {
85*4882a593Smuzhiyun 	unsigned int mask, irq = d->irq - I8259A_IRQ_BASE;
86*4882a593Smuzhiyun 	unsigned long flags;
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun 	mask = ~(1 << irq);
89*4882a593Smuzhiyun 	raw_spin_lock_irqsave(&i8259A_lock, flags);
90*4882a593Smuzhiyun 	cached_irq_mask &= mask;
91*4882a593Smuzhiyun 	if (irq & 8)
92*4882a593Smuzhiyun 		outb(cached_slave_mask, PIC_SLAVE_IMR);
93*4882a593Smuzhiyun 	else
94*4882a593Smuzhiyun 		outb(cached_master_mask, PIC_MASTER_IMR);
95*4882a593Smuzhiyun 	raw_spin_unlock_irqrestore(&i8259A_lock, flags);
96*4882a593Smuzhiyun }
97*4882a593Smuzhiyun 
make_8259A_irq(unsigned int irq)98*4882a593Smuzhiyun void make_8259A_irq(unsigned int irq)
99*4882a593Smuzhiyun {
100*4882a593Smuzhiyun 	disable_irq_nosync(irq);
101*4882a593Smuzhiyun 	irq_set_chip_and_handler(irq, &i8259A_chip, handle_level_irq);
102*4882a593Smuzhiyun 	enable_irq(irq);
103*4882a593Smuzhiyun }
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun /*
106*4882a593Smuzhiyun  * This function assumes to be called rarely. Switching between
107*4882a593Smuzhiyun  * 8259A registers is slow.
108*4882a593Smuzhiyun  * This has to be protected by the irq controller spinlock
109*4882a593Smuzhiyun  * before being called.
110*4882a593Smuzhiyun  */
i8259A_irq_real(unsigned int irq)111*4882a593Smuzhiyun static inline int i8259A_irq_real(unsigned int irq)
112*4882a593Smuzhiyun {
113*4882a593Smuzhiyun 	int value;
114*4882a593Smuzhiyun 	int irqmask = 1 << irq;
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun 	if (irq < 8) {
117*4882a593Smuzhiyun 		outb(0x0B, PIC_MASTER_CMD);	/* ISR register */
118*4882a593Smuzhiyun 		value = inb(PIC_MASTER_CMD) & irqmask;
119*4882a593Smuzhiyun 		outb(0x0A, PIC_MASTER_CMD);	/* back to the IRR register */
120*4882a593Smuzhiyun 		return value;
121*4882a593Smuzhiyun 	}
122*4882a593Smuzhiyun 	outb(0x0B, PIC_SLAVE_CMD);	/* ISR register */
123*4882a593Smuzhiyun 	value = inb(PIC_SLAVE_CMD) & (irqmask >> 8);
124*4882a593Smuzhiyun 	outb(0x0A, PIC_SLAVE_CMD);	/* back to the IRR register */
125*4882a593Smuzhiyun 	return value;
126*4882a593Smuzhiyun }
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun /*
129*4882a593Smuzhiyun  * Careful! The 8259A is a fragile beast, it pretty
130*4882a593Smuzhiyun  * much _has_ to be done exactly like this (mask it
131*4882a593Smuzhiyun  * first, _then_ send the EOI, and the order of EOI
132*4882a593Smuzhiyun  * to the two 8259s is important!
133*4882a593Smuzhiyun  */
mask_and_ack_8259A(struct irq_data * d)134*4882a593Smuzhiyun static void mask_and_ack_8259A(struct irq_data *d)
135*4882a593Smuzhiyun {
136*4882a593Smuzhiyun 	unsigned int irqmask, irq = d->irq - I8259A_IRQ_BASE;
137*4882a593Smuzhiyun 	unsigned long flags;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 	irqmask = 1 << irq;
140*4882a593Smuzhiyun 	raw_spin_lock_irqsave(&i8259A_lock, flags);
141*4882a593Smuzhiyun 	/*
142*4882a593Smuzhiyun 	 * Lightweight spurious IRQ detection. We do not want
143*4882a593Smuzhiyun 	 * to overdo spurious IRQ handling - it's usually a sign
144*4882a593Smuzhiyun 	 * of hardware problems, so we only do the checks we can
145*4882a593Smuzhiyun 	 * do without slowing down good hardware unnecessarily.
146*4882a593Smuzhiyun 	 *
147*4882a593Smuzhiyun 	 * Note that IRQ7 and IRQ15 (the two spurious IRQs
148*4882a593Smuzhiyun 	 * usually resulting from the 8259A-1|2 PICs) occur
149*4882a593Smuzhiyun 	 * even if the IRQ is masked in the 8259A. Thus we
150*4882a593Smuzhiyun 	 * can check spurious 8259A IRQs without doing the
151*4882a593Smuzhiyun 	 * quite slow i8259A_irq_real() call for every IRQ.
152*4882a593Smuzhiyun 	 * This does not cover 100% of spurious interrupts,
153*4882a593Smuzhiyun 	 * but should be enough to warn the user that there
154*4882a593Smuzhiyun 	 * is something bad going on ...
155*4882a593Smuzhiyun 	 */
156*4882a593Smuzhiyun 	if (cached_irq_mask & irqmask)
157*4882a593Smuzhiyun 		goto spurious_8259A_irq;
158*4882a593Smuzhiyun 	cached_irq_mask |= irqmask;
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun handle_real_irq:
161*4882a593Smuzhiyun 	if (irq & 8) {
162*4882a593Smuzhiyun 		inb(PIC_SLAVE_IMR);	/* DUMMY - (do we need this?) */
163*4882a593Smuzhiyun 		outb(cached_slave_mask, PIC_SLAVE_IMR);
164*4882a593Smuzhiyun 		outb(0x60+(irq&7), PIC_SLAVE_CMD);/* 'Specific EOI' to slave */
165*4882a593Smuzhiyun 		outb(0x60+PIC_CASCADE_IR, PIC_MASTER_CMD); /* 'Specific EOI' to master-IRQ2 */
166*4882a593Smuzhiyun 	} else {
167*4882a593Smuzhiyun 		inb(PIC_MASTER_IMR);	/* DUMMY - (do we need this?) */
168*4882a593Smuzhiyun 		outb(cached_master_mask, PIC_MASTER_IMR);
169*4882a593Smuzhiyun 		outb(0x60+irq, PIC_MASTER_CMD); /* 'Specific EOI to master */
170*4882a593Smuzhiyun 	}
171*4882a593Smuzhiyun 	raw_spin_unlock_irqrestore(&i8259A_lock, flags);
172*4882a593Smuzhiyun 	return;
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun spurious_8259A_irq:
175*4882a593Smuzhiyun 	/*
176*4882a593Smuzhiyun 	 * this is the slow path - should happen rarely.
177*4882a593Smuzhiyun 	 */
178*4882a593Smuzhiyun 	if (i8259A_irq_real(irq))
179*4882a593Smuzhiyun 		/*
180*4882a593Smuzhiyun 		 * oops, the IRQ _is_ in service according to the
181*4882a593Smuzhiyun 		 * 8259A - not spurious, go handle it.
182*4882a593Smuzhiyun 		 */
183*4882a593Smuzhiyun 		goto handle_real_irq;
184*4882a593Smuzhiyun 
185*4882a593Smuzhiyun 	{
186*4882a593Smuzhiyun 		static int spurious_irq_mask;
187*4882a593Smuzhiyun 		/*
188*4882a593Smuzhiyun 		 * At this point we can be sure the IRQ is spurious,
189*4882a593Smuzhiyun 		 * lets ACK and report it. [once per IRQ]
190*4882a593Smuzhiyun 		 */
191*4882a593Smuzhiyun 		if (!(spurious_irq_mask & irqmask)) {
192*4882a593Smuzhiyun 			printk(KERN_DEBUG "spurious 8259A interrupt: IRQ%d.\n", irq);
193*4882a593Smuzhiyun 			spurious_irq_mask |= irqmask;
194*4882a593Smuzhiyun 		}
195*4882a593Smuzhiyun 		atomic_inc(&irq_err_count);
196*4882a593Smuzhiyun 		/*
197*4882a593Smuzhiyun 		 * Theoretically we do not have to handle this IRQ,
198*4882a593Smuzhiyun 		 * but in Linux this does not cause problems and is
199*4882a593Smuzhiyun 		 * simpler for us.
200*4882a593Smuzhiyun 		 */
201*4882a593Smuzhiyun 		goto handle_real_irq;
202*4882a593Smuzhiyun 	}
203*4882a593Smuzhiyun }
204*4882a593Smuzhiyun 
i8259A_resume(void)205*4882a593Smuzhiyun static void i8259A_resume(void)
206*4882a593Smuzhiyun {
207*4882a593Smuzhiyun 	if (i8259A_auto_eoi >= 0)
208*4882a593Smuzhiyun 		init_8259A(i8259A_auto_eoi);
209*4882a593Smuzhiyun }
210*4882a593Smuzhiyun 
i8259A_shutdown(void)211*4882a593Smuzhiyun static void i8259A_shutdown(void)
212*4882a593Smuzhiyun {
213*4882a593Smuzhiyun 	/* Put the i8259A into a quiescent state that
214*4882a593Smuzhiyun 	 * the kernel initialization code can get it
215*4882a593Smuzhiyun 	 * out of.
216*4882a593Smuzhiyun 	 */
217*4882a593Smuzhiyun 	if (i8259A_auto_eoi >= 0) {
218*4882a593Smuzhiyun 		outb(0xff, PIC_MASTER_IMR);	/* mask all of 8259A-1 */
219*4882a593Smuzhiyun 		outb(0xff, PIC_SLAVE_IMR);	/* mask all of 8259A-2 */
220*4882a593Smuzhiyun 	}
221*4882a593Smuzhiyun }
222*4882a593Smuzhiyun 
223*4882a593Smuzhiyun static struct syscore_ops i8259_syscore_ops = {
224*4882a593Smuzhiyun 	.resume = i8259A_resume,
225*4882a593Smuzhiyun 	.shutdown = i8259A_shutdown,
226*4882a593Smuzhiyun };
227*4882a593Smuzhiyun 
init_8259A(int auto_eoi)228*4882a593Smuzhiyun static void init_8259A(int auto_eoi)
229*4882a593Smuzhiyun {
230*4882a593Smuzhiyun 	unsigned long flags;
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	i8259A_auto_eoi = auto_eoi;
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	raw_spin_lock_irqsave(&i8259A_lock, flags);
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	outb(0xff, PIC_MASTER_IMR);	/* mask all of 8259A-1 */
237*4882a593Smuzhiyun 	outb(0xff, PIC_SLAVE_IMR);	/* mask all of 8259A-2 */
238*4882a593Smuzhiyun 
239*4882a593Smuzhiyun 	/*
240*4882a593Smuzhiyun 	 * outb_p - this has to work on a wide range of PC hardware.
241*4882a593Smuzhiyun 	 */
242*4882a593Smuzhiyun 	outb_p(0x11, PIC_MASTER_CMD);	/* ICW1: select 8259A-1 init */
243*4882a593Smuzhiyun 	outb_p(I8259A_IRQ_BASE + 0, PIC_MASTER_IMR);	/* ICW2: 8259A-1 IR0 mapped to I8259A_IRQ_BASE + 0x00 */
244*4882a593Smuzhiyun 	outb_p(1U << PIC_CASCADE_IR, PIC_MASTER_IMR);	/* 8259A-1 (the master) has a slave on IR2 */
245*4882a593Smuzhiyun 	if (auto_eoi)	/* master does Auto EOI */
246*4882a593Smuzhiyun 		outb_p(MASTER_ICW4_DEFAULT | PIC_ICW4_AEOI, PIC_MASTER_IMR);
247*4882a593Smuzhiyun 	else		/* master expects normal EOI */
248*4882a593Smuzhiyun 		outb_p(MASTER_ICW4_DEFAULT, PIC_MASTER_IMR);
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 	outb_p(0x11, PIC_SLAVE_CMD);	/* ICW1: select 8259A-2 init */
251*4882a593Smuzhiyun 	outb_p(I8259A_IRQ_BASE + 8, PIC_SLAVE_IMR);	/* ICW2: 8259A-2 IR0 mapped to I8259A_IRQ_BASE + 0x08 */
252*4882a593Smuzhiyun 	outb_p(PIC_CASCADE_IR, PIC_SLAVE_IMR);	/* 8259A-2 is a slave on master's IR2 */
253*4882a593Smuzhiyun 	outb_p(SLAVE_ICW4_DEFAULT, PIC_SLAVE_IMR); /* (slave's support for AEOI in flat mode is to be investigated) */
254*4882a593Smuzhiyun 	if (auto_eoi)
255*4882a593Smuzhiyun 		/*
256*4882a593Smuzhiyun 		 * In AEOI mode we just have to mask the interrupt
257*4882a593Smuzhiyun 		 * when acking.
258*4882a593Smuzhiyun 		 */
259*4882a593Smuzhiyun 		i8259A_chip.irq_mask_ack = disable_8259A_irq;
260*4882a593Smuzhiyun 	else
261*4882a593Smuzhiyun 		i8259A_chip.irq_mask_ack = mask_and_ack_8259A;
262*4882a593Smuzhiyun 
263*4882a593Smuzhiyun 	udelay(100);		/* wait for 8259A to initialize */
264*4882a593Smuzhiyun 
265*4882a593Smuzhiyun 	outb(cached_master_mask, PIC_MASTER_IMR); /* restore master IRQ mask */
266*4882a593Smuzhiyun 	outb(cached_slave_mask, PIC_SLAVE_IMR);	  /* restore slave IRQ mask */
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 	raw_spin_unlock_irqrestore(&i8259A_lock, flags);
269*4882a593Smuzhiyun }
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun static struct resource pic1_io_resource = {
272*4882a593Smuzhiyun 	.name = "pic1",
273*4882a593Smuzhiyun 	.start = PIC_MASTER_CMD,
274*4882a593Smuzhiyun 	.end = PIC_MASTER_IMR,
275*4882a593Smuzhiyun 	.flags = IORESOURCE_IO | IORESOURCE_BUSY
276*4882a593Smuzhiyun };
277*4882a593Smuzhiyun 
278*4882a593Smuzhiyun static struct resource pic2_io_resource = {
279*4882a593Smuzhiyun 	.name = "pic2",
280*4882a593Smuzhiyun 	.start = PIC_SLAVE_CMD,
281*4882a593Smuzhiyun 	.end = PIC_SLAVE_IMR,
282*4882a593Smuzhiyun 	.flags = IORESOURCE_IO | IORESOURCE_BUSY
283*4882a593Smuzhiyun };
284*4882a593Smuzhiyun 
i8259A_irq_domain_map(struct irq_domain * d,unsigned int virq,irq_hw_number_t hw)285*4882a593Smuzhiyun static int i8259A_irq_domain_map(struct irq_domain *d, unsigned int virq,
286*4882a593Smuzhiyun 				 irq_hw_number_t hw)
287*4882a593Smuzhiyun {
288*4882a593Smuzhiyun 	irq_set_chip_and_handler(virq, &i8259A_chip, handle_level_irq);
289*4882a593Smuzhiyun 	irq_set_probe(virq);
290*4882a593Smuzhiyun 	return 0;
291*4882a593Smuzhiyun }
292*4882a593Smuzhiyun 
293*4882a593Smuzhiyun static const struct irq_domain_ops i8259A_ops = {
294*4882a593Smuzhiyun 	.map = i8259A_irq_domain_map,
295*4882a593Smuzhiyun 	.xlate = irq_domain_xlate_onecell,
296*4882a593Smuzhiyun };
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun /*
299*4882a593Smuzhiyun  * On systems with i8259-style interrupt controllers we assume for
300*4882a593Smuzhiyun  * driver compatibility reasons interrupts 0 - 15 to be the i8259
301*4882a593Smuzhiyun  * interrupts even if the hardware uses a different interrupt numbering.
302*4882a593Smuzhiyun  */
__init_i8259_irqs(struct device_node * node)303*4882a593Smuzhiyun struct irq_domain * __init __init_i8259_irqs(struct device_node *node)
304*4882a593Smuzhiyun {
305*4882a593Smuzhiyun 	/*
306*4882a593Smuzhiyun 	 * PIC_CASCADE_IR is cascade interrupt to second interrupt controller
307*4882a593Smuzhiyun 	 */
308*4882a593Smuzhiyun 	int irq = I8259A_IRQ_BASE + PIC_CASCADE_IR;
309*4882a593Smuzhiyun 	struct irq_domain *domain;
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	insert_resource(&ioport_resource, &pic1_io_resource);
312*4882a593Smuzhiyun 	insert_resource(&ioport_resource, &pic2_io_resource);
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 	init_8259A(0);
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun 	domain = irq_domain_add_legacy(node, 16, I8259A_IRQ_BASE, 0,
317*4882a593Smuzhiyun 				       &i8259A_ops, NULL);
318*4882a593Smuzhiyun 	if (!domain)
319*4882a593Smuzhiyun 		panic("Failed to add i8259 IRQ domain");
320*4882a593Smuzhiyun 
321*4882a593Smuzhiyun 	if (request_irq(irq, no_action, IRQF_NO_THREAD, "cascade", NULL))
322*4882a593Smuzhiyun 		pr_err("Failed to register cascade interrupt\n");
323*4882a593Smuzhiyun 	register_syscore_ops(&i8259_syscore_ops);
324*4882a593Smuzhiyun 	return domain;
325*4882a593Smuzhiyun }
326*4882a593Smuzhiyun 
init_i8259_irqs(void)327*4882a593Smuzhiyun void __init init_i8259_irqs(void)
328*4882a593Smuzhiyun {
329*4882a593Smuzhiyun 	__init_i8259_irqs(NULL);
330*4882a593Smuzhiyun }
331*4882a593Smuzhiyun 
i8259_irq_dispatch(struct irq_desc * desc)332*4882a593Smuzhiyun static void i8259_irq_dispatch(struct irq_desc *desc)
333*4882a593Smuzhiyun {
334*4882a593Smuzhiyun 	struct irq_domain *domain = irq_desc_get_handler_data(desc);
335*4882a593Smuzhiyun 	int hwirq = i8259_poll();
336*4882a593Smuzhiyun 	unsigned int irq;
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	if (hwirq < 0)
339*4882a593Smuzhiyun 		return;
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	irq = irq_linear_revmap(domain, hwirq);
342*4882a593Smuzhiyun 	generic_handle_irq(irq);
343*4882a593Smuzhiyun }
344*4882a593Smuzhiyun 
i8259_of_init(struct device_node * node,struct device_node * parent)345*4882a593Smuzhiyun int __init i8259_of_init(struct device_node *node, struct device_node *parent)
346*4882a593Smuzhiyun {
347*4882a593Smuzhiyun 	struct irq_domain *domain;
348*4882a593Smuzhiyun 	unsigned int parent_irq;
349*4882a593Smuzhiyun 
350*4882a593Smuzhiyun 	domain = __init_i8259_irqs(node);
351*4882a593Smuzhiyun 
352*4882a593Smuzhiyun 	parent_irq = irq_of_parse_and_map(node, 0);
353*4882a593Smuzhiyun 	if (!parent_irq) {
354*4882a593Smuzhiyun 		pr_err("Failed to map i8259 parent IRQ\n");
355*4882a593Smuzhiyun 		irq_domain_remove(domain);
356*4882a593Smuzhiyun 		return -ENODEV;
357*4882a593Smuzhiyun 	}
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	irq_set_chained_handler_and_data(parent_irq, i8259_irq_dispatch,
360*4882a593Smuzhiyun 					 domain);
361*4882a593Smuzhiyun 	return 0;
362*4882a593Smuzhiyun }
363*4882a593Smuzhiyun IRQCHIP_DECLARE(i8259, "intel,i8259", i8259_of_init);
364