123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707 |
- /*
- * TI CDCE706 programmable 3-PLL clock synthesizer driver
- *
- * Copyright (c) 2014 Cadence Design Systems Inc.
- *
- * Reference: http://www.ti.com/lit/ds/symlink/cdce706.pdf
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 as
- * published by the Free Software Foundation.
- */
- #include <linux/clk.h>
- #include <linux/clk-provider.h>
- #include <linux/delay.h>
- #include <linux/i2c.h>
- #include <linux/interrupt.h>
- #include <linux/mod_devicetable.h>
- #include <linux/module.h>
- #include <linux/of.h>
- #include <linux/rational.h>
- #include <linux/regmap.h>
- #include <linux/slab.h>
- #define CDCE706_CLKIN_CLOCK 10
- #define CDCE706_CLKIN_SOURCE 11
- #define CDCE706_PLL_M_LOW(pll) (1 + 3 * (pll))
- #define CDCE706_PLL_N_LOW(pll) (2 + 3 * (pll))
- #define CDCE706_PLL_HI(pll) (3 + 3 * (pll))
- #define CDCE706_PLL_MUX 3
- #define CDCE706_PLL_FVCO 6
- #define CDCE706_DIVIDER(div) (13 + (div))
- #define CDCE706_CLKOUT(out) (19 + (out))
- #define CDCE706_CLKIN_CLOCK_MASK 0x10
- #define CDCE706_CLKIN_SOURCE_SHIFT 6
- #define CDCE706_CLKIN_SOURCE_MASK 0xc0
- #define CDCE706_CLKIN_SOURCE_LVCMOS 0x40
- #define CDCE706_PLL_MUX_MASK(pll) (0x80 >> (pll))
- #define CDCE706_PLL_LOW_M_MASK 0xff
- #define CDCE706_PLL_LOW_N_MASK 0xff
- #define CDCE706_PLL_HI_M_MASK 0x1
- #define CDCE706_PLL_HI_N_MASK 0x1e
- #define CDCE706_PLL_HI_N_SHIFT 1
- #define CDCE706_PLL_M_MAX 0x1ff
- #define CDCE706_PLL_N_MAX 0xfff
- #define CDCE706_PLL_FVCO_MASK(pll) (0x80 >> (pll))
- #define CDCE706_PLL_FREQ_MIN 80000000
- #define CDCE706_PLL_FREQ_MAX 300000000
- #define CDCE706_PLL_FREQ_HI 180000000
- #define CDCE706_DIVIDER_PLL(div) (9 + (div) - ((div) > 2) - ((div) > 4))
- #define CDCE706_DIVIDER_PLL_SHIFT(div) ((div) < 2 ? 5 : 3 * ((div) & 1))
- #define CDCE706_DIVIDER_PLL_MASK(div) (0x7 << CDCE706_DIVIDER_PLL_SHIFT(div))
- #define CDCE706_DIVIDER_DIVIDER_MASK 0x7f
- #define CDCE706_DIVIDER_DIVIDER_MAX 0x7f
- #define CDCE706_CLKOUT_DIVIDER_MASK 0x7
- #define CDCE706_CLKOUT_ENABLE_MASK 0x8
- static const struct regmap_config cdce706_regmap_config = {
- .reg_bits = 8,
- .val_bits = 8,
- .val_format_endian = REGMAP_ENDIAN_NATIVE,
- };
- #define to_hw_data(phw) (container_of((phw), struct cdce706_hw_data, hw))
- struct cdce706_hw_data {
- struct cdce706_dev_data *dev_data;
- unsigned idx;
- unsigned parent;
- struct clk_hw hw;
- unsigned div;
- unsigned mul;
- unsigned mux;
- };
- struct cdce706_dev_data {
- struct i2c_client *client;
- struct regmap *regmap;
- struct clk *clkin_clk[2];
- const char *clkin_name[2];
- struct cdce706_hw_data clkin[1];
- struct cdce706_hw_data pll[3];
- struct cdce706_hw_data divider[6];
- struct cdce706_hw_data clkout[6];
- };
- static const char * const cdce706_source_name[] = {
- "clk_in0", "clk_in1",
- };
- static const char * const cdce706_clkin_name[] = {
- "clk_in",
- };
- static const char * const cdce706_pll_name[] = {
- "pll1", "pll2", "pll3",
- };
- static const char * const cdce706_divider_parent_name[] = {
- "clk_in", "pll1", "pll2", "pll2", "pll3",
- };
- static const char *cdce706_divider_name[] = {
- "p0", "p1", "p2", "p3", "p4", "p5",
- };
- static const char * const cdce706_clkout_name[] = {
- "clk_out0", "clk_out1", "clk_out2", "clk_out3", "clk_out4", "clk_out5",
- };
- static int cdce706_reg_read(struct cdce706_dev_data *dev_data, unsigned reg,
- unsigned *val)
- {
- int rc = regmap_read(dev_data->regmap, reg | 0x80, val);
- if (rc < 0)
- dev_err(&dev_data->client->dev, "error reading reg %u", reg);
- return rc;
- }
- static int cdce706_reg_write(struct cdce706_dev_data *dev_data, unsigned reg,
- unsigned val)
- {
- int rc = regmap_write(dev_data->regmap, reg | 0x80, val);
- if (rc < 0)
- dev_err(&dev_data->client->dev, "error writing reg %u", reg);
- return rc;
- }
- static int cdce706_reg_update(struct cdce706_dev_data *dev_data, unsigned reg,
- unsigned mask, unsigned val)
- {
- int rc = regmap_update_bits(dev_data->regmap, reg | 0x80, mask, val);
- if (rc < 0)
- dev_err(&dev_data->client->dev, "error updating reg %u", reg);
- return rc;
- }
- static int cdce706_clkin_set_parent(struct clk_hw *hw, u8 index)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- hwd->parent = index;
- return 0;
- }
- static u8 cdce706_clkin_get_parent(struct clk_hw *hw)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- return hwd->parent;
- }
- static const struct clk_ops cdce706_clkin_ops = {
- .set_parent = cdce706_clkin_set_parent,
- .get_parent = cdce706_clkin_get_parent,
- };
- static unsigned long cdce706_pll_recalc_rate(struct clk_hw *hw,
- unsigned long parent_rate)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, pll: %d, mux: %d, mul: %u, div: %u\n",
- __func__, hwd->idx, hwd->mux, hwd->mul, hwd->div);
- if (!hwd->mux) {
- if (hwd->div && hwd->mul) {
- u64 res = (u64)parent_rate * hwd->mul;
- do_div(res, hwd->div);
- return res;
- }
- } else {
- if (hwd->div)
- return parent_rate / hwd->div;
- }
- return 0;
- }
- static long cdce706_pll_round_rate(struct clk_hw *hw, unsigned long rate,
- unsigned long *parent_rate)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- unsigned long mul, div;
- u64 res;
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, rate: %lu, parent_rate: %lu\n",
- __func__, rate, *parent_rate);
- rational_best_approximation(rate, *parent_rate,
- CDCE706_PLL_N_MAX, CDCE706_PLL_M_MAX,
- &mul, &div);
- hwd->mul = mul;
- hwd->div = div;
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, pll: %d, mul: %lu, div: %lu\n",
- __func__, hwd->idx, mul, div);
- res = (u64)*parent_rate * hwd->mul;
- do_div(res, hwd->div);
- return res;
- }
- static int cdce706_pll_set_rate(struct clk_hw *hw, unsigned long rate,
- unsigned long parent_rate)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- unsigned long mul = hwd->mul, div = hwd->div;
- int err;
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, pll: %d, mul: %lu, div: %lu\n",
- __func__, hwd->idx, mul, div);
- err = cdce706_reg_update(hwd->dev_data,
- CDCE706_PLL_HI(hwd->idx),
- CDCE706_PLL_HI_M_MASK | CDCE706_PLL_HI_N_MASK,
- ((div >> 8) & CDCE706_PLL_HI_M_MASK) |
- ((mul >> (8 - CDCE706_PLL_HI_N_SHIFT)) &
- CDCE706_PLL_HI_N_MASK));
- if (err < 0)
- return err;
- err = cdce706_reg_write(hwd->dev_data,
- CDCE706_PLL_M_LOW(hwd->idx),
- div & CDCE706_PLL_LOW_M_MASK);
- if (err < 0)
- return err;
- err = cdce706_reg_write(hwd->dev_data,
- CDCE706_PLL_N_LOW(hwd->idx),
- mul & CDCE706_PLL_LOW_N_MASK);
- if (err < 0)
- return err;
- err = cdce706_reg_update(hwd->dev_data,
- CDCE706_PLL_FVCO,
- CDCE706_PLL_FVCO_MASK(hwd->idx),
- rate > CDCE706_PLL_FREQ_HI ?
- CDCE706_PLL_FVCO_MASK(hwd->idx) : 0);
- return err;
- }
- static const struct clk_ops cdce706_pll_ops = {
- .recalc_rate = cdce706_pll_recalc_rate,
- .round_rate = cdce706_pll_round_rate,
- .set_rate = cdce706_pll_set_rate,
- };
- static int cdce706_divider_set_parent(struct clk_hw *hw, u8 index)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- if (hwd->parent == index)
- return 0;
- hwd->parent = index;
- return cdce706_reg_update(hwd->dev_data,
- CDCE706_DIVIDER_PLL(hwd->idx),
- CDCE706_DIVIDER_PLL_MASK(hwd->idx),
- index << CDCE706_DIVIDER_PLL_SHIFT(hwd->idx));
- }
- static u8 cdce706_divider_get_parent(struct clk_hw *hw)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- return hwd->parent;
- }
- static unsigned long cdce706_divider_recalc_rate(struct clk_hw *hw,
- unsigned long parent_rate)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, divider: %d, div: %u\n",
- __func__, hwd->idx, hwd->div);
- if (hwd->div)
- return parent_rate / hwd->div;
- return 0;
- }
- static long cdce706_divider_round_rate(struct clk_hw *hw, unsigned long rate,
- unsigned long *parent_rate)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- struct cdce706_dev_data *cdce = hwd->dev_data;
- unsigned long mul, div;
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, rate: %lu, parent_rate: %lu\n",
- __func__, rate, *parent_rate);
- rational_best_approximation(rate, *parent_rate,
- 1, CDCE706_DIVIDER_DIVIDER_MAX,
- &mul, &div);
- if (!mul)
- div = CDCE706_DIVIDER_DIVIDER_MAX;
- if (clk_hw_get_flags(hw) & CLK_SET_RATE_PARENT) {
- unsigned long best_diff = rate;
- unsigned long best_div = 0;
- struct clk *gp_clk = cdce->clkin_clk[cdce->clkin[0].parent];
- unsigned long gp_rate = gp_clk ? clk_get_rate(gp_clk) : 0;
- for (div = CDCE706_PLL_FREQ_MIN / rate; best_diff &&
- div <= CDCE706_PLL_FREQ_MAX / rate; ++div) {
- unsigned long n, m;
- unsigned long diff;
- unsigned long div_rate;
- u64 div_rate64;
- if (rate * div < CDCE706_PLL_FREQ_MIN)
- continue;
- rational_best_approximation(rate * div, gp_rate,
- CDCE706_PLL_N_MAX,
- CDCE706_PLL_M_MAX,
- &n, &m);
- div_rate64 = (u64)gp_rate * n;
- do_div(div_rate64, m);
- do_div(div_rate64, div);
- div_rate = div_rate64;
- diff = max(div_rate, rate) - min(div_rate, rate);
- if (diff < best_diff) {
- best_diff = diff;
- best_div = div;
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, %lu * %lu / %lu / %lu = %lu\n",
- __func__, gp_rate, n, m, div, div_rate);
- }
- }
- div = best_div;
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, altering parent rate: %lu -> %lu\n",
- __func__, *parent_rate, rate * div);
- *parent_rate = rate * div;
- }
- hwd->div = div;
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, divider: %d, div: %lu\n",
- __func__, hwd->idx, div);
- return *parent_rate / div;
- }
- static int cdce706_divider_set_rate(struct clk_hw *hw, unsigned long rate,
- unsigned long parent_rate)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- dev_dbg(&hwd->dev_data->client->dev,
- "%s, divider: %d, div: %u\n",
- __func__, hwd->idx, hwd->div);
- return cdce706_reg_update(hwd->dev_data,
- CDCE706_DIVIDER(hwd->idx),
- CDCE706_DIVIDER_DIVIDER_MASK,
- hwd->div);
- }
- static const struct clk_ops cdce706_divider_ops = {
- .set_parent = cdce706_divider_set_parent,
- .get_parent = cdce706_divider_get_parent,
- .recalc_rate = cdce706_divider_recalc_rate,
- .round_rate = cdce706_divider_round_rate,
- .set_rate = cdce706_divider_set_rate,
- };
- static int cdce706_clkout_prepare(struct clk_hw *hw)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- return cdce706_reg_update(hwd->dev_data, CDCE706_CLKOUT(hwd->idx),
- CDCE706_CLKOUT_ENABLE_MASK,
- CDCE706_CLKOUT_ENABLE_MASK);
- }
- static void cdce706_clkout_unprepare(struct clk_hw *hw)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- cdce706_reg_update(hwd->dev_data, CDCE706_CLKOUT(hwd->idx),
- CDCE706_CLKOUT_ENABLE_MASK, 0);
- }
- static int cdce706_clkout_set_parent(struct clk_hw *hw, u8 index)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- if (hwd->parent == index)
- return 0;
- hwd->parent = index;
- return cdce706_reg_update(hwd->dev_data,
- CDCE706_CLKOUT(hwd->idx),
- CDCE706_CLKOUT_ENABLE_MASK, index);
- }
- static u8 cdce706_clkout_get_parent(struct clk_hw *hw)
- {
- struct cdce706_hw_data *hwd = to_hw_data(hw);
- return hwd->parent;
- }
- static unsigned long cdce706_clkout_recalc_rate(struct clk_hw *hw,
- unsigned long parent_rate)
- {
- return parent_rate;
- }
- static long cdce706_clkout_round_rate(struct clk_hw *hw, unsigned long rate,
- unsigned long *parent_rate)
- {
- *parent_rate = rate;
- return rate;
- }
- static int cdce706_clkout_set_rate(struct clk_hw *hw, unsigned long rate,
- unsigned long parent_rate)
- {
- return 0;
- }
- static const struct clk_ops cdce706_clkout_ops = {
- .prepare = cdce706_clkout_prepare,
- .unprepare = cdce706_clkout_unprepare,
- .set_parent = cdce706_clkout_set_parent,
- .get_parent = cdce706_clkout_get_parent,
- .recalc_rate = cdce706_clkout_recalc_rate,
- .round_rate = cdce706_clkout_round_rate,
- .set_rate = cdce706_clkout_set_rate,
- };
- static int cdce706_register_hw(struct cdce706_dev_data *cdce,
- struct cdce706_hw_data *hw, unsigned num_hw,
- const char * const *clk_names,
- struct clk_init_data *init)
- {
- unsigned i;
- int ret;
- for (i = 0; i < num_hw; ++i, ++hw) {
- init->name = clk_names[i];
- hw->dev_data = cdce;
- hw->idx = i;
- hw->hw.init = init;
- ret = devm_clk_hw_register(&cdce->client->dev,
- &hw->hw);
- if (ret) {
- dev_err(&cdce->client->dev, "Failed to register %s\n",
- clk_names[i]);
- return ret;
- }
- }
- return 0;
- }
- static int cdce706_register_clkin(struct cdce706_dev_data *cdce)
- {
- struct clk_init_data init = {
- .ops = &cdce706_clkin_ops,
- .parent_names = cdce->clkin_name,
- .num_parents = ARRAY_SIZE(cdce->clkin_name),
- };
- unsigned i;
- int ret;
- unsigned clock, source;
- for (i = 0; i < ARRAY_SIZE(cdce->clkin_name); ++i) {
- struct clk *parent = devm_clk_get(&cdce->client->dev,
- cdce706_source_name[i]);
- if (IS_ERR(parent)) {
- cdce->clkin_name[i] = cdce706_source_name[i];
- } else {
- cdce->clkin_name[i] = __clk_get_name(parent);
- cdce->clkin_clk[i] = parent;
- }
- }
- ret = cdce706_reg_read(cdce, CDCE706_CLKIN_SOURCE, &source);
- if (ret < 0)
- return ret;
- if ((source & CDCE706_CLKIN_SOURCE_MASK) ==
- CDCE706_CLKIN_SOURCE_LVCMOS) {
- ret = cdce706_reg_read(cdce, CDCE706_CLKIN_CLOCK, &clock);
- if (ret < 0)
- return ret;
- cdce->clkin[0].parent = !!(clock & CDCE706_CLKIN_CLOCK_MASK);
- }
- ret = cdce706_register_hw(cdce, cdce->clkin,
- ARRAY_SIZE(cdce->clkin),
- cdce706_clkin_name, &init);
- return ret;
- }
- static int cdce706_register_plls(struct cdce706_dev_data *cdce)
- {
- struct clk_init_data init = {
- .ops = &cdce706_pll_ops,
- .parent_names = cdce706_clkin_name,
- .num_parents = ARRAY_SIZE(cdce706_clkin_name),
- };
- unsigned i;
- int ret;
- unsigned mux;
- ret = cdce706_reg_read(cdce, CDCE706_PLL_MUX, &mux);
- if (ret < 0)
- return ret;
- for (i = 0; i < ARRAY_SIZE(cdce->pll); ++i) {
- unsigned m, n, v;
- ret = cdce706_reg_read(cdce, CDCE706_PLL_M_LOW(i), &m);
- if (ret < 0)
- return ret;
- ret = cdce706_reg_read(cdce, CDCE706_PLL_N_LOW(i), &n);
- if (ret < 0)
- return ret;
- ret = cdce706_reg_read(cdce, CDCE706_PLL_HI(i), &v);
- if (ret < 0)
- return ret;
- cdce->pll[i].div = m | ((v & CDCE706_PLL_HI_M_MASK) << 8);
- cdce->pll[i].mul = n | ((v & CDCE706_PLL_HI_N_MASK) <<
- (8 - CDCE706_PLL_HI_N_SHIFT));
- cdce->pll[i].mux = mux & CDCE706_PLL_MUX_MASK(i);
- dev_dbg(&cdce->client->dev,
- "%s: i: %u, div: %u, mul: %u, mux: %d\n", __func__, i,
- cdce->pll[i].div, cdce->pll[i].mul, cdce->pll[i].mux);
- }
- ret = cdce706_register_hw(cdce, cdce->pll,
- ARRAY_SIZE(cdce->pll),
- cdce706_pll_name, &init);
- return ret;
- }
- static int cdce706_register_dividers(struct cdce706_dev_data *cdce)
- {
- struct clk_init_data init = {
- .ops = &cdce706_divider_ops,
- .parent_names = cdce706_divider_parent_name,
- .num_parents = ARRAY_SIZE(cdce706_divider_parent_name),
- .flags = CLK_SET_RATE_PARENT,
- };
- unsigned i;
- int ret;
- for (i = 0; i < ARRAY_SIZE(cdce->divider); ++i) {
- unsigned val;
- ret = cdce706_reg_read(cdce, CDCE706_DIVIDER_PLL(i), &val);
- if (ret < 0)
- return ret;
- cdce->divider[i].parent =
- (val & CDCE706_DIVIDER_PLL_MASK(i)) >>
- CDCE706_DIVIDER_PLL_SHIFT(i);
- ret = cdce706_reg_read(cdce, CDCE706_DIVIDER(i), &val);
- if (ret < 0)
- return ret;
- cdce->divider[i].div = val & CDCE706_DIVIDER_DIVIDER_MASK;
- dev_dbg(&cdce->client->dev,
- "%s: i: %u, parent: %u, div: %u\n", __func__, i,
- cdce->divider[i].parent, cdce->divider[i].div);
- }
- ret = cdce706_register_hw(cdce, cdce->divider,
- ARRAY_SIZE(cdce->divider),
- cdce706_divider_name, &init);
- return ret;
- }
- static int cdce706_register_clkouts(struct cdce706_dev_data *cdce)
- {
- struct clk_init_data init = {
- .ops = &cdce706_clkout_ops,
- .parent_names = cdce706_divider_name,
- .num_parents = ARRAY_SIZE(cdce706_divider_name),
- .flags = CLK_SET_RATE_PARENT,
- };
- unsigned i;
- int ret;
- for (i = 0; i < ARRAY_SIZE(cdce->clkout); ++i) {
- unsigned val;
- ret = cdce706_reg_read(cdce, CDCE706_CLKOUT(i), &val);
- if (ret < 0)
- return ret;
- cdce->clkout[i].parent = val & CDCE706_CLKOUT_DIVIDER_MASK;
- dev_dbg(&cdce->client->dev,
- "%s: i: %u, parent: %u\n", __func__, i,
- cdce->clkout[i].parent);
- }
- return cdce706_register_hw(cdce, cdce->clkout,
- ARRAY_SIZE(cdce->clkout),
- cdce706_clkout_name, &init);
- }
- static struct clk_hw *
- of_clk_cdce_get(struct of_phandle_args *clkspec, void *data)
- {
- struct cdce706_dev_data *cdce = data;
- unsigned int idx = clkspec->args[0];
- if (idx >= ARRAY_SIZE(cdce->clkout)) {
- pr_err("%s: invalid index %u\n", __func__, idx);
- return ERR_PTR(-EINVAL);
- }
- return &cdce->clkout[idx].hw;
- }
- static int cdce706_probe(struct i2c_client *client,
- const struct i2c_device_id *id)
- {
- struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent);
- struct cdce706_dev_data *cdce;
- int ret;
- if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
- return -EIO;
- cdce = devm_kzalloc(&client->dev, sizeof(*cdce), GFP_KERNEL);
- if (!cdce)
- return -ENOMEM;
- cdce->client = client;
- cdce->regmap = devm_regmap_init_i2c(client, &cdce706_regmap_config);
- if (IS_ERR(cdce->regmap)) {
- dev_err(&client->dev, "Failed to initialize regmap\n");
- return -EINVAL;
- }
- i2c_set_clientdata(client, cdce);
- ret = cdce706_register_clkin(cdce);
- if (ret < 0)
- return ret;
- ret = cdce706_register_plls(cdce);
- if (ret < 0)
- return ret;
- ret = cdce706_register_dividers(cdce);
- if (ret < 0)
- return ret;
- ret = cdce706_register_clkouts(cdce);
- if (ret < 0)
- return ret;
- return of_clk_add_hw_provider(client->dev.of_node, of_clk_cdce_get,
- cdce);
- }
- static int cdce706_remove(struct i2c_client *client)
- {
- of_clk_del_provider(client->dev.of_node);
- return 0;
- }
- #ifdef CONFIG_OF
- static const struct of_device_id cdce706_dt_match[] = {
- { .compatible = "ti,cdce706" },
- { },
- };
- MODULE_DEVICE_TABLE(of, cdce706_dt_match);
- #endif
- static const struct i2c_device_id cdce706_id[] = {
- { "cdce706", 0 },
- { }
- };
- MODULE_DEVICE_TABLE(i2c, cdce706_id);
- static struct i2c_driver cdce706_i2c_driver = {
- .driver = {
- .name = "cdce706",
- .of_match_table = of_match_ptr(cdce706_dt_match),
- },
- .probe = cdce706_probe,
- .remove = cdce706_remove,
- .id_table = cdce706_id,
- };
- module_i2c_driver(cdce706_i2c_driver);
- MODULE_AUTHOR("Max Filippov <jcmvbkbc@gmail.com>");
- MODULE_DESCRIPTION("TI CDCE 706 clock synthesizer driver");
- MODULE_LICENSE("GPL");
|