blob: c5ade9d27a1d81d054624612c1f960d82ec5e134 [file] [log] [blame]
Sam Ravnborgaba20a82011-01-28 22:08:20 +00001/*
2 * sun4m irq support
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 *
4 * djhr: Hacked out of irq.c into a CPU dependent version.
5 *
6 * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
7 * Copyright (C) 1995 Miguel de Icaza (miguel@nuclecu.unam.mx)
8 * Copyright (C) 1995 Pete A. Zaitcev (zaitcev@yahoo.com)
9 * Copyright (C) 1996 Dave Redman (djhr@tadpole.co.uk)
10 */
11
Linus Torvalds1da177e2005-04-16 15:20:36 -070012#include <asm/timer.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070013#include <asm/traps.h>
14#include <asm/pgalloc.h>
15#include <asm/pgtable.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#include <asm/irq.h>
17#include <asm/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070018#include <asm/cacheflush.h>
19
Al Viro32231a62007-07-21 19:18:57 -070020#include "irq.h"
Sam Ravnborgaba20a82011-01-28 22:08:20 +000021#include "kernel.h"
Al Viro32231a62007-07-21 19:18:57 -070022
Sam Ravnborgaba20a82011-01-28 22:08:20 +000023/* Sample sun4m IRQ layout:
24 *
25 * 0x22 - Power
26 * 0x24 - ESP SCSI
27 * 0x26 - Lance ethernet
28 * 0x2b - Floppy
29 * 0x2c - Zilog uart
30 * 0x32 - SBUS level 0
31 * 0x33 - Parallel port, SBUS level 1
32 * 0x35 - SBUS level 2
33 * 0x37 - SBUS level 3
34 * 0x39 - Audio, Graphics card, SBUS level 4
35 * 0x3b - SBUS level 5
36 * 0x3d - SBUS level 6
37 *
38 * Each interrupt source has a mask bit in the interrupt registers.
39 * When the mask bit is set, this blocks interrupt deliver. So you
40 * clear the bit to enable the interrupt.
41 *
42 * Interrupts numbered less than 0x10 are software triggered interrupts
43 * and unused by Linux.
44 *
45 * Interrupt level assignment on sun4m:
David S. Miller778b1c62008-09-19 15:33:21 -070046 *
47 * level source
48 * ------------------------------------------------------------
Sam Ravnborgaba20a82011-01-28 22:08:20 +000049 * 1 softint-1
David S. Miller778b1c62008-09-19 15:33:21 -070050 * 2 softint-2, VME/SBUS level 1
51 * 3 softint-3, VME/SBUS level 2
52 * 4 softint-4, onboard SCSI
53 * 5 softint-5, VME/SBUS level 3
54 * 6 softint-6, onboard ETHERNET
55 * 7 softint-7, VME/SBUS level 4
56 * 8 softint-8, onboard VIDEO
57 * 9 softint-9, VME/SBUS level 5, Module Interrupt
58 * 10 softint-10, system counter/timer
59 * 11 softint-11, VME/SBUS level 6, Floppy
60 * 12 softint-12, Keyboard/Mouse, Serial
61 * 13 softint-13, VME/SBUS level 7, ISDN Audio
62 * 14 softint-14, per-processor counter/timer
63 * 15 softint-15, Asynchronous Errors (broadcast)
64 *
65 * Each interrupt source is masked distinctly in the sun4m interrupt
66 * registers. The PIL level alone is therefore ambiguous, since multiple
67 * interrupt sources map to a single PIL.
68 *
69 * This ambiguity is resolved in the 'intr' property for device nodes
70 * in the OF device tree. Each 'intr' property entry is composed of
71 * two 32-bit words. The first word is the IRQ priority value, which
72 * is what we're intersted in. The second word is the IRQ vector, which
73 * is unused.
74 *
75 * The low 4 bits of the IRQ priority indicate the PIL, and the upper
76 * 4 bits indicate onboard vs. SBUS leveled vs. VME leveled. 0x20
77 * means onboard, 0x30 means SBUS leveled, and 0x40 means VME leveled.
78 *
79 * For example, an 'intr' IRQ priority value of 0x24 is onboard SCSI
80 * whereas a value of 0x33 is SBUS level 2. Here are some sample
81 * 'intr' property IRQ priority values from ss4, ss5, ss10, ss20, and
82 * Tadpole S3 GX systems.
83 *
Sam Ravnborgaba20a82011-01-28 22:08:20 +000084 * esp: 0x24 onboard ESP SCSI
85 * le: 0x26 onboard Lance ETHERNET
David S. Miller778b1c62008-09-19 15:33:21 -070086 * p9100: 0x32 SBUS level 1 P9100 video
Sam Ravnborgaba20a82011-01-28 22:08:20 +000087 * bpp: 0x33 SBUS level 2 BPP parallel port device
David S. Miller778b1c62008-09-19 15:33:21 -070088 * DBRI: 0x39 SBUS level 5 DBRI ISDN audio
89 * SUNW,leo: 0x39 SBUS level 5 LEO video
90 * pcmcia: 0x3b SBUS level 6 PCMCIA controller
91 * uctrl: 0x3b SBUS level 6 UCTRL device
92 * modem: 0x3d SBUS level 7 MODEM
93 * zs: 0x2c onboard keyboard/mouse/serial
94 * floppy: 0x2b onboard Floppy
95 * power: 0x22 onboard power device (XXX unknown mask bit XXX)
96 */
97
Sam Ravnborgaba20a82011-01-28 22:08:20 +000098
Sam Ravnborgaba20a82011-01-28 22:08:20 +000099/* Code in entry.S needs to get at these register mappings. */
100struct sun4m_irq_percpu __iomem *sun4m_irq_percpu[SUN4M_NCPUS];
101struct sun4m_irq_global __iomem *sun4m_irq_global;
102
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000103struct sun4m_handler_data {
104 bool percpu;
105 long mask;
106};
107
Sam Ravnborgaba20a82011-01-28 22:08:20 +0000108/* Dave Redman (djhr@tadpole.co.uk)
109 * The sun4m interrupt registers.
110 */
111#define SUN4M_INT_ENABLE 0x80000000
112#define SUN4M_INT_E14 0x00000080
113#define SUN4M_INT_E10 0x00080000
114
Sam Ravnborgaba20a82011-01-28 22:08:20 +0000115#define SUN4M_INT_MASKALL 0x80000000 /* mask all interrupts */
116#define SUN4M_INT_MODULE_ERR 0x40000000 /* module error */
117#define SUN4M_INT_M2S_WRITE_ERR 0x20000000 /* write buffer error */
118#define SUN4M_INT_ECC_ERR 0x10000000 /* ecc memory error */
119#define SUN4M_INT_VME_ERR 0x08000000 /* vme async error */
120#define SUN4M_INT_FLOPPY 0x00400000 /* floppy disk */
121#define SUN4M_INT_MODULE 0x00200000 /* module interrupt */
122#define SUN4M_INT_VIDEO 0x00100000 /* onboard video */
123#define SUN4M_INT_REALTIME 0x00080000 /* system timer */
124#define SUN4M_INT_SCSI 0x00040000 /* onboard scsi */
125#define SUN4M_INT_AUDIO 0x00020000 /* audio/isdn */
126#define SUN4M_INT_ETHERNET 0x00010000 /* onboard ethernet */
127#define SUN4M_INT_SERIAL 0x00008000 /* serial ports */
128#define SUN4M_INT_KBDMS 0x00004000 /* keyboard/mouse */
129#define SUN4M_INT_SBUSBITS 0x00003F80 /* sbus int bits */
130#define SUN4M_INT_VMEBITS 0x0000007F /* vme int bits */
131
132#define SUN4M_INT_ERROR (SUN4M_INT_MODULE_ERR | \
133 SUN4M_INT_M2S_WRITE_ERR | \
134 SUN4M_INT_ECC_ERR | \
135 SUN4M_INT_VME_ERR)
136
137#define SUN4M_INT_SBUS(x) (1 << (x+7))
138#define SUN4M_INT_VME(x) (1 << (x))
139
140/* Interrupt levels used by OBP */
141#define OBP_INT_LEVEL_SOFT 0x10
142#define OBP_INT_LEVEL_ONBOARD 0x20
143#define OBP_INT_LEVEL_SBUS 0x30
144#define OBP_INT_LEVEL_VME 0x40
145
Sam Ravnborg0399bb52011-02-25 23:02:11 -0800146#define SUN4M_TIMER_IRQ (OBP_INT_LEVEL_ONBOARD | 10)
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000147#define SUN4M_PROFILE_IRQ (OBP_INT_LEVEL_ONBOARD | 14)
Sam Ravnborg0399bb52011-02-25 23:02:11 -0800148
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000149static unsigned long sun4m_imask[0x50] = {
Sam Ravnborg0399bb52011-02-25 23:02:11 -0800150 /* 0x00 - SMP */
Robert Reif6cf4a922008-10-07 15:24:02 -0700151 0, SUN4M_SOFT_INT(1),
152 SUN4M_SOFT_INT(2), SUN4M_SOFT_INT(3),
153 SUN4M_SOFT_INT(4), SUN4M_SOFT_INT(5),
154 SUN4M_SOFT_INT(6), SUN4M_SOFT_INT(7),
155 SUN4M_SOFT_INT(8), SUN4M_SOFT_INT(9),
156 SUN4M_SOFT_INT(10), SUN4M_SOFT_INT(11),
157 SUN4M_SOFT_INT(12), SUN4M_SOFT_INT(13),
158 SUN4M_SOFT_INT(14), SUN4M_SOFT_INT(15),
Sam Ravnborg0399bb52011-02-25 23:02:11 -0800159 /* 0x10 - soft */
Robert Reif6cf4a922008-10-07 15:24:02 -0700160 0, SUN4M_SOFT_INT(1),
161 SUN4M_SOFT_INT(2), SUN4M_SOFT_INT(3),
162 SUN4M_SOFT_INT(4), SUN4M_SOFT_INT(5),
163 SUN4M_SOFT_INT(6), SUN4M_SOFT_INT(7),
164 SUN4M_SOFT_INT(8), SUN4M_SOFT_INT(9),
165 SUN4M_SOFT_INT(10), SUN4M_SOFT_INT(11),
166 SUN4M_SOFT_INT(12), SUN4M_SOFT_INT(13),
167 SUN4M_SOFT_INT(14), SUN4M_SOFT_INT(15),
Sam Ravnborg0399bb52011-02-25 23:02:11 -0800168 /* 0x20 - onboard */
Robert Reif6cf4a922008-10-07 15:24:02 -0700169 0, 0, 0, 0,
170 SUN4M_INT_SCSI, 0, SUN4M_INT_ETHERNET, 0,
171 SUN4M_INT_VIDEO, SUN4M_INT_MODULE,
172 SUN4M_INT_REALTIME, SUN4M_INT_FLOPPY,
173 (SUN4M_INT_SERIAL | SUN4M_INT_KBDMS),
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000174 SUN4M_INT_AUDIO, SUN4M_INT_E14, SUN4M_INT_MODULE_ERR,
Sam Ravnborg0399bb52011-02-25 23:02:11 -0800175 /* 0x30 - sbus */
Robert Reif6cf4a922008-10-07 15:24:02 -0700176 0, 0, SUN4M_INT_SBUS(0), SUN4M_INT_SBUS(1),
177 0, SUN4M_INT_SBUS(2), 0, SUN4M_INT_SBUS(3),
178 0, SUN4M_INT_SBUS(4), 0, SUN4M_INT_SBUS(5),
179 0, SUN4M_INT_SBUS(6), 0, 0,
Sam Ravnborg0399bb52011-02-25 23:02:11 -0800180 /* 0x40 - vme */
Robert Reif6cf4a922008-10-07 15:24:02 -0700181 0, 0, SUN4M_INT_VME(0), SUN4M_INT_VME(1),
182 0, SUN4M_INT_VME(2), 0, SUN4M_INT_VME(3),
183 0, SUN4M_INT_VME(4), 0, SUN4M_INT_VME(5),
184 0, SUN4M_INT_VME(6), 0, 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185};
186
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000187static void sun4m_mask_irq(struct irq_data *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188{
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000189 struct sun4m_handler_data *handler_data = data->handler_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700190 int cpu = smp_processor_id();
191
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000192 if (handler_data->mask) {
193 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194
Linus Torvalds1da177e2005-04-16 15:20:36 -0700195 local_irq_save(flags);
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000196 if (handler_data->percpu) {
197 sbus_writel(handler_data->mask, &sun4m_irq_percpu[cpu]->set);
198 } else {
199 sbus_writel(handler_data->mask, &sun4m_irq_global->mask_set);
200 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201 local_irq_restore(flags);
202 }
203}
204
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000205static void sun4m_unmask_irq(struct irq_data *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206{
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000207 struct sun4m_handler_data *handler_data = data->handler_data;
208 int cpu = smp_processor_id();
209
210 if (handler_data->mask) {
211 unsigned long flags;
212
213 local_irq_save(flags);
214 if (handler_data->percpu) {
215 sbus_writel(handler_data->mask, &sun4m_irq_percpu[cpu]->clear);
216 } else {
217 sbus_writel(handler_data->mask, &sun4m_irq_global->mask_clear);
218 }
219 local_irq_restore(flags);
220 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221}
222
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000223static unsigned int sun4m_startup_irq(struct irq_data *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700224{
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000225 irq_link(data->irq);
226 sun4m_unmask_irq(data);
227 return 0;
228}
229
230static void sun4m_shutdown_irq(struct irq_data *data)
231{
232 sun4m_mask_irq(data);
233 irq_unlink(data->irq);
234}
235
236static struct irq_chip sun4m_irq = {
237 .name = "sun4m",
238 .irq_startup = sun4m_startup_irq,
239 .irq_shutdown = sun4m_shutdown_irq,
240 .irq_mask = sun4m_mask_irq,
241 .irq_unmask = sun4m_unmask_irq,
242};
243
244
245static unsigned int sun4m_build_device_irq(struct platform_device *op,
246 unsigned int real_irq)
247{
248 struct sun4m_handler_data *handler_data;
249 unsigned int irq;
250 unsigned int pil;
251
252 if (real_irq >= OBP_INT_LEVEL_VME) {
253 prom_printf("Bogus sun4m IRQ %u\n", real_irq);
254 prom_halt();
255 }
256 pil = (real_irq & 0xf);
257 irq = irq_alloc(real_irq, pil);
258
259 if (irq == 0)
260 goto out;
261
262 handler_data = irq_get_handler_data(irq);
263 if (unlikely(handler_data))
264 goto out;
265
266 handler_data = kzalloc(sizeof(struct sun4m_handler_data), GFP_ATOMIC);
267 if (unlikely(!handler_data)) {
268 prom_printf("IRQ: kzalloc(sun4m_handler_data) failed.\n");
269 prom_halt();
270 }
271
272 handler_data->mask = sun4m_imask[real_irq];
273 handler_data->percpu = real_irq < OBP_INT_LEVEL_ONBOARD;
274 irq_set_chip_and_handler_name(irq, &sun4m_irq,
275 handle_level_irq, "level");
276 irq_set_handler_data(irq, handler_data);
277
278out:
279 return irq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280}
281
David S. Miller9b2e43a2008-09-11 23:08:30 -0700282struct sun4m_timer_percpu {
283 u32 l14_limit;
284 u32 l14_count;
285 u32 l14_limit_noclear;
286 u32 user_timer_start_stop;
287};
288
289static struct sun4m_timer_percpu __iomem *timers_percpu[SUN4M_NCPUS];
290
291struct sun4m_timer_global {
292 u32 l10_limit;
293 u32 l10_count;
294 u32 l10_limit_noclear;
295 u32 reserved;
296 u32 timer_config;
297};
298
299static struct sun4m_timer_global __iomem *timers_global;
300
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301static void sun4m_clear_clock_irq(void)
302{
David S. Miller9b2e43a2008-09-11 23:08:30 -0700303 sbus_readl(&timers_global->l10_limit);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304}
305
Robert Reif6cf4a922008-10-07 15:24:02 -0700306void sun4m_nmi(struct pt_regs *regs)
307{
308 unsigned long afsr, afar, si;
309
310 printk(KERN_ERR "Aieee: sun4m NMI received!\n");
311 /* XXX HyperSparc hack XXX */
312 __asm__ __volatile__("mov 0x500, %%g1\n\t"
313 "lda [%%g1] 0x4, %0\n\t"
314 "mov 0x600, %%g1\n\t"
315 "lda [%%g1] 0x4, %1\n\t" :
316 "=r" (afsr), "=r" (afar));
317 printk(KERN_ERR "afsr=%08lx afar=%08lx\n", afsr, afar);
318 si = sbus_readl(&sun4m_irq_global->pending);
319 printk(KERN_ERR "si=%08lx\n", si);
320 if (si & SUN4M_INT_MODULE_ERR)
321 printk(KERN_ERR "Module async error\n");
322 if (si & SUN4M_INT_M2S_WRITE_ERR)
323 printk(KERN_ERR "MBus/SBus async error\n");
324 if (si & SUN4M_INT_ECC_ERR)
325 printk(KERN_ERR "ECC memory error\n");
326 if (si & SUN4M_INT_VME_ERR)
327 printk(KERN_ERR "VME async error\n");
328 printk(KERN_ERR "you lose buddy boy...\n");
329 show_regs(regs);
330 prom_halt();
331}
332
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000333void sun4m_unmask_profile_irq(void)
334{
335 unsigned long flags;
336
337 local_irq_save(flags);
338 sbus_writel(sun4m_imask[SUN4M_PROFILE_IRQ], &sun4m_irq_global->mask_clear);
339 local_irq_restore(flags);
340}
341
David S. Miller1de937a2008-09-13 22:07:56 -0700342void sun4m_clear_profile_irq(int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343{
David S. Miller9b2e43a2008-09-11 23:08:30 -0700344 sbus_readl(&timers_percpu[cpu]->l14_limit);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345}
346
347static void sun4m_load_profile_irq(int cpu, unsigned int limit)
348{
Tkhai Kirill62f08282012-04-04 21:49:26 +0200349 unsigned int value = limit ? timer_value(limit) : 0;
350 sbus_writel(value, &timers_percpu[cpu]->l14_limit);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351}
352
Tkhai Kirill62f08282012-04-04 21:49:26 +0200353static void __init sun4m_init_timers(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354{
David S. Miller9b2e43a2008-09-11 23:08:30 -0700355 struct device_node *dp = of_find_node_by_name(NULL, "counter");
356 int i, err, len, num_cpu_timers;
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000357 unsigned int irq;
David S. Miller9b2e43a2008-09-11 23:08:30 -0700358 const u32 *addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700359
David S. Miller9b2e43a2008-09-11 23:08:30 -0700360 if (!dp) {
361 printk(KERN_ERR "sun4m_init_timers: No 'counter' node.\n");
362 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 }
364
David S. Miller9b2e43a2008-09-11 23:08:30 -0700365 addr = of_get_property(dp, "address", &len);
Nicolas Palixc2e27c32008-12-03 21:10:57 -0800366 of_node_put(dp);
David S. Miller9b2e43a2008-09-11 23:08:30 -0700367 if (!addr) {
368 printk(KERN_ERR "sun4m_init_timers: No 'address' prop.\n");
369 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700370 }
David S. Miller9b2e43a2008-09-11 23:08:30 -0700371
372 num_cpu_timers = (len / sizeof(u32)) - 1;
373 for (i = 0; i < num_cpu_timers; i++) {
374 timers_percpu[i] = (void __iomem *)
375 (unsigned long) addr[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 }
David S. Miller9b2e43a2008-09-11 23:08:30 -0700377 timers_global = (void __iomem *)
378 (unsigned long) addr[num_cpu_timers];
379
Tkhai Kirille51e07e2012-01-10 13:17:03 +0000380 /* Every per-cpu timer works in timer mode */
381 sbus_writel(0x00000000, &timers_global->timer_config);
382
Tkhai Kirill62f08282012-04-04 21:49:26 +0200383#ifdef CONFIG_SMP
384 sparc_config.cs_period = SBUS_CLOCK_RATE * 2; /* 2 seconds */
385 sparc_config.features |= FEAT_L14_ONESHOT;
386#else
387 sparc_config.cs_period = SBUS_CLOCK_RATE / HZ; /* 1/HZ sec */
388 sparc_config.features |= FEAT_L10_CLOCKEVENT;
389#endif
390 sparc_config.features |= FEAT_L10_CLOCKSOURCE;
391 sbus_writel(timer_value(sparc_config.cs_period),
392 &timers_global->l10_limit);
David S. Miller9b2e43a2008-09-11 23:08:30 -0700393
394 master_l10_counter = &timers_global->l10_count;
David S. Miller9b2e43a2008-09-11 23:08:30 -0700395
Sam Ravnborg6baa9b22011-04-18 11:25:44 +0000396 irq = sun4m_build_device_irq(NULL, SUN4M_TIMER_IRQ);
397
Tkhai Kirill62f08282012-04-04 21:49:26 +0200398 err = request_irq(irq, timer_interrupt, IRQF_TIMER, "timer", NULL);
David S. Miller9b2e43a2008-09-11 23:08:30 -0700399 if (err) {
400 printk(KERN_ERR "sun4m_init_timers: Register IRQ error %d.\n",
401 err);
402 return;
403 }
404
405 for (i = 0; i < num_cpu_timers; i++)
406 sbus_writel(0, &timers_percpu[i]->l14_limit);
407 if (num_cpu_timers == 4)
David S. Miller69c010b2008-09-19 21:17:43 -0700408 sbus_writel(SUN4M_INT_E14, &sun4m_irq_global->mask_set);
David S. Miller9b2e43a2008-09-11 23:08:30 -0700409
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410#ifdef CONFIG_SMP
411 {
412 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413 struct tt_entry *trap_table = &sparc_ttable[SP_TRAP_IRQ1 + (14 - 1)];
414
415 /* For SMP we use the level 14 ticker, however the bootup code
Simon Arlottd1a78c32007-05-11 13:51:23 -0700416 * has copied the firmware's level 14 vector into the boot cpu's
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417 * trap table, we must fix this now or we get squashed.
418 */
419 local_irq_save(flags);
420 trap_table->inst_one = lvl14_save[0];
421 trap_table->inst_two = lvl14_save[1];
422 trap_table->inst_three = lvl14_save[2];
423 trap_table->inst_four = lvl14_save[3];
David S. Miller5d83d662012-05-13 20:49:31 -0700424 local_ops->cache_all();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425 local_irq_restore(flags);
426 }
427#endif
428}
429
430void __init sun4m_init_IRQ(void)
431{
David S. Miller69c010b2008-09-19 21:17:43 -0700432 struct device_node *dp = of_find_node_by_name(NULL, "interrupt");
433 int len, i, mid, num_cpu_iregs;
434 const u32 *addr;
435
436 if (!dp) {
437 printk(KERN_ERR "sun4m_init_IRQ: No 'interrupt' node.\n");
438 return;
439 }
440
441 addr = of_get_property(dp, "address", &len);
Nicolas Palixc2e27c32008-12-03 21:10:57 -0800442 of_node_put(dp);
David S. Miller69c010b2008-09-19 21:17:43 -0700443 if (!addr) {
444 printk(KERN_ERR "sun4m_init_IRQ: No 'address' prop.\n");
445 return;
446 }
447
448 num_cpu_iregs = (len / sizeof(u32)) - 1;
449 for (i = 0; i < num_cpu_iregs; i++) {
450 sun4m_irq_percpu[i] = (void __iomem *)
451 (unsigned long) addr[i];
452 }
453 sun4m_irq_global = (void __iomem *)
454 (unsigned long) addr[num_cpu_iregs];
455
Linus Torvalds1da177e2005-04-16 15:20:36 -0700456 local_irq_disable();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457
David S. Miller69c010b2008-09-19 21:17:43 -0700458 sbus_writel(~SUN4M_INT_MASKALL, &sun4m_irq_global->mask_set);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700459 for (i = 0; !cpu_find_by_instance(i, NULL, &mid); i++)
David S. Miller69c010b2008-09-19 21:17:43 -0700460 sbus_writel(~0x17fff, &sun4m_irq_percpu[mid]->clear);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461
David S. Millere7913de2008-09-13 22:48:41 -0700462 if (num_cpu_iregs == 4)
David S. Miller69c010b2008-09-19 21:17:43 -0700463 sbus_writel(0, &sun4m_irq_global->interrupt_target);
David S. Millere7913de2008-09-13 22:48:41 -0700464
Sam Ravnborg08c93882012-05-14 17:30:35 +0200465 sparc_config.init_timers = sun4m_init_timers;
Sam Ravnborg472bc4f2012-04-04 13:21:13 +0200466 sparc_config.build_device_irq = sun4m_build_device_irq;
Tkhai Kirill62f08282012-04-04 21:49:26 +0200467 sparc_config.clock_rate = SBUS_CLOCK_RATE;
Sam Ravnborg08c93882012-05-14 17:30:35 +0200468 sparc_config.clear_clock_irq = sun4m_clear_clock_irq;
469 sparc_config.load_profile_irq = sun4m_load_profile_irq;
470
Sam Ravnborgbbdc2662011-02-25 23:00:19 -0800471
Linus Torvalds1da177e2005-04-16 15:20:36 -0700472 /* Cannot enable interrupts until OBP ticker is disabled. */
473}