Kevin Hilman | 7c6337e | 2007-04-30 19:37:19 +0100 | [diff] [blame] | 1 | /* |
| 2 | * DaVinci timer subsystem |
| 3 | * |
| 4 | * Author: Kevin Hilman, MontaVista Software, Inc. <source@mvista.com> |
| 5 | * |
| 6 | * 2007 (c) MontaVista Software, Inc. This file is licensed under |
| 7 | * the terms of the GNU General Public License version 2. This program |
| 8 | * is licensed "as is" without any warranty of any kind, whether express |
| 9 | * or implied. |
| 10 | */ |
| 11 | #include <linux/kernel.h> |
| 12 | #include <linux/init.h> |
| 13 | #include <linux/types.h> |
| 14 | #include <linux/interrupt.h> |
| 15 | #include <linux/clocksource.h> |
| 16 | #include <linux/clockchips.h> |
| 17 | #include <linux/spinlock.h> |
| 18 | |
| 19 | #include <asm/io.h> |
| 20 | #include <asm/hardware.h> |
| 21 | #include <asm/system.h> |
| 22 | #include <asm/irq.h> |
| 23 | #include <asm/mach/irq.h> |
| 24 | #include <asm/mach/time.h> |
| 25 | #include <asm/errno.h> |
| 26 | #include <asm/arch/io.h> |
| 27 | |
| 28 | static struct clock_event_device clockevent_davinci; |
| 29 | |
| 30 | #define DAVINCI_TIMER0_BASE (IO_PHYS + 0x21400) |
| 31 | #define DAVINCI_TIMER1_BASE (IO_PHYS + 0x21800) |
| 32 | #define DAVINCI_WDOG_BASE (IO_PHYS + 0x21C00) |
| 33 | |
| 34 | enum { |
| 35 | T0_BOT = 0, T0_TOP, T1_BOT, T1_TOP, NUM_TIMERS, |
| 36 | }; |
| 37 | |
| 38 | #define IS_TIMER1(id) (id & 0x2) |
| 39 | #define IS_TIMER0(id) (!IS_TIMER1(id)) |
| 40 | #define IS_TIMER_TOP(id) ((id & 0x1)) |
| 41 | #define IS_TIMER_BOT(id) (!IS_TIMER_TOP(id)) |
| 42 | |
| 43 | static int timer_irqs[NUM_TIMERS] = { |
| 44 | IRQ_TINT0_TINT12, |
| 45 | IRQ_TINT0_TINT34, |
| 46 | IRQ_TINT1_TINT12, |
| 47 | IRQ_TINT1_TINT34, |
| 48 | }; |
| 49 | |
| 50 | /* |
| 51 | * This driver configures the 2 64-bit count-up timers as 4 independent |
| 52 | * 32-bit count-up timers used as follows: |
| 53 | * |
| 54 | * T0_BOT: Timer 0, bottom: clockevent source for hrtimers |
| 55 | * T0_TOP: Timer 0, top : clocksource for generic timekeeping |
| 56 | * T1_BOT: Timer 1, bottom: (used by DSP in TI DSPLink code) |
| 57 | * T1_TOP: Timer 1, top : <unused> |
| 58 | */ |
| 59 | #define TID_CLOCKEVENT T0_BOT |
| 60 | #define TID_CLOCKSOURCE T0_TOP |
| 61 | |
| 62 | /* Timer register offsets */ |
| 63 | #define PID12 0x0 |
| 64 | #define TIM12 0x10 |
| 65 | #define TIM34 0x14 |
| 66 | #define PRD12 0x18 |
| 67 | #define PRD34 0x1c |
| 68 | #define TCR 0x20 |
| 69 | #define TGCR 0x24 |
| 70 | #define WDTCR 0x28 |
| 71 | |
| 72 | /* Timer register bitfields */ |
| 73 | #define TCR_ENAMODE_DISABLE 0x0 |
| 74 | #define TCR_ENAMODE_ONESHOT 0x1 |
| 75 | #define TCR_ENAMODE_PERIODIC 0x2 |
| 76 | #define TCR_ENAMODE_MASK 0x3 |
| 77 | |
| 78 | #define TGCR_TIMMODE_SHIFT 2 |
| 79 | #define TGCR_TIMMODE_64BIT_GP 0x0 |
| 80 | #define TGCR_TIMMODE_32BIT_UNCHAINED 0x1 |
| 81 | #define TGCR_TIMMODE_64BIT_WDOG 0x2 |
| 82 | #define TGCR_TIMMODE_32BIT_CHAINED 0x3 |
| 83 | |
| 84 | #define TGCR_TIM12RS_SHIFT 0 |
| 85 | #define TGCR_TIM34RS_SHIFT 1 |
| 86 | #define TGCR_RESET 0x0 |
| 87 | #define TGCR_UNRESET 0x1 |
| 88 | #define TGCR_RESET_MASK 0x3 |
| 89 | |
| 90 | #define WDTCR_WDEN_SHIFT 14 |
| 91 | #define WDTCR_WDEN_DISABLE 0x0 |
| 92 | #define WDTCR_WDEN_ENABLE 0x1 |
| 93 | #define WDTCR_WDKEY_SHIFT 16 |
| 94 | #define WDTCR_WDKEY_SEQ0 0xa5c6 |
| 95 | #define WDTCR_WDKEY_SEQ1 0xda7e |
| 96 | |
| 97 | struct timer_s { |
| 98 | char *name; |
| 99 | unsigned int id; |
| 100 | unsigned long period; |
| 101 | unsigned long opts; |
| 102 | unsigned long reg_base; |
| 103 | unsigned long tim_reg; |
| 104 | unsigned long prd_reg; |
| 105 | unsigned long enamode_shift; |
| 106 | struct irqaction irqaction; |
| 107 | }; |
| 108 | static struct timer_s timers[]; |
| 109 | |
| 110 | /* values for 'opts' field of struct timer_s */ |
| 111 | #define TIMER_OPTS_DISABLED 0x00 |
| 112 | #define TIMER_OPTS_ONESHOT 0x01 |
| 113 | #define TIMER_OPTS_PERIODIC 0x02 |
| 114 | |
| 115 | static int timer32_config(struct timer_s *t) |
| 116 | { |
| 117 | u32 tcr = davinci_readl(t->reg_base + TCR); |
| 118 | |
| 119 | /* disable timer */ |
| 120 | tcr &= ~(TCR_ENAMODE_MASK << t->enamode_shift); |
| 121 | davinci_writel(tcr, t->reg_base + TCR); |
| 122 | |
| 123 | /* reset counter to zero, set new period */ |
| 124 | davinci_writel(0, t->tim_reg); |
| 125 | davinci_writel(t->period, t->prd_reg); |
| 126 | |
| 127 | /* Set enable mode */ |
| 128 | if (t->opts & TIMER_OPTS_ONESHOT) { |
| 129 | tcr |= TCR_ENAMODE_ONESHOT << t->enamode_shift; |
| 130 | } else if (t->opts & TIMER_OPTS_PERIODIC) { |
| 131 | tcr |= TCR_ENAMODE_PERIODIC << t->enamode_shift; |
| 132 | } |
| 133 | |
| 134 | davinci_writel(tcr, t->reg_base + TCR); |
| 135 | return 0; |
| 136 | } |
| 137 | |
| 138 | static inline u32 timer32_read(struct timer_s *t) |
| 139 | { |
| 140 | return davinci_readl(t->tim_reg); |
| 141 | } |
| 142 | |
| 143 | static irqreturn_t timer_interrupt(int irq, void *dev_id) |
| 144 | { |
| 145 | struct clock_event_device *evt = &clockevent_davinci; |
| 146 | |
| 147 | evt->event_handler(evt); |
| 148 | return IRQ_HANDLED; |
| 149 | } |
| 150 | |
| 151 | /* called when 32-bit counter wraps */ |
| 152 | static irqreturn_t freerun_interrupt(int irq, void *dev_id) |
| 153 | { |
| 154 | return IRQ_HANDLED; |
| 155 | } |
| 156 | |
| 157 | static struct timer_s timers[] = { |
| 158 | [TID_CLOCKEVENT] = { |
| 159 | .name = "clockevent", |
| 160 | .opts = TIMER_OPTS_DISABLED, |
| 161 | .irqaction = { |
| 162 | .flags = IRQF_DISABLED | IRQF_TIMER, |
| 163 | .handler = timer_interrupt, |
| 164 | } |
| 165 | }, |
| 166 | [TID_CLOCKSOURCE] = { |
| 167 | .name = "free-run counter", |
| 168 | .period = ~0, |
| 169 | .opts = TIMER_OPTS_PERIODIC, |
| 170 | .irqaction = { |
| 171 | .flags = IRQF_DISABLED | IRQF_TIMER, |
| 172 | .handler = freerun_interrupt, |
| 173 | } |
| 174 | }, |
| 175 | }; |
| 176 | |
| 177 | static void __init timer_init(void) |
| 178 | { |
| 179 | u32 bases[] = {DAVINCI_TIMER0_BASE, DAVINCI_TIMER1_BASE}; |
| 180 | int i; |
| 181 | |
| 182 | /* Global init of each 64-bit timer as a whole */ |
| 183 | for(i=0; i<2; i++) { |
| 184 | u32 tgcr, base = bases[i]; |
| 185 | |
| 186 | /* Disabled, Internal clock source */ |
| 187 | davinci_writel(0, base + TCR); |
| 188 | |
| 189 | /* reset both timers, no pre-scaler for timer34 */ |
| 190 | tgcr = 0; |
| 191 | davinci_writel(tgcr, base + TGCR); |
| 192 | |
| 193 | /* Set both timers to unchained 32-bit */ |
| 194 | tgcr = TGCR_TIMMODE_32BIT_UNCHAINED << TGCR_TIMMODE_SHIFT; |
| 195 | davinci_writel(tgcr, base + TGCR); |
| 196 | |
| 197 | /* Unreset timers */ |
| 198 | tgcr |= (TGCR_UNRESET << TGCR_TIM12RS_SHIFT) | |
| 199 | (TGCR_UNRESET << TGCR_TIM34RS_SHIFT); |
| 200 | davinci_writel(tgcr, base + TGCR); |
| 201 | |
| 202 | /* Init both counters to zero */ |
| 203 | davinci_writel(0, base + TIM12); |
| 204 | davinci_writel(0, base + TIM34); |
| 205 | } |
| 206 | |
| 207 | /* Init of each timer as a 32-bit timer */ |
| 208 | for (i=0; i< ARRAY_SIZE(timers); i++) { |
| 209 | struct timer_s *t = &timers[i]; |
| 210 | |
| 211 | if (t->name) { |
| 212 | t->id = i; |
| 213 | t->reg_base = (IS_TIMER1(t->id) ? |
| 214 | DAVINCI_TIMER1_BASE : DAVINCI_TIMER0_BASE); |
| 215 | |
| 216 | if (IS_TIMER_BOT(t->id)) { |
| 217 | t->enamode_shift = 6; |
| 218 | t->tim_reg = t->reg_base + TIM12; |
| 219 | t->prd_reg = t->reg_base + PRD12; |
| 220 | } else { |
| 221 | t->enamode_shift = 22; |
| 222 | t->tim_reg = t->reg_base + TIM34; |
| 223 | t->prd_reg = t->reg_base + PRD34; |
| 224 | } |
| 225 | |
| 226 | /* Register interrupt */ |
| 227 | t->irqaction.name = t->name; |
| 228 | t->irqaction.dev_id = (void *)t; |
| 229 | if (t->irqaction.handler != NULL) { |
| 230 | setup_irq(timer_irqs[t->id], &t->irqaction); |
| 231 | } |
| 232 | |
| 233 | timer32_config(&timers[i]); |
| 234 | } |
| 235 | } |
| 236 | } |
| 237 | |
| 238 | /* |
| 239 | * clocksource |
| 240 | */ |
| 241 | static cycle_t read_cycles(void) |
| 242 | { |
| 243 | struct timer_s *t = &timers[TID_CLOCKSOURCE]; |
| 244 | |
| 245 | return (cycles_t)timer32_read(t); |
| 246 | } |
| 247 | |
| 248 | static struct clocksource clocksource_davinci = { |
| 249 | .name = "timer0_1", |
| 250 | .rating = 300, |
| 251 | .read = read_cycles, |
| 252 | .mask = CLOCKSOURCE_MASK(32), |
| 253 | .shift = 24, |
| 254 | .flags = CLOCK_SOURCE_IS_CONTINUOUS, |
| 255 | }; |
| 256 | |
| 257 | /* |
| 258 | * clockevent |
| 259 | */ |
| 260 | static int davinci_set_next_event(unsigned long cycles, |
| 261 | struct clock_event_device *evt) |
| 262 | { |
| 263 | struct timer_s *t = &timers[TID_CLOCKEVENT]; |
| 264 | |
| 265 | t->period = cycles; |
| 266 | timer32_config(t); |
| 267 | return 0; |
| 268 | } |
| 269 | |
| 270 | static void davinci_set_mode(enum clock_event_mode mode, |
| 271 | struct clock_event_device *evt) |
| 272 | { |
| 273 | struct timer_s *t = &timers[TID_CLOCKEVENT]; |
| 274 | |
| 275 | switch (mode) { |
| 276 | case CLOCK_EVT_MODE_PERIODIC: |
| 277 | t->period = CLOCK_TICK_RATE / (HZ); |
| 278 | t->opts = TIMER_OPTS_PERIODIC; |
| 279 | timer32_config(t); |
| 280 | break; |
| 281 | case CLOCK_EVT_MODE_ONESHOT: |
| 282 | t->opts = TIMER_OPTS_ONESHOT; |
| 283 | break; |
| 284 | case CLOCK_EVT_MODE_UNUSED: |
| 285 | case CLOCK_EVT_MODE_SHUTDOWN: |
| 286 | t->opts = TIMER_OPTS_DISABLED; |
| 287 | break; |
Thomas Gleixner | 18de5bc | 2007-07-21 04:37:34 -0700 | [diff] [blame^] | 288 | case CLOCK_EVT_MODE_RESUME: |
| 289 | break; |
Kevin Hilman | 7c6337e | 2007-04-30 19:37:19 +0100 | [diff] [blame] | 290 | } |
| 291 | } |
| 292 | |
| 293 | static struct clock_event_device clockevent_davinci = { |
| 294 | .name = "timer0_0", |
| 295 | .features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT, |
| 296 | .shift = 32, |
| 297 | .set_next_event = davinci_set_next_event, |
| 298 | .set_mode = davinci_set_mode, |
| 299 | }; |
| 300 | |
| 301 | |
| 302 | static void __init davinci_timer_init(void) |
| 303 | { |
| 304 | static char err[] __initdata = KERN_ERR |
| 305 | "%s: can't register clocksource!\n"; |
| 306 | |
| 307 | /* init timer hw */ |
| 308 | timer_init(); |
| 309 | |
| 310 | /* setup clocksource */ |
| 311 | clocksource_davinci.mult = |
| 312 | clocksource_khz2mult(CLOCK_TICK_RATE/1000, |
| 313 | clocksource_davinci.shift); |
| 314 | if (clocksource_register(&clocksource_davinci)) |
| 315 | printk(err, clocksource_davinci.name); |
| 316 | |
| 317 | /* setup clockevent */ |
| 318 | clockevent_davinci.mult = div_sc(CLOCK_TICK_RATE, NSEC_PER_SEC, |
| 319 | clockevent_davinci.shift); |
| 320 | clockevent_davinci.max_delta_ns = |
| 321 | clockevent_delta2ns(0xfffffffe, &clockevent_davinci); |
| 322 | clockevent_davinci.min_delta_ns = |
| 323 | clockevent_delta2ns(1, &clockevent_davinci); |
| 324 | |
| 325 | clockevent_davinci.cpumask = cpumask_of_cpu(0); |
| 326 | clockevents_register_device(&clockevent_davinci); |
| 327 | } |
| 328 | |
| 329 | struct sys_timer davinci_timer = { |
| 330 | .init = davinci_timer_init, |
| 331 | }; |
| 332 | |
| 333 | |
| 334 | /* reset board using watchdog timer */ |
| 335 | void davinci_watchdog_reset(void) { |
| 336 | u32 tgcr, wdtcr, base = DAVINCI_WDOG_BASE; |
| 337 | |
| 338 | /* disable, internal clock source */ |
| 339 | davinci_writel(0, base + TCR); |
| 340 | |
| 341 | /* reset timer, set mode to 64-bit watchdog, and unreset */ |
| 342 | tgcr = 0; |
| 343 | davinci_writel(tgcr, base + TCR); |
| 344 | tgcr = TGCR_TIMMODE_64BIT_WDOG << TGCR_TIMMODE_SHIFT; |
| 345 | tgcr |= (TGCR_UNRESET << TGCR_TIM12RS_SHIFT) | |
| 346 | (TGCR_UNRESET << TGCR_TIM34RS_SHIFT); |
| 347 | davinci_writel(tgcr, base + TCR); |
| 348 | |
| 349 | /* clear counter and period regs */ |
| 350 | davinci_writel(0, base + TIM12); |
| 351 | davinci_writel(0, base + TIM34); |
| 352 | davinci_writel(0, base + PRD12); |
| 353 | davinci_writel(0, base + PRD34); |
| 354 | |
| 355 | /* enable */ |
| 356 | wdtcr = davinci_readl(base + WDTCR); |
| 357 | wdtcr |= WDTCR_WDEN_ENABLE << WDTCR_WDEN_SHIFT; |
| 358 | davinci_writel(wdtcr, base + WDTCR); |
| 359 | |
| 360 | /* put watchdog in pre-active state */ |
| 361 | wdtcr = (WDTCR_WDKEY_SEQ0 << WDTCR_WDKEY_SHIFT) | |
| 362 | (WDTCR_WDEN_ENABLE << WDTCR_WDEN_SHIFT); |
| 363 | davinci_writel(wdtcr, base + WDTCR); |
| 364 | |
| 365 | /* put watchdog in active state */ |
| 366 | wdtcr = (WDTCR_WDKEY_SEQ1 << WDTCR_WDKEY_SHIFT) | |
| 367 | (WDTCR_WDEN_ENABLE << WDTCR_WDEN_SHIFT); |
| 368 | davinci_writel(wdtcr, base + WDTCR); |
| 369 | |
| 370 | /* write an invalid value to the WDKEY field to trigger |
| 371 | * a watchdog reset */ |
| 372 | wdtcr = 0x00004000; |
| 373 | davinci_writel(wdtcr, base + WDTCR); |
| 374 | } |