projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
drm/i915: Rename intel_context[engine].ringbuf
[deliverable/linux.git] / drivers / clk / st / clkgen-fsyn.c
CommitLineData
5f7aa907
GF		 1/*
2 * Copyright (C) 2014 STMicroelectronics R&D Ltd
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
7 *
8 */
9
10/*
11 * Authors:
12 * Stephen Gallimore <stephen.gallimore@st.com>,
13 * Pankaj Dev <pankaj.dev@st.com>.
14 */
15
16#include <linux/slab.h>
17#include <linux/of_address.h>
d5f728ac 18#include <linux/clk.h>
5f7aa907
GF		 19#include <linux/clk-provider.h>
20
21#include "clkgen.h"
22
23/*
24 * Maximum input clock to the PLL before we divide it down by 2
25 * although in reality in actual systems this has never been seen to
26 * be used.
27 */
28#define QUADFS_NDIV_THRESHOLD 30000000
29
30#define PLL_BW_GOODREF (0L)
31#define PLL_BW_VBADREF (1L)
32#define PLL_BW_BADREF (2L)
33#define PLL_BW_VGOODREF (3L)
34
35#define QUADFS_MAX_CHAN 4
36
37struct stm_fs {
38 unsigned long ndiv;
39 unsigned long mdiv;
40 unsigned long pe;
41 unsigned long sdiv;
42 unsigned long nsdiv;
43};
44
4abb1b40 45static const struct stm_fs fs216c65_rtbl[] = {
5f7aa907
GF		 46 { .mdiv = 0x1f, .pe = 0x0, .sdiv = 0x7, .nsdiv = 0 }, /* 312.5 Khz */
47 { .mdiv = 0x17, .pe = 0x25ed, .sdiv = 0x1, .nsdiv = 0 }, /* 27 MHz */
48 { .mdiv = 0x1a, .pe = 0x7b36, .sdiv = 0x2, .nsdiv = 1 }, /* 36.87 MHz */
49 { .mdiv = 0x13, .pe = 0x0, .sdiv = 0x2, .nsdiv = 1 }, /* 48 MHz */
50 { .mdiv = 0x11, .pe = 0x1c72, .sdiv = 0x1, .nsdiv = 1 }, /* 108 MHz */
51};
52
4abb1b40 53static const struct stm_fs fs432c65_rtbl[] = {
f1a788ff
GF		 54 { .mdiv = 0x1f, .pe = 0x0, .sdiv = 0x7, .nsdiv = 0 }, /* 625 Khz */
55 { .mdiv = 0x13, .pe = 0x777c, .sdiv = 0x4, .nsdiv = 1 }, /* 25.175 MHz */
56 { .mdiv = 0x19, .pe = 0x4d35, .sdiv = 0x2, .nsdiv = 0 }, /* 25.200 MHz */
57 { .mdiv = 0x11, .pe = 0x1c72, .sdiv = 0x4, .nsdiv = 1 }, /* 27.000 MHz */
58 { .mdiv = 0x17, .pe = 0x28f5, .sdiv = 0x2, .nsdiv = 0 }, /* 27.027 MHz */
59 { .mdiv = 0x16, .pe = 0x3359, .sdiv = 0x2, .nsdiv = 0 }, /* 28.320 MHz */
60 { .mdiv = 0x1f, .pe = 0x2083, .sdiv = 0x3, .nsdiv = 1 }, /* 30.240 MHz */
61 { .mdiv = 0x1e, .pe = 0x430d, .sdiv = 0x3, .nsdiv = 1 }, /* 31.500 MHz */
62 { .mdiv = 0x17, .pe = 0x0, .sdiv = 0x3, .nsdiv = 1 }, /* 40.000 MHz */
63 { .mdiv = 0x19, .pe = 0x121a, .sdiv = 0x1, .nsdiv = 0 }, /* 49.500 MHz */
64 { .mdiv = 0x13, .pe = 0x6667, .sdiv = 0x3, .nsdiv = 1 }, /* 50.000 MHz */
65 { .mdiv = 0x10, .pe = 0x1ee6, .sdiv = 0x3, .nsdiv = 1 }, /* 57.284 MHz */
66 { .mdiv = 0x1d, .pe = 0x3b14, .sdiv = 0x2, .nsdiv = 1 }, /* 65.000 MHz */
67 { .mdiv = 0x12, .pe = 0x7c65, .sdiv = 0x1, .nsdiv = 0 }, /* 71.000 MHz */
68 { .mdiv = 0x19, .pe = 0xecd, .sdiv = 0x2, .nsdiv = 1 }, /* 74.176 MHz */
69 { .mdiv = 0x19, .pe = 0x121a, .sdiv = 0x2, .nsdiv = 1 }, /* 74.250 MHz */
70 { .mdiv = 0x19, .pe = 0x3334, .sdiv = 0x2, .nsdiv = 1 }, /* 75.000 MHz */
71 { .mdiv = 0x18, .pe = 0x5138, .sdiv = 0x2, .nsdiv = 1 }, /* 78.800 MHz */
72 { .mdiv = 0x1d, .pe = 0x77d, .sdiv = 0x0, .nsdiv = 0 }, /* 85.500 MHz */
73 { .mdiv = 0x1c, .pe = 0x13d5, .sdiv = 0x0, .nsdiv = 0 }, /* 88.750 MHz */
74 { .mdiv = 0x11, .pe = 0x1c72, .sdiv = 0x2, .nsdiv = 1 }, /* 108.000 MHz */
75 { .mdiv = 0x17, .pe = 0x28f5, .sdiv = 0x0, .nsdiv = 0 }, /* 108.108 MHz */
76 { .mdiv = 0x10, .pe = 0x6e26, .sdiv = 0x2, .nsdiv = 1 }, /* 118.963 MHz */
77 { .mdiv = 0x15, .pe = 0x3e63, .sdiv = 0x0, .nsdiv = 0 }, /* 119.000 MHz */
78 { .mdiv = 0x1c, .pe = 0x471d, .sdiv = 0x1, .nsdiv = 1 }, /* 135.000 MHz */
79 { .mdiv = 0x19, .pe = 0xecd, .sdiv = 0x1, .nsdiv = 1 }, /* 148.352 MHz */
80 { .mdiv = 0x19, .pe = 0x121a, .sdiv = 0x1, .nsdiv = 1 }, /* 148.500 MHz */
81 { .mdiv = 0x19, .pe = 0x121a, .sdiv = 0x0, .nsdiv = 1 }, /* 297 MHz */
5f7aa907
GF		 82};
83
4abb1b40 84static const struct stm_fs fs660c32_rtbl[] = {
f1a788ff
GF		 85 { .mdiv = 0x14, .pe = 0x376b, .sdiv = 0x4, .nsdiv = 1 }, /* 25.175 MHz */
86 { .mdiv = 0x14, .pe = 0x30c3, .sdiv = 0x4, .nsdiv = 1 }, /* 25.200 MHz */
87 { .mdiv = 0x10, .pe = 0x71c7, .sdiv = 0x4, .nsdiv = 1 }, /* 27.000 MHz */
88 { .mdiv = 0x00, .pe = 0x47af, .sdiv = 0x3, .nsdiv = 0 }, /* 27.027 MHz */
89 { .mdiv = 0x0e, .pe = 0x4e1a, .sdiv = 0x4, .nsdiv = 1 }, /* 28.320 MHz */
90 { .mdiv = 0x0b, .pe = 0x534d, .sdiv = 0x4, .nsdiv = 1 }, /* 30.240 MHz */
91 { .mdiv = 0x17, .pe = 0x6fbf, .sdiv = 0x2, .nsdiv = 0 }, /* 31.500 MHz */
92 { .mdiv = 0x01, .pe = 0x0, .sdiv = 0x4, .nsdiv = 1 }, /* 40.000 MHz */
93 { .mdiv = 0x15, .pe = 0x2aab, .sdiv = 0x3, .nsdiv = 1 }, /* 49.500 MHz */
94 { .mdiv = 0x14, .pe = 0x6666, .sdiv = 0x3, .nsdiv = 1 }, /* 50.000 MHz */
95 { .mdiv = 0x1d, .pe = 0x395f, .sdiv = 0x1, .nsdiv = 0 }, /* 57.284 MHz */
96 { .mdiv = 0x08, .pe = 0x4ec5, .sdiv = 0x3, .nsdiv = 1 }, /* 65.000 MHz */
97 { .mdiv = 0x05, .pe = 0x1770, .sdiv = 0x3, .nsdiv = 1 }, /* 71.000 MHz */
98 { .mdiv = 0x03, .pe = 0x4ba7, .sdiv = 0x3, .nsdiv = 1 }, /* 74.176 MHz */
99 { .mdiv = 0x0f, .pe = 0x3426, .sdiv = 0x1, .nsdiv = 0 }, /* 74.250 MHz */
100 { .mdiv = 0x0e, .pe = 0x7777, .sdiv = 0x1, .nsdiv = 0 }, /* 75.000 MHz */
101 { .mdiv = 0x01, .pe = 0x4053, .sdiv = 0x3, .nsdiv = 1 }, /* 78.800 MHz */
102 { .mdiv = 0x09, .pe = 0x15b5, .sdiv = 0x1, .nsdiv = 0 }, /* 85.500 MHz */
103 { .mdiv = 0x1b, .pe = 0x3f19, .sdiv = 0x2, .nsdiv = 1 }, /* 88.750 MHz */
104 { .mdiv = 0x10, .pe = 0x71c7, .sdiv = 0x2, .nsdiv = 1 }, /* 108.000 MHz */
105 { .mdiv = 0x00, .pe = 0x47af, .sdiv = 0x1, .nsdiv = 0 }, /* 108.108 MHz */
106 { .mdiv = 0x0c, .pe = 0x3118, .sdiv = 0x2, .nsdiv = 1 }, /* 118.963 MHz */
107 { .mdiv = 0x0c, .pe = 0x2f54, .sdiv = 0x2, .nsdiv = 1 }, /* 119.000 MHz */
108 { .mdiv = 0x07, .pe = 0xe39, .sdiv = 0x2, .nsdiv = 1 }, /* 135.000 MHz */
109 { .mdiv = 0x03, .pe = 0x4ba7, .sdiv = 0x2, .nsdiv = 1 }, /* 148.352 MHz */
110 { .mdiv = 0x0f, .pe = 0x3426, .sdiv = 0x0, .nsdiv = 0 }, /* 148.500 MHz */
111 { .mdiv = 0x03, .pe = 0x4ba7, .sdiv = 0x1, .nsdiv = 1 }, /* 296.704 MHz */
112 { .mdiv = 0x03, .pe = 0x471c, .sdiv = 0x1, .nsdiv = 1 }, /* 297.000 MHz */
113 { .mdiv = 0x00, .pe = 0x295f, .sdiv = 0x1, .nsdiv = 1 }, /* 326.700 MHz */
114 { .mdiv = 0x1f, .pe = 0x3633, .sdiv = 0x0, .nsdiv = 1 }, /* 333.000 MHz */
115 { .mdiv = 0x1c, .pe = 0x0, .sdiv = 0x0, .nsdiv = 1 }, /* 352.000 Mhz */
5f7aa907
GF		 116};
117
118struct clkgen_quadfs_data {
119 bool reset_present;
120 bool bwfilter_present;
121 bool lockstatus_present;
8f26df84
GF		 122 bool powerup_polarity;
123 bool standby_polarity;
5f7aa907 124 bool nsdiv_present;
fc755c8b 125 bool nrst_present;
5f7aa907
GF		 126 struct clkgen_field ndiv;
127 struct clkgen_field ref_bw;
128 struct clkgen_field nreset;
129 struct clkgen_field npda;
130 struct clkgen_field lock_status;
131
fc755c8b 132 struct clkgen_field nrst[QUADFS_MAX_CHAN];
5f7aa907
GF		 133 struct clkgen_field nsb[QUADFS_MAX_CHAN];
134 struct clkgen_field en[QUADFS_MAX_CHAN];
135 struct clkgen_field mdiv[QUADFS_MAX_CHAN];
136 struct clkgen_field pe[QUADFS_MAX_CHAN];
137 struct clkgen_field sdiv[QUADFS_MAX_CHAN];
138 struct clkgen_field nsdiv[QUADFS_MAX_CHAN];
139
140 const struct clk_ops *pll_ops;
4abb1b40 141 const struct stm_fs *rtbl;
5f7aa907 142 u8 rtbl_cnt;
4abb1b40 143 int (*get_rate)(unsigned long , const struct stm_fs *,
5f7aa907
GF		 144 unsigned long *);
145};
146
147static const struct clk_ops st_quadfs_pll_c65_ops;
148static const struct clk_ops st_quadfs_pll_c32_ops;
149static const struct clk_ops st_quadfs_fs216c65_ops;
150static const struct clk_ops st_quadfs_fs432c65_ops;
151static const struct clk_ops st_quadfs_fs660c32_ops;
152
4abb1b40 153static int clk_fs216c65_get_rate(unsigned long, const struct stm_fs *,
5f7aa907 154 unsigned long *);
4abb1b40 155static int clk_fs432c65_get_rate(unsigned long, const struct stm_fs *,
5f7aa907 156 unsigned long *);
4abb1b40 157static int clk_fs660c32_dig_get_rate(unsigned long, const struct stm_fs *,
5f7aa907
GF		 158 unsigned long *);
159/*
160 * Values for all of the standalone instances of this clock
161 * generator found in STiH415 and STiH416 SYSCFG register banks. Note
162 * that the individual channel standby control bits (nsb) are in the
163 * first register along with the PLL control bits.
164 */
4abb1b40 165static const struct clkgen_quadfs_data st_fs216c65_416 = {
5f7aa907
GF		 166 /* 416 specific */
167 .npda = CLKGEN_FIELD(0x0, 0x1, 14),
168 .nsb = { CLKGEN_FIELD(0x0, 0x1, 10),
169 CLKGEN_FIELD(0x0, 0x1, 11),
170 CLKGEN_FIELD(0x0, 0x1, 12),
171 CLKGEN_FIELD(0x0, 0x1, 13) },
172 .nsdiv_present = true,
173 .nsdiv = { CLKGEN_FIELD(0x0, 0x1, 18),
174 CLKGEN_FIELD(0x0, 0x1, 19),
175 CLKGEN_FIELD(0x0, 0x1, 20),
176 CLKGEN_FIELD(0x0, 0x1, 21) },
177 .mdiv = { CLKGEN_FIELD(0x4, 0x1f, 0),
178 CLKGEN_FIELD(0x14, 0x1f, 0),
179 CLKGEN_FIELD(0x24, 0x1f, 0),
180 CLKGEN_FIELD(0x34, 0x1f, 0) },
181 .en = { CLKGEN_FIELD(0x10, 0x1, 0),
182 CLKGEN_FIELD(0x20, 0x1, 0),
183 CLKGEN_FIELD(0x30, 0x1, 0),
184 CLKGEN_FIELD(0x40, 0x1, 0) },
185 .ndiv = CLKGEN_FIELD(0x0, 0x1, 15),
186 .bwfilter_present = true,
187 .ref_bw = CLKGEN_FIELD(0x0, 0x3, 16),
188 .pe = { CLKGEN_FIELD(0x8, 0xffff, 0),
189 CLKGEN_FIELD(0x18, 0xffff, 0),
190 CLKGEN_FIELD(0x28, 0xffff, 0),
191 CLKGEN_FIELD(0x38, 0xffff, 0) },
192 .sdiv = { CLKGEN_FIELD(0xC, 0x7, 0),
193 CLKGEN_FIELD(0x1C, 0x7, 0),
194 CLKGEN_FIELD(0x2C, 0x7, 0),
195 CLKGEN_FIELD(0x3C, 0x7, 0) },
196 .pll_ops = &st_quadfs_pll_c65_ops,
197 .rtbl = fs216c65_rtbl,
198 .rtbl_cnt = ARRAY_SIZE(fs216c65_rtbl),
199 .get_rate = clk_fs216c65_get_rate,
200};
201
4abb1b40 202static const struct clkgen_quadfs_data st_fs432c65_416 = {
5f7aa907
GF		 203 .npda = CLKGEN_FIELD(0x0, 0x1, 14),
204 .nsb = { CLKGEN_FIELD(0x0, 0x1, 10),
205 CLKGEN_FIELD(0x0, 0x1, 11),
206 CLKGEN_FIELD(0x0, 0x1, 12),
207 CLKGEN_FIELD(0x0, 0x1, 13) },
208 .nsdiv_present = true,
209 .nsdiv = { CLKGEN_FIELD(0x0, 0x1, 18),
210 CLKGEN_FIELD(0x0, 0x1, 19),
211 CLKGEN_FIELD(0x0, 0x1, 20),
212 CLKGEN_FIELD(0x0, 0x1, 21) },
213 .mdiv = { CLKGEN_FIELD(0x4, 0x1f, 0),
214 CLKGEN_FIELD(0x14, 0x1f, 0),
215 CLKGEN_FIELD(0x24, 0x1f, 0),
216 CLKGEN_FIELD(0x34, 0x1f, 0) },
217 .en = { CLKGEN_FIELD(0x10, 0x1, 0),
218 CLKGEN_FIELD(0x20, 0x1, 0),
219 CLKGEN_FIELD(0x30, 0x1, 0),
220 CLKGEN_FIELD(0x40, 0x1, 0) },
221 .ndiv = CLKGEN_FIELD(0x0, 0x1, 15),
222 .bwfilter_present = true,
223 .ref_bw = CLKGEN_FIELD(0x0, 0x3, 16),
224 .pe = { CLKGEN_FIELD(0x8, 0xffff, 0),
225 CLKGEN_FIELD(0x18, 0xffff, 0),
226 CLKGEN_FIELD(0x28, 0xffff, 0),
227 CLKGEN_FIELD(0x38, 0xffff, 0) },
228 .sdiv = { CLKGEN_FIELD(0xC, 0x7, 0),
229 CLKGEN_FIELD(0x1C, 0x7, 0),
230 CLKGEN_FIELD(0x2C, 0x7, 0),
231 CLKGEN_FIELD(0x3C, 0x7, 0) },
232 .pll_ops = &st_quadfs_pll_c65_ops,
233 .rtbl = fs432c65_rtbl,
234 .rtbl_cnt = ARRAY_SIZE(fs432c65_rtbl),
235 .get_rate = clk_fs432c65_get_rate,
236};
237
4abb1b40 238static const struct clkgen_quadfs_data st_fs660c32_E_416 = {
5f7aa907
GF		 239 .npda = CLKGEN_FIELD(0x0, 0x1, 14),
240 .nsb = { CLKGEN_FIELD(0x0, 0x1, 10),
241 CLKGEN_FIELD(0x0, 0x1, 11),
242 CLKGEN_FIELD(0x0, 0x1, 12),
243 CLKGEN_FIELD(0x0, 0x1, 13) },
244 .nsdiv_present = true,
245 .nsdiv = { CLKGEN_FIELD(0x0, 0x1, 18),
246 CLKGEN_FIELD(0x0, 0x1, 19),
247 CLKGEN_FIELD(0x0, 0x1, 20),
248 CLKGEN_FIELD(0x0, 0x1, 21) },
249 .mdiv = { CLKGEN_FIELD(0x4, 0x1f, 0),
250 CLKGEN_FIELD(0x14, 0x1f, 0),
251 CLKGEN_FIELD(0x24, 0x1f, 0),
252 CLKGEN_FIELD(0x34, 0x1f, 0) },
253 .en = { CLKGEN_FIELD(0x10, 0x1, 0),
254 CLKGEN_FIELD(0x20, 0x1, 0),
255 CLKGEN_FIELD(0x30, 0x1, 0),
256 CLKGEN_FIELD(0x40, 0x1, 0) },
257 .ndiv = CLKGEN_FIELD(0x0, 0x7, 15),
258 .pe = { CLKGEN_FIELD(0x8, 0x7fff, 0),
259 CLKGEN_FIELD(0x18, 0x7fff, 0),
260 CLKGEN_FIELD(0x28, 0x7fff, 0),
261 CLKGEN_FIELD(0x38, 0x7fff, 0) },
262 .sdiv = { CLKGEN_FIELD(0xC, 0xf, 0),
263 CLKGEN_FIELD(0x1C, 0xf, 0),
264 CLKGEN_FIELD(0x2C, 0xf, 0),
265 CLKGEN_FIELD(0x3C, 0xf, 0) },
266 .lockstatus_present = true,
267 .lock_status = CLKGEN_FIELD(0xAC, 0x1, 0),
268 .pll_ops = &st_quadfs_pll_c32_ops,
269 .rtbl = fs660c32_rtbl,
270 .rtbl_cnt = ARRAY_SIZE(fs660c32_rtbl),
271 .get_rate = clk_fs660c32_dig_get_rate,
272};
273
4abb1b40 274static const struct clkgen_quadfs_data st_fs660c32_F_416 = {
5f7aa907
GF		 275 .npda = CLKGEN_FIELD(0x0, 0x1, 14),
276 .nsb = { CLKGEN_FIELD(0x0, 0x1, 10),
277 CLKGEN_FIELD(0x0, 0x1, 11),
278 CLKGEN_FIELD(0x0, 0x1, 12),
279 CLKGEN_FIELD(0x0, 0x1, 13) },
280 .nsdiv_present = true,
281 .nsdiv = { CLKGEN_FIELD(0x0, 0x1, 18),
282 CLKGEN_FIELD(0x0, 0x1, 19),
283 CLKGEN_FIELD(0x0, 0x1, 20),
284 CLKGEN_FIELD(0x0, 0x1, 21) },
285 .mdiv = { CLKGEN_FIELD(0x4, 0x1f, 0),
286 CLKGEN_FIELD(0x14, 0x1f, 0),
287 CLKGEN_FIELD(0x24, 0x1f, 0),
288 CLKGEN_FIELD(0x34, 0x1f, 0) },
289 .en = { CLKGEN_FIELD(0x10, 0x1, 0),
290 CLKGEN_FIELD(0x20, 0x1, 0),
291 CLKGEN_FIELD(0x30, 0x1, 0),
292 CLKGEN_FIELD(0x40, 0x1, 0) },
293 .ndiv = CLKGEN_FIELD(0x0, 0x7, 15),
294 .pe = { CLKGEN_FIELD(0x8, 0x7fff, 0),
295 CLKGEN_FIELD(0x18, 0x7fff, 0),
296 CLKGEN_FIELD(0x28, 0x7fff, 0),
297 CLKGEN_FIELD(0x38, 0x7fff, 0) },
298 .sdiv = { CLKGEN_FIELD(0xC, 0xf, 0),
299 CLKGEN_FIELD(0x1C, 0xf, 0),
300 CLKGEN_FIELD(0x2C, 0xf, 0),
301 CLKGEN_FIELD(0x3C, 0xf, 0) },
302 .lockstatus_present = true,
303 .lock_status = CLKGEN_FIELD(0xEC, 0x1, 0),
304 .pll_ops = &st_quadfs_pll_c32_ops,
305 .rtbl = fs660c32_rtbl,
306 .rtbl_cnt = ARRAY_SIZE(fs660c32_rtbl),
307 .get_rate = clk_fs660c32_dig_get_rate,
308};
309
d34e210e 310static const struct clkgen_quadfs_data st_fs660c32_C = {
51306d56
GF		 311 .nrst_present = true,
312 .nrst = { CLKGEN_FIELD(0x2f0, 0x1, 0),
313 CLKGEN_FIELD(0x2f0, 0x1, 1),
314 CLKGEN_FIELD(0x2f0, 0x1, 2),
315 CLKGEN_FIELD(0x2f0, 0x1, 3) },
316 .npda = CLKGEN_FIELD(0x2f0, 0x1, 12),
317 .nsb = { CLKGEN_FIELD(0x2f0, 0x1, 8),
318 CLKGEN_FIELD(0x2f0, 0x1, 9),
319 CLKGEN_FIELD(0x2f0, 0x1, 10),
320 CLKGEN_FIELD(0x2f0, 0x1, 11) },
321 .nsdiv_present = true,
322 .nsdiv = { CLKGEN_FIELD(0x304, 0x1, 24),
323 CLKGEN_FIELD(0x308, 0x1, 24),
324 CLKGEN_FIELD(0x30c, 0x1, 24),
325 CLKGEN_FIELD(0x310, 0x1, 24) },
326 .mdiv = { CLKGEN_FIELD(0x304, 0x1f, 15),
327 CLKGEN_FIELD(0x308, 0x1f, 15),
328 CLKGEN_FIELD(0x30c, 0x1f, 15),
329 CLKGEN_FIELD(0x310, 0x1f, 15) },
330 .en = { CLKGEN_FIELD(0x2fc, 0x1, 0),
331 CLKGEN_FIELD(0x2fc, 0x1, 1),
332 CLKGEN_FIELD(0x2fc, 0x1, 2),
333 CLKGEN_FIELD(0x2fc, 0x1, 3) },
334 .ndiv = CLKGEN_FIELD(0x2f4, 0x7, 16),
335 .pe = { CLKGEN_FIELD(0x304, 0x7fff, 0),
336 CLKGEN_FIELD(0x308, 0x7fff, 0),
337 CLKGEN_FIELD(0x30c, 0x7fff, 0),
338 CLKGEN_FIELD(0x310, 0x7fff, 0) },
339 .sdiv = { CLKGEN_FIELD(0x304, 0xf, 20),
340 CLKGEN_FIELD(0x308, 0xf, 20),
341 CLKGEN_FIELD(0x30c, 0xf, 20),
342 CLKGEN_FIELD(0x310, 0xf, 20) },
343 .lockstatus_present = true,
56551da9 344 .lock_status = CLKGEN_FIELD(0x2f0, 0x1, 24),
51306d56
GF		 345 .powerup_polarity = 1,
346 .standby_polarity = 1,
347 .pll_ops = &st_quadfs_pll_c32_ops,
348 .rtbl = fs660c32_rtbl,
349 .rtbl_cnt = ARRAY_SIZE(fs660c32_rtbl),
350 .get_rate = clk_fs660c32_dig_get_rate,
351};
352
d34e210e 353static const struct clkgen_quadfs_data st_fs660c32_D = {
58de9b8e
GF		 354 .nrst_present = true,
355 .nrst = { CLKGEN_FIELD(0x2a0, 0x1, 0),
356 CLKGEN_FIELD(0x2a0, 0x1, 1),
357 CLKGEN_FIELD(0x2a0, 0x1, 2),
358 CLKGEN_FIELD(0x2a0, 0x1, 3) },
359 .ndiv = CLKGEN_FIELD(0x2a4, 0x7, 16),
360 .pe = { CLKGEN_FIELD(0x2b4, 0x7fff, 0),
361 CLKGEN_FIELD(0x2b8, 0x7fff, 0),
362 CLKGEN_FIELD(0x2bc, 0x7fff, 0),
363 CLKGEN_FIELD(0x2c0, 0x7fff, 0) },
364 .sdiv = { CLKGEN_FIELD(0x2b4, 0xf, 20),
365 CLKGEN_FIELD(0x2b8, 0xf, 20),
366 CLKGEN_FIELD(0x2bc, 0xf, 20),
367 CLKGEN_FIELD(0x2c0, 0xf, 20) },
368 .npda = CLKGEN_FIELD(0x2a0, 0x1, 12),
369 .nsb = { CLKGEN_FIELD(0x2a0, 0x1, 8),
370 CLKGEN_FIELD(0x2a0, 0x1, 9),
371 CLKGEN_FIELD(0x2a0, 0x1, 10),
372 CLKGEN_FIELD(0x2a0, 0x1, 11) },
373 .nsdiv_present = true,
374 .nsdiv = { CLKGEN_FIELD(0x2b4, 0x1, 24),
375 CLKGEN_FIELD(0x2b8, 0x1, 24),
376 CLKGEN_FIELD(0x2bc, 0x1, 24),
377 CLKGEN_FIELD(0x2c0, 0x1, 24) },
378 .mdiv = { CLKGEN_FIELD(0x2b4, 0x1f, 15),
379 CLKGEN_FIELD(0x2b8, 0x1f, 15),
380 CLKGEN_FIELD(0x2bc, 0x1f, 15),
381 CLKGEN_FIELD(0x2c0, 0x1f, 15) },
382 .en = { CLKGEN_FIELD(0x2ac, 0x1, 0),
383 CLKGEN_FIELD(0x2ac, 0x1, 1),
384 CLKGEN_FIELD(0x2ac, 0x1, 2),
385 CLKGEN_FIELD(0x2ac, 0x1, 3) },
386 .lockstatus_present = true,
387 .lock_status = CLKGEN_FIELD(0x2A0, 0x1, 24),
388 .powerup_polarity = 1,
389 .standby_polarity = 1,
390 .pll_ops = &st_quadfs_pll_c32_ops,
391 .rtbl = fs660c32_rtbl,
392 .rtbl_cnt = ARRAY_SIZE(fs660c32_rtbl),
393 .get_rate = clk_fs660c32_dig_get_rate,};
394
5f7aa907
GF		 395/**
396 * DOC: A Frequency Synthesizer that multiples its input clock by a fixed factor
397 *
398 * Traits of this clock:
399 * prepare - clk_(un)prepare only ensures parent is (un)prepared
400 * enable - clk_enable and clk_disable are functional & control the Fsyn
401 * rate - inherits rate from parent. set_rate/round_rate/recalc_rate
402 * parent - fixed parent. No clk_set_parent support
403 */
404
405/**
406 * struct st_clk_quadfs_pll - A pll which outputs a fixed multiplier of
407 * its parent clock, found inside a type of
408 * ST quad channel frequency synthesizer block
409 *
410 * @hw: handle between common and hardware-specific interfaces.
411 * @ndiv: regmap field for the ndiv control.
412 * @regs_base: base address of the configuration registers.
413 * @lock: spinlock.
414 *
415 */
416struct st_clk_quadfs_pll {
417 struct clk_hw hw;
418 void __iomem *regs_base;
419 spinlock_t *lock;
420 struct clkgen_quadfs_data *data;
421 u32 ndiv;
422};
423
424#define to_quadfs_pll(_hw) container_of(_hw, struct st_clk_quadfs_pll, hw)
425
426static int quadfs_pll_enable(struct clk_hw *hw)
427{
428 struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
429 unsigned long flags = 0, timeout = jiffies + msecs_to_jiffies(10);
430
431 if (pll->lock)
432 spin_lock_irqsave(pll->lock, flags);
433
434 /*
435 * Bring block out of reset if we have reset control.
436 */
437 if (pll->data->reset_present)
438 CLKGEN_WRITE(pll, nreset, 1);
439
440 /*
441 * Use a fixed input clock noise bandwidth filter for the moment
442 */
443 if (pll->data->bwfilter_present)
444 CLKGEN_WRITE(pll, ref_bw, PLL_BW_GOODREF);
445
446
447 CLKGEN_WRITE(pll, ndiv, pll->ndiv);
448
449 /*
450 * Power up the PLL
451 */
8f26df84 452 CLKGEN_WRITE(pll, npda, !pll->data->powerup_polarity);
5f7aa907
GF		 453
454 if (pll->lock)
455 spin_unlock_irqrestore(pll->lock, flags);
456
457 if (pll->data->lockstatus_present)
458 while (!CLKGEN_READ(pll, lock_status)) {
459 if (time_after(jiffies, timeout))
460 return -ETIMEDOUT;
461 cpu_relax();
462 }
463
464 return 0;
465}
466
467static void quadfs_pll_disable(struct clk_hw *hw)
468{
469 struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
470 unsigned long flags = 0;
471
472 if (pll->lock)
473 spin_lock_irqsave(pll->lock, flags);
474
475 /*
476 * Powerdown the PLL and then put block into soft reset if we have
477 * reset control.
478 */
8f26df84 479 CLKGEN_WRITE(pll, npda, pll->data->powerup_polarity);
5f7aa907
GF		 480
481 if (pll->data->reset_present)
482 CLKGEN_WRITE(pll, nreset, 0);
483
484 if (pll->lock)
485 spin_unlock_irqrestore(pll->lock, flags);
486}
487
488static int quadfs_pll_is_enabled(struct clk_hw *hw)
489{
490 struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
491 u32 npda = CLKGEN_READ(pll, npda);
492
c4d339c6 493 return pll->data->powerup_polarity ? !npda : !!npda;
5f7aa907
GF		 494}
495
8e6dd77c 496static int clk_fs660c32_vco_get_rate(unsigned long input, struct stm_fs *fs,
5f7aa907
GF		 497 unsigned long *rate)
498{
499 unsigned long nd = fs->ndiv + 16; /* ndiv value */
500
501 *rate = input * nd;
502
503 return 0;
504}
505
506static unsigned long quadfs_pll_fs660c32_recalc_rate(struct clk_hw *hw,
507 unsigned long parent_rate)
508{
509 struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
510 unsigned long rate = 0;
511 struct stm_fs params;
512
513 params.ndiv = CLKGEN_READ(pll, ndiv);
514 if (clk_fs660c32_vco_get_rate(parent_rate, &params, &rate))
515 pr_err("%s:%s error calculating rate\n",
836ee0f7 516 clk_hw_get_name(hw), __func__);
5f7aa907
GF		 517
518 pll->ndiv = params.ndiv;
519
520 return rate;
521}
522
8e6dd77c 523static int clk_fs660c32_vco_get_params(unsigned long input,
5f7aa907
GF		 524 unsigned long output, struct stm_fs *fs)
525{
526/* Formula
527 VCO frequency = (fin x ndiv) / pdiv
528 ndiv = VCOfreq * pdiv / fin
529 */
530 unsigned long pdiv = 1, n;
531
532 /* Output clock range: 384Mhz to 660Mhz */
533 if (output < 384000000 || output > 660000000)
534 return -EINVAL;
535
536 if (input > 40000000)
537 /* This means that PDIV would be 2 instead of 1.
538 Not supported today. */
539 return -EINVAL;
540
541 input /= 1000;
542 output /= 1000;
543
544 n = output * pdiv / input;
545 if (n < 16)
546 n = 16;
547 fs->ndiv = n - 16; /* Converting formula value to reg value */
548
549 return 0;
550}
551
2dd52d7f
AB		 552static long quadfs_pll_fs660c32_round_rate(struct clk_hw *hw,
553 unsigned long rate,
554 unsigned long *prate)
5f7aa907
GF		 555{
556 struct stm_fs params;
557
2dd52d7f
AB		 558 if (clk_fs660c32_vco_get_params(*prate, rate, &params))
559 return rate;
5f7aa907 560
2dd52d7f
AB		 561 clk_fs660c32_vco_get_rate(*prate, &params, &rate);
562
563 pr_debug("%s: %s new rate %ld [ndiv=%u]\n",
836ee0f7 564 __func__, clk_hw_get_name(hw),
2dd52d7f 565 rate, (unsigned int)params.ndiv);
5f7aa907
GF		 566
567 return rate;
568}
569
570static int quadfs_pll_fs660c32_set_rate(struct clk_hw *hw, unsigned long rate,
571 unsigned long parent_rate)
572{
573 struct st_clk_quadfs_pll *pll = to_quadfs_pll(hw);
574 struct stm_fs params;
575 long hwrate = 0;
576 unsigned long flags = 0;
9849fadf 577 int ret;
5f7aa907
GF		 578
579 if (!rate || !parent_rate)
580 return -EINVAL;
581
9849fadf
AB		 582 ret = clk_fs660c32_vco_get_params(parent_rate, rate, &params);
583 if (ret)
584 return ret;
585
586 clk_fs660c32_vco_get_rate(parent_rate, &params, &hwrate);
5f7aa907
GF		 587
588 pr_debug("%s: %s new rate %ld [ndiv=0x%x]\n",
836ee0f7 589 __func__, clk_hw_get_name(hw),
5f7aa907
GF		 590 hwrate, (unsigned int)params.ndiv);
591
592 if (!hwrate)
593 return -EINVAL;
594
595 pll->ndiv = params.ndiv;
596
597 if (pll->lock)
598 spin_lock_irqsave(pll->lock, flags);
599
600 CLKGEN_WRITE(pll, ndiv, pll->ndiv);
601
602 if (pll->lock)
603 spin_unlock_irqrestore(pll->lock, flags);
604
605 return 0;
606}
607
608static const struct clk_ops st_quadfs_pll_c65_ops = {
609 .enable = quadfs_pll_enable,
610 .disable = quadfs_pll_disable,
611 .is_enabled = quadfs_pll_is_enabled,
612};
613
614static const struct clk_ops st_quadfs_pll_c32_ops = {
615 .enable = quadfs_pll_enable,
616 .disable = quadfs_pll_disable,
617 .is_enabled = quadfs_pll_is_enabled,
618 .recalc_rate = quadfs_pll_fs660c32_recalc_rate,
619 .round_rate = quadfs_pll_fs660c32_round_rate,
620 .set_rate = quadfs_pll_fs660c32_set_rate,
621};
622
623static struct clk * __init st_clk_register_quadfs_pll(
624 const char *name, const char *parent_name,
625 struct clkgen_quadfs_data *quadfs, void __iomem *reg,
626 spinlock_t *lock)
627{
628 struct st_clk_quadfs_pll *pll;
629 struct clk *clk;
630 struct clk_init_data init;
631
632 /*
633 * Sanity check required pointers.
634 */
635 if (WARN_ON(!name || !parent_name))
636 return ERR_PTR(-EINVAL);
637
638 pll = kzalloc(sizeof(*pll), GFP_KERNEL);
639 if (!pll)
640 return ERR_PTR(-ENOMEM);
641
642 init.name = name;
643 init.ops = quadfs->pll_ops;
18fee453 644 init.flags = CLK_IS_BASIC | CLK_GET_RATE_NOCACHE;
5f7aa907
GF		 645 init.parent_names = &parent_name;
646 init.num_parents = 1;
647
648 pll->data = quadfs;
649 pll->regs_base = reg;
650 pll->lock = lock;
651 pll->hw.init = &init;
652
653 clk = clk_register(NULL, &pll->hw);
654
655 if (IS_ERR(clk))
656 kfree(pll);
657
658 return clk;
659}
660
661/**
662 * DOC: A digital frequency synthesizer
663 *
664 * Traits of this clock:
665 * prepare - clk_(un)prepare only ensures parent is (un)prepared
666 * enable - clk_enable and clk_disable are functional
667 * rate - set rate is functional
668 * parent - fixed parent. No clk_set_parent support
669 */
670
671/**
672 * struct st_clk_quadfs_fsynth - One clock output from a four channel digital
673 * frequency synthesizer (fsynth) block.
674 *
675 * @hw: handle between common and hardware-specific interfaces
676 *
677 * @nsb: regmap field in the output control register for the digital
678 * standby of this fsynth channel. This control is active low so
679 * the channel is in standby when the control bit is cleared.
680 *
681 * @nsdiv: regmap field in the output control register for
682 * for the optional divide by 3 of this fsynth channel. This control
683 * is active low so the divide by 3 is active when the control bit is
684 * cleared and the divide is bypassed when the bit is set.
685 */
686struct st_clk_quadfs_fsynth {
687 struct clk_hw hw;
688 void __iomem *regs_base;
689 spinlock_t *lock;
690 struct clkgen_quadfs_data *data;
691
692 u32 chan;
693 /*
694 * Cached hardware values from set_rate so we can program the
695 * hardware in enable. There are two reasons for this:
696 *
697 * 1. The registers may not be writable until the parent has been
698 * enabled.
699 *
700 * 2. It restores the clock rate when a driver does an enable
701 * on PM restore, after a suspend to RAM has lost the hardware
702 * setup.
703 */
704 u32 md;
705 u32 pe;
706 u32 sdiv;
707 u32 nsdiv;
708};
709
710#define to_quadfs_fsynth(_hw) \
711 container_of(_hw, struct st_clk_quadfs_fsynth, hw)
712
713static void quadfs_fsynth_program_enable(struct st_clk_quadfs_fsynth *fs)
714{
715 /*
716 * Pulse the program enable register lsb to make the hardware take
717 * notice of the new md/pe values with a glitchless transition.
718 */
719 CLKGEN_WRITE(fs, en[fs->chan], 1);
720 CLKGEN_WRITE(fs, en[fs->chan], 0);
721}
722
723static void quadfs_fsynth_program_rate(struct st_clk_quadfs_fsynth *fs)
724{
725 unsigned long flags = 0;
726
727 /*
728 * Ensure the md/pe parameters are ignored while we are
729 * reprogramming them so we can get a glitchless change
730 * when fine tuning the speed of a running clock.
731 */
732 CLKGEN_WRITE(fs, en[fs->chan], 0);
733
734 CLKGEN_WRITE(fs, mdiv[fs->chan], fs->md);
735 CLKGEN_WRITE(fs, pe[fs->chan], fs->pe);
736 CLKGEN_WRITE(fs, sdiv[fs->chan], fs->sdiv);
737
738 if (fs->lock)
739 spin_lock_irqsave(fs->lock, flags);
740
741 if (fs->data->nsdiv_present)
742 CLKGEN_WRITE(fs, nsdiv[fs->chan], fs->nsdiv);
743
744 if (fs->lock)
745 spin_unlock_irqrestore(fs->lock, flags);
746}
747
748static int quadfs_fsynth_enable(struct clk_hw *hw)
749{
750 struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
751 unsigned long flags = 0;
752
836ee0f7 753 pr_debug("%s: %s\n", __func__, clk_hw_get_name(hw));
5f7aa907
GF		 754
755 quadfs_fsynth_program_rate(fs);
756
757 if (fs->lock)
758 spin_lock_irqsave(fs->lock, flags);
759
8f26df84 760 CLKGEN_WRITE(fs, nsb[fs->chan], !fs->data->standby_polarity);
5f7aa907 761
fc755c8b
GF		 762 if (fs->data->nrst_present)
763 CLKGEN_WRITE(fs, nrst[fs->chan], 0);
764
5f7aa907
GF		 765 if (fs->lock)
766 spin_unlock_irqrestore(fs->lock, flags);
767
768 quadfs_fsynth_program_enable(fs);
769
770 return 0;
771}
772
773static void quadfs_fsynth_disable(struct clk_hw *hw)
774{
775 struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
776 unsigned long flags = 0;
777
836ee0f7 778 pr_debug("%s: %s\n", __func__, clk_hw_get_name(hw));
5f7aa907
GF		 779
780 if (fs->lock)
781 spin_lock_irqsave(fs->lock, flags);
782
c4d339c6 783 CLKGEN_WRITE(fs, nsb[fs->chan], fs->data->standby_polarity);
5f7aa907
GF		 784
785 if (fs->lock)
786 spin_unlock_irqrestore(fs->lock, flags);
787}
788
789static int quadfs_fsynth_is_enabled(struct clk_hw *hw)
790{
791 struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
792 u32 nsb = CLKGEN_READ(fs, nsb[fs->chan]);
793
794 pr_debug("%s: %s enable bit = 0x%x\n",
836ee0f7 795 __func__, clk_hw_get_name(hw), nsb);
5f7aa907 796
8f26df84 797 return fs->data->standby_polarity ? !nsb : !!nsb;
5f7aa907
GF		 798}
799
800#define P15 (uint64_t)(1 << 15)
801
4abb1b40 802static int clk_fs216c65_get_rate(unsigned long input, const struct stm_fs *fs,
5f7aa907
GF		 803 unsigned long *rate)
804{
805 uint64_t res;
806 unsigned long ns;
807 unsigned long nd = 8; /* ndiv stuck at 0 => val = 8 */
808 unsigned long s;
809 long m;
810
811 m = fs->mdiv - 32;
812 s = 1 << (fs->sdiv + 1);
813 ns = (fs->nsdiv ? 1 : 3);
814
815 res = (uint64_t)(s * ns * P15 * (uint64_t)(m + 33));
816 res = res - (s * ns * fs->pe);
817 *rate = div64_u64(P15 * nd * input * 32, res);
818
819 return 0;
820}
821
4abb1b40 822static int clk_fs432c65_get_rate(unsigned long input, const struct stm_fs *fs,
5f7aa907
GF		 823 unsigned long *rate)
824{
825 uint64_t res;
826 unsigned long nd = 16; /* ndiv value; stuck at 0 (30Mhz input) */
827 long m;
828 unsigned long sd;
829 unsigned long ns;
830
831 m = fs->mdiv - 32;
832 sd = 1 << (fs->sdiv + 1);
833 ns = (fs->nsdiv ? 1 : 3);
834
835 res = (uint64_t)(sd * ns * P15 * (uint64_t)(m + 33));
836 res = res - (sd * ns * fs->pe);
837 *rate = div64_u64(P15 * nd * input * 32, res);
838
839 return 0;
840}
841
842#define P20 (uint64_t)(1 << 20)
843
844static int clk_fs660c32_dig_get_rate(unsigned long input,
4abb1b40 845 const struct stm_fs *fs, unsigned long *rate)
5f7aa907
GF		 846{
847 unsigned long s = (1 << fs->sdiv);
848 unsigned long ns;
849 uint64_t res;
850
851 /*
852 * 'nsdiv' is a register value ('BIN') which is translated
853 * to a decimal value according to following rules.
854 *
855 * nsdiv ns.dec
856 * 0 3
857 * 1 1
858 */
859 ns = (fs->nsdiv == 1) ? 1 : 3;
860
861 res = (P20 * (32 + fs->mdiv) + 32 * fs->pe) * s * ns;
862 *rate = (unsigned long)div64_u64(input * P20 * 32, res);
863
864 return 0;
865}
866
867static int quadfs_fsynt_get_hw_value_for_recalc(struct st_clk_quadfs_fsynth *fs,
868 struct stm_fs *params)
869{
870 /*
871 * Get the initial hardware values for recalc_rate
872 */
873 params->mdiv = CLKGEN_READ(fs, mdiv[fs->chan]);
874 params->pe = CLKGEN_READ(fs, pe[fs->chan]);
875 params->sdiv = CLKGEN_READ(fs, sdiv[fs->chan]);
876
877 if (fs->data->nsdiv_present)
878 params->nsdiv = CLKGEN_READ(fs, nsdiv[fs->chan]);
879 else
880 params->nsdiv = 1;
881
882 /*
883 * If All are NULL then assume no clock rate is programmed.
884 */
885 if (!params->mdiv && !params->pe && !params->sdiv)
886 return 1;
887
888 fs->md = params->mdiv;
889 fs->pe = params->pe;
890 fs->sdiv = params->sdiv;
891 fs->nsdiv = params->nsdiv;
892
893 return 0;
894}
895
896static long quadfs_find_best_rate(struct clk_hw *hw, unsigned long drate,
897 unsigned long prate, struct stm_fs *params)
898{
899 struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
900 int (*clk_fs_get_rate)(unsigned long ,
4abb1b40 901 const struct stm_fs *, unsigned long *);
5f7aa907
GF		 902 struct stm_fs prev_params;
903 unsigned long prev_rate, rate = 0;
904 unsigned long diff_rate, prev_diff_rate = ~0;
905 int index;
906
907 clk_fs_get_rate = fs->data->get_rate;
908
909 for (index = 0; index < fs->data->rtbl_cnt; index++) {
910 prev_rate = rate;
911
912 *params = fs->data->rtbl[index];
913 prev_params = *params;
914
915 clk_fs_get_rate(prate, &fs->data->rtbl[index], &rate);
916
917 diff_rate = abs(drate - rate);
918
919 if (diff_rate > prev_diff_rate) {
920 rate = prev_rate;
921 *params = prev_params;
922 break;
923 }
924
925 prev_diff_rate = diff_rate;
926
927 if (drate == rate)
928 return rate;
929 }
930
931
932 if (index == fs->data->rtbl_cnt)
933 *params = prev_params;
934
935 return rate;
936}
937
938static unsigned long quadfs_recalc_rate(struct clk_hw *hw,
939 unsigned long parent_rate)
940{
941 struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
942 unsigned long rate = 0;
943 struct stm_fs params;
944 int (*clk_fs_get_rate)(unsigned long ,
4abb1b40 945 const struct stm_fs *, unsigned long *);
5f7aa907
GF		 946
947 clk_fs_get_rate = fs->data->get_rate;
948
949 if (quadfs_fsynt_get_hw_value_for_recalc(fs, &params))
950 return 0;
951
952 if (clk_fs_get_rate(parent_rate, &params, &rate)) {
953 pr_err("%s:%s error calculating rate\n",
836ee0f7 954 clk_hw_get_name(hw), __func__);
5f7aa907
GF		 955 }
956
836ee0f7 957 pr_debug("%s:%s rate %lu\n", clk_hw_get_name(hw), __func__, rate);
5f7aa907
GF		 958
959 return rate;
960}
961
962static long quadfs_round_rate(struct clk_hw *hw, unsigned long rate,
963 unsigned long *prate)
964{
965 struct stm_fs params;
966
967 rate = quadfs_find_best_rate(hw, rate, *prate, &params);
968
969 pr_debug("%s: %s new rate %ld [sdiv=0x%x,md=0x%x,pe=0x%x,nsdiv3=%u]\n",
836ee0f7 970 __func__, clk_hw_get_name(hw),
5f7aa907
GF		 971 rate, (unsigned int)params.sdiv, (unsigned int)params.mdiv,
972 (unsigned int)params.pe, (unsigned int)params.nsdiv);
973
974 return rate;
975}
976
977
978static void quadfs_program_and_enable(struct st_clk_quadfs_fsynth *fs,
979 struct stm_fs *params)
980{
981 fs->md = params->mdiv;
982 fs->pe = params->pe;
983 fs->sdiv = params->sdiv;
984 fs->nsdiv = params->nsdiv;
985
986 /*
987 * In some integrations you can only change the fsynth programming when
988 * the parent entity containing it is enabled.
989 */
990 quadfs_fsynth_program_rate(fs);
991 quadfs_fsynth_program_enable(fs);
992}
993
994static int quadfs_set_rate(struct clk_hw *hw, unsigned long rate,
995 unsigned long parent_rate)
996{
997 struct st_clk_quadfs_fsynth *fs = to_quadfs_fsynth(hw);
998 struct stm_fs params;
999 long hwrate;
1000 int uninitialized_var(i);
1001
1002 if (!rate || !parent_rate)
1003 return -EINVAL;
1004
1005 memset(&params, 0, sizeof(struct stm_fs));
1006
1007 hwrate = quadfs_find_best_rate(hw, rate, parent_rate, &params);
1008 if (!hwrate)
1009 return -EINVAL;
1010
1011 quadfs_program_and_enable(fs, &params);
1012
1013 return 0;
1014}
1015
1016
1017
1018static const struct clk_ops st_quadfs_ops = {
1019 .enable = quadfs_fsynth_enable,
1020 .disable = quadfs_fsynth_disable,
1021 .is_enabled = quadfs_fsynth_is_enabled,
1022 .round_rate = quadfs_round_rate,
1023 .set_rate = quadfs_set_rate,
1024 .recalc_rate = quadfs_recalc_rate,
1025};
1026
1027static struct clk * __init st_clk_register_quadfs_fsynth(
1028 const char *name, const char *parent_name,
1029 struct clkgen_quadfs_data *quadfs, void __iomem *reg, u32 chan,
1030 spinlock_t *lock)
1031{
1032 struct st_clk_quadfs_fsynth *fs;
1033 struct clk *clk;
1034 struct clk_init_data init;
1035
1036 /*
1037 * Sanity check required pointers, note that nsdiv3 is optional.
1038 */
1039 if (WARN_ON(!name || !parent_name))
1040 return ERR_PTR(-EINVAL);
1041
1042 fs = kzalloc(sizeof(*fs), GFP_KERNEL);
1043 if (!fs)
1044 return ERR_PTR(-ENOMEM);
1045
1046 init.name = name;
1047 init.ops = &st_quadfs_ops;
1048 init.flags = CLK_GET_RATE_NOCACHE | CLK_IS_BASIC;
1049 init.parent_names = &parent_name;
1050 init.num_parents = 1;
1051
1052 fs->data = quadfs;
1053 fs->regs_base = reg;
1054 fs->chan = chan;
1055 fs->lock = lock;
1056 fs->hw.init = &init;
1057
1058 clk = clk_register(NULL, &fs->hw);
1059
1060 if (IS_ERR(clk))
1061 kfree(fs);
1062
1063 return clk;
1064}
1065
f375573c 1066static const struct of_device_id quadfs_of_match[] = {
5f7aa907
GF		 1067 {
1068 .compatible = "st,stih416-quadfs216",
79bb8aa1 1069 .data = &st_fs216c65_416
5f7aa907
GF		 1070 },
1071 {
1072 .compatible = "st,stih416-quadfs432",
79bb8aa1 1073 .data = &st_fs432c65_416
5f7aa907
GF		 1074 },
1075 {
1076 .compatible = "st,stih416-quadfs660-E",
79bb8aa1 1077 .data = &st_fs660c32_E_416
5f7aa907
GF		 1078 },
1079 {
1080 .compatible = "st,stih416-quadfs660-F",
79bb8aa1 1081 .data = &st_fs660c32_F_416
5f7aa907 1082 },
51306d56
GF		 1083 {
1084 .compatible = "st,stih407-quadfs660-C",
d34e210e 1085 .data = &st_fs660c32_C
51306d56
GF		 1086 },
1087 {
1088 .compatible = "st,stih407-quadfs660-D",
d34e210e 1089 .data = &st_fs660c32_D
51306d56 1090 },
5f7aa907
GF		 1091 {}
1092};
1093
1094static void __init st_of_create_quadfs_fsynths(
1095 struct device_node *np, const char *pll_name,
1096 struct clkgen_quadfs_data *quadfs, void __iomem *reg,
1097 spinlock_t *lock)
1098{
1099 struct clk_onecell_data *clk_data;
1100 int fschan;
1101
1102 clk_data = kzalloc(sizeof(*clk_data), GFP_KERNEL);
1103 if (!clk_data)
1104 return;
1105
1106 clk_data->clk_num = QUADFS_MAX_CHAN;
1107 clk_data->clks = kzalloc(QUADFS_MAX_CHAN * sizeof(struct clk *),
1108 GFP_KERNEL);
1109
1110 if (!clk_data->clks) {
1111 kfree(clk_data);
1112 return;
1113 }
1114
1115 for (fschan = 0; fschan < QUADFS_MAX_CHAN; fschan++) {
1116 struct clk *clk;
1117 const char *clk_name;
1118
1119 if (of_property_read_string_index(np, "clock-output-names",
1120 fschan, &clk_name)) {
1121 break;
1122 }
1123
1124 /*
1125 * If we read an empty clock name then the channel is unused
1126 */
1127 if (*clk_name == '\0')
1128 continue;
1129
1130 clk = st_clk_register_quadfs_fsynth(clk_name, pll_name,
1131 quadfs, reg, fschan, lock);
1132
1133 /*
1134 * If there was an error registering this clock output, clean
1135 * up and move on to the next one.
1136 */
1137 if (!IS_ERR(clk)) {
1138 clk_data->clks[fschan] = clk;
1139 pr_debug("%s: parent %s rate %u\n",
1140 __clk_get_name(clk),
1141 __clk_get_name(clk_get_parent(clk)),
1142 (unsigned int)clk_get_rate(clk));
1143 }
1144 }
1145
1146 of_clk_add_provider(np, of_clk_src_onecell_get, clk_data);
1147}
1148
1149static void __init st_of_quadfs_setup(struct device_node *np)
1150{
1151 const struct of_device_id *match;
1152 struct clk *clk;
1153 const char *pll_name, *clk_parent_name;
1154 void __iomem *reg;
1155 spinlock_t *lock;
1156
1157 match = of_match_node(quadfs_of_match, np);
1158 if (WARN_ON(!match))
1159 return;
1160
1161 reg = of_iomap(np, 0);
1162 if (!reg)
1163 return;
1164
1165 clk_parent_name = of_clk_get_parent_name(np, 0);
1166 if (!clk_parent_name)
1167 return;
1168
1169 pll_name = kasprintf(GFP_KERNEL, "%s.pll", np->name);
1170 if (!pll_name)
1171 return;
1172
1173 lock = kzalloc(sizeof(*lock), GFP_KERNEL);
1174 if (!lock)
1175 goto err_exit;
1176
1177 spin_lock_init(lock);
1178
1179 clk = st_clk_register_quadfs_pll(pll_name, clk_parent_name,
1180 (struct clkgen_quadfs_data *) match->data, reg, lock);
1181 if (IS_ERR(clk))
1182 goto err_exit;
1183 else
1184 pr_debug("%s: parent %s rate %u\n",
1185 __clk_get_name(clk),
1186 __clk_get_name(clk_get_parent(clk)),
1187 (unsigned int)clk_get_rate(clk));
1188
1189 st_of_create_quadfs_fsynths(np, pll_name,
1190 (struct clkgen_quadfs_data *)match->data,
1191 reg, lock);
1192
1193err_exit:
1194 kfree(pll_name); /* No longer need local copy of the PLL name */
1195}
1196CLK_OF_DECLARE(quadfs, "st,quadfs", st_of_quadfs_setup);
Linux kernel - Deliverables
This page took 0.167554 seconds and 5 git commands to generate.