arch/arm/cpu/armv7/stv0991/timer.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2014, STMicroelectronics - All Rights Reserved
   4  * Author(s): Vikas Manocha, <vikas.manocha@st.com> for STMicroelectronics.
   5  */
   6
   7 #include <common.h>
   8 #include <init.h>
   9 #include <time.h>
  10 #include <asm/io.h>
  11 #include <asm/arch-stv0991/hardware.h>
  12 #include <asm/arch-stv0991/stv0991_cgu.h>
  13 #include <asm/arch-stv0991/stv0991_gpt.h>
  14 #include <linux/delay.h>
  15
  16 static struct stv0991_cgu_regs *const stv0991_cgu_regs = \
  17                                 (struct stv0991_cgu_regs *) (CGU_BASE_ADDR);
  18
  19 #define READ_TIMER()    (readl(&gpt1_regs_ptr->cnt) & GPT_FREE_RUNNING)
  20 #define GPT_RESOLUTION  (CONFIG_STV0991_HZ_CLOCK / CONFIG_STV0991_HZ)
  21
  22 DECLARE_GLOBAL_DATA_PTR;
  23
  24 #define timestamp gd->arch.tbl
  25 #define lastdec gd->arch.lastinc
  26
  27 static ulong get_timer_masked(void);
  28
  29 int timer_init(void)
  30 {
  31         /* Timer1 clock configuration */
  32         writel(TIMER1_CLK_CFG, &stv0991_cgu_regs->tim_freq);
  33         writel(readl(&stv0991_cgu_regs->cgu_enable_2) |
  34                         TIMER1_CLK_EN, &stv0991_cgu_regs->cgu_enable_2);
  35
  36         /* Stop the timer */
  37         writel(readl(&gpt1_regs_ptr->cr1) & ~GPT_CR1_CEN, &gpt1_regs_ptr->cr1);
  38         writel(GPT_PRESCALER_128, &gpt1_regs_ptr->psc);
  39         /* Configure timer for auto-reload */
  40         writel(readl(&gpt1_regs_ptr->cr1) | GPT_MODE_AUTO_RELOAD,
  41                         &gpt1_regs_ptr->cr1);
  42
  43         /* load value for free running */
  44         writel(GPT_FREE_RUNNING, &gpt1_regs_ptr->arr);
  45
  46         /* start timer */
  47         writel(readl(&gpt1_regs_ptr->cr1) | GPT_CR1_CEN,
  48                         &gpt1_regs_ptr->cr1);
  49
  50         /* Reset the timer */
  51         lastdec = READ_TIMER();
  52         timestamp = 0;
  53
  54         return 0;
  55 }
  56
  57 /*
  58  * timer without interrupts
  59  */
  60 ulong get_timer(ulong base)
  61 {
  62         return (get_timer_masked() / GPT_RESOLUTION) - base;
  63 }
  64
  65 void __udelay(unsigned long usec)
  66 {
  67         ulong tmo;
  68         ulong start = get_timer_masked();
  69         ulong tenudelcnt = CONFIG_STV0991_HZ_CLOCK / (1000 * 100);
  70         ulong rndoff;
  71
  72         rndoff = (usec % 10) ? 1 : 0;
  73
  74         /* tenudelcnt timer tick gives 10 microsecconds delay */
  75         tmo = ((usec / 10) + rndoff) * tenudelcnt;
  76
  77         while ((ulong) (get_timer_masked() - start) < tmo)
  78                 ;
  79 }
  80
  81 static ulong get_timer_masked(void)
  82 {
  83         ulong now = READ_TIMER();
  84
  85         if (now >= lastdec) {
  86                 /* normal mode */
  87                 timestamp += now - lastdec;
  88         } else {
  89                 /* we have an overflow ... */
  90                 timestamp += now + GPT_FREE_RUNNING - lastdec;
  91         }
  92         lastdec = now;
  93
  94         return timestamp;
  95 }
  96
  97 /*
  98  * This function is derived from PowerPC code (read timebase as long long).
  99  * On ARM it just returns the timer value.
 100  */
 101 unsigned long long get_ticks(void)
 102 {
 103         return get_timer(0);
 104 }
 105
 106 /*
 107  * This function is derived from PowerPC code (timebase clock frequency).
 108  * On ARM it returns the number of timer ticks per second.
 109  */
 110 ulong get_tbclk(void)
 111 {
 112         return CONFIG_STV0991_HZ;
 113 }