]>
Commit | Line | Data |
---|---|---|
c942fddf | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
3e1aec4e MV |
2 | /* |
3 | * Driver for IDT Versaclock 5 | |
4 | * | |
5 | * Copyright (C) 2017 Marek Vasut <marek.vasut@gmail.com> | |
3e1aec4e MV |
6 | */ |
7 | ||
8 | /* | |
9 | * Possible optimizations: | |
10 | * - Use spread spectrum | |
11 | * - Use integer divider in FOD if applicable | |
12 | */ | |
13 | ||
14 | #include <linux/clk.h> | |
15 | #include <linux/clk-provider.h> | |
16 | #include <linux/delay.h> | |
17 | #include <linux/i2c.h> | |
18 | #include <linux/interrupt.h> | |
19 | #include <linux/mod_devicetable.h> | |
20 | #include <linux/module.h> | |
21 | #include <linux/of.h> | |
22 | #include <linux/of_platform.h> | |
23 | #include <linux/rational.h> | |
24 | #include <linux/regmap.h> | |
25 | #include <linux/slab.h> | |
26 | ||
260249f9 AF |
27 | #include <dt-bindings/clk/versaclock.h> |
28 | ||
3e1aec4e MV |
29 | /* VersaClock5 registers */ |
30 | #define VC5_OTP_CONTROL 0x00 | |
31 | ||
32 | /* Factory-reserved register block */ | |
33 | #define VC5_RSVD_DEVICE_ID 0x01 | |
34 | #define VC5_RSVD_ADC_GAIN_7_0 0x02 | |
35 | #define VC5_RSVD_ADC_GAIN_15_8 0x03 | |
36 | #define VC5_RSVD_ADC_OFFSET_7_0 0x04 | |
37 | #define VC5_RSVD_ADC_OFFSET_15_8 0x05 | |
38 | #define VC5_RSVD_TEMPY 0x06 | |
39 | #define VC5_RSVD_OFFSET_TBIN 0x07 | |
40 | #define VC5_RSVD_GAIN 0x08 | |
41 | #define VC5_RSVD_TEST_NP 0x09 | |
42 | #define VC5_RSVD_UNUSED 0x0a | |
43 | #define VC5_RSVD_BANDGAP_TRIM_UP 0x0b | |
44 | #define VC5_RSVD_BANDGAP_TRIM_DN 0x0c | |
45 | #define VC5_RSVD_CLK_R_12_CLK_AMP_4 0x0d | |
46 | #define VC5_RSVD_CLK_R_34_CLK_AMP_4 0x0e | |
47 | #define VC5_RSVD_CLK_AMP_123 0x0f | |
48 | ||
49 | /* Configuration register block */ | |
50 | #define VC5_PRIM_SRC_SHDN 0x10 | |
51 | #define VC5_PRIM_SRC_SHDN_EN_XTAL BIT(7) | |
52 | #define VC5_PRIM_SRC_SHDN_EN_CLKIN BIT(6) | |
8c1ebe97 | 53 | #define VC5_PRIM_SRC_SHDN_EN_DOUBLE_XTAL_FREQ BIT(3) |
3e1aec4e MV |
54 | #define VC5_PRIM_SRC_SHDN_SP BIT(1) |
55 | #define VC5_PRIM_SRC_SHDN_EN_GBL_SHDN BIT(0) | |
56 | ||
57 | #define VC5_VCO_BAND 0x11 | |
58 | #define VC5_XTAL_X1_LOAD_CAP 0x12 | |
59 | #define VC5_XTAL_X2_LOAD_CAP 0x13 | |
60 | #define VC5_REF_DIVIDER 0x15 | |
61 | #define VC5_REF_DIVIDER_SEL_PREDIV2 BIT(7) | |
62 | #define VC5_REF_DIVIDER_REF_DIV(n) ((n) & 0x3f) | |
63 | ||
64 | #define VC5_VCO_CTRL_AND_PREDIV 0x16 | |
65 | #define VC5_VCO_CTRL_AND_PREDIV_BYPASS_PREDIV BIT(7) | |
66 | ||
67 | #define VC5_FEEDBACK_INT_DIV 0x17 | |
68 | #define VC5_FEEDBACK_INT_DIV_BITS 0x18 | |
69 | #define VC5_FEEDBACK_FRAC_DIV(n) (0x19 + (n)) | |
70 | #define VC5_RC_CONTROL0 0x1e | |
71 | #define VC5_RC_CONTROL1 0x1f | |
72 | /* Register 0x20 is factory reserved */ | |
73 | ||
74 | /* Output divider control for divider 1,2,3,4 */ | |
75 | #define VC5_OUT_DIV_CONTROL(idx) (0x21 + ((idx) * 0x10)) | |
76 | #define VC5_OUT_DIV_CONTROL_RESET BIT(7) | |
77 | #define VC5_OUT_DIV_CONTROL_SELB_NORM BIT(3) | |
78 | #define VC5_OUT_DIV_CONTROL_SEL_EXT BIT(2) | |
79 | #define VC5_OUT_DIV_CONTROL_INT_MODE BIT(1) | |
80 | #define VC5_OUT_DIV_CONTROL_EN_FOD BIT(0) | |
81 | ||
82 | #define VC5_OUT_DIV_FRAC(idx, n) (0x22 + ((idx) * 0x10) + (n)) | |
83 | #define VC5_OUT_DIV_FRAC4_OD_SCEE BIT(1) | |
84 | ||
85 | #define VC5_OUT_DIV_STEP_SPREAD(idx, n) (0x26 + ((idx) * 0x10) + (n)) | |
86 | #define VC5_OUT_DIV_SPREAD_MOD(idx, n) (0x29 + ((idx) * 0x10) + (n)) | |
87 | #define VC5_OUT_DIV_SKEW_INT(idx, n) (0x2b + ((idx) * 0x10) + (n)) | |
88 | #define VC5_OUT_DIV_INT(idx, n) (0x2d + ((idx) * 0x10) + (n)) | |
89 | #define VC5_OUT_DIV_SKEW_FRAC(idx) (0x2f + ((idx) * 0x10)) | |
90 | /* Registers 0x30, 0x40, 0x50 are factory reserved */ | |
91 | ||
92 | /* Clock control register for clock 1,2 */ | |
93 | #define VC5_CLK_OUTPUT_CFG(idx, n) (0x60 + ((idx) * 0x2) + (n)) | |
260249f9 AF |
94 | #define VC5_CLK_OUTPUT_CFG0_CFG_SHIFT 5 |
95 | #define VC5_CLK_OUTPUT_CFG0_CFG_MASK GENMASK(7, VC5_CLK_OUTPUT_CFG0_CFG_SHIFT) | |
96 | ||
97 | #define VC5_CLK_OUTPUT_CFG0_CFG_LVPECL (VC5_LVPECL) | |
98 | #define VC5_CLK_OUTPUT_CFG0_CFG_CMOS (VC5_CMOS) | |
99 | #define VC5_CLK_OUTPUT_CFG0_CFG_HCSL33 (VC5_HCSL33) | |
100 | #define VC5_CLK_OUTPUT_CFG0_CFG_LVDS (VC5_LVDS) | |
101 | #define VC5_CLK_OUTPUT_CFG0_CFG_CMOS2 (VC5_CMOS2) | |
102 | #define VC5_CLK_OUTPUT_CFG0_CFG_CMOSD (VC5_CMOSD) | |
103 | #define VC5_CLK_OUTPUT_CFG0_CFG_HCSL25 (VC5_HCSL25) | |
104 | ||
105 | #define VC5_CLK_OUTPUT_CFG0_PWR_SHIFT 3 | |
106 | #define VC5_CLK_OUTPUT_CFG0_PWR_MASK GENMASK(4, VC5_CLK_OUTPUT_CFG0_PWR_SHIFT) | |
107 | #define VC5_CLK_OUTPUT_CFG0_PWR_18 (0<<VC5_CLK_OUTPUT_CFG0_PWR_SHIFT) | |
108 | #define VC5_CLK_OUTPUT_CFG0_PWR_25 (2<<VC5_CLK_OUTPUT_CFG0_PWR_SHIFT) | |
109 | #define VC5_CLK_OUTPUT_CFG0_PWR_33 (3<<VC5_CLK_OUTPUT_CFG0_PWR_SHIFT) | |
110 | #define VC5_CLK_OUTPUT_CFG0_SLEW_SHIFT 0 | |
111 | #define VC5_CLK_OUTPUT_CFG0_SLEW_MASK GENMASK(1, VC5_CLK_OUTPUT_CFG0_SLEW_SHIFT) | |
112 | #define VC5_CLK_OUTPUT_CFG0_SLEW_80 (0<<VC5_CLK_OUTPUT_CFG0_SLEW_SHIFT) | |
113 | #define VC5_CLK_OUTPUT_CFG0_SLEW_85 (1<<VC5_CLK_OUTPUT_CFG0_SLEW_SHIFT) | |
114 | #define VC5_CLK_OUTPUT_CFG0_SLEW_90 (2<<VC5_CLK_OUTPUT_CFG0_SLEW_SHIFT) | |
115 | #define VC5_CLK_OUTPUT_CFG0_SLEW_100 (3<<VC5_CLK_OUTPUT_CFG0_SLEW_SHIFT) | |
3e1aec4e MV |
116 | #define VC5_CLK_OUTPUT_CFG1_EN_CLKBUF BIT(0) |
117 | ||
118 | #define VC5_CLK_OE_SHDN 0x68 | |
119 | #define VC5_CLK_OS_SHDN 0x69 | |
120 | ||
121 | #define VC5_GLOBAL_REGISTER 0x76 | |
122 | #define VC5_GLOBAL_REGISTER_GLOBAL_RESET BIT(5) | |
123 | ||
124 | /* PLL/VCO runs between 2.5 GHz and 3.0 GHz */ | |
125 | #define VC5_PLL_VCO_MIN 2500000000UL | |
126 | #define VC5_PLL_VCO_MAX 3000000000UL | |
127 | ||
128 | /* VC5 Input mux settings */ | |
129 | #define VC5_MUX_IN_XIN BIT(0) | |
130 | #define VC5_MUX_IN_CLKIN BIT(1) | |
131 | ||
9adddb01 | 132 | /* Maximum number of clk_out supported by this driver */ |
1193e14f | 133 | #define VC5_MAX_CLK_OUT_NUM 5 |
9adddb01 AF |
134 | |
135 | /* Maximum number of FODs supported by this driver */ | |
1193e14f | 136 | #define VC5_MAX_FOD_NUM 4 |
9adddb01 AF |
137 | |
138 | /* flags to describe chip features */ | |
139 | /* chip has built-in oscilator */ | |
140 | #define VC5_HAS_INTERNAL_XTAL BIT(0) | |
8c1ebe97 MV |
141 | /* chip has PFD requency doubler */ |
142 | #define VC5_HAS_PFD_FREQ_DBL BIT(1) | |
9adddb01 | 143 | |
3e1aec4e MV |
144 | /* Supported IDT VC5 models. */ |
145 | enum vc5_model { | |
146 | IDT_VC5_5P49V5923, | |
b1911555 | 147 | IDT_VC5_5P49V5925, |
3e1aec4e | 148 | IDT_VC5_5P49V5933, |
1193e14f | 149 | IDT_VC5_5P49V5935, |
dbf6b16f | 150 | IDT_VC6_5P49V6901, |
2bda748e | 151 | IDT_VC6_5P49V6965, |
3e1aec4e MV |
152 | }; |
153 | ||
9adddb01 AF |
154 | /* Structure to describe features of a particular VC5 model */ |
155 | struct vc5_chip_info { | |
156 | const enum vc5_model model; | |
157 | const unsigned int clk_fod_cnt; | |
158 | const unsigned int clk_out_cnt; | |
159 | const u32 flags; | |
160 | }; | |
161 | ||
3e1aec4e MV |
162 | struct vc5_driver_data; |
163 | ||
164 | struct vc5_hw_data { | |
165 | struct clk_hw hw; | |
166 | struct vc5_driver_data *vc5; | |
167 | u32 div_int; | |
168 | u32 div_frc; | |
169 | unsigned int num; | |
3bca66b0 LC |
170 | }; |
171 | ||
172 | struct vc5_out_data { | |
173 | struct clk_hw hw; | |
174 | struct vc5_driver_data *vc5; | |
175 | unsigned int num; | |
260249f9 AF |
176 | unsigned int clk_output_cfg0; |
177 | unsigned int clk_output_cfg0_mask; | |
3e1aec4e MV |
178 | }; |
179 | ||
180 | struct vc5_driver_data { | |
181 | struct i2c_client *client; | |
182 | struct regmap *regmap; | |
9adddb01 | 183 | const struct vc5_chip_info *chip_info; |
3e1aec4e MV |
184 | |
185 | struct clk *pin_xin; | |
186 | struct clk *pin_clkin; | |
187 | unsigned char clk_mux_ins; | |
188 | struct clk_hw clk_mux; | |
8c1ebe97 | 189 | struct clk_hw clk_mul; |
55997db5 | 190 | struct clk_hw clk_pfd; |
3e1aec4e | 191 | struct vc5_hw_data clk_pll; |
9adddb01 | 192 | struct vc5_hw_data clk_fod[VC5_MAX_FOD_NUM]; |
3bca66b0 | 193 | struct vc5_out_data clk_out[VC5_MAX_CLK_OUT_NUM]; |
3e1aec4e MV |
194 | }; |
195 | ||
3e1aec4e MV |
196 | /* |
197 | * VersaClock5 i2c regmap | |
198 | */ | |
199 | static bool vc5_regmap_is_writeable(struct device *dev, unsigned int reg) | |
200 | { | |
201 | /* Factory reserved regs, make them read-only */ | |
202 | if (reg <= 0xf) | |
203 | return false; | |
204 | ||
205 | /* Factory reserved regs, make them read-only */ | |
206 | if (reg == 0x14 || reg == 0x1c || reg == 0x1d) | |
207 | return false; | |
208 | ||
209 | return true; | |
210 | } | |
211 | ||
212 | static const struct regmap_config vc5_regmap_config = { | |
213 | .reg_bits = 8, | |
214 | .val_bits = 8, | |
215 | .cache_type = REGCACHE_RBTREE, | |
216 | .max_register = 0x76, | |
217 | .writeable_reg = vc5_regmap_is_writeable, | |
218 | }; | |
219 | ||
220 | /* | |
221 | * VersaClock5 input multiplexer between XTAL and CLKIN divider | |
222 | */ | |
223 | static unsigned char vc5_mux_get_parent(struct clk_hw *hw) | |
224 | { | |
225 | struct vc5_driver_data *vc5 = | |
226 | container_of(hw, struct vc5_driver_data, clk_mux); | |
227 | const u8 mask = VC5_PRIM_SRC_SHDN_EN_XTAL | VC5_PRIM_SRC_SHDN_EN_CLKIN; | |
228 | unsigned int src; | |
229 | ||
230 | regmap_read(vc5->regmap, VC5_PRIM_SRC_SHDN, &src); | |
231 | src &= mask; | |
232 | ||
233 | if (src == VC5_PRIM_SRC_SHDN_EN_XTAL) | |
234 | return 0; | |
235 | ||
236 | if (src == VC5_PRIM_SRC_SHDN_EN_CLKIN) | |
237 | return 1; | |
238 | ||
239 | dev_warn(&vc5->client->dev, | |
240 | "Invalid clock input configuration (%02x)\n", src); | |
241 | return 0; | |
242 | } | |
243 | ||
244 | static int vc5_mux_set_parent(struct clk_hw *hw, u8 index) | |
245 | { | |
246 | struct vc5_driver_data *vc5 = | |
247 | container_of(hw, struct vc5_driver_data, clk_mux); | |
248 | const u8 mask = VC5_PRIM_SRC_SHDN_EN_XTAL | VC5_PRIM_SRC_SHDN_EN_CLKIN; | |
249 | u8 src; | |
250 | ||
251 | if ((index > 1) || !vc5->clk_mux_ins) | |
252 | return -EINVAL; | |
253 | ||
254 | if (vc5->clk_mux_ins == (VC5_MUX_IN_CLKIN | VC5_MUX_IN_XIN)) { | |
255 | if (index == 0) | |
256 | src = VC5_PRIM_SRC_SHDN_EN_XTAL; | |
257 | if (index == 1) | |
258 | src = VC5_PRIM_SRC_SHDN_EN_CLKIN; | |
259 | } else { | |
260 | if (index != 0) | |
261 | return -EINVAL; | |
262 | ||
263 | if (vc5->clk_mux_ins == VC5_MUX_IN_XIN) | |
264 | src = VC5_PRIM_SRC_SHDN_EN_XTAL; | |
2137a109 | 265 | else if (vc5->clk_mux_ins == VC5_MUX_IN_CLKIN) |
3e1aec4e | 266 | src = VC5_PRIM_SRC_SHDN_EN_CLKIN; |
2137a109 MV |
267 | else /* Invalid; should have been caught by vc5_probe() */ |
268 | return -EINVAL; | |
3e1aec4e MV |
269 | } |
270 | ||
271 | return regmap_update_bits(vc5->regmap, VC5_PRIM_SRC_SHDN, mask, src); | |
272 | } | |
273 | ||
55997db5 MV |
274 | static const struct clk_ops vc5_mux_ops = { |
275 | .set_parent = vc5_mux_set_parent, | |
276 | .get_parent = vc5_mux_get_parent, | |
277 | }; | |
278 | ||
8c1ebe97 MV |
279 | static unsigned long vc5_dbl_recalc_rate(struct clk_hw *hw, |
280 | unsigned long parent_rate) | |
281 | { | |
282 | struct vc5_driver_data *vc5 = | |
283 | container_of(hw, struct vc5_driver_data, clk_mul); | |
284 | unsigned int premul; | |
285 | ||
286 | regmap_read(vc5->regmap, VC5_PRIM_SRC_SHDN, &premul); | |
287 | if (premul & VC5_PRIM_SRC_SHDN_EN_DOUBLE_XTAL_FREQ) | |
288 | parent_rate *= 2; | |
289 | ||
290 | return parent_rate; | |
291 | } | |
292 | ||
293 | static long vc5_dbl_round_rate(struct clk_hw *hw, unsigned long rate, | |
294 | unsigned long *parent_rate) | |
295 | { | |
296 | if ((*parent_rate == rate) || ((*parent_rate * 2) == rate)) | |
297 | return rate; | |
298 | else | |
299 | return -EINVAL; | |
300 | } | |
301 | ||
302 | static int vc5_dbl_set_rate(struct clk_hw *hw, unsigned long rate, | |
303 | unsigned long parent_rate) | |
304 | { | |
305 | struct vc5_driver_data *vc5 = | |
306 | container_of(hw, struct vc5_driver_data, clk_mul); | |
307 | u32 mask; | |
308 | ||
309 | if ((parent_rate * 2) == rate) | |
310 | mask = VC5_PRIM_SRC_SHDN_EN_DOUBLE_XTAL_FREQ; | |
311 | else | |
312 | mask = 0; | |
313 | ||
314 | regmap_update_bits(vc5->regmap, VC5_PRIM_SRC_SHDN, | |
315 | VC5_PRIM_SRC_SHDN_EN_DOUBLE_XTAL_FREQ, | |
316 | mask); | |
317 | ||
318 | return 0; | |
319 | } | |
320 | ||
321 | static const struct clk_ops vc5_dbl_ops = { | |
322 | .recalc_rate = vc5_dbl_recalc_rate, | |
323 | .round_rate = vc5_dbl_round_rate, | |
324 | .set_rate = vc5_dbl_set_rate, | |
325 | }; | |
326 | ||
55997db5 | 327 | static unsigned long vc5_pfd_recalc_rate(struct clk_hw *hw, |
3e1aec4e MV |
328 | unsigned long parent_rate) |
329 | { | |
330 | struct vc5_driver_data *vc5 = | |
55997db5 | 331 | container_of(hw, struct vc5_driver_data, clk_pfd); |
3e1aec4e MV |
332 | unsigned int prediv, div; |
333 | ||
334 | regmap_read(vc5->regmap, VC5_VCO_CTRL_AND_PREDIV, &prediv); | |
335 | ||
336 | /* The bypass_prediv is set, PLL fed from Ref_in directly. */ | |
337 | if (prediv & VC5_VCO_CTRL_AND_PREDIV_BYPASS_PREDIV) | |
338 | return parent_rate; | |
339 | ||
340 | regmap_read(vc5->regmap, VC5_REF_DIVIDER, &div); | |
341 | ||
342 | /* The Sel_prediv2 is set, PLL fed from prediv2 (Ref_in / 2) */ | |
343 | if (div & VC5_REF_DIVIDER_SEL_PREDIV2) | |
344 | return parent_rate / 2; | |
345 | else | |
346 | return parent_rate / VC5_REF_DIVIDER_REF_DIV(div); | |
347 | } | |
348 | ||
55997db5 | 349 | static long vc5_pfd_round_rate(struct clk_hw *hw, unsigned long rate, |
3e1aec4e MV |
350 | unsigned long *parent_rate) |
351 | { | |
352 | unsigned long idiv; | |
353 | ||
354 | /* PLL cannot operate with input clock above 50 MHz. */ | |
355 | if (rate > 50000000) | |
356 | return -EINVAL; | |
357 | ||
358 | /* CLKIN within range of PLL input, feed directly to PLL. */ | |
359 | if (*parent_rate <= 50000000) | |
360 | return *parent_rate; | |
361 | ||
362 | idiv = DIV_ROUND_UP(*parent_rate, rate); | |
363 | if (idiv > 127) | |
364 | return -EINVAL; | |
365 | ||
366 | return *parent_rate / idiv; | |
367 | } | |
368 | ||
55997db5 | 369 | static int vc5_pfd_set_rate(struct clk_hw *hw, unsigned long rate, |
3e1aec4e MV |
370 | unsigned long parent_rate) |
371 | { | |
372 | struct vc5_driver_data *vc5 = | |
55997db5 | 373 | container_of(hw, struct vc5_driver_data, clk_pfd); |
3e1aec4e MV |
374 | unsigned long idiv; |
375 | u8 div; | |
376 | ||
377 | /* CLKIN within range of PLL input, feed directly to PLL. */ | |
378 | if (parent_rate <= 50000000) { | |
379 | regmap_update_bits(vc5->regmap, VC5_VCO_CTRL_AND_PREDIV, | |
380 | VC5_VCO_CTRL_AND_PREDIV_BYPASS_PREDIV, | |
381 | VC5_VCO_CTRL_AND_PREDIV_BYPASS_PREDIV); | |
382 | regmap_update_bits(vc5->regmap, VC5_REF_DIVIDER, 0xff, 0x00); | |
383 | return 0; | |
384 | } | |
385 | ||
386 | idiv = DIV_ROUND_UP(parent_rate, rate); | |
387 | ||
388 | /* We have dedicated div-2 predivider. */ | |
389 | if (idiv == 2) | |
390 | div = VC5_REF_DIVIDER_SEL_PREDIV2; | |
391 | else | |
392 | div = VC5_REF_DIVIDER_REF_DIV(idiv); | |
393 | ||
394 | regmap_update_bits(vc5->regmap, VC5_REF_DIVIDER, 0xff, div); | |
395 | regmap_update_bits(vc5->regmap, VC5_VCO_CTRL_AND_PREDIV, | |
396 | VC5_VCO_CTRL_AND_PREDIV_BYPASS_PREDIV, 0); | |
397 | ||
398 | return 0; | |
399 | } | |
400 | ||
55997db5 MV |
401 | static const struct clk_ops vc5_pfd_ops = { |
402 | .recalc_rate = vc5_pfd_recalc_rate, | |
403 | .round_rate = vc5_pfd_round_rate, | |
404 | .set_rate = vc5_pfd_set_rate, | |
3e1aec4e MV |
405 | }; |
406 | ||
407 | /* | |
408 | * VersaClock5 PLL/VCO | |
409 | */ | |
410 | static unsigned long vc5_pll_recalc_rate(struct clk_hw *hw, | |
411 | unsigned long parent_rate) | |
412 | { | |
413 | struct vc5_hw_data *hwdata = container_of(hw, struct vc5_hw_data, hw); | |
414 | struct vc5_driver_data *vc5 = hwdata->vc5; | |
415 | u32 div_int, div_frc; | |
416 | u8 fb[5]; | |
417 | ||
418 | regmap_bulk_read(vc5->regmap, VC5_FEEDBACK_INT_DIV, fb, 5); | |
419 | ||
420 | div_int = (fb[0] << 4) | (fb[1] >> 4); | |
421 | div_frc = (fb[2] << 16) | (fb[3] << 8) | fb[4]; | |
422 | ||
423 | /* The PLL divider has 12 integer bits and 24 fractional bits */ | |
424 | return (parent_rate * div_int) + ((parent_rate * div_frc) >> 24); | |
425 | } | |
426 | ||
427 | static long vc5_pll_round_rate(struct clk_hw *hw, unsigned long rate, | |
428 | unsigned long *parent_rate) | |
429 | { | |
430 | struct vc5_hw_data *hwdata = container_of(hw, struct vc5_hw_data, hw); | |
431 | u32 div_int; | |
432 | u64 div_frc; | |
433 | ||
434 | if (rate < VC5_PLL_VCO_MIN) | |
435 | rate = VC5_PLL_VCO_MIN; | |
436 | if (rate > VC5_PLL_VCO_MAX) | |
437 | rate = VC5_PLL_VCO_MAX; | |
438 | ||
439 | /* Determine integer part, which is 12 bit wide */ | |
440 | div_int = rate / *parent_rate; | |
441 | if (div_int > 0xfff) | |
442 | rate = *parent_rate * 0xfff; | |
443 | ||
444 | /* Determine best fractional part, which is 24 bit wide */ | |
445 | div_frc = rate % *parent_rate; | |
446 | div_frc *= BIT(24) - 1; | |
447 | do_div(div_frc, *parent_rate); | |
448 | ||
449 | hwdata->div_int = div_int; | |
450 | hwdata->div_frc = (u32)div_frc; | |
451 | ||
452 | return (*parent_rate * div_int) + ((*parent_rate * div_frc) >> 24); | |
453 | } | |
454 | ||
455 | static int vc5_pll_set_rate(struct clk_hw *hw, unsigned long rate, | |
456 | unsigned long parent_rate) | |
457 | { | |
458 | struct vc5_hw_data *hwdata = container_of(hw, struct vc5_hw_data, hw); | |
459 | struct vc5_driver_data *vc5 = hwdata->vc5; | |
460 | u8 fb[5]; | |
461 | ||
462 | fb[0] = hwdata->div_int >> 4; | |
463 | fb[1] = hwdata->div_int << 4; | |
464 | fb[2] = hwdata->div_frc >> 16; | |
465 | fb[3] = hwdata->div_frc >> 8; | |
466 | fb[4] = hwdata->div_frc; | |
467 | ||
468 | return regmap_bulk_write(vc5->regmap, VC5_FEEDBACK_INT_DIV, fb, 5); | |
469 | } | |
470 | ||
471 | static const struct clk_ops vc5_pll_ops = { | |
472 | .recalc_rate = vc5_pll_recalc_rate, | |
473 | .round_rate = vc5_pll_round_rate, | |
474 | .set_rate = vc5_pll_set_rate, | |
475 | }; | |
476 | ||
477 | static unsigned long vc5_fod_recalc_rate(struct clk_hw *hw, | |
478 | unsigned long parent_rate) | |
479 | { | |
480 | struct vc5_hw_data *hwdata = container_of(hw, struct vc5_hw_data, hw); | |
481 | struct vc5_driver_data *vc5 = hwdata->vc5; | |
482 | /* VCO frequency is divided by two before entering FOD */ | |
483 | u32 f_in = parent_rate / 2; | |
484 | u32 div_int, div_frc; | |
485 | u8 od_int[2]; | |
486 | u8 od_frc[4]; | |
487 | ||
488 | regmap_bulk_read(vc5->regmap, VC5_OUT_DIV_INT(hwdata->num, 0), | |
489 | od_int, 2); | |
490 | regmap_bulk_read(vc5->regmap, VC5_OUT_DIV_FRAC(hwdata->num, 0), | |
491 | od_frc, 4); | |
492 | ||
493 | div_int = (od_int[0] << 4) | (od_int[1] >> 4); | |
494 | div_frc = (od_frc[0] << 22) | (od_frc[1] << 14) | | |
495 | (od_frc[2] << 6) | (od_frc[3] >> 2); | |
496 | ||
3bded569 MV |
497 | /* Avoid division by zero if the output is not configured. */ |
498 | if (div_int == 0 && div_frc == 0) | |
499 | return 0; | |
500 | ||
3e1aec4e MV |
501 | /* The PLL divider has 12 integer bits and 30 fractional bits */ |
502 | return div64_u64((u64)f_in << 24ULL, ((u64)div_int << 24ULL) + div_frc); | |
503 | } | |
504 | ||
505 | static long vc5_fod_round_rate(struct clk_hw *hw, unsigned long rate, | |
506 | unsigned long *parent_rate) | |
507 | { | |
508 | struct vc5_hw_data *hwdata = container_of(hw, struct vc5_hw_data, hw); | |
509 | /* VCO frequency is divided by two before entering FOD */ | |
510 | u32 f_in = *parent_rate / 2; | |
511 | u32 div_int; | |
512 | u64 div_frc; | |
513 | ||
514 | /* Determine integer part, which is 12 bit wide */ | |
515 | div_int = f_in / rate; | |
516 | /* | |
517 | * WARNING: The clock chip does not output signal if the integer part | |
518 | * of the divider is 0xfff and fractional part is non-zero. | |
519 | * Clamp the divider at 0xffe to keep the code simple. | |
520 | */ | |
521 | if (div_int > 0xffe) { | |
522 | div_int = 0xffe; | |
523 | rate = f_in / div_int; | |
524 | } | |
525 | ||
526 | /* Determine best fractional part, which is 30 bit wide */ | |
527 | div_frc = f_in % rate; | |
528 | div_frc <<= 24; | |
529 | do_div(div_frc, rate); | |
530 | ||
531 | hwdata->div_int = div_int; | |
532 | hwdata->div_frc = (u32)div_frc; | |
533 | ||
534 | return div64_u64((u64)f_in << 24ULL, ((u64)div_int << 24ULL) + div_frc); | |
535 | } | |
536 | ||
537 | static int vc5_fod_set_rate(struct clk_hw *hw, unsigned long rate, | |
538 | unsigned long parent_rate) | |
539 | { | |
540 | struct vc5_hw_data *hwdata = container_of(hw, struct vc5_hw_data, hw); | |
541 | struct vc5_driver_data *vc5 = hwdata->vc5; | |
542 | u8 data[14] = { | |
543 | hwdata->div_frc >> 22, hwdata->div_frc >> 14, | |
544 | hwdata->div_frc >> 6, hwdata->div_frc << 2, | |
545 | 0, 0, 0, 0, 0, | |
546 | 0, 0, | |
547 | hwdata->div_int >> 4, hwdata->div_int << 4, | |
548 | 0 | |
549 | }; | |
550 | ||
551 | regmap_bulk_write(vc5->regmap, VC5_OUT_DIV_FRAC(hwdata->num, 0), | |
552 | data, 14); | |
553 | ||
554 | /* | |
555 | * Toggle magic bit in undocumented register for unknown reason. | |
556 | * This is what the IDT timing commander tool does and the chip | |
557 | * datasheet somewhat implies this is needed, but the register | |
558 | * and the bit is not documented. | |
559 | */ | |
560 | regmap_update_bits(vc5->regmap, VC5_GLOBAL_REGISTER, | |
561 | VC5_GLOBAL_REGISTER_GLOBAL_RESET, 0); | |
562 | regmap_update_bits(vc5->regmap, VC5_GLOBAL_REGISTER, | |
563 | VC5_GLOBAL_REGISTER_GLOBAL_RESET, | |
564 | VC5_GLOBAL_REGISTER_GLOBAL_RESET); | |
565 | return 0; | |
566 | } | |
567 | ||
568 | static const struct clk_ops vc5_fod_ops = { | |
569 | .recalc_rate = vc5_fod_recalc_rate, | |
570 | .round_rate = vc5_fod_round_rate, | |
571 | .set_rate = vc5_fod_set_rate, | |
572 | }; | |
573 | ||
574 | static int vc5_clk_out_prepare(struct clk_hw *hw) | |
575 | { | |
3bca66b0 | 576 | struct vc5_out_data *hwdata = container_of(hw, struct vc5_out_data, hw); |
3e1aec4e | 577 | struct vc5_driver_data *vc5 = hwdata->vc5; |
718f4694 MV |
578 | const u8 mask = VC5_OUT_DIV_CONTROL_SELB_NORM | |
579 | VC5_OUT_DIV_CONTROL_SEL_EXT | | |
580 | VC5_OUT_DIV_CONTROL_EN_FOD; | |
581 | unsigned int src; | |
582 | int ret; | |
583 | ||
584 | /* | |
585 | * If the input mux is disabled, enable it first and | |
586 | * select source from matching FOD. | |
587 | */ | |
588 | regmap_read(vc5->regmap, VC5_OUT_DIV_CONTROL(hwdata->num), &src); | |
589 | if ((src & mask) == 0) { | |
590 | src = VC5_OUT_DIV_CONTROL_RESET | VC5_OUT_DIV_CONTROL_EN_FOD; | |
591 | ret = regmap_update_bits(vc5->regmap, | |
592 | VC5_OUT_DIV_CONTROL(hwdata->num), | |
593 | mask | VC5_OUT_DIV_CONTROL_RESET, src); | |
594 | if (ret) | |
595 | return ret; | |
596 | } | |
3e1aec4e MV |
597 | |
598 | /* Enable the clock buffer */ | |
599 | regmap_update_bits(vc5->regmap, VC5_CLK_OUTPUT_CFG(hwdata->num, 1), | |
600 | VC5_CLK_OUTPUT_CFG1_EN_CLKBUF, | |
601 | VC5_CLK_OUTPUT_CFG1_EN_CLKBUF); | |
260249f9 AF |
602 | if (hwdata->clk_output_cfg0_mask) { |
603 | dev_dbg(&vc5->client->dev, "Update output %d mask 0x%0X val 0x%0X\n", | |
604 | hwdata->num, hwdata->clk_output_cfg0_mask, | |
605 | hwdata->clk_output_cfg0); | |
606 | ||
607 | regmap_update_bits(vc5->regmap, | |
608 | VC5_CLK_OUTPUT_CFG(hwdata->num, 0), | |
609 | hwdata->clk_output_cfg0_mask, | |
610 | hwdata->clk_output_cfg0); | |
611 | } | |
612 | ||
3e1aec4e MV |
613 | return 0; |
614 | } | |
615 | ||
616 | static void vc5_clk_out_unprepare(struct clk_hw *hw) | |
617 | { | |
3bca66b0 | 618 | struct vc5_out_data *hwdata = container_of(hw, struct vc5_out_data, hw); |
3e1aec4e MV |
619 | struct vc5_driver_data *vc5 = hwdata->vc5; |
620 | ||
a4decf58 | 621 | /* Disable the clock buffer */ |
3e1aec4e MV |
622 | regmap_update_bits(vc5->regmap, VC5_CLK_OUTPUT_CFG(hwdata->num, 1), |
623 | VC5_CLK_OUTPUT_CFG1_EN_CLKBUF, 0); | |
624 | } | |
625 | ||
626 | static unsigned char vc5_clk_out_get_parent(struct clk_hw *hw) | |
627 | { | |
3bca66b0 | 628 | struct vc5_out_data *hwdata = container_of(hw, struct vc5_out_data, hw); |
3e1aec4e MV |
629 | struct vc5_driver_data *vc5 = hwdata->vc5; |
630 | const u8 mask = VC5_OUT_DIV_CONTROL_SELB_NORM | | |
631 | VC5_OUT_DIV_CONTROL_SEL_EXT | | |
632 | VC5_OUT_DIV_CONTROL_EN_FOD; | |
633 | const u8 fodclkmask = VC5_OUT_DIV_CONTROL_SELB_NORM | | |
634 | VC5_OUT_DIV_CONTROL_EN_FOD; | |
635 | const u8 extclk = VC5_OUT_DIV_CONTROL_SELB_NORM | | |
636 | VC5_OUT_DIV_CONTROL_SEL_EXT; | |
637 | unsigned int src; | |
638 | ||
639 | regmap_read(vc5->regmap, VC5_OUT_DIV_CONTROL(hwdata->num), &src); | |
640 | src &= mask; | |
641 | ||
325b7b90 MV |
642 | if (src == 0) /* Input mux set to DISABLED */ |
643 | return 0; | |
644 | ||
3e1aec4e MV |
645 | if ((src & fodclkmask) == VC5_OUT_DIV_CONTROL_EN_FOD) |
646 | return 0; | |
647 | ||
648 | if (src == extclk) | |
649 | return 1; | |
650 | ||
651 | dev_warn(&vc5->client->dev, | |
652 | "Invalid clock output configuration (%02x)\n", src); | |
653 | return 0; | |
654 | } | |
655 | ||
656 | static int vc5_clk_out_set_parent(struct clk_hw *hw, u8 index) | |
657 | { | |
3bca66b0 | 658 | struct vc5_out_data *hwdata = container_of(hw, struct vc5_out_data, hw); |
3e1aec4e MV |
659 | struct vc5_driver_data *vc5 = hwdata->vc5; |
660 | const u8 mask = VC5_OUT_DIV_CONTROL_RESET | | |
661 | VC5_OUT_DIV_CONTROL_SELB_NORM | | |
662 | VC5_OUT_DIV_CONTROL_SEL_EXT | | |
663 | VC5_OUT_DIV_CONTROL_EN_FOD; | |
664 | const u8 extclk = VC5_OUT_DIV_CONTROL_SELB_NORM | | |
665 | VC5_OUT_DIV_CONTROL_SEL_EXT; | |
666 | u8 src = VC5_OUT_DIV_CONTROL_RESET; | |
667 | ||
668 | if (index == 0) | |
669 | src |= VC5_OUT_DIV_CONTROL_EN_FOD; | |
670 | else | |
671 | src |= extclk; | |
672 | ||
673 | return regmap_update_bits(vc5->regmap, VC5_OUT_DIV_CONTROL(hwdata->num), | |
674 | mask, src); | |
675 | } | |
676 | ||
677 | static const struct clk_ops vc5_clk_out_ops = { | |
678 | .prepare = vc5_clk_out_prepare, | |
679 | .unprepare = vc5_clk_out_unprepare, | |
680 | .set_parent = vc5_clk_out_set_parent, | |
681 | .get_parent = vc5_clk_out_get_parent, | |
682 | }; | |
683 | ||
684 | static struct clk_hw *vc5_of_clk_get(struct of_phandle_args *clkspec, | |
685 | void *data) | |
686 | { | |
687 | struct vc5_driver_data *vc5 = data; | |
688 | unsigned int idx = clkspec->args[0]; | |
689 | ||
9adddb01 | 690 | if (idx >= vc5->chip_info->clk_out_cnt) |
3e1aec4e MV |
691 | return ERR_PTR(-EINVAL); |
692 | ||
693 | return &vc5->clk_out[idx].hw; | |
694 | } | |
695 | ||
696 | static int vc5_map_index_to_output(const enum vc5_model model, | |
697 | const unsigned int n) | |
698 | { | |
699 | switch (model) { | |
700 | case IDT_VC5_5P49V5933: | |
701 | return (n == 0) ? 0 : 3; | |
702 | case IDT_VC5_5P49V5923: | |
b1911555 | 703 | case IDT_VC5_5P49V5925: |
1193e14f | 704 | case IDT_VC5_5P49V5935: |
dbf6b16f | 705 | case IDT_VC6_5P49V6901: |
2bda748e | 706 | case IDT_VC6_5P49V6965: |
3e1aec4e MV |
707 | default: |
708 | return n; | |
709 | } | |
710 | } | |
711 | ||
260249f9 | 712 | static int vc5_update_mode(struct device_node *np_output, |
3bca66b0 | 713 | struct vc5_out_data *clk_out) |
260249f9 AF |
714 | { |
715 | u32 value; | |
716 | ||
717 | if (!of_property_read_u32(np_output, "idt,mode", &value)) { | |
718 | clk_out->clk_output_cfg0_mask |= VC5_CLK_OUTPUT_CFG0_CFG_MASK; | |
719 | switch (value) { | |
720 | case VC5_CLK_OUTPUT_CFG0_CFG_LVPECL: | |
721 | case VC5_CLK_OUTPUT_CFG0_CFG_CMOS: | |
722 | case VC5_CLK_OUTPUT_CFG0_CFG_HCSL33: | |
723 | case VC5_CLK_OUTPUT_CFG0_CFG_LVDS: | |
724 | case VC5_CLK_OUTPUT_CFG0_CFG_CMOS2: | |
725 | case VC5_CLK_OUTPUT_CFG0_CFG_CMOSD: | |
726 | case VC5_CLK_OUTPUT_CFG0_CFG_HCSL25: | |
727 | clk_out->clk_output_cfg0 |= | |
728 | value << VC5_CLK_OUTPUT_CFG0_CFG_SHIFT; | |
729 | break; | |
730 | default: | |
731 | return -EINVAL; | |
732 | } | |
733 | } | |
734 | return 0; | |
735 | } | |
736 | ||
737 | static int vc5_update_power(struct device_node *np_output, | |
3bca66b0 | 738 | struct vc5_out_data *clk_out) |
260249f9 AF |
739 | { |
740 | u32 value; | |
741 | ||
4b003f5f GU |
742 | if (!of_property_read_u32(np_output, "idt,voltage-microvolt", |
743 | &value)) { | |
260249f9 AF |
744 | clk_out->clk_output_cfg0_mask |= VC5_CLK_OUTPUT_CFG0_PWR_MASK; |
745 | switch (value) { | |
746 | case 1800000: | |
747 | clk_out->clk_output_cfg0 |= VC5_CLK_OUTPUT_CFG0_PWR_18; | |
748 | break; | |
749 | case 2500000: | |
750 | clk_out->clk_output_cfg0 |= VC5_CLK_OUTPUT_CFG0_PWR_25; | |
751 | break; | |
752 | case 3300000: | |
753 | clk_out->clk_output_cfg0 |= VC5_CLK_OUTPUT_CFG0_PWR_33; | |
754 | break; | |
755 | default: | |
756 | return -EINVAL; | |
757 | } | |
758 | } | |
759 | return 0; | |
760 | } | |
761 | ||
762 | static int vc5_update_slew(struct device_node *np_output, | |
3bca66b0 | 763 | struct vc5_out_data *clk_out) |
260249f9 AF |
764 | { |
765 | u32 value; | |
766 | ||
767 | if (!of_property_read_u32(np_output, "idt,slew-percent", &value)) { | |
768 | clk_out->clk_output_cfg0_mask |= VC5_CLK_OUTPUT_CFG0_SLEW_MASK; | |
769 | switch (value) { | |
770 | case 80: | |
771 | clk_out->clk_output_cfg0 |= VC5_CLK_OUTPUT_CFG0_SLEW_80; | |
772 | break; | |
773 | case 85: | |
774 | clk_out->clk_output_cfg0 |= VC5_CLK_OUTPUT_CFG0_SLEW_85; | |
775 | break; | |
776 | case 90: | |
777 | clk_out->clk_output_cfg0 |= VC5_CLK_OUTPUT_CFG0_SLEW_90; | |
778 | break; | |
779 | case 100: | |
780 | clk_out->clk_output_cfg0 |= | |
781 | VC5_CLK_OUTPUT_CFG0_SLEW_100; | |
782 | break; | |
783 | default: | |
784 | return -EINVAL; | |
785 | } | |
786 | } | |
787 | return 0; | |
788 | } | |
789 | ||
790 | static int vc5_get_output_config(struct i2c_client *client, | |
3bca66b0 | 791 | struct vc5_out_data *clk_out) |
260249f9 AF |
792 | { |
793 | struct device_node *np_output; | |
794 | char *child_name; | |
795 | int ret = 0; | |
796 | ||
797 | child_name = kasprintf(GFP_KERNEL, "OUT%d", clk_out->num + 1); | |
faf29338 AF |
798 | if (!child_name) |
799 | return -ENOMEM; | |
800 | ||
260249f9 AF |
801 | np_output = of_get_child_by_name(client->dev.of_node, child_name); |
802 | kfree(child_name); | |
803 | if (!np_output) | |
faf29338 | 804 | return 0; |
260249f9 AF |
805 | |
806 | ret = vc5_update_mode(np_output, clk_out); | |
807 | if (ret) | |
808 | goto output_error; | |
809 | ||
810 | ret = vc5_update_power(np_output, clk_out); | |
811 | if (ret) | |
812 | goto output_error; | |
813 | ||
814 | ret = vc5_update_slew(np_output, clk_out); | |
815 | ||
816 | output_error: | |
817 | if (ret) { | |
818 | dev_err(&client->dev, | |
819 | "Invalid clock output configuration OUT%d\n", | |
820 | clk_out->num + 1); | |
821 | } | |
822 | ||
823 | of_node_put(np_output); | |
824 | ||
260249f9 AF |
825 | return ret; |
826 | } | |
827 | ||
3e1aec4e MV |
828 | static const struct of_device_id clk_vc5_of_match[]; |
829 | ||
f491276a | 830 | static int vc5_probe(struct i2c_client *client, const struct i2c_device_id *id) |
3e1aec4e | 831 | { |
3e1aec4e MV |
832 | struct vc5_driver_data *vc5; |
833 | struct clk_init_data init; | |
834 | const char *parent_names[2]; | |
9adddb01 | 835 | unsigned int n, idx = 0; |
3e1aec4e MV |
836 | int ret; |
837 | ||
838 | vc5 = devm_kzalloc(&client->dev, sizeof(*vc5), GFP_KERNEL); | |
faf29338 | 839 | if (!vc5) |
3e1aec4e MV |
840 | return -ENOMEM; |
841 | ||
842 | i2c_set_clientdata(client, vc5); | |
843 | vc5->client = client; | |
9adddb01 | 844 | vc5->chip_info = of_device_get_match_data(&client->dev); |
3e1aec4e MV |
845 | |
846 | vc5->pin_xin = devm_clk_get(&client->dev, "xin"); | |
847 | if (PTR_ERR(vc5->pin_xin) == -EPROBE_DEFER) | |
848 | return -EPROBE_DEFER; | |
849 | ||
850 | vc5->pin_clkin = devm_clk_get(&client->dev, "clkin"); | |
851 | if (PTR_ERR(vc5->pin_clkin) == -EPROBE_DEFER) | |
852 | return -EPROBE_DEFER; | |
853 | ||
854 | vc5->regmap = devm_regmap_init_i2c(client, &vc5_regmap_config); | |
855 | if (IS_ERR(vc5->regmap)) { | |
856 | dev_err(&client->dev, "failed to allocate register map\n"); | |
857 | return PTR_ERR(vc5->regmap); | |
858 | } | |
859 | ||
860 | /* Register clock input mux */ | |
861 | memset(&init, 0, sizeof(init)); | |
862 | ||
863 | if (!IS_ERR(vc5->pin_xin)) { | |
864 | vc5->clk_mux_ins |= VC5_MUX_IN_XIN; | |
865 | parent_names[init.num_parents++] = __clk_get_name(vc5->pin_xin); | |
9adddb01 | 866 | } else if (vc5->chip_info->flags & VC5_HAS_INTERNAL_XTAL) { |
3e1aec4e MV |
867 | vc5->pin_xin = clk_register_fixed_rate(&client->dev, |
868 | "internal-xtal", NULL, | |
869 | 0, 25000000); | |
870 | if (IS_ERR(vc5->pin_xin)) | |
871 | return PTR_ERR(vc5->pin_xin); | |
872 | vc5->clk_mux_ins |= VC5_MUX_IN_XIN; | |
873 | parent_names[init.num_parents++] = __clk_get_name(vc5->pin_xin); | |
874 | } | |
875 | ||
876 | if (!IS_ERR(vc5->pin_clkin)) { | |
877 | vc5->clk_mux_ins |= VC5_MUX_IN_CLKIN; | |
878 | parent_names[init.num_parents++] = | |
f491276a | 879 | __clk_get_name(vc5->pin_clkin); |
3e1aec4e MV |
880 | } |
881 | ||
882 | if (!init.num_parents) { | |
883 | dev_err(&client->dev, "no input clock specified!\n"); | |
884 | return -EINVAL; | |
885 | } | |
886 | ||
f491276a | 887 | init.name = kasprintf(GFP_KERNEL, "%pOFn.mux", client->dev.of_node); |
3e1aec4e MV |
888 | init.ops = &vc5_mux_ops; |
889 | init.flags = 0; | |
890 | init.parent_names = parent_names; | |
891 | vc5->clk_mux.init = &init; | |
892 | ret = devm_clk_hw_register(&client->dev, &vc5->clk_mux); | |
8200597f CIK |
893 | if (ret) |
894 | goto err_clk_register; | |
f491276a | 895 | kfree(init.name); /* clock framework made a copy of the name */ |
3e1aec4e | 896 | |
8c1ebe97 MV |
897 | if (vc5->chip_info->flags & VC5_HAS_PFD_FREQ_DBL) { |
898 | /* Register frequency doubler */ | |
899 | memset(&init, 0, sizeof(init)); | |
f491276a AF |
900 | init.name = kasprintf(GFP_KERNEL, "%pOFn.dbl", |
901 | client->dev.of_node); | |
8c1ebe97 MV |
902 | init.ops = &vc5_dbl_ops; |
903 | init.flags = CLK_SET_RATE_PARENT; | |
f491276a AF |
904 | init.parent_names = parent_names; |
905 | parent_names[0] = clk_hw_get_name(&vc5->clk_mux); | |
8c1ebe97 MV |
906 | init.num_parents = 1; |
907 | vc5->clk_mul.init = &init; | |
908 | ret = devm_clk_hw_register(&client->dev, &vc5->clk_mul); | |
8200597f CIK |
909 | if (ret) |
910 | goto err_clk_register; | |
f491276a | 911 | kfree(init.name); /* clock framework made a copy of the name */ |
8c1ebe97 MV |
912 | } |
913 | ||
55997db5 MV |
914 | /* Register PFD */ |
915 | memset(&init, 0, sizeof(init)); | |
f491276a | 916 | init.name = kasprintf(GFP_KERNEL, "%pOFn.pfd", client->dev.of_node); |
55997db5 MV |
917 | init.ops = &vc5_pfd_ops; |
918 | init.flags = CLK_SET_RATE_PARENT; | |
f491276a | 919 | init.parent_names = parent_names; |
8c1ebe97 | 920 | if (vc5->chip_info->flags & VC5_HAS_PFD_FREQ_DBL) |
f491276a | 921 | parent_names[0] = clk_hw_get_name(&vc5->clk_mul); |
8c1ebe97 | 922 | else |
f491276a | 923 | parent_names[0] = clk_hw_get_name(&vc5->clk_mux); |
55997db5 MV |
924 | init.num_parents = 1; |
925 | vc5->clk_pfd.init = &init; | |
926 | ret = devm_clk_hw_register(&client->dev, &vc5->clk_pfd); | |
8200597f CIK |
927 | if (ret) |
928 | goto err_clk_register; | |
f491276a | 929 | kfree(init.name); /* clock framework made a copy of the name */ |
55997db5 | 930 | |
3e1aec4e MV |
931 | /* Register PLL */ |
932 | memset(&init, 0, sizeof(init)); | |
f491276a | 933 | init.name = kasprintf(GFP_KERNEL, "%pOFn.pll", client->dev.of_node); |
3e1aec4e MV |
934 | init.ops = &vc5_pll_ops; |
935 | init.flags = CLK_SET_RATE_PARENT; | |
f491276a AF |
936 | init.parent_names = parent_names; |
937 | parent_names[0] = clk_hw_get_name(&vc5->clk_pfd); | |
3e1aec4e MV |
938 | init.num_parents = 1; |
939 | vc5->clk_pll.num = 0; | |
940 | vc5->clk_pll.vc5 = vc5; | |
941 | vc5->clk_pll.hw.init = &init; | |
942 | ret = devm_clk_hw_register(&client->dev, &vc5->clk_pll.hw); | |
8200597f CIK |
943 | if (ret) |
944 | goto err_clk_register; | |
f491276a | 945 | kfree(init.name); /* clock framework made a copy of the name */ |
3e1aec4e MV |
946 | |
947 | /* Register FODs */ | |
9adddb01 AF |
948 | for (n = 0; n < vc5->chip_info->clk_fod_cnt; n++) { |
949 | idx = vc5_map_index_to_output(vc5->chip_info->model, n); | |
3e1aec4e | 950 | memset(&init, 0, sizeof(init)); |
f491276a AF |
951 | init.name = kasprintf(GFP_KERNEL, "%pOFn.fod%d", |
952 | client->dev.of_node, idx); | |
3e1aec4e MV |
953 | init.ops = &vc5_fod_ops; |
954 | init.flags = CLK_SET_RATE_PARENT; | |
f491276a AF |
955 | init.parent_names = parent_names; |
956 | parent_names[0] = clk_hw_get_name(&vc5->clk_pll.hw); | |
3e1aec4e MV |
957 | init.num_parents = 1; |
958 | vc5->clk_fod[n].num = idx; | |
959 | vc5->clk_fod[n].vc5 = vc5; | |
960 | vc5->clk_fod[n].hw.init = &init; | |
961 | ret = devm_clk_hw_register(&client->dev, &vc5->clk_fod[n].hw); | |
8200597f CIK |
962 | if (ret) |
963 | goto err_clk_register; | |
f491276a | 964 | kfree(init.name); /* clock framework made a copy of the name */ |
3e1aec4e MV |
965 | } |
966 | ||
967 | /* Register MUX-connected OUT0_I2C_SELB output */ | |
968 | memset(&init, 0, sizeof(init)); | |
f491276a AF |
969 | init.name = kasprintf(GFP_KERNEL, "%pOFn.out0_sel_i2cb", |
970 | client->dev.of_node); | |
3e1aec4e MV |
971 | init.ops = &vc5_clk_out_ops; |
972 | init.flags = CLK_SET_RATE_PARENT; | |
f491276a AF |
973 | init.parent_names = parent_names; |
974 | parent_names[0] = clk_hw_get_name(&vc5->clk_mux); | |
3e1aec4e MV |
975 | init.num_parents = 1; |
976 | vc5->clk_out[0].num = idx; | |
977 | vc5->clk_out[0].vc5 = vc5; | |
978 | vc5->clk_out[0].hw.init = &init; | |
979 | ret = devm_clk_hw_register(&client->dev, &vc5->clk_out[0].hw); | |
8200597f CIK |
980 | if (ret) |
981 | goto err_clk_register; | |
982 | kfree(init.name); /* clock framework made a copy of the name */ | |
3e1aec4e MV |
983 | |
984 | /* Register FOD-connected OUTx outputs */ | |
9adddb01 AF |
985 | for (n = 1; n < vc5->chip_info->clk_out_cnt; n++) { |
986 | idx = vc5_map_index_to_output(vc5->chip_info->model, n - 1); | |
f491276a | 987 | parent_names[0] = clk_hw_get_name(&vc5->clk_fod[idx].hw); |
3e1aec4e | 988 | if (n == 1) |
f491276a | 989 | parent_names[1] = clk_hw_get_name(&vc5->clk_mux); |
3e1aec4e | 990 | else |
f491276a AF |
991 | parent_names[1] = |
992 | clk_hw_get_name(&vc5->clk_out[n - 1].hw); | |
3e1aec4e MV |
993 | |
994 | memset(&init, 0, sizeof(init)); | |
f491276a AF |
995 | init.name = kasprintf(GFP_KERNEL, "%pOFn.out%d", |
996 | client->dev.of_node, idx + 1); | |
3e1aec4e MV |
997 | init.ops = &vc5_clk_out_ops; |
998 | init.flags = CLK_SET_RATE_PARENT; | |
999 | init.parent_names = parent_names; | |
1000 | init.num_parents = 2; | |
1001 | vc5->clk_out[n].num = idx; | |
1002 | vc5->clk_out[n].vc5 = vc5; | |
1003 | vc5->clk_out[n].hw.init = &init; | |
f491276a | 1004 | ret = devm_clk_hw_register(&client->dev, &vc5->clk_out[n].hw); |
8200597f CIK |
1005 | if (ret) |
1006 | goto err_clk_register; | |
f491276a | 1007 | kfree(init.name); /* clock framework made a copy of the name */ |
260249f9 AF |
1008 | |
1009 | /* Fetch Clock Output configuration from DT (if specified) */ | |
1010 | ret = vc5_get_output_config(client, &vc5->clk_out[n]); | |
1011 | if (ret) | |
1012 | goto err_clk; | |
3e1aec4e MV |
1013 | } |
1014 | ||
1015 | ret = of_clk_add_hw_provider(client->dev.of_node, vc5_of_clk_get, vc5); | |
1016 | if (ret) { | |
1017 | dev_err(&client->dev, "unable to add clk provider\n"); | |
1018 | goto err_clk; | |
1019 | } | |
1020 | ||
1021 | return 0; | |
1022 | ||
8200597f CIK |
1023 | err_clk_register: |
1024 | dev_err(&client->dev, "unable to register %s\n", init.name); | |
1025 | kfree(init.name); /* clock framework made a copy of the name */ | |
3e1aec4e | 1026 | err_clk: |
9adddb01 | 1027 | if (vc5->chip_info->flags & VC5_HAS_INTERNAL_XTAL) |
3e1aec4e MV |
1028 | clk_unregister_fixed_rate(vc5->pin_xin); |
1029 | return ret; | |
1030 | } | |
1031 | ||
1032 | static int vc5_remove(struct i2c_client *client) | |
1033 | { | |
1034 | struct vc5_driver_data *vc5 = i2c_get_clientdata(client); | |
1035 | ||
1036 | of_clk_del_provider(client->dev.of_node); | |
1037 | ||
9adddb01 | 1038 | if (vc5->chip_info->flags & VC5_HAS_INTERNAL_XTAL) |
3e1aec4e MV |
1039 | clk_unregister_fixed_rate(vc5->pin_xin); |
1040 | ||
1041 | return 0; | |
1042 | } | |
1043 | ||
8cbdc1f0 MV |
1044 | static int __maybe_unused vc5_suspend(struct device *dev) |
1045 | { | |
1046 | struct vc5_driver_data *vc5 = dev_get_drvdata(dev); | |
1047 | ||
1048 | regcache_cache_only(vc5->regmap, true); | |
1049 | regcache_mark_dirty(vc5->regmap); | |
1050 | ||
1051 | return 0; | |
1052 | } | |
1053 | ||
1054 | static int __maybe_unused vc5_resume(struct device *dev) | |
1055 | { | |
1056 | struct vc5_driver_data *vc5 = dev_get_drvdata(dev); | |
1057 | int ret; | |
1058 | ||
1059 | regcache_cache_only(vc5->regmap, false); | |
1060 | ret = regcache_sync(vc5->regmap); | |
1061 | if (ret) | |
1062 | dev_err(dev, "Failed to restore register map: %d\n", ret); | |
1063 | return ret; | |
1064 | } | |
1065 | ||
9adddb01 AF |
1066 | static const struct vc5_chip_info idt_5p49v5923_info = { |
1067 | .model = IDT_VC5_5P49V5923, | |
1068 | .clk_fod_cnt = 2, | |
1069 | .clk_out_cnt = 3, | |
1070 | .flags = 0, | |
1071 | }; | |
1072 | ||
b1911555 VB |
1073 | static const struct vc5_chip_info idt_5p49v5925_info = { |
1074 | .model = IDT_VC5_5P49V5925, | |
1075 | .clk_fod_cnt = 4, | |
1076 | .clk_out_cnt = 5, | |
1077 | .flags = 0, | |
1078 | }; | |
1079 | ||
9adddb01 AF |
1080 | static const struct vc5_chip_info idt_5p49v5933_info = { |
1081 | .model = IDT_VC5_5P49V5933, | |
1082 | .clk_fod_cnt = 2, | |
1083 | .clk_out_cnt = 3, | |
1084 | .flags = VC5_HAS_INTERNAL_XTAL, | |
1085 | }; | |
1086 | ||
1193e14f AF |
1087 | static const struct vc5_chip_info idt_5p49v5935_info = { |
1088 | .model = IDT_VC5_5P49V5935, | |
1089 | .clk_fod_cnt = 4, | |
1090 | .clk_out_cnt = 5, | |
1091 | .flags = VC5_HAS_INTERNAL_XTAL, | |
1092 | }; | |
1093 | ||
dbf6b16f MV |
1094 | static const struct vc5_chip_info idt_5p49v6901_info = { |
1095 | .model = IDT_VC6_5P49V6901, | |
1096 | .clk_fod_cnt = 4, | |
1097 | .clk_out_cnt = 5, | |
1098 | .flags = VC5_HAS_PFD_FREQ_DBL, | |
1099 | }; | |
1100 | ||
2bda748e AF |
1101 | static const struct vc5_chip_info idt_5p49v6965_info = { |
1102 | .model = IDT_VC6_5P49V6965, | |
1103 | .clk_fod_cnt = 4, | |
1104 | .clk_out_cnt = 5, | |
1105 | .flags = 0, | |
1106 | }; | |
1107 | ||
3e1aec4e MV |
1108 | static const struct i2c_device_id vc5_id[] = { |
1109 | { "5p49v5923", .driver_data = IDT_VC5_5P49V5923 }, | |
b1911555 | 1110 | { "5p49v5925", .driver_data = IDT_VC5_5P49V5925 }, |
3e1aec4e | 1111 | { "5p49v5933", .driver_data = IDT_VC5_5P49V5933 }, |
1193e14f | 1112 | { "5p49v5935", .driver_data = IDT_VC5_5P49V5935 }, |
dbf6b16f | 1113 | { "5p49v6901", .driver_data = IDT_VC6_5P49V6901 }, |
2bda748e | 1114 | { "5p49v6965", .driver_data = IDT_VC6_5P49V6965 }, |
3e1aec4e MV |
1115 | { } |
1116 | }; | |
1117 | MODULE_DEVICE_TABLE(i2c, vc5_id); | |
1118 | ||
1119 | static const struct of_device_id clk_vc5_of_match[] = { | |
9adddb01 | 1120 | { .compatible = "idt,5p49v5923", .data = &idt_5p49v5923_info }, |
b1911555 | 1121 | { .compatible = "idt,5p49v5925", .data = &idt_5p49v5925_info }, |
9adddb01 | 1122 | { .compatible = "idt,5p49v5933", .data = &idt_5p49v5933_info }, |
1193e14f | 1123 | { .compatible = "idt,5p49v5935", .data = &idt_5p49v5935_info }, |
dbf6b16f | 1124 | { .compatible = "idt,5p49v6901", .data = &idt_5p49v6901_info }, |
2bda748e | 1125 | { .compatible = "idt,5p49v6965", .data = &idt_5p49v6965_info }, |
3e1aec4e MV |
1126 | { }, |
1127 | }; | |
1128 | MODULE_DEVICE_TABLE(of, clk_vc5_of_match); | |
1129 | ||
8cbdc1f0 MV |
1130 | static SIMPLE_DEV_PM_OPS(vc5_pm_ops, vc5_suspend, vc5_resume); |
1131 | ||
3e1aec4e MV |
1132 | static struct i2c_driver vc5_driver = { |
1133 | .driver = { | |
1134 | .name = "vc5", | |
8cbdc1f0 | 1135 | .pm = &vc5_pm_ops, |
3e1aec4e MV |
1136 | .of_match_table = clk_vc5_of_match, |
1137 | }, | |
1138 | .probe = vc5_probe, | |
1139 | .remove = vc5_remove, | |
1140 | .id_table = vc5_id, | |
1141 | }; | |
1142 | module_i2c_driver(vc5_driver); | |
1143 | ||
1144 | MODULE_AUTHOR("Marek Vasut <marek.vasut@gmail.com>"); | |
1145 | MODULE_DESCRIPTION("IDT VersaClock 5 driver"); | |
1146 | MODULE_LICENSE("GPL"); |