diff options
Diffstat (limited to 'arch/mips/sibyte/sb1250/time.c')
-rw-r--r-- | arch/mips/sibyte/sb1250/time.c | 191 |
1 files changed, 3 insertions, 188 deletions
diff --git a/arch/mips/sibyte/sb1250/time.c b/arch/mips/sibyte/sb1250/time.c index 95ad34e3fbac..68337bf7a5aa 100644 --- a/arch/mips/sibyte/sb1250/time.c +++ b/arch/mips/sibyte/sb1250/time.c | |||
@@ -15,195 +15,10 @@ | |||
15 | * along with this program; if not, write to the Free Software | 15 | * along with this program; if not, write to the Free Software |
16 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | 16 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. |
17 | */ | 17 | */ |
18 | #include <linux/init.h> | ||
18 | 19 | ||
19 | /* | 20 | extern void sb1250_clocksource_init(void); |
20 | * These are routines to set up and handle interrupts from the | 21 | extern void sb1250_clockevent_init(void); |
21 | * sb1250 general purpose timer 0. We're using the timer as a | ||
22 | * system clock, so we set it up to run at 100 Hz. On every | ||
23 | * interrupt, we update our idea of what the time of day is, | ||
24 | * then call do_timer() in the architecture-independent kernel | ||
25 | * code to do general bookkeeping (e.g. update jiffies, run | ||
26 | * bottom halves, etc.) | ||
27 | */ | ||
28 | #include <linux/clockchips.h> | ||
29 | #include <linux/interrupt.h> | ||
30 | #include <linux/sched.h> | ||
31 | #include <linux/spinlock.h> | ||
32 | #include <linux/kernel_stat.h> | ||
33 | |||
34 | #include <asm/irq.h> | ||
35 | #include <asm/addrspace.h> | ||
36 | #include <asm/time.h> | ||
37 | #include <asm/io.h> | ||
38 | |||
39 | #include <asm/sibyte/sb1250.h> | ||
40 | #include <asm/sibyte/sb1250_regs.h> | ||
41 | #include <asm/sibyte/sb1250_int.h> | ||
42 | #include <asm/sibyte/sb1250_scd.h> | ||
43 | |||
44 | |||
45 | #define IMR_IP2_VAL K_INT_MAP_I0 | ||
46 | #define IMR_IP3_VAL K_INT_MAP_I1 | ||
47 | #define IMR_IP4_VAL K_INT_MAP_I2 | ||
48 | |||
49 | #define SB1250_HPT_NUM 3 | ||
50 | #define SB1250_HPT_VALUE M_SCD_TIMER_CNT /* max value */ | ||
51 | |||
52 | |||
53 | /* | ||
54 | * The general purpose timer ticks at 1 Mhz independent if | ||
55 | * the rest of the system | ||
56 | */ | ||
57 | static void sibyte_set_mode(enum clock_event_mode mode, | ||
58 | struct clock_event_device *evt) | ||
59 | { | ||
60 | unsigned int cpu = smp_processor_id(); | ||
61 | void __iomem *timer_cfg, *timer_init; | ||
62 | |||
63 | timer_cfg = IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG)); | ||
64 | timer_init = IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_INIT)); | ||
65 | |||
66 | switch(mode) { | ||
67 | case CLOCK_EVT_MODE_PERIODIC: | ||
68 | __raw_writeq(0, timer_cfg); | ||
69 | __raw_writeq((V_SCD_TIMER_FREQ / HZ) - 1, timer_init); | ||
70 | __raw_writeq(M_SCD_TIMER_ENABLE | M_SCD_TIMER_MODE_CONTINUOUS, | ||
71 | timer_cfg); | ||
72 | break; | ||
73 | |||
74 | case CLOCK_EVT_MODE_ONESHOT: | ||
75 | /* Stop the timer until we actually program a shot */ | ||
76 | case CLOCK_EVT_MODE_SHUTDOWN: | ||
77 | __raw_writeq(0, timer_cfg); | ||
78 | break; | ||
79 | |||
80 | case CLOCK_EVT_MODE_UNUSED: /* shuddup gcc */ | ||
81 | case CLOCK_EVT_MODE_RESUME: | ||
82 | ; | ||
83 | } | ||
84 | } | ||
85 | |||
86 | static int | ||
87 | sibyte_next_event(unsigned long delta, struct clock_event_device *evt) | ||
88 | { | ||
89 | unsigned int cpu = smp_processor_id(); | ||
90 | void __iomem *timer_cfg, *timer_init; | ||
91 | |||
92 | timer_cfg = IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG)); | ||
93 | timer_init = IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_INIT)); | ||
94 | |||
95 | __raw_writeq(0, timer_cfg); | ||
96 | __raw_writeq(delta, timer_init); | ||
97 | __raw_writeq(M_SCD_TIMER_ENABLE, timer_cfg); | ||
98 | |||
99 | return 0; | ||
100 | } | ||
101 | |||
102 | static irqreturn_t sibyte_counter_handler(int irq, void *dev_id) | ||
103 | { | ||
104 | unsigned int cpu = smp_processor_id(); | ||
105 | struct clock_event_device *cd = dev_id; | ||
106 | |||
107 | /* ACK interrupt */ | ||
108 | ____raw_writeq(M_SCD_TIMER_ENABLE | M_SCD_TIMER_MODE_CONTINUOUS, | ||
109 | IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG))); | ||
110 | |||
111 | cd->event_handler(cd); | ||
112 | |||
113 | return IRQ_HANDLED; | ||
114 | } | ||
115 | |||
116 | static struct irqaction sibyte_irqaction = { | ||
117 | .handler = sibyte_counter_handler, | ||
118 | .flags = IRQF_DISABLED | IRQF_PERCPU, | ||
119 | .name = "timer", | ||
120 | }; | ||
121 | |||
122 | static DEFINE_PER_CPU(struct clock_event_device, sibyte_hpt_clockevent); | ||
123 | static DEFINE_PER_CPU(struct irqaction, sibyte_hpt_irqaction); | ||
124 | static DEFINE_PER_CPU(char [18], sibyte_hpt_name); | ||
125 | |||
126 | void __cpuinit sb1250_clockevent_init(void) | ||
127 | { | ||
128 | unsigned int cpu = smp_processor_id(); | ||
129 | unsigned int irq = K_INT_TIMER_0 + cpu; | ||
130 | struct irqaction *action = &per_cpu(sibyte_hpt_irqaction, cpu); | ||
131 | struct clock_event_device *cd = &per_cpu(sibyte_hpt_clockevent, cpu); | ||
132 | unsigned char *name = per_cpu(sibyte_hpt_name, cpu); | ||
133 | |||
134 | /* Only have 4 general purpose timers, and we use last one as hpt */ | ||
135 | BUG_ON(cpu > 2); | ||
136 | |||
137 | sprintf(name, "bcm1480-counter %d", cpu); | ||
138 | cd->name = name; | ||
139 | cd->features = CLOCK_EVT_FEAT_PERIODIC | | ||
140 | CLOCK_EVT_FEAT_ONESHOT; | ||
141 | clockevent_set_clock(cd, V_SCD_TIMER_FREQ); | ||
142 | cd->max_delta_ns = clockevent_delta2ns(0x7fffff, cd); | ||
143 | cd->min_delta_ns = clockevent_delta2ns(1, cd); | ||
144 | cd->rating = 200; | ||
145 | cd->irq = irq; | ||
146 | cd->cpumask = cpumask_of_cpu(cpu); | ||
147 | cd->set_next_event = sibyte_next_event; | ||
148 | cd->set_mode = sibyte_set_mode; | ||
149 | clockevents_register_device(cd); | ||
150 | |||
151 | sb1250_mask_irq(cpu, irq); | ||
152 | |||
153 | /* Map the timer interrupt to ip[4] of this cpu */ | ||
154 | __raw_writeq(IMR_IP4_VAL, | ||
155 | IOADDR(A_IMR_REGISTER(cpu, R_IMR_INTERRUPT_MAP_BASE) + | ||
156 | (irq << 3))); | ||
157 | cd->cpumask = cpumask_of_cpu(0); | ||
158 | |||
159 | sb1250_unmask_irq(cpu, irq); | ||
160 | |||
161 | action->handler = sibyte_counter_handler; | ||
162 | action->flags = IRQF_DISABLED | IRQF_PERCPU; | ||
163 | action->name = name; | ||
164 | action->dev_id = cd; | ||
165 | setup_irq(irq, &sibyte_irqaction); | ||
166 | } | ||
167 | |||
168 | /* | ||
169 | * The HPT is free running from SB1250_HPT_VALUE down to 0 then starts over | ||
170 | * again. | ||
171 | */ | ||
172 | static cycle_t sb1250_hpt_read(void) | ||
173 | { | ||
174 | unsigned int count; | ||
175 | |||
176 | count = G_SCD_TIMER_CNT(__raw_readq(IOADDR(A_SCD_TIMER_REGISTER(SB1250_HPT_NUM, R_SCD_TIMER_CNT)))); | ||
177 | |||
178 | return SB1250_HPT_VALUE - count; | ||
179 | } | ||
180 | |||
181 | struct clocksource bcm1250_clocksource = { | ||
182 | .name = "MIPS", | ||
183 | .rating = 200, | ||
184 | .read = sb1250_hpt_read, | ||
185 | .mask = CLOCKSOURCE_MASK(23), | ||
186 | .flags = CLOCK_SOURCE_IS_CONTINUOUS, | ||
187 | }; | ||
188 | |||
189 | void __init sb1250_clocksource_init(void) | ||
190 | { | ||
191 | struct clocksource *cs = &bcm1250_clocksource; | ||
192 | |||
193 | /* Setup hpt using timer #3 but do not enable irq for it */ | ||
194 | __raw_writeq(0, | ||
195 | IOADDR(A_SCD_TIMER_REGISTER(SB1250_HPT_NUM, | ||
196 | R_SCD_TIMER_CFG))); | ||
197 | __raw_writeq(SB1250_HPT_VALUE, | ||
198 | IOADDR(A_SCD_TIMER_REGISTER(SB1250_HPT_NUM, | ||
199 | R_SCD_TIMER_INIT))); | ||
200 | __raw_writeq(M_SCD_TIMER_ENABLE | M_SCD_TIMER_MODE_CONTINUOUS, | ||
201 | IOADDR(A_SCD_TIMER_REGISTER(SB1250_HPT_NUM, | ||
202 | R_SCD_TIMER_CFG))); | ||
203 | |||
204 | clocksource_set_clock(cs, V_SCD_TIMER_FREQ); | ||
205 | clocksource_register(cs); | ||
206 | } | ||
207 | 22 | ||
208 | void __init plat_time_init(void) | 23 | void __init plat_time_init(void) |
209 | { | 24 | { |