120 lines
4.8 KiB
Diff
120 lines
4.8 KiB
Diff
From 1dffe06838c26b7c3fc99f9ddb7db78e378f6908 Mon Sep 17 00:00:00 2001
|
|
From: Daniel Hellstrom <daniel@gaisler.com>
|
|
Date: Wed, 22 Sep 2010 13:21:13 +0200
|
|
Subject: [PATCH] SPARC/LEON: added support for selecting Timer Core and Timer within core, useful for AMP systems.
|
|
|
|
Signed-off-by: Daniel Hellstrom <daniel@gaisler.com>
|
|
---
|
|
arch/sparc/kernel/leon_kernel.c | 41 +++++++++++++++++++++++++-------------
|
|
1 files changed, 27 insertions(+), 14 deletions(-)
|
|
|
|
--- a/arch/sparc/kernel/leon_kernel.c
|
|
+++ b/arch/sparc/kernel/leon_kernel.c
|
|
@@ -23,15 +23,16 @@
|
|
#include "prom.h"
|
|
#include "irq.h"
|
|
|
|
-struct leon3_irqctrl_regs_map *leon3_irqctrl_regs; /* interrupt controller base address, initialized by amba_init() */
|
|
-struct leon3_gptimer_regs_map *leon3_gptimer_regs; /* timer controller base address, initialized by amba_init() */
|
|
+struct leon3_irqctrl_regs_map *leon3_irqctrl_regs = NULL; /* interrupt controller base address, initialized by amba_init() */
|
|
+struct leon3_gptimer_regs_map *leon3_gptimer_regs = NULL; /* timer controller base address, initialized by amba_init() */
|
|
struct amba_apb_device leon_percpu_timer_dev[16];
|
|
|
|
int leondebug_irq_disable;
|
|
int leon_debug_irqout;
|
|
static int dummy_master_l10_counter;
|
|
|
|
-unsigned long leon3_gptimer_irq; /* interrupt controller irq number, initialized by amba_init() */
|
|
+unsigned long leon3_gptimer_irq = 0; /* interrupt controller irq number, initialized by amba_init() */
|
|
+unsigned long leon3_gptimer_idx = 0; /* Timer Index (starting at 0) with Timer Core */
|
|
unsigned int sparc_leon_eirq;
|
|
#define LEON_IMASK ((&leon3_irqctrl_regs->mask[0]))
|
|
|
|
@@ -109,6 +110,7 @@ void __init leon_init_timers(irq_handler
|
|
struct property *pp;
|
|
int len;
|
|
int cpu, icsel;
|
|
+ int ampopts;
|
|
|
|
leondebug_irq_disable = 0;
|
|
leon_debug_irqout = 0;
|
|
@@ -124,24 +126,35 @@ void __init leon_init_timers(irq_handler
|
|
}
|
|
|
|
/* Find GPTIMER Timer Registers base address otherwise bail out. */
|
|
- if (rootnp && (np=of_find_node_by_name(rootnp, "GAISLER_GPTIMER"))) {
|
|
+ np = rootnp;
|
|
+ while (np && (np=of_find_node_by_name(np, "GAISLER_GPTIMER"))) {
|
|
+ ampopts = 0;
|
|
+ pp = of_find_property(np, "ampopts", &len);
|
|
+ if ( pp && ((ampopts = *(int *)pp->value) == 0) ) {
|
|
+ /* Skip this instance, resource already allocated by other OS */
|
|
+ continue;
|
|
+ }
|
|
+ /* Select Timer-Instance on Timer Core. Default is zero */
|
|
+ leon3_gptimer_idx = ampopts & 0x7;
|
|
+
|
|
pp = of_find_property(np, "reg", &len);
|
|
if (pp)
|
|
leon3_gptimer_regs = *(struct leon3_gptimer_regs_map **)pp->value;
|
|
pp = of_find_property(np, "interrupts", &len);
|
|
if (pp)
|
|
leon3_gptimer_irq = *(unsigned int *)pp->value;
|
|
+ break;
|
|
}
|
|
|
|
if (leon3_gptimer_regs && leon3_irqctrl_regs && leon3_gptimer_irq) {
|
|
- LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[0].val, 0);
|
|
- LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[0].rld,
|
|
+ LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx].val, 0);
|
|
+ LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx].rld,
|
|
(((1000000 / 100) - 1)));
|
|
- LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[0].ctrl, 0);
|
|
+ LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx].ctrl, 0);
|
|
|
|
#ifdef CONFIG_SMP
|
|
leon_percpu_timer_dev[0].start = (int)leon3_gptimer_regs;
|
|
- leon_percpu_timer_dev[0].irq = leon3_gptimer_irq+1;
|
|
+ leon_percpu_timer_dev[0].irq = leon3_gptimer_irq+1+leon3_gptimer_idx;
|
|
|
|
if (!(LEON3_BYPASS_LOAD_PA(&leon3_gptimer_regs->config) &
|
|
(1<<LEON3_GPTIMER_SEPIRQ))) {
|
|
@@ -149,9 +162,9 @@ void __init leon_init_timers(irq_handler
|
|
BUG();
|
|
}
|
|
|
|
- LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[1].val, 0);
|
|
- LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[1].rld, (((1000000/100) - 1)));
|
|
- LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[1].ctrl, 0);
|
|
+ LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx+1].val, 0);
|
|
+ LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx+1].rld, (((1000000/100) - 1)));
|
|
+ LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx+1].ctrl, 0);
|
|
# endif
|
|
|
|
/* The IRQ controller may (if implemented) consist of multiple
|
|
@@ -178,7 +191,7 @@ void __init leon_init_timers(irq_handler
|
|
BUG();
|
|
}
|
|
|
|
- irq = request_irq(leon3_gptimer_irq,
|
|
+ irq = request_irq(leon3_gptimer_irq+leon3_gptimer_idx,
|
|
counter_fn,
|
|
(IRQF_DISABLED | SA_STATIC_ALLOC), "timer", NULL);
|
|
|
|
@@ -210,13 +223,13 @@ void __init leon_init_timers(irq_handler
|
|
# endif
|
|
|
|
if (leon3_gptimer_regs) {
|
|
- LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[0].ctrl,
|
|
+ LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx].ctrl,
|
|
LEON3_GPTIMER_EN |
|
|
LEON3_GPTIMER_RL |
|
|
LEON3_GPTIMER_LD | LEON3_GPTIMER_IRQEN);
|
|
|
|
#ifdef CONFIG_SMP
|
|
- LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[1].ctrl,
|
|
+ LEON3_BYPASS_STORE_PA(&leon3_gptimer_regs->e[leon3_gptimer_idx+1].ctrl,
|
|
LEON3_GPTIMER_EN |
|
|
LEON3_GPTIMER_RL |
|
|
LEON3_GPTIMER_LD |
|