diff options
author | Geert Uytterhoeven <geert@linux-m68k.org> | 2021-06-01 16:57:52 +0300 |
---|---|---|
committer | jianlong.huang <jianlong.huang@starfivetech.com> | 2022-04-21 03:11:21 +0300 |
commit | cdbcd30ffe3b582a32c3d247d26a4d324c17063d (patch) | |
tree | 8aac7302202953954e1f3626cfff3a5db4d3c0b9 | |
parent | d0112b2da25a01c65c35e5eecaf96ad2bb642bc6 (diff) | |
download | linux-cdbcd30ffe3b582a32c3d247d26a4d324c17063d.tar.xz |
clk: starfive: Add JH7100 clock generator driver
commit 4210be668a09ee20e4e1c7adf61b47d33d05c480 upstream.
Add a driver for the StarFive JH7100 clock generator.
Reviewed-by: Andy Shevchenko <andy.shevchenko@gmail.com>
Acked-by: Stephen Boyd <sboyd@kernel.org>
Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
Co-developed-by: Emil Renner Berthing <kernel@esmil.dk>
Signed-off-by: Emil Renner Berthing <kernel@esmil.dk>
-rw-r--r-- | MAINTAINERS | 7 | ||||
-rw-r--r-- | drivers/clk/Makefile | 2 | ||||
-rw-r--r-- | drivers/clk/starfive/Kconfig | 4 | ||||
-rw-r--r-- | drivers/clk/starfive/Makefile | 2 | ||||
-rw-r--r-- | drivers/clk/starfive/clk-starfive-jh7100.c | 1386 |
5 files changed, 574 insertions, 827 deletions
diff --git a/MAINTAINERS b/MAINTAINERS index 281de213ef47..c94259c7b0dd 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -16681,6 +16681,13 @@ L: linux-block@vger.kernel.org S: Maintained F: drivers/block/skd*[ch] +STARFIVE JH7100 CLOCK DRIVER +M: Emil Renner Berthing <kernel@esmil.dk> +S: Maintained +F: Documentation/devicetree/bindings/clock/starfive,jh7100-clkgen.yaml +F: drivers/clk/starfive/clk-starfive-jh7100.c +F: include/dt-bindings/clock/starfive-jh7100.h + STI AUDIO (ASoC) DRIVERS M: Arnaud Pouliquen <arnaud.pouliquen@st.com> L: alsa-devel@alsa-project.org (moderated for non-subscribers) diff --git a/drivers/clk/Makefile b/drivers/clk/Makefile index b16b68bbde05..f5ab7752aa74 100644 --- a/drivers/clk/Makefile +++ b/drivers/clk/Makefile @@ -111,7 +111,7 @@ obj-$(CONFIG_ARCH_STRATIX10) += socfpga/ obj-$(CONFIG_PLAT_SPEAR) += spear/ obj-y += sprd/ obj-$(CONFIG_ARCH_STI) += st/ -obj-$(CONFIG_SOC_STARFIVE_VIC7100) += starfive/ +obj-$(CONFIG_SOC_STARFIVE) += starfive/ obj-$(CONFIG_ARCH_SUNXI) += sunxi/ obj-$(CONFIG_SUNXI_CCU) += sunxi-ng/ obj-$(CONFIG_ARCH_TEGRA) += tegra/ diff --git a/drivers/clk/starfive/Kconfig b/drivers/clk/starfive/Kconfig index 0e23c9a8a663..c0fa9d5e641f 100644 --- a/drivers/clk/starfive/Kconfig +++ b/drivers/clk/starfive/Kconfig @@ -2,8 +2,8 @@ config CLK_STARFIVE_JH7100 bool "StarFive JH7100 clock support" - depends on SOC_STARFIVE_VIC7100 || COMPILE_TEST - default y if SOC_STARFIVE_VIC7100 + depends on SOC_STARFIVE || COMPILE_TEST + default SOC_STARFIVE help Say yes here to support the clock controller on the StarFive JH7100 SoC. diff --git a/drivers/clk/starfive/Makefile b/drivers/clk/starfive/Makefile index 335bf848de6f..09759cc73530 100644 --- a/drivers/clk/starfive/Makefile +++ b/drivers/clk/starfive/Makefile @@ -1,3 +1,3 @@ # SPDX-License-Identifier: GPL-2.0 # StarFive Clock -obj-$(CONFIG_CLK_STARFIVE_JH7100) += clk-starfive-jh7100.o
\ No newline at end of file +obj-$(CONFIG_CLK_STARFIVE_JH7100) += clk-starfive-jh7100.o diff --git a/drivers/clk/starfive/clk-starfive-jh7100.c b/drivers/clk/starfive/clk-starfive-jh7100.c index 527663b15550..25d31afa0f87 100644 --- a/drivers/clk/starfive/clk-starfive-jh7100.c +++ b/drivers/clk/starfive/clk-starfive-jh7100.c @@ -4,946 +4,686 @@ * * Copyright 2021 Ahmad Fatoum, Pengutronix * Copyright (C) 2021 Glider bv - * Copyright (C) 2021 Starfive + * Copyright (C) 2021 Emil Renner Berthing <kernel@esmil.dk> */ -#include <linux/clk.h> +#include <linux/bits.h> #include <linux/clk-provider.h> +#include <linux/debugfs.h> #include <linux/device.h> #include <linux/init.h> +#include <linux/io.h> #include <linux/kernel.h> +#include <linux/mod_devicetable.h> #include <linux/module.h> -#include <linux/overflow.h> #include <linux/platform_device.h> -#include <linux/of_device.h> #include <dt-bindings/clock/starfive-jh7100.h> -#define STARFIVE_CLK_ENABLE_SHIFT 31 -#define STARFIVE_CLK_INVERT_SHIFT 30 -#define STARFIVE_CLK_MUX_SHIFT 24 - - -static const char *cpundbus_root_sels[4] = { - [0] = "osc_sys", - [1] = "pll0_out", - [2] = "pll1_out", - [3] = "pll2_out", -}; - -static const char *dla_root_sels[4] = { - [0] = "osc_sys", - [1] = "pll1_out", - [2] = "pll2_out", - [3] = "dummy", -}; - -static const char *dsp_root_sels[4] = { - [0] = "osc_sys", - [1] = "pll0_out", - [2] = "pll1_out", - [3] = "pll2_out", -}; - -static const char *gmacusb_root_sels[4] = { - [0] = "osc_sys", - [1] = "pll0_out", - [2] = "pll2_out", - [3] = "dummy", -}; - -static const char *perh0_root_sels[2] = { - [0] = "osc_sys", - [1] = "pll0_out", -}; - -static const char *perh1_root_sels[2] = { - [0] = "osc_sys", - [1] = "pll2_out", -}; - -static const char *vin_root_sels[4] = { - [0] = "osc_sys", - [1] = "pll1_out", - [2] = "pll2_out", - [3] = "dummy", -}; - -static const char *vout_root_sels[4] = { - [0] = "osc_aud", - [1] = "pll0_out", - [2] = "pll2_out", - [3] = "dummy", -}; - -static const char *cdechifi4_root_sels[4] = { - [0] = "osc_sys", - [1] = "pll1_out", - [2] = "pll2_out", - [3] = "dummy", -}; - -static const char *cdec_root_sels[4] = { - [0] = "osc_sys", - [1] = "pll0_out", - [2] = "pll1_out", - [3] = "dummy", -}; - -static const char *voutbus_root_sels[4] = { - [0] = "osc_aud", - [1] = "pll0_out", - [2] = "pll2_out", - [3] = "dummy", -}; - -static const char *pll2_refclk_sels[2] = { - [0] = "osc_sys", - [1] = "osc_aud", -}; - -static const char *ddrc0_sels[4] = { - [0] = "ddrosc_div2", - [1] = "ddrpll_div2", - [2] = "ddrpll_div4", - [3] = "ddrpll_div8", -}; - -static const char *ddrc1_sels[4] = { - [0] = "ddrosc_div2", - [1] = "ddrpll_div2", - [2] = "ddrpll_div4", - [3] = "ddrpll_div8", -}; - -static const char *nne_bus_sels[2] = { - [0] = "cpu_axi", - [1] = "nnebus_src1", -}; - -static const char *usbphy_25m_sels[2] = { - [0] = "osc_sys", - [1] = "usbphy_plldiv25m", -}; - -static const char *gmac_tx_sels[4] = { - [0] = "gmac_gtxclk", - [1] = "gmac_mii_txclk", - [2] = "gmac_rmii_txclk", - [3] = "dummy", -}; - -static const char *gmac_rx_pre_sels[2] = { - [0] = "gmac_gr_mii_rxclk", - [1] = "gmac_rmii_rxclk", -}; - -static const char *audio_clk_sels[2] = { - [0] = "audio_src", - [1] = "audio_12288", -}; - -static const char *i2sadc_mclk_sels[2] = { - [0] = "clk_audio_src", - [1] = "clk_aud", -}; +/* external clocks */ +#define JH7100_CLK_OSC_SYS (JH7100_CLK_END + 0) +#define JH7100_CLK_OSC_AUD (JH7100_CLK_END + 1) +#define JH7100_CLK_GMAC_RMII_REF (JH7100_CLK_END + 2) +#define JH7100_CLK_GMAC_GR_MII_RX (JH7100_CLK_END + 3) + +/* register fields */ +#define JH7100_CLK_ENABLE BIT(31) +#define JH7100_CLK_INVERT BIT(30) +#define JH7100_CLK_MUX_MASK GENMASK(27, 24) +#define JH7100_CLK_MUX_SHIFT 24 +#define JH7100_CLK_DIV_MASK GENMASK(23, 0) + +/* clock data */ +#define JH7100_GATE(_idx, _name, _flags, _parent) [_idx] = { \ + .name = _name, \ + .flags = CLK_SET_RATE_PARENT | (_flags), \ + .max = JH7100_CLK_ENABLE, \ + .parents = { [0] = _parent }, \ +} -static const char *i2sadc_bclk_sels[2] = { - [0] = "adc_mclk", - [1] = "i2sadc_bclk_iopad", -}; +#define JH7100__DIV(_idx, _name, _max, _parent) [_idx] = { \ + .name = _name, \ + .flags = 0, \ + .max = _max, \ + .parents = { [0] = _parent }, \ +} -static const char *i2sadc_lrclk_sels[4] = { - [0] = "i2sadc_bclk_n", - [1] = "i2sadc_lrclk_iopad", - [2] = "i2sadc_bclk", - [3] = "dummy", -}; +#define JH7100_GDIV(_idx, _name, _flags, _max, _parent) [_idx] = { \ + .name = _name, \ + .flags = _flags, \ + .max = JH7100_CLK_ENABLE | (_max), \ + .parents = { [0] = _parent }, \ +} -static const char *i2sdac0_bclk_sels[2] = { - [0] = "audio_dac_mclk", - [1] = "i2sdac0_bclk_iopad", -}; +#define JH7100__MUX(_idx, _name, _nparents, ...) [_idx] = { \ + .name = _name, \ + .flags = 0, \ + .max = ((_nparents) - 1) << JH7100_CLK_MUX_SHIFT, \ + .parents = { __VA_ARGS__ }, \ +} -static const char *i2sdac0_lrclk_sels[4] = { - [0] = "i2sdac0_bclk_n", - [1] = "i2sdac0_lrclk_iopad", - [2] = "i2sdac0_bclk", - [3] = "dummy", -}; +#define JH7100_GMUX(_idx, _name, _flags, _nparents, ...) [_idx] = { \ + .name = _name, \ + .flags = _flags, \ + .max = JH7100_CLK_ENABLE | \ + (((_nparents) - 1) << JH7100_CLK_MUX_SHIFT), \ + .parents = { __VA_ARGS__ }, \ +} +#define JH7100__INV(_idx, _name, _parent) [_idx] = { \ + .name = _name, \ + .flags = CLK_SET_RATE_PARENT, \ + .max = JH7100_CLK_INVERT, \ + .parents = { [0] = _parent }, \ +} -static const char *i2sdac1_bclk_sels[2] = { - [0] = "i2s1_mclk", - [1] = "i2sadc1_bclk_iopad", +static const struct { + const char *name; + unsigned long flags; + u32 max; + u8 parents[4]; +} jh7100_clk_data[] __initconst = { + JH7100__MUX(JH7100_CLK_CPUNDBUS_ROOT, "cpundbus_root", 4, + JH7100_CLK_OSC_SYS, + JH7100_CLK_PLL0_OUT, + JH7100_CLK_PLL1_OUT, + JH7100_CLK_PLL2_OUT), + JH7100__MUX(JH7100_CLK_DLA_ROOT, "dla_root", 3, + JH7100_CLK_OSC_SYS, + JH7100_CLK_PLL1_OUT, + JH7100_CLK_PLL2_OUT), + JH7100__MUX(JH7100_CLK_DSP_ROOT, "dsp_root", 4, + JH7100_CLK_OSC_SYS, + JH7100_CLK_PLL0_OUT, + JH7100_CLK_PLL1_OUT, + JH7100_CLK_PLL2_OUT), + JH7100__MUX(JH7100_CLK_GMACUSB_ROOT, "gmacusb_root", 3, + JH7100_CLK_OSC_SYS, + JH7100_CLK_PLL0_OUT, + JH7100_CLK_PLL2_OUT), + JH7100__MUX(JH7100_CLK_PERH0_ROOT, "perh0_root", 2, + JH7100_CLK_OSC_SYS, + JH7100_CLK_PLL0_OUT), + JH7100__MUX(JH7100_CLK_PERH1_ROOT, "perh1_root", 2, + JH7100_CLK_OSC_SYS, + JH7100_CLK_PLL2_OUT), + JH7100__MUX(JH7100_CLK_VIN_ROOT, "vin_root", 3, + JH7100_CLK_OSC_SYS, + JH7100_CLK_PLL1_OUT, + JH7100_CLK_PLL2_OUT), + JH7100__MUX(JH7100_CLK_VOUT_ROOT, "vout_root", 3, + JH7100_CLK_OSC_AUD, + JH7100_CLK_PLL0_OUT, + JH7100_CLK_PLL2_OUT), + JH7100_GDIV(JH7100_CLK_AUDIO_ROOT, "audio_root", 0, 8, JH7100_CLK_PLL0_OUT), + JH7100__MUX(JH7100_CLK_CDECHIFI4_ROOT, "cdechifi4_root", 3, + JH7100_CLK_OSC_SYS, + JH7100_CLK_PLL1_OUT, + JH7100_CLK_PLL2_OUT), + JH7100__MUX(JH7100_CLK_CDEC_ROOT, "cdec_root", 3, + JH7100_CLK_OSC_SYS, + JH7100_CLK_PLL0_OUT, + JH7100_CLK_PLL1_OUT), + JH7100__MUX(JH7100_CLK_VOUTBUS_ROOT, "voutbus_root", 3, + JH7100_CLK_OSC_AUD, + JH7100_CLK_PLL0_OUT, + JH7100_CLK_PLL2_OUT), + JH7100__DIV(JH7100_CLK_CPUNBUS_ROOT_DIV, "cpunbus_root_div", 2, JH7100_CLK_CPUNDBUS_ROOT), + JH7100__DIV(JH7100_CLK_DSP_ROOT_DIV, "dsp_root_div", 4, JH7100_CLK_DSP_ROOT), + JH7100__DIV(JH7100_CLK_PERH0_SRC, "perh0_src", 4, JH7100_CLK_PERH0_ROOT), + JH7100__DIV(JH7100_CLK_PERH1_SRC, "perh1_src", 4, JH7100_CLK_PERH1_ROOT), + JH7100_GDIV(JH7100_CLK_PLL0_TESTOUT, "pll0_testout", 0, 31, JH7100_CLK_PERH0_SRC), + JH7100_GDIV(JH7100_CLK_PLL1_TESTOUT, "pll1_testout", 0, 31, JH7100_CLK_DLA_ROOT), + JH7100_GDIV(JH7100_CLK_PLL2_TESTOUT, "pll2_testout", 0, 31, JH7100_CLK_PERH1_SRC), + JH7100__MUX(JH7100_CLK_PLL2_REF, "pll2_refclk", 2, + JH7100_CLK_OSC_SYS, + JH7100_CLK_OSC_AUD), + JH7100__DIV(JH7100_CLK_CPU_CORE, "cpu_core", 8, JH7100_CLK_CPUNBUS_ROOT_DIV), + JH7100__DIV(JH7100_CLK_CPU_AXI, "cpu_axi", 8, JH7100_CLK_CPU_CORE), + JH7100__DIV(JH7100_CLK_AHB_BUS, "ahb_bus", 8, JH7100_CLK_CPUNBUS_ROOT_DIV), + JH7100__DIV(JH7100_CLK_APB1_BUS, "apb1_bus", 8, JH7100_CLK_AHB_BUS), + JH7100__DIV(JH7100_CLK_APB2_BUS, "apb2_bus", 8, JH7100_CLK_AHB_BUS), + JH7100_GATE(JH7100_CLK_DOM3AHB_BUS, "dom3ahb_bus", CLK_IS_CRITICAL, JH7100_CLK_AHB_BUS), + JH7100_GATE(JH7100_CLK_DOM7AHB_BUS, "dom7ahb_bus", CLK_IS_CRITICAL, JH7100_CLK_AHB_BUS), + JH7100_GATE(JH7100_CLK_U74_CORE0, "u74_core0", CLK_IS_CRITICAL, JH7100_CLK_CPU_CORE), + JH7100_GDIV(JH7100_CLK_U74_CORE1, "u74_core1", CLK_IS_CRITICAL, 8, JH7100_CLK_CPU_CORE), + JH7100_GATE(JH7100_CLK_U74_AXI, "u74_axi", CLK_IS_CRITICAL, JH7100_CLK_CPU_AXI), + JH7100_GATE(JH7100_CLK_U74RTC_TOGGLE, "u74rtc_toggle", CLK_IS_CRITICAL, JH7100_CLK_OSC_SYS), + JH7100_GATE(JH7100_CLK_SGDMA2P_AXI, "sgdma2p_axi", 0, JH7100_CLK_CPU_AXI), + JH7100_GATE(JH7100_CLK_DMA2PNOC_AXI, "dma2pnoc_axi", 0, JH7100_CLK_CPU_AXI), + JH7100_GATE(JH7100_CLK_SGDMA2P_AHB, "sgdma2p_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100__DIV(JH7100_CLK_DLA_BUS, "dla_bus", 4, JH7100_CLK_DLA_ROOT), + JH7100_GATE(JH7100_CLK_DLA_AXI, "dla_axi", 0, JH7100_CLK_DLA_BUS), + JH7100_GATE(JH7100_CLK_DLANOC_AXI, "dlanoc_axi", 0, JH7100_CLK_DLA_BUS), + JH7100_GATE(JH7100_CLK_DLA_APB, "dla_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_VP6_CORE, "vp6_core", 0, 4, JH7100_CLK_DSP_ROOT_DIV), + JH7100__DIV(JH7100_CLK_VP6BUS_SRC, "vp6bus_src", 4, JH7100_CLK_DSP_ROOT), + JH7100_GDIV(JH7100_CLK_VP6_AXI, "vp6_axi", 0, 4, JH7100_CLK_VP6BUS_SRC), + JH7100__DIV(JH7100_CLK_VCDECBUS_SRC, "vcdecbus_src", 4, JH7100_CLK_CDECHIFI4_ROOT), + JH7100__DIV(JH7100_CLK_VDEC_BUS, "vdec_bus", 8, JH7100_CLK_VCDECBUS_SRC), + JH7100_GATE(JH7100_CLK_VDEC_AXI, "vdec_axi", 0, JH7100_CLK_VDEC_BUS), + JH7100_GATE(JH7100_CLK_VDECBRG_MAIN, "vdecbrg_mainclk", 0, JH7100_CLK_VDEC_BUS), + JH7100_GDIV(JH7100_CLK_VDEC_BCLK, "vdec_bclk", 0, 8, JH7100_CLK_VCDECBUS_SRC), + JH7100_GDIV(JH7100_CLK_VDEC_CCLK, "vdec_cclk", 0, 8, JH7100_CLK_CDEC_ROOT), + JH7100_GATE(JH7100_CLK_VDEC_APB, "vdec_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_JPEG_AXI, "jpeg_axi", 0, 8, JH7100_CLK_CPUNBUS_ROOT_DIV), + JH7100_GDIV(JH7100_CLK_JPEG_CCLK, "jpeg_cclk", 0, 8, JH7100_CLK_CPUNBUS_ROOT_DIV), + JH7100_GATE(JH7100_CLK_JPEG_APB, "jpeg_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_GC300_2X, "gc300_2x", 0, 8, JH7100_CLK_CDECHIFI4_ROOT), + JH7100_GATE(JH7100_CLK_GC300_AHB, "gc300_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100__DIV(JH7100_CLK_JPCGC300_AXIBUS, "jpcgc300_axibus", 8, JH7100_CLK_VCDECBUS_SRC), + JH7100_GATE(JH7100_CLK_GC300_AXI, "gc300_axi", 0, JH7100_CLK_JPCGC300_AXIBUS), + JH7100_GATE(JH7100_CLK_JPCGC300_MAIN, "jpcgc300_mainclk", 0, JH7100_CLK_JPCGC300_AXIBUS), + JH7100__DIV(JH7100_CLK_VENC_BUS, "venc_bus", 8, JH7100_CLK_VCDECBUS_SRC), + JH7100_GATE(JH7100_CLK_VENC_AXI, "venc_axi", 0, JH7100_CLK_VENC_BUS), + JH7100_GATE(JH7100_CLK_VENCBRG_MAIN, "vencbrg_mainclk", 0, JH7100_CLK_VENC_BUS), + JH7100_GDIV(JH7100_CLK_VENC_BCLK, "venc_bclk", 0, 8, JH7100_CLK_VCDECBUS_SRC), + JH7100_GDIV(JH7100_CLK_VENC_CCLK, "venc_cclk", 0, 8, JH7100_CLK_CDEC_ROOT), + JH7100_GATE(JH7100_CLK_VENC_APB, "venc_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_DDRPLL_DIV2, "ddrpll_div2", CLK_IS_CRITICAL, 2, JH7100_CLK_PLL1_OUT), + JH7100_GDIV(JH7100_CLK_DDRPLL_DIV4, "ddrpll_div4", CLK_IS_CRITICAL, 2, JH7100_CLK_DDRPLL_DIV2), + JH7100_GDIV(JH7100_CLK_DDRPLL_DIV8, "ddrpll_div8", CLK_IS_CRITICAL, 2, JH7100_CLK_DDRPLL_DIV4), + JH7100_GDIV(JH7100_CLK_DDROSC_DIV2, "ddrosc_div2", CLK_IS_CRITICAL, 2, JH7100_CLK_OSC_SYS), + JH7100_GMUX(JH7100_CLK_DDRC0, "ddrc0", CLK_IS_CRITICAL, 4, + JH7100_CLK_DDROSC_DIV2, + JH7100_CLK_DDRPLL_DIV2, + JH7100_CLK_DDRPLL_DIV4, + JH7100_CLK_DDRPLL_DIV8), + JH7100_GMUX(JH7100_CLK_DDRC1, "ddrc1", CLK_IS_CRITICAL, 4, + JH7100_CLK_DDROSC_DIV2, + JH7100_CLK_DDRPLL_DIV2, + JH7100_CLK_DDRPLL_DIV4, + JH7100_CLK_DDRPLL_DIV8), + JH7100_GATE(JH7100_CLK_DDRPHY_APB, "ddrphy_apb", 0, JH7100_CLK_APB1_BUS), + JH7100__DIV(JH7100_CLK_NOC_ROB, "noc_rob", 8, JH7100_CLK_CPUNBUS_ROOT_DIV), + JH7100__DIV(JH7100_CLK_NOC_COG, "noc_cog", 8, JH7100_CLK_DLA_ROOT), + JH7100_GATE(JH7100_CLK_NNE_AHB, "nne_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100__DIV(JH7100_CLK_NNEBUS_SRC1, "nnebus_src1", 4, JH7100_CLK_DSP_ROOT), + JH7100__MUX(JH7100_CLK_NNE_BUS, "nne_bus", 2, + JH7100_CLK_CPU_AXI, + JH7100_CLK_NNEBUS_SRC1), + JH7100_GATE(JH7100_CLK_NNE_AXI, "nne_axi", 0, JH7100_CLK_NNE_BUS), + JH7100_GATE(JH7100_CLK_NNENOC_AXI, "nnenoc_axi", 0, JH7100_CLK_NNE_BUS), + JH7100_GATE(JH7100_CLK_DLASLV_AXI, "dlaslv_axi", 0, JH7100_CLK_NNE_BUS), + JH7100_GATE(JH7100_CLK_DSPX2C_AXI, "dspx2c_axi", CLK_IS_CRITICAL, JH7100_CLK_NNE_BUS), + JH7100__DIV(JH7100_CLK_HIFI4_SRC, "hifi4_src", 4, JH7100_CLK_CDECHIFI4_ROOT), + JH7100__DIV(JH7100_CLK_HIFI4_COREFREE, "hifi4_corefree", 8, JH7100_CLK_HIFI4_SRC), + JH7100_GATE(JH7100_CLK_HIFI4_CORE, "hifi4_core", 0, JH7100_CLK_HIFI4_COREFREE), + JH7100__DIV(JH7100_CLK_HIFI4_BUS, "hifi4_bus", 8, JH7100_CLK_HIFI4_COREFREE), + JH7100_GATE(JH7100_CLK_HIFI4_AXI, "hifi4_axi", 0, JH7100_CLK_HIFI4_BUS), + JH7100_GATE(JH7100_CLK_HIFI4NOC_AXI, "hifi4noc_axi", 0, JH7100_CLK_HIFI4_BUS), + JH7100__DIV(JH7100_CLK_SGDMA1P_BUS, "sgdma1p_bus", 8, JH7100_CLK_CPUNBUS_ROOT_DIV), + JH7100_GATE(JH7100_CLK_SGDMA1P_AXI, "sgdma1p_axi", 0, JH7100_CLK_SGDMA1P_BUS), + JH7100_GATE(JH7100_CLK_DMA1P_AXI, "dma1p_axi", 0, JH7100_CLK_SGDMA1P_BUS), + JH7100_GDIV(JH7100_CLK_X2C_AXI, "x2c_axi", CLK_IS_CRITICAL, 8, JH7100_CLK_CPUNBUS_ROOT_DIV), + JH7100__DIV(JH7100_CLK_USB_BUS, "usb_bus", 8, JH7100_CLK_CPUNBUS_ROOT_DIV), + JH7100_GATE(JH7100_CLK_USB_AXI, "usb_axi", 0, JH7100_CLK_USB_BUS), + JH7100_GATE(JH7100_CLK_USBNOC_AXI, "usbnoc_axi", 0, JH7100_CLK_USB_BUS), + JH7100__DIV(JH7100_CLK_USBPHY_ROOTDIV, "usbphy_rootdiv", 4, JH7100_CLK_GMACUSB_ROOT), + JH7100_GDIV(JH7100_CLK_USBPHY_125M, "usbphy_125m", 0, 8, JH7100_CLK_USBPHY_ROOTDIV), + JH7100_GDIV(JH7100_CLK_USBPHY_PLLDIV25M, "usbphy_plldiv25m", 0, 32, JH7100_CLK_USBPHY_ROOTDIV), + JH7100__MUX(JH7100_CLK_USBPHY_25M, "usbphy_25m", 2, + JH7100_CLK_OSC_SYS, + JH7100_CLK_USBPHY_PLLDIV25M), + JH7100__DIV(JH7100_CLK_AUDIO_DIV, "audio_div", 131072, JH7100_CLK_AUDIO_ROOT), + JH7100_GATE(JH7100_CLK_AUDIO_SRC, "audio_src", 0, JH7100_CLK_AUDIO_DIV), + JH7100_GATE(JH7100_CLK_AUDIO_12288, "audio_12288", 0, JH7100_CLK_OSC_AUD), + JH7100_GDIV(JH7100_CLK_VIN_SRC, "vin_src", 0, 4, JH7100_CLK_VIN_ROOT), + JH7100__DIV(JH7100_CLK_ISP0_BUS, "isp0_bus", 8, JH7100_CLK_VIN_SRC), + JH7100_GATE(JH7100_CLK_ISP0_AXI, "isp0_axi", 0, JH7100_CLK_ISP0_BUS), + JH7100_GATE(JH7100_CLK_ISP0NOC_AXI, "isp0noc_axi", 0, JH7100_CLK_ISP0_BUS), + JH7100_GATE(JH7100_CLK_ISPSLV_AXI, "ispslv_axi", 0, JH7100_CLK_ISP0_BUS), + JH7100__DIV(JH7100_CLK_ISP1_BUS, "isp1_bus", 8, JH7100_CLK_VIN_SRC), + JH7100_GATE(JH7100_CLK_ISP1_AXI, "isp1_axi", 0, JH7100_CLK_ISP1_BUS), + JH7100_GATE(JH7100_CLK_ISP1NOC_AXI, "isp1noc_axi", 0, JH7100_CLK_ISP1_BUS), + JH7100__DIV(JH7100_CLK_VIN_BUS, "vin_bus", 8, JH7100_CLK_VIN_SRC), + JH7100_GATE(JH7100_CLK_VIN_AXI, "vin_axi", 0, JH7100_CLK_VIN_BUS), + JH7100_GATE(JH7100_CLK_VINNOC_AXI, "vinnoc_axi", 0, JH7100_CLK_VIN_BUS), + JH7100_GDIV(JH7100_CLK_VOUT_SRC, "vout_src", 0, 4, JH7100_CLK_VOUT_ROOT), + JH7100__DIV(JH7100_CLK_DISPBUS_SRC, "dispbus_src", 4, JH7100_CLK_VOUTBUS_ROOT), + JH7100__DIV(JH7100_CLK_DISP_BUS, "disp_bus", 4, JH7100_CLK_DISPBUS_SRC), + JH7100_GATE(JH7100_CLK_DISP_AXI, "disp_axi", 0, JH7100_CLK_DISP_BUS), + JH7100_GATE(JH7100_CLK_DISPNOC_AXI, "dispnoc_axi", 0, JH7100_CLK_DISP_BUS), + JH7100_GATE(JH7100_CLK_SDIO0_AHB, "sdio0_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100_GDIV(JH7100_CLK_SDIO0_CCLKINT, "sdio0_cclkint", 0, 24, JH7100_CLK_PERH0_SRC), + JH7100__INV(JH7100_CLK_SDIO0_CCLKINT_INV, "sdio0_cclkint_inv", JH7100_CLK_SDIO0_CCLKINT), + JH7100_GATE(JH7100_CLK_SDIO1_AHB, "sdio1_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100_GDIV(JH7100_CLK_SDIO1_CCLKINT, "sdio1_cclkint", 0, 24, JH7100_CLK_PERH1_SRC), + JH7100__INV(JH7100_CLK_SDIO1_CCLKINT_INV, "sdio1_cclkint_inv", JH7100_CLK_SDIO1_CCLKINT), + JH7100_GATE(JH7100_CLK_GMAC_AHB, "gmac_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100__DIV(JH7100_CLK_GMAC_ROOT_DIV, "gmac_root_div", 8, JH7100_CLK_GMACUSB_ROOT), + JH7100_GDIV(JH7100_CLK_GMAC_PTP_REF, "gmac_ptp_refclk", 0, 31, JH7100_CLK_GMAC_ROOT_DIV), + JH7100_GDIV(JH7100_CLK_GMAC_GTX, "gmac_gtxclk", 0, 255, JH7100_CLK_GMAC_ROOT_DIV), + JH7100_GDIV(JH7100_CLK_GMAC_RMII_TX, "gmac_rmii_txclk", 0, 8, JH7100_CLK_GMAC_RMII_REF), + JH7100_GDIV(JH7100_CLK_GMAC_RMII_RX, "gmac_rmii_rxclk", 0, 8, JH7100_CLK_GMAC_RMII_REF), + JH7100__MUX(JH7100_CLK_GMAC_TX, "gmac_tx", 3, + JH7100_CLK_GMAC_GTX, + JH7100_CLK_GMAC_TX_INV, + JH7100_CLK_GMAC_RMII_TX), + JH7100__INV(JH7100_CLK_GMAC_TX_INV, "gmac_tx_inv", JH7100_CLK_GMAC_TX), + JH7100__MUX(JH7100_CLK_GMAC_RX_PRE, "gmac_rx_pre", 2, + JH7100_CLK_GMAC_GR_MII_RX, + JH7100_CLK_GMAC_RMII_RX), + JH7100__INV(JH7100_CLK_GMAC_RX_INV, "gmac_rx_inv", JH7100_CLK_GMAC_RX_PRE), + JH7100_GATE(JH7100_CLK_GMAC_RMII, "gmac_rmii", 0, JH7100_CLK_GMAC_RMII_REF), + JH7100_GDIV(JH7100_CLK_GMAC_TOPHYREF, "gmac_tophyref", 0, 127, JH7100_CLK_GMAC_ROOT_DIV), + JH7100_GATE(JH7100_CLK_SPI2AHB_AHB, "spi2ahb_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100_GDIV(JH7100_CLK_SPI2AHB_CORE, "spi2ahb_core", 0, 31, JH7100_CLK_PERH0_SRC), + JH7100_GATE(JH7100_CLK_EZMASTER_AHB, "ezmaster_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100_GATE(JH7100_CLK_E24_AHB, "e24_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100_GATE(JH7100_CLK_E24RTC_TOGGLE, "e24rtc_toggle", 0, JH7100_CLK_OSC_SYS), + JH7100_GATE(JH7100_CLK_QSPI_AHB, "qspi_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100_GATE(JH7100_CLK_QSPI_APB, "qspi_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_QSPI_REF, "qspi_refclk", 0, 31, JH7100_CLK_PERH0_SRC), + JH7100_GATE(JH7100_CLK_SEC_AHB, "sec_ahb", 0, JH7100_CLK_AHB_BUS), + JH7100_GATE(JH7100_CLK_AES, "aes_clk", 0, JH7100_CLK_SEC_AHB), + JH7100_GATE(JH7100_CLK_SHA, "sha_clk", 0, JH7100_CLK_SEC_AHB), + JH7100_GATE(JH7100_CLK_PKA, "pka_clk", 0, JH7100_CLK_SEC_AHB), + JH7100_GATE(JH7100_CLK_TRNG_APB, "trng_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GATE(JH7100_CLK_OTP_APB, "otp_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GATE(JH7100_CLK_UART0_APB, "uart0_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_UART0_CORE, "uart0_core", 0, 63, JH7100_CLK_PERH1_SRC), + JH7100_GATE(JH7100_CLK_UART1_APB, "uart1_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_UART1_CORE, "uart1_core", 0, 63, JH7100_CLK_PERH1_SRC), + JH7100_GATE(JH7100_CLK_SPI0_APB, "spi0_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_SPI0_CORE, "spi0_core", 0, 63, JH7100_CLK_PERH1_SRC), + JH7100_GATE(JH7100_CLK_SPI1_APB, "spi1_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_SPI1_CORE, "spi1_core", 0, 63, JH7100_CLK_PERH1_SRC), + JH7100_GATE(JH7100_CLK_I2C0_APB, "i2c0_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_I2C0_CORE, "i2c0_core", 0, 63, JH7100_CLK_PERH1_SRC), + JH7100_GATE(JH7100_CLK_I2C1_APB, "i2c1_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GDIV(JH7100_CLK_I2C1_CORE, "i2c1_core", 0, 63, JH7100_CLK_PERH1_SRC), + JH7100_GATE(JH7100_CLK_GPIO_APB, "gpio_apb", 0, JH7100_CLK_APB1_BUS), + JH7100_GATE(JH7100_CLK_UART2_APB, "uart2_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GDIV(JH7100_CLK_UART2_CORE, "uart2_core", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GATE(JH7100_CLK_UART3_APB, "uart3_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GDIV(JH7100_CLK_UART3_CORE, "uart3_core", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GATE(JH7100_CLK_SPI2_APB, "spi2_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GDIV(JH7100_CLK_SPI2_CORE, "spi2_core", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GATE(JH7100_CLK_SPI3_APB, "spi3_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GDIV(JH7100_CLK_SPI3_CORE, "spi3_core", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GATE(JH7100_CLK_I2C2_APB, "i2c2_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GDIV(JH7100_CLK_I2C2_CORE, "i2c2_core", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GATE(JH7100_CLK_I2C3_APB, "i2c3_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GDIV(JH7100_CLK_I2C3_CORE, "i2c3_core", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GATE(JH7100_CLK_WDTIMER_APB, "wdtimer_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GDIV(JH7100_CLK_WDT_CORE, "wdt_coreclk", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GDIV(JH7100_CLK_TIMER0_CORE, "timer0_coreclk", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GDIV(JH7100_CLK_TIMER1_CORE, "timer1_coreclk", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GDIV(JH7100_CLK_TIMER2_CORE, "timer2_coreclk", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GDIV(JH7100_CLK_TIMER3_CORE, "timer3_coreclk", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GDIV(JH7100_CLK_TIMER4_CORE, "timer4_coreclk", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GDIV(JH7100_CLK_TIMER5_CORE, "timer5_coreclk", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GDIV(JH7100_CLK_TIMER6_CORE, "timer6_coreclk", 0, 63, JH7100_CLK_PERH0_SRC), + JH7100_GATE(JH7100_CLK_VP6INTC_APB, "vp6intc_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GATE(JH7100_CLK_PWM_APB, "pwm_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GATE(JH7100_CLK_MSI_APB, "msi_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GATE(JH7100_CLK_TEMP_APB, "temp_apb", 0, JH7100_CLK_APB2_BUS), + JH7100_GDIV(JH7100_CLK_TEMP_SENSE, "temp_sense", 0, 31, JH7100_CLK_OSC_SYS), + JH7100_GATE(JH7100_CLK_SYSERR_APB, "syserr_apb", 0, JH7100_CLK_APB2_BUS), }; -static const char *i2sdac1_lrclk_sels[4] = { - [0] = "i2sdac1_bclk_n", - [1] = "i2sdac1_lrclk_iopad", - [2] = "i2sdac1_bclk", - [3] = "dummy", +struct jh7100_clk { + struct clk_hw hw; + unsigned int idx; + unsigned int max_div; }; -struct clk_starfive_jh7100_priv { +struct jh7100_clk_priv { + /* protect clk enable and set rate/parent from happening at the same time */ spinlock_t rmw_lock; struct device *dev; void __iomem *base; - struct clk_hw_onecell_data clk_hws; + struct clk_hw *pll[3]; + struct jh7100_clk reg[JH7100_CLK_PLL0_OUT]; }; -/* assume osc_sys as direct parent for clocks of yet unknown lineage */ -#define UNKNOWN "osc_sys" - -static struct clk_hw * __init starfive_clk_underspecifid(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char *parent) +static struct jh7100_clk *jh7100_clk_from(struct clk_hw *hw) { - /* - * TODO With documentation available, all users of this functions can be - * migrated to one of the above or to a clk_fixed_factor with - * appropriate factor - */ - return clk_hw_register_fixed_factor(priv->dev, name, parent, 0, 1, - 1); + return container_of(hw, struct jh7100_clk, hw); } -static struct clk_hw * __init starfive_clk_fixed_rate(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char *parent, - unsigned long fixed_rate) +static struct jh7100_clk_priv *jh7100_priv_from(struct jh7100_clk *clk) { - return clk_hw_register_fixed_rate(priv->dev, name, parent, 0, fixed_rate); + return container_of(clk, struct jh7100_clk_priv, reg[clk->idx]); } -static struct clk_hw * __init starfive_clk_fixed_factor(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char *parent, - unsigned int mult, - unsigned int div) +static u32 jh7100_clk_reg_get(struct jh7100_clk *clk) { - /* - * TODO With documentation available, all users of this functions can be - * migrated to one of the above or to a clk_fixed_factor with - * appropriate factor - */ - return clk_hw_register_fixed_factor(priv->dev, name, parent, 0, - mult, div); -} + struct jh7100_clk_priv *priv = jh7100_priv_from(clk); + void __iomem *reg = priv->base + 4 * clk->idx; -static struct clk_hw * __init starfive_clk_divider_o(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char *parent, - unsigned int offset, - unsigned int width) -{ - return starfive_clk_underspecifid(priv, name, parent); + return readl_relaxed(reg); } -static struct clk_hw * __init starfive_clk_divider(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char *parent, - unsigned int offset, - unsigned int width) +static void jh7100_clk_reg_rmw(struct jh7100_clk *clk, u32 mask, u32 value) { - return clk_hw_register_divider(priv->dev, name, parent, 0, - priv->base + offset, 0, width, - CLK_DIVIDER_ONE_BASED, - &priv->rmw_lock); + struct jh7100_clk_priv *priv = jh7100_priv_from(clk); + void __iomem *reg = priv->base + 4 * clk->idx; + unsigned long flags; + + spin_lock_irqsave(&priv->rmw_lock, flags); + value |= readl_relaxed(reg) & ~mask; + writel_relaxed(value, reg); + spin_unlock_irqrestore(&priv->rmw_lock, flags); } -static struct clk_hw * __init starfive_clk_gate(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char *parent, - unsigned int offset) +static int jh7100_clk_enable(struct clk_hw *hw) { - return clk_hw_register_gate(priv->dev, name, parent, - CLK_SET_RATE_PARENT, priv->base + offset, - STARFIVE_CLK_ENABLE_SHIFT, 0, - &priv->rmw_lock); + struct jh7100_clk *clk = jh7100_clk_from(hw); + + jh7100_clk_reg_rmw(clk, JH7100_CLK_ENABLE, JH7100_CLK_ENABLE); + return 0; } -static struct clk_hw * __init starfive_clk_composite(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char * const *parents, - unsigned int num_parents, - unsigned int offset, - unsigned int mux_width, - unsigned int gate_width, - unsigned int div_width) +static void jh7100_clk_disable(struct clk_hw *hw) { - struct clk_hw *hw; - struct clk_mux *mux = NULL; - struct clk_gate *gate = NULL; - struct clk_divider *div = NULL; - struct clk_hw *mux_hw = NULL, *gate_hw = NULL, *div_hw = NULL; - const struct clk_ops *mux_ops = NULL, *gate_ops = NULL, *div_ops = NULL; - int ret; - int mask_arry[4] = {0x1, 0x3, 0x7, 0xF}; - int mask; - - if (mux_width) { - if (mux_width > 4) { - return ERR_PTR(-EPERM); - }else { - mask = mask_arry[mux_width-1]; - } - - mux = devm_kzalloc(priv->dev, sizeof(*mux), GFP_KERNEL); - if (!mux) { - return ERR_PTR(-ENOMEM); - } - - mux->reg = priv->base + offset; - mux->mask = mask; - mux->shift = STARFIVE_CLK_MUX_SHIFT; - mux_hw = &mux->hw; - mux_ops = &clk_mux_ops; - mux->lock = &priv->rmw_lock; + struct jh7100_clk *clk = jh7100_clk_from(hw); - } - - if (gate_width) { - gate = devm_kzalloc(priv->dev, sizeof(*gate), GFP_KERNEL); - if (!gate) { - ret = -ENOMEM; - return ret; - } - - gate->reg = priv->base + offset; - gate->bit_idx = STARFIVE_CLK_ENABLE_SHIFT; - gate->lock = &priv->rmw_lock; - - gate_hw = &gate->hw; - gate_ops = &clk_gate_ops; - } - - if (div_width) { - div = devm_kzalloc(priv->dev, sizeof(*div), GFP_KERNEL); - if (!div) { - ret = -ENOMEM; - return ret; - } - - div->reg = priv->base + offset; - div->shift = 0; - div->width = div_width; - div->flags = CLK_DIVIDER_ONE_BASED; - div->table = NULL; - div->lock = &priv->rmw_lock; - - div_hw = &div->hw; - div_ops = &clk_divider_ops; - } - - hw = clk_hw_register_composite(priv->dev, name, parents, - num_parents, mux_hw, mux_ops, div_hw, - div_ops, gate_hw, gate_ops, 0); - - if (IS_ERR(hw)) { - ret = PTR_ERR(hw); - return ERR_PTR(ret); - } - - return hw; + jh7100_clk_reg_rmw(clk, JH7100_CLK_ENABLE, 0); } -static struct clk_hw * __init starfive_clk_gated_divider_old(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char *parent, - unsigned int offset, - unsigned int width) +static int jh7100_clk_is_enabled(struct clk_hw *hw) { - struct clk_hw *hw; - struct clk_gate *gate = NULL; - struct clk_divider *div = NULL; - struct clk_hw *mux_hw = NULL, *gate_hw = NULL, *div_hw = NULL; - const struct clk_ops *mux_ops = NULL, *gate_ops = NULL, *div_ops = NULL; - const char * const *parent_names; - int num_parents; - int ret; - - parent_names = &parent; - num_parents = 1; - - gate = devm_kzalloc(priv->dev, sizeof(*gate), GFP_KERNEL); - if (!gate) { - ret = -ENOMEM; - return ret; - } + struct jh7100_clk *clk = jh7100_clk_from(hw); - gate->reg = priv->base + offset; - gate->bit_idx = STARFIVE_CLK_ENABLE_SHIFT; - gate->lock = &priv->rmw_lock; - - gate_hw = &gate->hw; - gate_ops = &clk_gate_ops; - - div = devm_kzalloc(priv->dev, sizeof(*div), GFP_KERNEL); - if (!div) { - ret = -ENOMEM; - return ret; - } - - div->reg = priv->base + offset; - div->shift = 0; - div->width = width; - div->flags = CLK_DIVIDER_ONE_BASED; - div->table = NULL; - div->lock = &priv->rmw_lock; + return !!(jh7100_clk_reg_get(clk) & JH7100_CLK_ENABLE); +} - div_hw = &div->hw; - div_ops = &clk_divider_ops; +static unsigned long jh7100_clk_recalc_rate(struct clk_hw *hw, + unsigned long parent_rate) +{ + struct jh7100_clk *clk = jh7100_clk_from(hw); + u32 div = jh7100_clk_reg_get(clk) & JH7100_CLK_DIV_MASK; - hw = clk_hw_register_composite(priv->dev, name, parent_names, - num_parents, mux_hw, mux_ops, div_hw, - div_ops, gate_hw, gate_ops, 0); + return div ? parent_rate / div : 0; +} - if (IS_ERR(hw)) { - ret = PTR_ERR(hw); - return ret; - } +static unsigned long jh7100_clk_bestdiv(struct jh7100_clk *clk, + unsigned long rate, unsigned long parent) +{ + unsigned long max = clk->max_div; + unsigned long div = DIV_ROUND_UP(parent, rate); - return hw; + return min(div, max); } - -static struct clk_hw * __init starfive_clk_gated_divider(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char *parent, - unsigned int offset, - unsigned int width) +static int jh7100_clk_determine_rate(struct clk_hw *hw, + struct clk_rate_request *req) { - const char * const *parents; + struct jh7100_clk *clk = jh7100_clk_from(hw); + unsigned long parent = req->best_parent_rate; + unsigned long rate = clamp(req->rate, req->min_rate, req->max_rate); + unsigned long div = jh7100_clk_bestdiv(clk, rate, parent); + unsigned long result = parent / div; - parents = &parent; + /* + * we want the result clamped by min_rate and max_rate if possible: + * case 1: div hits the max divider value, which means it's less than + * parent / rate, so the result is greater than rate and min_rate in + * particular. we can't do anything about result > max_rate because the + * divider doesn't go any further. + * case 2: div = DIV_ROUND_UP(parent, rate) which means the result is + * always lower or equal to rate and max_rate. however the result may + * turn out lower than min_rate, but then the next higher rate is fine: + * div - 1 = ceil(parent / rate) - 1 < parent / rate + * and thus + * min_rate <= rate < parent / (div - 1) + */ + if (result < req->min_rate && div > 1) + result = parent / (div - 1); - return starfive_clk_composite(priv, name, parents, 1, offset, 0, 1, width); + req->rate = result; + return 0; } - -static struct clk_hw * __init starfive_clk_gate_dis(struct clk_starfive_jh7100_priv *priv, - const char *name, - const char *parent, - unsigned int offset) +static int jh7100_clk_set_rate(struct clk_hw *hw, + unsigned long rate, + unsigned long parent_rate) { - return clk_hw_register_gate(priv->dev, name, parent, - CLK_SET_RATE_PARENT, priv->base + offset, - STARFIVE_CLK_INVERT_SHIFT, - CLK_GATE_SET_TO_DISABLE, &priv->rmw_lock); + struct jh7100_clk *clk = jh7100_clk_from(hw); + unsigned long div = jh7100_clk_bestdiv(clk, rate, parent_rate); + + jh7100_clk_reg_rmw(clk, JH7100_CLK_DIV_MASK, div); + return 0; } -static struct clk_hw * __init starfive_clk_mux(struct clk_starfive_jh7100_priv *priv, - const char *name, - unsigned int offset, - unsigned int width, - const char * const *parents, - unsigned int num_parents) +static u8 jh7100_clk_get_parent(struct clk_hw *hw) { - return clk_hw_register_mux(priv->dev, name, parents, num_parents, - 0, priv->base + offset, - STARFIVE_CLK_MUX_SHIFT, width, 0, - &priv->rmw_lock); + struct jh7100_clk *clk = jh7100_clk_from(hw); + u32 value = jh7100_clk_reg_get(clk); + + return (value & JH7100_CLK_MUX_MASK) >> JH7100_CLK_MUX_SHIFT; } -static int __init starfive_clkgen_sys_init(struct clk_starfive_jh7100_priv *priv) +static int jh7100_clk_set_parent(struct clk_hw *hw, u8 index) { - struct clk_hw **hws = priv->clk_hws.hws; - int i; - int ret; - - hws[JH7100_CLK_OSC_SYS] = starfive_clk_fixed_rate(priv, "osc_sys", NULL, 25000000); - hws[JH7100_CLK_OSC_AUD] = starfive_clk_fixed_rate(priv, "osc_aud", NULL, 27000000); - - hws[JH7100_CLK_PLL0_OUT] = starfive_clk_fixed_factor(priv, "pll0_out", "osc_sys", 40, 1); - hws[JH7100_CLK_PLL1_OUT] = starfive_clk_fixed_factor(priv, "pll1_out", "osc_sys", 64, 1); - hws[JH7100_CLK_PLL2_OUT] = starfive_clk_fixed_factor(priv, "pll2_out", "pll2_refclk", 55, 1); - - //hws[JH7100_CLK_CPUNDBUS_ROOT] = starfive_clk_fixed_factor(priv, "cpundbus_root", "pll0_out", 1, 1); - hws[JH7100_CLK_CPUNDBUS_ROOT] = starfive_clk_mux(priv, "cpundbus_root", 0x0, 2, cpundbus_root_sels, ARRAY_SIZE(cpundbus_root_sels)); - hws[JH7100_CLK_DLA_ROOT] = starfive_clk_mux(priv, "dla_root", 0x4, 2, dla_root_sels, ARRAY_SIZE(dla_root_sels)); - hws[JH7100_CLK_DSP_ROOT] = starfive_clk_mux(priv, "dsp_root", 0x8, 2, dsp_root_sels, ARRAY_SIZE(dsp_root_sels)); - hws[JH7100_CLK_GMACUSB_ROOT] = starfive_clk_mux(priv, "gmacusb_root", 0xc, 2, gmacusb_root_sels, ARRAY_SIZE(gmacusb_root_sels)); - hws[JH7100_CLK_PERH0_ROOT] = starfive_clk_mux(priv, "perh0_root", 0x10, 1, perh0_root_sels, ARRAY_SIZE(perh0_root_sels)); - hws[JH7100_CLK_PERH1_ROOT] = starfive_clk_mux(priv, "perh1_root", 0x14, 1, perh1_root_sels, ARRAY_SIZE(perh1_root_sels)); - hws[JH7100_CLK_VIN_ROOT] = starfive_clk_mux(priv, "vin_root", 0x18, 2, vin_root_sels, ARRAY_SIZE(vin_root_sels)); - hws[JH7100_CLK_VOUT_ROOT] = starfive_clk_mux(priv, "vout_root", 0x1c, 2, vout_root_sels, ARRAY_SIZE(vout_root_sels)); - hws[JH7100_CLK_AUDIO_ROOT] = starfive_clk_gated_divider(priv, "audio_root", "pll0_out", 0x20, 2); - - hws[JH7100_CLK_CDECHIFI4_ROOT] = starfive_clk_mux(priv, "cdechifi4_root", 0x24, 2, cdechifi4_root_sels, ARRAY_SIZE(cdechifi4_root_sels)); - hws[JH7100_CLK_CDEC_ROOT] = starfive_clk_mux(priv, "cdec_root", 0x28, 2, cdec_root_sels, ARRAY_SIZE(cdec_root_sels)); - hws[JH7100_CLK_VOUTBUS_ROOT] = starfive_clk_mux(priv, "voutbus_root", 0x2c, 2, voutbus_root_sels, ARRAY_SIZE(voutbus_root_sels)); - hws[JH7100_CLK_CPUNBUS_ROOT_DIV] = starfive_clk_divider(priv, "cpunbus_root_div", "cpundbus_root", 0x30, 2); - hws[JH7100_CLK_DSP_ROOT_DIV] = starfive_clk_divider(priv, "dsp_root_div", "dsp_root", 0x34, 3); - hws[JH7100_CLK_PERH0_SRC] = starfive_clk_divider(priv, "perh0_src", "perh0_root", 0x38, 3); - hws[JH7100_CLK_PERH1_SRC] = starfive_clk_divider(priv, "perh1_src", "perh1_root", 0x3c, 3); - hws[JH7100_CLK_PLL0_TESTOUT] = starfive_clk_gated_divider(priv, "pll0_testout", "pll0_out", 0x40, 5); - hws[JH7100_CLK_PLL1_TESTOUT] = starfive_clk_gated_divider(priv, "pll1_testout", "pll1_out", 0x44, 5); - hws[JH7100_CLK_PLL2_TESTOUT] = starfive_clk_gated_divider(priv, "pll2_testout", "pll2_out", 0x48, 5); - hws[JH7100_CLK_PLL2_REF] = starfive_clk_mux(priv, "pll2_refclk", 0x4c, 1, pll2_refclk_sels, ARRAY_SIZE(pll2_refclk_sels)); - - hws[JH7100_CLK_CPU_CORE] = starfive_clk_fixed_factor(priv, "cpu_core", "cpunbus_root_div", 1, 1); - hws[JH7100_CLK_CPU_AXI] = starfive_clk_fixed_factor(priv, "cpu_axi", "cpu_core", 1, 2); - hws[JH7100_CLK_AHB_BUS] = starfive_clk_fixed_factor(priv, "ahb_bus", "cpunbus_root_div", 1, 4); - hws[JH7100_CLK_APB1_BUS] = starfive_clk_fixed_factor(priv, "apb1_bus", "ahb_bus", 1, 2); - hws[JH7100_CLK_APB2_BUS] = starfive_clk_fixed_factor(priv, "apb2_bus", "ahb_bus", 1, 2); - - #if 0 - hws[JH7100_CLK_CPU_CORE] = starfive_clk_divider_o(priv, "cpu_core", UNKNOWN, 0x50, 4); - hws[JH7100_CLK_CPU_AXI] = starfive_clk_divider_o(priv, "cpu_axi", UNKNOWN, 0x54, 4); - hws[JH7100_CLK_AHB_BUS] = starfive_clk_divider_o(priv, "ahb_bus", UNKNOWN, 0x58, 4); - hws[JH7100_CLK_APB1_BUS] = starfive_clk_divider_o(priv, "apb1_bus", UNKNOWN, 0x5c, 4); - hws[JH7100_CLK_APB2_BUS] = starfive_clk_divider_o(priv, "apb2_bus", UNKNOWN, 0x60, 4); - hws[JH7100_CLK_DOM3AHB_BUS] = starfive_clk_gate(priv, "dom3ahb_bus", UNKNOWN, 0x64); - hws[JH7100_CLK_DOM7AHB_BUS] = starfive_clk_gate(priv, "dom7ahb_bus", UNKNOWN, 0x68); - hws[JH7100_CLK_U74_CORE0] = starfive_clk_gate(priv, "u74_core0", UNKNOWN, 0x6c); - hws[JH7100_CLK_U74_CORE1] = starfive_clk_gated_divider(priv, "u74_core1", UNKNOWN, 0x70, 4); - hws[JH7100_CLK_U74_AXI] = starfive_clk_gate(priv, "u74_axi", UNKNOWN, 0x74); - hws[JH7100_CLK_U74RTC_TOGGLE] = starfive_clk_gate(priv, "u74rtc_toggle", UNKNOWN, 0x78); - hws[JH7100_CLK_SGDMA2P_AXI] = starfive_clk_gate(priv, "sgdma2p_axi", UNKNOWN, 0x7c); - hws[JH7100_CLK_DMA2PNOC_AXI] = starfive_clk_gate(priv, "dma2pnoc_axi", UNKNOWN, 0x80); - hws[JH7100_CLK_SGDMA2P_AHB] = starfive_clk_gate(priv, "sgdma2p_ahb", UNKNOWN, 0x84); - hws[JH7100_CLK_DLA_BUS] = starfive_clk_divider_o(priv, "dla_bus", UNKNOWN, 0x88, 3); - hws[JH7100_CLK_DLA_AXI] = starfive_clk_gate(priv, "dla_axi", UNKNOWN, 0x8c); - hws[JH7100_CLK_DLANOC_AXI] = starfive_clk_gate(priv, "dlanoc_axi", UNKNOWN, 0x90); - hws[JH7100_CLK_DLA_APB] = starfive_clk_gate(priv, "dla_apb", UNKNOWN, 0x94); - hws[JH7100_CLK_VP6_CORE] = starfive_clk_gated_divider(priv, "vp6_core", UNKNOWN, 0x98, 3); - hws[JH7100_CLK_VP6BUS_SRC] = starfive_clk_divider_o(priv, "vp6bus_src", UNKNOWN, 0x9c, 3); - hws[JH7100_CLK_VP6_AXI] = starfive_clk_gated_divider(priv, "vp6_axi", UNKNOWN, 0xa0, 3); - hws[JH7100_CLK_VCDECBUS_SRC] = starfive_clk_divider_o(priv, "vcdecbus_src", UNKNOWN, 0xa4, 3); - hws[JH7100_CLK_VDEC_BUS] = starfive_clk_divider_o(priv, "vdec_bus", UNKNOWN, 0xa8, 4); - hws[JH7100_CLK_VDEC_AXI] = starfive_clk_gate(priv, "vdec_axi", UNKNOWN, 0xac); - hws[JH7100_CLK_VDECBRG_MAIN] = starfive_clk_gate(priv, "vdecbrg_mainclk", UNKNOWN, 0xb0); - hws[JH7100_CLK_VDEC_BCLK] = starfive_clk_gated_divider(priv, "vdec_bclk", UNKNOWN, 0xb4, 4); - hws[JH7100_CLK_VDEC_CCLK] = starfive_clk_gated_divider(priv, "vdec_cclk", UNKNOWN, 0xb8, 4); - hws[JH7100_CLK_VDEC_APB] = starfive_clk_gate(priv, "vdec_apb", UNKNOWN, 0xbc); - hws[JH7100_CLK_JPEG_AXI] = starfive_clk_gated_divider(priv, "jpeg_axi", UNKNOWN, 0xc0, 4); - hws[JH7100_CLK_JPEG_CCLK] = starfive_clk_gated_divider(priv, "jpeg_cclk", UNKNOWN, 0xc4, 4); - hws[JH7100_CLK_JPEG_APB] = starfive_clk_gate(priv, "jpeg_apb", UNKNOWN, 0xc8); - hws[JH7100_CLK_GC300_2X] = starfive_clk_gated_divider(priv, "gc300_2x", UNKNOWN, 0xcc, 4); - hws[JH7100_CLK_GC300_AHB] = starfive_clk_gate(priv, "gc300_ahb", UNKNOWN, 0xd0); - hws[JH7100_CLK_JPCGC300_AXIBUS] = starfive_clk_divider_o(priv, "jpcgc300_axibus", UNKNOWN, 0xd4, 4); - hws[JH7100_CLK_GC300_AXI] = starfive_clk_gate(priv, "gc300_axi", UNKNOWN, 0xd8); - hws[JH7100_CLK_JPCGC300_MAIN] = starfive_clk_gate(priv, "jpcgc300_mainclk", UNKNOWN, 0xdc); - hws[JH7100_CLK_VENC_BUS] = starfive_clk_divider_o(priv, "venc_bus", UNKNOWN, 0xe0, 4); - hws[JH7100_CLK_VENC_AXI] = starfive_clk_gate(priv, "venc_axi", UNKNOWN, 0xe4); - hws[JH7100_CLK_VENCBRG_MAIN] = starfive_clk_gate(priv, "vencbrg_mainclk", UNKNOWN, 0xe8); - hws[JH7100_CLK_VENC_BCLK] = starfive_clk_gated_divider(priv, "venc_bclk", UNKNOWN, 0xec, 4); - hws[JH7100_CLK_VENC_CCLK] = starfive_clk_gated_divider(priv, "venc_cclk", UNKNOWN, 0xf0, 4); - hws[JH7100_CLK_VENC_APB] = starfive_clk_gate(priv, "venc_apb", UNKNOWN, 0xf4); - hws[JH7100_CLK_DDRPLL_DIV2] = starfive_clk_gated_divider(priv, "ddrpll_div2", UNKNOWN, 0xf8, 2); - hws[JH7100_CLK_DDRPLL_DIV4] = starfive_clk_gated_divider(priv, "ddrpll_div4", UNKNOWN, 0xfc, 2); - hws[JH7100_CLK_DDRPLL_DIV8] = starfive_clk_gated_divider(priv, "ddrpll_div8", UNKNOWN, 0x100, 2); - hws[JH7100_CLK_DDROSC_DIV2] = starfive_clk_gated_divider(priv, "ddrosc_div2", UNKNOWN, 0x104, 2); - hws[JH7100_CLK_DDRC0] = starfive_clk_mux(priv, "ddrc0", 0x108, 2, ddrc0_sels, ARRAY_SIZE(ddrc0_sels)); - hws[JH7100_CLK_DDRC1] = starfive_clk_mux(priv, "ddrc1", 0x10c, 2, ddrc1_sels, ARRAY_SIZE(ddrc1_sels)); - hws[JH7100_CLK_DDRPHY_APB] = starfive_clk_gate(priv, "ddrphy_apb", UNKNOWN, 0x110); - hws[JH7100_CLK_NOC_ROB] = starfive_clk_divider_o(priv, "noc_rob", UNKNOWN, 0x114, 4); - hws[JH7100_CLK_NOC_COG] = starfive_clk_divider_o(priv, "noc_cog", UNKNOWN, 0x118, 4); - hws[JH7100_CLK_NNE_AHB] = starfive_clk_gate(priv, "nne_ahb", UNKNOWN, 0x11c); - hws[JH7100_CLK_NNEBUS_SRC1] = starfive_clk_divider_o(priv, "nnebus_src1", UNKNOWN, 0x120, 3); - hws[JH7100_CLK_NNE_BUS] = starfive_clk_mux(priv, "nne_bus", 0x124, 2, nne_bus_sels, ARRAY_SIZE(nne_bus_sels)); - hws[JH7100_CLK_NNE_AXI] = starfive_clk_gate(priv, "nne_axi", UNKNOWN, 0x128); - hws[JH7100_CLK_NNENOC_AXI] = starfive_clk_gate(priv, "nnenoc_axi", UNKNOWN, 0x12c); - hws[JH7100_CLK_DLASLV_AXI] = starfive_clk_gate(priv, "dlaslv_axi", UNKNOWN, 0x130); - hws[JH7100_CLK_DSPX2C_AXI] = starfive_clk_gate(priv, "dspx2c_axi", UNKNOWN, 0x134); - hws[JH7100_CLK_HIFI4_SRC] = starfive_clk_divider_o(priv, "hifi4_src", UNKNOWN, 0x138, 3); - hws[JH7100_CLK_HIFI4_COREFREE] = starfive_clk_divider_o(priv, "hifi4_corefree", UNKNOWN, 0x13c, 4); - hws[JH7100_CLK_HIFI4_CORE] = starfive_clk_gate(priv, "hifi4_core", UNKNOWN, 0x140); - hws[JH7100_CLK_HIFI4_BUS] = starfive_clk_divider_o(priv, "hifi4_bus", UNKNOWN, 0x144, 4); - hws[JH7100_CLK_HIFI4_AXI] = starfive_clk_gate(priv, "hifi4_axi", UNKNOWN, 0x148); - hws[JH7100_CLK_HIFI4NOC_AXI] = starfive_clk_gate(priv, "hifi4noc_axi", UNKNOWN, 0x14c); - hws[JH7100_CLK_SGDMA1P_BUS] = starfive_clk_divider_o(priv, "sgdma1p_bus", UNKNOWN, 0x150, 4); - hws[JH7100_CLK_SGDMA1P_AXI] = starfive_clk_gate(priv, "sgdma1p_axi", UNKNOWN, 0x154); - hws[JH7100_CLK_DMA1P_AXI] = starfive_clk_gate(priv, "dma1p_axi", UNKNOWN, 0x158); - hws[JH7100_CLK_X2C_AXI] = starfive_clk_gated_divider(priv, "x2c_axi", UNKNOWN, 0x15c, 4); - hws[JH7100_CLK_USB_BUS] = starfive_clk_divider_o(priv, "usb_bus", UNKNOWN, 0x160, 4); - hws[JH7100_CLK_USB_AXI] = starfive_clk_gate(priv, "usb_axi", UNKNOWN, 0x164); - hws[JH7100_CLK_USBNOC_AXI] = starfive_clk_gate(priv, "usbnoc_axi", UNKNOWN, 0x168); - hws[JH7100_CLK_USBPHY_ROOTDIV] = starfive_clk_divider_o(priv, "usbphy_rootdiv", UNKNOWN, 0x16c, 3); - hws[JH7100_CLK_USBPHY_125M] = starfive_clk_gated_divider(priv, "usbphy_125m", UNKNOWN, 0x170, 4); - hws[JH7100_CLK_USBPHY_PLLDIV25M] = starfive_clk_gated_divider(priv, "usbphy_plldiv25m", UNKNOWN, 0x174, 6); - hws[JH7100_CLK_USBPHY_25M] = starfive_clk_mux(priv, "usbphy_25m", 0x178, 1, usbphy_25m_sels, ARRAY_SIZE(usbphy_25m_sels)); - #endif - - //hws[JH7100_CLK_AUDIO_DIV] = starfive_clk_divider(priv, "audio_div", "audio_root", 0x17c, 18); - //1000M ====> 24.576M, use fixed factor to replace the 40.69 divider. - hws[JH7100_CLK_AUDIO_DIV] = starfive_clk_fixed_factor(priv, "audio_div", "audio_root", 384, 15625); - hws[JH7100_CLK_AUDIO_SRC] = starfive_clk_gate(priv, "audio_src", "audio_div", 0x180); - hws[JH7100_CLK_AUDIO_12288] = starfive_clk_gate(priv, "audio_12288", "audio_src_12288", 0x184); - - hws[JH7100_CLK_VIN_SRC] = starfive_clk_gated_divider(priv, "vin_src", "vin_root", 0x188, 3); - hws[JH7100_CLK_ISP0_BUS] = starfive_clk_divider_o(priv, "isp0_bus", "vin_src", 0x18c, 4); - hws[JH7100_CLK_ISP0_AXI] = starfive_clk_gate(priv, "isp0_axi", "isp0_bus", 0x190); - hws[JH7100_CLK_ISP0NOC_AXI] = starfive_clk_gate(priv, "isp0noc_axi", "isp0_bus", 0x194); - hws[JH7100_CLK_ISPSLV_AXI] = starfive_clk_gate(priv, "ispslv_axi", "isp0_bus", 0x198); - hws[JH7100_CLK_ISP1_BUS] = starfive_clk_divider_o(priv, "isp1_bus", "vin_src", 0x19c, 4); - hws[JH7100_CLK_ISP1_AXI] = starfive_clk_gate(priv, "isp1_axi", "isp1_bus", 0x1a0); - hws[JH7100_CLK_ISP1NOC_AXI] = starfive_clk_gate(priv, "isp1noc_axi", "isp1_bus", 0x1a4); - hws[JH7100_CLK_VIN_BUS] = starfive_clk_divider_o(priv, "vin_bus", "vin_src", 0x1a8, 4); - hws[JH7100_CLK_VIN_AXI] = starfive_clk_gate(priv, "vin_axi", "vin_bus", 0x1ac); - hws[JH7100_CLK_VINNOC_AXI] = starfive_clk_gate(priv, "vinnoc_axi", "vin_bus", 0x1b0); - - #if 0 - hws[JH7100_CLK_VOUT_SRC] = starfive_clk_gated_divider(priv, "vout_src", UNKNOWN, 0x1b4, 3); - hws[JH7100_CLK_DISPBUS_SRC] = starfive_clk_divider_o(priv, "dispbus_src", UNKNOWN, 0x1b8, 3); - hws[JH7100_CLK_DISP_BUS] = starfive_clk_divider_o(priv, "disp_bus", UNKNOWN, 0x1bc, 3); - hws[JH7100_CLK_DISP_AXI] = starfive_clk_gate(priv, "disp_axi", UNKNOWN, 0x1c0); - hws[JH7100_CLK_DISPNOC_AXI] = starfive_clk_gate(priv, "dispnoc_axi", UNKNOWN, 0x1c4); - hws[JH7100_CLK_SDIO0_AHB] = starfive_clk_gate(priv, "sdio0_ahb", UNKNOWN, 0x1c8); - hws[JH7100_CLK_SDIO0_CCLKINT] = starfive_clk_gated_divider(priv, "sdio0_cclkint", UNKNOWN, 0x1cc, 5); - hws[JH7100_CLK_SDIO0_CCLKINT_INV] = starfive_clk_gate_dis(priv, "sdio0_cclkint_inv", UNKNOWN, 0x1d0); - hws[JH7100_CLK_SDIO1_AHB] = starfive_clk_gate(priv, "sdio1_ahb", UNKNOWN, 0x1d4); - hws[JH7100_CLK_SDIO1_CCLKINT] = starfive_clk_gated_divider(priv, "sdio1_cclkint", UNKNOWN, 0x1d8, 5); - hws[JH7100_CLK_SDIO1_CCLKINT_INV] = starfive_clk_gate_dis(priv, "sdio1_cclkint_inv", UNKNOWN, 0x1dc); - hws[JH7100_CLK_GMAC_AHB] = starfive_clk_gate(priv, "gmac_ahb", UNKNOWN, 0x1e0); - hws[JH7100_CLK_GMAC_ROOT_DIV] = starfive_clk_divider_o(priv, "gmac_root_div", UNKNOWN, 0x1e4, 4); - hws[JH7100_CLK_GMAC_PTP_REF] = starfive_clk_gated_divider(priv, "gmac_ptp_refclk", UNKNOWN, 0x1e8, 5); - hws[JH7100_CLK_GMAC_GTX] = starfive_clk_gated_divider(priv, "gmac_gtxclk", UNKNOWN, 0x1ec, 8); - hws[JH7100_CLK_GMAC_RMII_TX] = starfive_clk_gated_divider(priv, "gmac_rmii_txclk", UNKNOWN, 0x1f0, 4); - hws[JH7100_CLK_GMAC_RMII_RX] = starfive_clk_gated_divider(priv, "gmac_rmii_rxclk", UNKNOWN, 0x1f4, 4); - hws[JH7100_CLK_GMAC_TX] = starfive_clk_mux(priv, "gmac_tx", 0x1f8, 2, gmac_tx_sels, ARRAY_SIZE(gmac_tx_sels)); - hws[JH7100_CLK_GMAC_TX_INV] = starfive_clk_gate_dis(priv, "gmac_tx_inv", UNKNOWN, 0x1fc); - hws[JH7100_CLK_GMAC_RX_PRE] = starfive_clk_mux(priv, "gmac_rx_pre", 0x200, 1, gmac_rx_pre_sels, ARRAY_SIZE(gmac_rx_pre_sels)); - hws[JH7100_CLK_GMAC_RX_INV] = starfive_clk_gate_dis(priv, "gmac_rx_inv", UNKNOWN, 0x204); - hws[JH7100_CLK_GMAC_RMII] = starfive_clk_gate(priv, "gmac_rmii", UNKNOWN, 0x208); - hws[JH7100_CLK_GMAC_TOPHYREF] = starfive_clk_gated_divider(priv, "gmac_tophyref", UNKNOWN, 0x20c, 7); - hws[JH7100_CLK_SPI2AHB_AHB] = starfive_clk_gate(priv, "spi2ahb_ahb", UNKNOWN, 0x210); - hws[JH7100_CLK_SPI2AHB_CORE] = starfive_clk_gated_divider(priv, "spi2ahb_core", UNKNOWN, 0x214, 5); - hws[JH7100_CLK_EZMASTER_AHB] = starfive_clk_gate(priv, "ezmaster_ahb", UNKNOWN, 0x218); - hws[JH7100_CLK_E24_AHB] = starfive_clk_gate(priv, "e24_ahb", UNKNOWN, 0x21c); - hws[JH7100_CLK_E24RTC_TOGGLE] = starfive_clk_gate(priv, "e24rtc_toggle", UNKNOWN, 0x220); - hws[JH7100_CLK_QSPI_AHB] = starfive_clk_gate(priv, "qspi_ahb", UNKNOWN, 0x224); - hws[JH7100_CLK_QSPI_APB] = starfive_clk_gate(priv, "qspi_apb", UNKNOWN, 0x228); - hws[JH7100_CLK_QSPI_REF] = starfive_clk_gated_divider(priv, "qspi_refclk", UNKNOWN, 0x22c, 5); - hws[JH7100_CLK_SEC_AHB] = starfive_clk_gate(priv, "sec_ahb", UNKNOWN, 0x230); - hws[JH7100_CLK_AES] = starfive_clk_gate(priv, "aes_clk", UNKNOWN, 0x234); - hws[JH7100_CLK_SHA] = starfive_clk_gate(priv, "sha_clk", UNKNOWN, 0x238); - hws[JH7100_CLK_PKA] = starfive_clk_gate(priv, "pka_clk", UNKNOWN, 0x23c); - hws[JH7100_CLK_TRNG_APB] = starfive_clk_gate(priv, "trng_apb", UNKNOWN, 0x240); - hws[JH7100_CLK_OTP_APB] = starfive_clk_gate(priv, "otp_apb", UNKNOWN, 0x244); - hws[JH7100_CLK_UART0_APB] = starfive_clk_gate(priv, "uart0_apb", UNKNOWN, 0x248); - hws[JH7100_CLK_UART0_CORE] = starfive_clk_gated_divider(priv, "uart0_core", UNKNOWN, 0x24c, 6); - hws[JH7100_CLK_UART1_APB] = starfive_clk_gate(priv, "uart1_apb", UNKNOWN, 0x250); - hws[JH7100_CLK_UART1_CORE] = starfive_clk_gated_divider(priv, "uart1_core", UNKNOWN, 0x254, 6); - hws[JH7100_CLK_SPI0_APB] = starfive_clk_gate(priv, "spi0_apb", UNKNOWN, 0x258); - hws[JH7100_CLK_SPI0_CORE] = starfive_clk_gated_divider(priv, "spi0_core", UNKNOWN, 0x25c, 6); - hws[JH7100_CLK_SPI1_APB] = starfive_clk_gate(priv, "spi1_apb", UNKNOWN, 0x260); - hws[JH7100_CLK_SPI1_CORE] = starfive_clk_gated_divider(priv, "spi1_core", UNKNOWN, 0x264, 6); - hws[JH7100_CLK_I2C0_APB] = starfive_clk_gate(priv, "i2c0_apb", UNKNOWN, 0x268); - hws[JH7100_CLK_I2C0_CORE] = starfive_clk_gated_divider(priv, "i2c0_core", UNKNOWN, 0x26c, 6); - hws[JH7100_CLK_I2C1_APB] = starfive_clk_gate(priv, "i2c1_apb", UNKNOWN, 0x270); - hws[JH7100_CLK_I2C1_CORE] = starfive_clk_gated_divider(priv, "i2c1_core", UNKNOWN, 0x274, 6); - hws[JH7100_CLK_GPIO_APB] = starfive_clk_gate(priv, "gpio_apb", UNKNOWN, 0x278); - hws[JH7100_CLK_UART2_APB] = starfive_clk_gate(priv, "uart2_apb", UNKNOWN, 0x27c); - hws[JH7100_CLK_UART2_CORE] = starfive_clk_gated_divider(priv, "uart2_core", UNKNOWN, 0x280, 6); - hws[JH7100_CLK_UART3_APB] = starfive_clk_gate(priv, "uart3_apb", UNKNOWN, 0x284); - hws[JH7100_CLK_UART3_CORE] = starfive_clk_gated_divider(priv, "uart3_core", UNKNOWN, 0x288, 6); - hws[JH7100_CLK_SPI2_APB] = starfive_clk_gate(priv, "spi2_apb", UNKNOWN, 0x28c); - hws[JH7100_CLK_SPI2_CORE] = starfive_clk_gated_divider(priv, "spi2_core", UNKNOWN, 0x290, 6); - hws[JH7100_CLK_SPI3_APB] = starfive_clk_gate(priv, "spi3_apb", UNKNOWN, 0x294); - hws[JH7100_CLK_SPI3_CORE] = starfive_clk_gated_divider(priv, "spi3_core", UNKNOWN, 0x298, 6); - hws[JH7100_CLK_I2C2_APB] = starfive_clk_gate(priv, "i2c2_apb", UNKNOWN, 0x29c); - hws[JH7100_CLK_I2C2_CORE] = starfive_clk_gated_divider(priv, "i2c2_core", UNKNOWN, 0x2a0, 6); - hws[JH7100_CLK_I2C3_APB] = starfive_clk_gate(priv, "i2c3_apb", UNKNOWN, 0x2a4); - hws[JH7100_CLK_I2C3_CORE] = starfive_clk_gated_divider(priv, "i2c3_core", UNKNOWN, 0x2a8, 6); - hws[JH7100_CLK_WDTIMER_APB] = starfive_clk_gate(priv, "wdtimer_apb", UNKNOWN, 0x2ac); - hws[JH7100_CLK_WDT_CORE] = starfive_clk_gated_divider(priv, "wdt_coreclk", UNKNOWN, 0x2b0, 6); - hws[JH7100_CLK_TIMER0_CORE] = starfive_clk_gated_divider(priv, "timer0_coreclk", UNKNOWN, 0x2b4, 6); - hws[JH7100_CLK_TIMER1_CORE] = starfive_clk_gated_divider(priv, "timer1_coreclk", UNKNOWN, 0x2b8, 6); - hws[JH7100_CLK_TIMER2_CORE] = starfive_clk_gated_divider(priv, "timer2_coreclk", UNKNOWN, 0x2bc, 6); - hws[JH7100_CLK_TIMER3_CORE] = starfive_clk_gated_divider(priv, "timer3_coreclk", UNKNOWN, 0x2c0, 6); - hws[JH7100_CLK_TIMER4_CORE] = starfive_clk_gated_divider(priv, "timer4_coreclk", UNKNOWN, 0x2c4, 6); - hws[JH7100_CLK_TIMER5_CORE] = starfive_clk_gated_divider(priv, "timer5_coreclk", UNKNOWN, 0x2c8, 6); - hws[JH7100_CLK_TIMER6_CORE] = starfive_clk_gated_divider(priv, "timer6_coreclk", UNKNOWN, 0x2cc, 6); - hws[JH7100_CLK_VP6INTC_APB] = starfive_clk_gate(priv, "vp6intc_apb", UNKNOWN, 0x2d0); - hws[JH7100_CLK_PWM_APB] = starfive_clk_gate(priv, "pwm_apb", UNKNOWN, 0x2d4); - hws[JH7100_CLK_MSI_APB] = starfive_clk_gate(priv, "msi_apb", UNKNOWN, 0x2d8); - hws[JH7100_CLK_TEMP_APB] = starfive_clk_gate(priv, "temp_apb", UNKNOWN, 0x2dc); - hws[JH7100_CLK_TEMP_SENSE] = starfive_clk_gated_divider(priv, "temp_sense", UNKNOWN, 0x2e0, 5); - hws[JH7100_CLK_SYSERR_APB] = starfive_clk_gate(priv, "syserr_apb", UNKNOWN, 0x2e4); - #endif - - hws[JH7100_CLK_SDIO0_AHB] = starfive_clk_gate(priv, "sdio0_ahb", "ahb_bus", 0x1c8); - hws[JH7100_CLK_SDIO0_CCLKINT] = starfive_clk_gated_divider(priv, "sdio0_cclkint", "perh0_src", 0x1cc, 5); - hws[JH7100_CLK_SDIO0_CCLKINT_INV] = starfive_clk_gate_dis(priv, "sdio0_cclkint_inv", "sdio0_cclkint", 0x1d0); - hws[JH7100_CLK_SDIO1_AHB] = starfive_clk_gate(priv, "sdio1_ahb", "ahb_bus", 0x1d4); - hws[JH7100_CLK_SDIO1_CCLKINT] = starfive_clk_gated_divider(priv, "sdio1_cclkint", "perh1_src", 0x1d8, 5); - hws[JH7100_CLK_SDIO1_CCLKINT_INV] = starfive_clk_gate_dis(priv, "sdio1_cclkint_inv", "sdio1_cclkint", 0x1dc); - - hws[JH7100_CLK_GMAC_AHB] = starfive_clk_gate(priv, "gmac_ahb", "ahb_bus", 0x1e0); - hws[JH7100_CLK_GMAC_ROOT_DIV] = starfive_clk_divider(priv, "gmac_root_div", "gmacusb_root", 0x1e4, 4); - //hws[JH7100_CLK_GMAC_PTP_REF] = starfive_clk_gated_divider(priv, "gmac_ptp_refclk", "gmac_root_div", 0x1e8, 5); - hws[JH7100_CLK_GMAC_GTX] = starfive_clk_gated_divider(priv, "gmac_gtxclk", "gmac_root_div", 0x1ec, 8); - //hws[JH7100_CLK_GMAC_RMII_TX] = starfive_clk_gated_divider(priv, "gmac_rmii_txclk", "gmac_rmii_ref", 0x1f0, 4); - //hws[JH7100_CLK_GMAC_RMII_RX] = starfive_clk_gated_divider(priv, "gmac_rmii_rxclk", "gmac_rmii_ref", 0x1f4, 4); - //hws[JH7100_CLK_GMAC_TX] = starfive_clk_mux(priv, "gmac_tx", 0x1f8, 2, gmac_tx_sels, ARRAY_SIZE(gmac_tx_sels)); - //hws[JH7100_CLK_GMAC_TX_INV] = starfive_clk_gate_dis(priv, "gmac_tx_inv", UNKNOWN, 0x1fc); - //hws[JH7100_CLK_GMAC_RX_PRE] = starfive_clk_mux(priv, "gmac_rx_pre", 0x200, 1, gmac_rx_pre_sels, ARRAY_SIZE(gmac_rx_pre_sels)); - //hws[JH7100_CLK_GMAC_RX_INV] = starfive_clk_gate_dis(priv, "gmac_rx_inv", UNKNOWN, 0x204); - //hws[JH7100_CLK_GMAC_RMII] = starfive_clk_gate(priv, "gmac_rmii", UNKNOWN, 0x208); - //hws[JH7100_CLK_GMAC_TOPHYREF] = starfive_clk_gated_divider(priv, "gmac_tophyref", UNKNOWN, 0x20c, 7); - - hws[JH7100_CLK_WDTIMER_APB] = starfive_clk_gate(priv, "wdtimer_apb", "apb2_bus", 0x2ac); - hws[JH7100_CLK_WDT_CORE] = starfive_clk_gated_divider(priv, "wdt_coreclk", "perh0_src", 0x2b0, 6); - - hws[JH7100_CLK_UART0_APB] = starfive_clk_gate(priv, "uart0_apb", "apb1_bus", 0x248); - hws[JH7100_CLK_UART0_CORE] = starfive_clk_gated_divider(priv, "uart0_core", "perh1_src", 0x24c, 6); - hws[JH7100_CLK_UART1_APB] = starfive_clk_gate(priv, "uart1_apb", "apb1_bus", 0x250); - hws[JH7100_CLK_UART1_CORE] = starfive_clk_gated_divider(priv, "uart1_core", "perh1_src", 0x254, 6); - - hws[JH7100_CLK_I2C0_APB] = starfive_clk_gate(priv, "i2c0_apb", "apb1_bus", 0x268); - hws[JH7100_CLK_I2C0_CORE] = starfive_clk_gated_divider(priv, "i2c0_core", "perh1_src", 0x26c, 6); - hws[JH7100_CLK_I2C1_APB] = starfive_clk_gate(priv, "i2c1_apb", "apb1_bus", 0x270); - hws[JH7100_CLK_I2C1_CORE] = starfive_clk_gated_divider(priv, "i2c1_core", "perh1_src", 0x274, 6); - - hws[JH7100_CLK_UART2_APB] = starfive_clk_gate(priv, "uart2_apb", "apb2_bus", 0x27c); - hws[JH7100_CLK_UART2_CORE] = starfive_clk_gated_divider(priv, "uart2_core", "perh0_src", 0x280, 6); - hws[JH7100_CLK_UART3_APB] = starfive_clk_gate(priv, "uart3_apb", "apb2_bus", 0x284); - hws[JH7100_CLK_UART3_CORE] = starfive_clk_gated_divider(priv, "uart3_core", "perh0_src", 0x288, 6); - - hws[JH7100_CLK_I2C2_APB] = starfive_clk_gate(priv, "i2c2_apb", "apb2_bus", 0x29c); - hws[JH7100_CLK_I2C2_CORE] = starfive_clk_gated_divider(priv, "i2c2_core", "perh0_src", 0x2a0, 6); - hws[JH7100_CLK_I2C3_APB] = starfive_clk_gate(priv, "i2c3_apb", "apb2_bus", 0x2a4); - hws[JH7100_CLK_I2C3_CORE] = starfive_clk_gated_divider(priv, "i2c3_core", "perh0_src", 0x2a8, 6); - - for (i = 0; i < JH7100_CLK_SYS_MAX; i++) - if (IS_ERR(hws[i])) { - dev_err(priv->dev, "clock %d failed to register\n", i); - ret = PTR_ERR(hws[i]); - goto err_clk_register; - } + struct jh7100_clk *clk = jh7100_clk_from(hw); + u32 value = (u32)index << JH7100_CLK_MUX_SHIFT; + jh7100_clk_reg_rmw(clk, JH7100_CLK_MUX_MASK, value); return 0; - -err_clk_register: - for (i = 0; i < JH7100_CLK_SYS_MAX; i++) - if (hws[i] && !IS_ERR(hws[i])) - clk_hw_unregister(hws[i]); - - return ret; } -static int __init starfive_clkgen_audio_init(struct clk_starfive_jh7100_priv *priv) +static int jh7100_clk_mux_determine_rate(struct clk_hw *hw, + struct clk_rate_request *req) { - struct clk_hw **hws = priv->clk_hws.hws; - int i; - int ret; - - hws[JH7100_CLK_ADC_MCLK] = starfive_clk_composite(priv, "adc_mclk", audio_clk_sels, ARRAY_SIZE(audio_clk_sels), 0x0, 1, 1, 4); - hws[JH7100_CLK_I2S1_MCLK] = starfive_clk_composite(priv, "i2s1_mclk", audio_clk_sels, ARRAY_SIZE(audio_clk_sels), 0x4, 1, 1, 4); - hws[JH7100_CLK_APB_I2SADC_EN] = starfive_clk_gate(priv, "i2sadc_apb", "apb2_bus", 0x8); - hws[JH7100_CLK_I2SADC_BCLK] = starfive_clk_composite(priv, "i2sadc_bclk", i2sadc_bclk_sels, ARRAY_SIZE(i2sadc_bclk_sels), 0xc, 1, 0, 5); - hws[JH7100_CLK_I2SADC_BCLK_INV] = starfive_clk_gate_dis(priv, "i2sadc_bclk_n", "i2sadc_bclk", 0x10); - hws[JH7100_CLK_I2SADC_LRCLK] = starfive_clk_composite(priv, "i2sadc_lrclk", i2sadc_lrclk_sels, ARRAY_SIZE(i2sadc_lrclk_sels), 0x14, 2, 0, 6); - hws[JH7100_CLK_APB_PDM_EN] = starfive_clk_gate(priv, "pdm_apb", "apb2_bus", 0x18); - hws[JH7100_CLK_PDM_MCLK] = starfive_clk_composite(priv, "pdm_mclk", audio_clk_sels, ARRAY_SIZE(audio_clk_sels), 0x1c, 1, 1, 4); - hws[JH7100_CLK_APB_I2SVAD_EN] = starfive_clk_gate(priv, "i2svad_apb", "apb2_bus", 0x20); - hws[JH7100_CLK_SPDIF] = starfive_clk_composite(priv, "spdif_mclk", audio_clk_sels, ARRAY_SIZE(audio_clk_sels), 0x24, 1, 1, 4); - hws[JH7100_CLK_APB_SPDIF_EN] = starfive_clk_gate(priv, "spdif_apb", "apb2_bus", 0x28); - hws[JH7100_CLK_APB_PWMDAC_EN] = starfive_clk_gate(priv, "pwmdac_apb", "apb2_bus", 0x2c); - hws[JH7100_CLK_DAC_MCLK] = starfive_clk_composite(priv, "dac_mclk", audio_clk_sels, ARRAY_SIZE(audio_clk_sels), 0x30, 1, 1, 4); - hws[JH7100_CLK_APB_I2S0_EN] = starfive_clk_gate(priv, "i2sdac_apb", "apb2_bus", 0x34); - hws[JH7100_CLK_I2S0_BCLK] = starfive_clk_composite(priv, "i2sdac0_bclk", i2sdac0_bclk_sels, ARRAY_SIZE(i2sdac0_bclk_sels), 0x38, 1, 0, 5); - hws[JH7100_CLK_I2S0_BCLK_INV] = starfive_clk_gate_dis(priv, "clk_i2sdac0_bclk_n", "clk_i2sdac0_bclk", 0x3c); - hws[JH7100_CLK_I2S0_LRCLK] = starfive_clk_composite(priv, "i2sdac0_lrclk", i2sdac0_lrclk_sels, ARRAY_SIZE(i2sdac0_lrclk_sels), 0x40, 2, 0, 6); - hws[JH7100_CLK_APB_I2S1_EN] = starfive_clk_gate(priv, "i2s1_apb", "apb2_bus", 0x44); - hws[JH7100_CLK_I2S1_BCLK] = starfive_clk_composite(priv, "i2sdac1_bclk", i2sdac1_bclk_sels, ARRAY_SIZE(i2sdac1_bclk_sels), 0x48, 1, 0, 5); - hws[JH7100_CLK_I2S1_BCLK_INV] = starfive_clk_gate_dis(priv, "clk_i2sdac1_bclk_n", "clk_i2sdac1_bclk", 0x4c); - hws[JH7100_CLK_I2S1_LRCLK] = starfive_clk_composite(priv, "i2sdac1_lrclk", i2sdac1_lrclk_sels, ARRAY_SIZE(i2sdac1_lrclk_sels), 0x50, 2, 0, 6); - - //ext clk - hws[JH7100_CLK_ADC_BCLK_IO] = starfive_clk_fixed_rate(priv, "i2sadc_bclk_iopad", NULL, 12288000); - hws[JH7100_CLK_ADC_LRCLK_IO] = starfive_clk_fixed_rate(priv, "i2sadc_lrclk_iopad", NULL, 12288000); - hws[JH7100_CLK_DAC0_BCLK_IO] = starfive_clk_fixed_rate(priv, "i2sdac0_bclk_iopad", NULL, 12288000); - hws[JH7100_CLK_DAC0_LRCLK_IO] = starfive_clk_fixed_rate(priv, "i2sdac0_lrclk_iopad", NULL, 12288000); - hws[JH7100_CLK_DAC1_BCLK_IO] = starfive_clk_fixed_rate(priv, "i2sadc1_bclk_iopad", NULL, 12288000); - hws[JH7100_CLK_DAC1_LRCLK_IO] = starfive_clk_fixed_rate(priv, "i2sdac1_lrclk_iopad", NULL, 12288000); - hws[JH7100_CLK_CODEC_EXT] = starfive_clk_fixed_rate(priv, "codec_ext_clock", NULL, 24576000); - hws[JH7100_CLK_AUD_12288] = starfive_clk_fixed_rate(priv, "audio_src_12288", NULL, 12288000); - - for (i = 0; i < JH7100_CLK_AUD_MAX; i++) - if (IS_ERR(hws[i])) { - dev_err(priv->dev, "clock %d failed to register\n", i); - ret = PTR_ERR(hws[i]); - goto err_clk_register; - } - - return 0; + return clk_mux_determine_rate_flags(hw, req, 0); +} -err_clk_register: - for (i = 0; i < JH7100_CLK_AUD_MAX; i++) - if (hws[i] && !IS_ERR(hws[i])) - clk_hw_unregister(hws[i]); +static int jh7100_clk_get_phase(struct clk_hw *hw) +{ + struct jh7100_clk *clk = jh7100_clk_from(hw); + u32 value = jh7100_clk_reg_get(clk); - return ret; + return (value & JH7100_CLK_INVERT) ? 180 : 0; } -static int __init starfive_clkgen_isp_init(struct clk_starfive_jh7100_priv *priv) +static int jh7100_clk_set_phase(struct clk_hw *hw, int degrees) { - struct clk_hw **hws = priv->clk_hws.hws; - int i; - int ret; + struct jh7100_clk *clk = jh7100_clk_from(hw); + u32 value; - for (i = 0; i < JH7100_CLK_ISP_MAX; i++) - if (IS_ERR(hws[i])) { - dev_err(priv->dev, "clock %d failed to register\n", i); - ret = PTR_ERR(hws[i]); - goto err_clk_register; - } + if (degrees == 0) + value = 0; + else if (degrees == 180) + value = JH7100_CLK_INVERT; + else + return -EINVAL; + jh7100_clk_reg_rmw(clk, JH7100_CLK_INVERT, value); return 0; - -err_clk_register: - for (i = 0; i < JH7100_CLK_ISP_MAX; i++) - if (hws[i] && !IS_ERR(hws[i])) - clk_hw_unregister(hws[i]); - - return ret; } -static int starfive_clk_sys_init(struct platform_device *pdev) +#ifdef CONFIG_DEBUG_FS +static void jh7100_clk_debug_init(struct clk_hw *hw, struct dentry *dentry) { - struct device *dev = &pdev->dev; - struct clk_starfive_jh7100_priv *priv; - int error; + static const struct debugfs_reg32 jh7100_clk_reg = { + .name = "CTRL", + .offset = 0, + }; + struct jh7100_clk *clk = jh7100_clk_from(hw); + struct jh7100_clk_priv *priv = jh7100_priv_from(clk); + struct debugfs_regset32 *regset; + + regset = devm_kzalloc(priv->dev, sizeof(*regset), GFP_KERNEL); + if (!regset) + return; + + regset->regs = &jh7100_clk_reg; + regset->nregs = 1; + regset->base = priv->base + 4 * clk->idx; + + debugfs_create_regset32("registers", 0400, dentry, regset); +} +#else +#define jh7100_clk_debug_init NULL +#endif + +static const struct clk_ops jh7100_clk_gate_ops = { + .enable = jh7100_clk_enable, + .disable = jh7100_clk_disable, + .is_enabled = jh7100_clk_is_enabled, + .debug_init = jh7100_clk_debug_init, +}; - priv = devm_kzalloc(dev, struct_size(priv, clk_hws.hws, JH7100_CLK_SYS_MAX), GFP_KERNEL); - if (!priv) - return -ENOMEM; +static const struct clk_ops jh7100_clk_div_ops = { + .recalc_rate = jh7100_clk_recalc_rate, + .determine_rate = jh7100_clk_determine_rate, + .set_rate = jh7100_clk_set_rate, + .debug_init = jh7100_clk_debug_init, +}; - priv->dev = dev; - priv->clk_hws.num = JH7100_CLK_SYS_MAX; - spin_lock_init(&priv->rmw_lock); +static const struct clk_ops jh7100_clk_gdiv_ops = { + .enable = jh7100_clk_enable, + .disable = jh7100_clk_disable, + .is_enabled = jh7100_clk_is_enabled, + .recalc_rate = jh7100_clk_recalc_rate, + .determine_rate = jh7100_clk_determine_rate, + .set_rate = jh7100_clk_set_rate, + .debug_init = jh7100_clk_debug_init, +}; - priv->base = devm_platform_ioremap_resource(pdev, 0); - if (IS_ERR(priv->base)) - return PTR_ERR(priv->base); +static const struct clk_ops jh7100_clk_mux_ops = { + .determine_rate = jh7100_clk_mux_determine_rate, + .set_parent = jh7100_clk_set_parent, + .get_parent = jh7100_clk_get_parent, + .debug_init = jh7100_clk_debug_init, +}; - error = starfive_clkgen_sys_init(priv); - if (error) - return error; +static const struct clk_ops jh7100_clk_gmux_ops = { + .enable = jh7100_clk_enable, + .disable = jh7100_clk_disable, + .is_enabled = jh7100_clk_is_enabled, + .determine_rate = jh7100_clk_mux_determine_rate, + .set_parent = jh7100_clk_set_parent, + .get_parent = jh7100_clk_get_parent, + .debug_init = jh7100_clk_debug_init, +}; - error = devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, - &priv->clk_hws); - if (error) - return error; +static const struct clk_ops jh7100_clk_inv_ops = { + .get_phase = jh7100_clk_get_phase, + .set_phase = jh7100_clk_set_phase, + .debug_init = jh7100_clk_debug_init, +}; - return 0; -} -static int __init starfive_clk_audio_init(struct platform_device *pdev) +static const struct clk_ops *__init jh7100_clk_ops(u32 max) { - struct device *dev = &pdev->dev; - struct clk_starfive_jh7100_priv *priv; - int error; + if (max & JH7100_CLK_DIV_MASK) { + if (max & JH7100_CLK_ENABLE) + return &jh7100_clk_gdiv_ops; + return &jh7100_clk_div_ops; + } - priv = devm_kzalloc(dev, struct_size(priv, clk_hws.hws, JH7100_CLK_AUD_MAX), GFP_KERNEL); - if (!priv) - return -ENOMEM; + if (max & JH7100_CLK_MUX_MASK) { + if (max & JH7100_CLK_ENABLE) + return &jh7100_clk_gmux_ops; + return &jh7100_clk_mux_ops; + } - priv->dev = dev; - priv->clk_hws.num = JH7100_CLK_AUD_MAX; - spin_lock_init(&priv->rmw_lock); + if (max & JH7100_CLK_ENABLE) + return &jh7100_clk_gate_ops; - priv->base = devm_platform_ioremap_resource(pdev, 0); - if (IS_ERR(priv->base)) - return PTR_ERR(priv->base); + return &jh7100_clk_inv_ops; +} - error = starfive_clkgen_audio_init(priv); - if (error) - return error; +static struct clk_hw *jh7100_clk_get(struct of_phandle_args *clkspec, void *data) +{ + struct jh7100_clk_priv *priv = data; + unsigned int idx = clkspec->args[0]; - error = devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, - &priv->clk_hws); - if (error) - return error; + if (idx < JH7100_CLK_PLL0_OUT) + return &priv->reg[idx].hw; - return 0; + if (idx < JH7100_CLK_END) + return priv->pll[idx - JH7100_CLK_PLL0_OUT]; + + return ERR_PTR(-EINVAL); } -static int __init starfive_clk_isp_init(struct platform_device *pdev) +static int __init clk_starfive_jh7100_probe(struct platform_device *pdev) { - struct device *dev = &pdev->dev; - struct clk_starfive_jh7100_priv *priv; - int error; + struct jh7100_clk_priv *priv; + unsigned int idx; + int ret; - priv = devm_kzalloc(dev, struct_size(priv, clk_hws.hws, JH7100_CLK_ISP_MAX), GFP_KERNEL); + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); if (!priv) return -ENOMEM; - priv->dev = dev; - priv->clk_hws.num = JH7100_CLK_ISP_MAX; spin_lock_init(&priv->rmw_lock); - + priv->dev = &pdev->dev; priv->base = devm_platform_ioremap_resource(pdev, 0); if (IS_ERR(priv->base)) return PTR_ERR(priv->base); - error = starfive_clkgen_isp_init(priv); - if (error) - return error; - - error = devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, - &priv->clk_hws); - if (error) - return error; - - return 0; -} - -static int __init starfive_clk_vout_init(struct platform_device *pdev) -{ - return 0; -} + priv->pll[0] = devm_clk_hw_register_fixed_factor(priv->dev, "pll0_out", + "osc_sys", 0, 40, 1); + if (IS_ERR(priv->pll[0])) + return PTR_ERR(priv->pll[0]); + + priv->pll[1] = devm_clk_hw_register_fixed_factor(priv->dev, "pll1_out", + "osc_sys", 0, 64, 1); + if (IS_ERR(priv->pll[1])) + return PTR_ERR(priv->pll[1]); + + priv->pll[2] = devm_clk_hw_register_fixed_factor(priv->dev, "pll2_out", + "pll2_refclk", 0, 55, 1); + if (IS_ERR(priv->pll[2])) + return PTR_ERR(priv->pll[2]); + + for (idx = 0; idx < JH7100_CLK_PLL0_OUT; idx++) { + u32 max = jh7100_clk_data[idx].max; + struct clk_parent_data parents[4] = {}; + struct clk_init_data init = { + .name = jh7100_clk_data[idx].name, + .ops = jh7100_clk_ops(max), + .parent_data = parents, + .num_parents = ((max & JH7100_CLK_MUX_MASK) >> JH7100_CLK_MUX_SHIFT) + 1, + .flags = jh7100_clk_data[idx].flags, + }; + struct jh7100_clk *clk = &priv->reg[idx]; + unsigned int i; + + for (i = 0; i < init.num_parents; i++) { + unsigned int pidx = jh7100_clk_data[idx].parents[i]; + + if (pidx < JH7100_CLK_PLL0_OUT) + parents[i].hw = &priv->reg[pidx].hw; + else if (pidx < JH7100_CLK_END) + parents[i].hw = priv->pll[pidx - JH7100_CLK_PLL0_OUT]; + else if (pidx == JH7100_CLK_OSC_SYS) + parents[i].fw_name = "osc_sys"; + else if (pidx == JH7100_CLK_OSC_AUD) + parents[i].fw_name = "osc_aud"; + else if (pidx == JH7100_CLK_GMAC_RMII_REF) + parents[i].fw_name = "gmac_rmii_ref"; + else if (pidx == JH7100_CLK_GMAC_GR_MII_RX) + parents[i].fw_name = "gmac_gr_mii_rxclk"; + } -static int __init clk_starfive_jh7100_probe(struct platform_device *pdev) -{ - struct device *dev = &pdev->dev; - int (*init_func)(struct platform_device *pdev); + clk->hw.init = &init; + clk->idx = idx; + clk->max_div = max & JH7100_CLK_DIV_MASK; - init_func = of_device_get_match_data(dev); - if (!init_func) - return -ENODEV; + ret = devm_clk_hw_register(priv->dev, &clk->hw); + if (ret) + return ret; + } - return init_func(pdev); + return devm_of_clk_add_hw_provider(priv->dev, jh7100_clk_get, priv); } static const struct of_device_id clk_starfive_jh7100_match[] = { - { - .compatible = "starfive,jh7100-clkgen-sys", - .data = starfive_clk_sys_init - }, - { - .compatible = "starfive,jh7100-clkgen-audio", - .data = starfive_clk_audio_init - }, - { - .compatible = "starfive,jh7100-clkgen-isp", - .data = starfive_clk_isp_init - }, - { - .compatible = "starfive,jh7100-clkgen-vout", - .data = starfive_clk_vout_init - }, + { .compatible = "starfive,jh7100-clkgen" }, { /* sentinel */ } }; static struct platform_driver clk_starfive_jh7100_driver = { - .driver = { - .name = "clk-starfive-jh7100", + .driver = { + .name = "clk-starfive-jh7100", .of_match_table = clk_starfive_jh7100_match, + .suppress_bind_attrs = true, }, }; - -static int __init clk_starfive_jh7100_init(void) -{ - return platform_driver_probe(&clk_starfive_jh7100_driver, - clk_starfive_jh7100_probe); -} - -subsys_initcall(clk_starfive_jh7100_init); - -MODULE_DESCRIPTION("StarFive JH7100 Clock Generator Driver"); -MODULE_AUTHOR("Geert Uytterhoeven <geert@linux-m68k.org>"); -MODULE_AUTHOR("Micheal Yan <michael.yan@starfivetech.com>"); -MODULE_LICENSE("GPL v2"); +builtin_platform_driver_probe(clk_starfive_jh7100_driver, clk_starfive_jh7100_probe); |