drivers/clocksource/timer-keystone.c

   1 /*
   2  * Keystone broadcast clock-event
   3  *
   4  * Copyright 2013 Texas Instruments, Inc.
   5  *
   6  * Author: Ivan Khoronzhuk <ivan.khoronzhuk@ti.com>
   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  */
  13
  14 #include <linux/clk.h>
  15 #include <linux/clockchips.h>
  16 #include <linux/clocksource.h>
  17 #include <linux/interrupt.h>
  18 #include <linux/of_address.h>
  19 #include <linux/of_irq.h>
  20
  21 #define TIMER_NAME                      "timer-keystone"
  22
  23 /* Timer register offsets */
  24 #define TIM12                           0x10
  25 #define TIM34                           0x14
  26 #define PRD12                           0x18
  27 #define PRD34                           0x1c
  28 #define TCR                             0x20
  29 #define TGCR                            0x24
  30 #define INTCTLSTAT                      0x44
  31
  32 /* Timer register bitfields */
  33 #define TCR_ENAMODE_MASK                0xC0
  34 #define TCR_ENAMODE_ONESHOT_MASK        0x40
  35 #define TCR_ENAMODE_PERIODIC_MASK       0x80
  36
  37 #define TGCR_TIM_UNRESET_MASK           0x03
  38 #define INTCTLSTAT_ENINT_MASK           0x01
  39
  40 /**
  41  * struct keystone_timer: holds timer's data
  42  * @base: timer memory base address
  43  * @hz_period: cycles per HZ period
  44  * @event_dev: event device based on timer
  45  */
  46 static struct keystone_timer {
  47         void __iomem *base;
  48         unsigned long hz_period;
  49         struct clock_event_device event_dev;
  50 } timer;
  51
  52 static inline u32 keystone_timer_readl(unsigned long rg)
  53 {
  54         return readl_relaxed(timer.base + rg);
  55 }
  56
  57 static inline void keystone_timer_writel(u32 val, unsigned long rg)
  58 {
  59         writel_relaxed(val, timer.base + rg);
  60 }
  61
  62 /**
  63  * keystone_timer_barrier: write memory barrier
  64  * use explicit barrier to avoid using readl/writel non relaxed function
  65  * variants, because in our case non relaxed variants hide the true places
  66  * where barrier is needed.
  67  */
  68 static inline void keystone_timer_barrier(void)
  69 {
  70         __iowmb();
  71 }
  72
  73 /**
  74  * keystone_timer_config: configures timer to work in oneshot/periodic modes.
  75  * @ mask: mask of the mode to configure
  76  * @ period: cycles number to configure for
  77  */
  78 static int keystone_timer_config(u64 period, int mask)
  79 {
  80         u32 tcr;
  81         u32 off;
  82
  83         tcr = keystone_timer_readl(TCR);
  84         off = tcr & ~(TCR_ENAMODE_MASK);
  85
  86         /* set enable mode */
  87         tcr |= mask;
  88
  89         /* disable timer */
  90         keystone_timer_writel(off, TCR);
  91         /* here we have to be sure the timer has been disabled */
  92         keystone_timer_barrier();
  93
  94         /* reset counter to zero, set new period */
  95         keystone_timer_writel(0, TIM12);
  96         keystone_timer_writel(0, TIM34);
  97         keystone_timer_writel(period & 0xffffffff, PRD12);
  98         keystone_timer_writel(period >> 32, PRD34);
  99
 100         /*
 101          * enable timer
 102          * here we have to be sure that CNTLO, CNTHI, PRDLO, PRDHI registers
 103          * have been written.
 104          */
 105         keystone_timer_barrier();
 106         keystone_timer_writel(tcr, TCR);
 107         return 0;
 108 }
 109
 110 static void keystone_timer_disable(void)
 111 {
 112         u32 tcr;
 113
 114         tcr = keystone_timer_readl(TCR);
 115
 116         /* disable timer */
 117         tcr &= ~(TCR_ENAMODE_MASK);
 118         keystone_timer_writel(tcr, TCR);
 119 }
 120
 121 static irqreturn_t keystone_timer_interrupt(int irq, void *dev_id)
 122 {
 123         struct clock_event_device *evt = dev_id;
 124
 125         evt->event_handler(evt);
 126         return IRQ_HANDLED;
 127 }
 128
 129 static int keystone_set_next_event(unsigned long cycles,
 130                                   struct clock_event_device *evt)
 131 {
 132         return keystone_timer_config(cycles, TCR_ENAMODE_ONESHOT_MASK);
 133 }
 134
 135 static int keystone_shutdown(struct clock_event_device *evt)
 136 {
 137         keystone_timer_disable();
 138         return 0;
 139 }
 140
 141 static int keystone_set_periodic(struct clock_event_device *evt)
 142 {
 143         keystone_timer_config(timer.hz_period, TCR_ENAMODE_PERIODIC_MASK);
 144         return 0;
 145 }
 146
 147 static void __init keystone_timer_init(struct device_node *np)
 148 {
 149         struct clock_event_device *event_dev = &timer.event_dev;
 150         unsigned long rate;
 151         struct clk *clk;
 152         int irq, error;
 153
 154         irq  = irq_of_parse_and_map(np, 0);
 155         if (!irq) {
 156                 pr_err("%s: failed to map interrupts\n", __func__);
 157                 return;
 158         }
 159
 160         timer.base = of_iomap(np, 0);
 161         if (!timer.base) {
 162                 pr_err("%s: failed to map registers\n", __func__);
 163                 return;
 164         }
 165
 166         clk = of_clk_get(np, 0);
 167         if (IS_ERR(clk)) {
 168                 pr_err("%s: failed to get clock\n", __func__);
 169                 iounmap(timer.base);
 170                 return;
 171         }
 172
 173         error = clk_prepare_enable(clk);
 174         if (error) {
 175                 pr_err("%s: failed to enable clock\n", __func__);
 176                 goto err;
 177         }
 178
 179         rate = clk_get_rate(clk);
 180
 181         /* disable, use internal clock source */
 182         keystone_timer_writel(0, TCR);
 183         /* here we have to be sure the timer has been disabled */
 184         keystone_timer_barrier();
 185
 186         /* reset timer as 64-bit, no pre-scaler, plus features are disabled */
 187         keystone_timer_writel(0, TGCR);
 188
 189         /* unreset timer */
 190         keystone_timer_writel(TGCR_TIM_UNRESET_MASK, TGCR);
 191
 192         /* init counter to zero */
 193         keystone_timer_writel(0, TIM12);
 194         keystone_timer_writel(0, TIM34);
 195
 196         timer.hz_period = DIV_ROUND_UP(rate, HZ);
 197
 198         /* enable timer interrupts */
 199         keystone_timer_writel(INTCTLSTAT_ENINT_MASK, INTCTLSTAT);
 200
 201         error = request_irq(irq, keystone_timer_interrupt, IRQF_TIMER,
 202                             TIMER_NAME, event_dev);
 203         if (error) {
 204                 pr_err("%s: failed to setup irq\n", __func__);
 205                 goto err;
 206         }
 207
 208         /* setup clockevent */
 209         event_dev->features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT;
 210         event_dev->set_next_event = keystone_set_next_event;
 211         event_dev->set_state_shutdown = keystone_shutdown;
 212         event_dev->set_state_periodic = keystone_set_periodic;
 213         event_dev->set_state_oneshot = keystone_shutdown;
 214         event_dev->cpumask = cpu_all_mask;
 215         event_dev->owner = THIS_MODULE;
 216         event_dev->name = TIMER_NAME;
 217         event_dev->irq = irq;
 218
 219         clockevents_config_and_register(event_dev, rate, 1, ULONG_MAX);
 220
 221         pr_info("keystone timer clock @%lu Hz\n", rate);
 222         return;
 223 err:
 224         clk_put(clk);
 225         iounmap(timer.base);
 226 }
 227
 228 CLOCKSOURCE_OF_DECLARE(keystone_timer, "ti,keystone-timer",
 229                                         keystone_timer_init);