xref: /OK3568_Linux_fs/kernel/drivers/clk/clk-asm9260.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (c) 2014 Oleksij Rempel <linux@rempel-privat.de>.
4*4882a593Smuzhiyun  */
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun #include <linux/clk.h>
7*4882a593Smuzhiyun #include <linux/clkdev.h>
8*4882a593Smuzhiyun #include <linux/err.h>
9*4882a593Smuzhiyun #include <linux/io.h>
10*4882a593Smuzhiyun #include <linux/clk-provider.h>
11*4882a593Smuzhiyun #include <linux/spinlock.h>
12*4882a593Smuzhiyun #include <linux/of.h>
13*4882a593Smuzhiyun #include <linux/of_address.h>
14*4882a593Smuzhiyun #include <dt-bindings/clock/alphascale,asm9260.h>
15*4882a593Smuzhiyun 
16*4882a593Smuzhiyun #define HW_AHBCLKCTRL0		0x0020
17*4882a593Smuzhiyun #define HW_AHBCLKCTRL1		0x0030
18*4882a593Smuzhiyun #define HW_SYSPLLCTRL		0x0100
19*4882a593Smuzhiyun #define HW_MAINCLKSEL		0x0120
20*4882a593Smuzhiyun #define HW_MAINCLKUEN		0x0124
21*4882a593Smuzhiyun #define HW_UARTCLKSEL		0x0128
22*4882a593Smuzhiyun #define HW_UARTCLKUEN		0x012c
23*4882a593Smuzhiyun #define HW_I2S0CLKSEL		0x0130
24*4882a593Smuzhiyun #define HW_I2S0CLKUEN		0x0134
25*4882a593Smuzhiyun #define HW_I2S1CLKSEL		0x0138
26*4882a593Smuzhiyun #define HW_I2S1CLKUEN		0x013c
27*4882a593Smuzhiyun #define HW_WDTCLKSEL		0x0160
28*4882a593Smuzhiyun #define HW_WDTCLKUEN		0x0164
29*4882a593Smuzhiyun #define HW_CLKOUTCLKSEL		0x0170
30*4882a593Smuzhiyun #define HW_CLKOUTCLKUEN		0x0174
31*4882a593Smuzhiyun #define HW_CPUCLKDIV		0x017c
32*4882a593Smuzhiyun #define HW_SYSAHBCLKDIV		0x0180
33*4882a593Smuzhiyun #define HW_I2S0MCLKDIV		0x0190
34*4882a593Smuzhiyun #define HW_I2S0SCLKDIV		0x0194
35*4882a593Smuzhiyun #define HW_I2S1MCLKDIV		0x0188
36*4882a593Smuzhiyun #define HW_I2S1SCLKDIV		0x018c
37*4882a593Smuzhiyun #define HW_UART0CLKDIV		0x0198
38*4882a593Smuzhiyun #define HW_UART1CLKDIV		0x019c
39*4882a593Smuzhiyun #define HW_UART2CLKDIV		0x01a0
40*4882a593Smuzhiyun #define HW_UART3CLKDIV		0x01a4
41*4882a593Smuzhiyun #define HW_UART4CLKDIV		0x01a8
42*4882a593Smuzhiyun #define HW_UART5CLKDIV		0x01ac
43*4882a593Smuzhiyun #define HW_UART6CLKDIV		0x01b0
44*4882a593Smuzhiyun #define HW_UART7CLKDIV		0x01b4
45*4882a593Smuzhiyun #define HW_UART8CLKDIV		0x01b8
46*4882a593Smuzhiyun #define HW_UART9CLKDIV		0x01bc
47*4882a593Smuzhiyun #define HW_SPI0CLKDIV		0x01c0
48*4882a593Smuzhiyun #define HW_SPI1CLKDIV		0x01c4
49*4882a593Smuzhiyun #define HW_QUADSPICLKDIV	0x01c8
50*4882a593Smuzhiyun #define HW_SSP0CLKDIV		0x01d0
51*4882a593Smuzhiyun #define HW_NANDCLKDIV		0x01d4
52*4882a593Smuzhiyun #define HW_TRACECLKDIV		0x01e0
53*4882a593Smuzhiyun #define HW_CAMMCLKDIV		0x01e8
54*4882a593Smuzhiyun #define HW_WDTCLKDIV		0x01ec
55*4882a593Smuzhiyun #define HW_CLKOUTCLKDIV		0x01f4
56*4882a593Smuzhiyun #define HW_MACCLKDIV		0x01f8
57*4882a593Smuzhiyun #define HW_LCDCLKDIV		0x01fc
58*4882a593Smuzhiyun #define HW_ADCANACLKDIV		0x0200
59*4882a593Smuzhiyun 
60*4882a593Smuzhiyun static struct clk_hw_onecell_data *clk_data;
61*4882a593Smuzhiyun static DEFINE_SPINLOCK(asm9260_clk_lock);
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun struct asm9260_div_clk {
64*4882a593Smuzhiyun 	unsigned int idx;
65*4882a593Smuzhiyun 	const char *name;
66*4882a593Smuzhiyun 	const char *parent_name;
67*4882a593Smuzhiyun 	u32 reg;
68*4882a593Smuzhiyun };
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun struct asm9260_gate_data {
71*4882a593Smuzhiyun 	unsigned int idx;
72*4882a593Smuzhiyun 	const char *name;
73*4882a593Smuzhiyun 	const char *parent_name;
74*4882a593Smuzhiyun 	u32 reg;
75*4882a593Smuzhiyun 	u8 bit_idx;
76*4882a593Smuzhiyun 	unsigned long flags;
77*4882a593Smuzhiyun };
78*4882a593Smuzhiyun 
79*4882a593Smuzhiyun struct asm9260_mux_clock {
80*4882a593Smuzhiyun 	u8			mask;
81*4882a593Smuzhiyun 	u32			*table;
82*4882a593Smuzhiyun 	const char		*name;
83*4882a593Smuzhiyun 	const char		**parent_names;
84*4882a593Smuzhiyun 	u8			num_parents;
85*4882a593Smuzhiyun 	unsigned long		offset;
86*4882a593Smuzhiyun 	unsigned long		flags;
87*4882a593Smuzhiyun };
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun static void __iomem *base;
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun static const struct asm9260_div_clk asm9260_div_clks[] __initconst = {
92*4882a593Smuzhiyun 	{ CLKID_SYS_CPU,	"cpu_div", "main_gate", HW_CPUCLKDIV },
93*4882a593Smuzhiyun 	{ CLKID_SYS_AHB,	"ahb_div", "cpu_div", HW_SYSAHBCLKDIV },
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun 	/* i2s has two deviders: one for only external mclk and internal
96*4882a593Smuzhiyun 	 * devider for all clks. */
97*4882a593Smuzhiyun 	{ CLKID_SYS_I2S0M,	"i2s0m_div", "i2s0_mclk",  HW_I2S0MCLKDIV },
98*4882a593Smuzhiyun 	{ CLKID_SYS_I2S1M,	"i2s1m_div", "i2s1_mclk",  HW_I2S1MCLKDIV },
99*4882a593Smuzhiyun 	{ CLKID_SYS_I2S0S,	"i2s0s_div", "i2s0_gate",  HW_I2S0SCLKDIV },
100*4882a593Smuzhiyun 	{ CLKID_SYS_I2S1S,	"i2s1s_div", "i2s0_gate",  HW_I2S1SCLKDIV },
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun 	{ CLKID_SYS_UART0,	"uart0_div", "uart_gate", HW_UART0CLKDIV },
103*4882a593Smuzhiyun 	{ CLKID_SYS_UART1,	"uart1_div", "uart_gate", HW_UART1CLKDIV },
104*4882a593Smuzhiyun 	{ CLKID_SYS_UART2,	"uart2_div", "uart_gate", HW_UART2CLKDIV },
105*4882a593Smuzhiyun 	{ CLKID_SYS_UART3,	"uart3_div", "uart_gate", HW_UART3CLKDIV },
106*4882a593Smuzhiyun 	{ CLKID_SYS_UART4,	"uart4_div", "uart_gate", HW_UART4CLKDIV },
107*4882a593Smuzhiyun 	{ CLKID_SYS_UART5,	"uart5_div", "uart_gate", HW_UART5CLKDIV },
108*4882a593Smuzhiyun 	{ CLKID_SYS_UART6,	"uart6_div", "uart_gate", HW_UART6CLKDIV },
109*4882a593Smuzhiyun 	{ CLKID_SYS_UART7,	"uart7_div", "uart_gate", HW_UART7CLKDIV },
110*4882a593Smuzhiyun 	{ CLKID_SYS_UART8,	"uart8_div", "uart_gate", HW_UART8CLKDIV },
111*4882a593Smuzhiyun 	{ CLKID_SYS_UART9,	"uart9_div", "uart_gate", HW_UART9CLKDIV },
112*4882a593Smuzhiyun 
113*4882a593Smuzhiyun 	{ CLKID_SYS_SPI0,	"spi0_div",	"main_gate", HW_SPI0CLKDIV },
114*4882a593Smuzhiyun 	{ CLKID_SYS_SPI1,	"spi1_div",	"main_gate", HW_SPI1CLKDIV },
115*4882a593Smuzhiyun 	{ CLKID_SYS_QUADSPI,	"quadspi_div",	"main_gate", HW_QUADSPICLKDIV },
116*4882a593Smuzhiyun 	{ CLKID_SYS_SSP0,	"ssp0_div",	"main_gate", HW_SSP0CLKDIV },
117*4882a593Smuzhiyun 	{ CLKID_SYS_NAND,	"nand_div",	"main_gate", HW_NANDCLKDIV },
118*4882a593Smuzhiyun 	{ CLKID_SYS_TRACE,	"trace_div",	"main_gate", HW_TRACECLKDIV },
119*4882a593Smuzhiyun 	{ CLKID_SYS_CAMM,	"camm_div",	"main_gate", HW_CAMMCLKDIV },
120*4882a593Smuzhiyun 	{ CLKID_SYS_MAC,	"mac_div",	"main_gate", HW_MACCLKDIV },
121*4882a593Smuzhiyun 	{ CLKID_SYS_LCD,	"lcd_div",	"main_gate", HW_LCDCLKDIV },
122*4882a593Smuzhiyun 	{ CLKID_SYS_ADCANA,	"adcana_div",	"main_gate", HW_ADCANACLKDIV },
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun 	{ CLKID_SYS_WDT,	"wdt_div",	"wdt_gate",    HW_WDTCLKDIV },
125*4882a593Smuzhiyun 	{ CLKID_SYS_CLKOUT,	"clkout_div",	"clkout_gate", HW_CLKOUTCLKDIV },
126*4882a593Smuzhiyun };
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun static const struct asm9260_gate_data asm9260_mux_gates[] __initconst = {
129*4882a593Smuzhiyun 	{ 0, "main_gate",	"main_mux",	HW_MAINCLKUEN,	0 },
130*4882a593Smuzhiyun 	{ 0, "uart_gate",	"uart_mux",	HW_UARTCLKUEN,	0 },
131*4882a593Smuzhiyun 	{ 0, "i2s0_gate",	"i2s0_mux",	HW_I2S0CLKUEN,	0 },
132*4882a593Smuzhiyun 	{ 0, "i2s1_gate",	"i2s1_mux",	HW_I2S1CLKUEN,	0 },
133*4882a593Smuzhiyun 	{ 0, "wdt_gate",	"wdt_mux",	HW_WDTCLKUEN,	0 },
134*4882a593Smuzhiyun 	{ 0, "clkout_gate",	"clkout_mux",	HW_CLKOUTCLKUEN, 0 },
135*4882a593Smuzhiyun };
136*4882a593Smuzhiyun static const struct asm9260_gate_data asm9260_ahb_gates[] __initconst = {
137*4882a593Smuzhiyun 	/* ahb gates */
138*4882a593Smuzhiyun 	{ CLKID_AHB_ROM,	"rom",		"ahb_div",
139*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	1, CLK_IGNORE_UNUSED},
140*4882a593Smuzhiyun 	{ CLKID_AHB_RAM,	"ram",		"ahb_div",
141*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	2, CLK_IGNORE_UNUSED},
142*4882a593Smuzhiyun 	{ CLKID_AHB_GPIO,	"gpio",		"ahb_div",
143*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	4 },
144*4882a593Smuzhiyun 	{ CLKID_AHB_MAC,	"mac",		"ahb_div",
145*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	5 },
146*4882a593Smuzhiyun 	{ CLKID_AHB_EMI,	"emi",		"ahb_div",
147*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	6, CLK_IGNORE_UNUSED},
148*4882a593Smuzhiyun 	{ CLKID_AHB_USB0,	"usb0",		"ahb_div",
149*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	7 },
150*4882a593Smuzhiyun 	{ CLKID_AHB_USB1,	"usb1",		"ahb_div",
151*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	8 },
152*4882a593Smuzhiyun 	{ CLKID_AHB_DMA0,	"dma0",		"ahb_div",
153*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	9 },
154*4882a593Smuzhiyun 	{ CLKID_AHB_DMA1,	"dma1",		"ahb_div",
155*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	10 },
156*4882a593Smuzhiyun 	{ CLKID_AHB_UART0,	"uart0",	"ahb_div",
157*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	11 },
158*4882a593Smuzhiyun 	{ CLKID_AHB_UART1,	"uart1",	"ahb_div",
159*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	12 },
160*4882a593Smuzhiyun 	{ CLKID_AHB_UART2,	"uart2",	"ahb_div",
161*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	13 },
162*4882a593Smuzhiyun 	{ CLKID_AHB_UART3,	"uart3",	"ahb_div",
163*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	14 },
164*4882a593Smuzhiyun 	{ CLKID_AHB_UART4,	"uart4",	"ahb_div",
165*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	15 },
166*4882a593Smuzhiyun 	{ CLKID_AHB_UART5,	"uart5",	"ahb_div",
167*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	16 },
168*4882a593Smuzhiyun 	{ CLKID_AHB_UART6,	"uart6",	"ahb_div",
169*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	17 },
170*4882a593Smuzhiyun 	{ CLKID_AHB_UART7,	"uart7",	"ahb_div",
171*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	18 },
172*4882a593Smuzhiyun 	{ CLKID_AHB_UART8,	"uart8",	"ahb_div",
173*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	19 },
174*4882a593Smuzhiyun 	{ CLKID_AHB_UART9,	"uart9",	"ahb_div",
175*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	20 },
176*4882a593Smuzhiyun 	{ CLKID_AHB_I2S0,	"i2s0",		"ahb_div",
177*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	21 },
178*4882a593Smuzhiyun 	{ CLKID_AHB_I2C0,	"i2c0",		"ahb_div",
179*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	22 },
180*4882a593Smuzhiyun 	{ CLKID_AHB_I2C1,	"i2c1",		"ahb_div",
181*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	23 },
182*4882a593Smuzhiyun 	{ CLKID_AHB_SSP0,	"ssp0",		"ahb_div",
183*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	24 },
184*4882a593Smuzhiyun 	{ CLKID_AHB_IOCONFIG,	"ioconf",	"ahb_div",
185*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	25 },
186*4882a593Smuzhiyun 	{ CLKID_AHB_WDT,	"wdt",		"ahb_div",
187*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	26 },
188*4882a593Smuzhiyun 	{ CLKID_AHB_CAN0,	"can0",		"ahb_div",
189*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	27 },
190*4882a593Smuzhiyun 	{ CLKID_AHB_CAN1,	"can1",		"ahb_div",
191*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	28 },
192*4882a593Smuzhiyun 	{ CLKID_AHB_MPWM,	"mpwm",		"ahb_div",
193*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	29 },
194*4882a593Smuzhiyun 	{ CLKID_AHB_SPI0,	"spi0",		"ahb_div",
195*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	30 },
196*4882a593Smuzhiyun 	{ CLKID_AHB_SPI1,	"spi1",		"ahb_div",
197*4882a593Smuzhiyun 		HW_AHBCLKCTRL0,	31 },
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 	{ CLKID_AHB_QEI,	"qei",		"ahb_div",
200*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	0 },
201*4882a593Smuzhiyun 	{ CLKID_AHB_QUADSPI0,	"quadspi0",	"ahb_div",
202*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	1 },
203*4882a593Smuzhiyun 	{ CLKID_AHB_CAMIF,	"capmif",	"ahb_div",
204*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	2 },
205*4882a593Smuzhiyun 	{ CLKID_AHB_LCDIF,	"lcdif",	"ahb_div",
206*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	3 },
207*4882a593Smuzhiyun 	{ CLKID_AHB_TIMER0,	"timer0",	"ahb_div",
208*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	4 },
209*4882a593Smuzhiyun 	{ CLKID_AHB_TIMER1,	"timer1",	"ahb_div",
210*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	5 },
211*4882a593Smuzhiyun 	{ CLKID_AHB_TIMER2,	"timer2",	"ahb_div",
212*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	6 },
213*4882a593Smuzhiyun 	{ CLKID_AHB_TIMER3,	"timer3",	"ahb_div",
214*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	7 },
215*4882a593Smuzhiyun 	{ CLKID_AHB_IRQ,	"irq",		"ahb_div",
216*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	8, CLK_IGNORE_UNUSED},
217*4882a593Smuzhiyun 	{ CLKID_AHB_RTC,	"rtc",		"ahb_div",
218*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	9 },
219*4882a593Smuzhiyun 	{ CLKID_AHB_NAND,	"nand",		"ahb_div",
220*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	10 },
221*4882a593Smuzhiyun 	{ CLKID_AHB_ADC0,	"adc0",		"ahb_div",
222*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	11 },
223*4882a593Smuzhiyun 	{ CLKID_AHB_LED,	"led",		"ahb_div",
224*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	12 },
225*4882a593Smuzhiyun 	{ CLKID_AHB_DAC0,	"dac0",		"ahb_div",
226*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	13 },
227*4882a593Smuzhiyun 	{ CLKID_AHB_LCD,	"lcd",		"ahb_div",
228*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	14 },
229*4882a593Smuzhiyun 	{ CLKID_AHB_I2S1,	"i2s1",		"ahb_div",
230*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	15 },
231*4882a593Smuzhiyun 	{ CLKID_AHB_MAC1,	"mac1",		"ahb_div",
232*4882a593Smuzhiyun 		HW_AHBCLKCTRL1,	16 },
233*4882a593Smuzhiyun };
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun static const char __initdata *main_mux_p[] =   { NULL, NULL };
236*4882a593Smuzhiyun static const char __initdata *i2s0_mux_p[] =   { NULL, NULL, "i2s0m_div"};
237*4882a593Smuzhiyun static const char __initdata *i2s1_mux_p[] =   { NULL, NULL, "i2s1m_div"};
238*4882a593Smuzhiyun static const char __initdata *clkout_mux_p[] = { NULL, NULL, "rtc"};
239*4882a593Smuzhiyun static u32 three_mux_table[] = {0, 1, 3};
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun static struct asm9260_mux_clock asm9260_mux_clks[] __initdata = {
242*4882a593Smuzhiyun 	{ 1, three_mux_table, "main_mux",	main_mux_p,
243*4882a593Smuzhiyun 		ARRAY_SIZE(main_mux_p), HW_MAINCLKSEL, },
244*4882a593Smuzhiyun 	{ 1, three_mux_table, "uart_mux",	main_mux_p,
245*4882a593Smuzhiyun 		ARRAY_SIZE(main_mux_p), HW_UARTCLKSEL, },
246*4882a593Smuzhiyun 	{ 1, three_mux_table, "wdt_mux",	main_mux_p,
247*4882a593Smuzhiyun 		ARRAY_SIZE(main_mux_p), HW_WDTCLKSEL, },
248*4882a593Smuzhiyun 	{ 3, three_mux_table, "i2s0_mux",	i2s0_mux_p,
249*4882a593Smuzhiyun 		ARRAY_SIZE(i2s0_mux_p), HW_I2S0CLKSEL, },
250*4882a593Smuzhiyun 	{ 3, three_mux_table, "i2s1_mux",	i2s1_mux_p,
251*4882a593Smuzhiyun 		ARRAY_SIZE(i2s1_mux_p), HW_I2S1CLKSEL, },
252*4882a593Smuzhiyun 	{ 3, three_mux_table, "clkout_mux",	clkout_mux_p,
253*4882a593Smuzhiyun 		ARRAY_SIZE(clkout_mux_p), HW_CLKOUTCLKSEL, },
254*4882a593Smuzhiyun };
255*4882a593Smuzhiyun 
asm9260_acc_init(struct device_node * np)256*4882a593Smuzhiyun static void __init asm9260_acc_init(struct device_node *np)
257*4882a593Smuzhiyun {
258*4882a593Smuzhiyun 	struct clk_hw *hw;
259*4882a593Smuzhiyun 	struct clk_hw **hws;
260*4882a593Smuzhiyun 	const char *ref_clk, *pll_clk = "pll";
261*4882a593Smuzhiyun 	u32 rate;
262*4882a593Smuzhiyun 	int n;
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	clk_data = kzalloc(struct_size(clk_data, hws, MAX_CLKS), GFP_KERNEL);
265*4882a593Smuzhiyun 	if (!clk_data)
266*4882a593Smuzhiyun 		return;
267*4882a593Smuzhiyun 	clk_data->num = MAX_CLKS;
268*4882a593Smuzhiyun 	hws = clk_data->hws;
269*4882a593Smuzhiyun 
270*4882a593Smuzhiyun 	base = of_io_request_and_map(np, 0, np->name);
271*4882a593Smuzhiyun 	if (IS_ERR(base))
272*4882a593Smuzhiyun 		panic("%pOFn: unable to map resource", np);
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun 	/* register pll */
275*4882a593Smuzhiyun 	rate = (ioread32(base + HW_SYSPLLCTRL) & 0xffff) * 1000000;
276*4882a593Smuzhiyun 
277*4882a593Smuzhiyun 	/* TODO: Convert to DT parent scheme */
278*4882a593Smuzhiyun 	ref_clk = of_clk_get_parent_name(np, 0);
279*4882a593Smuzhiyun 	hw = __clk_hw_register_fixed_rate(NULL, NULL, pll_clk,
280*4882a593Smuzhiyun 			ref_clk, NULL, NULL, 0, rate, 0,
281*4882a593Smuzhiyun 			CLK_FIXED_RATE_PARENT_ACCURACY);
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun 	if (IS_ERR(hw))
284*4882a593Smuzhiyun 		panic("%pOFn: can't register REFCLK. Check DT!", np);
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	for (n = 0; n < ARRAY_SIZE(asm9260_mux_clks); n++) {
287*4882a593Smuzhiyun 		const struct asm9260_mux_clock *mc = &asm9260_mux_clks[n];
288*4882a593Smuzhiyun 
289*4882a593Smuzhiyun 		mc->parent_names[0] = ref_clk;
290*4882a593Smuzhiyun 		mc->parent_names[1] = pll_clk;
291*4882a593Smuzhiyun 		hw = clk_hw_register_mux_table(NULL, mc->name, mc->parent_names,
292*4882a593Smuzhiyun 				mc->num_parents, mc->flags, base + mc->offset,
293*4882a593Smuzhiyun 				0, mc->mask, 0, mc->table, &asm9260_clk_lock);
294*4882a593Smuzhiyun 	}
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	/* clock mux gate cells */
297*4882a593Smuzhiyun 	for (n = 0; n < ARRAY_SIZE(asm9260_mux_gates); n++) {
298*4882a593Smuzhiyun 		const struct asm9260_gate_data *gd = &asm9260_mux_gates[n];
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 		hw = clk_hw_register_gate(NULL, gd->name,
301*4882a593Smuzhiyun 			gd->parent_name, gd->flags | CLK_SET_RATE_PARENT,
302*4882a593Smuzhiyun 			base + gd->reg, gd->bit_idx, 0, &asm9260_clk_lock);
303*4882a593Smuzhiyun 	}
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 	/* clock div cells */
306*4882a593Smuzhiyun 	for (n = 0; n < ARRAY_SIZE(asm9260_div_clks); n++) {
307*4882a593Smuzhiyun 		const struct asm9260_div_clk *dc = &asm9260_div_clks[n];
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 		hws[dc->idx] = clk_hw_register_divider(NULL, dc->name,
310*4882a593Smuzhiyun 				dc->parent_name, CLK_SET_RATE_PARENT,
311*4882a593Smuzhiyun 				base + dc->reg, 0, 8, CLK_DIVIDER_ONE_BASED,
312*4882a593Smuzhiyun 				&asm9260_clk_lock);
313*4882a593Smuzhiyun 	}
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	/* clock ahb gate cells */
316*4882a593Smuzhiyun 	for (n = 0; n < ARRAY_SIZE(asm9260_ahb_gates); n++) {
317*4882a593Smuzhiyun 		const struct asm9260_gate_data *gd = &asm9260_ahb_gates[n];
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 		hws[gd->idx] = clk_hw_register_gate(NULL, gd->name,
320*4882a593Smuzhiyun 				gd->parent_name, gd->flags, base + gd->reg,
321*4882a593Smuzhiyun 				gd->bit_idx, 0, &asm9260_clk_lock);
322*4882a593Smuzhiyun 	}
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 	/* check for errors on leaf clocks */
325*4882a593Smuzhiyun 	for (n = 0; n < MAX_CLKS; n++) {
326*4882a593Smuzhiyun 		if (!IS_ERR(hws[n]))
327*4882a593Smuzhiyun 			continue;
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun 		pr_err("%pOF: Unable to register leaf clock %d\n",
330*4882a593Smuzhiyun 				np, n);
331*4882a593Smuzhiyun 		goto fail;
332*4882a593Smuzhiyun 	}
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	/* register clk-provider */
335*4882a593Smuzhiyun 	of_clk_add_hw_provider(np, of_clk_hw_onecell_get, clk_data);
336*4882a593Smuzhiyun 	return;
337*4882a593Smuzhiyun fail:
338*4882a593Smuzhiyun 	iounmap(base);
339*4882a593Smuzhiyun }
340*4882a593Smuzhiyun CLK_OF_DECLARE(asm9260_acc, "alphascale,asm9260-clock-controller",
341*4882a593Smuzhiyun 		asm9260_acc_init);
342