162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci *  Copyright (C) 2011-2012 John Crispin <john@phrozen.org>
562306a36Sopenharmony_ci *  Copyright (C) 2013-2015 Lantiq Beteiligungs-GmbH & Co.KG
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/ioport.h>
962306a36Sopenharmony_ci#include <linux/export.h>
1062306a36Sopenharmony_ci#include <linux/clkdev.h>
1162306a36Sopenharmony_ci#include <linux/spinlock.h>
1262306a36Sopenharmony_ci#include <linux/of.h>
1362306a36Sopenharmony_ci#include <linux/of_address.h>
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#include <lantiq_soc.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#include "../clk.h"
1862306a36Sopenharmony_ci#include "../prom.h"
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci/* clock control register for legacy */
2162306a36Sopenharmony_ci#define CGU_IFCCR	0x0018
2262306a36Sopenharmony_ci#define CGU_IFCCR_VR9	0x0024
2362306a36Sopenharmony_ci/* system clock register for legacy */
2462306a36Sopenharmony_ci#define CGU_SYS		0x0010
2562306a36Sopenharmony_ci/* pci control register */
2662306a36Sopenharmony_ci#define CGU_PCICR	0x0034
2762306a36Sopenharmony_ci#define CGU_PCICR_VR9	0x0038
2862306a36Sopenharmony_ci/* ephy configuration register */
2962306a36Sopenharmony_ci#define CGU_EPHY	0x10
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci/* Legacy PMU register for ar9, ase, danube */
3262306a36Sopenharmony_ci/* power control register */
3362306a36Sopenharmony_ci#define PMU_PWDCR	0x1C
3462306a36Sopenharmony_ci/* power status register */
3562306a36Sopenharmony_ci#define PMU_PWDSR	0x20
3662306a36Sopenharmony_ci/* power control register */
3762306a36Sopenharmony_ci#define PMU_PWDCR1	0x24
3862306a36Sopenharmony_ci/* power status register */
3962306a36Sopenharmony_ci#define PMU_PWDSR1	0x28
4062306a36Sopenharmony_ci/* power control register */
4162306a36Sopenharmony_ci#define PWDCR(x) ((x) ? (PMU_PWDCR1) : (PMU_PWDCR))
4262306a36Sopenharmony_ci/* power status register */
4362306a36Sopenharmony_ci#define PWDSR(x) ((x) ? (PMU_PWDSR1) : (PMU_PWDSR))
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci/* PMU register for ar10 and grx390 */
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci/* First register set */
4962306a36Sopenharmony_ci#define PMU_CLK_SR	0x20 /* status */
5062306a36Sopenharmony_ci#define PMU_CLK_CR_A	0x24 /* Enable */
5162306a36Sopenharmony_ci#define PMU_CLK_CR_B	0x28 /* Disable */
5262306a36Sopenharmony_ci/* Second register set */
5362306a36Sopenharmony_ci#define PMU_CLK_SR1	0x30 /* status */
5462306a36Sopenharmony_ci#define PMU_CLK_CR1_A	0x34 /* Enable */
5562306a36Sopenharmony_ci#define PMU_CLK_CR1_B	0x38 /* Disable */
5662306a36Sopenharmony_ci/* Third register set */
5762306a36Sopenharmony_ci#define PMU_ANA_SR	0x40 /* status */
5862306a36Sopenharmony_ci#define PMU_ANA_CR_A	0x44 /* Enable */
5962306a36Sopenharmony_ci#define PMU_ANA_CR_B	0x48 /* Disable */
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_ci/* Status */
6262306a36Sopenharmony_cistatic u32 pmu_clk_sr[] = {
6362306a36Sopenharmony_ci	PMU_CLK_SR,
6462306a36Sopenharmony_ci	PMU_CLK_SR1,
6562306a36Sopenharmony_ci	PMU_ANA_SR,
6662306a36Sopenharmony_ci};
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_ci/* Enable */
6962306a36Sopenharmony_cistatic u32 pmu_clk_cr_a[] = {
7062306a36Sopenharmony_ci	PMU_CLK_CR_A,
7162306a36Sopenharmony_ci	PMU_CLK_CR1_A,
7262306a36Sopenharmony_ci	PMU_ANA_CR_A,
7362306a36Sopenharmony_ci};
7462306a36Sopenharmony_ci
7562306a36Sopenharmony_ci/* Disable */
7662306a36Sopenharmony_cistatic u32 pmu_clk_cr_b[] = {
7762306a36Sopenharmony_ci	PMU_CLK_CR_B,
7862306a36Sopenharmony_ci	PMU_CLK_CR1_B,
7962306a36Sopenharmony_ci	PMU_ANA_CR_B,
8062306a36Sopenharmony_ci};
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci#define PWDCR_EN_XRX(x)		(pmu_clk_cr_a[(x)])
8362306a36Sopenharmony_ci#define PWDCR_DIS_XRX(x)	(pmu_clk_cr_b[(x)])
8462306a36Sopenharmony_ci#define PWDSR_XRX(x)		(pmu_clk_sr[(x)])
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci/* clock gates that we can en/disable */
8762306a36Sopenharmony_ci#define PMU_USB0_P	BIT(0)
8862306a36Sopenharmony_ci#define PMU_ASE_SDIO	BIT(2) /* ASE special */
8962306a36Sopenharmony_ci#define PMU_PCI		BIT(4)
9062306a36Sopenharmony_ci#define PMU_DMA		BIT(5)
9162306a36Sopenharmony_ci#define PMU_USB0	BIT(6)
9262306a36Sopenharmony_ci#define PMU_ASC0	BIT(7)
9362306a36Sopenharmony_ci#define PMU_EPHY	BIT(7)	/* ase */
9462306a36Sopenharmony_ci#define PMU_USIF	BIT(7) /* from vr9 until grx390 */
9562306a36Sopenharmony_ci#define PMU_SPI		BIT(8)
9662306a36Sopenharmony_ci#define PMU_DFE		BIT(9)
9762306a36Sopenharmony_ci#define PMU_EBU		BIT(10)
9862306a36Sopenharmony_ci#define PMU_STP		BIT(11)
9962306a36Sopenharmony_ci#define PMU_GPT		BIT(12)
10062306a36Sopenharmony_ci#define PMU_AHBS	BIT(13) /* vr9 */
10162306a36Sopenharmony_ci#define PMU_FPI		BIT(14)
10262306a36Sopenharmony_ci#define PMU_AHBM	BIT(15)
10362306a36Sopenharmony_ci#define PMU_SDIO	BIT(16) /* danube, ar9, vr9 */
10462306a36Sopenharmony_ci#define PMU_ASC1	BIT(17)
10562306a36Sopenharmony_ci#define PMU_PPE_QSB	BIT(18)
10662306a36Sopenharmony_ci#define PMU_PPE_SLL01	BIT(19)
10762306a36Sopenharmony_ci#define PMU_DEU		BIT(20)
10862306a36Sopenharmony_ci#define PMU_PPE_TC	BIT(21)
10962306a36Sopenharmony_ci#define PMU_PPE_EMA	BIT(22)
11062306a36Sopenharmony_ci#define PMU_PPE_DPLUM	BIT(23)
11162306a36Sopenharmony_ci#define PMU_PPE_DP	BIT(23)
11262306a36Sopenharmony_ci#define PMU_PPE_DPLUS	BIT(24)
11362306a36Sopenharmony_ci#define PMU_USB1_P	BIT(26)
11462306a36Sopenharmony_ci#define PMU_GPHY3	BIT(26) /* grx390 */
11562306a36Sopenharmony_ci#define PMU_USB1	BIT(27)
11662306a36Sopenharmony_ci#define PMU_SWITCH	BIT(28)
11762306a36Sopenharmony_ci#define PMU_PPE_TOP	BIT(29)
11862306a36Sopenharmony_ci#define PMU_GPHY0	BIT(29) /* ar10, xrx390 */
11962306a36Sopenharmony_ci#define PMU_GPHY	BIT(30)
12062306a36Sopenharmony_ci#define PMU_GPHY1	BIT(30) /* ar10, xrx390 */
12162306a36Sopenharmony_ci#define PMU_PCIE_CLK	BIT(31)
12262306a36Sopenharmony_ci#define PMU_GPHY2	BIT(31) /* ar10, xrx390 */
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci#define PMU1_PCIE_PHY	BIT(0)	/* vr9-specific,moved in ar10/grx390 */
12562306a36Sopenharmony_ci#define PMU1_PCIE_CTL	BIT(1)
12662306a36Sopenharmony_ci#define PMU1_PCIE_PDI	BIT(4)
12762306a36Sopenharmony_ci#define PMU1_PCIE_MSI	BIT(5)
12862306a36Sopenharmony_ci#define PMU1_CKE	BIT(6)
12962306a36Sopenharmony_ci#define PMU1_PCIE1_CTL	BIT(17)
13062306a36Sopenharmony_ci#define PMU1_PCIE1_PDI	BIT(20)
13162306a36Sopenharmony_ci#define PMU1_PCIE1_MSI	BIT(21)
13262306a36Sopenharmony_ci#define PMU1_PCIE2_CTL	BIT(25)
13362306a36Sopenharmony_ci#define PMU1_PCIE2_PDI	BIT(26)
13462306a36Sopenharmony_ci#define PMU1_PCIE2_MSI	BIT(27)
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci#define PMU_ANALOG_USB0_P	BIT(0)
13762306a36Sopenharmony_ci#define PMU_ANALOG_USB1_P	BIT(1)
13862306a36Sopenharmony_ci#define PMU_ANALOG_PCIE0_P	BIT(8)
13962306a36Sopenharmony_ci#define PMU_ANALOG_PCIE1_P	BIT(9)
14062306a36Sopenharmony_ci#define PMU_ANALOG_PCIE2_P	BIT(10)
14162306a36Sopenharmony_ci#define PMU_ANALOG_DSL_AFE	BIT(16)
14262306a36Sopenharmony_ci#define PMU_ANALOG_DCDC_2V5	BIT(17)
14362306a36Sopenharmony_ci#define PMU_ANALOG_DCDC_1VX	BIT(18)
14462306a36Sopenharmony_ci#define PMU_ANALOG_DCDC_1V0	BIT(19)
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_ci#define pmu_w32(x, y)	ltq_w32((x), pmu_membase + (y))
14762306a36Sopenharmony_ci#define pmu_r32(x)	ltq_r32(pmu_membase + (x))
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_cistatic void __iomem *pmu_membase;
15062306a36Sopenharmony_civoid __iomem *ltq_cgu_membase;
15162306a36Sopenharmony_civoid __iomem *ltq_ebu_membase;
15262306a36Sopenharmony_ci
15362306a36Sopenharmony_cistatic u32 ifccr = CGU_IFCCR;
15462306a36Sopenharmony_cistatic u32 pcicr = CGU_PCICR;
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_cistatic DEFINE_SPINLOCK(g_pmu_lock);
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci/* legacy function kept alive to ease clkdev transition */
15962306a36Sopenharmony_civoid ltq_pmu_enable(unsigned int module)
16062306a36Sopenharmony_ci{
16162306a36Sopenharmony_ci	int retry = 1000000;
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci	spin_lock(&g_pmu_lock);
16462306a36Sopenharmony_ci	pmu_w32(pmu_r32(PMU_PWDCR) & ~module, PMU_PWDCR);
16562306a36Sopenharmony_ci	do {} while (--retry && (pmu_r32(PMU_PWDSR) & module));
16662306a36Sopenharmony_ci	spin_unlock(&g_pmu_lock);
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci	if (!retry)
16962306a36Sopenharmony_ci		panic("activating PMU module failed!");
17062306a36Sopenharmony_ci}
17162306a36Sopenharmony_ciEXPORT_SYMBOL(ltq_pmu_enable);
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci/* legacy function kept alive to ease clkdev transition */
17462306a36Sopenharmony_civoid ltq_pmu_disable(unsigned int module)
17562306a36Sopenharmony_ci{
17662306a36Sopenharmony_ci	int retry = 1000000;
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci	spin_lock(&g_pmu_lock);
17962306a36Sopenharmony_ci	pmu_w32(pmu_r32(PMU_PWDCR) | module, PMU_PWDCR);
18062306a36Sopenharmony_ci	do {} while (--retry && (!(pmu_r32(PMU_PWDSR) & module)));
18162306a36Sopenharmony_ci	spin_unlock(&g_pmu_lock);
18262306a36Sopenharmony_ci
18362306a36Sopenharmony_ci	if (!retry)
18462306a36Sopenharmony_ci		pr_warn("deactivating PMU module failed!");
18562306a36Sopenharmony_ci}
18662306a36Sopenharmony_ciEXPORT_SYMBOL(ltq_pmu_disable);
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci/* enable a hw clock */
18962306a36Sopenharmony_cistatic int cgu_enable(struct clk *clk)
19062306a36Sopenharmony_ci{
19162306a36Sopenharmony_ci	ltq_cgu_w32(ltq_cgu_r32(ifccr) | clk->bits, ifccr);
19262306a36Sopenharmony_ci	return 0;
19362306a36Sopenharmony_ci}
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_ci/* disable a hw clock */
19662306a36Sopenharmony_cistatic void cgu_disable(struct clk *clk)
19762306a36Sopenharmony_ci{
19862306a36Sopenharmony_ci	ltq_cgu_w32(ltq_cgu_r32(ifccr) & ~clk->bits, ifccr);
19962306a36Sopenharmony_ci}
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_ci/* enable a clock gate */
20262306a36Sopenharmony_cistatic int pmu_enable(struct clk *clk)
20362306a36Sopenharmony_ci{
20462306a36Sopenharmony_ci	int retry = 1000000;
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_ci	if (of_machine_is_compatible("lantiq,ar10")
20762306a36Sopenharmony_ci	    || of_machine_is_compatible("lantiq,grx390")) {
20862306a36Sopenharmony_ci		pmu_w32(clk->bits, PWDCR_EN_XRX(clk->module));
20962306a36Sopenharmony_ci		do {} while (--retry &&
21062306a36Sopenharmony_ci			     (!(pmu_r32(PWDSR_XRX(clk->module)) & clk->bits)));
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_ci	} else {
21362306a36Sopenharmony_ci		spin_lock(&g_pmu_lock);
21462306a36Sopenharmony_ci		pmu_w32(pmu_r32(PWDCR(clk->module)) & ~clk->bits,
21562306a36Sopenharmony_ci				PWDCR(clk->module));
21662306a36Sopenharmony_ci		do {} while (--retry &&
21762306a36Sopenharmony_ci			     (pmu_r32(PWDSR(clk->module)) & clk->bits));
21862306a36Sopenharmony_ci		spin_unlock(&g_pmu_lock);
21962306a36Sopenharmony_ci	}
22062306a36Sopenharmony_ci
22162306a36Sopenharmony_ci	if (!retry)
22262306a36Sopenharmony_ci		panic("activating PMU module failed!");
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_ci	return 0;
22562306a36Sopenharmony_ci}
22662306a36Sopenharmony_ci
22762306a36Sopenharmony_ci/* disable a clock gate */
22862306a36Sopenharmony_cistatic void pmu_disable(struct clk *clk)
22962306a36Sopenharmony_ci{
23062306a36Sopenharmony_ci	int retry = 1000000;
23162306a36Sopenharmony_ci
23262306a36Sopenharmony_ci	if (of_machine_is_compatible("lantiq,ar10")
23362306a36Sopenharmony_ci	    || of_machine_is_compatible("lantiq,grx390")) {
23462306a36Sopenharmony_ci		pmu_w32(clk->bits, PWDCR_DIS_XRX(clk->module));
23562306a36Sopenharmony_ci		do {} while (--retry &&
23662306a36Sopenharmony_ci			     (pmu_r32(PWDSR_XRX(clk->module)) & clk->bits));
23762306a36Sopenharmony_ci	} else {
23862306a36Sopenharmony_ci		spin_lock(&g_pmu_lock);
23962306a36Sopenharmony_ci		pmu_w32(pmu_r32(PWDCR(clk->module)) | clk->bits,
24062306a36Sopenharmony_ci				PWDCR(clk->module));
24162306a36Sopenharmony_ci		do {} while (--retry &&
24262306a36Sopenharmony_ci			     (!(pmu_r32(PWDSR(clk->module)) & clk->bits)));
24362306a36Sopenharmony_ci		spin_unlock(&g_pmu_lock);
24462306a36Sopenharmony_ci	}
24562306a36Sopenharmony_ci
24662306a36Sopenharmony_ci	if (!retry)
24762306a36Sopenharmony_ci		pr_warn("deactivating PMU module failed!");
24862306a36Sopenharmony_ci}
24962306a36Sopenharmony_ci
25062306a36Sopenharmony_ci/* the pci enable helper */
25162306a36Sopenharmony_cistatic int pci_enable(struct clk *clk)
25262306a36Sopenharmony_ci{
25362306a36Sopenharmony_ci	unsigned int val = ltq_cgu_r32(ifccr);
25462306a36Sopenharmony_ci	/* set bus clock speed */
25562306a36Sopenharmony_ci	if (of_machine_is_compatible("lantiq,ar9") ||
25662306a36Sopenharmony_ci			of_machine_is_compatible("lantiq,vr9")) {
25762306a36Sopenharmony_ci		val &= ~0x1f00000;
25862306a36Sopenharmony_ci		if (clk->rate == CLOCK_33M)
25962306a36Sopenharmony_ci			val |= 0xe00000;
26062306a36Sopenharmony_ci		else
26162306a36Sopenharmony_ci			val |= 0x700000; /* 62.5M */
26262306a36Sopenharmony_ci	} else {
26362306a36Sopenharmony_ci		val &= ~0xf00000;
26462306a36Sopenharmony_ci		if (clk->rate == CLOCK_33M)
26562306a36Sopenharmony_ci			val |= 0x800000;
26662306a36Sopenharmony_ci		else
26762306a36Sopenharmony_ci			val |= 0x400000; /* 62.5M */
26862306a36Sopenharmony_ci	}
26962306a36Sopenharmony_ci	ltq_cgu_w32(val, ifccr);
27062306a36Sopenharmony_ci	pmu_enable(clk);
27162306a36Sopenharmony_ci	return 0;
27262306a36Sopenharmony_ci}
27362306a36Sopenharmony_ci
27462306a36Sopenharmony_ci/* enable the external clock as a source */
27562306a36Sopenharmony_cistatic int pci_ext_enable(struct clk *clk)
27662306a36Sopenharmony_ci{
27762306a36Sopenharmony_ci	ltq_cgu_w32(ltq_cgu_r32(ifccr) & ~(1 << 16), ifccr);
27862306a36Sopenharmony_ci	ltq_cgu_w32((1 << 30), pcicr);
27962306a36Sopenharmony_ci	return 0;
28062306a36Sopenharmony_ci}
28162306a36Sopenharmony_ci
28262306a36Sopenharmony_ci/* disable the external clock as a source */
28362306a36Sopenharmony_cistatic void pci_ext_disable(struct clk *clk)
28462306a36Sopenharmony_ci{
28562306a36Sopenharmony_ci	ltq_cgu_w32(ltq_cgu_r32(ifccr) | (1 << 16), ifccr);
28662306a36Sopenharmony_ci	ltq_cgu_w32((1 << 31) | (1 << 30), pcicr);
28762306a36Sopenharmony_ci}
28862306a36Sopenharmony_ci
28962306a36Sopenharmony_ci/* enable a clockout source */
29062306a36Sopenharmony_cistatic int clkout_enable(struct clk *clk)
29162306a36Sopenharmony_ci{
29262306a36Sopenharmony_ci	int i;
29362306a36Sopenharmony_ci
29462306a36Sopenharmony_ci	/* get the correct rate */
29562306a36Sopenharmony_ci	for (i = 0; i < 4; i++) {
29662306a36Sopenharmony_ci		if (clk->rates[i] == clk->rate) {
29762306a36Sopenharmony_ci			int shift = 14 - (2 * clk->module);
29862306a36Sopenharmony_ci			int enable = 7 - clk->module;
29962306a36Sopenharmony_ci			unsigned int val = ltq_cgu_r32(ifccr);
30062306a36Sopenharmony_ci
30162306a36Sopenharmony_ci			val &= ~(3 << shift);
30262306a36Sopenharmony_ci			val |= i << shift;
30362306a36Sopenharmony_ci			val |= enable;
30462306a36Sopenharmony_ci			ltq_cgu_w32(val, ifccr);
30562306a36Sopenharmony_ci			return 0;
30662306a36Sopenharmony_ci		}
30762306a36Sopenharmony_ci	}
30862306a36Sopenharmony_ci	return -1;
30962306a36Sopenharmony_ci}
31062306a36Sopenharmony_ci
31162306a36Sopenharmony_ci/* manage the clock gates via PMU */
31262306a36Sopenharmony_cistatic void clkdev_add_pmu(const char *dev, const char *con, bool deactivate,
31362306a36Sopenharmony_ci			   unsigned int module, unsigned int bits)
31462306a36Sopenharmony_ci{
31562306a36Sopenharmony_ci	struct clk *clk = kzalloc(sizeof(struct clk), GFP_KERNEL);
31662306a36Sopenharmony_ci
31762306a36Sopenharmony_ci	if (!clk)
31862306a36Sopenharmony_ci		return;
31962306a36Sopenharmony_ci	clk->cl.dev_id = dev;
32062306a36Sopenharmony_ci	clk->cl.con_id = con;
32162306a36Sopenharmony_ci	clk->cl.clk = clk;
32262306a36Sopenharmony_ci	clk->enable = pmu_enable;
32362306a36Sopenharmony_ci	clk->disable = pmu_disable;
32462306a36Sopenharmony_ci	clk->module = module;
32562306a36Sopenharmony_ci	clk->bits = bits;
32662306a36Sopenharmony_ci	if (deactivate) {
32762306a36Sopenharmony_ci		/*
32862306a36Sopenharmony_ci		 * Disable it during the initialization. Module should enable
32962306a36Sopenharmony_ci		 * when used
33062306a36Sopenharmony_ci		 */
33162306a36Sopenharmony_ci		pmu_disable(clk);
33262306a36Sopenharmony_ci	}
33362306a36Sopenharmony_ci	clkdev_add(&clk->cl);
33462306a36Sopenharmony_ci}
33562306a36Sopenharmony_ci
33662306a36Sopenharmony_ci/* manage the clock generator */
33762306a36Sopenharmony_cistatic void clkdev_add_cgu(const char *dev, const char *con,
33862306a36Sopenharmony_ci					unsigned int bits)
33962306a36Sopenharmony_ci{
34062306a36Sopenharmony_ci	struct clk *clk = kzalloc(sizeof(struct clk), GFP_KERNEL);
34162306a36Sopenharmony_ci
34262306a36Sopenharmony_ci	if (!clk)
34362306a36Sopenharmony_ci		return;
34462306a36Sopenharmony_ci	clk->cl.dev_id = dev;
34562306a36Sopenharmony_ci	clk->cl.con_id = con;
34662306a36Sopenharmony_ci	clk->cl.clk = clk;
34762306a36Sopenharmony_ci	clk->enable = cgu_enable;
34862306a36Sopenharmony_ci	clk->disable = cgu_disable;
34962306a36Sopenharmony_ci	clk->bits = bits;
35062306a36Sopenharmony_ci	clkdev_add(&clk->cl);
35162306a36Sopenharmony_ci}
35262306a36Sopenharmony_ci
35362306a36Sopenharmony_ci/* pci needs its own enable function as the setup is a bit more complex */
35462306a36Sopenharmony_cistatic unsigned long valid_pci_rates[] = {CLOCK_33M, CLOCK_62_5M, 0};
35562306a36Sopenharmony_ci
35662306a36Sopenharmony_cistatic void clkdev_add_pci(void)
35762306a36Sopenharmony_ci{
35862306a36Sopenharmony_ci	struct clk *clk = kzalloc(sizeof(struct clk), GFP_KERNEL);
35962306a36Sopenharmony_ci	struct clk *clk_ext = kzalloc(sizeof(struct clk), GFP_KERNEL);
36062306a36Sopenharmony_ci
36162306a36Sopenharmony_ci	/* main pci clock */
36262306a36Sopenharmony_ci	if (clk) {
36362306a36Sopenharmony_ci		clk->cl.dev_id = "17000000.pci";
36462306a36Sopenharmony_ci		clk->cl.con_id = NULL;
36562306a36Sopenharmony_ci		clk->cl.clk = clk;
36662306a36Sopenharmony_ci		clk->rate = CLOCK_33M;
36762306a36Sopenharmony_ci		clk->rates = valid_pci_rates;
36862306a36Sopenharmony_ci		clk->enable = pci_enable;
36962306a36Sopenharmony_ci		clk->disable = pmu_disable;
37062306a36Sopenharmony_ci		clk->module = 0;
37162306a36Sopenharmony_ci		clk->bits = PMU_PCI;
37262306a36Sopenharmony_ci		clkdev_add(&clk->cl);
37362306a36Sopenharmony_ci	}
37462306a36Sopenharmony_ci
37562306a36Sopenharmony_ci	/* use internal/external bus clock */
37662306a36Sopenharmony_ci	if (clk_ext) {
37762306a36Sopenharmony_ci		clk_ext->cl.dev_id = "17000000.pci";
37862306a36Sopenharmony_ci		clk_ext->cl.con_id = "external";
37962306a36Sopenharmony_ci		clk_ext->cl.clk = clk_ext;
38062306a36Sopenharmony_ci		clk_ext->enable = pci_ext_enable;
38162306a36Sopenharmony_ci		clk_ext->disable = pci_ext_disable;
38262306a36Sopenharmony_ci		clkdev_add(&clk_ext->cl);
38362306a36Sopenharmony_ci	}
38462306a36Sopenharmony_ci}
38562306a36Sopenharmony_ci
38662306a36Sopenharmony_ci/* xway socs can generate clocks on gpio pins */
38762306a36Sopenharmony_cistatic unsigned long valid_clkout_rates[4][5] = {
38862306a36Sopenharmony_ci	{CLOCK_32_768K, CLOCK_1_536M, CLOCK_2_5M, CLOCK_12M, 0},
38962306a36Sopenharmony_ci	{CLOCK_40M, CLOCK_12M, CLOCK_24M, CLOCK_48M, 0},
39062306a36Sopenharmony_ci	{CLOCK_25M, CLOCK_40M, CLOCK_30M, CLOCK_60M, 0},
39162306a36Sopenharmony_ci	{CLOCK_12M, CLOCK_50M, CLOCK_32_768K, CLOCK_25M, 0},
39262306a36Sopenharmony_ci};
39362306a36Sopenharmony_ci
39462306a36Sopenharmony_cistatic void clkdev_add_clkout(void)
39562306a36Sopenharmony_ci{
39662306a36Sopenharmony_ci	int i;
39762306a36Sopenharmony_ci
39862306a36Sopenharmony_ci	for (i = 0; i < 4; i++) {
39962306a36Sopenharmony_ci		struct clk *clk;
40062306a36Sopenharmony_ci		char *name;
40162306a36Sopenharmony_ci
40262306a36Sopenharmony_ci		name = kzalloc(sizeof("clkout0"), GFP_KERNEL);
40362306a36Sopenharmony_ci		if (!name)
40462306a36Sopenharmony_ci			continue;
40562306a36Sopenharmony_ci		sprintf(name, "clkout%d", i);
40662306a36Sopenharmony_ci
40762306a36Sopenharmony_ci		clk = kzalloc(sizeof(struct clk), GFP_KERNEL);
40862306a36Sopenharmony_ci		if (!clk) {
40962306a36Sopenharmony_ci			kfree(name);
41062306a36Sopenharmony_ci			continue;
41162306a36Sopenharmony_ci		}
41262306a36Sopenharmony_ci		clk->cl.dev_id = "1f103000.cgu";
41362306a36Sopenharmony_ci		clk->cl.con_id = name;
41462306a36Sopenharmony_ci		clk->cl.clk = clk;
41562306a36Sopenharmony_ci		clk->rate = 0;
41662306a36Sopenharmony_ci		clk->rates = valid_clkout_rates[i];
41762306a36Sopenharmony_ci		clk->enable = clkout_enable;
41862306a36Sopenharmony_ci		clk->module = i;
41962306a36Sopenharmony_ci		clkdev_add(&clk->cl);
42062306a36Sopenharmony_ci	}
42162306a36Sopenharmony_ci}
42262306a36Sopenharmony_ci
42362306a36Sopenharmony_ci/* bring up all register ranges that we need for basic system control */
42462306a36Sopenharmony_civoid __init ltq_soc_init(void)
42562306a36Sopenharmony_ci{
42662306a36Sopenharmony_ci	struct resource res_pmu, res_cgu, res_ebu;
42762306a36Sopenharmony_ci	struct device_node *np_pmu =
42862306a36Sopenharmony_ci			of_find_compatible_node(NULL, NULL, "lantiq,pmu-xway");
42962306a36Sopenharmony_ci	struct device_node *np_cgu =
43062306a36Sopenharmony_ci			of_find_compatible_node(NULL, NULL, "lantiq,cgu-xway");
43162306a36Sopenharmony_ci	struct device_node *np_ebu =
43262306a36Sopenharmony_ci			of_find_compatible_node(NULL, NULL, "lantiq,ebu-xway");
43362306a36Sopenharmony_ci
43462306a36Sopenharmony_ci	/* check if all the core register ranges are available */
43562306a36Sopenharmony_ci	if (!np_pmu || !np_cgu || !np_ebu)
43662306a36Sopenharmony_ci		panic("Failed to load core nodes from devicetree");
43762306a36Sopenharmony_ci
43862306a36Sopenharmony_ci	if (of_address_to_resource(np_pmu, 0, &res_pmu) ||
43962306a36Sopenharmony_ci			of_address_to_resource(np_cgu, 0, &res_cgu) ||
44062306a36Sopenharmony_ci			of_address_to_resource(np_ebu, 0, &res_ebu))
44162306a36Sopenharmony_ci		panic("Failed to get core resources");
44262306a36Sopenharmony_ci
44362306a36Sopenharmony_ci	of_node_put(np_pmu);
44462306a36Sopenharmony_ci	of_node_put(np_cgu);
44562306a36Sopenharmony_ci	of_node_put(np_ebu);
44662306a36Sopenharmony_ci
44762306a36Sopenharmony_ci	if (!request_mem_region(res_pmu.start, resource_size(&res_pmu),
44862306a36Sopenharmony_ci				res_pmu.name) ||
44962306a36Sopenharmony_ci		!request_mem_region(res_cgu.start, resource_size(&res_cgu),
45062306a36Sopenharmony_ci				res_cgu.name) ||
45162306a36Sopenharmony_ci		!request_mem_region(res_ebu.start, resource_size(&res_ebu),
45262306a36Sopenharmony_ci				res_ebu.name))
45362306a36Sopenharmony_ci		pr_err("Failed to request core resources");
45462306a36Sopenharmony_ci
45562306a36Sopenharmony_ci	pmu_membase = ioremap(res_pmu.start, resource_size(&res_pmu));
45662306a36Sopenharmony_ci	ltq_cgu_membase = ioremap(res_cgu.start,
45762306a36Sopenharmony_ci						resource_size(&res_cgu));
45862306a36Sopenharmony_ci	ltq_ebu_membase = ioremap(res_ebu.start,
45962306a36Sopenharmony_ci						resource_size(&res_ebu));
46062306a36Sopenharmony_ci	if (!pmu_membase || !ltq_cgu_membase || !ltq_ebu_membase)
46162306a36Sopenharmony_ci		panic("Failed to remap core resources");
46262306a36Sopenharmony_ci
46362306a36Sopenharmony_ci	/* make sure to unprotect the memory region where flash is located */
46462306a36Sopenharmony_ci	ltq_ebu_w32(ltq_ebu_r32(LTQ_EBU_BUSCON0) & ~EBU_WRDIS, LTQ_EBU_BUSCON0);
46562306a36Sopenharmony_ci
46662306a36Sopenharmony_ci	/* add our generic xway clocks */
46762306a36Sopenharmony_ci	clkdev_add_pmu("10000000.fpi", NULL, 0, 0, PMU_FPI);
46862306a36Sopenharmony_ci	clkdev_add_pmu("1e100a00.gptu", NULL, 1, 0, PMU_GPT);
46962306a36Sopenharmony_ci	clkdev_add_pmu("1e100bb0.stp", NULL, 1, 0, PMU_STP);
47062306a36Sopenharmony_ci	clkdev_add_pmu("1e100c00.serial", NULL, 0, 0, PMU_ASC1);
47162306a36Sopenharmony_ci	clkdev_add_pmu("1e104100.dma", NULL, 1, 0, PMU_DMA);
47262306a36Sopenharmony_ci	clkdev_add_pmu("1e100800.spi", NULL, 1, 0, PMU_SPI);
47362306a36Sopenharmony_ci	clkdev_add_pmu("1e105300.ebu", NULL, 0, 0, PMU_EBU);
47462306a36Sopenharmony_ci	clkdev_add_clkout();
47562306a36Sopenharmony_ci
47662306a36Sopenharmony_ci	/* add the soc dependent clocks */
47762306a36Sopenharmony_ci	if (of_machine_is_compatible("lantiq,vr9")) {
47862306a36Sopenharmony_ci		ifccr = CGU_IFCCR_VR9;
47962306a36Sopenharmony_ci		pcicr = CGU_PCICR_VR9;
48062306a36Sopenharmony_ci	} else {
48162306a36Sopenharmony_ci		clkdev_add_pmu("1e180000.etop", NULL, 1, 0, PMU_PPE);
48262306a36Sopenharmony_ci	}
48362306a36Sopenharmony_ci
48462306a36Sopenharmony_ci	if (!of_machine_is_compatible("lantiq,ase"))
48562306a36Sopenharmony_ci		clkdev_add_pci();
48662306a36Sopenharmony_ci
48762306a36Sopenharmony_ci	if (of_machine_is_compatible("lantiq,grx390") ||
48862306a36Sopenharmony_ci	    of_machine_is_compatible("lantiq,ar10")) {
48962306a36Sopenharmony_ci		clkdev_add_pmu("1e108000.switch", "gphy0", 0, 0, PMU_GPHY0);
49062306a36Sopenharmony_ci		clkdev_add_pmu("1e108000.switch", "gphy1", 0, 0, PMU_GPHY1);
49162306a36Sopenharmony_ci		clkdev_add_pmu("1e108000.switch", "gphy2", 0, 0, PMU_GPHY2);
49262306a36Sopenharmony_ci		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 2, PMU_ANALOG_USB0_P);
49362306a36Sopenharmony_ci		clkdev_add_pmu("1f203034.usb2-phy", "phy", 1, 2, PMU_ANALOG_USB1_P);
49462306a36Sopenharmony_ci		/* rc 0 */
49562306a36Sopenharmony_ci		clkdev_add_pmu("1f106800.phy", "phy", 1, 2, PMU_ANALOG_PCIE0_P);
49662306a36Sopenharmony_ci		clkdev_add_pmu("1d900000.pcie", "msi", 1, 1, PMU1_PCIE_MSI);
49762306a36Sopenharmony_ci		clkdev_add_pmu("1f106800.phy", "pdi", 1, 1, PMU1_PCIE_PDI);
49862306a36Sopenharmony_ci		clkdev_add_pmu("1d900000.pcie", "ctl", 1, 1, PMU1_PCIE_CTL);
49962306a36Sopenharmony_ci		/* rc 1 */
50062306a36Sopenharmony_ci		clkdev_add_pmu("1f700400.phy", "phy", 1, 2, PMU_ANALOG_PCIE1_P);
50162306a36Sopenharmony_ci		clkdev_add_pmu("19000000.pcie", "msi", 1, 1, PMU1_PCIE1_MSI);
50262306a36Sopenharmony_ci		clkdev_add_pmu("1f700400.phy", "pdi", 1, 1, PMU1_PCIE1_PDI);
50362306a36Sopenharmony_ci		clkdev_add_pmu("19000000.pcie", "ctl", 1, 1, PMU1_PCIE1_CTL);
50462306a36Sopenharmony_ci	}
50562306a36Sopenharmony_ci
50662306a36Sopenharmony_ci	if (of_machine_is_compatible("lantiq,ase")) {
50762306a36Sopenharmony_ci		if (ltq_cgu_r32(CGU_SYS) & (1 << 5))
50862306a36Sopenharmony_ci			clkdev_add_static(CLOCK_266M, CLOCK_133M,
50962306a36Sopenharmony_ci						CLOCK_133M, CLOCK_266M);
51062306a36Sopenharmony_ci		else
51162306a36Sopenharmony_ci			clkdev_add_static(CLOCK_133M, CLOCK_133M,
51262306a36Sopenharmony_ci						CLOCK_133M, CLOCK_133M);
51362306a36Sopenharmony_ci		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0);
51462306a36Sopenharmony_ci		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 0, PMU_USB0_P);
51562306a36Sopenharmony_ci		clkdev_add_pmu("1e180000.etop", "ppe", 1, 0, PMU_PPE);
51662306a36Sopenharmony_ci		clkdev_add_cgu("1e180000.etop", "ephycgu", CGU_EPHY);
51762306a36Sopenharmony_ci		clkdev_add_pmu("1e180000.etop", "ephy", 1, 0, PMU_EPHY);
51862306a36Sopenharmony_ci		clkdev_add_pmu("1e103000.sdio", NULL, 1, 0, PMU_ASE_SDIO);
51962306a36Sopenharmony_ci		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
52062306a36Sopenharmony_ci	} else if (of_machine_is_compatible("lantiq,grx390")) {
52162306a36Sopenharmony_ci		clkdev_add_static(ltq_grx390_cpu_hz(), ltq_grx390_fpi_hz(),
52262306a36Sopenharmony_ci				  ltq_grx390_fpi_hz(), ltq_grx390_pp32_hz());
52362306a36Sopenharmony_ci		clkdev_add_pmu("1e108000.switch", "gphy3", 0, 0, PMU_GPHY3);
52462306a36Sopenharmony_ci		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0);
52562306a36Sopenharmony_ci		clkdev_add_pmu("1e106000.usb", "otg", 1, 0, PMU_USB1);
52662306a36Sopenharmony_ci		/* rc 2 */
52762306a36Sopenharmony_ci		clkdev_add_pmu("1f106a00.pcie", "phy", 1, 2, PMU_ANALOG_PCIE2_P);
52862306a36Sopenharmony_ci		clkdev_add_pmu("1a800000.pcie", "msi", 1, 1, PMU1_PCIE2_MSI);
52962306a36Sopenharmony_ci		clkdev_add_pmu("1f106a00.pcie", "pdi", 1, 1, PMU1_PCIE2_PDI);
53062306a36Sopenharmony_ci		clkdev_add_pmu("1a800000.pcie", "ctl", 1, 1, PMU1_PCIE2_CTL);
53162306a36Sopenharmony_ci		clkdev_add_pmu("1e10b308.eth", NULL, 0, 0, PMU_SWITCH | PMU_PPE_DP);
53262306a36Sopenharmony_ci		clkdev_add_pmu("1da00000.usif", "NULL", 1, 0, PMU_USIF);
53362306a36Sopenharmony_ci		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
53462306a36Sopenharmony_ci	} else if (of_machine_is_compatible("lantiq,ar10")) {
53562306a36Sopenharmony_ci		clkdev_add_static(ltq_ar10_cpu_hz(), ltq_ar10_fpi_hz(),
53662306a36Sopenharmony_ci				  ltq_ar10_fpi_hz(), ltq_ar10_pp32_hz());
53762306a36Sopenharmony_ci		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0);
53862306a36Sopenharmony_ci		clkdev_add_pmu("1e106000.usb", "otg", 1, 0, PMU_USB1);
53962306a36Sopenharmony_ci		clkdev_add_pmu("1e10b308.eth", NULL, 0, 0, PMU_SWITCH |
54062306a36Sopenharmony_ci			       PMU_PPE_DP | PMU_PPE_TC);
54162306a36Sopenharmony_ci		clkdev_add_pmu("1da00000.usif", "NULL", 1, 0, PMU_USIF);
54262306a36Sopenharmony_ci		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
54362306a36Sopenharmony_ci		clkdev_add_pmu("1e116000.mei", "afe", 1, 2, PMU_ANALOG_DSL_AFE);
54462306a36Sopenharmony_ci		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
54562306a36Sopenharmony_ci	} else if (of_machine_is_compatible("lantiq,vr9")) {
54662306a36Sopenharmony_ci		clkdev_add_static(ltq_vr9_cpu_hz(), ltq_vr9_fpi_hz(),
54762306a36Sopenharmony_ci				ltq_vr9_fpi_hz(), ltq_vr9_pp32_hz());
54862306a36Sopenharmony_ci		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 0, PMU_USB0_P);
54962306a36Sopenharmony_ci		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0 | PMU_AHBM);
55062306a36Sopenharmony_ci		clkdev_add_pmu("1f203034.usb2-phy", "phy", 1, 0, PMU_USB1_P);
55162306a36Sopenharmony_ci		clkdev_add_pmu("1e106000.usb", "otg", 1, 0, PMU_USB1 | PMU_AHBM);
55262306a36Sopenharmony_ci		clkdev_add_pmu("1f106800.phy", "phy", 1, 1, PMU1_PCIE_PHY);
55362306a36Sopenharmony_ci		clkdev_add_pmu("1d900000.pcie", "bus", 1, 0, PMU_PCIE_CLK);
55462306a36Sopenharmony_ci		clkdev_add_pmu("1d900000.pcie", "msi", 1, 1, PMU1_PCIE_MSI);
55562306a36Sopenharmony_ci		clkdev_add_pmu("1f106800.phy", "pdi", 1, 1, PMU1_PCIE_PDI);
55662306a36Sopenharmony_ci		clkdev_add_pmu("1d900000.pcie", "ctl", 1, 1, PMU1_PCIE_CTL);
55762306a36Sopenharmony_ci		clkdev_add_pmu(NULL, "ahb", 1, 0, PMU_AHBM | PMU_AHBS);
55862306a36Sopenharmony_ci
55962306a36Sopenharmony_ci		clkdev_add_pmu("1da00000.usif", "NULL", 1, 0, PMU_USIF);
56062306a36Sopenharmony_ci		clkdev_add_pmu("1e10b308.eth", NULL, 0, 0,
56162306a36Sopenharmony_ci				PMU_SWITCH | PMU_PPE_DPLUS | PMU_PPE_DPLUM |
56262306a36Sopenharmony_ci				PMU_PPE_EMA | PMU_PPE_TC | PMU_PPE_SLL01 |
56362306a36Sopenharmony_ci				PMU_PPE_QSB | PMU_PPE_TOP);
56462306a36Sopenharmony_ci		clkdev_add_pmu("1e108000.switch", "gphy0", 0, 0, PMU_GPHY);
56562306a36Sopenharmony_ci		clkdev_add_pmu("1e108000.switch", "gphy1", 0, 0, PMU_GPHY);
56662306a36Sopenharmony_ci		clkdev_add_pmu("1e103000.sdio", NULL, 1, 0, PMU_SDIO);
56762306a36Sopenharmony_ci		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
56862306a36Sopenharmony_ci		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
56962306a36Sopenharmony_ci	} else if (of_machine_is_compatible("lantiq,ar9")) {
57062306a36Sopenharmony_ci		clkdev_add_static(ltq_ar9_cpu_hz(), ltq_ar9_fpi_hz(),
57162306a36Sopenharmony_ci				ltq_ar9_fpi_hz(), CLOCK_250M);
57262306a36Sopenharmony_ci		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 0, PMU_USB0_P);
57362306a36Sopenharmony_ci		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0 | PMU_AHBM);
57462306a36Sopenharmony_ci		clkdev_add_pmu("1f203034.usb2-phy", "phy", 1, 0, PMU_USB1_P);
57562306a36Sopenharmony_ci		clkdev_add_pmu("1e106000.usb", "otg", 1, 0, PMU_USB1 | PMU_AHBM);
57662306a36Sopenharmony_ci		clkdev_add_pmu("1e180000.etop", "switch", 1, 0, PMU_SWITCH);
57762306a36Sopenharmony_ci		clkdev_add_pmu("1e103000.sdio", NULL, 1, 0, PMU_SDIO);
57862306a36Sopenharmony_ci		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
57962306a36Sopenharmony_ci		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
58062306a36Sopenharmony_ci		clkdev_add_pmu("1e100400.serial", NULL, 1, 0, PMU_ASC0);
58162306a36Sopenharmony_ci	} else {
58262306a36Sopenharmony_ci		clkdev_add_static(ltq_danube_cpu_hz(), ltq_danube_fpi_hz(),
58362306a36Sopenharmony_ci				ltq_danube_fpi_hz(), ltq_danube_pp32_hz());
58462306a36Sopenharmony_ci		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0 | PMU_AHBM);
58562306a36Sopenharmony_ci		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 0, PMU_USB0_P);
58662306a36Sopenharmony_ci		clkdev_add_pmu("1e103000.sdio", NULL, 1, 0, PMU_SDIO);
58762306a36Sopenharmony_ci		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
58862306a36Sopenharmony_ci		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
58962306a36Sopenharmony_ci		clkdev_add_pmu("1e100400.serial", NULL, 1, 0, PMU_ASC0);
59062306a36Sopenharmony_ci	}
59162306a36Sopenharmony_ci}
592