xref: /OK3568_Linux_fs/kernel/arch/mips/lantiq/xway/sysctrl.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  *  Copyright (C) 2011-2012 John Crispin <john@phrozen.org>
5*4882a593Smuzhiyun  *  Copyright (C) 2013-2015 Lantiq Beteiligungs-GmbH & Co.KG
6*4882a593Smuzhiyun  */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #include <linux/ioport.h>
9*4882a593Smuzhiyun #include <linux/export.h>
10*4882a593Smuzhiyun #include <linux/clkdev.h>
11*4882a593Smuzhiyun #include <linux/spinlock.h>
12*4882a593Smuzhiyun #include <linux/of.h>
13*4882a593Smuzhiyun #include <linux/of_platform.h>
14*4882a593Smuzhiyun #include <linux/of_address.h>
15*4882a593Smuzhiyun 
16*4882a593Smuzhiyun #include <lantiq_soc.h>
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #include "../clk.h"
19*4882a593Smuzhiyun #include "../prom.h"
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun /* clock control register for legacy */
22*4882a593Smuzhiyun #define CGU_IFCCR	0x0018
23*4882a593Smuzhiyun #define CGU_IFCCR_VR9	0x0024
24*4882a593Smuzhiyun /* system clock register for legacy */
25*4882a593Smuzhiyun #define CGU_SYS		0x0010
26*4882a593Smuzhiyun /* pci control register */
27*4882a593Smuzhiyun #define CGU_PCICR	0x0034
28*4882a593Smuzhiyun #define CGU_PCICR_VR9	0x0038
29*4882a593Smuzhiyun /* ephy configuration register */
30*4882a593Smuzhiyun #define CGU_EPHY	0x10
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun /* Legacy PMU register for ar9, ase, danube */
33*4882a593Smuzhiyun /* power control register */
34*4882a593Smuzhiyun #define PMU_PWDCR	0x1C
35*4882a593Smuzhiyun /* power status register */
36*4882a593Smuzhiyun #define PMU_PWDSR	0x20
37*4882a593Smuzhiyun /* power control register */
38*4882a593Smuzhiyun #define PMU_PWDCR1	0x24
39*4882a593Smuzhiyun /* power status register */
40*4882a593Smuzhiyun #define PMU_PWDSR1	0x28
41*4882a593Smuzhiyun /* power control register */
42*4882a593Smuzhiyun #define PWDCR(x) ((x) ? (PMU_PWDCR1) : (PMU_PWDCR))
43*4882a593Smuzhiyun /* power status register */
44*4882a593Smuzhiyun #define PWDSR(x) ((x) ? (PMU_PWDSR1) : (PMU_PWDSR))
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun /* PMU register for ar10 and grx390 */
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun /* First register set */
50*4882a593Smuzhiyun #define PMU_CLK_SR	0x20 /* status */
51*4882a593Smuzhiyun #define PMU_CLK_CR_A	0x24 /* Enable */
52*4882a593Smuzhiyun #define PMU_CLK_CR_B	0x28 /* Disable */
53*4882a593Smuzhiyun /* Second register set */
54*4882a593Smuzhiyun #define PMU_CLK_SR1	0x30 /* status */
55*4882a593Smuzhiyun #define PMU_CLK_CR1_A	0x34 /* Enable */
56*4882a593Smuzhiyun #define PMU_CLK_CR1_B	0x38 /* Disable */
57*4882a593Smuzhiyun /* Third register set */
58*4882a593Smuzhiyun #define PMU_ANA_SR	0x40 /* status */
59*4882a593Smuzhiyun #define PMU_ANA_CR_A	0x44 /* Enable */
60*4882a593Smuzhiyun #define PMU_ANA_CR_B	0x48 /* Disable */
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun /* Status */
63*4882a593Smuzhiyun static u32 pmu_clk_sr[] = {
64*4882a593Smuzhiyun 	PMU_CLK_SR,
65*4882a593Smuzhiyun 	PMU_CLK_SR1,
66*4882a593Smuzhiyun 	PMU_ANA_SR,
67*4882a593Smuzhiyun };
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun /* Enable */
70*4882a593Smuzhiyun static u32 pmu_clk_cr_a[] = {
71*4882a593Smuzhiyun 	PMU_CLK_CR_A,
72*4882a593Smuzhiyun 	PMU_CLK_CR1_A,
73*4882a593Smuzhiyun 	PMU_ANA_CR_A,
74*4882a593Smuzhiyun };
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun /* Disable */
77*4882a593Smuzhiyun static u32 pmu_clk_cr_b[] = {
78*4882a593Smuzhiyun 	PMU_CLK_CR_B,
79*4882a593Smuzhiyun 	PMU_CLK_CR1_B,
80*4882a593Smuzhiyun 	PMU_ANA_CR_B,
81*4882a593Smuzhiyun };
82*4882a593Smuzhiyun 
83*4882a593Smuzhiyun #define PWDCR_EN_XRX(x)		(pmu_clk_cr_a[(x)])
84*4882a593Smuzhiyun #define PWDCR_DIS_XRX(x)	(pmu_clk_cr_b[(x)])
85*4882a593Smuzhiyun #define PWDSR_XRX(x)		(pmu_clk_sr[(x)])
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun /* clock gates that we can en/disable */
88*4882a593Smuzhiyun #define PMU_USB0_P	BIT(0)
89*4882a593Smuzhiyun #define PMU_ASE_SDIO	BIT(2) /* ASE special */
90*4882a593Smuzhiyun #define PMU_PCI		BIT(4)
91*4882a593Smuzhiyun #define PMU_DMA		BIT(5)
92*4882a593Smuzhiyun #define PMU_USB0	BIT(6)
93*4882a593Smuzhiyun #define PMU_ASC0	BIT(7)
94*4882a593Smuzhiyun #define PMU_EPHY	BIT(7)	/* ase */
95*4882a593Smuzhiyun #define PMU_USIF	BIT(7) /* from vr9 until grx390 */
96*4882a593Smuzhiyun #define PMU_SPI		BIT(8)
97*4882a593Smuzhiyun #define PMU_DFE		BIT(9)
98*4882a593Smuzhiyun #define PMU_EBU		BIT(10)
99*4882a593Smuzhiyun #define PMU_STP		BIT(11)
100*4882a593Smuzhiyun #define PMU_GPT		BIT(12)
101*4882a593Smuzhiyun #define PMU_AHBS	BIT(13) /* vr9 */
102*4882a593Smuzhiyun #define PMU_FPI		BIT(14)
103*4882a593Smuzhiyun #define PMU_AHBM	BIT(15)
104*4882a593Smuzhiyun #define PMU_SDIO	BIT(16) /* danube, ar9, vr9 */
105*4882a593Smuzhiyun #define PMU_ASC1	BIT(17)
106*4882a593Smuzhiyun #define PMU_PPE_QSB	BIT(18)
107*4882a593Smuzhiyun #define PMU_PPE_SLL01	BIT(19)
108*4882a593Smuzhiyun #define PMU_DEU		BIT(20)
109*4882a593Smuzhiyun #define PMU_PPE_TC	BIT(21)
110*4882a593Smuzhiyun #define PMU_PPE_EMA	BIT(22)
111*4882a593Smuzhiyun #define PMU_PPE_DPLUM	BIT(23)
112*4882a593Smuzhiyun #define PMU_PPE_DP	BIT(23)
113*4882a593Smuzhiyun #define PMU_PPE_DPLUS	BIT(24)
114*4882a593Smuzhiyun #define PMU_USB1_P	BIT(26)
115*4882a593Smuzhiyun #define PMU_GPHY3	BIT(26) /* grx390 */
116*4882a593Smuzhiyun #define PMU_USB1	BIT(27)
117*4882a593Smuzhiyun #define PMU_SWITCH	BIT(28)
118*4882a593Smuzhiyun #define PMU_PPE_TOP	BIT(29)
119*4882a593Smuzhiyun #define PMU_GPHY0	BIT(29) /* ar10, xrx390 */
120*4882a593Smuzhiyun #define PMU_GPHY	BIT(30)
121*4882a593Smuzhiyun #define PMU_GPHY1	BIT(30) /* ar10, xrx390 */
122*4882a593Smuzhiyun #define PMU_PCIE_CLK	BIT(31)
123*4882a593Smuzhiyun #define PMU_GPHY2	BIT(31) /* ar10, xrx390 */
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun #define PMU1_PCIE_PHY	BIT(0)	/* vr9-specific,moved in ar10/grx390 */
126*4882a593Smuzhiyun #define PMU1_PCIE_CTL	BIT(1)
127*4882a593Smuzhiyun #define PMU1_PCIE_PDI	BIT(4)
128*4882a593Smuzhiyun #define PMU1_PCIE_MSI	BIT(5)
129*4882a593Smuzhiyun #define PMU1_CKE	BIT(6)
130*4882a593Smuzhiyun #define PMU1_PCIE1_CTL	BIT(17)
131*4882a593Smuzhiyun #define PMU1_PCIE1_PDI	BIT(20)
132*4882a593Smuzhiyun #define PMU1_PCIE1_MSI	BIT(21)
133*4882a593Smuzhiyun #define PMU1_PCIE2_CTL	BIT(25)
134*4882a593Smuzhiyun #define PMU1_PCIE2_PDI	BIT(26)
135*4882a593Smuzhiyun #define PMU1_PCIE2_MSI	BIT(27)
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun #define PMU_ANALOG_USB0_P	BIT(0)
138*4882a593Smuzhiyun #define PMU_ANALOG_USB1_P	BIT(1)
139*4882a593Smuzhiyun #define PMU_ANALOG_PCIE0_P	BIT(8)
140*4882a593Smuzhiyun #define PMU_ANALOG_PCIE1_P	BIT(9)
141*4882a593Smuzhiyun #define PMU_ANALOG_PCIE2_P	BIT(10)
142*4882a593Smuzhiyun #define PMU_ANALOG_DSL_AFE	BIT(16)
143*4882a593Smuzhiyun #define PMU_ANALOG_DCDC_2V5	BIT(17)
144*4882a593Smuzhiyun #define PMU_ANALOG_DCDC_1VX	BIT(18)
145*4882a593Smuzhiyun #define PMU_ANALOG_DCDC_1V0	BIT(19)
146*4882a593Smuzhiyun 
147*4882a593Smuzhiyun #define pmu_w32(x, y)	ltq_w32((x), pmu_membase + (y))
148*4882a593Smuzhiyun #define pmu_r32(x)	ltq_r32(pmu_membase + (x))
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun static void __iomem *pmu_membase;
151*4882a593Smuzhiyun void __iomem *ltq_cgu_membase;
152*4882a593Smuzhiyun void __iomem *ltq_ebu_membase;
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun static u32 ifccr = CGU_IFCCR;
155*4882a593Smuzhiyun static u32 pcicr = CGU_PCICR;
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun static DEFINE_SPINLOCK(g_pmu_lock);
158*4882a593Smuzhiyun 
159*4882a593Smuzhiyun /* legacy function kept alive to ease clkdev transition */
ltq_pmu_enable(unsigned int module)160*4882a593Smuzhiyun void ltq_pmu_enable(unsigned int module)
161*4882a593Smuzhiyun {
162*4882a593Smuzhiyun 	int retry = 1000000;
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 	spin_lock(&g_pmu_lock);
165*4882a593Smuzhiyun 	pmu_w32(pmu_r32(PMU_PWDCR) & ~module, PMU_PWDCR);
166*4882a593Smuzhiyun 	do {} while (--retry && (pmu_r32(PMU_PWDSR) & module));
167*4882a593Smuzhiyun 	spin_unlock(&g_pmu_lock);
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 	if (!retry)
170*4882a593Smuzhiyun 		panic("activating PMU module failed!");
171*4882a593Smuzhiyun }
172*4882a593Smuzhiyun EXPORT_SYMBOL(ltq_pmu_enable);
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun /* legacy function kept alive to ease clkdev transition */
ltq_pmu_disable(unsigned int module)175*4882a593Smuzhiyun void ltq_pmu_disable(unsigned int module)
176*4882a593Smuzhiyun {
177*4882a593Smuzhiyun 	int retry = 1000000;
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun 	spin_lock(&g_pmu_lock);
180*4882a593Smuzhiyun 	pmu_w32(pmu_r32(PMU_PWDCR) | module, PMU_PWDCR);
181*4882a593Smuzhiyun 	do {} while (--retry && (!(pmu_r32(PMU_PWDSR) & module)));
182*4882a593Smuzhiyun 	spin_unlock(&g_pmu_lock);
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun 	if (!retry)
185*4882a593Smuzhiyun 		pr_warn("deactivating PMU module failed!");
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun EXPORT_SYMBOL(ltq_pmu_disable);
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun /* enable a hw clock */
cgu_enable(struct clk * clk)190*4882a593Smuzhiyun static int cgu_enable(struct clk *clk)
191*4882a593Smuzhiyun {
192*4882a593Smuzhiyun 	ltq_cgu_w32(ltq_cgu_r32(ifccr) | clk->bits, ifccr);
193*4882a593Smuzhiyun 	return 0;
194*4882a593Smuzhiyun }
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun /* disable a hw clock */
cgu_disable(struct clk * clk)197*4882a593Smuzhiyun static void cgu_disable(struct clk *clk)
198*4882a593Smuzhiyun {
199*4882a593Smuzhiyun 	ltq_cgu_w32(ltq_cgu_r32(ifccr) & ~clk->bits, ifccr);
200*4882a593Smuzhiyun }
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun /* enable a clock gate */
pmu_enable(struct clk * clk)203*4882a593Smuzhiyun static int pmu_enable(struct clk *clk)
204*4882a593Smuzhiyun {
205*4882a593Smuzhiyun 	int retry = 1000000;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	if (of_machine_is_compatible("lantiq,ar10")
208*4882a593Smuzhiyun 	    || of_machine_is_compatible("lantiq,grx390")) {
209*4882a593Smuzhiyun 		pmu_w32(clk->bits, PWDCR_EN_XRX(clk->module));
210*4882a593Smuzhiyun 		do {} while (--retry &&
211*4882a593Smuzhiyun 			     (!(pmu_r32(PWDSR_XRX(clk->module)) & clk->bits)));
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun 	} else {
214*4882a593Smuzhiyun 		spin_lock(&g_pmu_lock);
215*4882a593Smuzhiyun 		pmu_w32(pmu_r32(PWDCR(clk->module)) & ~clk->bits,
216*4882a593Smuzhiyun 				PWDCR(clk->module));
217*4882a593Smuzhiyun 		do {} while (--retry &&
218*4882a593Smuzhiyun 			     (pmu_r32(PWDSR(clk->module)) & clk->bits));
219*4882a593Smuzhiyun 		spin_unlock(&g_pmu_lock);
220*4882a593Smuzhiyun 	}
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 	if (!retry)
223*4882a593Smuzhiyun 		panic("activating PMU module failed!");
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	return 0;
226*4882a593Smuzhiyun }
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun /* disable a clock gate */
pmu_disable(struct clk * clk)229*4882a593Smuzhiyun static void pmu_disable(struct clk *clk)
230*4882a593Smuzhiyun {
231*4882a593Smuzhiyun 	int retry = 1000000;
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun 	if (of_machine_is_compatible("lantiq,ar10")
234*4882a593Smuzhiyun 	    || of_machine_is_compatible("lantiq,grx390")) {
235*4882a593Smuzhiyun 		pmu_w32(clk->bits, PWDCR_DIS_XRX(clk->module));
236*4882a593Smuzhiyun 		do {} while (--retry &&
237*4882a593Smuzhiyun 			     (pmu_r32(PWDSR_XRX(clk->module)) & clk->bits));
238*4882a593Smuzhiyun 	} else {
239*4882a593Smuzhiyun 		spin_lock(&g_pmu_lock);
240*4882a593Smuzhiyun 		pmu_w32(pmu_r32(PWDCR(clk->module)) | clk->bits,
241*4882a593Smuzhiyun 				PWDCR(clk->module));
242*4882a593Smuzhiyun 		do {} while (--retry &&
243*4882a593Smuzhiyun 			     (!(pmu_r32(PWDSR(clk->module)) & clk->bits)));
244*4882a593Smuzhiyun 		spin_unlock(&g_pmu_lock);
245*4882a593Smuzhiyun 	}
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	if (!retry)
248*4882a593Smuzhiyun 		pr_warn("deactivating PMU module failed!");
249*4882a593Smuzhiyun }
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun /* the pci enable helper */
pci_enable(struct clk * clk)252*4882a593Smuzhiyun static int pci_enable(struct clk *clk)
253*4882a593Smuzhiyun {
254*4882a593Smuzhiyun 	unsigned int val = ltq_cgu_r32(ifccr);
255*4882a593Smuzhiyun 	/* set bus clock speed */
256*4882a593Smuzhiyun 	if (of_machine_is_compatible("lantiq,ar9") ||
257*4882a593Smuzhiyun 			of_machine_is_compatible("lantiq,vr9")) {
258*4882a593Smuzhiyun 		val &= ~0x1f00000;
259*4882a593Smuzhiyun 		if (clk->rate == CLOCK_33M)
260*4882a593Smuzhiyun 			val |= 0xe00000;
261*4882a593Smuzhiyun 		else
262*4882a593Smuzhiyun 			val |= 0x700000; /* 62.5M */
263*4882a593Smuzhiyun 	} else {
264*4882a593Smuzhiyun 		val &= ~0xf00000;
265*4882a593Smuzhiyun 		if (clk->rate == CLOCK_33M)
266*4882a593Smuzhiyun 			val |= 0x800000;
267*4882a593Smuzhiyun 		else
268*4882a593Smuzhiyun 			val |= 0x400000; /* 62.5M */
269*4882a593Smuzhiyun 	}
270*4882a593Smuzhiyun 	ltq_cgu_w32(val, ifccr);
271*4882a593Smuzhiyun 	pmu_enable(clk);
272*4882a593Smuzhiyun 	return 0;
273*4882a593Smuzhiyun }
274*4882a593Smuzhiyun 
275*4882a593Smuzhiyun /* enable the external clock as a source */
pci_ext_enable(struct clk * clk)276*4882a593Smuzhiyun static int pci_ext_enable(struct clk *clk)
277*4882a593Smuzhiyun {
278*4882a593Smuzhiyun 	ltq_cgu_w32(ltq_cgu_r32(ifccr) & ~(1 << 16), ifccr);
279*4882a593Smuzhiyun 	ltq_cgu_w32((1 << 30), pcicr);
280*4882a593Smuzhiyun 	return 0;
281*4882a593Smuzhiyun }
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun /* disable the external clock as a source */
pci_ext_disable(struct clk * clk)284*4882a593Smuzhiyun static void pci_ext_disable(struct clk *clk)
285*4882a593Smuzhiyun {
286*4882a593Smuzhiyun 	ltq_cgu_w32(ltq_cgu_r32(ifccr) | (1 << 16), ifccr);
287*4882a593Smuzhiyun 	ltq_cgu_w32((1 << 31) | (1 << 30), pcicr);
288*4882a593Smuzhiyun }
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun /* enable a clockout source */
clkout_enable(struct clk * clk)291*4882a593Smuzhiyun static int clkout_enable(struct clk *clk)
292*4882a593Smuzhiyun {
293*4882a593Smuzhiyun 	int i;
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun 	/* get the correct rate */
296*4882a593Smuzhiyun 	for (i = 0; i < 4; i++) {
297*4882a593Smuzhiyun 		if (clk->rates[i] == clk->rate) {
298*4882a593Smuzhiyun 			int shift = 14 - (2 * clk->module);
299*4882a593Smuzhiyun 			int enable = 7 - clk->module;
300*4882a593Smuzhiyun 			unsigned int val = ltq_cgu_r32(ifccr);
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 			val &= ~(3 << shift);
303*4882a593Smuzhiyun 			val |= i << shift;
304*4882a593Smuzhiyun 			val |= enable;
305*4882a593Smuzhiyun 			ltq_cgu_w32(val, ifccr);
306*4882a593Smuzhiyun 			return 0;
307*4882a593Smuzhiyun 		}
308*4882a593Smuzhiyun 	}
309*4882a593Smuzhiyun 	return -1;
310*4882a593Smuzhiyun }
311*4882a593Smuzhiyun 
312*4882a593Smuzhiyun /* manage the clock gates via PMU */
clkdev_add_pmu(const char * dev,const char * con,bool deactivate,unsigned int module,unsigned int bits)313*4882a593Smuzhiyun static void clkdev_add_pmu(const char *dev, const char *con, bool deactivate,
314*4882a593Smuzhiyun 			   unsigned int module, unsigned int bits)
315*4882a593Smuzhiyun {
316*4882a593Smuzhiyun 	struct clk *clk = kzalloc(sizeof(struct clk), GFP_KERNEL);
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 	if (!clk)
319*4882a593Smuzhiyun 		return;
320*4882a593Smuzhiyun 	clk->cl.dev_id = dev;
321*4882a593Smuzhiyun 	clk->cl.con_id = con;
322*4882a593Smuzhiyun 	clk->cl.clk = clk;
323*4882a593Smuzhiyun 	clk->enable = pmu_enable;
324*4882a593Smuzhiyun 	clk->disable = pmu_disable;
325*4882a593Smuzhiyun 	clk->module = module;
326*4882a593Smuzhiyun 	clk->bits = bits;
327*4882a593Smuzhiyun 	if (deactivate) {
328*4882a593Smuzhiyun 		/*
329*4882a593Smuzhiyun 		 * Disable it during the initialization. Module should enable
330*4882a593Smuzhiyun 		 * when used
331*4882a593Smuzhiyun 		 */
332*4882a593Smuzhiyun 		pmu_disable(clk);
333*4882a593Smuzhiyun 	}
334*4882a593Smuzhiyun 	clkdev_add(&clk->cl);
335*4882a593Smuzhiyun }
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun /* manage the clock generator */
clkdev_add_cgu(const char * dev,const char * con,unsigned int bits)338*4882a593Smuzhiyun static void clkdev_add_cgu(const char *dev, const char *con,
339*4882a593Smuzhiyun 					unsigned int bits)
340*4882a593Smuzhiyun {
341*4882a593Smuzhiyun 	struct clk *clk = kzalloc(sizeof(struct clk), GFP_KERNEL);
342*4882a593Smuzhiyun 
343*4882a593Smuzhiyun 	if (!clk)
344*4882a593Smuzhiyun 		return;
345*4882a593Smuzhiyun 	clk->cl.dev_id = dev;
346*4882a593Smuzhiyun 	clk->cl.con_id = con;
347*4882a593Smuzhiyun 	clk->cl.clk = clk;
348*4882a593Smuzhiyun 	clk->enable = cgu_enable;
349*4882a593Smuzhiyun 	clk->disable = cgu_disable;
350*4882a593Smuzhiyun 	clk->bits = bits;
351*4882a593Smuzhiyun 	clkdev_add(&clk->cl);
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun /* pci needs its own enable function as the setup is a bit more complex */
355*4882a593Smuzhiyun static unsigned long valid_pci_rates[] = {CLOCK_33M, CLOCK_62_5M, 0};
356*4882a593Smuzhiyun 
clkdev_add_pci(void)357*4882a593Smuzhiyun static void clkdev_add_pci(void)
358*4882a593Smuzhiyun {
359*4882a593Smuzhiyun 	struct clk *clk = kzalloc(sizeof(struct clk), GFP_KERNEL);
360*4882a593Smuzhiyun 	struct clk *clk_ext = kzalloc(sizeof(struct clk), GFP_KERNEL);
361*4882a593Smuzhiyun 
362*4882a593Smuzhiyun 	/* main pci clock */
363*4882a593Smuzhiyun 	if (clk) {
364*4882a593Smuzhiyun 		clk->cl.dev_id = "17000000.pci";
365*4882a593Smuzhiyun 		clk->cl.con_id = NULL;
366*4882a593Smuzhiyun 		clk->cl.clk = clk;
367*4882a593Smuzhiyun 		clk->rate = CLOCK_33M;
368*4882a593Smuzhiyun 		clk->rates = valid_pci_rates;
369*4882a593Smuzhiyun 		clk->enable = pci_enable;
370*4882a593Smuzhiyun 		clk->disable = pmu_disable;
371*4882a593Smuzhiyun 		clk->module = 0;
372*4882a593Smuzhiyun 		clk->bits = PMU_PCI;
373*4882a593Smuzhiyun 		clkdev_add(&clk->cl);
374*4882a593Smuzhiyun 	}
375*4882a593Smuzhiyun 
376*4882a593Smuzhiyun 	/* use internal/external bus clock */
377*4882a593Smuzhiyun 	if (clk_ext) {
378*4882a593Smuzhiyun 		clk_ext->cl.dev_id = "17000000.pci";
379*4882a593Smuzhiyun 		clk_ext->cl.con_id = "external";
380*4882a593Smuzhiyun 		clk_ext->cl.clk = clk_ext;
381*4882a593Smuzhiyun 		clk_ext->enable = pci_ext_enable;
382*4882a593Smuzhiyun 		clk_ext->disable = pci_ext_disable;
383*4882a593Smuzhiyun 		clkdev_add(&clk_ext->cl);
384*4882a593Smuzhiyun 	}
385*4882a593Smuzhiyun }
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun /* xway socs can generate clocks on gpio pins */
388*4882a593Smuzhiyun static unsigned long valid_clkout_rates[4][5] = {
389*4882a593Smuzhiyun 	{CLOCK_32_768K, CLOCK_1_536M, CLOCK_2_5M, CLOCK_12M, 0},
390*4882a593Smuzhiyun 	{CLOCK_40M, CLOCK_12M, CLOCK_24M, CLOCK_48M, 0},
391*4882a593Smuzhiyun 	{CLOCK_25M, CLOCK_40M, CLOCK_30M, CLOCK_60M, 0},
392*4882a593Smuzhiyun 	{CLOCK_12M, CLOCK_50M, CLOCK_32_768K, CLOCK_25M, 0},
393*4882a593Smuzhiyun };
394*4882a593Smuzhiyun 
clkdev_add_clkout(void)395*4882a593Smuzhiyun static void clkdev_add_clkout(void)
396*4882a593Smuzhiyun {
397*4882a593Smuzhiyun 	int i;
398*4882a593Smuzhiyun 
399*4882a593Smuzhiyun 	for (i = 0; i < 4; i++) {
400*4882a593Smuzhiyun 		struct clk *clk;
401*4882a593Smuzhiyun 		char *name;
402*4882a593Smuzhiyun 
403*4882a593Smuzhiyun 		name = kzalloc(sizeof("clkout0"), GFP_KERNEL);
404*4882a593Smuzhiyun 		if (!name)
405*4882a593Smuzhiyun 			continue;
406*4882a593Smuzhiyun 		sprintf(name, "clkout%d", i);
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun 		clk = kzalloc(sizeof(struct clk), GFP_KERNEL);
409*4882a593Smuzhiyun 		if (!clk) {
410*4882a593Smuzhiyun 			kfree(name);
411*4882a593Smuzhiyun 			continue;
412*4882a593Smuzhiyun 		}
413*4882a593Smuzhiyun 		clk->cl.dev_id = "1f103000.cgu";
414*4882a593Smuzhiyun 		clk->cl.con_id = name;
415*4882a593Smuzhiyun 		clk->cl.clk = clk;
416*4882a593Smuzhiyun 		clk->rate = 0;
417*4882a593Smuzhiyun 		clk->rates = valid_clkout_rates[i];
418*4882a593Smuzhiyun 		clk->enable = clkout_enable;
419*4882a593Smuzhiyun 		clk->module = i;
420*4882a593Smuzhiyun 		clkdev_add(&clk->cl);
421*4882a593Smuzhiyun 	}
422*4882a593Smuzhiyun }
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun /* bring up all register ranges that we need for basic system control */
ltq_soc_init(void)425*4882a593Smuzhiyun void __init ltq_soc_init(void)
426*4882a593Smuzhiyun {
427*4882a593Smuzhiyun 	struct resource res_pmu, res_cgu, res_ebu;
428*4882a593Smuzhiyun 	struct device_node *np_pmu =
429*4882a593Smuzhiyun 			of_find_compatible_node(NULL, NULL, "lantiq,pmu-xway");
430*4882a593Smuzhiyun 	struct device_node *np_cgu =
431*4882a593Smuzhiyun 			of_find_compatible_node(NULL, NULL, "lantiq,cgu-xway");
432*4882a593Smuzhiyun 	struct device_node *np_ebu =
433*4882a593Smuzhiyun 			of_find_compatible_node(NULL, NULL, "lantiq,ebu-xway");
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun 	/* check if all the core register ranges are available */
436*4882a593Smuzhiyun 	if (!np_pmu || !np_cgu || !np_ebu)
437*4882a593Smuzhiyun 		panic("Failed to load core nodes from devicetree");
438*4882a593Smuzhiyun 
439*4882a593Smuzhiyun 	if (of_address_to_resource(np_pmu, 0, &res_pmu) ||
440*4882a593Smuzhiyun 			of_address_to_resource(np_cgu, 0, &res_cgu) ||
441*4882a593Smuzhiyun 			of_address_to_resource(np_ebu, 0, &res_ebu))
442*4882a593Smuzhiyun 		panic("Failed to get core resources");
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun 	if (!request_mem_region(res_pmu.start, resource_size(&res_pmu),
445*4882a593Smuzhiyun 				res_pmu.name) ||
446*4882a593Smuzhiyun 		!request_mem_region(res_cgu.start, resource_size(&res_cgu),
447*4882a593Smuzhiyun 				res_cgu.name) ||
448*4882a593Smuzhiyun 		!request_mem_region(res_ebu.start, resource_size(&res_ebu),
449*4882a593Smuzhiyun 				res_ebu.name))
450*4882a593Smuzhiyun 		pr_err("Failed to request core resources");
451*4882a593Smuzhiyun 
452*4882a593Smuzhiyun 	pmu_membase = ioremap(res_pmu.start, resource_size(&res_pmu));
453*4882a593Smuzhiyun 	ltq_cgu_membase = ioremap(res_cgu.start,
454*4882a593Smuzhiyun 						resource_size(&res_cgu));
455*4882a593Smuzhiyun 	ltq_ebu_membase = ioremap(res_ebu.start,
456*4882a593Smuzhiyun 						resource_size(&res_ebu));
457*4882a593Smuzhiyun 	if (!pmu_membase || !ltq_cgu_membase || !ltq_ebu_membase)
458*4882a593Smuzhiyun 		panic("Failed to remap core resources");
459*4882a593Smuzhiyun 
460*4882a593Smuzhiyun 	/* make sure to unprotect the memory region where flash is located */
461*4882a593Smuzhiyun 	ltq_ebu_w32(ltq_ebu_r32(LTQ_EBU_BUSCON0) & ~EBU_WRDIS, LTQ_EBU_BUSCON0);
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 	/* add our generic xway clocks */
464*4882a593Smuzhiyun 	clkdev_add_pmu("10000000.fpi", NULL, 0, 0, PMU_FPI);
465*4882a593Smuzhiyun 	clkdev_add_pmu("1e100a00.gptu", NULL, 1, 0, PMU_GPT);
466*4882a593Smuzhiyun 	clkdev_add_pmu("1e100bb0.stp", NULL, 1, 0, PMU_STP);
467*4882a593Smuzhiyun 	clkdev_add_pmu("1e100c00.serial", NULL, 0, 0, PMU_ASC1);
468*4882a593Smuzhiyun 	clkdev_add_pmu("1e104100.dma", NULL, 1, 0, PMU_DMA);
469*4882a593Smuzhiyun 	clkdev_add_pmu("1e100800.spi", NULL, 1, 0, PMU_SPI);
470*4882a593Smuzhiyun 	clkdev_add_pmu("1e105300.ebu", NULL, 0, 0, PMU_EBU);
471*4882a593Smuzhiyun 	clkdev_add_clkout();
472*4882a593Smuzhiyun 
473*4882a593Smuzhiyun 	/* add the soc dependent clocks */
474*4882a593Smuzhiyun 	if (of_machine_is_compatible("lantiq,vr9")) {
475*4882a593Smuzhiyun 		ifccr = CGU_IFCCR_VR9;
476*4882a593Smuzhiyun 		pcicr = CGU_PCICR_VR9;
477*4882a593Smuzhiyun 	} else {
478*4882a593Smuzhiyun 		clkdev_add_pmu("1e180000.etop", NULL, 1, 0, PMU_PPE);
479*4882a593Smuzhiyun 	}
480*4882a593Smuzhiyun 
481*4882a593Smuzhiyun 	if (!of_machine_is_compatible("lantiq,ase"))
482*4882a593Smuzhiyun 		clkdev_add_pci();
483*4882a593Smuzhiyun 
484*4882a593Smuzhiyun 	if (of_machine_is_compatible("lantiq,grx390") ||
485*4882a593Smuzhiyun 	    of_machine_is_compatible("lantiq,ar10")) {
486*4882a593Smuzhiyun 		clkdev_add_pmu("1e108000.switch", "gphy0", 0, 0, PMU_GPHY0);
487*4882a593Smuzhiyun 		clkdev_add_pmu("1e108000.switch", "gphy1", 0, 0, PMU_GPHY1);
488*4882a593Smuzhiyun 		clkdev_add_pmu("1e108000.switch", "gphy2", 0, 0, PMU_GPHY2);
489*4882a593Smuzhiyun 		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 2, PMU_ANALOG_USB0_P);
490*4882a593Smuzhiyun 		clkdev_add_pmu("1f203034.usb2-phy", "phy", 1, 2, PMU_ANALOG_USB1_P);
491*4882a593Smuzhiyun 		/* rc 0 */
492*4882a593Smuzhiyun 		clkdev_add_pmu("1f106800.phy", "phy", 1, 2, PMU_ANALOG_PCIE0_P);
493*4882a593Smuzhiyun 		clkdev_add_pmu("1d900000.pcie", "msi", 1, 1, PMU1_PCIE_MSI);
494*4882a593Smuzhiyun 		clkdev_add_pmu("1f106800.phy", "pdi", 1, 1, PMU1_PCIE_PDI);
495*4882a593Smuzhiyun 		clkdev_add_pmu("1d900000.pcie", "ctl", 1, 1, PMU1_PCIE_CTL);
496*4882a593Smuzhiyun 		/* rc 1 */
497*4882a593Smuzhiyun 		clkdev_add_pmu("1f700400.phy", "phy", 1, 2, PMU_ANALOG_PCIE1_P);
498*4882a593Smuzhiyun 		clkdev_add_pmu("19000000.pcie", "msi", 1, 1, PMU1_PCIE1_MSI);
499*4882a593Smuzhiyun 		clkdev_add_pmu("1f700400.phy", "pdi", 1, 1, PMU1_PCIE1_PDI);
500*4882a593Smuzhiyun 		clkdev_add_pmu("19000000.pcie", "ctl", 1, 1, PMU1_PCIE1_CTL);
501*4882a593Smuzhiyun 	}
502*4882a593Smuzhiyun 
503*4882a593Smuzhiyun 	if (of_machine_is_compatible("lantiq,ase")) {
504*4882a593Smuzhiyun 		if (ltq_cgu_r32(CGU_SYS) & (1 << 5))
505*4882a593Smuzhiyun 			clkdev_add_static(CLOCK_266M, CLOCK_133M,
506*4882a593Smuzhiyun 						CLOCK_133M, CLOCK_266M);
507*4882a593Smuzhiyun 		else
508*4882a593Smuzhiyun 			clkdev_add_static(CLOCK_133M, CLOCK_133M,
509*4882a593Smuzhiyun 						CLOCK_133M, CLOCK_133M);
510*4882a593Smuzhiyun 		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0);
511*4882a593Smuzhiyun 		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 0, PMU_USB0_P);
512*4882a593Smuzhiyun 		clkdev_add_pmu("1e180000.etop", "ppe", 1, 0, PMU_PPE);
513*4882a593Smuzhiyun 		clkdev_add_cgu("1e180000.etop", "ephycgu", CGU_EPHY);
514*4882a593Smuzhiyun 		clkdev_add_pmu("1e180000.etop", "ephy", 1, 0, PMU_EPHY);
515*4882a593Smuzhiyun 		clkdev_add_pmu("1e103000.sdio", NULL, 1, 0, PMU_ASE_SDIO);
516*4882a593Smuzhiyun 		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
517*4882a593Smuzhiyun 	} else if (of_machine_is_compatible("lantiq,grx390")) {
518*4882a593Smuzhiyun 		clkdev_add_static(ltq_grx390_cpu_hz(), ltq_grx390_fpi_hz(),
519*4882a593Smuzhiyun 				  ltq_grx390_fpi_hz(), ltq_grx390_pp32_hz());
520*4882a593Smuzhiyun 		clkdev_add_pmu("1e108000.switch", "gphy3", 0, 0, PMU_GPHY3);
521*4882a593Smuzhiyun 		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0);
522*4882a593Smuzhiyun 		clkdev_add_pmu("1e106000.usb", "otg", 1, 0, PMU_USB1);
523*4882a593Smuzhiyun 		/* rc 2 */
524*4882a593Smuzhiyun 		clkdev_add_pmu("1f106a00.pcie", "phy", 1, 2, PMU_ANALOG_PCIE2_P);
525*4882a593Smuzhiyun 		clkdev_add_pmu("1a800000.pcie", "msi", 1, 1, PMU1_PCIE2_MSI);
526*4882a593Smuzhiyun 		clkdev_add_pmu("1f106a00.pcie", "pdi", 1, 1, PMU1_PCIE2_PDI);
527*4882a593Smuzhiyun 		clkdev_add_pmu("1a800000.pcie", "ctl", 1, 1, PMU1_PCIE2_CTL);
528*4882a593Smuzhiyun 		clkdev_add_pmu("1e10b308.eth", NULL, 0, 0, PMU_SWITCH | PMU_PPE_DP);
529*4882a593Smuzhiyun 		clkdev_add_pmu("1da00000.usif", "NULL", 1, 0, PMU_USIF);
530*4882a593Smuzhiyun 		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
531*4882a593Smuzhiyun 	} else if (of_machine_is_compatible("lantiq,ar10")) {
532*4882a593Smuzhiyun 		clkdev_add_static(ltq_ar10_cpu_hz(), ltq_ar10_fpi_hz(),
533*4882a593Smuzhiyun 				  ltq_ar10_fpi_hz(), ltq_ar10_pp32_hz());
534*4882a593Smuzhiyun 		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0);
535*4882a593Smuzhiyun 		clkdev_add_pmu("1e106000.usb", "otg", 1, 0, PMU_USB1);
536*4882a593Smuzhiyun 		clkdev_add_pmu("1e10b308.eth", NULL, 0, 0, PMU_SWITCH |
537*4882a593Smuzhiyun 			       PMU_PPE_DP | PMU_PPE_TC);
538*4882a593Smuzhiyun 		clkdev_add_pmu("1da00000.usif", "NULL", 1, 0, PMU_USIF);
539*4882a593Smuzhiyun 		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
540*4882a593Smuzhiyun 		clkdev_add_pmu("1e116000.mei", "afe", 1, 2, PMU_ANALOG_DSL_AFE);
541*4882a593Smuzhiyun 		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
542*4882a593Smuzhiyun 	} else if (of_machine_is_compatible("lantiq,vr9")) {
543*4882a593Smuzhiyun 		clkdev_add_static(ltq_vr9_cpu_hz(), ltq_vr9_fpi_hz(),
544*4882a593Smuzhiyun 				ltq_vr9_fpi_hz(), ltq_vr9_pp32_hz());
545*4882a593Smuzhiyun 		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 0, PMU_USB0_P);
546*4882a593Smuzhiyun 		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0 | PMU_AHBM);
547*4882a593Smuzhiyun 		clkdev_add_pmu("1f203034.usb2-phy", "phy", 1, 0, PMU_USB1_P);
548*4882a593Smuzhiyun 		clkdev_add_pmu("1e106000.usb", "otg", 1, 0, PMU_USB1 | PMU_AHBM);
549*4882a593Smuzhiyun 		clkdev_add_pmu("1f106800.phy", "phy", 1, 1, PMU1_PCIE_PHY);
550*4882a593Smuzhiyun 		clkdev_add_pmu("1d900000.pcie", "bus", 1, 0, PMU_PCIE_CLK);
551*4882a593Smuzhiyun 		clkdev_add_pmu("1d900000.pcie", "msi", 1, 1, PMU1_PCIE_MSI);
552*4882a593Smuzhiyun 		clkdev_add_pmu("1f106800.phy", "pdi", 1, 1, PMU1_PCIE_PDI);
553*4882a593Smuzhiyun 		clkdev_add_pmu("1d900000.pcie", "ctl", 1, 1, PMU1_PCIE_CTL);
554*4882a593Smuzhiyun 		clkdev_add_pmu(NULL, "ahb", 1, 0, PMU_AHBM | PMU_AHBS);
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun 		clkdev_add_pmu("1da00000.usif", "NULL", 1, 0, PMU_USIF);
557*4882a593Smuzhiyun 		clkdev_add_pmu("1e10b308.eth", NULL, 0, 0,
558*4882a593Smuzhiyun 				PMU_SWITCH | PMU_PPE_DPLUS | PMU_PPE_DPLUM |
559*4882a593Smuzhiyun 				PMU_PPE_EMA | PMU_PPE_TC | PMU_PPE_SLL01 |
560*4882a593Smuzhiyun 				PMU_PPE_QSB | PMU_PPE_TOP);
561*4882a593Smuzhiyun 		clkdev_add_pmu("1e108000.switch", "gphy0", 0, 0, PMU_GPHY);
562*4882a593Smuzhiyun 		clkdev_add_pmu("1e108000.switch", "gphy1", 0, 0, PMU_GPHY);
563*4882a593Smuzhiyun 		clkdev_add_pmu("1e103000.sdio", NULL, 1, 0, PMU_SDIO);
564*4882a593Smuzhiyun 		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
565*4882a593Smuzhiyun 		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
566*4882a593Smuzhiyun 	} else if (of_machine_is_compatible("lantiq,ar9")) {
567*4882a593Smuzhiyun 		clkdev_add_static(ltq_ar9_cpu_hz(), ltq_ar9_fpi_hz(),
568*4882a593Smuzhiyun 				ltq_ar9_fpi_hz(), CLOCK_250M);
569*4882a593Smuzhiyun 		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 0, PMU_USB0_P);
570*4882a593Smuzhiyun 		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0 | PMU_AHBM);
571*4882a593Smuzhiyun 		clkdev_add_pmu("1f203034.usb2-phy", "phy", 1, 0, PMU_USB1_P);
572*4882a593Smuzhiyun 		clkdev_add_pmu("1e106000.usb", "otg", 1, 0, PMU_USB1 | PMU_AHBM);
573*4882a593Smuzhiyun 		clkdev_add_pmu("1e180000.etop", "switch", 1, 0, PMU_SWITCH);
574*4882a593Smuzhiyun 		clkdev_add_pmu("1e103000.sdio", NULL, 1, 0, PMU_SDIO);
575*4882a593Smuzhiyun 		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
576*4882a593Smuzhiyun 		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
577*4882a593Smuzhiyun 		clkdev_add_pmu("1e100400.serial", NULL, 1, 0, PMU_ASC0);
578*4882a593Smuzhiyun 	} else {
579*4882a593Smuzhiyun 		clkdev_add_static(ltq_danube_cpu_hz(), ltq_danube_fpi_hz(),
580*4882a593Smuzhiyun 				ltq_danube_fpi_hz(), ltq_danube_pp32_hz());
581*4882a593Smuzhiyun 		clkdev_add_pmu("1e101000.usb", "otg", 1, 0, PMU_USB0 | PMU_AHBM);
582*4882a593Smuzhiyun 		clkdev_add_pmu("1f203018.usb2-phy", "phy", 1, 0, PMU_USB0_P);
583*4882a593Smuzhiyun 		clkdev_add_pmu("1e103000.sdio", NULL, 1, 0, PMU_SDIO);
584*4882a593Smuzhiyun 		clkdev_add_pmu("1e103100.deu", NULL, 1, 0, PMU_DEU);
585*4882a593Smuzhiyun 		clkdev_add_pmu("1e116000.mei", "dfe", 1, 0, PMU_DFE);
586*4882a593Smuzhiyun 		clkdev_add_pmu("1e100400.serial", NULL, 1, 0, PMU_ASC0);
587*4882a593Smuzhiyun 	}
588*4882a593Smuzhiyun }
589