blob: 01877f64eff6a764ec2fcc2e5e3ff1f88d8f3514 [file] [log] [blame]
Max Filippov0c7665c2015-01-12 10:20:46 +03001/*
2 * TI CDCE706 programmable 3-PLL clock synthesizer driver
3 *
4 * Copyright (c) 2014 Cadence Design Systems Inc.
5 *
6 * Reference: http://www.ti.com/lit/ds/symlink/cdce706.pdf
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 */
12
Stephen Boydfc1699c2015-06-19 15:00:46 -070013#include <linux/clk.h>
Max Filippov0c7665c2015-01-12 10:20:46 +030014#include <linux/clk-provider.h>
15#include <linux/delay.h>
16#include <linux/i2c.h>
17#include <linux/interrupt.h>
18#include <linux/mod_devicetable.h>
19#include <linux/module.h>
20#include <linux/of.h>
21#include <linux/rational.h>
22#include <linux/regmap.h>
23#include <linux/slab.h>
24
25#define CDCE706_CLKIN_CLOCK 10
26#define CDCE706_CLKIN_SOURCE 11
27#define CDCE706_PLL_M_LOW(pll) (1 + 3 * (pll))
28#define CDCE706_PLL_N_LOW(pll) (2 + 3 * (pll))
29#define CDCE706_PLL_HI(pll) (3 + 3 * (pll))
30#define CDCE706_PLL_MUX 3
31#define CDCE706_PLL_FVCO 6
32#define CDCE706_DIVIDER(div) (13 + (div))
33#define CDCE706_CLKOUT(out) (19 + (out))
34
35#define CDCE706_CLKIN_CLOCK_MASK 0x10
36#define CDCE706_CLKIN_SOURCE_SHIFT 6
37#define CDCE706_CLKIN_SOURCE_MASK 0xc0
38#define CDCE706_CLKIN_SOURCE_LVCMOS 0x40
39
40#define CDCE706_PLL_MUX_MASK(pll) (0x80 >> (pll))
41#define CDCE706_PLL_LOW_M_MASK 0xff
42#define CDCE706_PLL_LOW_N_MASK 0xff
43#define CDCE706_PLL_HI_M_MASK 0x1
44#define CDCE706_PLL_HI_N_MASK 0x1e
45#define CDCE706_PLL_HI_N_SHIFT 1
46#define CDCE706_PLL_M_MAX 0x1ff
47#define CDCE706_PLL_N_MAX 0xfff
48#define CDCE706_PLL_FVCO_MASK(pll) (0x80 >> (pll))
49#define CDCE706_PLL_FREQ_MIN 80000000
50#define CDCE706_PLL_FREQ_MAX 300000000
51#define CDCE706_PLL_FREQ_HI 180000000
52
53#define CDCE706_DIVIDER_PLL(div) (9 + (div) - ((div) > 2) - ((div) > 4))
54#define CDCE706_DIVIDER_PLL_SHIFT(div) ((div) < 2 ? 5 : 3 * ((div) & 1))
55#define CDCE706_DIVIDER_PLL_MASK(div) (0x7 << CDCE706_DIVIDER_PLL_SHIFT(div))
56#define CDCE706_DIVIDER_DIVIDER_MASK 0x7f
57#define CDCE706_DIVIDER_DIVIDER_MAX 0x7f
58
59#define CDCE706_CLKOUT_DIVIDER_MASK 0x7
60#define CDCE706_CLKOUT_ENABLE_MASK 0x8
61
Krzysztof Kozlowski0d7ef4a2015-03-20 12:34:12 +010062static const struct regmap_config cdce706_regmap_config = {
Max Filippov0c7665c2015-01-12 10:20:46 +030063 .reg_bits = 8,
64 .val_bits = 8,
65 .val_format_endian = REGMAP_ENDIAN_NATIVE,
66};
67
68#define to_hw_data(phw) (container_of((phw), struct cdce706_hw_data, hw))
69
70struct cdce706_hw_data {
71 struct cdce706_dev_data *dev_data;
72 unsigned idx;
73 unsigned parent;
74 struct clk *clk;
75 struct clk_hw hw;
76 unsigned div;
77 unsigned mul;
78 unsigned mux;
79};
80
81struct cdce706_dev_data {
82 struct i2c_client *client;
83 struct regmap *regmap;
84 struct clk_onecell_data onecell;
85 struct clk *clks[6];
86 struct clk *clkin_clk[2];
87 const char *clkin_name[2];
88 struct cdce706_hw_data clkin[1];
89 struct cdce706_hw_data pll[3];
90 struct cdce706_hw_data divider[6];
91 struct cdce706_hw_data clkout[6];
92};
93
94static const char * const cdce706_source_name[] = {
95 "clk_in0", "clk_in1",
96};
97
Krzysztof Kozlowskif3db6f12015-04-28 13:46:20 +090098static const char * const cdce706_clkin_name[] = {
Max Filippov0c7665c2015-01-12 10:20:46 +030099 "clk_in",
100};
101
102static const char * const cdce706_pll_name[] = {
103 "pll1", "pll2", "pll3",
104};
105
Krzysztof Kozlowskif3db6f12015-04-28 13:46:20 +0900106static const char * const cdce706_divider_parent_name[] = {
Max Filippov0c7665c2015-01-12 10:20:46 +0300107 "clk_in", "pll1", "pll2", "pll2", "pll3",
108};
109
110static const char *cdce706_divider_name[] = {
111 "p0", "p1", "p2", "p3", "p4", "p5",
112};
113
114static const char * const cdce706_clkout_name[] = {
115 "clk_out0", "clk_out1", "clk_out2", "clk_out3", "clk_out4", "clk_out5",
116};
117
118static int cdce706_reg_read(struct cdce706_dev_data *dev_data, unsigned reg,
119 unsigned *val)
120{
121 int rc = regmap_read(dev_data->regmap, reg | 0x80, val);
122
123 if (rc < 0)
124 dev_err(&dev_data->client->dev, "error reading reg %u", reg);
125 return rc;
126}
127
128static int cdce706_reg_write(struct cdce706_dev_data *dev_data, unsigned reg,
129 unsigned val)
130{
131 int rc = regmap_write(dev_data->regmap, reg | 0x80, val);
132
133 if (rc < 0)
134 dev_err(&dev_data->client->dev, "error writing reg %u", reg);
135 return rc;
136}
137
138static int cdce706_reg_update(struct cdce706_dev_data *dev_data, unsigned reg,
139 unsigned mask, unsigned val)
140{
141 int rc = regmap_update_bits(dev_data->regmap, reg | 0x80, mask, val);
142
143 if (rc < 0)
144 dev_err(&dev_data->client->dev, "error updating reg %u", reg);
145 return rc;
146}
147
148static int cdce706_clkin_set_parent(struct clk_hw *hw, u8 index)
149{
150 struct cdce706_hw_data *hwd = to_hw_data(hw);
151
152 hwd->parent = index;
153 return 0;
154}
155
156static u8 cdce706_clkin_get_parent(struct clk_hw *hw)
157{
158 struct cdce706_hw_data *hwd = to_hw_data(hw);
159
160 return hwd->parent;
161}
162
163static const struct clk_ops cdce706_clkin_ops = {
164 .set_parent = cdce706_clkin_set_parent,
165 .get_parent = cdce706_clkin_get_parent,
166};
167
168static unsigned long cdce706_pll_recalc_rate(struct clk_hw *hw,
169 unsigned long parent_rate)
170{
171 struct cdce706_hw_data *hwd = to_hw_data(hw);
172
173 dev_dbg(&hwd->dev_data->client->dev,
174 "%s, pll: %d, mux: %d, mul: %u, div: %u\n",
175 __func__, hwd->idx, hwd->mux, hwd->mul, hwd->div);
176
177 if (!hwd->mux) {
178 if (hwd->div && hwd->mul) {
179 u64 res = (u64)parent_rate * hwd->mul;
180
181 do_div(res, hwd->div);
182 return res;
183 }
184 } else {
185 if (hwd->div)
186 return parent_rate / hwd->div;
187 }
188 return 0;
189}
190
191static long cdce706_pll_round_rate(struct clk_hw *hw, unsigned long rate,
192 unsigned long *parent_rate)
193{
194 struct cdce706_hw_data *hwd = to_hw_data(hw);
195 unsigned long mul, div;
196 u64 res;
197
198 dev_dbg(&hwd->dev_data->client->dev,
199 "%s, rate: %lu, parent_rate: %lu\n",
200 __func__, rate, *parent_rate);
201
202 rational_best_approximation(rate, *parent_rate,
203 CDCE706_PLL_N_MAX, CDCE706_PLL_M_MAX,
204 &mul, &div);
205 hwd->mul = mul;
206 hwd->div = div;
207
208 dev_dbg(&hwd->dev_data->client->dev,
209 "%s, pll: %d, mul: %lu, div: %lu\n",
210 __func__, hwd->idx, mul, div);
211
212 res = (u64)*parent_rate * hwd->mul;
213 do_div(res, hwd->div);
214 return res;
215}
216
217static int cdce706_pll_set_rate(struct clk_hw *hw, unsigned long rate,
218 unsigned long parent_rate)
219{
220 struct cdce706_hw_data *hwd = to_hw_data(hw);
221 unsigned long mul = hwd->mul, div = hwd->div;
222 int err;
223
224 dev_dbg(&hwd->dev_data->client->dev,
225 "%s, pll: %d, mul: %lu, div: %lu\n",
226 __func__, hwd->idx, mul, div);
227
228 err = cdce706_reg_update(hwd->dev_data,
229 CDCE706_PLL_HI(hwd->idx),
230 CDCE706_PLL_HI_M_MASK | CDCE706_PLL_HI_N_MASK,
231 ((div >> 8) & CDCE706_PLL_HI_M_MASK) |
232 ((mul >> (8 - CDCE706_PLL_HI_N_SHIFT)) &
233 CDCE706_PLL_HI_N_MASK));
234 if (err < 0)
235 return err;
236
237 err = cdce706_reg_write(hwd->dev_data,
238 CDCE706_PLL_M_LOW(hwd->idx),
239 div & CDCE706_PLL_LOW_M_MASK);
240 if (err < 0)
241 return err;
242
243 err = cdce706_reg_write(hwd->dev_data,
244 CDCE706_PLL_N_LOW(hwd->idx),
245 mul & CDCE706_PLL_LOW_N_MASK);
246 if (err < 0)
247 return err;
248
249 err = cdce706_reg_update(hwd->dev_data,
250 CDCE706_PLL_FVCO,
251 CDCE706_PLL_FVCO_MASK(hwd->idx),
252 rate > CDCE706_PLL_FREQ_HI ?
253 CDCE706_PLL_FVCO_MASK(hwd->idx) : 0);
254 return err;
255}
256
257static const struct clk_ops cdce706_pll_ops = {
258 .recalc_rate = cdce706_pll_recalc_rate,
259 .round_rate = cdce706_pll_round_rate,
260 .set_rate = cdce706_pll_set_rate,
261};
262
263static int cdce706_divider_set_parent(struct clk_hw *hw, u8 index)
264{
265 struct cdce706_hw_data *hwd = to_hw_data(hw);
266
267 if (hwd->parent == index)
268 return 0;
269 hwd->parent = index;
270 return cdce706_reg_update(hwd->dev_data,
271 CDCE706_DIVIDER_PLL(hwd->idx),
272 CDCE706_DIVIDER_PLL_MASK(hwd->idx),
273 index << CDCE706_DIVIDER_PLL_SHIFT(hwd->idx));
274}
275
276static u8 cdce706_divider_get_parent(struct clk_hw *hw)
277{
278 struct cdce706_hw_data *hwd = to_hw_data(hw);
279
280 return hwd->parent;
281}
282
283static unsigned long cdce706_divider_recalc_rate(struct clk_hw *hw,
284 unsigned long parent_rate)
285{
286 struct cdce706_hw_data *hwd = to_hw_data(hw);
287
288 dev_dbg(&hwd->dev_data->client->dev,
289 "%s, divider: %d, div: %u\n",
290 __func__, hwd->idx, hwd->div);
291 if (hwd->div)
292 return parent_rate / hwd->div;
293 return 0;
294}
295
296static long cdce706_divider_round_rate(struct clk_hw *hw, unsigned long rate,
297 unsigned long *parent_rate)
298{
299 struct cdce706_hw_data *hwd = to_hw_data(hw);
300 struct cdce706_dev_data *cdce = hwd->dev_data;
301 unsigned long mul, div;
302
303 dev_dbg(&hwd->dev_data->client->dev,
304 "%s, rate: %lu, parent_rate: %lu\n",
305 __func__, rate, *parent_rate);
306
307 rational_best_approximation(rate, *parent_rate,
308 1, CDCE706_DIVIDER_DIVIDER_MAX,
309 &mul, &div);
310 if (!mul)
311 div = CDCE706_DIVIDER_DIVIDER_MAX;
312
Stephen Boyd98d8a602015-06-29 16:56:30 -0700313 if (clk_hw_get_flags(hw) & CLK_SET_RATE_PARENT) {
Max Filippov0c7665c2015-01-12 10:20:46 +0300314 unsigned long best_diff = rate;
315 unsigned long best_div = 0;
316 struct clk *gp_clk = cdce->clkin_clk[cdce->clkin[0].parent];
317 unsigned long gp_rate = gp_clk ? clk_get_rate(gp_clk) : 0;
318
319 for (div = CDCE706_PLL_FREQ_MIN / rate; best_diff &&
320 div <= CDCE706_PLL_FREQ_MAX / rate; ++div) {
321 unsigned long n, m;
322 unsigned long diff;
323 unsigned long div_rate;
324 u64 div_rate64;
325
326 if (rate * div < CDCE706_PLL_FREQ_MIN)
327 continue;
328
329 rational_best_approximation(rate * div, gp_rate,
330 CDCE706_PLL_N_MAX,
331 CDCE706_PLL_M_MAX,
332 &n, &m);
333 div_rate64 = (u64)gp_rate * n;
334 do_div(div_rate64, m);
335 do_div(div_rate64, div);
336 div_rate = div_rate64;
337 diff = max(div_rate, rate) - min(div_rate, rate);
338
339 if (diff < best_diff) {
340 best_diff = diff;
341 best_div = div;
342 dev_dbg(&hwd->dev_data->client->dev,
343 "%s, %lu * %lu / %lu / %lu = %lu\n",
344 __func__, gp_rate, n, m, div, div_rate);
345 }
346 }
347
348 div = best_div;
349
350 dev_dbg(&hwd->dev_data->client->dev,
351 "%s, altering parent rate: %lu -> %lu\n",
352 __func__, *parent_rate, rate * div);
353 *parent_rate = rate * div;
354 }
355 hwd->div = div;
356
357 dev_dbg(&hwd->dev_data->client->dev,
358 "%s, divider: %d, div: %lu\n",
359 __func__, hwd->idx, div);
360
361 return *parent_rate / div;
362}
363
364static int cdce706_divider_set_rate(struct clk_hw *hw, unsigned long rate,
365 unsigned long parent_rate)
366{
367 struct cdce706_hw_data *hwd = to_hw_data(hw);
368
369 dev_dbg(&hwd->dev_data->client->dev,
370 "%s, divider: %d, div: %u\n",
371 __func__, hwd->idx, hwd->div);
372
373 return cdce706_reg_update(hwd->dev_data,
374 CDCE706_DIVIDER(hwd->idx),
375 CDCE706_DIVIDER_DIVIDER_MASK,
376 hwd->div);
377}
378
379static const struct clk_ops cdce706_divider_ops = {
380 .set_parent = cdce706_divider_set_parent,
381 .get_parent = cdce706_divider_get_parent,
382 .recalc_rate = cdce706_divider_recalc_rate,
383 .round_rate = cdce706_divider_round_rate,
384 .set_rate = cdce706_divider_set_rate,
385};
386
387static int cdce706_clkout_prepare(struct clk_hw *hw)
388{
389 struct cdce706_hw_data *hwd = to_hw_data(hw);
390
391 return cdce706_reg_update(hwd->dev_data, CDCE706_CLKOUT(hwd->idx),
392 CDCE706_CLKOUT_ENABLE_MASK,
393 CDCE706_CLKOUT_ENABLE_MASK);
394}
395
396static void cdce706_clkout_unprepare(struct clk_hw *hw)
397{
398 struct cdce706_hw_data *hwd = to_hw_data(hw);
399
400 cdce706_reg_update(hwd->dev_data, CDCE706_CLKOUT(hwd->idx),
401 CDCE706_CLKOUT_ENABLE_MASK, 0);
402}
403
404static int cdce706_clkout_set_parent(struct clk_hw *hw, u8 index)
405{
406 struct cdce706_hw_data *hwd = to_hw_data(hw);
407
408 if (hwd->parent == index)
409 return 0;
410 hwd->parent = index;
411 return cdce706_reg_update(hwd->dev_data,
412 CDCE706_CLKOUT(hwd->idx),
413 CDCE706_CLKOUT_ENABLE_MASK, index);
414}
415
416static u8 cdce706_clkout_get_parent(struct clk_hw *hw)
417{
418 struct cdce706_hw_data *hwd = to_hw_data(hw);
419
420 return hwd->parent;
421}
422
423static unsigned long cdce706_clkout_recalc_rate(struct clk_hw *hw,
424 unsigned long parent_rate)
425{
426 return parent_rate;
427}
428
429static long cdce706_clkout_round_rate(struct clk_hw *hw, unsigned long rate,
430 unsigned long *parent_rate)
431{
432 *parent_rate = rate;
433 return rate;
434}
435
436static int cdce706_clkout_set_rate(struct clk_hw *hw, unsigned long rate,
437 unsigned long parent_rate)
438{
439 return 0;
440}
441
442static const struct clk_ops cdce706_clkout_ops = {
443 .prepare = cdce706_clkout_prepare,
444 .unprepare = cdce706_clkout_unprepare,
445 .set_parent = cdce706_clkout_set_parent,
446 .get_parent = cdce706_clkout_get_parent,
447 .recalc_rate = cdce706_clkout_recalc_rate,
448 .round_rate = cdce706_clkout_round_rate,
449 .set_rate = cdce706_clkout_set_rate,
450};
451
452static int cdce706_register_hw(struct cdce706_dev_data *cdce,
453 struct cdce706_hw_data *hw, unsigned num_hw,
454 const char * const *clk_names,
455 struct clk_init_data *init)
456{
457 unsigned i;
458
459 for (i = 0; i < num_hw; ++i, ++hw) {
460 init->name = clk_names[i];
461 hw->dev_data = cdce;
462 hw->idx = i;
463 hw->hw.init = init;
464 hw->clk = devm_clk_register(&cdce->client->dev,
465 &hw->hw);
466 if (IS_ERR(hw->clk)) {
467 dev_err(&cdce->client->dev, "Failed to register %s\n",
468 clk_names[i]);
469 return PTR_ERR(hw->clk);
470 }
471 }
472 return 0;
473}
474
475static int cdce706_register_clkin(struct cdce706_dev_data *cdce)
476{
477 struct clk_init_data init = {
478 .ops = &cdce706_clkin_ops,
479 .parent_names = cdce->clkin_name,
480 .num_parents = ARRAY_SIZE(cdce->clkin_name),
481 };
482 unsigned i;
483 int ret;
484 unsigned clock, source;
485
486 for (i = 0; i < ARRAY_SIZE(cdce->clkin_name); ++i) {
487 struct clk *parent = devm_clk_get(&cdce->client->dev,
488 cdce706_source_name[i]);
489
490 if (IS_ERR(parent)) {
491 cdce->clkin_name[i] = cdce706_source_name[i];
492 } else {
493 cdce->clkin_name[i] = __clk_get_name(parent);
494 cdce->clkin_clk[i] = parent;
495 }
496 }
497
498 ret = cdce706_reg_read(cdce, CDCE706_CLKIN_SOURCE, &source);
499 if (ret < 0)
500 return ret;
501 if ((source & CDCE706_CLKIN_SOURCE_MASK) ==
502 CDCE706_CLKIN_SOURCE_LVCMOS) {
503 ret = cdce706_reg_read(cdce, CDCE706_CLKIN_CLOCK, &clock);
504 if (ret < 0)
505 return ret;
506 cdce->clkin[0].parent = !!(clock & CDCE706_CLKIN_CLOCK_MASK);
507 }
508
509 ret = cdce706_register_hw(cdce, cdce->clkin,
510 ARRAY_SIZE(cdce->clkin),
511 cdce706_clkin_name, &init);
512 return ret;
513}
514
515static int cdce706_register_plls(struct cdce706_dev_data *cdce)
516{
517 struct clk_init_data init = {
518 .ops = &cdce706_pll_ops,
519 .parent_names = cdce706_clkin_name,
520 .num_parents = ARRAY_SIZE(cdce706_clkin_name),
521 };
522 unsigned i;
523 int ret;
524 unsigned mux;
525
526 ret = cdce706_reg_read(cdce, CDCE706_PLL_MUX, &mux);
527 if (ret < 0)
528 return ret;
529
530 for (i = 0; i < ARRAY_SIZE(cdce->pll); ++i) {
531 unsigned m, n, v;
532
533 ret = cdce706_reg_read(cdce, CDCE706_PLL_M_LOW(i), &m);
534 if (ret < 0)
535 return ret;
536 ret = cdce706_reg_read(cdce, CDCE706_PLL_N_LOW(i), &n);
537 if (ret < 0)
538 return ret;
539 ret = cdce706_reg_read(cdce, CDCE706_PLL_HI(i), &v);
540 if (ret < 0)
541 return ret;
542 cdce->pll[i].div = m | ((v & CDCE706_PLL_HI_M_MASK) << 8);
543 cdce->pll[i].mul = n | ((v & CDCE706_PLL_HI_N_MASK) <<
544 (8 - CDCE706_PLL_HI_N_SHIFT));
545 cdce->pll[i].mux = mux & CDCE706_PLL_MUX_MASK(i);
546 dev_dbg(&cdce->client->dev,
547 "%s: i: %u, div: %u, mul: %u, mux: %d\n", __func__, i,
548 cdce->pll[i].div, cdce->pll[i].mul, cdce->pll[i].mux);
549 }
550
551 ret = cdce706_register_hw(cdce, cdce->pll,
552 ARRAY_SIZE(cdce->pll),
553 cdce706_pll_name, &init);
554 return ret;
555}
556
557static int cdce706_register_dividers(struct cdce706_dev_data *cdce)
558{
559 struct clk_init_data init = {
560 .ops = &cdce706_divider_ops,
561 .parent_names = cdce706_divider_parent_name,
562 .num_parents = ARRAY_SIZE(cdce706_divider_parent_name),
563 .flags = CLK_SET_RATE_PARENT,
564 };
565 unsigned i;
566 int ret;
567
568 for (i = 0; i < ARRAY_SIZE(cdce->divider); ++i) {
569 unsigned val;
570
571 ret = cdce706_reg_read(cdce, CDCE706_DIVIDER_PLL(i), &val);
572 if (ret < 0)
573 return ret;
574 cdce->divider[i].parent =
575 (val & CDCE706_DIVIDER_PLL_MASK(i)) >>
576 CDCE706_DIVIDER_PLL_SHIFT(i);
577
578 ret = cdce706_reg_read(cdce, CDCE706_DIVIDER(i), &val);
579 if (ret < 0)
580 return ret;
581 cdce->divider[i].div = val & CDCE706_DIVIDER_DIVIDER_MASK;
582 dev_dbg(&cdce->client->dev,
583 "%s: i: %u, parent: %u, div: %u\n", __func__, i,
584 cdce->divider[i].parent, cdce->divider[i].div);
585 }
586
587 ret = cdce706_register_hw(cdce, cdce->divider,
588 ARRAY_SIZE(cdce->divider),
589 cdce706_divider_name, &init);
590 return ret;
591}
592
593static int cdce706_register_clkouts(struct cdce706_dev_data *cdce)
594{
595 struct clk_init_data init = {
596 .ops = &cdce706_clkout_ops,
597 .parent_names = cdce706_divider_name,
598 .num_parents = ARRAY_SIZE(cdce706_divider_name),
599 .flags = CLK_SET_RATE_PARENT,
600 };
601 unsigned i;
602 int ret;
603
604 for (i = 0; i < ARRAY_SIZE(cdce->clkout); ++i) {
605 unsigned val;
606
607 ret = cdce706_reg_read(cdce, CDCE706_CLKOUT(i), &val);
608 if (ret < 0)
609 return ret;
610 cdce->clkout[i].parent = val & CDCE706_CLKOUT_DIVIDER_MASK;
611 dev_dbg(&cdce->client->dev,
612 "%s: i: %u, parent: %u\n", __func__, i,
613 cdce->clkout[i].parent);
614 }
615
616 ret = cdce706_register_hw(cdce, cdce->clkout,
617 ARRAY_SIZE(cdce->clkout),
618 cdce706_clkout_name, &init);
619 for (i = 0; i < ARRAY_SIZE(cdce->clkout); ++i)
620 cdce->clks[i] = cdce->clkout[i].clk;
621
622 return ret;
623}
624
625static int cdce706_probe(struct i2c_client *client,
626 const struct i2c_device_id *id)
627{
628 struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent);
629 struct cdce706_dev_data *cdce;
630 int ret;
631
632 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
633 return -EIO;
634
635 cdce = devm_kzalloc(&client->dev, sizeof(*cdce), GFP_KERNEL);
636 if (!cdce)
637 return -ENOMEM;
638
639 cdce->client = client;
640 cdce->regmap = devm_regmap_init_i2c(client, &cdce706_regmap_config);
641 if (IS_ERR(cdce->regmap)) {
642 dev_err(&client->dev, "Failed to initialize regmap\n");
643 return -EINVAL;
644 }
645
646 i2c_set_clientdata(client, cdce);
647
648 ret = cdce706_register_clkin(cdce);
649 if (ret < 0)
650 return ret;
651 ret = cdce706_register_plls(cdce);
652 if (ret < 0)
653 return ret;
654 ret = cdce706_register_dividers(cdce);
655 if (ret < 0)
656 return ret;
657 ret = cdce706_register_clkouts(cdce);
658 if (ret < 0)
659 return ret;
660 cdce->onecell.clks = cdce->clks;
661 cdce->onecell.clk_num = ARRAY_SIZE(cdce->clks);
662 ret = of_clk_add_provider(client->dev.of_node, of_clk_src_onecell_get,
663 &cdce->onecell);
664
665 return ret;
666}
667
668static int cdce706_remove(struct i2c_client *client)
669{
Axel Lin8cdea502015-05-21 22:26:13 +0800670 of_clk_del_provider(client->dev.of_node);
Max Filippov0c7665c2015-01-12 10:20:46 +0300671 return 0;
672}
673
674
675#ifdef CONFIG_OF
676static const struct of_device_id cdce706_dt_match[] = {
677 { .compatible = "ti,cdce706" },
678 { },
679};
680MODULE_DEVICE_TABLE(of, cdce706_dt_match);
681#endif
682
683static const struct i2c_device_id cdce706_id[] = {
684 { "cdce706", 0 },
685 { }
686};
687MODULE_DEVICE_TABLE(i2c, cdce706_id);
688
689static struct i2c_driver cdce706_i2c_driver = {
690 .driver = {
691 .name = "cdce706",
692 .of_match_table = of_match_ptr(cdce706_dt_match),
693 },
694 .probe = cdce706_probe,
695 .remove = cdce706_remove,
696 .id_table = cdce706_id,
697};
698module_i2c_driver(cdce706_i2c_driver);
699
700MODULE_AUTHOR("Max Filippov <jcmvbkbc@gmail.com>");
701MODULE_DESCRIPTION("TI CDCE 706 clock synthesizer driver");
702MODULE_LICENSE("GPL");