arch/arm/plat-nomadik/timer.c

   1 /*
   2  *  linux/arch/arm/plat-nomadik/timer.c
   3  *
   4  * Copyright (C) 2008 STMicroelectronics
   5  * Copyright (C) 2010 Alessandro Rubini
   6  * Copyright (C) 2010 Linus Walleij for ST-Ericsson
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2, as
  10  * published by the Free Software Foundation.
  11  */
  12 #include <linux/init.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/irq.h>
  15 #include <linux/io.h>
  16 #include <linux/clockchips.h>
  17 #include <linux/clk.h>
  18 #include <linux/jiffies.h>
  19 #include <linux/err.h>
  20 #include <linux/cnt32_to_63.h>
  21 #include <linux/timer.h>
  22 #include <asm/mach/time.h>
  23
  24 #include <plat/mtu.h>
  25
  26 void __iomem *mtu_base; /* Assigned by machine code */
  27
  28 /*
  29  * Kernel assumes that sched_clock can be called early
  30  * but the MTU may not yet be initialized.
  31  */
  32 static cycle_t nmdk_read_timer_dummy(struct clocksource *cs)
  33 {
  34         return 0;
  35 }
  36
  37 /* clocksource: MTU decrements, so we negate the value being read. */
  38 static cycle_t nmdk_read_timer(struct clocksource *cs)
  39 {
  40         return -readl(mtu_base + MTU_VAL(0));
  41 }
  42
  43 static struct clocksource nmdk_clksrc = {
  44         .name           = "mtu_0",
  45         .rating         = 200,
  46         .read           = nmdk_read_timer_dummy,
  47         .mask           = CLOCKSOURCE_MASK(32),
  48         .flags          = CLOCK_SOURCE_IS_CONTINUOUS,
  49 };
  50
  51 /*
  52  * Override the global weak sched_clock symbol with this
  53  * local implementation which uses the clocksource to get some
  54  * better resolution when scheduling the kernel.
  55  *
  56  * Because the hardware timer period may be quite short
  57  * (32.3 secs on the 133 MHz MTU timer selection on ux500)
  58  * and because cnt32_to_63() needs to be called at least once per
  59  * half period to work properly, a kernel keepwarm() timer is set up
  60  * to ensure this requirement is always met.
  61  *
  62  * Also the sched_clock timer will wrap around at some point,
  63  * here we set it to run continously for a year.
  64  */
  65 #define SCHED_CLOCK_MIN_WRAP 3600*24*365
  66 static struct timer_list cnt32_to_63_keepwarm_timer;
  67 static u32 sched_mult;
  68 static u32 sched_shift;
  69
  70 unsigned long long notrace sched_clock(void)
  71 {
  72         u64 cycles;
  73
  74         if (unlikely(!mtu_base))
  75                 return 0;
  76
  77         cycles = cnt32_to_63(-readl(mtu_base + MTU_VAL(0)));
  78         /*
  79          * sched_mult is guaranteed to be even so will
  80          * shift out bit 63
  81          */
  82         return (cycles * sched_mult) >> sched_shift;
  83 }
  84
  85 /* Just kick sched_clock every so often */
  86 static void cnt32_to_63_keepwarm(unsigned long data)
  87 {
  88         mod_timer(&cnt32_to_63_keepwarm_timer, round_jiffies(jiffies + data));
  89         (void) sched_clock();
  90 }
  91
  92 /*
  93  * Set up a timer to keep sched_clock():s 32_to_63 algorithm warm
  94  * once in half a 32bit timer wrap interval.
  95  */
  96 static void __init nmdk_sched_clock_init(unsigned long rate)
  97 {
  98         u32 v;
  99         unsigned long delta;
 100         u64 days;
 101
 102         /* Find the apropriate mult and shift factors */
 103         clocks_calc_mult_shift(&sched_mult, &sched_shift,
 104                                rate, NSEC_PER_SEC, SCHED_CLOCK_MIN_WRAP);
 105         /* We need to multiply by an even number to get rid of bit 63 */
 106         if (sched_mult & 1)
 107                 sched_mult++;
 108
 109         /* Let's see what we get, take max counter and scale it */
 110         days = (0xFFFFFFFFFFFFFFFFLLU * sched_mult) >> sched_shift;
 111         do_div(days, NSEC_PER_SEC);
 112         do_div(days, (3600*24));
 113
 114         pr_info("sched_clock: using %d bits @ %lu Hz wrap in %lu days\n",
 115                 (64 - sched_shift), rate, (unsigned long) days);
 116
 117         /*
 118          * Program a timer to kick us at half 32bit wraparound
 119          * Formula: seconds per wrap = (2^32) / f
 120          */
 121         v = 0xFFFFFFFFUL / rate;
 122         /* We want half of the wrap time to keep cnt32_to_63 warm */
 123         v /= 2;
 124         pr_debug("sched_clock: prescaled timer rate: %lu Hz, "
 125                  "initialize keepwarm timer every %d seconds\n", rate, v);
 126         /* Convert seconds to jiffies */
 127         delta = msecs_to_jiffies(v*1000);
 128         setup_timer(&cnt32_to_63_keepwarm_timer, cnt32_to_63_keepwarm, delta);
 129         mod_timer(&cnt32_to_63_keepwarm_timer, round_jiffies(jiffies + delta));
 130 }
 131
 132 /* Clockevent device: use one-shot mode */
 133 static void nmdk_clkevt_mode(enum clock_event_mode mode,
 134                              struct clock_event_device *dev)
 135 {
 136         u32 cr;
 137
 138         switch (mode) {
 139         case CLOCK_EVT_MODE_PERIODIC:
 140                 pr_err("%s: periodic mode not supported\n", __func__);
 141                 break;
 142         case CLOCK_EVT_MODE_ONESHOT:
 143                 /* Load highest value, enable device, enable interrupts */
 144                 cr = readl(mtu_base + MTU_CR(1));
 145                 writel(0, mtu_base + MTU_LR(1));
 146                 writel(cr | MTU_CRn_ENA, mtu_base + MTU_CR(1));
 147                 writel(1 << 1, mtu_base + MTU_IMSC);
 148                 break;
 149         case CLOCK_EVT_MODE_SHUTDOWN:
 150         case CLOCK_EVT_MODE_UNUSED:
 151                 /* disable irq */
 152                 writel(0, mtu_base + MTU_IMSC);
 153                 /* disable timer */
 154                 cr = readl(mtu_base + MTU_CR(1));
 155                 cr &= ~MTU_CRn_ENA;
 156                 writel(cr, mtu_base + MTU_CR(1));
 157                 /* load some high default value */
 158                 writel(0xffffffff, mtu_base + MTU_LR(1));
 159                 break;
 160         case CLOCK_EVT_MODE_RESUME:
 161                 break;
 162         }
 163 }
 164
 165 static int nmdk_clkevt_next(unsigned long evt, struct clock_event_device *ev)
 166 {
 167         /* writing the value has immediate effect */
 168         writel(evt, mtu_base + MTU_LR(1));
 169         return 0;
 170 }
 171
 172 static struct clock_event_device nmdk_clkevt = {
 173         .name           = "mtu_1",
 174         .features       = CLOCK_EVT_FEAT_ONESHOT,
 175         .rating         = 200,
 176         .set_mode       = nmdk_clkevt_mode,
 177         .set_next_event = nmdk_clkevt_next,
 178 };
 179
 180 /*
 181  * IRQ Handler for timer 1 of the MTU block.
 182  */
 183 static irqreturn_t nmdk_timer_interrupt(int irq, void *dev_id)
 184 {
 185         struct clock_event_device *evdev = dev_id;
 186
 187         writel(1 << 1, mtu_base + MTU_ICR); /* Interrupt clear reg */
 188         evdev->event_handler(evdev);
 189         return IRQ_HANDLED;
 190 }
 191
 192 static struct irqaction nmdk_timer_irq = {
 193         .name           = "Nomadik Timer Tick",
 194         .flags          = IRQF_DISABLED | IRQF_TIMER,
 195         .handler        = nmdk_timer_interrupt,
 196         .dev_id         = &nmdk_clkevt,
 197 };
 198
 199 void __init nmdk_timer_init(void)
 200 {
 201         unsigned long rate;
 202         struct clk *clk0;
 203         u32 cr = MTU_CRn_32BITS;
 204
 205         clk0 = clk_get_sys("mtu0", NULL);
 206         BUG_ON(IS_ERR(clk0));
 207
 208         clk_enable(clk0);
 209
 210         /*
 211          * Tick rate is 2.4MHz for Nomadik and 2.4Mhz, 100MHz or 133 MHz
 212          * for ux500.
 213          * Use a divide-by-16 counter if the tick rate is more than 32MHz.
 214          * At 32 MHz, the timer (with 32 bit counter) can be programmed
 215          * to wake-up at a max 127s a head in time. Dividing a 2.4 MHz timer
 216          * with 16 gives too low timer resolution.
 217          */
 218         rate = clk_get_rate(clk0);
 219         if (rate > 32000000) {
 220                 rate /= 16;
 221                 cr |= MTU_CRn_PRESCALE_16;
 222         } else {
 223                 cr |= MTU_CRn_PRESCALE_1;
 224         }
 225         clocksource_calc_mult_shift(&nmdk_clksrc, rate, MTU_MIN_RANGE);
 226
 227         /* Timer 0 is the free running clocksource */
 228         writel(cr, mtu_base + MTU_CR(0));
 229         writel(0, mtu_base + MTU_LR(0));
 230         writel(0, mtu_base + MTU_BGLR(0));
 231         writel(cr | MTU_CRn_ENA, mtu_base + MTU_CR(0));
 232
 233         /* Now the clock source is ready */
 234         nmdk_clksrc.read = nmdk_read_timer;
 235
 236         if (clocksource_register(&nmdk_clksrc))
 237                 pr_err("timer: failed to initialize clock source %s\n",
 238                        nmdk_clksrc.name);
 239
 240         nmdk_sched_clock_init(rate);
 241
 242         /* Timer 1 is used for events */
 243
 244         clockevents_calc_mult_shift(&nmdk_clkevt, rate, MTU_MIN_RANGE);
 245
 246         writel(cr | MTU_CRn_ONESHOT, mtu_base + MTU_CR(1)); /* off, currently */
 247
 248         nmdk_clkevt.max_delta_ns =
 249                 clockevent_delta2ns(0xffffffff, &nmdk_clkevt);
 250         nmdk_clkevt.min_delta_ns =
 251                 clockevent_delta2ns(0x00000002, &nmdk_clkevt);
 252         nmdk_clkevt.cpumask     = cpumask_of(0);
 253
 254         /* Register irq and clockevents */
 255         setup_irq(IRQ_MTU0, &nmdk_timer_irq);
 256         clockevents_register_device(&nmdk_clkevt);
 257 }