drivers/clocksource/timer-stm32.c

   1 /*
   2  * Copyright (C) Maxime Coquelin 2015
   3  * Author:  Maxime Coquelin <mcoquelin.stm32@gmail.com>
   4  * License terms:  GNU General Public License (GPL), version 2
   5  *
   6  * Inspired by time-efm32.c from Uwe Kleine-Koenig
   7  */
   8
   9 #include <linux/kernel.h>
  10 #include <linux/clocksource.h>
  11 #include <linux/clockchips.h>
  12 #include <linux/irq.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/of.h>
  15 #include <linux/of_address.h>
  16 #include <linux/of_irq.h>
  17 #include <linux/clk.h>
  18 #include <linux/reset.h>
  19
  20 #define TIM_CR1         0x00
  21 #define TIM_DIER        0x0c
  22 #define TIM_SR          0x10
  23 #define TIM_EGR         0x14
  24 #define TIM_PSC         0x28
  25 #define TIM_ARR         0x2c
  26
  27 #define TIM_CR1_CEN     BIT(0)
  28 #define TIM_CR1_OPM     BIT(3)
  29 #define TIM_CR1_ARPE    BIT(7)
  30
  31 #define TIM_DIER_UIE    BIT(0)
  32
  33 #define TIM_SR_UIF      BIT(0)
  34
  35 #define TIM_EGR_UG      BIT(0)
  36
  37 struct stm32_clock_event_ddata {
  38         struct clock_event_device evtdev;
  39         unsigned periodic_top;
  40         void __iomem *base;
  41 };
  42
  43 static int stm32_clock_event_shutdown(struct clock_event_device *evtdev)
  44 {
  45         struct stm32_clock_event_ddata *data =
  46                 container_of(evtdev, struct stm32_clock_event_ddata, evtdev);
  47         void *base = data->base;
  48
  49         writel_relaxed(0, base + TIM_CR1);
  50         return 0;
  51 }
  52
  53 static int stm32_clock_event_set_periodic(struct clock_event_device *evtdev)
  54 {
  55         struct stm32_clock_event_ddata *data =
  56                 container_of(evtdev, struct stm32_clock_event_ddata, evtdev);
  57         void *base = data->base;
  58
  59         writel_relaxed(data->periodic_top, base + TIM_ARR);
  60         writel_relaxed(TIM_CR1_ARPE | TIM_CR1_CEN, base + TIM_CR1);
  61         return 0;
  62 }
  63
  64 static int stm32_clock_event_set_next_event(unsigned long evt,
  65                                             struct clock_event_device *evtdev)
  66 {
  67         struct stm32_clock_event_ddata *data =
  68                 container_of(evtdev, struct stm32_clock_event_ddata, evtdev);
  69
  70         writel_relaxed(evt, data->base + TIM_ARR);
  71         writel_relaxed(TIM_CR1_ARPE | TIM_CR1_OPM | TIM_CR1_CEN,
  72                        data->base + TIM_CR1);
  73
  74         return 0;
  75 }
  76
  77 static irqreturn_t stm32_clock_event_handler(int irq, void *dev_id)
  78 {
  79         struct stm32_clock_event_ddata *data = dev_id;
  80
  81         writel_relaxed(0, data->base + TIM_SR);
  82
  83         data->evtdev.event_handler(&data->evtdev);
  84
  85         return IRQ_HANDLED;
  86 }
  87
  88 static struct stm32_clock_event_ddata clock_event_ddata = {
  89         .evtdev = {
  90                 .name = "stm32 clockevent",
  91                 .features = CLOCK_EVT_FEAT_ONESHOT | CLOCK_EVT_FEAT_PERIODIC,
  92                 .set_state_shutdown = stm32_clock_event_shutdown,
  93                 .set_state_periodic = stm32_clock_event_set_periodic,
  94                 .set_state_oneshot = stm32_clock_event_shutdown,
  95                 .tick_resume = stm32_clock_event_shutdown,
  96                 .set_next_event = stm32_clock_event_set_next_event,
  97                 .rating = 200,
  98         },
  99 };
 100
 101 static int __init stm32_clockevent_init(struct device_node *np)
 102 {
 103         struct stm32_clock_event_ddata *data = &clock_event_ddata;
 104         struct clk *clk;
 105         struct reset_control *rstc;
 106         unsigned long rate, max_delta;
 107         int irq, ret, bits, prescaler = 1;
 108
 109         clk = of_clk_get(np, 0);
 110         if (IS_ERR(clk)) {
 111                 ret = PTR_ERR(clk);
 112                 pr_err("failed to get clock for clockevent (%d)\n", ret);
 113                 goto err_clk_get;
 114         }
 115
 116         ret = clk_prepare_enable(clk);
 117         if (ret) {
 118                 pr_err("failed to enable timer clock for clockevent (%d)\n",
 119                        ret);
 120                 goto err_clk_enable;
 121         }
 122
 123         rate = clk_get_rate(clk);
 124
 125         rstc = of_reset_control_get(np, NULL);
 126         if (!IS_ERR(rstc)) {
 127                 reset_control_assert(rstc);
 128                 reset_control_deassert(rstc);
 129         }
 130
 131         data->base = of_iomap(np, 0);
 132         if (!data->base) {
 133                 ret = -ENXIO;
 134                 pr_err("failed to map registers for clockevent\n");
 135                 goto err_iomap;
 136         }
 137
 138         irq = irq_of_parse_and_map(np, 0);
 139         if (!irq) {
 140                 ret = -EINVAL;
 141                 pr_err("%s: failed to get irq.\n", np->full_name);
 142                 goto err_get_irq;
 143         }
 144
 145         /* Detect whether the timer is 16 or 32 bits */
 146         writel_relaxed(~0U, data->base + TIM_ARR);
 147         max_delta = readl_relaxed(data->base + TIM_ARR);
 148         if (max_delta == ~0U) {
 149                 prescaler = 1;
 150                 bits = 32;
 151         } else {
 152                 prescaler = 1024;
 153                 bits = 16;
 154         }
 155         writel_relaxed(0, data->base + TIM_ARR);
 156
 157         writel_relaxed(prescaler - 1, data->base + TIM_PSC);
 158         writel_relaxed(TIM_EGR_UG, data->base + TIM_EGR);
 159         writel_relaxed(TIM_DIER_UIE, data->base + TIM_DIER);
 160         writel_relaxed(0, data->base + TIM_SR);
 161
 162         data->periodic_top = DIV_ROUND_CLOSEST(rate, prescaler * HZ);
 163
 164         clockevents_config_and_register(&data->evtdev,
 165                                         DIV_ROUND_CLOSEST(rate, prescaler),
 166                                         0x1, max_delta);
 167
 168         ret = request_irq(irq, stm32_clock_event_handler, IRQF_TIMER,
 169                         "stm32 clockevent", data);
 170         if (ret) {
 171                 pr_err("%s: failed to request irq.\n", np->full_name);
 172                 goto err_get_irq;
 173         }
 174
 175         pr_info("%s: STM32 clockevent driver initialized (%d bits)\n",
 176                         np->full_name, bits);
 177
 178         return ret;
 179
 180 err_get_irq:
 181         iounmap(data->base);
 182 err_iomap:
 183         clk_disable_unprepare(clk);
 184 err_clk_enable:
 185         clk_put(clk);
 186 err_clk_get:
 187         return ret;
 188 }
 189
 190 CLOCKSOURCE_OF_DECLARE(stm32, "st,stm32-timer", stm32_clockevent_init);