blob: 72be2977547ab53b953b1a821cf16ea20532c058 [file] [log] [blame]
Giulio Benettif8c85732021-05-13 12:18:31 +02001// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Copyright (C) 2021
4 * Author(s): Giulio Benetti <giulio.benetti@benettiengineering.com>
5 */
6
7#include <common.h>
8#include <clk.h>
9#include <dm.h>
10#include <fdtdec.h>
11#include <timer.h>
12#include <dm/device_compat.h>
13
14#include <asm/io.h>
15
16#define GPT_CR_EN BIT(0)
17#define GPT_CR_FRR BIT(9)
18#define GPT_CR_EN_24M BIT(10)
19#define GPT_CR_SWR BIT(15)
20
21#define GPT_PR_PRESCALER24M_MASK 0x0000F000
22#define GPT_PR_PRESCALER24M_SHIFT 12
23#define GPT_PR_PRESCALER24M_MAX (GPT_PR_PRESCALER24M_MASK >> GPT_PR_PRESCALER24M_SHIFT)
24#define GPT_PR_PRESCALER_MASK 0x00000FFF
25#define GPT_PR_PRESCALER_SHIFT 0
26#define GPT_PR_PRESCALER_MAX (GPT_PR_PRESCALER_MASK >> GPT_PR_PRESCALER_SHIFT)
27
28#define GPT_CLKSRC_IPG_CLK (1 << 6)
29#define GPT_CLKSRC_IPG_CLK_24M (5 << 6)
30
31/* If CONFIG_SYS_HZ_CLOCK not specified et's default to 3Mhz */
32#ifndef CONFIG_SYS_HZ_CLOCK
33#define CONFIG_SYS_HZ_CLOCK 3000000
34#endif
35
36struct imx_gpt_timer_regs {
37 u32 cr;
38 u32 pr;
39 u32 sr;
40 u32 ir;
41 u32 ocr1;
42 u32 ocr2;
43 u32 ocr3;
44 u32 icr1;
45 u32 icr2;
46 u32 cnt;
47};
48
49struct imx_gpt_timer_priv {
50 struct imx_gpt_timer_regs *base;
51};
52
53static u64 imx_gpt_timer_get_count(struct udevice *dev)
54{
55 struct imx_gpt_timer_priv *priv = dev_get_priv(dev);
56 struct imx_gpt_timer_regs *regs = priv->base;
57
58 return timer_conv_64(readl(&regs->cnt));
59}
60
61static int imx_gpt_setup(struct imx_gpt_timer_regs *regs, u32 rate)
62{
63 u32 prescaler = (rate / CONFIG_SYS_HZ_CLOCK) - 1;
64
65 /* Reset the timer */
66 setbits_le32(&regs->cr, GPT_CR_SWR);
67
68 /* Wait for timer to finish reset */
69 while (readl(&regs->cr) & GPT_CR_SWR)
70 ;
71
72 if (rate == 24000000UL) {
73 /* Set timer frequency if using 24M clock source */
74 if (prescaler > GPT_PR_PRESCALER24M_MAX)
75 return -EINVAL;
76
77 /* Set 24M prescaler */
78 writel((prescaler << GPT_PR_PRESCALER24M_SHIFT), &regs->pr);
79 /* Set Oscillator as clock source, enable 24M input and set gpt
80 * in free-running mode
81 */
82 writel(GPT_CLKSRC_IPG_CLK_24M | GPT_CR_EN_24M | GPT_CR_FRR, &regs->cr);
83 } else {
84 if (prescaler > GPT_PR_PRESCALER_MAX)
85 return -EINVAL;
86
87 /* Set prescaler */
88 writel((prescaler << GPT_PR_PRESCALER_SHIFT), &regs->pr);
89 /* Set Peripheral as clock source and set gpt in free-running
90 * mode
91 */
92 writel(GPT_CLKSRC_IPG_CLK | GPT_CR_FRR, &regs->cr);
93 }
94
95 /* Start timer */
96 setbits_le32(&regs->cr, GPT_CR_EN);
97
98 return 0;
99}
100
101static int imx_gpt_timer_probe(struct udevice *dev)
102{
103 struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev);
104 struct imx_gpt_timer_priv *priv = dev_get_priv(dev);
105 struct imx_gpt_timer_regs *regs;
106 struct clk clk;
107 fdt_addr_t addr;
108 u32 clk_rate;
109 int ret;
110
111 addr = dev_read_addr(dev);
112 if (addr == FDT_ADDR_T_NONE)
113 return -EINVAL;
114
115 priv->base = (struct imx_gpt_timer_regs *)addr;
116 regs = priv->base;
117
118 ret = clk_get_by_index(dev, 0, &clk);
119 if (ret < 0)
120 return ret;
121
122 ret = clk_enable(&clk);
123 if (ret) {
124 dev_err(dev, "Failed to enable clock\n");
125 return ret;
126 }
127
128 /* Get timer clock rate */
129 clk_rate = clk_get_rate(&clk);
130 if (clk_rate <= 0) {
131 dev_err(dev, "Could not get clock rate...\n");
132 return -EINVAL;
133 }
134
135 ret = imx_gpt_setup(regs, clk_rate);
136 if (ret) {
137 dev_err(dev, "Could not setup timer\n");
138 return ret;
139 }
140
141 uc_priv->clock_rate = CONFIG_SYS_HZ_CLOCK;
142
143 return 0;
144}
145
146static const struct timer_ops imx_gpt_timer_ops = {
147 .get_count = imx_gpt_timer_get_count,
148};
149
150static const struct udevice_id imx_gpt_timer_ids[] = {
151 { .compatible = "fsl,imxrt-gpt" },
152 {}
153};
154
155U_BOOT_DRIVER(imx_gpt_timer) = {
156 .name = "imx_gpt_timer",
157 .id = UCLASS_TIMER,
158 .of_match = imx_gpt_timer_ids,
159 .priv_auto = sizeof(struct imx_gpt_timer_priv),
160 .probe = imx_gpt_timer_probe,
161 .ops = &imx_gpt_timer_ops,
162};