mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-25 13:14:07 +08:00
ed5c2f5fd1
The value returned by an i2c driver's remove function is mostly ignored. (Only an error message is printed if the value is non-zero that the error is ignored.) So change the prototype of the remove function to return no value. This way driver authors are not tempted to assume that passing an error to the upper layer is a good idea. All drivers are adapted accordingly. There is no intended change of behaviour, all callbacks were prepared to return 0 before. Reviewed-by: Peter Senna Tschudin <peter.senna@gmail.com> Reviewed-by: Jeremy Kerr <jk@codeconstruct.com.au> Reviewed-by: Benjamin Mugnier <benjamin.mugnier@foss.st.com> Reviewed-by: Javier Martinez Canillas <javierm@redhat.com> Reviewed-by: Crt Mori <cmo@melexis.com> Reviewed-by: Heikki Krogerus <heikki.krogerus@linux.intel.com> Acked-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> Acked-by: Marek Behún <kabel@kernel.org> # for leds-turris-omnia Acked-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Reviewed-by: Petr Machata <petrm@nvidia.com> # for mlxsw Reviewed-by: Maximilian Luz <luzmaximilian@gmail.com> # for surface3_power Acked-by: Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com> # for bmc150-accel-i2c + kxcjk-1013 Reviewed-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> # for media/* + staging/media/* Acked-by: Miguel Ojeda <ojeda@kernel.org> # for auxdisplay/ht16k33 + auxdisplay/lcd2s Reviewed-by: Luca Ceresoli <luca.ceresoli@bootlin.com> # for versaclock5 Reviewed-by: Ajay Gupta <ajayg@nvidia.com> # for ucsi_ccg Acked-by: Jonathan Cameron <Jonathan.Cameron@huawei.com> # for iio Acked-by: Peter Rosin <peda@axentia.se> # for i2c-mux-*, max9860 Acked-by: Adrien Grassein <adrien.grassein@gmail.com> # for lontium-lt8912b Reviewed-by: Jean Delvare <jdelvare@suse.de> # for hwmon, i2c-core and i2c/muxes Acked-by: Corey Minyard <cminyard@mvista.com> # for IPMI Reviewed-by: Vladimir Oltean <olteanv@gmail.com> Acked-by: Dmitry Torokhov <dmitry.torokhov@gmail.com> Acked-by: Sebastian Reichel <sebastian.reichel@collabora.com> # for drivers/power Acked-by: Krzysztof Hałasa <khalasa@piap.pl> Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de> Signed-off-by: Wolfram Sang <wsa@kernel.org>
702 lines
18 KiB
C
702 lines
18 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* TI CDCE706 programmable 3-PLL clock synthesizer driver
|
|
*
|
|
* Copyright (c) 2014 Cadence Design Systems Inc.
|
|
*
|
|
* Reference: https://www.ti.com/lit/ds/symlink/cdce706.pdf
|
|
*/
|
|
|
|
#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)
|
|
{
|
|
struct i2c_adapter *adapter = client->adapter;
|
|
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 void cdce706_remove(struct i2c_client *client)
|
|
{
|
|
of_clk_del_provider(client->dev.of_node);
|
|
}
|
|
|
|
|
|
#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_new = 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");
|