mirror of
https://github.com/torvalds/linux.git
synced 2024-11-26 14:12:06 +00:00
Merge branches 'clk-doc', 'clk-renesas', 'clk-allwinner', 'clk-rockchip' and 'clk-xilinx' into clk-next
- Convert Xilinx VCU clk driver to a proper clk provider driver - Expose Xilinx ZynqMP clk driver to more platforms * clk-doc: linux/clk.h: use correct kernel-doc notation for 2 functions * clk-renesas: (21 commits) clk: renesas: cpg-mssr: Fix formatting issues for 'smstpcr_saved's documentation clk: renesas: r8a779a0: Add RAVB clocks clk: renesas: r8a779a0: Add I2C clocks dt-bindings: clock: renesas: rcar-usb2-clock-sel: Add support for RZ/G2 M/N/H clk: renesas: r8a779a0: Add SYS-DMAC clocks clk: renesas: r8a779a0: Add SDHI support clk: renesas: rcar-gen3: Factor out CPG library clk: renesas: rcar-gen3: Remove cpg_quirks access when registering SD clock clk: renesas: r8a779a0: Add MSIOF clocks clk: renesas: r8a779a0: Add PFC/GPIO clocks clk: renesas: r8a779a0: Fix parent of CBFUSA clock clk: renesas: r8a779a0: Remove non-existent S2 clock clk: renesas: r8a779a0: Add HSCIF support clk: renesas: r8a779a0: Add RWDT clocks clk: renesas: r8a779a0: Add VSPX clock support clk: renesas: r8a779a0: Add VSPD clock support clk: renesas: r8a779a0: Add FCPVD clock support clk: renesas: r8a77995: Add TMU clocks clk: renesas: r8a77990: Add TMU clocks clk: renesas: r8a77965: Add TMU clocks ... * clk-allwinner: clk: sunxi-ng: Add support for the Allwinner H616 CCU clk: sunxi-ng: Add support for the Allwinner H616 R-CCU dt-bindings: clk: sunxi-ccu: Add compatible string for Allwinner H616 clk: sunxi-ng: h6: Fix clock divider range on some clocks clk: sunxi: clk-mod0: Demote non-conformant kernel-doc header clk: sunxi: clk-a10-ve: Demote obvious kernel-doc abuse clk: sunxi: clk-sunxi: Demote a bunch of non-conformant kernel-doc headers clk: sunxi-ng: h6: Fix CEC clock clk: sunxi-ng: h6-r: Add R_APB2_RSB clock and reset * clk-rockchip: clk: rockchip: fix DPHY gate locations on rk3368 clk: rockchip: use clock id for SCLK_VIP_OUT on rk3368 clk: rockchip: add clock id for SCLK_VIP_OUT on rk3368 clk: rockchip: use clock ids for PCLK_DPHYRX and PCLK_DPHYTX0 on rk3368 clk: rockchip: add clock ids for PCLK_DPHYRX and PCLK_DPHYTX0 on rk3368 clk: rockchip: Demote non-conformant kernel-doc header in half-divider clk: rockchip: Demote kernel-doc abuses to standard comment blocks in plls clk: rockchip: Remove unused/undocumented struct members from clk-cpu clk: rockchip: Demote non-conformant kernel-doc headers in main clock code * clk-xilinx: clk: xilinx: move xlnx_vcu clock driver from soc soc: xilinx: vcu: fix alignment to open parenthesis soc: xilinx: vcu: fix repeated word the in comment soc: xilinx: vcu: use bitfields for register definition soc: xilinx: vcu: remove calculation of PLL configuration soc: xilinx: vcu: make the PLL configurable soc: xilinx: vcu: make pll post divider explicit soc: xilinx: vcu: implement clock provider for output clocks soc: xilinx: vcu: register PLL as fixed rate clock soc: xilinx: vcu: implement PLL disable soc: xilinx: vcu: add helpers for configuring PLL soc: xilinx: vcu: add helper to wait for PLL locked soc: xilinx: vcu: drop coreclk from struct xlnx_vcu clk: divider: fix initialization with parent_hw ARM: dts: vcu: define indexes for output clocks clk: axi-clkgen: use devm_platform_ioremap_resource() short-hand dt-bindings: clock: adi,axi-clkgen: add compatible string for ZynqMP support clk: clk-axiclkgen: add ZynqMP PFD and VCO limits clk: axi-clkgen: replace ARCH dependencies with driver deps
This commit is contained in:
commit
0d7a660bfe
@ -20,6 +20,7 @@ properties:
|
||||
compatible:
|
||||
enum:
|
||||
- adi,axi-clkgen-2.00.a
|
||||
- adi,zynqmp-axi-clkgen-2.00.a
|
||||
|
||||
clocks:
|
||||
description:
|
||||
|
@ -41,6 +41,8 @@ properties:
|
||||
- allwinner,sun50i-h5-ccu
|
||||
- allwinner,sun50i-h6-ccu
|
||||
- allwinner,sun50i-h6-r-ccu
|
||||
- allwinner,sun50i-h616-ccu
|
||||
- allwinner,sun50i-h616-r-ccu
|
||||
- allwinner,suniv-f1c100s-ccu
|
||||
- nextthing,gr8-ccu
|
||||
|
||||
@ -82,6 +84,7 @@ if:
|
||||
- allwinner,sun50i-a64-r-ccu
|
||||
- allwinner,sun50i-a100-r-ccu
|
||||
- allwinner,sun50i-h6-r-ccu
|
||||
- allwinner,sun50i-h616-r-ccu
|
||||
|
||||
then:
|
||||
properties:
|
||||
@ -100,6 +103,7 @@ else:
|
||||
enum:
|
||||
- allwinner,sun50i-a100-ccu
|
||||
- allwinner,sun50i-h6-ccu
|
||||
- allwinner,sun50i-h616-ccu
|
||||
|
||||
then:
|
||||
properties:
|
||||
|
@ -35,6 +35,9 @@ properties:
|
||||
compatible:
|
||||
items:
|
||||
- enum:
|
||||
- renesas,r8a774a1-rcar-usb2-clock-sel # RZ/G2M
|
||||
- renesas,r8a774b1-rcar-usb2-clock-sel # RZ/G2N
|
||||
- renesas,r8a774e1-rcar-usb2-clock-sel # RZ/G2H
|
||||
- renesas,r8a7795-rcar-usb2-clock-sel # R-Car H3
|
||||
- renesas,r8a7796-rcar-usb2-clock-sel # R-Car M3-W
|
||||
- renesas,r8a77961-rcar-usb2-clock-sel # R-Car M3-W+
|
||||
|
@ -247,7 +247,8 @@ config CLK_TWL6040
|
||||
|
||||
config COMMON_CLK_AXI_CLKGEN
|
||||
tristate "AXI clkgen driver"
|
||||
depends on ARCH_ZYNQ || MICROBLAZE || COMPILE_TEST
|
||||
depends on HAS_IOMEM || COMPILE_TEST
|
||||
depends on OF
|
||||
help
|
||||
Support for the Analog Devices axi-clkgen pcore clock generator for Xilinx
|
||||
FPGAs. It is commonly used in Analog Devices' reference designs.
|
||||
@ -392,6 +393,7 @@ source "drivers/clk/tegra/Kconfig"
|
||||
source "drivers/clk/ti/Kconfig"
|
||||
source "drivers/clk/uniphier/Kconfig"
|
||||
source "drivers/clk/x86/Kconfig"
|
||||
source "drivers/clk/xilinx/Kconfig"
|
||||
source "drivers/clk/zynqmp/Kconfig"
|
||||
|
||||
endif
|
||||
|
@ -122,6 +122,7 @@ obj-y += versatile/
|
||||
ifeq ($(CONFIG_COMMON_CLK), y)
|
||||
obj-$(CONFIG_X86) += x86/
|
||||
endif
|
||||
obj-y += xilinx/
|
||||
obj-$(CONFIG_ARCH_ZX) += zte/
|
||||
obj-$(CONFIG_ARCH_ZYNQ) += zynq/
|
||||
obj-$(CONFIG_COMMON_CLK_ZYNQMP) += zynqmp/
|
||||
|
@ -108,6 +108,13 @@ static uint32_t axi_clkgen_lookup_lock(unsigned int m)
|
||||
return 0x1f1f00fa;
|
||||
}
|
||||
|
||||
static const struct axi_clkgen_limits axi_clkgen_zynqmp_default_limits = {
|
||||
.fpfd_min = 10000,
|
||||
.fpfd_max = 450000,
|
||||
.fvco_min = 800000,
|
||||
.fvco_max = 1600000,
|
||||
};
|
||||
|
||||
static const struct axi_clkgen_limits axi_clkgen_zynq_default_limits = {
|
||||
.fpfd_min = 10000,
|
||||
.fpfd_max = 300000,
|
||||
@ -503,7 +510,6 @@ static int axi_clkgen_probe(struct platform_device *pdev)
|
||||
struct clk_init_data init;
|
||||
const char *parent_names[2];
|
||||
const char *clk_name;
|
||||
struct resource *mem;
|
||||
unsigned int i;
|
||||
int ret;
|
||||
|
||||
@ -515,8 +521,7 @@ static int axi_clkgen_probe(struct platform_device *pdev)
|
||||
if (!axi_clkgen)
|
||||
return -ENOMEM;
|
||||
|
||||
mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
axi_clkgen->base = devm_ioremap_resource(&pdev->dev, mem);
|
||||
axi_clkgen->base = devm_platform_ioremap_resource(pdev, 0);
|
||||
if (IS_ERR(axi_clkgen->base))
|
||||
return PTR_ERR(axi_clkgen->base);
|
||||
|
||||
@ -560,6 +565,10 @@ static int axi_clkgen_remove(struct platform_device *pdev)
|
||||
}
|
||||
|
||||
static const struct of_device_id axi_clkgen_ids[] = {
|
||||
{
|
||||
.compatible = "adi,zynqmp-axi-clkgen-2.00.a",
|
||||
.data = &axi_clkgen_zynqmp_default_limits,
|
||||
},
|
||||
{
|
||||
.compatible = "adi,axi-clkgen-2.00.a",
|
||||
.data = &axi_clkgen_zynq_default_limits,
|
||||
|
@ -494,8 +494,13 @@ struct clk_hw *__clk_hw_register_divider(struct device *dev,
|
||||
else
|
||||
init.ops = &clk_divider_ops;
|
||||
init.flags = flags;
|
||||
init.parent_names = (parent_name ? &parent_name: NULL);
|
||||
init.num_parents = (parent_name ? 1 : 0);
|
||||
init.parent_names = parent_name ? &parent_name : NULL;
|
||||
init.parent_hws = parent_hw ? &parent_hw : NULL;
|
||||
init.parent_data = parent_data;
|
||||
if (parent_name || parent_hw || parent_data)
|
||||
init.num_parents = 1;
|
||||
else
|
||||
init.num_parents = 0;
|
||||
|
||||
/* struct clk_divider assignments */
|
||||
div->reg = reg;
|
||||
|
@ -148,6 +148,7 @@ config CLK_R8A77995
|
||||
|
||||
config CLK_R8A779A0
|
||||
bool "R-Car V3U clock support" if COMPILE_TEST
|
||||
select CLK_RCAR_CPG_LIB
|
||||
select CLK_RENESAS_CPG_MSSR
|
||||
|
||||
config CLK_R9A06G032
|
||||
@ -162,12 +163,16 @@ config CLK_SH73A0
|
||||
|
||||
|
||||
# Family
|
||||
config CLK_RCAR_CPG_LIB
|
||||
bool "CPG/MSSR library functions" if COMPILE_TEST
|
||||
|
||||
config CLK_RCAR_GEN2_CPG
|
||||
bool "R-Car Gen2 CPG clock support" if COMPILE_TEST
|
||||
select CLK_RENESAS_CPG_MSSR
|
||||
|
||||
config CLK_RCAR_GEN3_CPG
|
||||
bool "R-Car Gen3 and RZ/G2 CPG clock support" if COMPILE_TEST
|
||||
select CLK_RCAR_CPG_LIB
|
||||
select CLK_RENESAS_CPG_MSSR
|
||||
|
||||
config CLK_RCAR_USB2_CLOCK_SEL
|
||||
|
@ -32,6 +32,7 @@ obj-$(CONFIG_CLK_R9A06G032) += r9a06g032-clocks.o
|
||||
obj-$(CONFIG_CLK_SH73A0) += clk-sh73a0.o
|
||||
|
||||
# Family
|
||||
obj-$(CONFIG_CLK_RCAR_CPG_LIB) += rcar-cpg-lib.o
|
||||
obj-$(CONFIG_CLK_RCAR_GEN2_CPG) += rcar-gen2-cpg.o
|
||||
obj-$(CONFIG_CLK_RCAR_GEN3_CPG) += rcar-gen3-cpg.o
|
||||
obj-$(CONFIG_CLK_RCAR_USB2_CLOCK_SEL) += rcar-usb2-clock-sel.o
|
||||
|
@ -128,6 +128,11 @@ static const struct cpg_core_clk r8a7796_core_clks[] __initconst = {
|
||||
|
||||
static struct mssr_mod_clk r8a7796_mod_clks[] __initdata = {
|
||||
DEF_MOD("fdp1-0", 119, R8A7796_CLK_S0D1),
|
||||
DEF_MOD("tmu4", 121, R8A7796_CLK_S0D6),
|
||||
DEF_MOD("tmu3", 122, R8A7796_CLK_S3D2),
|
||||
DEF_MOD("tmu2", 123, R8A7796_CLK_S3D2),
|
||||
DEF_MOD("tmu1", 124, R8A7796_CLK_S3D2),
|
||||
DEF_MOD("tmu0", 125, R8A7796_CLK_CP),
|
||||
DEF_MOD("scif5", 202, R8A7796_CLK_S3D4),
|
||||
DEF_MOD("scif4", 203, R8A7796_CLK_S3D4),
|
||||
DEF_MOD("scif3", 204, R8A7796_CLK_S3D4),
|
||||
|
@ -123,6 +123,11 @@ static const struct cpg_core_clk r8a77965_core_clks[] __initconst = {
|
||||
|
||||
static const struct mssr_mod_clk r8a77965_mod_clks[] __initconst = {
|
||||
DEF_MOD("fdp1-0", 119, R8A77965_CLK_S0D1),
|
||||
DEF_MOD("tmu4", 121, R8A77965_CLK_S0D6),
|
||||
DEF_MOD("tmu3", 122, R8A77965_CLK_S3D2),
|
||||
DEF_MOD("tmu2", 123, R8A77965_CLK_S3D2),
|
||||
DEF_MOD("tmu1", 124, R8A77965_CLK_S3D2),
|
||||
DEF_MOD("tmu0", 125, R8A77965_CLK_CP),
|
||||
DEF_MOD("scif5", 202, R8A77965_CLK_S3D4),
|
||||
DEF_MOD("scif4", 203, R8A77965_CLK_S3D4),
|
||||
DEF_MOD("scif3", 204, R8A77965_CLK_S3D4),
|
||||
|
@ -124,6 +124,11 @@ static const struct cpg_core_clk r8a77990_core_clks[] __initconst = {
|
||||
};
|
||||
|
||||
static const struct mssr_mod_clk r8a77990_mod_clks[] __initconst = {
|
||||
DEF_MOD("tmu4", 121, R8A77990_CLK_S0D6C),
|
||||
DEF_MOD("tmu3", 122, R8A77990_CLK_S3D2C),
|
||||
DEF_MOD("tmu2", 123, R8A77990_CLK_S3D2C),
|
||||
DEF_MOD("tmu1", 124, R8A77990_CLK_S3D2C),
|
||||
DEF_MOD("tmu0", 125, R8A77990_CLK_CP),
|
||||
DEF_MOD("scif5", 202, R8A77990_CLK_S3D4C),
|
||||
DEF_MOD("scif4", 203, R8A77990_CLK_S3D4C),
|
||||
DEF_MOD("scif3", 204, R8A77990_CLK_S3D4C),
|
||||
|
@ -111,6 +111,11 @@ static const struct cpg_core_clk r8a77995_core_clks[] __initconst = {
|
||||
};
|
||||
|
||||
static const struct mssr_mod_clk r8a77995_mod_clks[] __initconst = {
|
||||
DEF_MOD("tmu4", 121, R8A77995_CLK_S1D4C),
|
||||
DEF_MOD("tmu3", 122, R8A77995_CLK_S3D2C),
|
||||
DEF_MOD("tmu2", 123, R8A77995_CLK_S3D2C),
|
||||
DEF_MOD("tmu1", 124, R8A77995_CLK_S3D2C),
|
||||
DEF_MOD("tmu0", 125, R8A77995_CLK_CP),
|
||||
DEF_MOD("scif5", 202, R8A77995_CLK_S3D4C),
|
||||
DEF_MOD("scif4", 203, R8A77995_CLK_S3D4C),
|
||||
DEF_MOD("scif3", 204, R8A77995_CLK_S3D4C),
|
||||
|
@ -25,6 +25,7 @@
|
||||
|
||||
#include <dt-bindings/clock/r8a779a0-cpg-mssr.h>
|
||||
|
||||
#include "rcar-cpg-lib.h"
|
||||
#include "renesas-cpg-mssr.h"
|
||||
|
||||
enum rcar_r8a779a0_clk_types {
|
||||
@ -32,6 +33,7 @@ enum rcar_r8a779a0_clk_types {
|
||||
CLK_TYPE_R8A779A0_PLL1,
|
||||
CLK_TYPE_R8A779A0_PLL2X_3X, /* PLL[23][01] */
|
||||
CLK_TYPE_R8A779A0_PLL5,
|
||||
CLK_TYPE_R8A779A0_SD,
|
||||
CLK_TYPE_R8A779A0_MDSEL, /* Select parent/divider using mode pin */
|
||||
CLK_TYPE_R8A779A0_OSC, /* OSC EXTAL predivider and fixed divider */
|
||||
};
|
||||
@ -69,7 +71,6 @@ enum clk_ids {
|
||||
CLK_PLL5_DIV2,
|
||||
CLK_PLL5_DIV4,
|
||||
CLK_S1,
|
||||
CLK_S2,
|
||||
CLK_S3,
|
||||
CLK_SDSRC,
|
||||
CLK_RPCSRC,
|
||||
@ -83,6 +84,9 @@ enum clk_ids {
|
||||
DEF_BASE(_name, _id, CLK_TYPE_R8A779A0_PLL2X_3X, CLK_MAIN, \
|
||||
.offset = _offset)
|
||||
|
||||
#define DEF_SD(_name, _id, _parent, _offset) \
|
||||
DEF_BASE(_name, _id, CLK_TYPE_R8A779A0_SD, _parent, .offset = _offset)
|
||||
|
||||
#define DEF_MDSEL(_name, _id, _md, _parent0, _div0, _parent1, _div1) \
|
||||
DEF_BASE(_name, _id, CLK_TYPE_R8A779A0_MDSEL, \
|
||||
(_parent0) << 16 | (_parent1), \
|
||||
@ -114,6 +118,7 @@ static const struct cpg_core_clk r8a779a0_core_clks[] __initconst = {
|
||||
DEF_FIXED(".pll5_div4", CLK_PLL5_DIV4, CLK_PLL5_DIV2, 2, 1),
|
||||
DEF_FIXED(".s1", CLK_S1, CLK_PLL1_DIV2, 2, 1),
|
||||
DEF_FIXED(".s3", CLK_S3, CLK_PLL1_DIV2, 4, 1),
|
||||
DEF_FIXED(".sdsrc", CLK_SDSRC, CLK_PLL5_DIV4, 1, 1),
|
||||
DEF_RATE(".oco", CLK_OCO, 32768),
|
||||
|
||||
/* Core Clock Outputs */
|
||||
@ -137,7 +142,10 @@ static const struct cpg_core_clk r8a779a0_core_clks[] __initconst = {
|
||||
DEF_FIXED("icu", R8A779A0_CLK_ICU, CLK_PLL5_DIV4, 2, 1),
|
||||
DEF_FIXED("icud2", R8A779A0_CLK_ICUD2, CLK_PLL5_DIV4, 4, 1),
|
||||
DEF_FIXED("vcbus", R8A779A0_CLK_VCBUS, CLK_PLL5_DIV4, 1, 1),
|
||||
DEF_FIXED("cbfusa", R8A779A0_CLK_CBFUSA, CLK_MAIN, 2, 1),
|
||||
DEF_FIXED("cbfusa", R8A779A0_CLK_CBFUSA, CLK_EXTAL, 2, 1),
|
||||
DEF_FIXED("cp", R8A779A0_CLK_CP, CLK_EXTAL, 2, 1),
|
||||
|
||||
DEF_SD("sd0", R8A779A0_CLK_SD0, CLK_SDSRC, 0x870),
|
||||
|
||||
DEF_DIV6P1("mso", R8A779A0_CLK_MSO, CLK_PLL5_DIV4, 0x87c),
|
||||
DEF_DIV6P1("canfd", R8A779A0_CLK_CANFD, CLK_PLL5_DIV4, 0x878),
|
||||
@ -148,14 +156,42 @@ static const struct cpg_core_clk r8a779a0_core_clks[] __initconst = {
|
||||
};
|
||||
|
||||
static const struct mssr_mod_clk r8a779a0_mod_clks[] __initconst = {
|
||||
DEF_MOD("avb0", 211, R8A779A0_CLK_S3D2),
|
||||
DEF_MOD("avb1", 212, R8A779A0_CLK_S3D2),
|
||||
DEF_MOD("avb2", 213, R8A779A0_CLK_S3D2),
|
||||
DEF_MOD("avb3", 214, R8A779A0_CLK_S3D2),
|
||||
DEF_MOD("avb4", 215, R8A779A0_CLK_S3D2),
|
||||
DEF_MOD("avb5", 216, R8A779A0_CLK_S3D2),
|
||||
DEF_MOD("csi40", 331, R8A779A0_CLK_CSI0),
|
||||
DEF_MOD("csi41", 400, R8A779A0_CLK_CSI0),
|
||||
DEF_MOD("csi42", 401, R8A779A0_CLK_CSI0),
|
||||
DEF_MOD("csi43", 402, R8A779A0_CLK_CSI0),
|
||||
DEF_MOD("fcpvd0", 508, R8A779A0_CLK_S3D1),
|
||||
DEF_MOD("fcpvd1", 509, R8A779A0_CLK_S3D1),
|
||||
DEF_MOD("hscif0", 514, R8A779A0_CLK_S1D2),
|
||||
DEF_MOD("hscif1", 515, R8A779A0_CLK_S1D2),
|
||||
DEF_MOD("hscif2", 516, R8A779A0_CLK_S1D2),
|
||||
DEF_MOD("hscif3", 517, R8A779A0_CLK_S1D2),
|
||||
DEF_MOD("i2c0", 518, R8A779A0_CLK_S1D4),
|
||||
DEF_MOD("i2c1", 519, R8A779A0_CLK_S1D4),
|
||||
DEF_MOD("i2c2", 520, R8A779A0_CLK_S1D4),
|
||||
DEF_MOD("i2c3", 521, R8A779A0_CLK_S1D4),
|
||||
DEF_MOD("i2c4", 522, R8A779A0_CLK_S1D4),
|
||||
DEF_MOD("i2c5", 523, R8A779A0_CLK_S1D4),
|
||||
DEF_MOD("i2c6", 524, R8A779A0_CLK_S1D4),
|
||||
DEF_MOD("msi0", 618, R8A779A0_CLK_MSO),
|
||||
DEF_MOD("msi1", 619, R8A779A0_CLK_MSO),
|
||||
DEF_MOD("msi2", 620, R8A779A0_CLK_MSO),
|
||||
DEF_MOD("msi3", 621, R8A779A0_CLK_MSO),
|
||||
DEF_MOD("msi4", 622, R8A779A0_CLK_MSO),
|
||||
DEF_MOD("msi5", 623, R8A779A0_CLK_MSO),
|
||||
DEF_MOD("scif0", 702, R8A779A0_CLK_S1D8),
|
||||
DEF_MOD("scif1", 703, R8A779A0_CLK_S1D8),
|
||||
DEF_MOD("scif3", 704, R8A779A0_CLK_S1D8),
|
||||
DEF_MOD("scif4", 705, R8A779A0_CLK_S1D8),
|
||||
DEF_MOD("sdhi0", 706, R8A779A0_CLK_SD0),
|
||||
DEF_MOD("sydm1", 709, R8A779A0_CLK_S1D2),
|
||||
DEF_MOD("sydm2", 710, R8A779A0_CLK_S1D2),
|
||||
DEF_MOD("vin00", 730, R8A779A0_CLK_S1D1),
|
||||
DEF_MOD("vin01", 731, R8A779A0_CLK_S1D1),
|
||||
DEF_MOD("vin02", 800, R8A779A0_CLK_S1D1),
|
||||
@ -188,10 +224,19 @@ static const struct mssr_mod_clk r8a779a0_mod_clks[] __initconst = {
|
||||
DEF_MOD("vin35", 827, R8A779A0_CLK_S1D1),
|
||||
DEF_MOD("vin36", 828, R8A779A0_CLK_S1D1),
|
||||
DEF_MOD("vin37", 829, R8A779A0_CLK_S1D1),
|
||||
DEF_MOD("vspd0", 830, R8A779A0_CLK_S3D1),
|
||||
DEF_MOD("vspd1", 831, R8A779A0_CLK_S3D1),
|
||||
DEF_MOD("rwdt", 907, R8A779A0_CLK_R),
|
||||
DEF_MOD("pfc0", 915, R8A779A0_CLK_CP),
|
||||
DEF_MOD("pfc1", 916, R8A779A0_CLK_CP),
|
||||
DEF_MOD("pfc2", 917, R8A779A0_CLK_CP),
|
||||
DEF_MOD("pfc3", 918, R8A779A0_CLK_CP),
|
||||
DEF_MOD("vspx0", 1028, R8A779A0_CLK_S1D1),
|
||||
DEF_MOD("vspx1", 1029, R8A779A0_CLK_S1D1),
|
||||
DEF_MOD("vspx2", 1030, R8A779A0_CLK_S1D1),
|
||||
DEF_MOD("vspx3", 1031, R8A779A0_CLK_S1D1),
|
||||
};
|
||||
|
||||
static spinlock_t cpg_lock;
|
||||
|
||||
static const struct rcar_r8a779a0_cpg_pll_config *cpg_pll_config __initdata;
|
||||
static unsigned int cpg_clk_extalr __initdata;
|
||||
static u32 cpg_mode __initdata;
|
||||
@ -230,6 +275,12 @@ static struct clk * __init rcar_r8a779a0_cpg_clk_register(struct device *dev,
|
||||
div = cpg_pll_config->pll5_div;
|
||||
break;
|
||||
|
||||
case CLK_TYPE_R8A779A0_SD:
|
||||
return cpg_sd_clk_register(core->name, base, core->offset,
|
||||
__clk_get_name(parent), notifiers,
|
||||
false);
|
||||
break;
|
||||
|
||||
case CLK_TYPE_R8A779A0_MDSEL:
|
||||
/*
|
||||
* Clock selectable between two parents and two fixed dividers
|
||||
@ -261,6 +312,10 @@ static struct clk * __init rcar_r8a779a0_cpg_clk_register(struct device *dev,
|
||||
__clk_get_name(parent), 0, mult, div);
|
||||
}
|
||||
|
||||
static const unsigned int r8a779a0_crit_mod_clks[] __initconst = {
|
||||
MOD_CLK_ID(907), /* RWDT */
|
||||
};
|
||||
|
||||
/*
|
||||
* CPG Clock Data
|
||||
*/
|
||||
@ -311,6 +366,10 @@ const struct cpg_mssr_info r8a779a0_cpg_mssr_info __initconst = {
|
||||
.num_mod_clks = ARRAY_SIZE(r8a779a0_mod_clks),
|
||||
.num_hw_mod_clks = 15 * 32,
|
||||
|
||||
/* Critical Module Clocks */
|
||||
.crit_mod_clks = r8a779a0_crit_mod_clks,
|
||||
.num_crit_mod_clks = ARRAY_SIZE(r8a779a0_crit_mod_clks),
|
||||
|
||||
/* Callbacks */
|
||||
.init = r8a779a0_cpg_mssr_init,
|
||||
.cpg_clk_register = rcar_r8a779a0_cpg_clk_register,
|
||||
|
270
drivers/clk/renesas/rcar-cpg-lib.c
Normal file
270
drivers/clk/renesas/rcar-cpg-lib.c
Normal file
@ -0,0 +1,270 @@
|
||||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* R-Car Gen3 Clock Pulse Generator Library
|
||||
*
|
||||
* Copyright (C) 2015-2018 Glider bvba
|
||||
* Copyright (C) 2019 Renesas Electronics Corp.
|
||||
*
|
||||
* Based on clk-rcar-gen3.c
|
||||
*
|
||||
* Copyright (C) 2015 Renesas Electronics Corp.
|
||||
*/
|
||||
|
||||
#include <linux/clk.h>
|
||||
#include <linux/clk-provider.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/pm.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/sys_soc.h>
|
||||
|
||||
#include "rcar-cpg-lib.h"
|
||||
|
||||
spinlock_t cpg_lock;
|
||||
|
||||
void cpg_reg_modify(void __iomem *reg, u32 clear, u32 set)
|
||||
{
|
||||
unsigned long flags;
|
||||
u32 val;
|
||||
|
||||
spin_lock_irqsave(&cpg_lock, flags);
|
||||
val = readl(reg);
|
||||
val &= ~clear;
|
||||
val |= set;
|
||||
writel(val, reg);
|
||||
spin_unlock_irqrestore(&cpg_lock, flags);
|
||||
};
|
||||
|
||||
static int cpg_simple_notifier_call(struct notifier_block *nb,
|
||||
unsigned long action, void *data)
|
||||
{
|
||||
struct cpg_simple_notifier *csn =
|
||||
container_of(nb, struct cpg_simple_notifier, nb);
|
||||
|
||||
switch (action) {
|
||||
case PM_EVENT_SUSPEND:
|
||||
csn->saved = readl(csn->reg);
|
||||
return NOTIFY_OK;
|
||||
|
||||
case PM_EVENT_RESUME:
|
||||
writel(csn->saved, csn->reg);
|
||||
return NOTIFY_OK;
|
||||
}
|
||||
return NOTIFY_DONE;
|
||||
}
|
||||
|
||||
void cpg_simple_notifier_register(struct raw_notifier_head *notifiers,
|
||||
struct cpg_simple_notifier *csn)
|
||||
{
|
||||
csn->nb.notifier_call = cpg_simple_notifier_call;
|
||||
raw_notifier_chain_register(notifiers, &csn->nb);
|
||||
}
|
||||
|
||||
/*
|
||||
* SDn Clock
|
||||
*/
|
||||
#define CPG_SD_STP_HCK BIT(9)
|
||||
#define CPG_SD_STP_CK BIT(8)
|
||||
|
||||
#define CPG_SD_STP_MASK (CPG_SD_STP_HCK | CPG_SD_STP_CK)
|
||||
#define CPG_SD_FC_MASK (0x7 << 2 | 0x3 << 0)
|
||||
|
||||
#define CPG_SD_DIV_TABLE_DATA(stp_hck, sd_srcfc, sd_fc, sd_div) \
|
||||
{ \
|
||||
.val = ((stp_hck) ? CPG_SD_STP_HCK : 0) | \
|
||||
((sd_srcfc) << 2) | \
|
||||
((sd_fc) << 0), \
|
||||
.div = (sd_div), \
|
||||
}
|
||||
|
||||
struct sd_div_table {
|
||||
u32 val;
|
||||
unsigned int div;
|
||||
};
|
||||
|
||||
struct sd_clock {
|
||||
struct clk_hw hw;
|
||||
const struct sd_div_table *div_table;
|
||||
struct cpg_simple_notifier csn;
|
||||
unsigned int div_num;
|
||||
unsigned int cur_div_idx;
|
||||
};
|
||||
|
||||
/* SDn divider
|
||||
* sd_srcfc sd_fc div
|
||||
* stp_hck (div) (div) = sd_srcfc x sd_fc
|
||||
*---------------------------------------------------------
|
||||
* 0 0 (1) 1 (4) 4 : SDR104 / HS200 / HS400 (8 TAP)
|
||||
* 0 1 (2) 1 (4) 8 : SDR50
|
||||
* 1 2 (4) 1 (4) 16 : HS / SDR25
|
||||
* 1 3 (8) 1 (4) 32 : NS / SDR12
|
||||
* 1 4 (16) 1 (4) 64
|
||||
* 0 0 (1) 0 (2) 2
|
||||
* 0 1 (2) 0 (2) 4 : SDR104 / HS200 / HS400 (4 TAP)
|
||||
* 1 2 (4) 0 (2) 8
|
||||
* 1 3 (8) 0 (2) 16
|
||||
* 1 4 (16) 0 (2) 32
|
||||
*
|
||||
* NOTE: There is a quirk option to ignore the first row of the dividers
|
||||
* table when searching for suitable settings. This is because HS400 on
|
||||
* early ES versions of H3 and M3-W requires a specific setting to work.
|
||||
*/
|
||||
static const struct sd_div_table cpg_sd_div_table[] = {
|
||||
/* CPG_SD_DIV_TABLE_DATA(stp_hck, sd_srcfc, sd_fc, sd_div) */
|
||||
CPG_SD_DIV_TABLE_DATA(0, 0, 1, 4),
|
||||
CPG_SD_DIV_TABLE_DATA(0, 1, 1, 8),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 2, 1, 16),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 3, 1, 32),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 4, 1, 64),
|
||||
CPG_SD_DIV_TABLE_DATA(0, 0, 0, 2),
|
||||
CPG_SD_DIV_TABLE_DATA(0, 1, 0, 4),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 2, 0, 8),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 3, 0, 16),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 4, 0, 32),
|
||||
};
|
||||
|
||||
#define to_sd_clock(_hw) container_of(_hw, struct sd_clock, hw)
|
||||
|
||||
static int cpg_sd_clock_enable(struct clk_hw *hw)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
|
||||
cpg_reg_modify(clock->csn.reg, CPG_SD_STP_MASK,
|
||||
clock->div_table[clock->cur_div_idx].val &
|
||||
CPG_SD_STP_MASK);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void cpg_sd_clock_disable(struct clk_hw *hw)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
|
||||
cpg_reg_modify(clock->csn.reg, 0, CPG_SD_STP_MASK);
|
||||
}
|
||||
|
||||
static int cpg_sd_clock_is_enabled(struct clk_hw *hw)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
|
||||
return !(readl(clock->csn.reg) & CPG_SD_STP_MASK);
|
||||
}
|
||||
|
||||
static unsigned long cpg_sd_clock_recalc_rate(struct clk_hw *hw,
|
||||
unsigned long parent_rate)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
|
||||
return DIV_ROUND_CLOSEST(parent_rate,
|
||||
clock->div_table[clock->cur_div_idx].div);
|
||||
}
|
||||
|
||||
static int cpg_sd_clock_determine_rate(struct clk_hw *hw,
|
||||
struct clk_rate_request *req)
|
||||
{
|
||||
unsigned long best_rate = ULONG_MAX, diff_min = ULONG_MAX;
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
unsigned long calc_rate, diff;
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < clock->div_num; i++) {
|
||||
calc_rate = DIV_ROUND_CLOSEST(req->best_parent_rate,
|
||||
clock->div_table[i].div);
|
||||
if (calc_rate < req->min_rate || calc_rate > req->max_rate)
|
||||
continue;
|
||||
|
||||
diff = calc_rate > req->rate ? calc_rate - req->rate
|
||||
: req->rate - calc_rate;
|
||||
if (diff < diff_min) {
|
||||
best_rate = calc_rate;
|
||||
diff_min = diff;
|
||||
}
|
||||
}
|
||||
|
||||
if (best_rate == ULONG_MAX)
|
||||
return -EINVAL;
|
||||
|
||||
req->rate = best_rate;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int cpg_sd_clock_set_rate(struct clk_hw *hw, unsigned long rate,
|
||||
unsigned long parent_rate)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < clock->div_num; i++)
|
||||
if (rate == DIV_ROUND_CLOSEST(parent_rate,
|
||||
clock->div_table[i].div))
|
||||
break;
|
||||
|
||||
if (i >= clock->div_num)
|
||||
return -EINVAL;
|
||||
|
||||
clock->cur_div_idx = i;
|
||||
|
||||
cpg_reg_modify(clock->csn.reg, CPG_SD_STP_MASK | CPG_SD_FC_MASK,
|
||||
clock->div_table[i].val &
|
||||
(CPG_SD_STP_MASK | CPG_SD_FC_MASK));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct clk_ops cpg_sd_clock_ops = {
|
||||
.enable = cpg_sd_clock_enable,
|
||||
.disable = cpg_sd_clock_disable,
|
||||
.is_enabled = cpg_sd_clock_is_enabled,
|
||||
.recalc_rate = cpg_sd_clock_recalc_rate,
|
||||
.determine_rate = cpg_sd_clock_determine_rate,
|
||||
.set_rate = cpg_sd_clock_set_rate,
|
||||
};
|
||||
|
||||
struct clk * __init cpg_sd_clk_register(const char *name,
|
||||
void __iomem *base, unsigned int offset, const char *parent_name,
|
||||
struct raw_notifier_head *notifiers, bool skip_first)
|
||||
{
|
||||
struct clk_init_data init;
|
||||
struct sd_clock *clock;
|
||||
struct clk *clk;
|
||||
u32 val;
|
||||
|
||||
clock = kzalloc(sizeof(*clock), GFP_KERNEL);
|
||||
if (!clock)
|
||||
return ERR_PTR(-ENOMEM);
|
||||
|
||||
init.name = name;
|
||||
init.ops = &cpg_sd_clock_ops;
|
||||
init.flags = CLK_SET_RATE_PARENT;
|
||||
init.parent_names = &parent_name;
|
||||
init.num_parents = 1;
|
||||
|
||||
clock->csn.reg = base + offset;
|
||||
clock->hw.init = &init;
|
||||
clock->div_table = cpg_sd_div_table;
|
||||
clock->div_num = ARRAY_SIZE(cpg_sd_div_table);
|
||||
|
||||
if (skip_first) {
|
||||
clock->div_table++;
|
||||
clock->div_num--;
|
||||
}
|
||||
|
||||
val = readl(clock->csn.reg) & ~CPG_SD_FC_MASK;
|
||||
val |= CPG_SD_STP_MASK | (clock->div_table[0].val & CPG_SD_FC_MASK);
|
||||
writel(val, clock->csn.reg);
|
||||
|
||||
clk = clk_register(NULL, &clock->hw);
|
||||
if (IS_ERR(clk))
|
||||
goto free_clock;
|
||||
|
||||
cpg_simple_notifier_register(notifiers, &clock->csn);
|
||||
return clk;
|
||||
|
||||
free_clock:
|
||||
kfree(clock);
|
||||
return clk;
|
||||
}
|
||||
|
||||
|
33
drivers/clk/renesas/rcar-cpg-lib.h
Normal file
33
drivers/clk/renesas/rcar-cpg-lib.h
Normal file
@ -0,0 +1,33 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
/*
|
||||
* R-Car Gen3 Clock Pulse Generator Library
|
||||
*
|
||||
* Copyright (C) 2015-2018 Glider bvba
|
||||
* Copyright (C) 2019 Renesas Electronics Corp.
|
||||
*
|
||||
* Based on clk-rcar-gen3.c
|
||||
*
|
||||
* Copyright (C) 2015 Renesas Electronics Corp.
|
||||
*/
|
||||
|
||||
#ifndef __CLK_RENESAS_RCAR_CPG_LIB_H__
|
||||
#define __CLK_RENESAS_RCAR_CPG_LIB_H__
|
||||
|
||||
extern spinlock_t cpg_lock;
|
||||
|
||||
struct cpg_simple_notifier {
|
||||
struct notifier_block nb;
|
||||
void __iomem *reg;
|
||||
u32 saved;
|
||||
};
|
||||
|
||||
void cpg_simple_notifier_register(struct raw_notifier_head *notifiers,
|
||||
struct cpg_simple_notifier *csn);
|
||||
|
||||
void cpg_reg_modify(void __iomem *reg, u32 clear, u32 set);
|
||||
|
||||
struct clk * __init cpg_sd_clk_register(const char *name,
|
||||
void __iomem *base, unsigned int offset, const char *parent_name,
|
||||
struct raw_notifier_head *notifiers, bool skip_first);
|
||||
|
||||
#endif
|
@ -23,6 +23,7 @@
|
||||
#include <linux/sys_soc.h>
|
||||
|
||||
#include "renesas-cpg-mssr.h"
|
||||
#include "rcar-cpg-lib.h"
|
||||
#include "rcar-gen3-cpg.h"
|
||||
|
||||
#define CPG_PLL0CR 0x00d8
|
||||
@ -31,52 +32,6 @@
|
||||
|
||||
#define CPG_RCKCR_CKSEL BIT(15) /* RCLK Clock Source Select */
|
||||
|
||||
static spinlock_t cpg_lock;
|
||||
|
||||
static void cpg_reg_modify(void __iomem *reg, u32 clear, u32 set)
|
||||
{
|
||||
unsigned long flags;
|
||||
u32 val;
|
||||
|
||||
spin_lock_irqsave(&cpg_lock, flags);
|
||||
val = readl(reg);
|
||||
val &= ~clear;
|
||||
val |= set;
|
||||
writel(val, reg);
|
||||
spin_unlock_irqrestore(&cpg_lock, flags);
|
||||
};
|
||||
|
||||
struct cpg_simple_notifier {
|
||||
struct notifier_block nb;
|
||||
void __iomem *reg;
|
||||
u32 saved;
|
||||
};
|
||||
|
||||
static int cpg_simple_notifier_call(struct notifier_block *nb,
|
||||
unsigned long action, void *data)
|
||||
{
|
||||
struct cpg_simple_notifier *csn =
|
||||
container_of(nb, struct cpg_simple_notifier, nb);
|
||||
|
||||
switch (action) {
|
||||
case PM_EVENT_SUSPEND:
|
||||
csn->saved = readl(csn->reg);
|
||||
return NOTIFY_OK;
|
||||
|
||||
case PM_EVENT_RESUME:
|
||||
writel(csn->saved, csn->reg);
|
||||
return NOTIFY_OK;
|
||||
}
|
||||
return NOTIFY_DONE;
|
||||
}
|
||||
|
||||
static void cpg_simple_notifier_register(struct raw_notifier_head *notifiers,
|
||||
struct cpg_simple_notifier *csn)
|
||||
{
|
||||
csn->nb.notifier_call = cpg_simple_notifier_call;
|
||||
raw_notifier_chain_register(notifiers, &csn->nb);
|
||||
}
|
||||
|
||||
/*
|
||||
* Z Clock & Z2 Clock
|
||||
*
|
||||
@ -215,217 +170,6 @@ static struct clk * __init cpg_z_clk_register(const char *name,
|
||||
return clk;
|
||||
}
|
||||
|
||||
/*
|
||||
* SDn Clock
|
||||
*/
|
||||
#define CPG_SD_STP_HCK BIT(9)
|
||||
#define CPG_SD_STP_CK BIT(8)
|
||||
|
||||
#define CPG_SD_STP_MASK (CPG_SD_STP_HCK | CPG_SD_STP_CK)
|
||||
#define CPG_SD_FC_MASK (0x7 << 2 | 0x3 << 0)
|
||||
|
||||
#define CPG_SD_DIV_TABLE_DATA(stp_hck, sd_srcfc, sd_fc, sd_div) \
|
||||
{ \
|
||||
.val = ((stp_hck) ? CPG_SD_STP_HCK : 0) | \
|
||||
((sd_srcfc) << 2) | \
|
||||
((sd_fc) << 0), \
|
||||
.div = (sd_div), \
|
||||
}
|
||||
|
||||
struct sd_div_table {
|
||||
u32 val;
|
||||
unsigned int div;
|
||||
};
|
||||
|
||||
struct sd_clock {
|
||||
struct clk_hw hw;
|
||||
const struct sd_div_table *div_table;
|
||||
struct cpg_simple_notifier csn;
|
||||
unsigned int div_num;
|
||||
unsigned int cur_div_idx;
|
||||
};
|
||||
|
||||
/* SDn divider
|
||||
* sd_srcfc sd_fc div
|
||||
* stp_hck (div) (div) = sd_srcfc x sd_fc
|
||||
*---------------------------------------------------------
|
||||
* 0 0 (1) 1 (4) 4 : SDR104 / HS200 / HS400 (8 TAP)
|
||||
* 0 1 (2) 1 (4) 8 : SDR50
|
||||
* 1 2 (4) 1 (4) 16 : HS / SDR25
|
||||
* 1 3 (8) 1 (4) 32 : NS / SDR12
|
||||
* 1 4 (16) 1 (4) 64
|
||||
* 0 0 (1) 0 (2) 2
|
||||
* 0 1 (2) 0 (2) 4 : SDR104 / HS200 / HS400 (4 TAP)
|
||||
* 1 2 (4) 0 (2) 8
|
||||
* 1 3 (8) 0 (2) 16
|
||||
* 1 4 (16) 0 (2) 32
|
||||
*
|
||||
* NOTE: There is a quirk option to ignore the first row of the dividers
|
||||
* table when searching for suitable settings. This is because HS400 on
|
||||
* early ES versions of H3 and M3-W requires a specific setting to work.
|
||||
*/
|
||||
static const struct sd_div_table cpg_sd_div_table[] = {
|
||||
/* CPG_SD_DIV_TABLE_DATA(stp_hck, sd_srcfc, sd_fc, sd_div) */
|
||||
CPG_SD_DIV_TABLE_DATA(0, 0, 1, 4),
|
||||
CPG_SD_DIV_TABLE_DATA(0, 1, 1, 8),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 2, 1, 16),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 3, 1, 32),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 4, 1, 64),
|
||||
CPG_SD_DIV_TABLE_DATA(0, 0, 0, 2),
|
||||
CPG_SD_DIV_TABLE_DATA(0, 1, 0, 4),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 2, 0, 8),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 3, 0, 16),
|
||||
CPG_SD_DIV_TABLE_DATA(1, 4, 0, 32),
|
||||
};
|
||||
|
||||
#define to_sd_clock(_hw) container_of(_hw, struct sd_clock, hw)
|
||||
|
||||
static int cpg_sd_clock_enable(struct clk_hw *hw)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
|
||||
cpg_reg_modify(clock->csn.reg, CPG_SD_STP_MASK,
|
||||
clock->div_table[clock->cur_div_idx].val &
|
||||
CPG_SD_STP_MASK);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void cpg_sd_clock_disable(struct clk_hw *hw)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
|
||||
cpg_reg_modify(clock->csn.reg, 0, CPG_SD_STP_MASK);
|
||||
}
|
||||
|
||||
static int cpg_sd_clock_is_enabled(struct clk_hw *hw)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
|
||||
return !(readl(clock->csn.reg) & CPG_SD_STP_MASK);
|
||||
}
|
||||
|
||||
static unsigned long cpg_sd_clock_recalc_rate(struct clk_hw *hw,
|
||||
unsigned long parent_rate)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
|
||||
return DIV_ROUND_CLOSEST(parent_rate,
|
||||
clock->div_table[clock->cur_div_idx].div);
|
||||
}
|
||||
|
||||
static int cpg_sd_clock_determine_rate(struct clk_hw *hw,
|
||||
struct clk_rate_request *req)
|
||||
{
|
||||
unsigned long best_rate = ULONG_MAX, diff_min = ULONG_MAX;
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
unsigned long calc_rate, diff;
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < clock->div_num; i++) {
|
||||
calc_rate = DIV_ROUND_CLOSEST(req->best_parent_rate,
|
||||
clock->div_table[i].div);
|
||||
if (calc_rate < req->min_rate || calc_rate > req->max_rate)
|
||||
continue;
|
||||
|
||||
diff = calc_rate > req->rate ? calc_rate - req->rate
|
||||
: req->rate - calc_rate;
|
||||
if (diff < diff_min) {
|
||||
best_rate = calc_rate;
|
||||
diff_min = diff;
|
||||
}
|
||||
}
|
||||
|
||||
if (best_rate == ULONG_MAX)
|
||||
return -EINVAL;
|
||||
|
||||
req->rate = best_rate;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int cpg_sd_clock_set_rate(struct clk_hw *hw, unsigned long rate,
|
||||
unsigned long parent_rate)
|
||||
{
|
||||
struct sd_clock *clock = to_sd_clock(hw);
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < clock->div_num; i++)
|
||||
if (rate == DIV_ROUND_CLOSEST(parent_rate,
|
||||
clock->div_table[i].div))
|
||||
break;
|
||||
|
||||
if (i >= clock->div_num)
|
||||
return -EINVAL;
|
||||
|
||||
clock->cur_div_idx = i;
|
||||
|
||||
cpg_reg_modify(clock->csn.reg, CPG_SD_STP_MASK | CPG_SD_FC_MASK,
|
||||
clock->div_table[i].val &
|
||||
(CPG_SD_STP_MASK | CPG_SD_FC_MASK));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct clk_ops cpg_sd_clock_ops = {
|
||||
.enable = cpg_sd_clock_enable,
|
||||
.disable = cpg_sd_clock_disable,
|
||||
.is_enabled = cpg_sd_clock_is_enabled,
|
||||
.recalc_rate = cpg_sd_clock_recalc_rate,
|
||||
.determine_rate = cpg_sd_clock_determine_rate,
|
||||
.set_rate = cpg_sd_clock_set_rate,
|
||||
};
|
||||
|
||||
static u32 cpg_quirks __initdata;
|
||||
|
||||
#define PLL_ERRATA BIT(0) /* Missing PLL0/2/4 post-divider */
|
||||
#define RCKCR_CKSEL BIT(1) /* Manual RCLK parent selection */
|
||||
#define SD_SKIP_FIRST BIT(2) /* Skip first clock in SD table */
|
||||
|
||||
static struct clk * __init cpg_sd_clk_register(const char *name,
|
||||
void __iomem *base, unsigned int offset, const char *parent_name,
|
||||
struct raw_notifier_head *notifiers)
|
||||
{
|
||||
struct clk_init_data init;
|
||||
struct sd_clock *clock;
|
||||
struct clk *clk;
|
||||
u32 val;
|
||||
|
||||
clock = kzalloc(sizeof(*clock), GFP_KERNEL);
|
||||
if (!clock)
|
||||
return ERR_PTR(-ENOMEM);
|
||||
|
||||
init.name = name;
|
||||
init.ops = &cpg_sd_clock_ops;
|
||||
init.flags = CLK_SET_RATE_PARENT;
|
||||
init.parent_names = &parent_name;
|
||||
init.num_parents = 1;
|
||||
|
||||
clock->csn.reg = base + offset;
|
||||
clock->hw.init = &init;
|
||||
clock->div_table = cpg_sd_div_table;
|
||||
clock->div_num = ARRAY_SIZE(cpg_sd_div_table);
|
||||
|
||||
if (cpg_quirks & SD_SKIP_FIRST) {
|
||||
clock->div_table++;
|
||||
clock->div_num--;
|
||||
}
|
||||
|
||||
val = readl(clock->csn.reg) & ~CPG_SD_FC_MASK;
|
||||
val |= CPG_SD_STP_MASK | (clock->div_table[0].val & CPG_SD_FC_MASK);
|
||||
writel(val, clock->csn.reg);
|
||||
|
||||
clk = clk_register(NULL, &clock->hw);
|
||||
if (IS_ERR(clk))
|
||||
goto free_clock;
|
||||
|
||||
cpg_simple_notifier_register(notifiers, &clock->csn);
|
||||
return clk;
|
||||
|
||||
free_clock:
|
||||
kfree(clock);
|
||||
return clk;
|
||||
}
|
||||
|
||||
struct rpc_clock {
|
||||
struct clk_divider div;
|
||||
struct clk_gate gate;
|
||||
@ -518,6 +262,12 @@ static struct clk * __init cpg_rpcd2_clk_register(const char *name,
|
||||
static const struct rcar_gen3_cpg_pll_config *cpg_pll_config __initdata;
|
||||
static unsigned int cpg_clk_extalr __initdata;
|
||||
static u32 cpg_mode __initdata;
|
||||
static u32 cpg_quirks __initdata;
|
||||
|
||||
#define PLL_ERRATA BIT(0) /* Missing PLL0/2/4 post-divider */
|
||||
#define RCKCR_CKSEL BIT(1) /* Manual RCLK parent selection */
|
||||
#define SD_SKIP_FIRST BIT(2) /* Skip first clock in SD table */
|
||||
|
||||
|
||||
static const struct soc_device_attribute cpg_quirks_match[] __initconst = {
|
||||
{
|
||||
@ -613,7 +363,8 @@ struct clk * __init rcar_gen3_cpg_clk_register(struct device *dev,
|
||||
|
||||
case CLK_TYPE_GEN3_SD:
|
||||
return cpg_sd_clk_register(core->name, base, core->offset,
|
||||
__clk_get_name(parent), notifiers);
|
||||
__clk_get_name(parent), notifiers,
|
||||
cpg_quirks & SD_SKIP_FIRST);
|
||||
|
||||
case CLK_TYPE_GEN3_R:
|
||||
if (cpg_quirks & RCKCR_CKSEL) {
|
||||
|
@ -136,8 +136,8 @@ static const u16 srstclr_for_v3u[] = {
|
||||
* @control_regs: Pointer to control registers array
|
||||
* @reset_regs: Pointer to reset registers array
|
||||
* @reset_clear_regs: Pointer to reset clearing registers array
|
||||
* @smstpcr_saved[].mask: Mask of SMSTPCR[] bits under our control
|
||||
* @smstpcr_saved[].val: Saved values of SMSTPCR[]
|
||||
* @smstpcr_saved: [].mask: Mask of SMSTPCR[] bits under our control
|
||||
* [].val: Saved values of SMSTPCR[]
|
||||
* @clks: Array containing all Core and Module Clocks
|
||||
*/
|
||||
struct cpg_mssr_priv {
|
||||
|
@ -51,10 +51,6 @@
|
||||
*/
|
||||
struct rockchip_cpuclk {
|
||||
struct clk_hw hw;
|
||||
|
||||
struct clk_mux cpu_mux;
|
||||
const struct clk_ops *cpu_mux_ops;
|
||||
|
||||
struct clk *alt_parent;
|
||||
void __iomem *reg_base;
|
||||
struct notifier_block clk_nb;
|
||||
|
@ -145,7 +145,7 @@ static const struct clk_ops clk_half_divider_ops = {
|
||||
.set_rate = clk_half_divider_set_rate,
|
||||
};
|
||||
|
||||
/**
|
||||
/*
|
||||
* Register a clock branch.
|
||||
* Most clock branches have a form like
|
||||
*
|
||||
|
@ -97,7 +97,7 @@ static int rockchip_pll_wait_lock(struct rockchip_clk_pll *pll)
|
||||
return ret;
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* PLL used in RK3036
|
||||
*/
|
||||
|
||||
@ -358,7 +358,7 @@ static const struct clk_ops rockchip_rk3036_pll_clk_ops = {
|
||||
.init = rockchip_rk3036_pll_init,
|
||||
};
|
||||
|
||||
/**
|
||||
/*
|
||||
* PLL used in RK3066, RK3188 and RK3288
|
||||
*/
|
||||
|
||||
@ -577,7 +577,7 @@ static const struct clk_ops rockchip_rk3066_pll_clk_ops = {
|
||||
.init = rockchip_rk3066_pll_init,
|
||||
};
|
||||
|
||||
/**
|
||||
/*
|
||||
* PLL used in RK3399
|
||||
*/
|
||||
|
||||
|
@ -474,7 +474,7 @@ static struct rockchip_clk_branch rk3368_clk_branches[] __initdata = {
|
||||
COMPOSITE_NODIV(0, "vip_src", mux_pll_src_cpll_gpll_p, 0,
|
||||
RK3368_CLKSEL_CON(21), 15, 1, MFLAGS,
|
||||
RK3368_CLKGATE_CON(4), 5, GFLAGS),
|
||||
COMPOSITE_NOGATE(0, "sclk_vip_out", mux_vip_out_p, 0,
|
||||
COMPOSITE_NOGATE(SCLK_VIP_OUT, "sclk_vip_out", mux_vip_out_p, 0,
|
||||
RK3368_CLKSEL_CON(21), 14, 1, MFLAGS, 8, 5, DFLAGS),
|
||||
|
||||
COMPOSITE_NODIV(SCLK_EDP_24M, "sclk_edp_24m", mux_edp_24m_p, 0,
|
||||
@ -818,8 +818,8 @@ static struct rockchip_clk_branch rk3368_clk_branches[] __initdata = {
|
||||
* pclk_vio gates
|
||||
* pclk_vio comes from the exactly same source as hclk_vio
|
||||
*/
|
||||
GATE(0, "pclk_dphyrx", "hclk_vio", CLK_IGNORE_UNUSED, RK3368_CLKGATE_CON(14), 8, GFLAGS),
|
||||
GATE(0, "pclk_dphytx", "hclk_vio", CLK_IGNORE_UNUSED, RK3368_CLKGATE_CON(14), 8, GFLAGS),
|
||||
GATE(PCLK_DPHYRX, "pclk_dphyrx", "hclk_vio", CLK_IGNORE_UNUSED, RK3368_CLKGATE_CON(22), 11, GFLAGS),
|
||||
GATE(PCLK_DPHYTX0, "pclk_dphytx0", "hclk_vio", CLK_IGNORE_UNUSED, RK3368_CLKGATE_CON(22), 10, GFLAGS),
|
||||
|
||||
/* pclk_pd_pmu gates */
|
||||
GATE(PCLK_PMUGRF, "pclk_pmugrf", "pclk_pd_pmu", CLK_IGNORE_UNUSED, RK3368_CLKGATE_CON(23), 5, GFLAGS),
|
||||
|
@ -24,7 +24,7 @@
|
||||
#include <linux/rational.h>
|
||||
#include "clk.h"
|
||||
|
||||
/**
|
||||
/*
|
||||
* Register a clock branch.
|
||||
* Most clock branches have a form like
|
||||
*
|
||||
@ -170,7 +170,7 @@ static int rockchip_clk_frac_notifier_cb(struct notifier_block *nb,
|
||||
return notifier_from_errno(ret);
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* fractional divider must set that denominator is 20 times larger than
|
||||
* numerator to generate precise clock frequency.
|
||||
*/
|
||||
|
@ -32,8 +32,13 @@ config SUN50I_H6_CCU
|
||||
default ARM64 && ARCH_SUNXI
|
||||
depends on (ARM64 && ARCH_SUNXI) || COMPILE_TEST
|
||||
|
||||
config SUN50I_H616_CCU
|
||||
bool "Support for the Allwinner H616 CCU"
|
||||
default ARM64 && ARCH_SUNXI
|
||||
depends on (ARM64 && ARCH_SUNXI) || COMPILE_TEST
|
||||
|
||||
config SUN50I_H6_R_CCU
|
||||
bool "Support for the Allwinner H6 PRCM CCU"
|
||||
bool "Support for the Allwinner H6 and H616 PRCM CCU"
|
||||
default ARM64 && ARCH_SUNXI
|
||||
depends on (ARM64 && ARCH_SUNXI) || COMPILE_TEST
|
||||
|
||||
|
@ -26,6 +26,7 @@ obj-$(CONFIG_SUN50I_A64_CCU) += ccu-sun50i-a64.o
|
||||
obj-$(CONFIG_SUN50I_A100_CCU) += ccu-sun50i-a100.o
|
||||
obj-$(CONFIG_SUN50I_A100_R_CCU) += ccu-sun50i-a100-r.o
|
||||
obj-$(CONFIG_SUN50I_H6_CCU) += ccu-sun50i-h6.o
|
||||
obj-$(CONFIG_SUN50I_H616_CCU) += ccu-sun50i-h616.o
|
||||
obj-$(CONFIG_SUN50I_H6_R_CCU) += ccu-sun50i-h6-r.o
|
||||
obj-$(CONFIG_SUN4I_A10_CCU) += ccu-sun4i-a10.o
|
||||
obj-$(CONFIG_SUN5I_CCU) += ccu-sun5i.o
|
||||
|
@ -91,6 +91,8 @@ static SUNXI_CCU_GATE(r_apb2_uart_clk, "r-apb2-uart", "r-apb2",
|
||||
0x18c, BIT(0), 0);
|
||||
static SUNXI_CCU_GATE(r_apb2_i2c_clk, "r-apb2-i2c", "r-apb2",
|
||||
0x19c, BIT(0), 0);
|
||||
static SUNXI_CCU_GATE(r_apb2_rsb_clk, "r-apb2-rsb", "r-apb2",
|
||||
0x1bc, BIT(0), 0);
|
||||
static SUNXI_CCU_GATE(r_apb1_ir_clk, "r-apb1-ir", "r-apb1",
|
||||
0x1cc, BIT(0), 0);
|
||||
static SUNXI_CCU_GATE(r_apb1_w1_clk, "r-apb1-w1", "r-apb1",
|
||||
@ -130,12 +132,23 @@ static struct ccu_common *sun50i_h6_r_ccu_clks[] = {
|
||||
&r_apb1_pwm_clk.common,
|
||||
&r_apb2_uart_clk.common,
|
||||
&r_apb2_i2c_clk.common,
|
||||
&r_apb2_rsb_clk.common,
|
||||
&r_apb1_ir_clk.common,
|
||||
&r_apb1_w1_clk.common,
|
||||
&ir_clk.common,
|
||||
&w1_clk.common,
|
||||
};
|
||||
|
||||
static struct ccu_common *sun50i_h616_r_ccu_clks[] = {
|
||||
&r_apb1_clk.common,
|
||||
&r_apb2_clk.common,
|
||||
&r_apb1_twd_clk.common,
|
||||
&r_apb2_i2c_clk.common,
|
||||
&r_apb2_rsb_clk.common,
|
||||
&r_apb1_ir_clk.common,
|
||||
&ir_clk.common,
|
||||
};
|
||||
|
||||
static struct clk_hw_onecell_data sun50i_h6_r_hw_clks = {
|
||||
.hws = {
|
||||
[CLK_AR100] = &ar100_clk.common.hw,
|
||||
@ -147,6 +160,7 @@ static struct clk_hw_onecell_data sun50i_h6_r_hw_clks = {
|
||||
[CLK_R_APB1_PWM] = &r_apb1_pwm_clk.common.hw,
|
||||
[CLK_R_APB2_UART] = &r_apb2_uart_clk.common.hw,
|
||||
[CLK_R_APB2_I2C] = &r_apb2_i2c_clk.common.hw,
|
||||
[CLK_R_APB2_RSB] = &r_apb2_rsb_clk.common.hw,
|
||||
[CLK_R_APB1_IR] = &r_apb1_ir_clk.common.hw,
|
||||
[CLK_R_APB1_W1] = &r_apb1_w1_clk.common.hw,
|
||||
[CLK_IR] = &ir_clk.common.hw,
|
||||
@ -155,16 +169,38 @@ static struct clk_hw_onecell_data sun50i_h6_r_hw_clks = {
|
||||
.num = CLK_NUMBER,
|
||||
};
|
||||
|
||||
static struct clk_hw_onecell_data sun50i_h616_r_hw_clks = {
|
||||
.hws = {
|
||||
[CLK_R_AHB] = &r_ahb_clk.hw,
|
||||
[CLK_R_APB1] = &r_apb1_clk.common.hw,
|
||||
[CLK_R_APB2] = &r_apb2_clk.common.hw,
|
||||
[CLK_R_APB1_TWD] = &r_apb1_twd_clk.common.hw,
|
||||
[CLK_R_APB2_I2C] = &r_apb2_i2c_clk.common.hw,
|
||||
[CLK_R_APB2_RSB] = &r_apb2_rsb_clk.common.hw,
|
||||
[CLK_R_APB1_IR] = &r_apb1_ir_clk.common.hw,
|
||||
[CLK_IR] = &ir_clk.common.hw,
|
||||
},
|
||||
.num = CLK_NUMBER,
|
||||
};
|
||||
|
||||
static struct ccu_reset_map sun50i_h6_r_ccu_resets[] = {
|
||||
[RST_R_APB1_TIMER] = { 0x11c, BIT(16) },
|
||||
[RST_R_APB1_TWD] = { 0x12c, BIT(16) },
|
||||
[RST_R_APB1_PWM] = { 0x13c, BIT(16) },
|
||||
[RST_R_APB2_UART] = { 0x18c, BIT(16) },
|
||||
[RST_R_APB2_I2C] = { 0x19c, BIT(16) },
|
||||
[RST_R_APB2_RSB] = { 0x1bc, BIT(16) },
|
||||
[RST_R_APB1_IR] = { 0x1cc, BIT(16) },
|
||||
[RST_R_APB1_W1] = { 0x1ec, BIT(16) },
|
||||
};
|
||||
|
||||
static struct ccu_reset_map sun50i_h616_r_ccu_resets[] = {
|
||||
[RST_R_APB1_TWD] = { 0x12c, BIT(16) },
|
||||
[RST_R_APB2_I2C] = { 0x19c, BIT(16) },
|
||||
[RST_R_APB2_RSB] = { 0x1bc, BIT(16) },
|
||||
[RST_R_APB1_IR] = { 0x1cc, BIT(16) },
|
||||
};
|
||||
|
||||
static const struct sunxi_ccu_desc sun50i_h6_r_ccu_desc = {
|
||||
.ccu_clks = sun50i_h6_r_ccu_clks,
|
||||
.num_ccu_clks = ARRAY_SIZE(sun50i_h6_r_ccu_clks),
|
||||
@ -175,6 +211,16 @@ static const struct sunxi_ccu_desc sun50i_h6_r_ccu_desc = {
|
||||
.num_resets = ARRAY_SIZE(sun50i_h6_r_ccu_resets),
|
||||
};
|
||||
|
||||
static const struct sunxi_ccu_desc sun50i_h616_r_ccu_desc = {
|
||||
.ccu_clks = sun50i_h616_r_ccu_clks,
|
||||
.num_ccu_clks = ARRAY_SIZE(sun50i_h616_r_ccu_clks),
|
||||
|
||||
.hw_clks = &sun50i_h616_r_hw_clks,
|
||||
|
||||
.resets = sun50i_h616_r_ccu_resets,
|
||||
.num_resets = ARRAY_SIZE(sun50i_h616_r_ccu_resets),
|
||||
};
|
||||
|
||||
static void __init sunxi_r_ccu_init(struct device_node *node,
|
||||
const struct sunxi_ccu_desc *desc)
|
||||
{
|
||||
@ -195,3 +241,10 @@ static void __init sun50i_h6_r_ccu_setup(struct device_node *node)
|
||||
}
|
||||
CLK_OF_DECLARE(sun50i_h6_r_ccu, "allwinner,sun50i-h6-r-ccu",
|
||||
sun50i_h6_r_ccu_setup);
|
||||
|
||||
static void __init sun50i_h616_r_ccu_setup(struct device_node *node)
|
||||
{
|
||||
sunxi_r_ccu_init(node, &sun50i_h616_r_ccu_desc);
|
||||
}
|
||||
CLK_OF_DECLARE(sun50i_h616_r_ccu, "allwinner,sun50i-h616-r-ccu",
|
||||
sun50i_h616_r_ccu_setup);
|
||||
|
@ -14,6 +14,6 @@
|
||||
|
||||
#define CLK_R_APB2 3
|
||||
|
||||
#define CLK_NUMBER (CLK_W1 + 1)
|
||||
#define CLK_NUMBER (CLK_R_APB2_RSB + 1)
|
||||
|
||||
#endif /* _CCU_SUN50I_H6_R_H */
|
||||
|
@ -237,7 +237,7 @@ static const char * const psi_ahb1_ahb2_parents[] = { "osc24M", "osc32k",
|
||||
static SUNXI_CCU_MP_WITH_MUX(psi_ahb1_ahb2_clk, "psi-ahb1-ahb2",
|
||||
psi_ahb1_ahb2_parents,
|
||||
0x510,
|
||||
0, 5, /* M */
|
||||
0, 2, /* M */
|
||||
8, 2, /* P */
|
||||
24, 2, /* mux */
|
||||
0);
|
||||
@ -246,19 +246,19 @@ static const char * const ahb3_apb1_apb2_parents[] = { "osc24M", "osc32k",
|
||||
"psi-ahb1-ahb2",
|
||||
"pll-periph0" };
|
||||
static SUNXI_CCU_MP_WITH_MUX(ahb3_clk, "ahb3", ahb3_apb1_apb2_parents, 0x51c,
|
||||
0, 5, /* M */
|
||||
0, 2, /* M */
|
||||
8, 2, /* P */
|
||||
24, 2, /* mux */
|
||||
0);
|
||||
|
||||
static SUNXI_CCU_MP_WITH_MUX(apb1_clk, "apb1", ahb3_apb1_apb2_parents, 0x520,
|
||||
0, 5, /* M */
|
||||
0, 2, /* M */
|
||||
8, 2, /* P */
|
||||
24, 2, /* mux */
|
||||
0);
|
||||
|
||||
static SUNXI_CCU_MP_WITH_MUX(apb2_clk, "apb2", ahb3_apb1_apb2_parents, 0x524,
|
||||
0, 5, /* M */
|
||||
0, 2, /* M */
|
||||
8, 2, /* P */
|
||||
24, 2, /* mux */
|
||||
0);
|
||||
@ -682,7 +682,7 @@ static struct ccu_mux hdmi_cec_clk = {
|
||||
|
||||
.common = {
|
||||
.reg = 0xb10,
|
||||
.features = CCU_FEATURE_VARIABLE_PREDIV,
|
||||
.features = CCU_FEATURE_FIXED_PREDIV,
|
||||
.hw.init = CLK_HW_INIT_PARENTS("hdmi-cec",
|
||||
hdmi_cec_parents,
|
||||
&ccu_mux_ops,
|
||||
|
1150
drivers/clk/sunxi-ng/ccu-sun50i-h616.c
Normal file
1150
drivers/clk/sunxi-ng/ccu-sun50i-h616.c
Normal file
File diff suppressed because it is too large
Load Diff
56
drivers/clk/sunxi-ng/ccu-sun50i-h616.h
Normal file
56
drivers/clk/sunxi-ng/ccu-sun50i-h616.h
Normal file
@ -0,0 +1,56 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
/*
|
||||
* Copyright 2020 Arm Ltd.
|
||||
*/
|
||||
|
||||
#ifndef _CCU_SUN50I_H616_H_
|
||||
#define _CCU_SUN50I_H616_H_
|
||||
|
||||
#include <dt-bindings/clock/sun50i-h616-ccu.h>
|
||||
#include <dt-bindings/reset/sun50i-h616-ccu.h>
|
||||
|
||||
#define CLK_OSC12M 0
|
||||
#define CLK_PLL_CPUX 1
|
||||
#define CLK_PLL_DDR0 2
|
||||
#define CLK_PLL_DDR1 3
|
||||
|
||||
/* PLL_PERIPH0 exported for PRCM */
|
||||
|
||||
#define CLK_PLL_PERIPH0_2X 5
|
||||
#define CLK_PLL_PERIPH1 6
|
||||
#define CLK_PLL_PERIPH1_2X 7
|
||||
#define CLK_PLL_GPU 8
|
||||
#define CLK_PLL_VIDEO0 9
|
||||
#define CLK_PLL_VIDEO0_4X 10
|
||||
#define CLK_PLL_VIDEO1 11
|
||||
#define CLK_PLL_VIDEO1_4X 12
|
||||
#define CLK_PLL_VIDEO2 13
|
||||
#define CLK_PLL_VIDEO2_4X 14
|
||||
#define CLK_PLL_VE 15
|
||||
#define CLK_PLL_DE 16
|
||||
#define CLK_PLL_AUDIO_HS 17
|
||||
#define CLK_PLL_AUDIO_1X 18
|
||||
#define CLK_PLL_AUDIO_2X 19
|
||||
#define CLK_PLL_AUDIO_4X 20
|
||||
|
||||
/* CPUX clock exported for DVFS */
|
||||
|
||||
#define CLK_AXI 22
|
||||
#define CLK_CPUX_APB 23
|
||||
#define CLK_PSI_AHB1_AHB2 24
|
||||
#define CLK_AHB3 25
|
||||
|
||||
/* APB1 clock exported for PIO */
|
||||
|
||||
#define CLK_APB2 27
|
||||
#define CLK_MBUS 28
|
||||
|
||||
/* All module clocks and bus gates are exported except DRAM */
|
||||
|
||||
#define CLK_DRAM 49
|
||||
|
||||
#define CLK_BUS_DRAM 56
|
||||
|
||||
#define CLK_NUMBER (CLK_BUS_HDCP + 1)
|
||||
|
||||
#endif /* _CCU_SUN50I_H616_H_ */
|
@ -20,7 +20,7 @@ static DEFINE_SPINLOCK(ve_lock);
|
||||
#define SUN4I_VE_DIVIDER_WIDTH 3
|
||||
#define SUN4I_VE_RESET 0
|
||||
|
||||
/**
|
||||
/*
|
||||
* sunxi_ve_reset... - reset bit in ve clk registers handling
|
||||
*/
|
||||
|
||||
|
@ -14,7 +14,7 @@
|
||||
|
||||
#include "clk-factors.h"
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun4i_a10_get_mod0_factors() - calculates m, n factors for MOD0-style clocks
|
||||
* MOD0 rate is calculated as follows
|
||||
* rate = (parent_rate >> p) / (m + 1);
|
||||
|
@ -23,7 +23,7 @@ static DEFINE_SPINLOCK(clk_lock);
|
||||
/* Maximum number of parents our clocks have */
|
||||
#define SUNXI_MAX_PARENTS 5
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun4i_get_pll1_factors() - calculates n, k, m, p factors for PLL1
|
||||
* PLL1 rate is calculated as follows
|
||||
* rate = (parent_rate * n * (k + 1) >> p) / (m + 1);
|
||||
@ -71,7 +71,7 @@ static void sun4i_get_pll1_factors(struct factors_request *req)
|
||||
req->n = div / 4;
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun6i_a31_get_pll1_factors() - calculates n, k and m factors for PLL1
|
||||
* PLL1 rate is calculated as follows
|
||||
* rate = parent_rate * (n + 1) * (k + 1) / (m + 1);
|
||||
@ -147,7 +147,7 @@ static void sun6i_a31_get_pll1_factors(struct factors_request *req)
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun8i_a23_get_pll1_factors() - calculates n, k, m, p factors for PLL1
|
||||
* PLL1 rate is calculated as follows
|
||||
* rate = (parent_rate * (n + 1) * (k + 1) >> p) / (m + 1);
|
||||
@ -191,7 +191,7 @@ static void sun8i_a23_get_pll1_factors(struct factors_request *req)
|
||||
req->n = div / 4 - 1;
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun4i_get_pll5_factors() - calculates n, k factors for PLL5
|
||||
* PLL5 rate is calculated as follows
|
||||
* rate = parent_rate * n * (k + 1)
|
||||
@ -218,7 +218,7 @@ static void sun4i_get_pll5_factors(struct factors_request *req)
|
||||
req->n = DIV_ROUND_UP(div, (req->k + 1));
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun6i_a31_get_pll6_factors() - calculates n, k factors for A31 PLL6x2
|
||||
* PLL6x2 rate is calculated as follows
|
||||
* rate = parent_rate * (n + 1) * (k + 1)
|
||||
@ -240,7 +240,7 @@ static void sun6i_a31_get_pll6_factors(struct factors_request *req)
|
||||
req->n = DIV_ROUND_UP(div, (req->k + 1)) - 1;
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun5i_a13_get_ahb_factors() - calculates m, p factors for AHB
|
||||
* AHB rate is calculated as follows
|
||||
* rate = parent_rate >> p
|
||||
@ -276,7 +276,7 @@ static void sun5i_a13_get_ahb_factors(struct factors_request *req)
|
||||
|
||||
#define SUN6I_AHB1_PARENT_PLL6 3
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun6i_a31_get_ahb_factors() - calculates m, p factors for AHB
|
||||
* AHB rate is calculated as follows
|
||||
* rate = parent_rate >> p
|
||||
@ -320,7 +320,7 @@ static void sun6i_get_ahb1_factors(struct factors_request *req)
|
||||
req->m = calcm - 1;
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun6i_ahb1_recalc() - calculates AHB clock rate from m, p factors and
|
||||
* parent index
|
||||
*/
|
||||
@ -336,7 +336,7 @@ static void sun6i_ahb1_recalc(struct factors_request *req)
|
||||
req->rate >>= req->p;
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun4i_get_apb1_factors() - calculates m, p factors for APB1
|
||||
* APB1 rate is calculated as follows
|
||||
* rate = (parent_rate >> p) / (m + 1);
|
||||
@ -375,7 +375,7 @@ static void sun4i_get_apb1_factors(struct factors_request *req)
|
||||
|
||||
|
||||
|
||||
/**
|
||||
/*
|
||||
* sun7i_a20_get_out_factors() - calculates m, p factors for CLK_OUT_A/B
|
||||
* CLK_OUT rate is calculated as follows
|
||||
* rate = (parent_rate >> p) / (m + 1);
|
||||
@ -408,7 +408,7 @@ static void sun7i_a20_get_out_factors(struct factors_request *req)
|
||||
req->p = calcp;
|
||||
}
|
||||
|
||||
/**
|
||||
/*
|
||||
* sunxi_factors_clk_setup() - Setup function for factor clocks
|
||||
*/
|
||||
|
||||
@ -625,7 +625,7 @@ CLK_OF_DECLARE(sun7i_out, "allwinner,sun7i-a20-out-clk",
|
||||
sun7i_out_clk_setup);
|
||||
|
||||
|
||||
/**
|
||||
/*
|
||||
* sunxi_mux_clk_setup() - Setup function for muxes
|
||||
*/
|
||||
|
||||
@ -717,7 +717,7 @@ CLK_OF_DECLARE(sun8i_ahb2, "allwinner,sun8i-h3-ahb2-clk",
|
||||
sun8i_ahb2_clk_setup);
|
||||
|
||||
|
||||
/**
|
||||
/*
|
||||
* sunxi_divider_clk_setup() - Setup function for simple divider clocks
|
||||
*/
|
||||
|
||||
@ -853,7 +853,7 @@ CLK_OF_DECLARE(sun8i_axi, "allwinner,sun8i-a23-axi-clk",
|
||||
|
||||
|
||||
|
||||
/**
|
||||
/*
|
||||
* sunxi_gates_clk_setup() - Setup function for leaf gates on clocks
|
||||
*/
|
||||
|
||||
@ -863,7 +863,7 @@ struct gates_data {
|
||||
DECLARE_BITMAP(mask, SUNXI_GATES_MAX_SIZE);
|
||||
};
|
||||
|
||||
/**
|
||||
/*
|
||||
* sunxi_divs_clk_setup() helper data
|
||||
*/
|
||||
|
||||
@ -929,7 +929,7 @@ static const struct divs_data sun6i_a31_pll6_divs_data __initconst = {
|
||||
}
|
||||
};
|
||||
|
||||
/**
|
||||
/*
|
||||
* sunxi_divs_clk_setup() - Setup function for leaf divisors on clocks
|
||||
*
|
||||
* These clocks look something like this
|
||||
|
19
drivers/clk/xilinx/Kconfig
Normal file
19
drivers/clk/xilinx/Kconfig
Normal file
@ -0,0 +1,19 @@
|
||||
# SPDX-License-Identifier: GPL-2.0
|
||||
|
||||
config XILINX_VCU
|
||||
tristate "Xilinx VCU logicoreIP Init"
|
||||
depends on HAS_IOMEM && COMMON_CLK
|
||||
select REGMAP_MMIO
|
||||
help
|
||||
Provides the driver to enable and disable the isolation between the
|
||||
processing system and programmable logic part by using the logicoreIP
|
||||
register set. This driver also configures the frequency based on the
|
||||
clock information from the logicoreIP register set.
|
||||
|
||||
If you say yes here you get support for the logicoreIP.
|
||||
|
||||
If unsure, say N.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called xlnx_vcu.
|
||||
|
2
drivers/clk/xilinx/Makefile
Normal file
2
drivers/clk/xilinx/Makefile
Normal file
@ -0,0 +1,2 @@
|
||||
# SPDX-License-Identifier: GPL-2.0
|
||||
obj-$(CONFIG_XILINX_VCU) += xlnx_vcu.o
|
743
drivers/clk/xilinx/xlnx_vcu.c
Normal file
743
drivers/clk/xilinx/xlnx_vcu.c
Normal file
@ -0,0 +1,743 @@
|
||||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* Xilinx VCU Init
|
||||
*
|
||||
* Copyright (C) 2016 - 2017 Xilinx, Inc.
|
||||
*
|
||||
* Contacts Dhaval Shah <dshah@xilinx.com>
|
||||
*/
|
||||
#include <linux/bitfield.h>
|
||||
#include <linux/clk.h>
|
||||
#include <linux/clk-provider.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/mfd/syscon.h>
|
||||
#include <linux/mfd/syscon/xlnx-vcu.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/of_platform.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/regmap.h>
|
||||
|
||||
#include <dt-bindings/clock/xlnx-vcu.h>
|
||||
|
||||
#define VCU_PLL_CTRL 0x24
|
||||
#define VCU_PLL_CTRL_RESET BIT(0)
|
||||
#define VCU_PLL_CTRL_POR_IN BIT(1)
|
||||
#define VCU_PLL_CTRL_PWR_POR BIT(2)
|
||||
#define VCU_PLL_CTRL_BYPASS BIT(3)
|
||||
#define VCU_PLL_CTRL_FBDIV GENMASK(14, 8)
|
||||
#define VCU_PLL_CTRL_CLKOUTDIV GENMASK(18, 16)
|
||||
|
||||
#define VCU_PLL_CFG 0x28
|
||||
#define VCU_PLL_CFG_RES GENMASK(3, 0)
|
||||
#define VCU_PLL_CFG_CP GENMASK(8, 5)
|
||||
#define VCU_PLL_CFG_LFHF GENMASK(12, 10)
|
||||
#define VCU_PLL_CFG_LOCK_CNT GENMASK(22, 13)
|
||||
#define VCU_PLL_CFG_LOCK_DLY GENMASK(31, 25)
|
||||
#define VCU_ENC_CORE_CTRL 0x30
|
||||
#define VCU_ENC_MCU_CTRL 0x34
|
||||
#define VCU_DEC_CORE_CTRL 0x38
|
||||
#define VCU_DEC_MCU_CTRL 0x3c
|
||||
#define VCU_PLL_STATUS 0x60
|
||||
#define VCU_PLL_STATUS_LOCK_STATUS BIT(0)
|
||||
|
||||
#define MHZ 1000000
|
||||
#define FVCO_MIN (1500U * MHZ)
|
||||
#define FVCO_MAX (3000U * MHZ)
|
||||
|
||||
/**
|
||||
* struct xvcu_device - Xilinx VCU init device structure
|
||||
* @dev: Platform device
|
||||
* @pll_ref: pll ref clock source
|
||||
* @aclk: axi clock source
|
||||
* @logicore_reg_ba: logicore reg base address
|
||||
* @vcu_slcr_ba: vcu_slcr Register base address
|
||||
* @pll: handle for the VCU PLL
|
||||
* @pll_post: handle for the VCU PLL post divider
|
||||
* @clk_data: clocks provided by the vcu clock provider
|
||||
*/
|
||||
struct xvcu_device {
|
||||
struct device *dev;
|
||||
struct clk *pll_ref;
|
||||
struct clk *aclk;
|
||||
struct regmap *logicore_reg_ba;
|
||||
void __iomem *vcu_slcr_ba;
|
||||
struct clk_hw *pll;
|
||||
struct clk_hw *pll_post;
|
||||
struct clk_hw_onecell_data *clk_data;
|
||||
};
|
||||
|
||||
static struct regmap_config vcu_settings_regmap_config = {
|
||||
.name = "regmap",
|
||||
.reg_bits = 32,
|
||||
.val_bits = 32,
|
||||
.reg_stride = 4,
|
||||
.max_register = 0xfff,
|
||||
.cache_type = REGCACHE_NONE,
|
||||
};
|
||||
|
||||
/**
|
||||
* struct xvcu_pll_cfg - Helper data
|
||||
* @fbdiv: The integer portion of the feedback divider to the PLL
|
||||
* @cp: PLL charge pump control
|
||||
* @res: PLL loop filter resistor control
|
||||
* @lfhf: PLL loop filter high frequency capacitor control
|
||||
* @lock_dly: Lock circuit configuration settings for lock windowsize
|
||||
* @lock_cnt: Lock circuit counter setting
|
||||
*/
|
||||
struct xvcu_pll_cfg {
|
||||
u32 fbdiv;
|
||||
u32 cp;
|
||||
u32 res;
|
||||
u32 lfhf;
|
||||
u32 lock_dly;
|
||||
u32 lock_cnt;
|
||||
};
|
||||
|
||||
static const struct xvcu_pll_cfg xvcu_pll_cfg[] = {
|
||||
{ 25, 3, 10, 3, 63, 1000 },
|
||||
{ 26, 3, 10, 3, 63, 1000 },
|
||||
{ 27, 4, 6, 3, 63, 1000 },
|
||||
{ 28, 4, 6, 3, 63, 1000 },
|
||||
{ 29, 4, 6, 3, 63, 1000 },
|
||||
{ 30, 4, 6, 3, 63, 1000 },
|
||||
{ 31, 6, 1, 3, 63, 1000 },
|
||||
{ 32, 6, 1, 3, 63, 1000 },
|
||||
{ 33, 4, 10, 3, 63, 1000 },
|
||||
{ 34, 5, 6, 3, 63, 1000 },
|
||||
{ 35, 5, 6, 3, 63, 1000 },
|
||||
{ 36, 5, 6, 3, 63, 1000 },
|
||||
{ 37, 5, 6, 3, 63, 1000 },
|
||||
{ 38, 5, 6, 3, 63, 975 },
|
||||
{ 39, 3, 12, 3, 63, 950 },
|
||||
{ 40, 3, 12, 3, 63, 925 },
|
||||
{ 41, 3, 12, 3, 63, 900 },
|
||||
{ 42, 3, 12, 3, 63, 875 },
|
||||
{ 43, 3, 12, 3, 63, 850 },
|
||||
{ 44, 3, 12, 3, 63, 850 },
|
||||
{ 45, 3, 12, 3, 63, 825 },
|
||||
{ 46, 3, 12, 3, 63, 800 },
|
||||
{ 47, 3, 12, 3, 63, 775 },
|
||||
{ 48, 3, 12, 3, 63, 775 },
|
||||
{ 49, 3, 12, 3, 63, 750 },
|
||||
{ 50, 3, 12, 3, 63, 750 },
|
||||
{ 51, 3, 2, 3, 63, 725 },
|
||||
{ 52, 3, 2, 3, 63, 700 },
|
||||
{ 53, 3, 2, 3, 63, 700 },
|
||||
{ 54, 3, 2, 3, 63, 675 },
|
||||
{ 55, 3, 2, 3, 63, 675 },
|
||||
{ 56, 3, 2, 3, 63, 650 },
|
||||
{ 57, 3, 2, 3, 63, 650 },
|
||||
{ 58, 3, 2, 3, 63, 625 },
|
||||
{ 59, 3, 2, 3, 63, 625 },
|
||||
{ 60, 3, 2, 3, 63, 625 },
|
||||
{ 61, 3, 2, 3, 63, 600 },
|
||||
{ 62, 3, 2, 3, 63, 600 },
|
||||
{ 63, 3, 2, 3, 63, 600 },
|
||||
{ 64, 3, 2, 3, 63, 600 },
|
||||
{ 65, 3, 2, 3, 63, 600 },
|
||||
{ 66, 3, 2, 3, 63, 600 },
|
||||
{ 67, 3, 2, 3, 63, 600 },
|
||||
{ 68, 3, 2, 3, 63, 600 },
|
||||
{ 69, 3, 2, 3, 63, 600 },
|
||||
{ 70, 3, 2, 3, 63, 600 },
|
||||
{ 71, 3, 2, 3, 63, 600 },
|
||||
{ 72, 3, 2, 3, 63, 600 },
|
||||
{ 73, 3, 2, 3, 63, 600 },
|
||||
{ 74, 3, 2, 3, 63, 600 },
|
||||
{ 75, 3, 2, 3, 63, 600 },
|
||||
{ 76, 3, 2, 3, 63, 600 },
|
||||
{ 77, 3, 2, 3, 63, 600 },
|
||||
{ 78, 3, 2, 3, 63, 600 },
|
||||
{ 79, 3, 2, 3, 63, 600 },
|
||||
{ 80, 3, 2, 3, 63, 600 },
|
||||
{ 81, 3, 2, 3, 63, 600 },
|
||||
{ 82, 3, 2, 3, 63, 600 },
|
||||
{ 83, 4, 2, 3, 63, 600 },
|
||||
{ 84, 4, 2, 3, 63, 600 },
|
||||
{ 85, 4, 2, 3, 63, 600 },
|
||||
{ 86, 4, 2, 3, 63, 600 },
|
||||
{ 87, 4, 2, 3, 63, 600 },
|
||||
{ 88, 4, 2, 3, 63, 600 },
|
||||
{ 89, 4, 2, 3, 63, 600 },
|
||||
{ 90, 4, 2, 3, 63, 600 },
|
||||
{ 91, 4, 2, 3, 63, 600 },
|
||||
{ 92, 4, 2, 3, 63, 600 },
|
||||
{ 93, 4, 2, 3, 63, 600 },
|
||||
{ 94, 4, 2, 3, 63, 600 },
|
||||
{ 95, 4, 2, 3, 63, 600 },
|
||||
{ 96, 4, 2, 3, 63, 600 },
|
||||
{ 97, 4, 2, 3, 63, 600 },
|
||||
{ 98, 4, 2, 3, 63, 600 },
|
||||
{ 99, 4, 2, 3, 63, 600 },
|
||||
{ 100, 4, 2, 3, 63, 600 },
|
||||
{ 101, 4, 2, 3, 63, 600 },
|
||||
{ 102, 4, 2, 3, 63, 600 },
|
||||
{ 103, 5, 2, 3, 63, 600 },
|
||||
{ 104, 5, 2, 3, 63, 600 },
|
||||
{ 105, 5, 2, 3, 63, 600 },
|
||||
{ 106, 5, 2, 3, 63, 600 },
|
||||
{ 107, 3, 4, 3, 63, 600 },
|
||||
{ 108, 3, 4, 3, 63, 600 },
|
||||
{ 109, 3, 4, 3, 63, 600 },
|
||||
{ 110, 3, 4, 3, 63, 600 },
|
||||
{ 111, 3, 4, 3, 63, 600 },
|
||||
{ 112, 3, 4, 3, 63, 600 },
|
||||
{ 113, 3, 4, 3, 63, 600 },
|
||||
{ 114, 3, 4, 3, 63, 600 },
|
||||
{ 115, 3, 4, 3, 63, 600 },
|
||||
{ 116, 3, 4, 3, 63, 600 },
|
||||
{ 117, 3, 4, 3, 63, 600 },
|
||||
{ 118, 3, 4, 3, 63, 600 },
|
||||
{ 119, 3, 4, 3, 63, 600 },
|
||||
{ 120, 3, 4, 3, 63, 600 },
|
||||
{ 121, 3, 4, 3, 63, 600 },
|
||||
{ 122, 3, 4, 3, 63, 600 },
|
||||
{ 123, 3, 4, 3, 63, 600 },
|
||||
{ 124, 3, 4, 3, 63, 600 },
|
||||
{ 125, 3, 4, 3, 63, 600 },
|
||||
};
|
||||
|
||||
/**
|
||||
* xvcu_read - Read from the VCU register space
|
||||
* @iomem: vcu reg space base address
|
||||
* @offset: vcu reg offset from base
|
||||
*
|
||||
* Return: Returns 32bit value from VCU register specified
|
||||
*
|
||||
*/
|
||||
static inline u32 xvcu_read(void __iomem *iomem, u32 offset)
|
||||
{
|
||||
return ioread32(iomem + offset);
|
||||
}
|
||||
|
||||
/**
|
||||
* xvcu_write - Write to the VCU register space
|
||||
* @iomem: vcu reg space base address
|
||||
* @offset: vcu reg offset from base
|
||||
* @value: Value to write
|
||||
*/
|
||||
static inline void xvcu_write(void __iomem *iomem, u32 offset, u32 value)
|
||||
{
|
||||
iowrite32(value, iomem + offset);
|
||||
}
|
||||
|
||||
#define to_vcu_pll(_hw) container_of(_hw, struct vcu_pll, hw)
|
||||
|
||||
struct vcu_pll {
|
||||
struct clk_hw hw;
|
||||
void __iomem *reg_base;
|
||||
unsigned long fvco_min;
|
||||
unsigned long fvco_max;
|
||||
};
|
||||
|
||||
static int xvcu_pll_wait_for_lock(struct vcu_pll *pll)
|
||||
{
|
||||
void __iomem *base = pll->reg_base;
|
||||
unsigned long timeout;
|
||||
u32 lock_status;
|
||||
|
||||
timeout = jiffies + msecs_to_jiffies(2000);
|
||||
do {
|
||||
lock_status = xvcu_read(base, VCU_PLL_STATUS);
|
||||
if (lock_status & VCU_PLL_STATUS_LOCK_STATUS)
|
||||
return 0;
|
||||
} while (!time_after(jiffies, timeout));
|
||||
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
static struct clk_hw *xvcu_register_pll_post(struct device *dev,
|
||||
const char *name,
|
||||
const struct clk_hw *parent_hw,
|
||||
void __iomem *reg_base)
|
||||
{
|
||||
u32 div;
|
||||
u32 vcu_pll_ctrl;
|
||||
|
||||
/*
|
||||
* The output divider of the PLL must be set to 1/2 to meet the
|
||||
* timing in the design.
|
||||
*/
|
||||
vcu_pll_ctrl = xvcu_read(reg_base, VCU_PLL_CTRL);
|
||||
div = FIELD_GET(VCU_PLL_CTRL_CLKOUTDIV, vcu_pll_ctrl);
|
||||
if (div != 1)
|
||||
return ERR_PTR(-EINVAL);
|
||||
|
||||
return clk_hw_register_fixed_factor(dev, "vcu_pll_post",
|
||||
clk_hw_get_name(parent_hw),
|
||||
CLK_SET_RATE_PARENT, 1, 2);
|
||||
}
|
||||
|
||||
static const struct xvcu_pll_cfg *xvcu_find_cfg(int div)
|
||||
{
|
||||
const struct xvcu_pll_cfg *cfg = NULL;
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(xvcu_pll_cfg) - 1; i++)
|
||||
if (xvcu_pll_cfg[i].fbdiv == div)
|
||||
cfg = &xvcu_pll_cfg[i];
|
||||
|
||||
return cfg;
|
||||
}
|
||||
|
||||
static int xvcu_pll_set_div(struct vcu_pll *pll, int div)
|
||||
{
|
||||
void __iomem *base = pll->reg_base;
|
||||
const struct xvcu_pll_cfg *cfg = NULL;
|
||||
u32 vcu_pll_ctrl;
|
||||
u32 cfg_val;
|
||||
|
||||
cfg = xvcu_find_cfg(div);
|
||||
if (!cfg)
|
||||
return -EINVAL;
|
||||
|
||||
vcu_pll_ctrl = xvcu_read(base, VCU_PLL_CTRL);
|
||||
vcu_pll_ctrl &= ~VCU_PLL_CTRL_FBDIV;
|
||||
vcu_pll_ctrl |= FIELD_PREP(VCU_PLL_CTRL_FBDIV, cfg->fbdiv);
|
||||
xvcu_write(base, VCU_PLL_CTRL, vcu_pll_ctrl);
|
||||
|
||||
cfg_val = FIELD_PREP(VCU_PLL_CFG_RES, cfg->res) |
|
||||
FIELD_PREP(VCU_PLL_CFG_CP, cfg->cp) |
|
||||
FIELD_PREP(VCU_PLL_CFG_LFHF, cfg->lfhf) |
|
||||
FIELD_PREP(VCU_PLL_CFG_LOCK_CNT, cfg->lock_cnt) |
|
||||
FIELD_PREP(VCU_PLL_CFG_LOCK_DLY, cfg->lock_dly);
|
||||
xvcu_write(base, VCU_PLL_CFG, cfg_val);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static long xvcu_pll_round_rate(struct clk_hw *hw,
|
||||
unsigned long rate, unsigned long *parent_rate)
|
||||
{
|
||||
struct vcu_pll *pll = to_vcu_pll(hw);
|
||||
unsigned int feedback_div;
|
||||
|
||||
rate = clamp_t(unsigned long, rate, pll->fvco_min, pll->fvco_max);
|
||||
|
||||
feedback_div = DIV_ROUND_CLOSEST_ULL(rate, *parent_rate);
|
||||
feedback_div = clamp_t(unsigned int, feedback_div, 25, 125);
|
||||
|
||||
return *parent_rate * feedback_div;
|
||||
}
|
||||
|
||||
static unsigned long xvcu_pll_recalc_rate(struct clk_hw *hw,
|
||||
unsigned long parent_rate)
|
||||
{
|
||||
struct vcu_pll *pll = to_vcu_pll(hw);
|
||||
void __iomem *base = pll->reg_base;
|
||||
unsigned int div;
|
||||
u32 vcu_pll_ctrl;
|
||||
|
||||
vcu_pll_ctrl = xvcu_read(base, VCU_PLL_CTRL);
|
||||
div = FIELD_GET(VCU_PLL_CTRL_FBDIV, vcu_pll_ctrl);
|
||||
|
||||
return div * parent_rate;
|
||||
}
|
||||
|
||||
static int xvcu_pll_set_rate(struct clk_hw *hw,
|
||||
unsigned long rate, unsigned long parent_rate)
|
||||
{
|
||||
struct vcu_pll *pll = to_vcu_pll(hw);
|
||||
|
||||
return xvcu_pll_set_div(pll, rate / parent_rate);
|
||||
}
|
||||
|
||||
static int xvcu_pll_enable(struct clk_hw *hw)
|
||||
{
|
||||
struct vcu_pll *pll = to_vcu_pll(hw);
|
||||
void __iomem *base = pll->reg_base;
|
||||
u32 vcu_pll_ctrl;
|
||||
int ret;
|
||||
|
||||
vcu_pll_ctrl = xvcu_read(base, VCU_PLL_CTRL);
|
||||
vcu_pll_ctrl |= VCU_PLL_CTRL_BYPASS;
|
||||
xvcu_write(base, VCU_PLL_CTRL, vcu_pll_ctrl);
|
||||
|
||||
vcu_pll_ctrl = xvcu_read(base, VCU_PLL_CTRL);
|
||||
vcu_pll_ctrl &= ~VCU_PLL_CTRL_POR_IN;
|
||||
vcu_pll_ctrl &= ~VCU_PLL_CTRL_PWR_POR;
|
||||
vcu_pll_ctrl &= ~VCU_PLL_CTRL_RESET;
|
||||
xvcu_write(base, VCU_PLL_CTRL, vcu_pll_ctrl);
|
||||
|
||||
ret = xvcu_pll_wait_for_lock(pll);
|
||||
if (ret) {
|
||||
pr_err("VCU PLL is not locked\n");
|
||||
goto err;
|
||||
}
|
||||
|
||||
vcu_pll_ctrl = xvcu_read(base, VCU_PLL_CTRL);
|
||||
vcu_pll_ctrl &= ~VCU_PLL_CTRL_BYPASS;
|
||||
xvcu_write(base, VCU_PLL_CTRL, vcu_pll_ctrl);
|
||||
|
||||
err:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void xvcu_pll_disable(struct clk_hw *hw)
|
||||
{
|
||||
struct vcu_pll *pll = to_vcu_pll(hw);
|
||||
void __iomem *base = pll->reg_base;
|
||||
u32 vcu_pll_ctrl;
|
||||
|
||||
vcu_pll_ctrl = xvcu_read(base, VCU_PLL_CTRL);
|
||||
vcu_pll_ctrl |= VCU_PLL_CTRL_POR_IN;
|
||||
vcu_pll_ctrl |= VCU_PLL_CTRL_PWR_POR;
|
||||
vcu_pll_ctrl |= VCU_PLL_CTRL_RESET;
|
||||
xvcu_write(base, VCU_PLL_CTRL, vcu_pll_ctrl);
|
||||
}
|
||||
|
||||
static const struct clk_ops vcu_pll_ops = {
|
||||
.enable = xvcu_pll_enable,
|
||||
.disable = xvcu_pll_disable,
|
||||
.round_rate = xvcu_pll_round_rate,
|
||||
.recalc_rate = xvcu_pll_recalc_rate,
|
||||
.set_rate = xvcu_pll_set_rate,
|
||||
};
|
||||
|
||||
static struct clk_hw *xvcu_register_pll(struct device *dev,
|
||||
void __iomem *reg_base,
|
||||
const char *name, const char *parent,
|
||||
unsigned long flags)
|
||||
{
|
||||
struct vcu_pll *pll;
|
||||
struct clk_hw *hw;
|
||||
struct clk_init_data init;
|
||||
int ret;
|
||||
|
||||
init.name = name;
|
||||
init.parent_names = &parent;
|
||||
init.ops = &vcu_pll_ops;
|
||||
init.num_parents = 1;
|
||||
init.flags = flags;
|
||||
|
||||
pll = devm_kmalloc(dev, sizeof(*pll), GFP_KERNEL);
|
||||
if (!pll)
|
||||
return ERR_PTR(-ENOMEM);
|
||||
|
||||
pll->hw.init = &init;
|
||||
pll->reg_base = reg_base;
|
||||
pll->fvco_min = FVCO_MIN;
|
||||
pll->fvco_max = FVCO_MAX;
|
||||
|
||||
hw = &pll->hw;
|
||||
ret = devm_clk_hw_register(dev, hw);
|
||||
if (ret)
|
||||
return ERR_PTR(ret);
|
||||
|
||||
clk_hw_set_rate_range(hw, pll->fvco_min, pll->fvco_max);
|
||||
|
||||
return hw;
|
||||
}
|
||||
|
||||
static struct clk_hw *xvcu_clk_hw_register_leaf(struct device *dev,
|
||||
const char *name,
|
||||
const struct clk_parent_data *parent_data,
|
||||
u8 num_parents,
|
||||
void __iomem *reg)
|
||||
{
|
||||
u8 mux_flags = CLK_MUX_ROUND_CLOSEST;
|
||||
u8 divider_flags = CLK_DIVIDER_ONE_BASED | CLK_DIVIDER_ALLOW_ZERO |
|
||||
CLK_DIVIDER_ROUND_CLOSEST;
|
||||
struct clk_hw *mux = NULL;
|
||||
struct clk_hw *divider = NULL;
|
||||
struct clk_hw *gate = NULL;
|
||||
char *name_mux;
|
||||
char *name_div;
|
||||
int err;
|
||||
/* Protect register shared by clocks */
|
||||
spinlock_t *lock;
|
||||
|
||||
lock = devm_kzalloc(dev, sizeof(*lock), GFP_KERNEL);
|
||||
if (!lock)
|
||||
return ERR_PTR(-ENOMEM);
|
||||
spin_lock_init(lock);
|
||||
|
||||
name_mux = devm_kasprintf(dev, GFP_KERNEL, "%s%s", name, "_mux");
|
||||
if (!name_mux)
|
||||
return ERR_PTR(-ENOMEM);
|
||||
mux = clk_hw_register_mux_parent_data(dev, name_mux,
|
||||
parent_data, num_parents,
|
||||
CLK_SET_RATE_PARENT,
|
||||
reg, 0, 1, mux_flags, lock);
|
||||
if (IS_ERR(mux))
|
||||
return mux;
|
||||
|
||||
name_div = devm_kasprintf(dev, GFP_KERNEL, "%s%s", name, "_div");
|
||||
if (!name_div) {
|
||||
err = -ENOMEM;
|
||||
goto unregister_mux;
|
||||
}
|
||||
divider = clk_hw_register_divider_parent_hw(dev, name_div, mux,
|
||||
CLK_SET_RATE_PARENT,
|
||||
reg, 4, 6, divider_flags,
|
||||
lock);
|
||||
if (IS_ERR(divider)) {
|
||||
err = PTR_ERR(divider);
|
||||
goto unregister_mux;
|
||||
}
|
||||
|
||||
gate = clk_hw_register_gate_parent_hw(dev, name, divider,
|
||||
CLK_SET_RATE_PARENT, reg, 12, 0,
|
||||
lock);
|
||||
if (IS_ERR(gate)) {
|
||||
err = PTR_ERR(gate);
|
||||
goto unregister_divider;
|
||||
}
|
||||
|
||||
return gate;
|
||||
|
||||
unregister_divider:
|
||||
clk_hw_unregister_divider(divider);
|
||||
unregister_mux:
|
||||
clk_hw_unregister_mux(mux);
|
||||
|
||||
return ERR_PTR(err);
|
||||
}
|
||||
|
||||
static void xvcu_clk_hw_unregister_leaf(struct clk_hw *hw)
|
||||
{
|
||||
struct clk_hw *gate = hw;
|
||||
struct clk_hw *divider;
|
||||
struct clk_hw *mux;
|
||||
|
||||
if (!gate)
|
||||
return;
|
||||
|
||||
divider = clk_hw_get_parent(gate);
|
||||
clk_hw_unregister_gate(gate);
|
||||
if (!divider)
|
||||
return;
|
||||
|
||||
mux = clk_hw_get_parent(divider);
|
||||
clk_hw_unregister_mux(mux);
|
||||
if (!divider)
|
||||
return;
|
||||
|
||||
clk_hw_unregister_divider(divider);
|
||||
}
|
||||
|
||||
static int xvcu_register_clock_provider(struct xvcu_device *xvcu)
|
||||
{
|
||||
struct device *dev = xvcu->dev;
|
||||
struct clk_parent_data parent_data[2] = { 0 };
|
||||
struct clk_hw_onecell_data *data;
|
||||
struct clk_hw **hws;
|
||||
struct clk_hw *hw;
|
||||
void __iomem *reg_base = xvcu->vcu_slcr_ba;
|
||||
|
||||
data = devm_kzalloc(dev, struct_size(data, hws, CLK_XVCU_NUM_CLOCKS), GFP_KERNEL);
|
||||
if (!data)
|
||||
return -ENOMEM;
|
||||
data->num = CLK_XVCU_NUM_CLOCKS;
|
||||
hws = data->hws;
|
||||
|
||||
xvcu->clk_data = data;
|
||||
|
||||
hw = xvcu_register_pll(dev, reg_base,
|
||||
"vcu_pll", __clk_get_name(xvcu->pll_ref),
|
||||
CLK_SET_RATE_NO_REPARENT | CLK_OPS_PARENT_ENABLE);
|
||||
if (IS_ERR(hw))
|
||||
return PTR_ERR(hw);
|
||||
xvcu->pll = hw;
|
||||
|
||||
hw = xvcu_register_pll_post(dev, "vcu_pll_post", xvcu->pll, reg_base);
|
||||
if (IS_ERR(hw))
|
||||
return PTR_ERR(hw);
|
||||
xvcu->pll_post = hw;
|
||||
|
||||
parent_data[0].fw_name = "pll_ref";
|
||||
parent_data[1].hw = xvcu->pll_post;
|
||||
|
||||
hws[CLK_XVCU_ENC_CORE] =
|
||||
xvcu_clk_hw_register_leaf(dev, "venc_core_clk",
|
||||
parent_data,
|
||||
ARRAY_SIZE(parent_data),
|
||||
reg_base + VCU_ENC_CORE_CTRL);
|
||||
hws[CLK_XVCU_ENC_MCU] =
|
||||
xvcu_clk_hw_register_leaf(dev, "venc_mcu_clk",
|
||||
parent_data,
|
||||
ARRAY_SIZE(parent_data),
|
||||
reg_base + VCU_ENC_MCU_CTRL);
|
||||
hws[CLK_XVCU_DEC_CORE] =
|
||||
xvcu_clk_hw_register_leaf(dev, "vdec_core_clk",
|
||||
parent_data,
|
||||
ARRAY_SIZE(parent_data),
|
||||
reg_base + VCU_DEC_CORE_CTRL);
|
||||
hws[CLK_XVCU_DEC_MCU] =
|
||||
xvcu_clk_hw_register_leaf(dev, "vdec_mcu_clk",
|
||||
parent_data,
|
||||
ARRAY_SIZE(parent_data),
|
||||
reg_base + VCU_DEC_MCU_CTRL);
|
||||
|
||||
return devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, data);
|
||||
}
|
||||
|
||||
static void xvcu_unregister_clock_provider(struct xvcu_device *xvcu)
|
||||
{
|
||||
struct clk_hw_onecell_data *data = xvcu->clk_data;
|
||||
struct clk_hw **hws = data->hws;
|
||||
|
||||
if (!IS_ERR_OR_NULL(hws[CLK_XVCU_DEC_MCU]))
|
||||
xvcu_clk_hw_unregister_leaf(hws[CLK_XVCU_DEC_MCU]);
|
||||
if (!IS_ERR_OR_NULL(hws[CLK_XVCU_DEC_CORE]))
|
||||
xvcu_clk_hw_unregister_leaf(hws[CLK_XVCU_DEC_CORE]);
|
||||
if (!IS_ERR_OR_NULL(hws[CLK_XVCU_ENC_MCU]))
|
||||
xvcu_clk_hw_unregister_leaf(hws[CLK_XVCU_ENC_MCU]);
|
||||
if (!IS_ERR_OR_NULL(hws[CLK_XVCU_ENC_CORE]))
|
||||
xvcu_clk_hw_unregister_leaf(hws[CLK_XVCU_ENC_CORE]);
|
||||
|
||||
clk_hw_unregister_fixed_factor(xvcu->pll_post);
|
||||
}
|
||||
|
||||
/**
|
||||
* xvcu_probe - Probe existence of the logicoreIP
|
||||
* and initialize PLL
|
||||
*
|
||||
* @pdev: Pointer to the platform_device structure
|
||||
*
|
||||
* Return: Returns 0 on success
|
||||
* Negative error code otherwise
|
||||
*/
|
||||
static int xvcu_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct resource *res;
|
||||
struct xvcu_device *xvcu;
|
||||
void __iomem *regs;
|
||||
int ret;
|
||||
|
||||
xvcu = devm_kzalloc(&pdev->dev, sizeof(*xvcu), GFP_KERNEL);
|
||||
if (!xvcu)
|
||||
return -ENOMEM;
|
||||
|
||||
xvcu->dev = &pdev->dev;
|
||||
res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "vcu_slcr");
|
||||
if (!res) {
|
||||
dev_err(&pdev->dev, "get vcu_slcr memory resource failed.\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
xvcu->vcu_slcr_ba = devm_ioremap(&pdev->dev, res->start,
|
||||
resource_size(res));
|
||||
if (!xvcu->vcu_slcr_ba) {
|
||||
dev_err(&pdev->dev, "vcu_slcr register mapping failed.\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
xvcu->logicore_reg_ba =
|
||||
syscon_regmap_lookup_by_compatible("xlnx,vcu-settings");
|
||||
if (IS_ERR(xvcu->logicore_reg_ba)) {
|
||||
dev_info(&pdev->dev,
|
||||
"could not find xlnx,vcu-settings: trying direct register access\n");
|
||||
|
||||
res = platform_get_resource_byname(pdev,
|
||||
IORESOURCE_MEM, "logicore");
|
||||
if (!res) {
|
||||
dev_err(&pdev->dev, "get logicore memory resource failed.\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
regs = devm_ioremap(&pdev->dev, res->start, resource_size(res));
|
||||
if (!regs) {
|
||||
dev_err(&pdev->dev, "logicore register mapping failed.\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
xvcu->logicore_reg_ba =
|
||||
devm_regmap_init_mmio(&pdev->dev, regs,
|
||||
&vcu_settings_regmap_config);
|
||||
if (IS_ERR(xvcu->logicore_reg_ba)) {
|
||||
dev_err(&pdev->dev, "failed to init regmap\n");
|
||||
return PTR_ERR(xvcu->logicore_reg_ba);
|
||||
}
|
||||
}
|
||||
|
||||
xvcu->aclk = devm_clk_get(&pdev->dev, "aclk");
|
||||
if (IS_ERR(xvcu->aclk)) {
|
||||
dev_err(&pdev->dev, "Could not get aclk clock\n");
|
||||
return PTR_ERR(xvcu->aclk);
|
||||
}
|
||||
|
||||
xvcu->pll_ref = devm_clk_get(&pdev->dev, "pll_ref");
|
||||
if (IS_ERR(xvcu->pll_ref)) {
|
||||
dev_err(&pdev->dev, "Could not get pll_ref clock\n");
|
||||
return PTR_ERR(xvcu->pll_ref);
|
||||
}
|
||||
|
||||
ret = clk_prepare_enable(xvcu->aclk);
|
||||
if (ret) {
|
||||
dev_err(&pdev->dev, "aclk clock enable failed\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* Do the Gasket isolation and put the VCU out of reset
|
||||
* Bit 0 : Gasket isolation
|
||||
* Bit 1 : put VCU out of reset
|
||||
*/
|
||||
regmap_write(xvcu->logicore_reg_ba, VCU_GASKET_INIT, VCU_GASKET_VALUE);
|
||||
|
||||
ret = xvcu_register_clock_provider(xvcu);
|
||||
if (ret) {
|
||||
dev_err(&pdev->dev, "failed to register clock provider\n");
|
||||
goto error_clk_provider;
|
||||
}
|
||||
|
||||
dev_set_drvdata(&pdev->dev, xvcu);
|
||||
|
||||
return 0;
|
||||
|
||||
error_clk_provider:
|
||||
xvcu_unregister_clock_provider(xvcu);
|
||||
clk_disable_unprepare(xvcu->aclk);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/**
|
||||
* xvcu_remove - Insert gasket isolation
|
||||
* and disable the clock
|
||||
* @pdev: Pointer to the platform_device structure
|
||||
*
|
||||
* Return: Returns 0 on success
|
||||
* Negative error code otherwise
|
||||
*/
|
||||
static int xvcu_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct xvcu_device *xvcu;
|
||||
|
||||
xvcu = platform_get_drvdata(pdev);
|
||||
if (!xvcu)
|
||||
return -ENODEV;
|
||||
|
||||
xvcu_unregister_clock_provider(xvcu);
|
||||
|
||||
/* Add the Gasket isolation and put the VCU in reset. */
|
||||
regmap_write(xvcu->logicore_reg_ba, VCU_GASKET_INIT, 0);
|
||||
|
||||
clk_disable_unprepare(xvcu->aclk);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id xvcu_of_id_table[] = {
|
||||
{ .compatible = "xlnx,vcu" },
|
||||
{ .compatible = "xlnx,vcu-logicoreip-1.0" },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, xvcu_of_id_table);
|
||||
|
||||
static struct platform_driver xvcu_driver = {
|
||||
.driver = {
|
||||
.name = "xilinx-vcu",
|
||||
.of_match_table = xvcu_of_id_table,
|
||||
},
|
||||
.probe = xvcu_probe,
|
||||
.remove = xvcu_remove,
|
||||
};
|
||||
|
||||
module_platform_driver(xvcu_driver);
|
||||
|
||||
MODULE_AUTHOR("Dhaval Shah <dshah@xilinx.com>");
|
||||
MODULE_DESCRIPTION("Xilinx VCU init Driver");
|
||||
MODULE_LICENSE("GPL v2");
|
@ -1,23 +1,6 @@
|
||||
# SPDX-License-Identifier: GPL-2.0
|
||||
menu "Xilinx SoC drivers"
|
||||
|
||||
config XILINX_VCU
|
||||
tristate "Xilinx VCU logicoreIP Init"
|
||||
depends on HAS_IOMEM
|
||||
select REGMAP_MMIO
|
||||
help
|
||||
Provides the driver to enable and disable the isolation between the
|
||||
processing system and programmable logic part by using the logicoreIP
|
||||
register set. This driver also configures the frequency based on the
|
||||
clock information from the logicoreIP register set.
|
||||
|
||||
If you say yes here you get support for the logicoreIP.
|
||||
|
||||
If unsure, say N.
|
||||
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called xlnx_vcu.
|
||||
|
||||
config ZYNQMP_POWER
|
||||
bool "Enable Xilinx Zynq MPSoC Power Management driver"
|
||||
depends on PM && ZYNQMP_FIRMWARE
|
||||
|
@ -1,4 +1,3 @@
|
||||
# SPDX-License-Identifier: GPL-2.0
|
||||
obj-$(CONFIG_XILINX_VCU) += xlnx_vcu.o
|
||||
obj-$(CONFIG_ZYNQMP_POWER) += zynqmp_power.o
|
||||
obj-$(CONFIG_ZYNQMP_PM_DOMAINS) += zynqmp_pm_domains.o
|
||||
|
@ -1,628 +0,0 @@
|
||||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* Xilinx VCU Init
|
||||
*
|
||||
* Copyright (C) 2016 - 2017 Xilinx, Inc.
|
||||
*
|
||||
* Contacts Dhaval Shah <dshah@xilinx.com>
|
||||
*/
|
||||
#include <linux/clk.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/mfd/syscon.h>
|
||||
#include <linux/mfd/syscon/xlnx-vcu.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/of_platform.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/regmap.h>
|
||||
|
||||
/* vcu slcr registers, bitmask and shift */
|
||||
#define VCU_PLL_CTRL 0x24
|
||||
#define VCU_PLL_CTRL_RESET_MASK 0x01
|
||||
#define VCU_PLL_CTRL_RESET_SHIFT 0
|
||||
#define VCU_PLL_CTRL_BYPASS_MASK 0x01
|
||||
#define VCU_PLL_CTRL_BYPASS_SHIFT 3
|
||||
#define VCU_PLL_CTRL_FBDIV_MASK 0x7f
|
||||
#define VCU_PLL_CTRL_FBDIV_SHIFT 8
|
||||
#define VCU_PLL_CTRL_POR_IN_MASK 0x01
|
||||
#define VCU_PLL_CTRL_POR_IN_SHIFT 1
|
||||
#define VCU_PLL_CTRL_PWR_POR_MASK 0x01
|
||||
#define VCU_PLL_CTRL_PWR_POR_SHIFT 2
|
||||
#define VCU_PLL_CTRL_CLKOUTDIV_MASK 0x03
|
||||
#define VCU_PLL_CTRL_CLKOUTDIV_SHIFT 16
|
||||
#define VCU_PLL_CTRL_DEFAULT 0
|
||||
#define VCU_PLL_DIV2 2
|
||||
|
||||
#define VCU_PLL_CFG 0x28
|
||||
#define VCU_PLL_CFG_RES_MASK 0x0f
|
||||
#define VCU_PLL_CFG_RES_SHIFT 0
|
||||
#define VCU_PLL_CFG_CP_MASK 0x0f
|
||||
#define VCU_PLL_CFG_CP_SHIFT 5
|
||||
#define VCU_PLL_CFG_LFHF_MASK 0x03
|
||||
#define VCU_PLL_CFG_LFHF_SHIFT 10
|
||||
#define VCU_PLL_CFG_LOCK_CNT_MASK 0x03ff
|
||||
#define VCU_PLL_CFG_LOCK_CNT_SHIFT 13
|
||||
#define VCU_PLL_CFG_LOCK_DLY_MASK 0x7f
|
||||
#define VCU_PLL_CFG_LOCK_DLY_SHIFT 25
|
||||
#define VCU_ENC_CORE_CTRL 0x30
|
||||
#define VCU_ENC_MCU_CTRL 0x34
|
||||
#define VCU_DEC_CORE_CTRL 0x38
|
||||
#define VCU_DEC_MCU_CTRL 0x3c
|
||||
#define VCU_PLL_DIVISOR_MASK 0x3f
|
||||
#define VCU_PLL_DIVISOR_SHIFT 4
|
||||
#define VCU_SRCSEL_MASK 0x01
|
||||
#define VCU_SRCSEL_SHIFT 0
|
||||
#define VCU_SRCSEL_PLL 1
|
||||
|
||||
#define VCU_PLL_STATUS 0x60
|
||||
#define VCU_PLL_STATUS_LOCK_STATUS_MASK 0x01
|
||||
|
||||
#define MHZ 1000000
|
||||
#define FVCO_MIN (1500U * MHZ)
|
||||
#define FVCO_MAX (3000U * MHZ)
|
||||
#define DIVISOR_MIN 0
|
||||
#define DIVISOR_MAX 63
|
||||
#define FRAC 100
|
||||
#define LIMIT (10 * MHZ)
|
||||
|
||||
/**
|
||||
* struct xvcu_device - Xilinx VCU init device structure
|
||||
* @dev: Platform device
|
||||
* @pll_ref: pll ref clock source
|
||||
* @aclk: axi clock source
|
||||
* @logicore_reg_ba: logicore reg base address
|
||||
* @vcu_slcr_ba: vcu_slcr Register base address
|
||||
* @coreclk: core clock frequency
|
||||
*/
|
||||
struct xvcu_device {
|
||||
struct device *dev;
|
||||
struct clk *pll_ref;
|
||||
struct clk *aclk;
|
||||
struct regmap *logicore_reg_ba;
|
||||
void __iomem *vcu_slcr_ba;
|
||||
u32 coreclk;
|
||||
};
|
||||
|
||||
static struct regmap_config vcu_settings_regmap_config = {
|
||||
.name = "regmap",
|
||||
.reg_bits = 32,
|
||||
.val_bits = 32,
|
||||
.reg_stride = 4,
|
||||
.max_register = 0xfff,
|
||||
.cache_type = REGCACHE_NONE,
|
||||
};
|
||||
|
||||
/**
|
||||
* struct xvcu_pll_cfg - Helper data
|
||||
* @fbdiv: The integer portion of the feedback divider to the PLL
|
||||
* @cp: PLL charge pump control
|
||||
* @res: PLL loop filter resistor control
|
||||
* @lfhf: PLL loop filter high frequency capacitor control
|
||||
* @lock_dly: Lock circuit configuration settings for lock windowsize
|
||||
* @lock_cnt: Lock circuit counter setting
|
||||
*/
|
||||
struct xvcu_pll_cfg {
|
||||
u32 fbdiv;
|
||||
u32 cp;
|
||||
u32 res;
|
||||
u32 lfhf;
|
||||
u32 lock_dly;
|
||||
u32 lock_cnt;
|
||||
};
|
||||
|
||||
static const struct xvcu_pll_cfg xvcu_pll_cfg[] = {
|
||||
{ 25, 3, 10, 3, 63, 1000 },
|
||||
{ 26, 3, 10, 3, 63, 1000 },
|
||||
{ 27, 4, 6, 3, 63, 1000 },
|
||||
{ 28, 4, 6, 3, 63, 1000 },
|
||||
{ 29, 4, 6, 3, 63, 1000 },
|
||||
{ 30, 4, 6, 3, 63, 1000 },
|
||||
{ 31, 6, 1, 3, 63, 1000 },
|
||||
{ 32, 6, 1, 3, 63, 1000 },
|
||||
{ 33, 4, 10, 3, 63, 1000 },
|
||||
{ 34, 5, 6, 3, 63, 1000 },
|
||||
{ 35, 5, 6, 3, 63, 1000 },
|
||||
{ 36, 5, 6, 3, 63, 1000 },
|
||||
{ 37, 5, 6, 3, 63, 1000 },
|
||||
{ 38, 5, 6, 3, 63, 975 },
|
||||
{ 39, 3, 12, 3, 63, 950 },
|
||||
{ 40, 3, 12, 3, 63, 925 },
|
||||
{ 41, 3, 12, 3, 63, 900 },
|
||||
{ 42, 3, 12, 3, 63, 875 },
|
||||
{ 43, 3, 12, 3, 63, 850 },
|
||||
{ 44, 3, 12, 3, 63, 850 },
|
||||
{ 45, 3, 12, 3, 63, 825 },
|
||||
{ 46, 3, 12, 3, 63, 800 },
|
||||
{ 47, 3, 12, 3, 63, 775 },
|
||||
{ 48, 3, 12, 3, 63, 775 },
|
||||
{ 49, 3, 12, 3, 63, 750 },
|
||||
{ 50, 3, 12, 3, 63, 750 },
|
||||
{ 51, 3, 2, 3, 63, 725 },
|
||||
{ 52, 3, 2, 3, 63, 700 },
|
||||
{ 53, 3, 2, 3, 63, 700 },
|
||||
{ 54, 3, 2, 3, 63, 675 },
|
||||
{ 55, 3, 2, 3, 63, 675 },
|
||||
{ 56, 3, 2, 3, 63, 650 },
|
||||
{ 57, 3, 2, 3, 63, 650 },
|
||||
{ 58, 3, 2, 3, 63, 625 },
|
||||
{ 59, 3, 2, 3, 63, 625 },
|
||||
{ 60, 3, 2, 3, 63, 625 },
|
||||
{ 61, 3, 2, 3, 63, 600 },
|
||||
{ 62, 3, 2, 3, 63, 600 },
|
||||
{ 63, 3, 2, 3, 63, 600 },
|
||||
{ 64, 3, 2, 3, 63, 600 },
|
||||
{ 65, 3, 2, 3, 63, 600 },
|
||||
{ 66, 3, 2, 3, 63, 600 },
|
||||
{ 67, 3, 2, 3, 63, 600 },
|
||||
{ 68, 3, 2, 3, 63, 600 },
|
||||
{ 69, 3, 2, 3, 63, 600 },
|
||||
{ 70, 3, 2, 3, 63, 600 },
|
||||
{ 71, 3, 2, 3, 63, 600 },
|
||||
{ 72, 3, 2, 3, 63, 600 },
|
||||
{ 73, 3, 2, 3, 63, 600 },
|
||||
{ 74, 3, 2, 3, 63, 600 },
|
||||
{ 75, 3, 2, 3, 63, 600 },
|
||||
{ 76, 3, 2, 3, 63, 600 },
|
||||
{ 77, 3, 2, 3, 63, 600 },
|
||||
{ 78, 3, 2, 3, 63, 600 },
|
||||
{ 79, 3, 2, 3, 63, 600 },
|
||||
{ 80, 3, 2, 3, 63, 600 },
|
||||
{ 81, 3, 2, 3, 63, 600 },
|
||||
{ 82, 3, 2, 3, 63, 600 },
|
||||
{ 83, 4, 2, 3, 63, 600 },
|
||||
{ 84, 4, 2, 3, 63, 600 },
|
||||
{ 85, 4, 2, 3, 63, 600 },
|
||||
{ 86, 4, 2, 3, 63, 600 },
|
||||
{ 87, 4, 2, 3, 63, 600 },
|
||||
{ 88, 4, 2, 3, 63, 600 },
|
||||
{ 89, 4, 2, 3, 63, 600 },
|
||||
{ 90, 4, 2, 3, 63, 600 },
|
||||
{ 91, 4, 2, 3, 63, 600 },
|
||||
{ 92, 4, 2, 3, 63, 600 },
|
||||
{ 93, 4, 2, 3, 63, 600 },
|
||||
{ 94, 4, 2, 3, 63, 600 },
|
||||
{ 95, 4, 2, 3, 63, 600 },
|
||||
{ 96, 4, 2, 3, 63, 600 },
|
||||
{ 97, 4, 2, 3, 63, 600 },
|
||||
{ 98, 4, 2, 3, 63, 600 },
|
||||
{ 99, 4, 2, 3, 63, 600 },
|
||||
{ 100, 4, 2, 3, 63, 600 },
|
||||
{ 101, 4, 2, 3, 63, 600 },
|
||||
{ 102, 4, 2, 3, 63, 600 },
|
||||
{ 103, 5, 2, 3, 63, 600 },
|
||||
{ 104, 5, 2, 3, 63, 600 },
|
||||
{ 105, 5, 2, 3, 63, 600 },
|
||||
{ 106, 5, 2, 3, 63, 600 },
|
||||
{ 107, 3, 4, 3, 63, 600 },
|
||||
{ 108, 3, 4, 3, 63, 600 },
|
||||
{ 109, 3, 4, 3, 63, 600 },
|
||||
{ 110, 3, 4, 3, 63, 600 },
|
||||
{ 111, 3, 4, 3, 63, 600 },
|
||||
{ 112, 3, 4, 3, 63, 600 },
|
||||
{ 113, 3, 4, 3, 63, 600 },
|
||||
{ 114, 3, 4, 3, 63, 600 },
|
||||
{ 115, 3, 4, 3, 63, 600 },
|
||||
{ 116, 3, 4, 3, 63, 600 },
|
||||
{ 117, 3, 4, 3, 63, 600 },
|
||||
{ 118, 3, 4, 3, 63, 600 },
|
||||
{ 119, 3, 4, 3, 63, 600 },
|
||||
{ 120, 3, 4, 3, 63, 600 },
|
||||
{ 121, 3, 4, 3, 63, 600 },
|
||||
{ 122, 3, 4, 3, 63, 600 },
|
||||
{ 123, 3, 4, 3, 63, 600 },
|
||||
{ 124, 3, 4, 3, 63, 600 },
|
||||
{ 125, 3, 4, 3, 63, 600 },
|
||||
};
|
||||
|
||||
/**
|
||||
* xvcu_read - Read from the VCU register space
|
||||
* @iomem: vcu reg space base address
|
||||
* @offset: vcu reg offset from base
|
||||
*
|
||||
* Return: Returns 32bit value from VCU register specified
|
||||
*
|
||||
*/
|
||||
static inline u32 xvcu_read(void __iomem *iomem, u32 offset)
|
||||
{
|
||||
return ioread32(iomem + offset);
|
||||
}
|
||||
|
||||
/**
|
||||
* xvcu_write - Write to the VCU register space
|
||||
* @iomem: vcu reg space base address
|
||||
* @offset: vcu reg offset from base
|
||||
* @value: Value to write
|
||||
*/
|
||||
static inline void xvcu_write(void __iomem *iomem, u32 offset, u32 value)
|
||||
{
|
||||
iowrite32(value, iomem + offset);
|
||||
}
|
||||
|
||||
/**
|
||||
* xvcu_write_field_reg - Write to the vcu reg field
|
||||
* @iomem: vcu reg space base address
|
||||
* @offset: vcu reg offset from base
|
||||
* @field: vcu reg field to write to
|
||||
* @mask: vcu reg mask
|
||||
* @shift: vcu reg number of bits to shift the bitfield
|
||||
*/
|
||||
static void xvcu_write_field_reg(void __iomem *iomem, int offset,
|
||||
u32 field, u32 mask, int shift)
|
||||
{
|
||||
u32 val = xvcu_read(iomem, offset);
|
||||
|
||||
val &= ~(mask << shift);
|
||||
val |= (field & mask) << shift;
|
||||
|
||||
xvcu_write(iomem, offset, val);
|
||||
}
|
||||
|
||||
/**
|
||||
* xvcu_set_vcu_pll_info - Set the VCU PLL info
|
||||
* @xvcu: Pointer to the xvcu_device structure
|
||||
*
|
||||
* Programming the VCU PLL based on the user configuration
|
||||
* (ref clock freq, core clock freq, mcu clock freq).
|
||||
* Core clock frequency has higher priority than mcu clock frequency
|
||||
* Errors in following cases
|
||||
* - When mcu or clock clock get from logicoreIP is 0
|
||||
* - When VCU PLL DIV related bits value other than 1
|
||||
* - When proper data not found for given data
|
||||
* - When sis570_1 clocksource related operation failed
|
||||
*
|
||||
* Return: Returns status, either success or error+reason
|
||||
*/
|
||||
static int xvcu_set_vcu_pll_info(struct xvcu_device *xvcu)
|
||||
{
|
||||
u32 refclk, coreclk, mcuclk, inte, deci;
|
||||
u32 divisor_mcu, divisor_core, fvco;
|
||||
u32 clkoutdiv, vcu_pll_ctrl, pll_clk;
|
||||
u32 cfg_val, mod, ctrl;
|
||||
int ret, i;
|
||||
const struct xvcu_pll_cfg *found = NULL;
|
||||
|
||||
regmap_read(xvcu->logicore_reg_ba, VCU_PLL_CLK, &inte);
|
||||
regmap_read(xvcu->logicore_reg_ba, VCU_PLL_CLK_DEC, &deci);
|
||||
regmap_read(xvcu->logicore_reg_ba, VCU_CORE_CLK, &coreclk);
|
||||
coreclk *= MHZ;
|
||||
regmap_read(xvcu->logicore_reg_ba, VCU_MCU_CLK, &mcuclk);
|
||||
mcuclk *= MHZ;
|
||||
if (!mcuclk || !coreclk) {
|
||||
dev_err(xvcu->dev, "Invalid mcu and core clock data\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
refclk = (inte * MHZ) + (deci * (MHZ / FRAC));
|
||||
dev_dbg(xvcu->dev, "Ref clock from logicoreIP is %uHz\n", refclk);
|
||||
dev_dbg(xvcu->dev, "Core clock from logicoreIP is %uHz\n", coreclk);
|
||||
dev_dbg(xvcu->dev, "Mcu clock from logicoreIP is %uHz\n", mcuclk);
|
||||
|
||||
clk_disable_unprepare(xvcu->pll_ref);
|
||||
ret = clk_set_rate(xvcu->pll_ref, refclk);
|
||||
if (ret)
|
||||
dev_warn(xvcu->dev, "failed to set logicoreIP refclk rate\n");
|
||||
|
||||
ret = clk_prepare_enable(xvcu->pll_ref);
|
||||
if (ret) {
|
||||
dev_err(xvcu->dev, "failed to enable pll_ref clock source\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
refclk = clk_get_rate(xvcu->pll_ref);
|
||||
|
||||
/*
|
||||
* The divide-by-2 should be always enabled (==1)
|
||||
* to meet the timing in the design.
|
||||
* Otherwise, it's an error
|
||||
*/
|
||||
vcu_pll_ctrl = xvcu_read(xvcu->vcu_slcr_ba, VCU_PLL_CTRL);
|
||||
clkoutdiv = vcu_pll_ctrl >> VCU_PLL_CTRL_CLKOUTDIV_SHIFT;
|
||||
clkoutdiv = clkoutdiv & VCU_PLL_CTRL_CLKOUTDIV_MASK;
|
||||
if (clkoutdiv != 1) {
|
||||
dev_err(xvcu->dev, "clkoutdiv value is invalid\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
for (i = ARRAY_SIZE(xvcu_pll_cfg) - 1; i >= 0; i--) {
|
||||
const struct xvcu_pll_cfg *cfg = &xvcu_pll_cfg[i];
|
||||
|
||||
fvco = cfg->fbdiv * refclk;
|
||||
if (fvco >= FVCO_MIN && fvco <= FVCO_MAX) {
|
||||
pll_clk = fvco / VCU_PLL_DIV2;
|
||||
if (fvco % VCU_PLL_DIV2 != 0)
|
||||
pll_clk++;
|
||||
mod = pll_clk % coreclk;
|
||||
if (mod < LIMIT) {
|
||||
divisor_core = pll_clk / coreclk;
|
||||
} else if (coreclk - mod < LIMIT) {
|
||||
divisor_core = pll_clk / coreclk;
|
||||
divisor_core++;
|
||||
} else {
|
||||
continue;
|
||||
}
|
||||
if (divisor_core >= DIVISOR_MIN &&
|
||||
divisor_core <= DIVISOR_MAX) {
|
||||
found = cfg;
|
||||
divisor_mcu = pll_clk / mcuclk;
|
||||
mod = pll_clk % mcuclk;
|
||||
if (mcuclk - mod < LIMIT)
|
||||
divisor_mcu++;
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (!found) {
|
||||
dev_err(xvcu->dev, "Invalid clock combination.\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
xvcu->coreclk = pll_clk / divisor_core;
|
||||
mcuclk = pll_clk / divisor_mcu;
|
||||
dev_dbg(xvcu->dev, "Actual Ref clock freq is %uHz\n", refclk);
|
||||
dev_dbg(xvcu->dev, "Actual Core clock freq is %uHz\n", xvcu->coreclk);
|
||||
dev_dbg(xvcu->dev, "Actual Mcu clock freq is %uHz\n", mcuclk);
|
||||
|
||||
vcu_pll_ctrl &= ~(VCU_PLL_CTRL_FBDIV_MASK << VCU_PLL_CTRL_FBDIV_SHIFT);
|
||||
vcu_pll_ctrl |= (found->fbdiv & VCU_PLL_CTRL_FBDIV_MASK) <<
|
||||
VCU_PLL_CTRL_FBDIV_SHIFT;
|
||||
vcu_pll_ctrl &= ~(VCU_PLL_CTRL_POR_IN_MASK <<
|
||||
VCU_PLL_CTRL_POR_IN_SHIFT);
|
||||
vcu_pll_ctrl |= (VCU_PLL_CTRL_DEFAULT & VCU_PLL_CTRL_POR_IN_MASK) <<
|
||||
VCU_PLL_CTRL_POR_IN_SHIFT;
|
||||
vcu_pll_ctrl &= ~(VCU_PLL_CTRL_PWR_POR_MASK <<
|
||||
VCU_PLL_CTRL_PWR_POR_SHIFT);
|
||||
vcu_pll_ctrl |= (VCU_PLL_CTRL_DEFAULT & VCU_PLL_CTRL_PWR_POR_MASK) <<
|
||||
VCU_PLL_CTRL_PWR_POR_SHIFT;
|
||||
xvcu_write(xvcu->vcu_slcr_ba, VCU_PLL_CTRL, vcu_pll_ctrl);
|
||||
|
||||
/* Set divisor for the core and mcu clock */
|
||||
ctrl = xvcu_read(xvcu->vcu_slcr_ba, VCU_ENC_CORE_CTRL);
|
||||
ctrl &= ~(VCU_PLL_DIVISOR_MASK << VCU_PLL_DIVISOR_SHIFT);
|
||||
ctrl |= (divisor_core & VCU_PLL_DIVISOR_MASK) <<
|
||||
VCU_PLL_DIVISOR_SHIFT;
|
||||
ctrl &= ~(VCU_SRCSEL_MASK << VCU_SRCSEL_SHIFT);
|
||||
ctrl |= (VCU_SRCSEL_PLL & VCU_SRCSEL_MASK) << VCU_SRCSEL_SHIFT;
|
||||
xvcu_write(xvcu->vcu_slcr_ba, VCU_ENC_CORE_CTRL, ctrl);
|
||||
|
||||
ctrl = xvcu_read(xvcu->vcu_slcr_ba, VCU_DEC_CORE_CTRL);
|
||||
ctrl &= ~(VCU_PLL_DIVISOR_MASK << VCU_PLL_DIVISOR_SHIFT);
|
||||
ctrl |= (divisor_core & VCU_PLL_DIVISOR_MASK) <<
|
||||
VCU_PLL_DIVISOR_SHIFT;
|
||||
ctrl &= ~(VCU_SRCSEL_MASK << VCU_SRCSEL_SHIFT);
|
||||
ctrl |= (VCU_SRCSEL_PLL & VCU_SRCSEL_MASK) << VCU_SRCSEL_SHIFT;
|
||||
xvcu_write(xvcu->vcu_slcr_ba, VCU_DEC_CORE_CTRL, ctrl);
|
||||
|
||||
ctrl = xvcu_read(xvcu->vcu_slcr_ba, VCU_ENC_MCU_CTRL);
|
||||
ctrl &= ~(VCU_PLL_DIVISOR_MASK << VCU_PLL_DIVISOR_SHIFT);
|
||||
ctrl |= (divisor_mcu & VCU_PLL_DIVISOR_MASK) << VCU_PLL_DIVISOR_SHIFT;
|
||||
ctrl &= ~(VCU_SRCSEL_MASK << VCU_SRCSEL_SHIFT);
|
||||
ctrl |= (VCU_SRCSEL_PLL & VCU_SRCSEL_MASK) << VCU_SRCSEL_SHIFT;
|
||||
xvcu_write(xvcu->vcu_slcr_ba, VCU_ENC_MCU_CTRL, ctrl);
|
||||
|
||||
ctrl = xvcu_read(xvcu->vcu_slcr_ba, VCU_DEC_MCU_CTRL);
|
||||
ctrl &= ~(VCU_PLL_DIVISOR_MASK << VCU_PLL_DIVISOR_SHIFT);
|
||||
ctrl |= (divisor_mcu & VCU_PLL_DIVISOR_MASK) << VCU_PLL_DIVISOR_SHIFT;
|
||||
ctrl &= ~(VCU_SRCSEL_MASK << VCU_SRCSEL_SHIFT);
|
||||
ctrl |= (VCU_SRCSEL_PLL & VCU_SRCSEL_MASK) << VCU_SRCSEL_SHIFT;
|
||||
xvcu_write(xvcu->vcu_slcr_ba, VCU_DEC_MCU_CTRL, ctrl);
|
||||
|
||||
/* Set RES, CP, LFHF, LOCK_CNT and LOCK_DLY cfg values */
|
||||
cfg_val = (found->res << VCU_PLL_CFG_RES_SHIFT) |
|
||||
(found->cp << VCU_PLL_CFG_CP_SHIFT) |
|
||||
(found->lfhf << VCU_PLL_CFG_LFHF_SHIFT) |
|
||||
(found->lock_cnt << VCU_PLL_CFG_LOCK_CNT_SHIFT) |
|
||||
(found->lock_dly << VCU_PLL_CFG_LOCK_DLY_SHIFT);
|
||||
xvcu_write(xvcu->vcu_slcr_ba, VCU_PLL_CFG, cfg_val);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* xvcu_set_pll - PLL init sequence
|
||||
* @xvcu: Pointer to the xvcu_device structure
|
||||
*
|
||||
* Call the api to set the PLL info and once that is done then
|
||||
* init the PLL sequence to make the PLL stable.
|
||||
*
|
||||
* Return: Returns status, either success or error+reason
|
||||
*/
|
||||
static int xvcu_set_pll(struct xvcu_device *xvcu)
|
||||
{
|
||||
u32 lock_status;
|
||||
unsigned long timeout;
|
||||
int ret;
|
||||
|
||||
ret = xvcu_set_vcu_pll_info(xvcu);
|
||||
if (ret) {
|
||||
dev_err(xvcu->dev, "failed to set pll info\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
xvcu_write_field_reg(xvcu->vcu_slcr_ba, VCU_PLL_CTRL,
|
||||
1, VCU_PLL_CTRL_BYPASS_MASK,
|
||||
VCU_PLL_CTRL_BYPASS_SHIFT);
|
||||
xvcu_write_field_reg(xvcu->vcu_slcr_ba, VCU_PLL_CTRL,
|
||||
1, VCU_PLL_CTRL_RESET_MASK,
|
||||
VCU_PLL_CTRL_RESET_SHIFT);
|
||||
xvcu_write_field_reg(xvcu->vcu_slcr_ba, VCU_PLL_CTRL,
|
||||
0, VCU_PLL_CTRL_RESET_MASK,
|
||||
VCU_PLL_CTRL_RESET_SHIFT);
|
||||
/*
|
||||
* Defined the timeout for the max time to wait the
|
||||
* PLL_STATUS to be locked.
|
||||
*/
|
||||
timeout = jiffies + msecs_to_jiffies(2000);
|
||||
do {
|
||||
lock_status = xvcu_read(xvcu->vcu_slcr_ba, VCU_PLL_STATUS);
|
||||
if (lock_status & VCU_PLL_STATUS_LOCK_STATUS_MASK) {
|
||||
xvcu_write_field_reg(xvcu->vcu_slcr_ba, VCU_PLL_CTRL,
|
||||
0, VCU_PLL_CTRL_BYPASS_MASK,
|
||||
VCU_PLL_CTRL_BYPASS_SHIFT);
|
||||
return 0;
|
||||
}
|
||||
} while (!time_after(jiffies, timeout));
|
||||
|
||||
/* PLL is not locked even after the timeout of the 2sec */
|
||||
dev_err(xvcu->dev, "PLL is not locked\n");
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
/**
|
||||
* xvcu_probe - Probe existence of the logicoreIP
|
||||
* and initialize PLL
|
||||
*
|
||||
* @pdev: Pointer to the platform_device structure
|
||||
*
|
||||
* Return: Returns 0 on success
|
||||
* Negative error code otherwise
|
||||
*/
|
||||
static int xvcu_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct resource *res;
|
||||
struct xvcu_device *xvcu;
|
||||
void __iomem *regs;
|
||||
int ret;
|
||||
|
||||
xvcu = devm_kzalloc(&pdev->dev, sizeof(*xvcu), GFP_KERNEL);
|
||||
if (!xvcu)
|
||||
return -ENOMEM;
|
||||
|
||||
xvcu->dev = &pdev->dev;
|
||||
res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "vcu_slcr");
|
||||
if (!res) {
|
||||
dev_err(&pdev->dev, "get vcu_slcr memory resource failed.\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
xvcu->vcu_slcr_ba = devm_ioremap(&pdev->dev, res->start,
|
||||
resource_size(res));
|
||||
if (!xvcu->vcu_slcr_ba) {
|
||||
dev_err(&pdev->dev, "vcu_slcr register mapping failed.\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
xvcu->logicore_reg_ba =
|
||||
syscon_regmap_lookup_by_compatible("xlnx,vcu-settings");
|
||||
if (IS_ERR(xvcu->logicore_reg_ba)) {
|
||||
dev_info(&pdev->dev,
|
||||
"could not find xlnx,vcu-settings: trying direct register access\n");
|
||||
|
||||
res = platform_get_resource_byname(pdev,
|
||||
IORESOURCE_MEM, "logicore");
|
||||
if (!res) {
|
||||
dev_err(&pdev->dev, "get logicore memory resource failed.\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
regs = devm_ioremap(&pdev->dev, res->start, resource_size(res));
|
||||
if (!regs) {
|
||||
dev_err(&pdev->dev, "logicore register mapping failed.\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
xvcu->logicore_reg_ba =
|
||||
devm_regmap_init_mmio(&pdev->dev, regs,
|
||||
&vcu_settings_regmap_config);
|
||||
if (IS_ERR(xvcu->logicore_reg_ba)) {
|
||||
dev_err(&pdev->dev, "failed to init regmap\n");
|
||||
return PTR_ERR(xvcu->logicore_reg_ba);
|
||||
}
|
||||
}
|
||||
|
||||
xvcu->aclk = devm_clk_get(&pdev->dev, "aclk");
|
||||
if (IS_ERR(xvcu->aclk)) {
|
||||
dev_err(&pdev->dev, "Could not get aclk clock\n");
|
||||
return PTR_ERR(xvcu->aclk);
|
||||
}
|
||||
|
||||
xvcu->pll_ref = devm_clk_get(&pdev->dev, "pll_ref");
|
||||
if (IS_ERR(xvcu->pll_ref)) {
|
||||
dev_err(&pdev->dev, "Could not get pll_ref clock\n");
|
||||
return PTR_ERR(xvcu->pll_ref);
|
||||
}
|
||||
|
||||
ret = clk_prepare_enable(xvcu->aclk);
|
||||
if (ret) {
|
||||
dev_err(&pdev->dev, "aclk clock enable failed\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = clk_prepare_enable(xvcu->pll_ref);
|
||||
if (ret) {
|
||||
dev_err(&pdev->dev, "pll_ref clock enable failed\n");
|
||||
goto error_aclk;
|
||||
}
|
||||
|
||||
/*
|
||||
* Do the Gasket isolation and put the VCU out of reset
|
||||
* Bit 0 : Gasket isolation
|
||||
* Bit 1 : put VCU out of reset
|
||||
*/
|
||||
regmap_write(xvcu->logicore_reg_ba, VCU_GASKET_INIT, VCU_GASKET_VALUE);
|
||||
|
||||
/* Do the PLL Settings based on the ref clk,core and mcu clk freq */
|
||||
ret = xvcu_set_pll(xvcu);
|
||||
if (ret) {
|
||||
dev_err(&pdev->dev, "Failed to set the pll\n");
|
||||
goto error_pll_ref;
|
||||
}
|
||||
|
||||
dev_set_drvdata(&pdev->dev, xvcu);
|
||||
|
||||
return 0;
|
||||
|
||||
error_pll_ref:
|
||||
clk_disable_unprepare(xvcu->pll_ref);
|
||||
error_aclk:
|
||||
clk_disable_unprepare(xvcu->aclk);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/**
|
||||
* xvcu_remove - Insert gasket isolation
|
||||
* and disable the clock
|
||||
* @pdev: Pointer to the platform_device structure
|
||||
*
|
||||
* Return: Returns 0 on success
|
||||
* Negative error code otherwise
|
||||
*/
|
||||
static int xvcu_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct xvcu_device *xvcu;
|
||||
|
||||
xvcu = platform_get_drvdata(pdev);
|
||||
if (!xvcu)
|
||||
return -ENODEV;
|
||||
|
||||
/* Add the the Gasket isolation and put the VCU in reset. */
|
||||
regmap_write(xvcu->logicore_reg_ba, VCU_GASKET_INIT, 0);
|
||||
|
||||
clk_disable_unprepare(xvcu->pll_ref);
|
||||
clk_disable_unprepare(xvcu->aclk);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id xvcu_of_id_table[] = {
|
||||
{ .compatible = "xlnx,vcu" },
|
||||
{ .compatible = "xlnx,vcu-logicoreip-1.0" },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, xvcu_of_id_table);
|
||||
|
||||
static struct platform_driver xvcu_driver = {
|
||||
.driver = {
|
||||
.name = "xilinx-vcu",
|
||||
.of_match_table = xvcu_of_id_table,
|
||||
},
|
||||
.probe = xvcu_probe,
|
||||
.remove = xvcu_remove,
|
||||
};
|
||||
|
||||
module_platform_driver(xvcu_driver);
|
||||
|
||||
MODULE_AUTHOR("Dhaval Shah <dshah@xilinx.com>");
|
||||
MODULE_DESCRIPTION("Xilinx VCU init Driver");
|
||||
MODULE_LICENSE("GPL v2");
|
@ -78,6 +78,7 @@
|
||||
#define SCLK_TIMER13 136
|
||||
#define SCLK_TIMER14 137
|
||||
#define SCLK_TIMER15 138
|
||||
#define SCLK_VIP_OUT 139
|
||||
|
||||
#define DCLK_VOP 190
|
||||
#define MCLK_CRYPTO 191
|
||||
@ -148,6 +149,8 @@
|
||||
#define PCLK_VIP 367
|
||||
#define PCLK_WDT 368
|
||||
#define PCLK_EFUSE256 369
|
||||
#define PCLK_DPHYRX 370
|
||||
#define PCLK_DPHYTX0 371
|
||||
|
||||
/* hclk gates */
|
||||
#define HCLK_SFC 448
|
||||
|
@ -21,4 +21,6 @@
|
||||
#define CLK_IR 11
|
||||
#define CLK_W1 12
|
||||
|
||||
#define CLK_R_APB2_RSB 13
|
||||
|
||||
#endif /* _DT_BINDINGS_CLK_SUN50I_H6_R_CCU_H_ */
|
||||
|
115
include/dt-bindings/clock/sun50i-h616-ccu.h
Normal file
115
include/dt-bindings/clock/sun50i-h616-ccu.h
Normal file
@ -0,0 +1,115 @@
|
||||
/* SPDX-License-Identifier: (GPL-2.0+ or MIT) */
|
||||
/*
|
||||
* Copyright (C) 2020 Arm Ltd.
|
||||
*/
|
||||
|
||||
#ifndef _DT_BINDINGS_CLK_SUN50I_H616_H_
|
||||
#define _DT_BINDINGS_CLK_SUN50I_H616_H_
|
||||
|
||||
#define CLK_PLL_PERIPH0 4
|
||||
|
||||
#define CLK_CPUX 21
|
||||
|
||||
#define CLK_APB1 26
|
||||
|
||||
#define CLK_DE 29
|
||||
#define CLK_BUS_DE 30
|
||||
#define CLK_DEINTERLACE 31
|
||||
#define CLK_BUS_DEINTERLACE 32
|
||||
#define CLK_G2D 33
|
||||
#define CLK_BUS_G2D 34
|
||||
#define CLK_GPU0 35
|
||||
#define CLK_BUS_GPU 36
|
||||
#define CLK_GPU1 37
|
||||
#define CLK_CE 38
|
||||
#define CLK_BUS_CE 39
|
||||
#define CLK_VE 40
|
||||
#define CLK_BUS_VE 41
|
||||
#define CLK_BUS_DMA 42
|
||||
#define CLK_BUS_HSTIMER 43
|
||||
#define CLK_AVS 44
|
||||
#define CLK_BUS_DBG 45
|
||||
#define CLK_BUS_PSI 46
|
||||
#define CLK_BUS_PWM 47
|
||||
#define CLK_BUS_IOMMU 48
|
||||
|
||||
#define CLK_MBUS_DMA 50
|
||||
#define CLK_MBUS_VE 51
|
||||
#define CLK_MBUS_CE 52
|
||||
#define CLK_MBUS_TS 53
|
||||
#define CLK_MBUS_NAND 54
|
||||
#define CLK_MBUS_G2D 55
|
||||
|
||||
#define CLK_NAND0 57
|
||||
#define CLK_NAND1 58
|
||||
#define CLK_BUS_NAND 59
|
||||
#define CLK_MMC0 60
|
||||
#define CLK_MMC1 61
|
||||
#define CLK_MMC2 62
|
||||
#define CLK_BUS_MMC0 63
|
||||
#define CLK_BUS_MMC1 64
|
||||
#define CLK_BUS_MMC2 65
|
||||
#define CLK_BUS_UART0 66
|
||||
#define CLK_BUS_UART1 67
|
||||
#define CLK_BUS_UART2 68
|
||||
#define CLK_BUS_UART3 69
|
||||
#define CLK_BUS_UART4 70
|
||||
#define CLK_BUS_UART5 71
|
||||
#define CLK_BUS_I2C0 72
|
||||
#define CLK_BUS_I2C1 73
|
||||
#define CLK_BUS_I2C2 74
|
||||
#define CLK_BUS_I2C3 75
|
||||
#define CLK_BUS_I2C4 76
|
||||
#define CLK_SPI0 77
|
||||
#define CLK_SPI1 78
|
||||
#define CLK_BUS_SPI0 79
|
||||
#define CLK_BUS_SPI1 80
|
||||
#define CLK_EMAC_25M 81
|
||||
#define CLK_BUS_EMAC0 82
|
||||
#define CLK_BUS_EMAC1 83
|
||||
#define CLK_TS 84
|
||||
#define CLK_BUS_TS 85
|
||||
#define CLK_BUS_THS 86
|
||||
#define CLK_SPDIF 87
|
||||
#define CLK_BUS_SPDIF 88
|
||||
#define CLK_DMIC 89
|
||||
#define CLK_BUS_DMIC 90
|
||||
#define CLK_AUDIO_CODEC_1X 91
|
||||
#define CLK_AUDIO_CODEC_4X 92
|
||||
#define CLK_BUS_AUDIO_CODEC 93
|
||||
#define CLK_AUDIO_HUB 94
|
||||
#define CLK_BUS_AUDIO_HUB 95
|
||||
#define CLK_USB_OHCI0 96
|
||||
#define CLK_USB_PHY0 97
|
||||
#define CLK_USB_OHCI1 98
|
||||
#define CLK_USB_PHY1 99
|
||||
#define CLK_USB_OHCI2 100
|
||||
#define CLK_USB_PHY2 101
|
||||
#define CLK_USB_OHCI3 102
|
||||
#define CLK_USB_PHY3 103
|
||||
#define CLK_BUS_OHCI0 104
|
||||
#define CLK_BUS_OHCI1 105
|
||||
#define CLK_BUS_OHCI2 106
|
||||
#define CLK_BUS_OHCI3 107
|
||||
#define CLK_BUS_EHCI0 108
|
||||
#define CLK_BUS_EHCI1 109
|
||||
#define CLK_BUS_EHCI2 110
|
||||
#define CLK_BUS_EHCI3 111
|
||||
#define CLK_BUS_OTG 112
|
||||
#define CLK_BUS_KEYADC 113
|
||||
#define CLK_HDMI 114
|
||||
#define CLK_HDMI_SLOW 115
|
||||
#define CLK_HDMI_CEC 116
|
||||
#define CLK_BUS_HDMI 117
|
||||
#define CLK_BUS_TCON_TOP 118
|
||||
#define CLK_TCON_TV0 119
|
||||
#define CLK_TCON_TV1 120
|
||||
#define CLK_BUS_TCON_TV0 121
|
||||
#define CLK_BUS_TCON_TV1 122
|
||||
#define CLK_TVE0 123
|
||||
#define CLK_BUS_TVE_TOP 124
|
||||
#define CLK_BUS_TVE0 125
|
||||
#define CLK_HDCP 126
|
||||
#define CLK_BUS_HDCP 127
|
||||
|
||||
#endif /* _DT_BINDINGS_CLK_SUN50I_H616_H_ */
|
15
include/dt-bindings/clock/xlnx-vcu.h
Normal file
15
include/dt-bindings/clock/xlnx-vcu.h
Normal file
@ -0,0 +1,15 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
/*
|
||||
* Copyright (C) 2020 Pengutronix, Michael Tretter <kernel@pengutronix.de>
|
||||
*/
|
||||
|
||||
#ifndef _DT_BINDINGS_CLOCK_XLNX_VCU_H
|
||||
#define _DT_BINDINGS_CLOCK_XLNX_VCU_H
|
||||
|
||||
#define CLK_XVCU_ENC_CORE 0
|
||||
#define CLK_XVCU_ENC_MCU 1
|
||||
#define CLK_XVCU_DEC_CORE 2
|
||||
#define CLK_XVCU_DEC_MCU 3
|
||||
#define CLK_XVCU_NUM_CLOCKS 4
|
||||
|
||||
#endif /* _DT_BINDINGS_CLOCK_XLNX_VCU_H */
|
@ -13,5 +13,6 @@
|
||||
#define RST_R_APB2_I2C 4
|
||||
#define RST_R_APB1_IR 5
|
||||
#define RST_R_APB1_W1 6
|
||||
#define RST_R_APB2_RSB 7
|
||||
|
||||
#endif /* _DT_BINDINGS_RST_SUN50I_H6_R_CCU_H_ */
|
||||
|
70
include/dt-bindings/reset/sun50i-h616-ccu.h
Normal file
70
include/dt-bindings/reset/sun50i-h616-ccu.h
Normal file
@ -0,0 +1,70 @@
|
||||
/* SPDX-License-Identifier: (GPL-2.0+ or MIT) */
|
||||
/*
|
||||
* Copyright (C) 2020 Arm Ltd.
|
||||
*/
|
||||
|
||||
#ifndef _DT_BINDINGS_RESET_SUN50I_H616_H_
|
||||
#define _DT_BINDINGS_RESET_SUN50I_H616_H_
|
||||
|
||||
#define RST_MBUS 0
|
||||
#define RST_BUS_DE 1
|
||||
#define RST_BUS_DEINTERLACE 2
|
||||
#define RST_BUS_GPU 3
|
||||
#define RST_BUS_CE 4
|
||||
#define RST_BUS_VE 5
|
||||
#define RST_BUS_DMA 6
|
||||
#define RST_BUS_HSTIMER 7
|
||||
#define RST_BUS_DBG 8
|
||||
#define RST_BUS_PSI 9
|
||||
#define RST_BUS_PWM 10
|
||||
#define RST_BUS_IOMMU 11
|
||||
#define RST_BUS_DRAM 12
|
||||
#define RST_BUS_NAND 13
|
||||
#define RST_BUS_MMC0 14
|
||||
#define RST_BUS_MMC1 15
|
||||
#define RST_BUS_MMC2 16
|
||||
#define RST_BUS_UART0 17
|
||||
#define RST_BUS_UART1 18
|
||||
#define RST_BUS_UART2 19
|
||||
#define RST_BUS_UART3 20
|
||||
#define RST_BUS_UART4 21
|
||||
#define RST_BUS_UART5 22
|
||||
#define RST_BUS_I2C0 23
|
||||
#define RST_BUS_I2C1 24
|
||||
#define RST_BUS_I2C2 25
|
||||
#define RST_BUS_I2C3 26
|
||||
#define RST_BUS_I2C4 27
|
||||
#define RST_BUS_SPI0 28
|
||||
#define RST_BUS_SPI1 29
|
||||
#define RST_BUS_EMAC0 30
|
||||
#define RST_BUS_EMAC1 31
|
||||
#define RST_BUS_TS 32
|
||||
#define RST_BUS_THS 33
|
||||
#define RST_BUS_SPDIF 34
|
||||
#define RST_BUS_DMIC 35
|
||||
#define RST_BUS_AUDIO_CODEC 36
|
||||
#define RST_BUS_AUDIO_HUB 37
|
||||
#define RST_USB_PHY0 38
|
||||
#define RST_USB_PHY1 39
|
||||
#define RST_USB_PHY2 40
|
||||
#define RST_USB_PHY3 41
|
||||
#define RST_BUS_OHCI0 42
|
||||
#define RST_BUS_OHCI1 43
|
||||
#define RST_BUS_OHCI2 44
|
||||
#define RST_BUS_OHCI3 45
|
||||
#define RST_BUS_EHCI0 46
|
||||
#define RST_BUS_EHCI1 47
|
||||
#define RST_BUS_EHCI2 48
|
||||
#define RST_BUS_EHCI3 49
|
||||
#define RST_BUS_OTG 50
|
||||
#define RST_BUS_HDMI 51
|
||||
#define RST_BUS_HDMI_SUB 52
|
||||
#define RST_BUS_TCON_TOP 53
|
||||
#define RST_BUS_TCON_TV0 54
|
||||
#define RST_BUS_TCON_TV1 55
|
||||
#define RST_BUS_TVE_TOP 56
|
||||
#define RST_BUS_TVE0 57
|
||||
#define RST_BUS_HDCP 58
|
||||
#define RST_BUS_KEYADC 59
|
||||
|
||||
#endif /* _DT_BINDINGS_RESET_SUN50I_H616_H_ */
|
Loading…
Reference in New Issue
Block a user