Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 1 | /* |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 2 | * Based on arm clockevents implementation and old bfin time tick. |
| 3 | * |
Robin Getz | 96f1050 | 2009-09-24 14:11:24 +0000 | [diff] [blame] | 4 | * Copyright 2008-2009 Analog Devics Inc. |
| 5 | * 2008 GeoTechnologies |
| 6 | * Vitja Makarov |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 7 | * |
Robin Getz | 96f1050 | 2009-09-24 14:11:24 +0000 | [diff] [blame] | 8 | * Licensed under the GPL-2 |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 9 | */ |
Robin Getz | 96f1050 | 2009-09-24 14:11:24 +0000 | [diff] [blame] | 10 | |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 11 | #include <linux/module.h> |
| 12 | #include <linux/profile.h> |
| 13 | #include <linux/interrupt.h> |
| 14 | #include <linux/time.h> |
Mike Frysinger | 764cb81 | 2008-04-24 05:07:29 +0800 | [diff] [blame] | 15 | #include <linux/timex.h> |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 16 | #include <linux/irq.h> |
| 17 | #include <linux/clocksource.h> |
| 18 | #include <linux/clockchips.h> |
Michael Hennerich | e6c91b6 | 2008-04-25 04:58:29 +0800 | [diff] [blame] | 19 | #include <linux/cpufreq.h> |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 20 | |
| 21 | #include <asm/blackfin.h> |
Michael Hennerich | e6c91b6 | 2008-04-25 04:58:29 +0800 | [diff] [blame] | 22 | #include <asm/time.h> |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 23 | #include <asm/gptimers.h> |
Graf Yang | 60ffdb3 | 2010-01-20 10:56:24 +0000 | [diff] [blame] | 24 | #include <asm/nmi.h> |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 25 | |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 26 | |
Yi Li | ceb33be | 2009-09-15 06:50:51 +0000 | [diff] [blame] | 27 | #if defined(CONFIG_CYCLES_CLOCKSOURCE) |
| 28 | |
Yi Li | ceb33be | 2009-09-15 06:50:51 +0000 | [diff] [blame] | 29 | static notrace cycle_t bfin_read_cycles(struct clocksource *cs) |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 30 | { |
Graf Yang | 6c2b707 | 2010-01-27 11:16:32 +0000 | [diff] [blame] | 31 | #ifdef CONFIG_CPU_FREQ |
Vitja Makarov | 1bfb4b2 | 2008-05-07 11:41:26 +0800 | [diff] [blame] | 32 | return __bfin_cycles_off + (get_cycles() << __bfin_cycles_mod); |
Graf Yang | 6c2b707 | 2010-01-27 11:16:32 +0000 | [diff] [blame] | 33 | #else |
| 34 | return get_cycles(); |
| 35 | #endif |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 36 | } |
| 37 | |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 38 | static struct clocksource bfin_cs_cycles = { |
| 39 | .name = "bfin_cs_cycles", |
Graf Yang | e78feaa | 2009-09-14 04:41:00 +0000 | [diff] [blame] | 40 | .rating = 400, |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 41 | .read = bfin_read_cycles, |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 42 | .mask = CLOCKSOURCE_MASK(64), |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 43 | .flags = CLOCK_SOURCE_IS_CONTINUOUS, |
| 44 | }; |
| 45 | |
Yi Li | ceb33be | 2009-09-15 06:50:51 +0000 | [diff] [blame] | 46 | static inline unsigned long long bfin_cs_cycles_sched_clock(void) |
Magnus Damm | 8e19608 | 2009-04-21 12:24:00 -0700 | [diff] [blame] | 47 | { |
Mike Frysinger | c768a94 | 2009-12-04 03:32:11 +0000 | [diff] [blame] | 48 | return clocksource_cyc2ns(bfin_read_cycles(&bfin_cs_cycles), |
| 49 | bfin_cs_cycles.mult, bfin_cs_cycles.shift); |
Magnus Damm | 8e19608 | 2009-04-21 12:24:00 -0700 | [diff] [blame] | 50 | } |
| 51 | |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 52 | static int __init bfin_cs_cycles_init(void) |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 53 | { |
John Stultz | a1c57e0 | 2010-04-26 20:20:07 -0700 | [diff] [blame] | 54 | if (clocksource_register_hz(&bfin_cs_cycles, get_cclk())) |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 55 | panic("failed to register clocksource"); |
| 56 | |
| 57 | return 0; |
| 58 | } |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 59 | #else |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 60 | # define bfin_cs_cycles_init() |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 61 | #endif |
| 62 | |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 63 | #ifdef CONFIG_GPTMR0_CLOCKSOURCE |
| 64 | |
| 65 | void __init setup_gptimer0(void) |
| 66 | { |
| 67 | disable_gptimers(TIMER0bit); |
| 68 | |
Steven Miao | 2879bb3 | 2012-05-16 18:11:10 +0800 | [diff] [blame] | 69 | #ifdef CONFIG_BF60x |
| 70 | bfin_write16(TIMER_DATA_IMSK, 0); |
| 71 | set_gptimer_config(TIMER0_id, TIMER_OUT_DIS |
| 72 | | TIMER_MODE_PWM_CONT | TIMER_PULSE_HI | TIMER_IRQ_PER); |
| 73 | #else |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 74 | set_gptimer_config(TIMER0_id, \ |
| 75 | TIMER_OUT_DIS | TIMER_PERIOD_CNT | TIMER_MODE_PWM); |
Steven Miao | 2879bb3 | 2012-05-16 18:11:10 +0800 | [diff] [blame] | 76 | #endif |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 77 | set_gptimer_period(TIMER0_id, -1); |
| 78 | set_gptimer_pwidth(TIMER0_id, -2); |
| 79 | SSYNC(); |
| 80 | enable_gptimers(TIMER0bit); |
| 81 | } |
| 82 | |
Yi Li | f7036d6 | 2009-09-15 02:08:50 +0000 | [diff] [blame] | 83 | static cycle_t bfin_read_gptimer0(struct clocksource *cs) |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 84 | { |
| 85 | return bfin_read_TIMER0_COUNTER(); |
| 86 | } |
| 87 | |
| 88 | static struct clocksource bfin_cs_gptimer0 = { |
| 89 | .name = "bfin_cs_gptimer0", |
Graf Yang | e78feaa | 2009-09-14 04:41:00 +0000 | [diff] [blame] | 90 | .rating = 350, |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 91 | .read = bfin_read_gptimer0, |
| 92 | .mask = CLOCKSOURCE_MASK(32), |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 93 | .flags = CLOCK_SOURCE_IS_CONTINUOUS, |
| 94 | }; |
| 95 | |
Yi Li | ceb33be | 2009-09-15 06:50:51 +0000 | [diff] [blame] | 96 | static inline unsigned long long bfin_cs_gptimer0_sched_clock(void) |
| 97 | { |
Mike Frysinger | c768a94 | 2009-12-04 03:32:11 +0000 | [diff] [blame] | 98 | return clocksource_cyc2ns(bfin_read_TIMER0_COUNTER(), |
| 99 | bfin_cs_gptimer0.mult, bfin_cs_gptimer0.shift); |
Yi Li | ceb33be | 2009-09-15 06:50:51 +0000 | [diff] [blame] | 100 | } |
| 101 | |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 102 | static int __init bfin_cs_gptimer0_init(void) |
| 103 | { |
| 104 | setup_gptimer0(); |
| 105 | |
John Stultz | a1c57e0 | 2010-04-26 20:20:07 -0700 | [diff] [blame] | 106 | if (clocksource_register_hz(&bfin_cs_gptimer0, get_sclk())) |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 107 | panic("failed to register clocksource"); |
| 108 | |
| 109 | return 0; |
| 110 | } |
| 111 | #else |
| 112 | # define bfin_cs_gptimer0_init() |
| 113 | #endif |
| 114 | |
Yi Li | ceb33be | 2009-09-15 06:50:51 +0000 | [diff] [blame] | 115 | #if defined(CONFIG_GPTMR0_CLOCKSOURCE) || defined(CONFIG_CYCLES_CLOCKSOURCE) |
| 116 | /* prefer to use cycles since it has higher rating */ |
| 117 | notrace unsigned long long sched_clock(void) |
| 118 | { |
| 119 | #if defined(CONFIG_CYCLES_CLOCKSOURCE) |
| 120 | return bfin_cs_cycles_sched_clock(); |
| 121 | #else |
| 122 | return bfin_cs_gptimer0_sched_clock(); |
| 123 | #endif |
| 124 | } |
| 125 | #endif |
| 126 | |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 127 | #if defined(CONFIG_TICKSOURCE_GPTMR0) |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 128 | static int bfin_gptmr0_set_next_event(unsigned long cycles, |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 129 | struct clock_event_device *evt) |
| 130 | { |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 131 | disable_gptimers(TIMER0bit); |
| 132 | |
| 133 | /* it starts counting three SCLK cycles after the TIMENx bit is set */ |
| 134 | set_gptimer_pwidth(TIMER0_id, cycles - 3); |
| 135 | enable_gptimers(TIMER0bit); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 136 | return 0; |
| 137 | } |
| 138 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 139 | static void bfin_gptmr0_set_mode(enum clock_event_mode mode, |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 140 | struct clock_event_device *evt) |
| 141 | { |
| 142 | switch (mode) { |
| 143 | case CLOCK_EVT_MODE_PERIODIC: { |
Steven Miao | 2879bb3 | 2012-05-16 18:11:10 +0800 | [diff] [blame] | 144 | #ifndef CONFIG_BF60x |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 145 | set_gptimer_config(TIMER0_id, \ |
| 146 | TIMER_OUT_DIS | TIMER_IRQ_ENA | \ |
| 147 | TIMER_PERIOD_CNT | TIMER_MODE_PWM); |
Steven Miao | 2879bb3 | 2012-05-16 18:11:10 +0800 | [diff] [blame] | 148 | #else |
| 149 | set_gptimer_config(TIMER0_id, TIMER_OUT_DIS |
| 150 | | TIMER_MODE_PWM_CONT | TIMER_PULSE_HI | TIMER_IRQ_PER); |
| 151 | #endif |
| 152 | |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 153 | set_gptimer_period(TIMER0_id, get_sclk() / HZ); |
| 154 | set_gptimer_pwidth(TIMER0_id, get_sclk() / HZ - 1); |
| 155 | enable_gptimers(TIMER0bit); |
| 156 | break; |
| 157 | } |
| 158 | case CLOCK_EVT_MODE_ONESHOT: |
| 159 | disable_gptimers(TIMER0bit); |
Steven Miao | 2879bb3 | 2012-05-16 18:11:10 +0800 | [diff] [blame] | 160 | #ifndef CONFIG_BF60x |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 161 | set_gptimer_config(TIMER0_id, \ |
| 162 | TIMER_OUT_DIS | TIMER_IRQ_ENA | TIMER_MODE_PWM); |
Steven Miao | 2879bb3 | 2012-05-16 18:11:10 +0800 | [diff] [blame] | 163 | #else |
| 164 | set_gptimer_config(TIMER0_id, TIMER_OUT_DIS | TIMER_MODE_PWM |
| 165 | | TIMER_PULSE_HI | TIMER_IRQ_WID_DLY); |
| 166 | #endif |
| 167 | |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 168 | set_gptimer_period(TIMER0_id, 0); |
| 169 | break; |
| 170 | case CLOCK_EVT_MODE_UNUSED: |
| 171 | case CLOCK_EVT_MODE_SHUTDOWN: |
| 172 | disable_gptimers(TIMER0bit); |
| 173 | break; |
| 174 | case CLOCK_EVT_MODE_RESUME: |
| 175 | break; |
| 176 | } |
| 177 | } |
| 178 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 179 | static void bfin_gptmr0_ack(void) |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 180 | { |
Steven Miao | 2879bb3 | 2012-05-16 18:11:10 +0800 | [diff] [blame] | 181 | clear_gptimer_intr(TIMER0_id); |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 182 | } |
| 183 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 184 | static void __init bfin_gptmr0_init(void) |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 185 | { |
| 186 | disable_gptimers(TIMER0bit); |
| 187 | } |
| 188 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 189 | #ifdef CONFIG_CORE_TIMER_IRQ_L1 |
| 190 | __attribute__((l1_text)) |
| 191 | #endif |
| 192 | irqreturn_t bfin_gptmr0_interrupt(int irq, void *dev_id) |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 193 | { |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 194 | struct clock_event_device *evt = dev_id; |
| 195 | smp_mb(); |
Mike Frysinger | 0bf02ce | 2011-04-04 15:26:11 +0000 | [diff] [blame] | 196 | /* |
| 197 | * We want to ACK before we handle so that we can handle smaller timer |
| 198 | * intervals. This way if the timer expires again while we're handling |
| 199 | * things, we're more likely to see that 2nd int rather than swallowing |
| 200 | * it by ACKing the int at the end of this handler. |
| 201 | */ |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 202 | bfin_gptmr0_ack(); |
Mike Frysinger | 0bf02ce | 2011-04-04 15:26:11 +0000 | [diff] [blame] | 203 | evt->event_handler(evt); |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 204 | return IRQ_HANDLED; |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 205 | } |
| 206 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 207 | static struct irqaction gptmr0_irq = { |
| 208 | .name = "Blackfin GPTimer0", |
Yong Zhang | 7832bb5 | 2011-09-07 16:10:03 +0800 | [diff] [blame] | 209 | .flags = IRQF_TIMER | IRQF_IRQPOLL | IRQF_PERCPU, |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 210 | .handler = bfin_gptmr0_interrupt, |
| 211 | }; |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 212 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 213 | static struct clock_event_device clockevent_gptmr0 = { |
| 214 | .name = "bfin_gptimer0", |
| 215 | .rating = 300, |
| 216 | .irq = IRQ_TIMER0, |
| 217 | .shift = 32, |
Steven Miao | 2879bb3 | 2012-05-16 18:11:10 +0800 | [diff] [blame] | 218 | .features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT, |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 219 | .set_next_event = bfin_gptmr0_set_next_event, |
| 220 | .set_mode = bfin_gptmr0_set_mode, |
| 221 | }; |
| 222 | |
| 223 | static void __init bfin_gptmr0_clockevent_init(struct clock_event_device *evt) |
| 224 | { |
| 225 | unsigned long clock_tick; |
| 226 | |
| 227 | clock_tick = get_sclk(); |
| 228 | evt->mult = div_sc(clock_tick, NSEC_PER_SEC, evt->shift); |
| 229 | evt->max_delta_ns = clockevent_delta2ns(-1, evt); |
| 230 | evt->min_delta_ns = clockevent_delta2ns(100, evt); |
| 231 | |
| 232 | evt->cpumask = cpumask_of(0); |
| 233 | |
| 234 | clockevents_register_device(evt); |
| 235 | } |
| 236 | #endif /* CONFIG_TICKSOURCE_GPTMR0 */ |
| 237 | |
| 238 | #if defined(CONFIG_TICKSOURCE_CORETMR) |
| 239 | /* per-cpu local core timer */ |
Bob Liu | d0014be | 2011-12-12 11:04:05 +0800 | [diff] [blame] | 240 | DEFINE_PER_CPU(struct clock_event_device, coretmr_events); |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 241 | |
| 242 | static int bfin_coretmr_set_next_event(unsigned long cycles, |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 243 | struct clock_event_device *evt) |
| 244 | { |
| 245 | bfin_write_TCNTL(TMPWR); |
| 246 | CSYNC(); |
| 247 | bfin_write_TCOUNT(cycles); |
| 248 | CSYNC(); |
| 249 | bfin_write_TCNTL(TMPWR | TMREN); |
| 250 | return 0; |
| 251 | } |
| 252 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 253 | static void bfin_coretmr_set_mode(enum clock_event_mode mode, |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 254 | struct clock_event_device *evt) |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 255 | { |
| 256 | switch (mode) { |
| 257 | case CLOCK_EVT_MODE_PERIODIC: { |
Michael Hennerich | e6c91b6 | 2008-04-25 04:58:29 +0800 | [diff] [blame] | 258 | unsigned long tcount = ((get_cclk() / (HZ * TIME_SCALE)) - 1); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 259 | bfin_write_TCNTL(TMPWR); |
| 260 | CSYNC(); |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 261 | bfin_write_TSCALE(TIME_SCALE - 1); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 262 | bfin_write_TPERIOD(tcount); |
| 263 | bfin_write_TCOUNT(tcount); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 264 | CSYNC(); |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 265 | bfin_write_TCNTL(TMPWR | TMREN | TAUTORLD); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 266 | break; |
| 267 | } |
| 268 | case CLOCK_EVT_MODE_ONESHOT: |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 269 | bfin_write_TCNTL(TMPWR); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 270 | CSYNC(); |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 271 | bfin_write_TSCALE(TIME_SCALE - 1); |
| 272 | bfin_write_TPERIOD(0); |
| 273 | bfin_write_TCOUNT(0); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 274 | break; |
| 275 | case CLOCK_EVT_MODE_UNUSED: |
| 276 | case CLOCK_EVT_MODE_SHUTDOWN: |
| 277 | bfin_write_TCNTL(0); |
| 278 | CSYNC(); |
| 279 | break; |
| 280 | case CLOCK_EVT_MODE_RESUME: |
| 281 | break; |
| 282 | } |
| 283 | } |
| 284 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 285 | void bfin_coretmr_init(void) |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 286 | { |
| 287 | /* power up the timer, but don't enable it just yet */ |
| 288 | bfin_write_TCNTL(TMPWR); |
| 289 | CSYNC(); |
| 290 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 291 | /* the TSCALE prescaler counter. */ |
Michael Hennerich | e6c91b6 | 2008-04-25 04:58:29 +0800 | [diff] [blame] | 292 | bfin_write_TSCALE(TIME_SCALE - 1); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 293 | bfin_write_TPERIOD(0); |
| 294 | bfin_write_TCOUNT(0); |
| 295 | |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 296 | CSYNC(); |
| 297 | } |
| 298 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 299 | #ifdef CONFIG_CORE_TIMER_IRQ_L1 |
| 300 | __attribute__((l1_text)) |
| 301 | #endif |
Bob Liu | d0014be | 2011-12-12 11:04:05 +0800 | [diff] [blame] | 302 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 303 | irqreturn_t bfin_coretmr_interrupt(int irq, void *dev_id) |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 304 | { |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 305 | int cpu = smp_processor_id(); |
| 306 | struct clock_event_device *evt = &per_cpu(coretmr_events, cpu); |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 307 | |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 308 | smp_mb(); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 309 | evt->event_handler(evt); |
Graf Yang | 60ffdb3 | 2010-01-20 10:56:24 +0000 | [diff] [blame] | 310 | |
| 311 | touch_nmi_watchdog(); |
| 312 | |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 313 | return IRQ_HANDLED; |
| 314 | } |
| 315 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 316 | static struct irqaction coretmr_irq = { |
| 317 | .name = "Blackfin CoreTimer", |
Yong Zhang | 7832bb5 | 2011-09-07 16:10:03 +0800 | [diff] [blame] | 318 | .flags = IRQF_TIMER | IRQF_IRQPOLL | IRQF_PERCPU, |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 319 | .handler = bfin_coretmr_interrupt, |
| 320 | }; |
| 321 | |
| 322 | void bfin_coretmr_clockevent_init(void) |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 323 | { |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 324 | unsigned long clock_tick; |
| 325 | unsigned int cpu = smp_processor_id(); |
| 326 | struct clock_event_device *evt = &per_cpu(coretmr_events, cpu); |
Vitja Makarov | 1bfb4b2 | 2008-05-07 11:41:26 +0800 | [diff] [blame] | 327 | |
Bob Liu | d0014be | 2011-12-12 11:04:05 +0800 | [diff] [blame] | 328 | #ifdef CONFIG_SMP |
| 329 | evt->broadcast = smp_timer_broadcast; |
| 330 | #endif |
| 331 | |
| 332 | |
Steven Miao | 2879bb3 | 2012-05-16 18:11:10 +0800 | [diff] [blame] | 333 | #ifdef CONFIG_SMP |
| 334 | evt->broadcast = smp_timer_broadcast; |
| 335 | #endif |
| 336 | |
| 337 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 338 | evt->name = "bfin_core_timer"; |
| 339 | evt->rating = 350; |
| 340 | evt->irq = -1; |
| 341 | evt->shift = 32; |
| 342 | evt->features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT; |
| 343 | evt->set_next_event = bfin_coretmr_set_next_event; |
| 344 | evt->set_mode = bfin_coretmr_set_mode; |
Vitja Makarov | 1bfb4b2 | 2008-05-07 11:41:26 +0800 | [diff] [blame] | 345 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 346 | clock_tick = get_cclk() / TIME_SCALE; |
| 347 | evt->mult = div_sc(clock_tick, NSEC_PER_SEC, evt->shift); |
| 348 | evt->max_delta_ns = clockevent_delta2ns(-1, evt); |
| 349 | evt->min_delta_ns = clockevent_delta2ns(100, evt); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 350 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 351 | evt->cpumask = cpumask_of(cpu); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 352 | |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 353 | clockevents_register_device(evt); |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 354 | } |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 355 | #endif /* CONFIG_TICKSOURCE_CORETMR */ |
| 356 | |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 357 | |
John Stultz | cb0e996 | 2010-03-03 19:57:24 -0800 | [diff] [blame] | 358 | void read_persistent_clock(struct timespec *ts) |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 359 | { |
| 360 | time_t secs_since_1970 = (365 * 37 + 9) * 24 * 60 * 60; /* 1 Jan 2007 */ |
John Stultz | cb0e996 | 2010-03-03 19:57:24 -0800 | [diff] [blame] | 361 | ts->tv_sec = secs_since_1970; |
| 362 | ts->tv_nsec = 0; |
| 363 | } |
| 364 | |
| 365 | void __init time_init(void) |
| 366 | { |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 367 | |
| 368 | #ifdef CONFIG_RTC_DRV_BFIN |
| 369 | /* [#2663] hack to filter junk RTC values that would cause |
| 370 | * userspace to have to deal with time values greater than |
| 371 | * 2^31 seconds (which uClibc cannot cope with yet) |
| 372 | */ |
| 373 | if ((bfin_read_RTC_STAT() & 0xC0000000) == 0xC0000000) { |
| 374 | printk(KERN_NOTICE "bfin-rtc: invalid date; resetting\n"); |
| 375 | bfin_write_RTC_STAT(0); |
| 376 | } |
| 377 | #endif |
| 378 | |
Graf Yang | 1fa9be7 | 2009-05-15 11:01:59 +0000 | [diff] [blame] | 379 | bfin_cs_cycles_init(); |
| 380 | bfin_cs_gptimer0_init(); |
Yi Li | 0d152c2 | 2009-12-28 10:21:49 +0000 | [diff] [blame] | 381 | |
| 382 | #if defined(CONFIG_TICKSOURCE_CORETMR) |
| 383 | bfin_coretmr_init(); |
| 384 | setup_irq(IRQ_CORETMR, &coretmr_irq); |
| 385 | bfin_coretmr_clockevent_init(); |
| 386 | #endif |
| 387 | |
| 388 | #if defined(CONFIG_TICKSOURCE_GPTMR0) |
| 389 | bfin_gptmr0_init(); |
| 390 | setup_irq(IRQ_TIMER0, &gptmr0_irq); |
| 391 | gptmr0_irq.dev_id = &clockevent_gptmr0; |
| 392 | bfin_gptmr0_clockevent_init(&clockevent_gptmr0); |
| 393 | #endif |
| 394 | |
| 395 | #if !defined(CONFIG_TICKSOURCE_CORETMR) && !defined(CONFIG_TICKSOURCE_GPTMR0) |
| 396 | # error at least one clock event device is required |
| 397 | #endif |
Vitja Makarov | 8b5f79f | 2008-02-29 12:24:23 +0800 | [diff] [blame] | 398 | } |