Merge tag 'amd-drm-next-5.14-2021-05-21' of https://gitlab.freedesktop.org/agd5f...
[linux-block.git] / drivers / clk / sunxi / clk-sun9i-core.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Copyright 2014 Chen-Yu Tsai
4  *
5  * Chen-Yu Tsai <wens@csie.org>
6  */
7
8 #include <linux/clk.h>
9 #include <linux/clk-provider.h>
10 #include <linux/of.h>
11 #include <linux/of_address.h>
12 #include <linux/log2.h>
13
14 #include "clk-factors.h"
15
16
17 /*
18  * sun9i_a80_get_pll4_factors() - calculates n, p, m factors for PLL4
19  * PLL4 rate is calculated as follows
20  * rate = (parent_rate * n >> p) / (m + 1);
21  * parent_rate is always 24MHz
22  *
23  * p and m are named div1 and div2 in Allwinner's SDK
24  */
25
26 static void sun9i_a80_get_pll4_factors(struct factors_request *req)
27 {
28         int n;
29         int m = 1;
30         int p = 1;
31
32         /* Normalize value to a 6 MHz multiple (24 MHz / 4) */
33         n = DIV_ROUND_UP(req->rate, 6000000);
34
35         /* If n is too large switch to steps of 12 MHz */
36         if (n > 255) {
37                 m = 0;
38                 n = (n + 1) / 2;
39         }
40
41         /* If n is still too large switch to steps of 24 MHz */
42         if (n > 255) {
43                 p = 0;
44                 n = (n + 1) / 2;
45         }
46
47         /* n must be between 12 and 255 */
48         if (n > 255)
49                 n = 255;
50         else if (n < 12)
51                 n = 12;
52
53         req->rate = ((24000000 * n) >> p) / (m + 1);
54         req->n = n;
55         req->m = m;
56         req->p = p;
57 }
58
59 static const struct clk_factors_config sun9i_a80_pll4_config = {
60         .mshift = 18,
61         .mwidth = 1,
62         .nshift = 8,
63         .nwidth = 8,
64         .pshift = 16,
65         .pwidth = 1,
66 };
67
68 static const struct factors_data sun9i_a80_pll4_data __initconst = {
69         .enable = 31,
70         .table = &sun9i_a80_pll4_config,
71         .getter = sun9i_a80_get_pll4_factors,
72 };
73
74 static DEFINE_SPINLOCK(sun9i_a80_pll4_lock);
75
76 static void __init sun9i_a80_pll4_setup(struct device_node *node)
77 {
78         void __iomem *reg;
79
80         reg = of_io_request_and_map(node, 0, of_node_full_name(node));
81         if (IS_ERR(reg)) {
82                 pr_err("Could not get registers for a80-pll4-clk: %pOFn\n",
83                        node);
84                 return;
85         }
86
87         sunxi_factors_register(node, &sun9i_a80_pll4_data,
88                                &sun9i_a80_pll4_lock, reg);
89 }
90 CLK_OF_DECLARE(sun9i_a80_pll4, "allwinner,sun9i-a80-pll4-clk", sun9i_a80_pll4_setup);
91
92
93 /*
94  * sun9i_a80_get_gt_factors() - calculates m factor for GT
95  * GT rate is calculated as follows
96  * rate = parent_rate / (m + 1);
97  */
98
99 static void sun9i_a80_get_gt_factors(struct factors_request *req)
100 {
101         u32 div;
102
103         if (req->parent_rate < req->rate)
104                 req->rate = req->parent_rate;
105
106         div = DIV_ROUND_UP(req->parent_rate, req->rate);
107
108         /* maximum divider is 4 */
109         if (div > 4)
110                 div = 4;
111
112         req->rate = req->parent_rate / div;
113         req->m = div;
114 }
115
116 static const struct clk_factors_config sun9i_a80_gt_config = {
117         .mshift = 0,
118         .mwidth = 2,
119 };
120
121 static const struct factors_data sun9i_a80_gt_data __initconst = {
122         .mux = 24,
123         .muxmask = BIT(1) | BIT(0),
124         .table = &sun9i_a80_gt_config,
125         .getter = sun9i_a80_get_gt_factors,
126 };
127
128 static DEFINE_SPINLOCK(sun9i_a80_gt_lock);
129
130 static void __init sun9i_a80_gt_setup(struct device_node *node)
131 {
132         void __iomem *reg;
133
134         reg = of_io_request_and_map(node, 0, of_node_full_name(node));
135         if (IS_ERR(reg)) {
136                 pr_err("Could not get registers for a80-gt-clk: %pOFn\n",
137                        node);
138                 return;
139         }
140
141         /* The GT bus clock needs to be always enabled */
142         sunxi_factors_register_critical(node, &sun9i_a80_gt_data,
143                                         &sun9i_a80_gt_lock, reg);
144 }
145 CLK_OF_DECLARE(sun9i_a80_gt, "allwinner,sun9i-a80-gt-clk", sun9i_a80_gt_setup);
146
147
148 /*
149  * sun9i_a80_get_ahb_factors() - calculates p factor for AHB0/1/2
150  * AHB rate is calculated as follows
151  * rate = parent_rate >> p;
152  */
153
154 static void sun9i_a80_get_ahb_factors(struct factors_request *req)
155 {
156         u32 _p;
157
158         if (req->parent_rate < req->rate)
159                 req->rate = req->parent_rate;
160
161         _p = order_base_2(DIV_ROUND_UP(req->parent_rate, req->rate));
162
163         /* maximum p is 3 */
164         if (_p > 3)
165                 _p = 3;
166
167         req->rate = req->parent_rate >> _p;
168         req->p = _p;
169 }
170
171 static const struct clk_factors_config sun9i_a80_ahb_config = {
172         .pshift = 0,
173         .pwidth = 2,
174 };
175
176 static const struct factors_data sun9i_a80_ahb_data __initconst = {
177         .mux = 24,
178         .muxmask = BIT(1) | BIT(0),
179         .table = &sun9i_a80_ahb_config,
180         .getter = sun9i_a80_get_ahb_factors,
181 };
182
183 static DEFINE_SPINLOCK(sun9i_a80_ahb_lock);
184
185 static void __init sun9i_a80_ahb_setup(struct device_node *node)
186 {
187         void __iomem *reg;
188
189         reg = of_io_request_and_map(node, 0, of_node_full_name(node));
190         if (IS_ERR(reg)) {
191                 pr_err("Could not get registers for a80-ahb-clk: %pOFn\n",
192                        node);
193                 return;
194         }
195
196         sunxi_factors_register(node, &sun9i_a80_ahb_data,
197                                &sun9i_a80_ahb_lock, reg);
198 }
199 CLK_OF_DECLARE(sun9i_a80_ahb, "allwinner,sun9i-a80-ahb-clk", sun9i_a80_ahb_setup);
200
201
202 static const struct factors_data sun9i_a80_apb0_data __initconst = {
203         .mux = 24,
204         .muxmask = BIT(0),
205         .table = &sun9i_a80_ahb_config,
206         .getter = sun9i_a80_get_ahb_factors,
207 };
208
209 static DEFINE_SPINLOCK(sun9i_a80_apb0_lock);
210
211 static void __init sun9i_a80_apb0_setup(struct device_node *node)
212 {
213         void __iomem *reg;
214
215         reg = of_io_request_and_map(node, 0, of_node_full_name(node));
216         if (IS_ERR(reg)) {
217                 pr_err("Could not get registers for a80-apb0-clk: %pOFn\n",
218                        node);
219                 return;
220         }
221
222         sunxi_factors_register(node, &sun9i_a80_apb0_data,
223                                &sun9i_a80_apb0_lock, reg);
224 }
225 CLK_OF_DECLARE(sun9i_a80_apb0, "allwinner,sun9i-a80-apb0-clk", sun9i_a80_apb0_setup);
226
227
228 /*
229  * sun9i_a80_get_apb1_factors() - calculates m, p factors for APB1
230  * APB1 rate is calculated as follows
231  * rate = (parent_rate >> p) / (m + 1);
232  */
233
234 static void sun9i_a80_get_apb1_factors(struct factors_request *req)
235 {
236         u32 div;
237
238         if (req->parent_rate < req->rate)
239                 req->rate = req->parent_rate;
240
241         div = DIV_ROUND_UP(req->parent_rate, req->rate);
242
243         /* Highest possible divider is 256 (p = 3, m = 31) */
244         if (div > 256)
245                 div = 256;
246
247         req->p = order_base_2(div);
248         req->m = (req->parent_rate >> req->p) - 1;
249         req->rate = (req->parent_rate >> req->p) / (req->m + 1);
250 }
251
252 static const struct clk_factors_config sun9i_a80_apb1_config = {
253         .mshift = 0,
254         .mwidth = 5,
255         .pshift = 16,
256         .pwidth = 2,
257 };
258
259 static const struct factors_data sun9i_a80_apb1_data __initconst = {
260         .mux = 24,
261         .muxmask = BIT(0),
262         .table = &sun9i_a80_apb1_config,
263         .getter = sun9i_a80_get_apb1_factors,
264 };
265
266 static DEFINE_SPINLOCK(sun9i_a80_apb1_lock);
267
268 static void __init sun9i_a80_apb1_setup(struct device_node *node)
269 {
270         void __iomem *reg;
271
272         reg = of_io_request_and_map(node, 0, of_node_full_name(node));
273         if (IS_ERR(reg)) {
274                 pr_err("Could not get registers for a80-apb1-clk: %pOFn\n",
275                        node);
276                 return;
277         }
278
279         sunxi_factors_register(node, &sun9i_a80_apb1_data,
280                                &sun9i_a80_apb1_lock, reg);
281 }
282 CLK_OF_DECLARE(sun9i_a80_apb1, "allwinner,sun9i-a80-apb1-clk", sun9i_a80_apb1_setup);