2 * linux/arch/sh/boards/se/7206/irq.c
4 * Copyright (C) 2005,2006 Yoshinori Sato
6 * Hitachi SolutionEngine Support.
9 #include <linux/init.h>
10 #include <linux/irq.h>
12 #include <linux/interrupt.h>
13 #include <mach-se/mach/se7206.h>
15 #define INTSTS0 0x31800000
16 #define INTSTS1 0x31800002
17 #define INTMSK0 0x31800004
18 #define INTMSK1 0x31800006
19 #define INTSEL 0x31800008
25 #define INTC_IPR01 0xfffe0818
26 #define INTC_ICR1 0xfffe0802
28 static void disable_se7206_irq(struct irq_data *data)
30 unsigned int irq = data->irq;
32 unsigned short mask = 0xffff ^ (0x0f << 4 * (3 - (IRQ0_IRQ - irq)));
33 unsigned short msk0,msk1;
35 /* Set the priority in IPR to 0 */
36 val = __raw_readw(INTC_IPR01);
38 __raw_writew(val, INTC_IPR01);
40 msk0 = __raw_readw(INTMSK0);
41 msk1 = __raw_readw(INTMSK1);
55 __raw_writew(msk0, INTMSK0);
56 __raw_writew(msk1, INTMSK1);
59 static void enable_se7206_irq(struct irq_data *data)
61 unsigned int irq = data->irq;
63 unsigned short value = (0x0001 << 4 * (3 - (IRQ0_IRQ - irq)));
64 unsigned short msk0,msk1;
66 /* Set priority in IPR back to original value */
67 val = __raw_readw(INTC_IPR01);
69 __raw_writew(val, INTC_IPR01);
72 msk0 = __raw_readw(INTMSK0);
73 msk1 = __raw_readw(INTMSK1);
87 __raw_writew(msk0, INTMSK0);
88 __raw_writew(msk1, INTMSK1);
91 static void eoi_se7206_irq(struct irq_data *data)
93 unsigned short sts0,sts1;
94 unsigned int irq = data->irq;
95 struct irq_desc *desc = irq_to_desc(irq);
97 if (!(desc->status & (IRQ_DISABLED|IRQ_INPROGRESS)))
98 enable_se7206_irq(data);
100 sts0 = __raw_readw(INTSTS0);
101 sts1 = __raw_readw(INTSTS1);
115 __raw_writew(sts0, INTSTS0);
116 __raw_writew(sts1, INTSTS1);
119 static struct irq_chip se7206_irq_chip __read_mostly = {
120 .name = "SE7206-FPGA",
121 .irq_mask = disable_se7206_irq,
122 .irq_unmask = enable_se7206_irq,
123 .irq_eoi = eoi_se7206_irq,
126 static void make_se7206_irq(unsigned int irq)
128 disable_irq_nosync(irq);
129 set_irq_chip_and_handler_name(irq, &se7206_irq_chip,
130 handle_level_irq, "level");
131 disable_se7206_irq(irq_get_irq_data(irq));
135 * Initialize IRQ setting
137 void __init init_se7206_IRQ(void)
139 make_se7206_irq(IRQ0_IRQ); /* SMC91C111 */
140 make_se7206_irq(IRQ1_IRQ); /* ATA */
141 make_se7206_irq(IRQ3_IRQ); /* SLOT / PCM */
142 __raw_writew(inw(INTC_ICR1) | 0x000b ,INTC_ICR1 ) ; /* ICR1 */
144 /* FPGA System register setup*/
145 __raw_writew(0x0000,INTSTS0); /* Clear INTSTS0 */
146 __raw_writew(0x0000,INTSTS1); /* Clear INTSTS1 */
147 /* IRQ0=LAN, IRQ1=ATA, IRQ3=SLT,PCM */
148 __raw_writew(0x0001,INTSEL);