[people/ms/u-boot.git] / drivers / clk / rockchip / clk_rk3368.c

/*
 * (C) Copyright 2017 Rockchip Electronics Co., Ltd
 * Author: Andy Yan <andy.yan@rock-chips.com>
 * (C) Copyright 2017 Theobroma Systems Design und Consulting GmbH
 * SPDX-License-Identifier:	GPL-2.0
 */

#include <common.h>
#include <clk-uclass.h>
#include <dm.h>
#include <dt-structs.h>
#include <errno.h>
#include <mapmem.h>
#include <syscon.h>
#include <bitfield.h>
#include <asm/arch/clock.h>
#include <asm/arch/cru_rk3368.h>
#include <asm/arch/hardware.h>
#include <asm/io.h>
#include <dm/lists.h>
#include <dt-bindings/clock/rk3368-cru.h>

DECLARE_GLOBAL_DATA_PTR;

#if CONFIG_IS_ENABLED(OF_PLATDATA)
struct rk3368_clk_plat {
	struct dtd_rockchip_rk3368_cru dtd;
};
#endif

struct pll_div {
	u32 nr;
	u32 nf;
	u32 no;
};

#define OSC_HZ		(24 * 1000 * 1000)
#define APLL_L_HZ	(800 * 1000 * 1000)
#define APLL_B_HZ	(816 * 1000 * 1000)
#define GPLL_HZ		(576 * 1000 * 1000)
#define CPLL_HZ		(400 * 1000 * 1000)

#define DIV_TO_RATE(input_rate, div)    ((input_rate) / ((div) + 1))

#define PLL_DIVISORS(hz, _nr, _no) { \
	.nr = _nr, .nf = (u32)((u64)hz * _nr * _no / OSC_HZ), .no = _no}; \
	_Static_assert(((u64)hz * _nr * _no / OSC_HZ) * OSC_HZ /\
		       (_nr * _no) == hz, #hz "Hz cannot be hit with PLL " \
		       "divisors on line " __stringify(__LINE__));

#if IS_ENABLED(CONFIG_SPL_BUILD) || IS_ENABLED(CONFIG_TPL_BUILD)
static const struct pll_div apll_l_init_cfg = PLL_DIVISORS(APLL_L_HZ, 12, 2);
static const struct pll_div apll_b_init_cfg = PLL_DIVISORS(APLL_B_HZ, 1, 2);
#if !defined(CONFIG_TPL_BUILD)
static const struct pll_div gpll_init_cfg = PLL_DIVISORS(GPLL_HZ, 1, 2);
static const struct pll_div cpll_init_cfg = PLL_DIVISORS(CPLL_HZ, 1, 6);
#endif
#endif

static ulong rk3368_clk_get_rate(struct clk *clk);

/* Get pll rate by id */
static uint32_t rkclk_pll_get_rate(struct rk3368_cru *cru,
				   enum rk3368_pll_id pll_id)
{
	uint32_t nr, no, nf;
	uint32_t con;
	struct rk3368_pll *pll = &cru->pll[pll_id];

	con = readl(&pll->con3);

	switch ((con & PLL_MODE_MASK) >> PLL_MODE_SHIFT) {
	case PLL_MODE_SLOW:
		return OSC_HZ;
	case PLL_MODE_NORMAL:
		con = readl(&pll->con0);
		no = ((con & PLL_OD_MASK) >> PLL_OD_SHIFT) + 1;
		nr = ((con & PLL_NR_MASK) >> PLL_NR_SHIFT) + 1;
		con = readl(&pll->con1);
		nf = ((con & PLL_NF_MASK) >> PLL_NF_SHIFT) + 1;

		return (24 * nf / (nr * no)) * 1000000;
	case PLL_MODE_DEEP_SLOW:
	default:
		return 32768;
	}
}

#if IS_ENABLED(CONFIG_SPL_BUILD) || IS_ENABLED(CONFIG_TPL_BUILD)
static int rkclk_set_pll(struct rk3368_cru *cru, enum rk3368_pll_id pll_id,
			 const struct pll_div *div)
{
	struct rk3368_pll *pll = &cru->pll[pll_id];
	/* All PLLs have same VCO and output frequency range restrictions*/
	uint vco_hz = OSC_HZ / 1000 * div->nf / div->nr * 1000;
	uint output_hz = vco_hz / div->no;

	debug("PLL at %p: nf=%d, nr=%d, no=%d, vco=%u Hz, output=%u Hz\n",
	      pll, div->nf, div->nr, div->no, vco_hz, output_hz);

	/* enter slow mode and reset pll */
	rk_clrsetreg(&pll->con3, PLL_MODE_MASK | PLL_RESET_MASK,
		     PLL_RESET << PLL_RESET_SHIFT);

	rk_clrsetreg(&pll->con0, PLL_NR_MASK | PLL_OD_MASK,
		     ((div->nr - 1) << PLL_NR_SHIFT) |
		     ((div->no - 1) << PLL_OD_SHIFT));
	writel((div->nf - 1) << PLL_NF_SHIFT, &pll->con1);
	/*
	 * BWADJ should be set to NF / 2 to ensure the nominal bandwidth.
	 * Compare the RK3368 TRM, section "3.6.4 PLL Bandwidth Adjustment".
	 */
	clrsetbits_le32(&pll->con2, PLL_BWADJ_MASK, (div->nf >> 1) - 1);

	udelay(10);

	/* return from reset */
	rk_clrreg(&pll->con3, PLL_RESET_MASK);

	/* waiting for pll lock */
	while (!(readl(&pll->con1) & PLL_LOCK_STA))
		udelay(1);

	rk_clrsetreg(&pll->con3, PLL_MODE_MASK,
		     PLL_MODE_NORMAL << PLL_MODE_SHIFT);

	return 0;
}
#endif

#if IS_ENABLED(CONFIG_SPL_BUILD) || IS_ENABLED(CONFIG_TPL_BUILD)
static void rkclk_init(struct rk3368_cru *cru)
{
	u32 apllb, aplll, dpll, cpll, gpll;

	rkclk_set_pll(cru, APLLB, &apll_b_init_cfg);
	rkclk_set_pll(cru, APLLL, &apll_l_init_cfg);
#if !defined(CONFIG_TPL_BUILD)
	/*
	 * If we plan to return to the boot ROM, we can't increase the
	 * GPLL rate from the SPL stage.
	 */
	rkclk_set_pll(cru, GPLL, &gpll_init_cfg);
	rkclk_set_pll(cru, CPLL, &cpll_init_cfg);
#endif

	apllb = rkclk_pll_get_rate(cru, APLLB);
	aplll = rkclk_pll_get_rate(cru, APLLL);
	dpll = rkclk_pll_get_rate(cru, DPLL);
	cpll = rkclk_pll_get_rate(cru, CPLL);
	gpll = rkclk_pll_get_rate(cru, GPLL);

	debug("%s apllb(%d) apll(%d) dpll(%d) cpll(%d) gpll(%d)\n",
	       __func__, apllb, aplll, dpll, cpll, gpll);
}
#endif

#if !IS_ENABLED(CONFIG_SPL_BUILD) || CONFIG_IS_ENABLED(MMC_SUPPORT)
static ulong rk3368_mmc_get_clk(struct rk3368_cru *cru, uint clk_id)
{
	u32 div, con, con_id, rate;
	u32 pll_rate;

	switch (clk_id) {
	case HCLK_SDMMC:
		con_id = 50;
		break;
	case HCLK_EMMC:
		con_id = 51;
		break;
	case SCLK_SDIO0:
		con_id = 48;
		break;
	default:
		return -EINVAL;
	}

	con = readl(&cru->clksel_con[con_id]);
	switch (con & MMC_PLL_SEL_MASK) {
	case MMC_PLL_SEL_GPLL:
		pll_rate = rkclk_pll_get_rate(cru, GPLL);
		break;
	case MMC_PLL_SEL_24M:
		pll_rate = OSC_HZ;
		break;
	case MMC_PLL_SEL_CPLL:
		pll_rate = rkclk_pll_get_rate(cru, CPLL);
		break;
	case MMC_PLL_SEL_USBPHY_480M:
	default:
		return -EINVAL;
	}
	div = (con & MMC_CLK_DIV_MASK) >> MMC_CLK_DIV_SHIFT;
	rate = DIV_TO_RATE(pll_rate, div);

	debug("%s: raw rate %d (post-divide by 2)\n", __func__, rate);
	return rate >> 1;
}

static ulong rk3368_mmc_find_best_rate_and_parent(struct clk *clk,
						  ulong rate,
						  u32 *best_mux,
						  u32 *best_div)
{
	int i;
	ulong best_rate = 0;
	const ulong MHz = 1000000;
	const struct {
		u32 mux;
		ulong rate;
	} parents[] = {
		{ .mux = MMC_PLL_SEL_CPLL, .rate = CPLL_HZ },
		{ .mux = MMC_PLL_SEL_GPLL, .rate = GPLL_HZ },
		{ .mux = MMC_PLL_SEL_24M,  .rate = 24 * MHz }
	};

	debug("%s: target rate %ld\n", __func__, rate);
	for (i = 0; i < ARRAY_SIZE(parents); ++i) {
		/*
		 * Find the largest rate no larger than the target-rate for
		 * the current parent.
		 */
		ulong parent_rate = parents[i].rate;
		u32 div = DIV_ROUND_UP(parent_rate, rate);
		u32 adj_div = div;
		ulong new_rate = parent_rate / adj_div;

		debug("%s: rate %ld, parent-mux %d, parent-rate %ld, div %d\n",
		      __func__, rate, parents[i].mux, parents[i].rate, div);

		/* Skip, if not representable */
		if ((div - 1) > MMC_CLK_DIV_MASK)
			continue;

		/* Skip, if we already have a better (or equal) solution */
		if (new_rate <= best_rate)
			continue;

		/* This is our new best rate. */
		best_rate = new_rate;
		*best_mux = parents[i].mux;
		*best_div = div - 1;
	}

	debug("%s: best_mux = %x, best_div = %d, best_rate = %ld\n",
	      __func__, *best_mux, *best_div, best_rate);

	return best_rate;
}

static ulong rk3368_mmc_set_clk(struct clk *clk, ulong rate)
{
	struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
	struct rk3368_cru *cru = priv->cru;
	ulong clk_id = clk->id;
	u32 con_id, mux = 0, div = 0;

	/* Find the best parent and rate */
	rk3368_mmc_find_best_rate_and_parent(clk, rate << 1, &mux, &div);

	switch (clk_id) {
	case HCLK_SDMMC:
		con_id = 50;
		break;
	case HCLK_EMMC:
		con_id = 51;
		break;
	case SCLK_SDIO0:
		con_id = 48;
		break;
	default:
		return -EINVAL;
	}

	rk_clrsetreg(&cru->clksel_con[con_id],
		     MMC_PLL_SEL_MASK | MMC_CLK_DIV_MASK,
		     mux | div);

	return rk3368_mmc_get_clk(cru, clk_id);
}
#endif

#if IS_ENABLED(CONFIG_TPL_BUILD)
static ulong rk3368_ddr_set_clk(struct rk3368_cru *cru, ulong set_rate)
{
	const struct pll_div *dpll_cfg = NULL;
	const ulong MHz = 1000000;

	/* Fout = ((Fin /NR) * NF )/ NO */
	static const struct pll_div dpll_1200 = PLL_DIVISORS(1200 * MHz, 1, 1);
	static const struct pll_div dpll_1332 =	PLL_DIVISORS(1332 * MHz, 2, 1);
	static const struct pll_div dpll_1600 =	PLL_DIVISORS(1600 * MHz, 3, 2);

	switch (set_rate) {
	case 1200*MHz:
		dpll_cfg = &dpll_1200;
		break;
	case 1332*MHz:
		dpll_cfg = &dpll_1332;
		break;
	case 1600*MHz:
		dpll_cfg = &dpll_1600;
		break;
	default:
		pr_err("Unsupported SDRAM frequency!,%ld\n", set_rate);
	}
	rkclk_set_pll(cru, DPLL, dpll_cfg);

	return set_rate;
}
#endif

#if CONFIG_IS_ENABLED(GMAC_ROCKCHIP)
static ulong rk3368_gmac_set_clk(struct rk3368_cru *cru, ulong set_rate)
{
	ulong ret;

	/*
	 * The gmac clock can be derived either from an external clock
	 * or can be generated from internally by a divider from SCLK_MAC.
	 */
	if (readl(&cru->clksel_con[43]) & GMAC_MUX_SEL_EXTCLK) {
		/* An external clock will always generate the right rate... */
		ret = set_rate;
	} else {
		u32 con = readl(&cru->clksel_con[43]);
		ulong pll_rate;
		u8 div;

		if (((con >> GMAC_PLL_SHIFT) & GMAC_PLL_MASK) ==
		    GMAC_PLL_SELECT_GENERAL)
			pll_rate = GPLL_HZ;
		else if (((con >> GMAC_PLL_SHIFT) & GMAC_PLL_MASK) ==
			 GMAC_PLL_SELECT_CODEC)
			pll_rate = CPLL_HZ;
		else
			/* CPLL is not set */
			return -EPERM;

		div = DIV_ROUND_UP(pll_rate, set_rate) - 1;
		if (div <= 0x1f)
			rk_clrsetreg(&cru->clksel_con[43], GMAC_DIV_CON_MASK,
				     div << GMAC_DIV_CON_SHIFT);
		else
			debug("Unsupported div for gmac:%d\n", div);

		return DIV_TO_RATE(pll_rate, div);
	}

	return ret;
}
#endif

/*
 * RK3368 SPI clocks have a common divider-width (7 bits) and a single bit
 * to select either CPLL or GPLL as the clock-parent. The location within
 * the enclosing CLKSEL_CON (i.e. div_shift and sel_shift) are variable.
 */

struct spi_clkreg {
	uint8_t reg;  /* CLKSEL_CON[reg] register in CRU */
	uint8_t div_shift;
	uint8_t sel_shift;
};

/*
 * The entries are numbered relative to their offset from SCLK_SPI0.
 */
static const struct spi_clkreg spi_clkregs[] = {
	[0] = { .reg = 45, .div_shift = 0, .sel_shift = 7, },
	[1] = { .reg = 45, .div_shift = 8, .sel_shift = 15, },
	[2] = { .reg = 46, .div_shift = 8, .sel_shift = 15, },
};

static inline u32 extract_bits(u32 val, unsigned width, unsigned shift)
{
	return (val >> shift) & ((1 << width) - 1);
}

static ulong rk3368_spi_get_clk(struct rk3368_cru *cru, ulong clk_id)
{
	const struct spi_clkreg *spiclk = NULL;
	u32 div, val;

	switch (clk_id) {
	case SCLK_SPI0 ... SCLK_SPI2:
		spiclk = &spi_clkregs[clk_id - SCLK_SPI0];
		break;

	default:
		pr_err("%s: SPI clk-id %ld not supported\n", __func__, clk_id);
		return -EINVAL;
	}

	val = readl(&cru->clksel_con[spiclk->reg]);
	div = extract_bits(val, 7, spiclk->div_shift);

	debug("%s: div 0x%x\n", __func__, div);
	return DIV_TO_RATE(GPLL_HZ, div);
}

static ulong rk3368_spi_set_clk(struct rk3368_cru *cru, ulong clk_id, uint hz)
{
	const struct spi_clkreg *spiclk = NULL;
	int src_clk_div;

	src_clk_div = DIV_ROUND_UP(GPLL_HZ, hz);
	assert(src_clk_div < 127);

	switch (clk_id) {
	case SCLK_SPI0 ... SCLK_SPI2:
		spiclk = &spi_clkregs[clk_id - SCLK_SPI0];
		break;

	default:
		pr_err("%s: SPI clk-id %ld not supported\n", __func__, clk_id);
		return -EINVAL;
	}

	rk_clrsetreg(&cru->clksel_con[spiclk->reg],
		     ((0x7f << spiclk->div_shift) |
		      (0x1 << spiclk->sel_shift)),
		     ((src_clk_div << spiclk->div_shift) |
		      (1 << spiclk->sel_shift)));

	return rk3368_spi_get_clk(cru, clk_id);
}

static ulong rk3368_saradc_get_clk(struct rk3368_cru *cru)
{
	u32 div, val;

	val = readl(&cru->clksel_con[25]);
	div = bitfield_extract(val, CLK_SARADC_DIV_CON_SHIFT,
			       CLK_SARADC_DIV_CON_WIDTH);

	return DIV_TO_RATE(OSC_HZ, div);
}

static ulong rk3368_saradc_set_clk(struct rk3368_cru *cru, uint hz)
{
	int src_clk_div;

	src_clk_div = DIV_ROUND_UP(OSC_HZ, hz) - 1;
	assert(src_clk_div < 128);

	rk_clrsetreg(&cru->clksel_con[25],
		     CLK_SARADC_DIV_CON_MASK,
		     src_clk_div << CLK_SARADC_DIV_CON_SHIFT);

	return rk3368_saradc_get_clk(cru);
}

static ulong rk3368_clk_get_rate(struct clk *clk)
{
	struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
	ulong rate = 0;

	debug("%s: id %ld\n", __func__, clk->id);
	switch (clk->id) {
	case PLL_CPLL:
		rate = rkclk_pll_get_rate(priv->cru, CPLL);
		break;
	case PLL_GPLL:
		rate = rkclk_pll_get_rate(priv->cru, GPLL);
		break;
	case SCLK_SPI0 ... SCLK_SPI2:
		rate = rk3368_spi_get_clk(priv->cru, clk->id);
		break;
#if !IS_ENABLED(CONFIG_SPL_BUILD) || CONFIG_IS_ENABLED(MMC_SUPPORT)
	case HCLK_SDMMC:
	case HCLK_EMMC:
		rate = rk3368_mmc_get_clk(priv->cru, clk->id);
		break;
#endif
	case SCLK_SARADC:
		rate = rk3368_saradc_get_clk(priv->cru);
		break;
	default:
		return -ENOENT;
	}

	return rate;
}

static ulong rk3368_clk_set_rate(struct clk *clk, ulong rate)
{
	__maybe_unused struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
	ulong ret = 0;

	debug("%s id:%ld rate:%ld\n", __func__, clk->id, rate);
	switch (clk->id) {
	case SCLK_SPI0 ... SCLK_SPI2:
		ret = rk3368_spi_set_clk(priv->cru, clk->id, rate);
		break;
#if IS_ENABLED(CONFIG_TPL_BUILD)
	case CLK_DDR:
		ret = rk3368_ddr_set_clk(priv->cru, rate);
		break;
#endif
#if !IS_ENABLED(CONFIG_SPL_BUILD) || CONFIG_IS_ENABLED(MMC_SUPPORT)
	case HCLK_SDMMC:
	case HCLK_EMMC:
		ret = rk3368_mmc_set_clk(clk, rate);
		break;
#endif
#if CONFIG_IS_ENABLED(GMAC_ROCKCHIP)
	case SCLK_MAC:
		/* select the external clock */
		ret = rk3368_gmac_set_clk(priv->cru, rate);
		break;
#endif
	case SCLK_SARADC:
		ret =  rk3368_saradc_set_clk(priv->cru, rate);
		break;
	default:
		return -ENOENT;
	}

	return ret;
}

static int __maybe_unused rk3368_gmac_set_parent(struct clk *clk, struct clk *parent)
{
	struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
	struct rk3368_cru *cru = priv->cru;
	const char *clock_output_name;
	int ret;

	/*
	 * If the requested parent is in the same clock-controller and
	 * the id is SCLK_MAC ("sclk_mac"), switch to the internal
	 * clock.
	 */
	if ((parent->dev == clk->dev) && (parent->id == SCLK_MAC)) {
		debug("%s: switching GAMC to SCLK_MAC\n", __func__);
		rk_clrreg(&cru->clksel_con[43], GMAC_MUX_SEL_EXTCLK);
		return 0;
	}

	/*
	 * Otherwise, we need to check the clock-output-names of the
	 * requested parent to see if the requested id is "ext_gmac".
	 */
	ret = dev_read_string_index(parent->dev, "clock-output-names",
				    parent->id, &clock_output_name);
	if (ret < 0)
		return -ENODATA;

	/* If this is "ext_gmac", switch to the external clock input */
	if (!strcmp(clock_output_name, "ext_gmac")) {
		debug("%s: switching GMAC to external clock\n", __func__);
		rk_setreg(&cru->clksel_con[43], GMAC_MUX_SEL_EXTCLK);
		return 0;
	}

	return -EINVAL;
}

static int __maybe_unused rk3368_clk_set_parent(struct clk *clk, struct clk *parent)
{
	switch (clk->id) {
	case SCLK_MAC:
		return rk3368_gmac_set_parent(clk, parent);
	}

	debug("%s: unsupported clk %ld\n", __func__, clk->id);
	return -ENOENT;
}

static int rk3368_clk_enable(struct clk *clk)
{
	switch (clk->id) {
	case SCLK_MAC:
	case SCLK_MAC_RX:
	case SCLK_MAC_TX:
	case SCLK_MACREF:
	case SCLK_MACREF_OUT:
	case ACLK_GMAC:
	case PCLK_GMAC:
		/* Required to successfully probe the Designware GMAC driver */
		return 0;
	}

	debug("%s: unsupported clk %ld\n", __func__, clk->id);
	return -ENOENT;
}

static struct clk_ops rk3368_clk_ops = {
	.get_rate = rk3368_clk_get_rate,
	.set_rate = rk3368_clk_set_rate,
#if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
	.set_parent = rk3368_clk_set_parent,
#endif
	.enable = rk3368_clk_enable,
};

static int rk3368_clk_probe(struct udevice *dev)
{
	struct rk3368_clk_priv __maybe_unused *priv = dev_get_priv(dev);
#if CONFIG_IS_ENABLED(OF_PLATDATA)
	struct rk3368_clk_plat *plat = dev_get_platdata(dev);

	priv->cru = map_sysmem(plat->dtd.reg[0], plat->dtd.reg[1]);
#endif
#if IS_ENABLED(CONFIG_SPL_BUILD) || IS_ENABLED(CONFIG_TPL_BUILD)
	rkclk_init(priv->cru);
#endif

	return 0;
}

static int rk3368_clk_ofdata_to_platdata(struct udevice *dev)
{
#if !CONFIG_IS_ENABLED(OF_PLATDATA)
	struct rk3368_clk_priv *priv = dev_get_priv(dev);

	priv->cru = dev_read_addr_ptr(dev);
#endif

	return 0;
}

static int rk3368_clk_bind(struct udevice *dev)
{
	int ret;
	struct udevice *sys_child;
	struct sysreset_reg *priv;

	/* The reset driver does not have a device node, so bind it here */
	ret = device_bind_driver(dev, "rockchip_sysreset", "sysreset",
				 &sys_child);
	if (ret) {
		debug("Warning: No sysreset driver: ret=%d\n", ret);
	} else {
		priv = malloc(sizeof(struct sysreset_reg));
		priv->glb_srst_fst_value = offsetof(struct rk3368_cru,
						    glb_srst_fst_val);
		priv->glb_srst_snd_value = offsetof(struct rk3368_cru,
						    glb_srst_snd_val);
		sys_child->priv = priv;
	}

#if CONFIG_IS_ENABLED(CONFIG_RESET_ROCKCHIP)
	ret = offsetof(struct rk3368_cru, softrst_con[0]);
	ret = rockchip_reset_bind(dev, ret, 15);
	if (ret)
		debug("Warning: software reset driver bind faile\n");
#endif

	return ret;
}

static const struct udevice_id rk3368_clk_ids[] = {
	{ .compatible = "rockchip,rk3368-cru" },
	{ }
};

U_BOOT_DRIVER(rockchip_rk3368_cru) = {
	.name		= "rockchip_rk3368_cru",
	.id		= UCLASS_CLK,
	.of_match	= rk3368_clk_ids,
	.priv_auto_alloc_size = sizeof(struct rk3368_clk_priv),
#if CONFIG_IS_ENABLED(OF_PLATDATA)
	.platdata_auto_alloc_size = sizeof(struct rk3368_clk_plat),
#endif
	.ofdata_to_platdata = rk3368_clk_ofdata_to_platdata,
	.ops		= &rk3368_clk_ops,
	.bind		= rk3368_clk_bind,
	.probe		= rk3368_clk_probe,
};
Commit	Line	Data
d1dcf852 AY	1	/*
	2	* (C) Copyright 2017 Rockchip Electronics Co., Ltd
	3	* Author: Andy Yan <andy.yan@rock-chips.com>
ddfe77df	4	* (C) Copyright 2017 Theobroma Systems Design und Consulting GmbH
d1dcf852 AY	5	* SPDX-License-Identifier: GPL-2.0
	6	*/
	7
	8	#include <common.h>
	9	#include <clk-uclass.h>
	10	#include <dm.h>
bee61801	11	#include <dt-structs.h>
d1dcf852	12	#include <errno.h>
bee61801	13	#include <mapmem.h>
d1dcf852	14	#include <syscon.h>
615514c1	15	#include <bitfield.h>
d1dcf852 AY	16	#include <asm/arch/clock.h>
	17	#include <asm/arch/cru_rk3368.h>
	18	#include <asm/arch/hardware.h>
	19	#include <asm/io.h>
	20	#include <dm/lists.h>
	21	#include <dt-bindings/clock/rk3368-cru.h>
	22
	23	DECLARE_GLOBAL_DATA_PTR;
	24
bee61801 PT	25	#if CONFIG_IS_ENABLED(OF_PLATDATA)
	26	struct rk3368_clk_plat {
	27	struct dtd_rockchip_rk3368_cru dtd;
	28	};
	29	#endif
	30
d1dcf852 AY	31	struct pll_div {
	32	u32 nr;
	33	u32 nf;
	34	u32 no;
	35	};
	36
	37	#define OSC_HZ (24 * 1000 * 1000)
	38	#define APLL_L_HZ (800 * 1000 * 1000)
	39	#define APLL_B_HZ (816 * 1000 * 1000)
	40	#define GPLL_HZ (576 * 1000 * 1000)
	41	#define CPLL_HZ (400 * 1000 * 1000)
	42
d1dcf852 AY	43	#define DIV_TO_RATE(input_rate, div) ((input_rate) / ((div) + 1))
	44
	45	#define PLL_DIVISORS(hz, _nr, _no) { \
	46	.nr = _nr, .nf = (u32)((u64)hz * _nr * _no / OSC_HZ), .no = _no}; \
	47	_Static_assert(((u64)hz * _nr * _no / OSC_HZ) * OSC_HZ /\
	48	(_nr * _no) == hz, #hz "Hz cannot be hit with PLL " \
	49	"divisors on line " __stringify(__LINE__));
	50
4bebf94e	51	#if IS_ENABLED(CONFIG_SPL_BUILD) \|\| IS_ENABLED(CONFIG_TPL_BUILD)
d1dcf852 AY	52	static const struct pll_div apll_l_init_cfg = PLL_DIVISORS(APLL_L_HZ, 12, 2);
d1dcf852 AY	53	static const struct pll_div apll_b_init_cfg = PLL_DIVISORS(APLL_B_HZ, 1, 2);
4bebf94e	54	#if !defined(CONFIG_TPL_BUILD)
d1dcf852 AY	55	static const struct pll_div gpll_init_cfg = PLL_DIVISORS(GPLL_HZ, 1, 2);
d1dcf852 AY	56	static const struct pll_div cpll_init_cfg = PLL_DIVISORS(CPLL_HZ, 1, 6);
4bebf94e PT	57	#endif
4bebf94e PT	58	#endif
d1dcf852	59
f5a43295 PT	60	static ulong rk3368_clk_get_rate(struct clk *clk);
f5a43295 PT	61
d1dcf852 AY	62	/* Get pll rate by id */
	63	static uint32_t rkclk_pll_get_rate(struct rk3368_cru *cru,
	64	enum rk3368_pll_id pll_id)
	65	{
	66	uint32_t nr, no, nf;
	67	uint32_t con;
	68	struct rk3368_pll *pll = &cru->pll[pll_id];
	69
	70	con = readl(&pll->con3);
	71
	72	switch ((con & PLL_MODE_MASK) >> PLL_MODE_SHIFT) {
	73	case PLL_MODE_SLOW:
	74	return OSC_HZ;
	75	case PLL_MODE_NORMAL:
	76	con = readl(&pll->con0);
	77	no = ((con & PLL_OD_MASK) >> PLL_OD_SHIFT) + 1;
	78	nr = ((con & PLL_NR_MASK) >> PLL_NR_SHIFT) + 1;
	79	con = readl(&pll->con1);
	80	nf = ((con & PLL_NF_MASK) >> PLL_NF_SHIFT) + 1;
	81
	82	return (24 * nf / (nr * no)) * 1000000;
	83	case PLL_MODE_DEEP_SLOW:
	84	default:
	85	return 32768;
	86	}
	87	}
	88
4bebf94e	89	#if IS_ENABLED(CONFIG_SPL_BUILD) \|\| IS_ENABLED(CONFIG_TPL_BUILD)
d1dcf852	90	static int rkclk_set_pll(struct rk3368_cru *cru, enum rk3368_pll_id pll_id,
ddfe77df	91	const struct pll_div *div)
d1dcf852 AY	92	{
	93	struct rk3368_pll *pll = &cru->pll[pll_id];
	94	/* All PLLs have same VCO and output frequency range restrictions*/
	95	uint vco_hz = OSC_HZ / 1000 * div->nf / div->nr * 1000;
	96	uint output_hz = vco_hz / div->no;
	97
	98	debug("PLL at %p: nf=%d, nr=%d, no=%d, vco=%u Hz, output=%u Hz\n",
	99	pll, div->nf, div->nr, div->no, vco_hz, output_hz);
	100
	101	/* enter slow mode and reset pll */
	102	rk_clrsetreg(&pll->con3, PLL_MODE_MASK \| PLL_RESET_MASK,
	103	PLL_RESET << PLL_RESET_SHIFT);
	104
	105	rk_clrsetreg(&pll->con0, PLL_NR_MASK \| PLL_OD_MASK,
	106	((div->nr - 1) << PLL_NR_SHIFT) \|
	107	((div->no - 1) << PLL_OD_SHIFT));
	108	writel((div->nf - 1) << PLL_NF_SHIFT, &pll->con1);
ddfe77df PT	109	/*
	110	* BWADJ should be set to NF / 2 to ensure the nominal bandwidth.
	111	* Compare the RK3368 TRM, section "3.6.4 PLL Bandwidth Adjustment".
	112	*/
	113	clrsetbits_le32(&pll->con2, PLL_BWADJ_MASK, (div->nf >> 1) - 1);
	114
d1dcf852 AY	115	udelay(10);
	116
	117	/* return from reset */
	118	rk_clrreg(&pll->con3, PLL_RESET_MASK);
	119
	120	/* waiting for pll lock */
	121	while (!(readl(&pll->con1) & PLL_LOCK_STA))
	122	udelay(1);
	123
	124	rk_clrsetreg(&pll->con3, PLL_MODE_MASK,
	125	PLL_MODE_NORMAL << PLL_MODE_SHIFT);
	126
	127	return 0;
	128	}
4bebf94e	129	#endif
d1dcf852	130
4bebf94e	131	#if IS_ENABLED(CONFIG_SPL_BUILD) \|\| IS_ENABLED(CONFIG_TPL_BUILD)
d1dcf852 AY	132	static void rkclk_init(struct rk3368_cru *cru)
	133	{
	134	u32 apllb, aplll, dpll, cpll, gpll;
	135
ddfe77df PT	136	rkclk_set_pll(cru, APLLB, &apll_b_init_cfg);
ddfe77df PT	137	rkclk_set_pll(cru, APLLL, &apll_l_init_cfg);
4bebf94e PT	138	#if !defined(CONFIG_TPL_BUILD)
	139	/*
	140	* If we plan to return to the boot ROM, we can't increase the
	141	* GPLL rate from the SPL stage.
	142	*/
ddfe77df PT	143	rkclk_set_pll(cru, GPLL, &gpll_init_cfg);
ddfe77df PT	144	rkclk_set_pll(cru, CPLL, &cpll_init_cfg);
4bebf94e	145	#endif
d1dcf852 AY	146
	147	apllb = rkclk_pll_get_rate(cru, APLLB);
	148	aplll = rkclk_pll_get_rate(cru, APLLL);
	149	dpll = rkclk_pll_get_rate(cru, DPLL);
	150	cpll = rkclk_pll_get_rate(cru, CPLL);
	151	gpll = rkclk_pll_get_rate(cru, GPLL);
	152
	153	debug("%s apllb(%d) apll(%d) dpll(%d) cpll(%d) gpll(%d)\n",
	154	__func__, apllb, aplll, dpll, cpll, gpll);
	155	}
4bebf94e	156	#endif
d1dcf852	157
f5a43295	158	#if !IS_ENABLED(CONFIG_SPL_BUILD) \|\| CONFIG_IS_ENABLED(MMC_SUPPORT)
d1dcf852 AY	159	static ulong rk3368_mmc_get_clk(struct rk3368_cru *cru, uint clk_id)
	160	{
	161	u32 div, con, con_id, rate;
	162	u32 pll_rate;
	163
	164	switch (clk_id) {
f5a43295	165	case HCLK_SDMMC:
d1dcf852 AY	166	con_id = 50;
d1dcf852 AY	167	break;
f5a43295	168	case HCLK_EMMC:
d1dcf852 AY	169	con_id = 51;
	170	break;
	171	case SCLK_SDIO0:
	172	con_id = 48;
	173	break;
	174	default:
	175	return -EINVAL;
	176	}
	177
	178	con = readl(&cru->clksel_con[con_id]);
f5a43295	179	switch (con & MMC_PLL_SEL_MASK) {
d1dcf852 AY	180	case MMC_PLL_SEL_GPLL:
	181	pll_rate = rkclk_pll_get_rate(cru, GPLL);
	182	break;
	183	case MMC_PLL_SEL_24M:
	184	pll_rate = OSC_HZ;
	185	break;
	186	case MMC_PLL_SEL_CPLL:
f5a43295 PT	187	pll_rate = rkclk_pll_get_rate(cru, CPLL);
f5a43295 PT	188	break;
d1dcf852 AY	189	case MMC_PLL_SEL_USBPHY_480M:
	190	default:
	191	return -EINVAL;
	192	}
	193	div = (con & MMC_CLK_DIV_MASK) >> MMC_CLK_DIV_SHIFT;
	194	rate = DIV_TO_RATE(pll_rate, div);
	195
f5a43295	196	debug("%s: raw rate %d (post-divide by 2)\n", __func__, rate);
d1dcf852 AY	197	return rate >> 1;
	198	}
	199
f5a43295 PT	200	static ulong rk3368_mmc_find_best_rate_and_parent(struct clk *clk,
	201	ulong rate,
	202	u32 *best_mux,
	203	u32 *best_div)
	204	{
	205	int i;
	206	ulong best_rate = 0;
	207	const ulong MHz = 1000000;
	208	const struct {
	209	u32 mux;
	210	ulong rate;
	211	} parents[] = {
	212	{ .mux = MMC_PLL_SEL_CPLL, .rate = CPLL_HZ },
	213	{ .mux = MMC_PLL_SEL_GPLL, .rate = GPLL_HZ },
	214	{ .mux = MMC_PLL_SEL_24M, .rate = 24 * MHz }
	215	};
	216
	217	debug("%s: target rate %ld\n", __func__, rate);
	218	for (i = 0; i < ARRAY_SIZE(parents); ++i) {
	219	/*
	220	* Find the largest rate no larger than the target-rate for
	221	* the current parent.
	222	*/
	223	ulong parent_rate = parents[i].rate;
	224	u32 div = DIV_ROUND_UP(parent_rate, rate);
	225	u32 adj_div = div;
	226	ulong new_rate = parent_rate / adj_div;
	227
	228	debug("%s: rate %ld, parent-mux %d, parent-rate %ld, div %d\n",
	229	__func__, rate, parents[i].mux, parents[i].rate, div);
	230
	231	/* Skip, if not representable */
	232	if ((div - 1) > MMC_CLK_DIV_MASK)
	233	continue;
	234
	235	/* Skip, if we already have a better (or equal) solution */
	236	if (new_rate <= best_rate)
	237	continue;
	238
	239	/* This is our new best rate. */
	240	best_rate = new_rate;
	241	*best_mux = parents[i].mux;
	242	*best_div = div - 1;
	243	}
	244
	245	debug("%s: best_mux = %x, best_div = %d, best_rate = %ld\n",
	246	__func__, best_mux, best_div, best_rate);
	247
	248	return best_rate;
	249	}
	250
	251	static ulong rk3368_mmc_set_clk(struct clk *clk, ulong rate)
d1dcf852	252	{
f5a43295 PT	253	struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
	254	struct rk3368_cru *cru = priv->cru;
	255	ulong clk_id = clk->id;
	256	u32 con_id, mux = 0, div = 0;
d1dcf852	257
f5a43295 PT	258	/* Find the best parent and rate */
f5a43295 PT	259	rk3368_mmc_find_best_rate_and_parent(clk, rate << 1, &mux, &div);
d1dcf852 AY	260
d1dcf852 AY	261	switch (clk_id) {
f5a43295	262	case HCLK_SDMMC:
d1dcf852 AY	263	con_id = 50;
d1dcf852 AY	264	break;
f5a43295	265	case HCLK_EMMC:
d1dcf852 AY	266	con_id = 51;
	267	break;
	268	case SCLK_SDIO0:
	269	con_id = 48;
	270	break;
	271	default:
	272	return -EINVAL;
	273	}
	274
f5a43295 PT	275	rk_clrsetreg(&cru->clksel_con[con_id],
	276	MMC_PLL_SEL_MASK \| MMC_CLK_DIV_MASK,
	277	mux \| div);
d1dcf852 AY	278
	279	return rk3368_mmc_get_clk(cru, clk_id);
	280	}
f5a43295	281	#endif
d1dcf852	282
62924690	283	#if IS_ENABLED(CONFIG_TPL_BUILD)
a00dfa04 PT	284	static ulong rk3368_ddr_set_clk(struct rk3368_cru *cru, ulong set_rate)
	285	{
	286	const struct pll_div *dpll_cfg = NULL;
	287	const ulong MHz = 1000000;
	288
	289	/* Fout = ((Fin /NR) * NF )/ NO */
62924690 PT	290	static const struct pll_div dpll_1200 = PLL_DIVISORS(1200 * MHz, 1, 1);
	291	static const struct pll_div dpll_1332 = PLL_DIVISORS(1332 * MHz, 2, 1);
	292	static const struct pll_div dpll_1600 = PLL_DIVISORS(1600 * MHz, 3, 2);
a00dfa04 PT	293
	294	switch (set_rate) {
	295	case 1200*MHz:
	296	dpll_cfg = &dpll_1200;
	297	break;
	298	case 1332*MHz:
	299	dpll_cfg = &dpll_1332;
	300	break;
	301	case 1600*MHz:
	302	dpll_cfg = &dpll_1600;
	303	break;
	304	default:
9b643e31	305	pr_err("Unsupported SDRAM frequency!,%ld\n", set_rate);
a00dfa04 PT	306	}
	307	rkclk_set_pll(cru, DPLL, dpll_cfg);
	308
	309	return set_rate;
	310	}
62924690	311	#endif
a00dfa04	312
df0ae000	313	#if CONFIG_IS_ENABLED(GMAC_ROCKCHIP)
64a12202	314	static ulong rk3368_gmac_set_clk(struct rk3368_cru *cru, ulong set_rate)
df0ae000	315	{
64a12202 DW	316	ulong ret;
64a12202 DW	317
df0ae000	318	/*
64a12202 DW	319	* The gmac clock can be derived either from an external clock
64a12202 DW	320	* or can be generated from internally by a divider from SCLK_MAC.
df0ae000	321	*/
64a12202 DW	322	if (readl(&cru->clksel_con[43]) & GMAC_MUX_SEL_EXTCLK) {
	323	/* An external clock will always generate the right rate... */
	324	ret = set_rate;
	325	} else {
	326	u32 con = readl(&cru->clksel_con[43]);
	327	ulong pll_rate;
	328	u8 div;
	329
	330	if (((con >> GMAC_PLL_SHIFT) & GMAC_PLL_MASK) ==
	331	GMAC_PLL_SELECT_GENERAL)
	332	pll_rate = GPLL_HZ;
	333	else if (((con >> GMAC_PLL_SHIFT) & GMAC_PLL_MASK) ==
	334	GMAC_PLL_SELECT_CODEC)
	335	pll_rate = CPLL_HZ;
	336	else
	337	/* CPLL is not set */
	338	return -EPERM;
	339
	340	div = DIV_ROUND_UP(pll_rate, set_rate) - 1;
	341	if (div <= 0x1f)
	342	rk_clrsetreg(&cru->clksel_con[43], GMAC_DIV_CON_MASK,
	343	div << GMAC_DIV_CON_SHIFT);
	344	else
	345	debug("Unsupported div for gmac:%d\n", div);
	346
	347	return DIV_TO_RATE(pll_rate, div);
	348	}
	349
	350	return ret;
df0ae000 PT	351	}
	352	#endif
	353
cf8aceb1 PT	354	/*
	355	* RK3368 SPI clocks have a common divider-width (7 bits) and a single bit
	356	* to select either CPLL or GPLL as the clock-parent. The location within
	357	* the enclosing CLKSEL_CON (i.e. div_shift and sel_shift) are variable.
	358	*/
	359
	360	struct spi_clkreg {
	361	uint8_t reg; /* CLKSEL_CON[reg] register in CRU */
	362	uint8_t div_shift;
	363	uint8_t sel_shift;
	364	};
	365
	366	/*
	367	* The entries are numbered relative to their offset from SCLK_SPI0.
	368	*/
	369	static const struct spi_clkreg spi_clkregs[] = {
	370	[0] = { .reg = 45, .div_shift = 0, .sel_shift = 7, },
	371	[1] = { .reg = 45, .div_shift = 8, .sel_shift = 15, },
	372	[2] = { .reg = 46, .div_shift = 8, .sel_shift = 15, },
	373	};
	374
	375	static inline u32 extract_bits(u32 val, unsigned width, unsigned shift)
	376	{
	377	return (val >> shift) & ((1 << width) - 1);
	378	}
	379
	380	static ulong rk3368_spi_get_clk(struct rk3368_cru *cru, ulong clk_id)
	381	{
	382	const struct spi_clkreg *spiclk = NULL;
	383	u32 div, val;
	384
	385	switch (clk_id) {
	386	case SCLK_SPI0 ... SCLK_SPI2:
	387	spiclk = &spi_clkregs[clk_id - SCLK_SPI0];
	388	break;
	389
	390	default:
9b643e31	391	pr_err("%s: SPI clk-id %ld not supported\n", __func__, clk_id);
cf8aceb1 PT	392	return -EINVAL;
	393	}
	394
	395	val = readl(&cru->clksel_con[spiclk->reg]);
	396	div = extract_bits(val, 7, spiclk->div_shift);
	397
	398	debug("%s: div 0x%x\n", __func__, div);
	399	return DIV_TO_RATE(GPLL_HZ, div);
	400	}
	401
	402	static ulong rk3368_spi_set_clk(struct rk3368_cru *cru, ulong clk_id, uint hz)
	403	{
	404	const struct spi_clkreg *spiclk = NULL;
	405	int src_clk_div;
	406
	407	src_clk_div = DIV_ROUND_UP(GPLL_HZ, hz);
	408	assert(src_clk_div < 127);
	409
	410	switch (clk_id) {
	411	case SCLK_SPI0 ... SCLK_SPI2:
	412	spiclk = &spi_clkregs[clk_id - SCLK_SPI0];
	413	break;
	414
	415	default:
9b643e31	416	pr_err("%s: SPI clk-id %ld not supported\n", __func__, clk_id);
cf8aceb1 PT	417	return -EINVAL;
	418	}
	419
	420	rk_clrsetreg(&cru->clksel_con[spiclk->reg],
	421	((0x7f << spiclk->div_shift) \|
	422	(0x1 << spiclk->sel_shift)),
	423	((src_clk_div << spiclk->div_shift) \|
	424	(1 << spiclk->sel_shift)));
	425
	426	return rk3368_spi_get_clk(cru, clk_id);
	427	}
	428
615514c1 DW	429	static ulong rk3368_saradc_get_clk(struct rk3368_cru *cru)
	430	{
	431	u32 div, val;
	432
	433	val = readl(&cru->clksel_con[25]);
	434	div = bitfield_extract(val, CLK_SARADC_DIV_CON_SHIFT,
	435	CLK_SARADC_DIV_CON_WIDTH);
	436
	437	return DIV_TO_RATE(OSC_HZ, div);
	438	}
	439
	440	static ulong rk3368_saradc_set_clk(struct rk3368_cru *cru, uint hz)
	441	{
	442	int src_clk_div;
	443
	444	src_clk_div = DIV_ROUND_UP(OSC_HZ, hz) - 1;
	445	assert(src_clk_div < 128);
	446
	447	rk_clrsetreg(&cru->clksel_con[25],
	448	CLK_SARADC_DIV_CON_MASK,
	449	src_clk_div << CLK_SARADC_DIV_CON_SHIFT);
	450
	451	return rk3368_saradc_get_clk(cru);
	452	}
	453
cf8aceb1 PT	454	static ulong rk3368_clk_get_rate(struct clk *clk)
	455	{
	456	struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
	457	ulong rate = 0;
	458
	459	debug("%s: id %ld\n", __func__, clk->id);
	460	switch (clk->id) {
	461	case PLL_CPLL:
	462	rate = rkclk_pll_get_rate(priv->cru, CPLL);
	463	break;
	464	case PLL_GPLL:
	465	rate = rkclk_pll_get_rate(priv->cru, GPLL);
	466	break;
	467	case SCLK_SPI0 ... SCLK_SPI2:
	468	rate = rk3368_spi_get_clk(priv->cru, clk->id);
	469	break;
	470	#if !IS_ENABLED(CONFIG_SPL_BUILD) \|\| CONFIG_IS_ENABLED(MMC_SUPPORT)
	471	case HCLK_SDMMC:
	472	case HCLK_EMMC:
	473	rate = rk3368_mmc_get_clk(priv->cru, clk->id);
	474	break;
	475	#endif
615514c1 DW	476	case SCLK_SARADC:
	477	rate = rk3368_saradc_get_clk(priv->cru);
	478	break;
cf8aceb1 PT	479	default:
	480	return -ENOENT;
	481	}
	482
	483	return rate;
	484	}
	485
d1dcf852 AY	486	static ulong rk3368_clk_set_rate(struct clk *clk, ulong rate)
d1dcf852 AY	487	{
4e4c40df	488	__maybe_unused struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
d1dcf852 AY	489	ulong ret = 0;
	490
	491	debug("%s id:%ld rate:%ld\n", __func__, clk->id, rate);
	492	switch (clk->id) {
cf8aceb1 PT	493	case SCLK_SPI0 ... SCLK_SPI2:
	494	ret = rk3368_spi_set_clk(priv->cru, clk->id, rate);
	495	break;
62924690	496	#if IS_ENABLED(CONFIG_TPL_BUILD)
a00dfa04 PT	497	case CLK_DDR:
	498	ret = rk3368_ddr_set_clk(priv->cru, rate);
	499	break;
62924690	500	#endif
f5a43295 PT	501	#if !IS_ENABLED(CONFIG_SPL_BUILD) \|\| CONFIG_IS_ENABLED(MMC_SUPPORT)
	502	case HCLK_SDMMC:
	503	case HCLK_EMMC:
	504	ret = rk3368_mmc_set_clk(clk, rate);
	505	break;
	506	#endif
df0ae000	507	#if CONFIG_IS_ENABLED(GMAC_ROCKCHIP)
f5a43295	508	case SCLK_MAC:
df0ae000	509	/* select the external clock */
64a12202	510	ret = rk3368_gmac_set_clk(priv->cru, rate);
d1dcf852	511	break;
df0ae000	512	#endif
615514c1 DW	513	case SCLK_SARADC:
	514	ret = rk3368_saradc_set_clk(priv->cru, rate);
	515	break;
d1dcf852 AY	516	default:
	517	return -ENOENT;
	518	}
	519
	520	return ret;
	521	}
	522
75b381aa	523	static int __maybe_unused rk3368_gmac_set_parent(struct clk clk, struct clk parent)
64a12202 DW	524	{
	525	struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
	526	struct rk3368_cru *cru = priv->cru;
	527	const char *clock_output_name;
	528	int ret;
	529
	530	/*
	531	* If the requested parent is in the same clock-controller and
	532	* the id is SCLK_MAC ("sclk_mac"), switch to the internal
	533	* clock.
	534	*/
	535	if ((parent->dev == clk->dev) && (parent->id == SCLK_MAC)) {
	536	debug("%s: switching GAMC to SCLK_MAC\n", __func__);
	537	rk_clrreg(&cru->clksel_con[43], GMAC_MUX_SEL_EXTCLK);
	538	return 0;
	539	}
	540
	541	/*
	542	* Otherwise, we need to check the clock-output-names of the
	543	* requested parent to see if the requested id is "ext_gmac".
	544	*/
	545	ret = dev_read_string_index(parent->dev, "clock-output-names",
	546	parent->id, &clock_output_name);
	547	if (ret < 0)
	548	return -ENODATA;
	549
	550	/* If this is "ext_gmac", switch to the external clock input */
	551	if (!strcmp(clock_output_name, "ext_gmac")) {
	552	debug("%s: switching GMAC to external clock\n", __func__);
	553	rk_setreg(&cru->clksel_con[43], GMAC_MUX_SEL_EXTCLK);
	554	return 0;
	555	}
	556
	557	return -EINVAL;
	558	}
	559
75b381aa	560	static int __maybe_unused rk3368_clk_set_parent(struct clk clk, struct clk parent)
64a12202 DW	561	{
	562	switch (clk->id) {
	563	case SCLK_MAC:
	564	return rk3368_gmac_set_parent(clk, parent);
	565	}
	566
	567	debug("%s: unsupported clk %ld\n", __func__, clk->id);
	568	return -ENOENT;
	569	}
	570
35a69a3b PT	571	static int rk3368_clk_enable(struct clk *clk)
	572	{
	573	switch (clk->id) {
	574	case SCLK_MAC:
	575	case SCLK_MAC_RX:
	576	case SCLK_MAC_TX:
	577	case SCLK_MACREF:
	578	case SCLK_MACREF_OUT:
	579	case ACLK_GMAC:
	580	case PCLK_GMAC:
	581	/* Required to successfully probe the Designware GMAC driver */
	582	return 0;
	583	}
	584
	585	debug("%s: unsupported clk %ld\n", __func__, clk->id);
	586	return -ENOENT;
	587	}
	588
d1dcf852 AY	589	static struct clk_ops rk3368_clk_ops = {
	590	.get_rate = rk3368_clk_get_rate,
	591	.set_rate = rk3368_clk_set_rate,
75b381aa	592	#if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
64a12202	593	.set_parent = rk3368_clk_set_parent,
75b381aa	594	#endif
35a69a3b	595	.enable = rk3368_clk_enable,
d1dcf852 AY	596	};
	597
	598	static int rk3368_clk_probe(struct udevice *dev)
	599	{
4bebf94e	600	struct rk3368_clk_priv __maybe_unused *priv = dev_get_priv(dev);
bee61801 PT	601	#if CONFIG_IS_ENABLED(OF_PLATDATA)
bee61801 PT	602	struct rk3368_clk_plat *plat = dev_get_platdata(dev);
d1dcf852	603
c20ee0ed	604	priv->cru = map_sysmem(plat->dtd.reg[0], plat->dtd.reg[1]);
bee61801	605	#endif
4bebf94e	606	#if IS_ENABLED(CONFIG_SPL_BUILD) \|\| IS_ENABLED(CONFIG_TPL_BUILD)
d1dcf852	607	rkclk_init(priv->cru);
4bebf94e	608	#endif
d1dcf852 AY	609
	610	return 0;
	611	}
	612
	613	static int rk3368_clk_ofdata_to_platdata(struct udevice *dev)
	614	{
bee61801	615	#if !CONFIG_IS_ENABLED(OF_PLATDATA)
d1dcf852 AY	616	struct rk3368_clk_priv *priv = dev_get_priv(dev);
d1dcf852 AY	617
9a342f48	618	priv->cru = dev_read_addr_ptr(dev);
bee61801	619	#endif
d1dcf852 AY	620
	621	return 0;
	622	}
	623
	624	static int rk3368_clk_bind(struct udevice *dev)
	625	{
	626	int ret;
f24e36da KY	627	struct udevice *sys_child;
f24e36da KY	628	struct sysreset_reg *priv;
d1dcf852 AY	629
d1dcf852 AY	630	/* The reset driver does not have a device node, so bind it here */
f24e36da KY	631	ret = device_bind_driver(dev, "rockchip_sysreset", "sysreset",
	632	&sys_child);
	633	if (ret) {
	634	debug("Warning: No sysreset driver: ret=%d\n", ret);
	635	} else {
	636	priv = malloc(sizeof(struct sysreset_reg));
	637	priv->glb_srst_fst_value = offsetof(struct rk3368_cru,
	638	glb_srst_fst_val);
	639	priv->glb_srst_snd_value = offsetof(struct rk3368_cru,
	640	glb_srst_snd_val);
	641	sys_child->priv = priv;
	642	}
d1dcf852	643
538f67c3 EZ	644	#if CONFIG_IS_ENABLED(CONFIG_RESET_ROCKCHIP)
	645	ret = offsetof(struct rk3368_cru, softrst_con[0]);
	646	ret = rockchip_reset_bind(dev, ret, 15);
	647	if (ret)
	648	debug("Warning: software reset driver bind faile\n");
	649	#endif
	650
d1dcf852 AY	651	return ret;
	652	}
	653
	654	static const struct udevice_id rk3368_clk_ids[] = {
	655	{ .compatible = "rockchip,rk3368-cru" },
	656	{ }
	657	};
	658
	659	U_BOOT_DRIVER(rockchip_rk3368_cru) = {
	660	.name = "rockchip_rk3368_cru",
	661	.id = UCLASS_CLK,
	662	.of_match = rk3368_clk_ids,
cdc6080a	663	.priv_auto_alloc_size = sizeof(struct rk3368_clk_priv),
bee61801 PT	664	#if CONFIG_IS_ENABLED(OF_PLATDATA)
	665	.platdata_auto_alloc_size = sizeof(struct rk3368_clk_plat),
	666	#endif
d1dcf852 AY	667	.ofdata_to_platdata = rk3368_clk_ofdata_to_platdata,
	668	.ops = &rk3368_clk_ops,
	669	.bind = rk3368_clk_bind,
	670	.probe = rk3368_clk_probe,
	671	};