forked from luck/tmp_suning_uos_patched
916f562fb2
side. The two main highlights in the core framework are the addition of an bulk clk_get API that handles optional clks and an extra debugfs file that tells the developer about the current parent of a clk. The driver updates are dominated by i.MX in the diffstat, but that is mostly because that SoC has started converting to the clk_hw style of clk registration. The next big update is in the Amlogic meson clk driver that gained some support for audio, cpu, and temperature clks while fixing some PLL issues. Finally, the biggest thing that stands out is the conversion of a large part of the Allwinner sunxi-ng driver to the new clk parent scheme that uses less strings and more pointer comparisons to match clk parents and children up. In general, it looks like we have a lot of little fixes and tweaks here and there to clk data along with the normal addition of a handful of new drivers and a couple new core framework features. Core: - Add a 'clk_parent' file in clk debugfs - Add a clk_bulk_get_optional() API (with devm too) New Drivers: - Support gated clk controller on MIPS based BCM63XX SoCs - Support SiLabs Si5341 and Si5340 chips - Support for CPU clks on Raspberry Pi devices - Audsys clock driver for MediaTek MT8516 SoCs Updates: - Convert a large portion of the Allwinner sunxi-ng driver to new clk parent scheme - Small frequency support for SiLabs Si544 chips - Slow clk support for AT91 SAM9X60 SoCs - Remove dead code in various clk drivers (-Wunused) - Support for Marvell 98DX1135 SoCs - Get duty cycle of generic pwm clks - Improvement in mmc phase calculation and cleanup of some rate defintions - Switch i.MX6 and i.MX7 clock drivers to clk_hw based APIs - Add GPIO, SNVS and GIC clocks for i.MX8 drivers - Mark imx6sx/ul/ull/sll MMDC_P1_IPG and imx8mm DRAM_APB as critical clock - Correct imx7ulp nic1_bus_clk and imx8mm audio_pll2_clk clock setting - Add clks for new Exynos5422 Dynamic Memory Controller driver - Clock definition for Exynos4412 Mali - Add CMM (Color Management Module) clocks on Renesas R-Car H3, M3-N, E3, and D3 - Add TPU (Timer Pulse Unit / PWM) clocks on Renesas RZ/G2M - Support for 32 bit clock IDs in TI's sci-clks for J721e SoCs - TI clock probing done from DT by default instead of firmware - Fix Amlogic Meson mpll fractional part and spread sprectrum issues - Add Amlogic meson8 audio clocks - Add Amlogic g12a temperature sensors clocks - Add Amlogic g12a and g12b cpu clocks - Add TPU (Timer Pulse Unit / PWM) clocks on Renesas R-Car H3, M3-W, and M3-N - Add CMM (Color Management Module) clocks on Renesas R-Car M3-W - Add Clock Domain support on Renesas RZ/N1 -----BEGIN PGP SIGNATURE----- iQJFBAABCAAvFiEE9L57QeeUxqYDyoaDrQKIl8bklSUFAl0uBEERHHNib3lkQGtl cm5lbC5vcmcACgkQrQKIl8bklSWucw/9ELKlfvdxrc8mdIuzt+CpKdNiSG88shXY hF+vnuE6Jhv5hmlbA/DbplPTAnHT/FQF65/GPQMAYy2wYO6CjleNxQyepiVv4h8/ tWoXu5vYZXubtQyMnYTffREzjYFPBNAscLUhXNwJKRno7nT0qKCk62WgOMfaW/KN lP5dKmrL7rdJDUvxHEStrwP515Lg5Wkhj3+XzgbgFUKGuGlvHfwUOEZucT++kqhu Z1vMjPv2ksHQf3r15BsbX/6jMIONEt2Xd6jA3Lm7ebDXJl2hjX4Gq0Kkl5pmkj2w F0V7Tw4XYk6DkSl7HQaOBgQ8KV0Mw2L8Vj6eEDhUwx6wPGlQ5YTKkUCJkjs0mUyb UpO3TuPFN2W0hsTNDzwYpjqcfodDn159XJcduv1/ZpIanUvHgx0uVzQ7iwwYwW+l VR4SipY5AEn9hpief30X7TAUSKsE4do58imYeoGBrq78zdsJaEcDAMX7AcYdXVQ9 ahBS8ME/d1JEBNdRsSW7eTAfu8dZdI08uR8/T37GRG59XyZSjsyVmZ6kHCYrBygF AyLNMsXMCbW1rOoIpWkuGMD86XZy40laLg8T7WWTaq28t1VQ0BaBTGM4/eEexs3p FhZ1M7aH+PsDLrI2IGTBt/4xAMv+dhDS7HnxRlOONbWnLWVqmR+tYzF0aCkqJCmd O2zWCGffeYs= =mK0C -----END PGP SIGNATURE----- Merge tag 'clk-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/clk/linux Pull clk updates from Stephen Boyd: "This round of clk driver and framework updates is heavy on the driver update side. The two main highlights in the core framework are the addition of an bulk clk_get API that handles optional clks and an extra debugfs file that tells the developer about the current parent of a clk. The driver updates are dominated by i.MX in the diffstat, but that is mostly because that SoC has started converting to the clk_hw style of clk registration. The next big update is in the Amlogic meson clk driver that gained some support for audio, cpu, and temperature clks while fixing some PLL issues. Finally, the biggest thing that stands out is the conversion of a large part of the Allwinner sunxi-ng driver to the new clk parent scheme that uses less strings and more pointer comparisons to match clk parents and children up. In general, it looks like we have a lot of little fixes and tweaks here and there to clk data along with the normal addition of a handful of new drivers and a couple new core framework features. Core: - Add a 'clk_parent' file in clk debugfs - Add a clk_bulk_get_optional() API (with devm too) New Drivers: - Support gated clk controller on MIPS based BCM63XX SoCs - Support SiLabs Si5341 and Si5340 chips - Support for CPU clks on Raspberry Pi devices - Audsys clock driver for MediaTek MT8516 SoCs Updates: - Convert a large portion of the Allwinner sunxi-ng driver to new clk parent scheme - Small frequency support for SiLabs Si544 chips - Slow clk support for AT91 SAM9X60 SoCs - Remove dead code in various clk drivers (-Wunused) - Support for Marvell 98DX1135 SoCs - Get duty cycle of generic pwm clks - Improvement in mmc phase calculation and cleanup of some rate defintions - Switch i.MX6 and i.MX7 clock drivers to clk_hw based APIs - Add GPIO, SNVS and GIC clocks for i.MX8 drivers - Mark imx6sx/ul/ull/sll MMDC_P1_IPG and imx8mm DRAM_APB as critical clock - Correct imx7ulp nic1_bus_clk and imx8mm audio_pll2_clk clock setting - Add clks for new Exynos5422 Dynamic Memory Controller driver - Clock definition for Exynos4412 Mali - Add CMM (Color Management Module) clocks on Renesas R-Car H3, M3-N, E3, and D3 - Add TPU (Timer Pulse Unit / PWM) clocks on Renesas RZ/G2M - Support for 32 bit clock IDs in TI's sci-clks for J721e SoCs - TI clock probing done from DT by default instead of firmware - Fix Amlogic Meson mpll fractional part and spread sprectrum issues - Add Amlogic meson8 audio clocks - Add Amlogic g12a temperature sensors clocks - Add Amlogic g12a and g12b cpu clocks - Add TPU (Timer Pulse Unit / PWM) clocks on Renesas R-Car H3, M3-W, and M3-N - Add CMM (Color Management Module) clocks on Renesas R-Car M3-W - Add Clock Domain support on Renesas RZ/N1" * tag 'clk-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/clk/linux: (190 commits) clk: consoldiate the __clk_get_hw() declarations clk: sprd: Add check for return value of sprd_clk_regmap_init() clk: lochnagar: Update DT binding doc to include the primary SPDIF MCLK clk: Add Si5341/Si5340 driver dt-bindings: clock: Add silabs,si5341 clk: clk-si544: Implement small frequency change support clk: add BCM63XX gated clock controller driver devicetree: document the BCM63XX gated clock bindings clk: at91: sckc: use dedicated functions to unregister clock clk: at91: sckc: improve error path for sama5d4 sck registration clk: at91: sckc: remove unnecessary line clk: at91: sckc: improve error path for sam9x5 sck register clk: at91: sckc: add support to free slow clock osclillator clk: at91: sckc: add support to free slow rc oscillator clk: at91: sckc: add support to free slow oscillator clk: rockchip: export HDMIPHY clock on rk3228 clk: rockchip: add watchdog pclk on rk3328 clk: rockchip: add clock id for hdmi_phy special clock on rk3228 clk: rockchip: add clock id for watchdog pclk on rk3328 clk: at91: sckc: add support for SAM9X60 ...
704 lines
18 KiB
C
704 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: http://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,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
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 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");
|