2 * Copyright (C) 2009 Daniel Hellstrom (daniel@gaisler.com) Aeroflex Gaisler AB
3 * Copyright (C) 2009 Konrad Eisele (konrad@gaisler.com) Aeroflex Gaisler AB
6 #include <linux/kernel.h>
7 #include <linux/module.h>
8 #include <linux/errno.h>
9 #include <linux/mutex.h>
11 #include <linux/of_platform.h>
12 #include <linux/interrupt.h>
13 #include <linux/of_device.h>
15 #include <asm/oplib.h>
16 #include <asm/timer.h>
19 #include <asm/leon_amba.h>
20 #include <asm/traps.h>
21 #include <asm/cacheflush.h>
26 struct leon3_irqctrl_regs_map
*leon3_irqctrl_regs
; /* interrupt controller base address */
27 struct leon3_gptimer_regs_map
*leon3_gptimer_regs
; /* timer controller base address */
28 struct amba_apb_device leon_percpu_timer_dev
[16];
30 int leondebug_irq_disable
;
31 int leon_debug_irqout
;
32 static int dummy_master_l10_counter
;
34 unsigned long leon3_gptimer_irq
; /* interrupt controller irq number */
35 unsigned long leon3_gptimer_idx
; /* Timer Index (0..6) within Timer Core */
36 unsigned int sparc_leon_eirq
;
37 #define LEON_IMASK ((&leon3_irqctrl_regs->mask[0]))
39 /* Return the IRQ of the pending IRQ on the extended IRQ controller */
40 int sparc_leon_eirq_get(int eirq
, int cpu
)
42 return LEON3_BYPASS_LOAD_PA(&leon3_irqctrl_regs
->intid
[cpu
]) & 0x1f;
45 irqreturn_t
sparc_leon_eirq_isr(int dummy
, void *dev_id
)
47 printk(KERN_ERR
"sparc_leon_eirq_isr: ERROR EXTENDED IRQ\n");
51 /* The extended IRQ controller has been found, this function registers it */
52 void sparc_leon_eirq_register(int eirq
)
56 /* Register a "BAD" handler for this interrupt, it should never happen */
57 irq
= request_irq(eirq
, sparc_leon_eirq_isr
,
58 (IRQF_DISABLED
| SA_STATIC_ALLOC
), "extirq", NULL
);
62 "sparc_leon_eirq_register: unable to attach IRQ%d\n",
65 sparc_leon_eirq
= eirq
;
70 static inline unsigned long get_irqmask(unsigned int irq
)
74 if (!irq
|| ((irq
> 0xf) && !sparc_leon_eirq
)
75 || ((irq
> 0x1f) && sparc_leon_eirq
)) {
77 "leon_get_irqmask: false irq number: %d\n", irq
);
80 mask
= LEON_HARD_INT(irq
);
85 static void leon_enable_irq(unsigned int irq_nr
)
87 unsigned long mask
, flags
;
88 mask
= get_irqmask(irq_nr
);
89 local_irq_save(flags
);
90 LEON3_BYPASS_STORE_PA(LEON_IMASK
,
91 (LEON3_BYPASS_LOAD_PA(LEON_IMASK
) | (mask
)));
92 local_irq_restore(flags
);
95 static void leon_disable_irq(unsigned int irq_nr
)
97 unsigned long mask
, flags
;
98 mask
= get_irqmask(irq_nr
);
99 local_irq_save(flags
);
100 LEON3_BYPASS_STORE_PA(LEON_IMASK
,
101 (LEON3_BYPASS_LOAD_PA(LEON_IMASK
) & ~(mask
)));
102 local_irq_restore(flags
);
106 void __init
leon_init_timers(irq_handler_t counter_fn
)
109 struct device_node
*rootnp
, *np
, *nnp
;
115 leondebug_irq_disable
= 0;
116 leon_debug_irqout
= 0;
117 master_l10_counter
= (unsigned int *)&dummy_master_l10_counter
;
118 dummy_master_l10_counter
= 0;
120 /*Find IRQMP IRQ Controller Registers base address otherwise bail out.*/
121 rootnp
= of_find_node_by_path("/ambapp0");
124 np
= of_find_node_by_name(rootnp
, "GAISLER_IRQMP");
126 np
= of_find_node_by_name(rootnp
, "01_00d");
130 pp
= of_find_property(np
, "reg", &len
);
133 leon3_irqctrl_regs
= *(struct leon3_irqctrl_regs_map
**)pp
->value
;
135 /* Find GPTIMER Timer Registers base address otherwise bail out. */
138 np
= of_find_node_by_name(nnp
, "GAISLER_GPTIMER");
140 np
= of_find_node_by_name(nnp
, "01_011");
146 pp
= of_find_property(np
, "ampopts", &len
);
148 ampopts
= *(int *)pp
->value
;
150 /* Skip this instance, resource already
151 * allocated by other OS */
157 /* Select Timer-Instance on Timer Core. Default is zero */
158 leon3_gptimer_idx
= ampopts
& 0x7;
160 pp
= of_find_property(np
, "reg", &len
);
162 leon3_gptimer_regs
= *(struct leon3_gptimer_regs_map
**)
164 pp
= of_find_property(np
, "interrupts", &len
);
166 leon3_gptimer_irq
= *(unsigned int *)pp
->value
;
169 if (leon3_gptimer_regs
&& leon3_irqctrl_regs
&& leon3_gptimer_irq
) {
170 LEON3_BYPASS_STORE_PA(
171 &leon3_gptimer_regs
->e
[leon3_gptimer_idx
].val
, 0);
172 LEON3_BYPASS_STORE_PA(
173 &leon3_gptimer_regs
->e
[leon3_gptimer_idx
].rld
,
174 (((1000000 / HZ
) - 1)));
175 LEON3_BYPASS_STORE_PA(
176 &leon3_gptimer_regs
->e
[leon3_gptimer_idx
].ctrl
, 0);
179 leon_percpu_timer_dev
[0].start
= (int)leon3_gptimer_regs
;
180 leon_percpu_timer_dev
[0].irq
= leon3_gptimer_irq
+ 1 +
183 if (!(LEON3_BYPASS_LOAD_PA(&leon3_gptimer_regs
->config
) &
184 (1<<LEON3_GPTIMER_SEPIRQ
))) {
185 prom_printf("irq timer not configured with separate irqs\n");
189 LEON3_BYPASS_STORE_PA(
190 &leon3_gptimer_regs
->e
[leon3_gptimer_idx
+1].val
, 0);
191 LEON3_BYPASS_STORE_PA(
192 &leon3_gptimer_regs
->e
[leon3_gptimer_idx
+1].rld
,
193 (((1000000/HZ
) - 1)));
194 LEON3_BYPASS_STORE_PA(
195 &leon3_gptimer_regs
->e
[leon3_gptimer_idx
+1].ctrl
, 0);
199 * The IRQ controller may (if implemented) consist of multiple
200 * IRQ controllers, each mapped on a 4Kb boundary.
201 * Each CPU may be routed to different IRQCTRLs, however
202 * we assume that all CPUs (in SMP system) is routed to the
203 * same IRQ Controller, and for non-SMP only one IRQCTRL is
205 * In AMP systems, Linux must run on CPU0 for the time being.
207 cpu
= sparc_leon3_cpuid();
208 icsel
= LEON3_BYPASS_LOAD_PA(&leon3_irqctrl_regs
->icsel
[cpu
/8]);
209 icsel
= (icsel
>> ((7 - (cpu
&0x7)) * 4)) & 0xf;
210 leon3_irqctrl_regs
+= icsel
;
215 irq
= request_irq(leon3_gptimer_irq
+leon3_gptimer_idx
,
217 (IRQF_DISABLED
| SA_STATIC_ALLOC
), "timer", NULL
);
220 printk(KERN_ERR
"leon_time_init: unable to attach IRQ%d\n",
221 LEON_INTERRUPT_TIMER1
);
228 struct tt_entry
*trap_table
= &sparc_ttable
[SP_TRAP_IRQ1
+ (leon_percpu_timer_dev
[0].irq
- 1)];
230 /* For SMP we use the level 14 ticker, however the bootup code
231 * has copied the firmwares level 14 vector into boot cpu's
232 * trap table, we must fix this now or we get squashed.
234 local_irq_save(flags
);
236 patchme_maybe_smp_msg
[0] = 0x01000000; /* NOP out the branch */
238 /* Adjust so that we jump directly to smpleon_ticker */
239 trap_table
->inst_three
+= smpleon_ticker
- real_irq_entry
;
241 local_flush_cache_all();
242 local_irq_restore(flags
);
246 if (leon3_gptimer_regs
) {
247 LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs
->e
[leon3_gptimer_idx
].ctrl
,
250 LEON3_GPTIMER_LD
| LEON3_GPTIMER_IRQEN
);
253 LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs
->e
[leon3_gptimer_idx
+1].ctrl
,
257 LEON3_GPTIMER_IRQEN
);
263 printk(KERN_ERR
"No Timer/irqctrl found\n");
268 void leon_clear_clock_irq(void)
272 void leon_load_profile_irq(int cpu
, unsigned int limit
)
280 void __init
leon_trans_init(struct device_node
*dp
)
282 if (strcmp(dp
->type
, "cpu") == 0 && strcmp(dp
->name
, "<NULL>") == 0) {
284 p
= of_find_property(dp
, "mid", (void *)0);
287 dp
->name
= prom_early_alloc(5 + 1);
288 memcpy(&mid
, p
->value
, p
->length
);
289 sprintf((char *)dp
->name
, "cpu%.2d", mid
);
294 void __initdata (*prom_amba_init
)(struct device_node
*dp
, struct device_node
***nextp
) = 0;
296 void __init
leon_node_init(struct device_node
*dp
, struct device_node
***nextp
)
298 if (prom_amba_init
&&
299 strcmp(dp
->type
, "ambapp") == 0 &&
300 strcmp(dp
->name
, "ambapp0") == 0) {
301 prom_amba_init(dp
, nextp
);
307 void leon_set_cpu_int(int cpu
, int level
)
310 mask
= get_irqmask(level
);
311 LEON3_BYPASS_STORE_PA(&leon3_irqctrl_regs
->force
[cpu
], mask
);
314 static void leon_clear_ipi(int cpu
, int level
)
317 mask
= get_irqmask(level
);
318 LEON3_BYPASS_STORE_PA(&leon3_irqctrl_regs
->force
[cpu
], mask
<<16);
321 static void leon_set_udt(int cpu
)
325 void leon_clear_profile_irq(int cpu
)
329 void leon_enable_irq_cpu(unsigned int irq_nr
, unsigned int cpu
)
331 unsigned long mask
, flags
, *addr
;
332 mask
= get_irqmask(irq_nr
);
333 local_irq_save(flags
);
334 addr
= (unsigned long *)&(leon3_irqctrl_regs
->mask
[cpu
]);
335 LEON3_BYPASS_STORE_PA(addr
, (LEON3_BYPASS_LOAD_PA(addr
) | (mask
)));
336 local_irq_restore(flags
);
341 void __init
leon_init_IRQ(void)
343 sparc_init_timers
= leon_init_timers
;
345 BTFIXUPSET_CALL(enable_irq
, leon_enable_irq
, BTFIXUPCALL_NORM
);
346 BTFIXUPSET_CALL(disable_irq
, leon_disable_irq
, BTFIXUPCALL_NORM
);
347 BTFIXUPSET_CALL(enable_pil_irq
, leon_enable_irq
, BTFIXUPCALL_NORM
);
348 BTFIXUPSET_CALL(disable_pil_irq
, leon_disable_irq
, BTFIXUPCALL_NORM
);
350 BTFIXUPSET_CALL(clear_clock_irq
, leon_clear_clock_irq
,
352 BTFIXUPSET_CALL(load_profile_irq
, leon_load_profile_irq
,
356 BTFIXUPSET_CALL(set_cpu_int
, leon_set_cpu_int
, BTFIXUPCALL_NORM
);
357 BTFIXUPSET_CALL(clear_cpu_int
, leon_clear_ipi
, BTFIXUPCALL_NORM
);
358 BTFIXUPSET_CALL(set_irq_udt
, leon_set_udt
, BTFIXUPCALL_NORM
);
363 void __init
leon_init(void)
365 of_pdt_build_more
= &leon_node_init
;