1
2
3
4
5
6
7
8
9
10#include <linux/irq.h>
11#include <linux/kernel.h>
12#include <linux/init.h>
13#include <linux/platform_device.h>
14
15#include <asm/m32r.h>
16#include <asm/io.h>
17
18#define irq2port(x) (M32R_ICU_CR1_PORTL + ((x - 1) * sizeof(unsigned long)))
19
20icu_data_t icu_data[NR_IRQS];
21
22static void disable_mappi2_irq(unsigned int irq)
23{
24 unsigned long port, data;
25
26 if ((irq == 0) ||(irq >= NR_IRQS)) {
27 printk("bad irq 0x%08x\n", irq);
28 return;
29 }
30 port = irq2port(irq);
31 data = icu_data[irq].icucr|M32R_ICUCR_ILEVEL7;
32 outl(data, port);
33}
34
35static void enable_mappi2_irq(unsigned int irq)
36{
37 unsigned long port, data;
38
39 if ((irq == 0) ||(irq >= NR_IRQS)) {
40 printk("bad irq 0x%08x\n", irq);
41 return;
42 }
43 port = irq2port(irq);
44 data = icu_data[irq].icucr|M32R_ICUCR_IEN|M32R_ICUCR_ILEVEL6;
45 outl(data, port);
46}
47
48static void mask_mappi2(struct irq_data *data)
49{
50 disable_mappi2_irq(data->irq);
51}
52
53static void unmask_mappi2(struct irq_data *data)
54{
55 enable_mappi2_irq(data->irq);
56}
57
58static void shutdown_mappi2(struct irq_data *data)
59{
60 unsigned long port;
61
62 port = irq2port(data->irq);
63 outl(M32R_ICUCR_ILEVEL7, port);
64}
65
66static struct irq_chip mappi2_irq_type =
67{
68 .name = "MAPPI2-IRQ",
69 .irq_shutdown = shutdown_mappi2,
70 .irq_mask = mask_mappi2,
71 .irq_unmask = unmask_mappi2,
72};
73
74void __init init_IRQ(void)
75{
76#if defined(CONFIG_SMC91X)
77
78 irq_set_chip_and_handler(M32R_IRQ_INT0, &mappi2_irq_type,
79 handle_level_irq);
80 icu_data[M32R_IRQ_INT0].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD10;
81 disable_mappi2_irq(M32R_IRQ_INT0);
82#endif
83
84
85 irq_set_chip_and_handler(M32R_IRQ_MFT2, &mappi2_irq_type,
86 handle_level_irq);
87 icu_data[M32R_IRQ_MFT2].icucr = M32R_ICUCR_IEN;
88 disable_mappi2_irq(M32R_IRQ_MFT2);
89
90#ifdef CONFIG_SERIAL_M32R_SIO
91
92 irq_set_chip_and_handler(M32R_IRQ_SIO0_R, &mappi2_irq_type,
93 handle_level_irq);
94 icu_data[M32R_IRQ_SIO0_R].icucr = 0;
95 disable_mappi2_irq(M32R_IRQ_SIO0_R);
96
97
98 irq_set_chip_and_handler(M32R_IRQ_SIO0_S, &mappi2_irq_type,
99 handle_level_irq);
100 icu_data[M32R_IRQ_SIO0_S].icucr = 0;
101 disable_mappi2_irq(M32R_IRQ_SIO0_S);
102
103 irq_set_chip_and_handler(M32R_IRQ_SIO1_R, &mappi2_irq_type,
104 handle_level_irq);
105 icu_data[M32R_IRQ_SIO1_R].icucr = 0;
106 disable_mappi2_irq(M32R_IRQ_SIO1_R);
107
108
109 irq_set_chip_and_handler(M32R_IRQ_SIO1_S, &mappi2_irq_type,
110 handle_level_irq);
111 icu_data[M32R_IRQ_SIO1_S].icucr = 0;
112 disable_mappi2_irq(M32R_IRQ_SIO1_S);
113#endif
114
115#if defined(CONFIG_USB)
116
117 irq_set_chip_and_handler(M32R_IRQ_INT1, &mappi2_irq_type,
118 handle_level_irq);
119 icu_data[M32R_IRQ_INT1].icucr = M32R_ICUCR_ISMOD01;
120 disable_mappi2_irq(M32R_IRQ_INT1);
121#endif
122
123
124 irq_set_chip_and_handler(PLD_IRQ_CFIREQ, &mappi2_irq_type,
125 handle_level_irq);
126 icu_data[PLD_IRQ_CFIREQ].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD01;
127 disable_mappi2_irq(PLD_IRQ_CFIREQ);
128
129#if defined(CONFIG_M32R_CFC)
130
131 irq_set_chip_and_handler(PLD_IRQ_CFC_INSERT, &mappi2_irq_type,
132 handle_level_irq);
133 icu_data[PLD_IRQ_CFC_INSERT].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD00;
134 disable_mappi2_irq(PLD_IRQ_CFC_INSERT);
135
136
137 irq_set_chip_and_handler(PLD_IRQ_CFC_EJECT, &mappi2_irq_type,
138 handle_level_irq);
139 icu_data[PLD_IRQ_CFC_EJECT].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD10;
140 disable_mappi2_irq(PLD_IRQ_CFC_EJECT);
141#endif
142}
143
144#define LAN_IOSTART 0x300
145#define LAN_IOEND 0x320
146static struct resource smc91x_resources[] = {
147 [0] = {
148 .start = (LAN_IOSTART),
149 .end = (LAN_IOEND),
150 .flags = IORESOURCE_MEM,
151 },
152 [1] = {
153 .start = M32R_IRQ_INT0,
154 .end = M32R_IRQ_INT0,
155 .flags = IORESOURCE_IRQ,
156 }
157};
158
159static struct platform_device smc91x_device = {
160 .name = "smc91x",
161 .id = 0,
162 .num_resources = ARRAY_SIZE(smc91x_resources),
163 .resource = smc91x_resources,
164};
165
166static int __init platform_init(void)
167{
168 platform_device_register(&smc91x_device);
169 return 0;
170}
171arch_initcall(platform_init);
172