xref: /OK3568_Linux_fs/kernel/drivers/clk/mmp/clk-of-pxa910.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * pxa910 clock framework source file
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * Copyright (C) 2012 Marvell
5*4882a593Smuzhiyun  * Chao Xie <xiechao.mail@gmail.com>
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * This file is licensed under the terms of the GNU General Public
8*4882a593Smuzhiyun  * License version 2. This program is licensed "as is" without any
9*4882a593Smuzhiyun  * warranty of any kind, whether express or implied.
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <linux/module.h>
13*4882a593Smuzhiyun #include <linux/kernel.h>
14*4882a593Smuzhiyun #include <linux/spinlock.h>
15*4882a593Smuzhiyun #include <linux/io.h>
16*4882a593Smuzhiyun #include <linux/delay.h>
17*4882a593Smuzhiyun #include <linux/err.h>
18*4882a593Smuzhiyun #include <linux/of_address.h>
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun #include <dt-bindings/clock/marvell,pxa910.h>
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #include "clk.h"
23*4882a593Smuzhiyun #include "reset.h"
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun #define APBC_RTC	0x28
26*4882a593Smuzhiyun #define APBC_TWSI0	0x2c
27*4882a593Smuzhiyun #define APBC_KPC	0x18
28*4882a593Smuzhiyun #define APBC_UART0	0x0
29*4882a593Smuzhiyun #define APBC_UART1	0x4
30*4882a593Smuzhiyun #define APBC_GPIO	0x8
31*4882a593Smuzhiyun #define APBC_PWM0	0xc
32*4882a593Smuzhiyun #define APBC_PWM1	0x10
33*4882a593Smuzhiyun #define APBC_PWM2	0x14
34*4882a593Smuzhiyun #define APBC_PWM3	0x18
35*4882a593Smuzhiyun #define APBC_SSP0	0x1c
36*4882a593Smuzhiyun #define APBC_SSP1	0x20
37*4882a593Smuzhiyun #define APBC_SSP2	0x4c
38*4882a593Smuzhiyun #define APBC_TIMER0	0x30
39*4882a593Smuzhiyun #define APBC_TIMER1	0x44
40*4882a593Smuzhiyun #define APBCP_TWSI1	0x28
41*4882a593Smuzhiyun #define APBCP_UART2	0x1c
42*4882a593Smuzhiyun #define APMU_SDH0	0x54
43*4882a593Smuzhiyun #define APMU_SDH1	0x58
44*4882a593Smuzhiyun #define APMU_USB	0x5c
45*4882a593Smuzhiyun #define APMU_DISP0	0x4c
46*4882a593Smuzhiyun #define APMU_CCIC0	0x50
47*4882a593Smuzhiyun #define APMU_DFC	0x60
48*4882a593Smuzhiyun #define MPMU_UART_PLL	0x14
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun struct pxa910_clk_unit {
51*4882a593Smuzhiyun 	struct mmp_clk_unit unit;
52*4882a593Smuzhiyun 	void __iomem *mpmu_base;
53*4882a593Smuzhiyun 	void __iomem *apmu_base;
54*4882a593Smuzhiyun 	void __iomem *apbc_base;
55*4882a593Smuzhiyun 	void __iomem *apbcp_base;
56*4882a593Smuzhiyun };
57*4882a593Smuzhiyun 
58*4882a593Smuzhiyun static struct mmp_param_fixed_rate_clk fixed_rate_clks[] = {
59*4882a593Smuzhiyun 	{PXA910_CLK_CLK32, "clk32", NULL, 0, 32768},
60*4882a593Smuzhiyun 	{PXA910_CLK_VCTCXO, "vctcxo", NULL, 0, 26000000},
61*4882a593Smuzhiyun 	{PXA910_CLK_PLL1, "pll1", NULL, 0, 624000000},
62*4882a593Smuzhiyun 	{PXA910_CLK_USB_PLL, "usb_pll", NULL, 0, 480000000},
63*4882a593Smuzhiyun };
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun static struct mmp_param_fixed_factor_clk fixed_factor_clks[] = {
66*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_2, "pll1_2", "pll1", 1, 2, 0},
67*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_4, "pll1_4", "pll1_2", 1, 2, 0},
68*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_8, "pll1_8", "pll1_4", 1, 2, 0},
69*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_16, "pll1_16", "pll1_8", 1, 2, 0},
70*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_6, "pll1_6", "pll1_2", 1, 3, 0},
71*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_12, "pll1_12", "pll1_6", 1, 2, 0},
72*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_24, "pll1_24", "pll1_12", 1, 2, 0},
73*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_48, "pll1_48", "pll1_24", 1, 2, 0},
74*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_96, "pll1_96", "pll1_48", 1, 2, 0},
75*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_192, "pll1_192", "pll1_96", 1, 2, 0},
76*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_13, "pll1_13", "pll1", 1, 13, 0},
77*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_13_1_5, "pll1_13_1_5", "pll1_13", 2, 3, 0},
78*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_2_1_5, "pll1_2_1_5", "pll1_2", 2, 3, 0},
79*4882a593Smuzhiyun 	{PXA910_CLK_PLL1_3_16, "pll1_3_16", "pll1", 3, 16, 0},
80*4882a593Smuzhiyun };
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun static struct mmp_clk_factor_masks uart_factor_masks = {
83*4882a593Smuzhiyun 	.factor = 2,
84*4882a593Smuzhiyun 	.num_mask = 0x1fff,
85*4882a593Smuzhiyun 	.den_mask = 0x1fff,
86*4882a593Smuzhiyun 	.num_shift = 16,
87*4882a593Smuzhiyun 	.den_shift = 0,
88*4882a593Smuzhiyun };
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun static struct mmp_clk_factor_tbl uart_factor_tbl[] = {
91*4882a593Smuzhiyun 	{.num = 8125, .den = 1536},	/*14.745MHZ */
92*4882a593Smuzhiyun };
93*4882a593Smuzhiyun 
pxa910_pll_init(struct pxa910_clk_unit * pxa_unit)94*4882a593Smuzhiyun static void pxa910_pll_init(struct pxa910_clk_unit *pxa_unit)
95*4882a593Smuzhiyun {
96*4882a593Smuzhiyun 	struct clk *clk;
97*4882a593Smuzhiyun 	struct mmp_clk_unit *unit = &pxa_unit->unit;
98*4882a593Smuzhiyun 
99*4882a593Smuzhiyun 	mmp_register_fixed_rate_clks(unit, fixed_rate_clks,
100*4882a593Smuzhiyun 					ARRAY_SIZE(fixed_rate_clks));
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun 	mmp_register_fixed_factor_clks(unit, fixed_factor_clks,
103*4882a593Smuzhiyun 					ARRAY_SIZE(fixed_factor_clks));
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 	clk = mmp_clk_register_factor("uart_pll", "pll1_4",
106*4882a593Smuzhiyun 				CLK_SET_RATE_PARENT,
107*4882a593Smuzhiyun 				pxa_unit->mpmu_base + MPMU_UART_PLL,
108*4882a593Smuzhiyun 				&uart_factor_masks, uart_factor_tbl,
109*4882a593Smuzhiyun 				ARRAY_SIZE(uart_factor_tbl), NULL);
110*4882a593Smuzhiyun 	mmp_clk_add(unit, PXA910_CLK_UART_PLL, clk);
111*4882a593Smuzhiyun }
112*4882a593Smuzhiyun 
113*4882a593Smuzhiyun static DEFINE_SPINLOCK(uart0_lock);
114*4882a593Smuzhiyun static DEFINE_SPINLOCK(uart1_lock);
115*4882a593Smuzhiyun static DEFINE_SPINLOCK(uart2_lock);
116*4882a593Smuzhiyun static const char *uart_parent_names[] = {"pll1_3_16", "uart_pll"};
117*4882a593Smuzhiyun 
118*4882a593Smuzhiyun static DEFINE_SPINLOCK(ssp0_lock);
119*4882a593Smuzhiyun static DEFINE_SPINLOCK(ssp1_lock);
120*4882a593Smuzhiyun static const char *ssp_parent_names[] = {"pll1_96", "pll1_48", "pll1_24", "pll1_12"};
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun static DEFINE_SPINLOCK(timer0_lock);
123*4882a593Smuzhiyun static DEFINE_SPINLOCK(timer1_lock);
124*4882a593Smuzhiyun static const char *timer_parent_names[] = {"pll1_48", "clk32", "pll1_96"};
125*4882a593Smuzhiyun 
126*4882a593Smuzhiyun static DEFINE_SPINLOCK(reset_lock);
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun static struct mmp_param_mux_clk apbc_mux_clks[] = {
129*4882a593Smuzhiyun 	{0, "uart0_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBC_UART0, 4, 3, 0, &uart0_lock},
130*4882a593Smuzhiyun 	{0, "uart1_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBC_UART1, 4, 3, 0, &uart1_lock},
131*4882a593Smuzhiyun 	{0, "ssp0_mux", ssp_parent_names, ARRAY_SIZE(ssp_parent_names), CLK_SET_RATE_PARENT, APBC_SSP0, 4, 3, 0, &ssp0_lock},
132*4882a593Smuzhiyun 	{0, "ssp1_mux", ssp_parent_names, ARRAY_SIZE(ssp_parent_names), CLK_SET_RATE_PARENT, APBC_SSP1, 4, 3, 0, &ssp1_lock},
133*4882a593Smuzhiyun 	{0, "timer0_mux", timer_parent_names, ARRAY_SIZE(timer_parent_names), CLK_SET_RATE_PARENT, APBC_TIMER0, 4, 3, 0, &timer0_lock},
134*4882a593Smuzhiyun 	{0, "timer1_mux", timer_parent_names, ARRAY_SIZE(timer_parent_names), CLK_SET_RATE_PARENT, APBC_TIMER1, 4, 3, 0, &timer1_lock},
135*4882a593Smuzhiyun };
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun static struct mmp_param_mux_clk apbcp_mux_clks[] = {
138*4882a593Smuzhiyun 	{0, "uart2_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBCP_UART2, 4, 3, 0, &uart2_lock},
139*4882a593Smuzhiyun };
140*4882a593Smuzhiyun 
141*4882a593Smuzhiyun static struct mmp_param_gate_clk apbc_gate_clks[] = {
142*4882a593Smuzhiyun 	{PXA910_CLK_TWSI0, "twsi0_clk", "pll1_13_1_5", CLK_SET_RATE_PARENT, APBC_TWSI0, 0x3, 0x3, 0x0, 0, &reset_lock},
143*4882a593Smuzhiyun 	{PXA910_CLK_GPIO, "gpio_clk", "vctcxo", CLK_SET_RATE_PARENT, APBC_GPIO, 0x3, 0x3, 0x0, 0, &reset_lock},
144*4882a593Smuzhiyun 	{PXA910_CLK_KPC, "kpc_clk", "clk32", CLK_SET_RATE_PARENT, APBC_KPC, 0x3, 0x3, 0x0, MMP_CLK_GATE_NEED_DELAY, NULL},
145*4882a593Smuzhiyun 	{PXA910_CLK_RTC, "rtc_clk", "clk32", CLK_SET_RATE_PARENT, APBC_RTC, 0x83, 0x83, 0x0, MMP_CLK_GATE_NEED_DELAY, NULL},
146*4882a593Smuzhiyun 	{PXA910_CLK_PWM0, "pwm0_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM0, 0x3, 0x3, 0x0, 0, &reset_lock},
147*4882a593Smuzhiyun 	{PXA910_CLK_PWM1, "pwm1_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM1, 0x3, 0x3, 0x0, 0, &reset_lock},
148*4882a593Smuzhiyun 	{PXA910_CLK_PWM2, "pwm2_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM2, 0x3, 0x3, 0x0, 0, &reset_lock},
149*4882a593Smuzhiyun 	{PXA910_CLK_PWM3, "pwm3_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM3, 0x3, 0x3, 0x0, 0, &reset_lock},
150*4882a593Smuzhiyun 	/* The gate clocks has mux parent. */
151*4882a593Smuzhiyun 	{PXA910_CLK_UART0, "uart0_clk", "uart0_mux", CLK_SET_RATE_PARENT, APBC_UART0, 0x3, 0x3, 0x0, 0, &uart0_lock},
152*4882a593Smuzhiyun 	{PXA910_CLK_UART1, "uart1_clk", "uart1_mux", CLK_SET_RATE_PARENT, APBC_UART1, 0x3, 0x3, 0x0, 0, &uart1_lock},
153*4882a593Smuzhiyun 	{PXA910_CLK_SSP0, "ssp0_clk", "ssp0_mux", CLK_SET_RATE_PARENT, APBC_SSP0, 0x3, 0x3, 0x0, 0, &ssp0_lock},
154*4882a593Smuzhiyun 	{PXA910_CLK_SSP1, "ssp1_clk", "ssp1_mux", CLK_SET_RATE_PARENT, APBC_SSP1, 0x3, 0x3, 0x0, 0, &ssp1_lock},
155*4882a593Smuzhiyun 	{PXA910_CLK_TIMER0, "timer0_clk", "timer0_mux", CLK_SET_RATE_PARENT, APBC_TIMER0, 0x3, 0x3, 0x0, 0, &timer0_lock},
156*4882a593Smuzhiyun 	{PXA910_CLK_TIMER1, "timer1_clk", "timer1_mux", CLK_SET_RATE_PARENT, APBC_TIMER1, 0x3, 0x3, 0x0, 0, &timer1_lock},
157*4882a593Smuzhiyun };
158*4882a593Smuzhiyun 
159*4882a593Smuzhiyun static struct mmp_param_gate_clk apbcp_gate_clks[] = {
160*4882a593Smuzhiyun 	{PXA910_CLK_TWSI1, "twsi1_clk", "pll1_13_1_5", CLK_SET_RATE_PARENT, APBCP_TWSI1, 0x3, 0x3, 0x0, 0, &reset_lock},
161*4882a593Smuzhiyun 	/* The gate clocks has mux parent. */
162*4882a593Smuzhiyun 	{PXA910_CLK_UART2, "uart2_clk", "uart2_mux", CLK_SET_RATE_PARENT, APBCP_UART2, 0x3, 0x3, 0x0, 0, &uart2_lock},
163*4882a593Smuzhiyun };
164*4882a593Smuzhiyun 
pxa910_apb_periph_clk_init(struct pxa910_clk_unit * pxa_unit)165*4882a593Smuzhiyun static void pxa910_apb_periph_clk_init(struct pxa910_clk_unit *pxa_unit)
166*4882a593Smuzhiyun {
167*4882a593Smuzhiyun 	struct mmp_clk_unit *unit = &pxa_unit->unit;
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 	mmp_register_mux_clks(unit, apbc_mux_clks, pxa_unit->apbc_base,
170*4882a593Smuzhiyun 				ARRAY_SIZE(apbc_mux_clks));
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 	mmp_register_mux_clks(unit, apbcp_mux_clks, pxa_unit->apbcp_base,
173*4882a593Smuzhiyun 				ARRAY_SIZE(apbcp_mux_clks));
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun 	mmp_register_gate_clks(unit, apbc_gate_clks, pxa_unit->apbc_base,
176*4882a593Smuzhiyun 				ARRAY_SIZE(apbc_gate_clks));
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 	mmp_register_gate_clks(unit, apbcp_gate_clks, pxa_unit->apbcp_base,
179*4882a593Smuzhiyun 				ARRAY_SIZE(apbcp_gate_clks));
180*4882a593Smuzhiyun }
181*4882a593Smuzhiyun 
182*4882a593Smuzhiyun static DEFINE_SPINLOCK(sdh0_lock);
183*4882a593Smuzhiyun static DEFINE_SPINLOCK(sdh1_lock);
184*4882a593Smuzhiyun static const char *sdh_parent_names[] = {"pll1_12", "pll1_13"};
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun static DEFINE_SPINLOCK(usb_lock);
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun static DEFINE_SPINLOCK(disp0_lock);
189*4882a593Smuzhiyun static const char *disp_parent_names[] = {"pll1_2", "pll1_12"};
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun static DEFINE_SPINLOCK(ccic0_lock);
192*4882a593Smuzhiyun static const char *ccic_parent_names[] = {"pll1_2", "pll1_12"};
193*4882a593Smuzhiyun static const char *ccic_phy_parent_names[] = {"pll1_6", "pll1_12"};
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun static struct mmp_param_mux_clk apmu_mux_clks[] = {
196*4882a593Smuzhiyun 	{0, "sdh0_mux", sdh_parent_names, ARRAY_SIZE(sdh_parent_names), CLK_SET_RATE_PARENT, APMU_SDH0, 6, 1, 0, &sdh0_lock},
197*4882a593Smuzhiyun 	{0, "sdh1_mux", sdh_parent_names, ARRAY_SIZE(sdh_parent_names), CLK_SET_RATE_PARENT, APMU_SDH1, 6, 1, 0, &sdh1_lock},
198*4882a593Smuzhiyun 	{0, "disp0_mux", disp_parent_names, ARRAY_SIZE(disp_parent_names), CLK_SET_RATE_PARENT, APMU_DISP0, 6, 1, 0, &disp0_lock},
199*4882a593Smuzhiyun 	{0, "ccic0_mux", ccic_parent_names, ARRAY_SIZE(ccic_parent_names), CLK_SET_RATE_PARENT, APMU_CCIC0, 6, 1, 0, &ccic0_lock},
200*4882a593Smuzhiyun 	{0, "ccic0_phy_mux", ccic_phy_parent_names, ARRAY_SIZE(ccic_phy_parent_names), CLK_SET_RATE_PARENT, APMU_CCIC0, 7, 1, 0, &ccic0_lock},
201*4882a593Smuzhiyun };
202*4882a593Smuzhiyun 
203*4882a593Smuzhiyun static struct mmp_param_div_clk apmu_div_clks[] = {
204*4882a593Smuzhiyun 	{0, "ccic0_sphy_div", "ccic0_mux", CLK_SET_RATE_PARENT, APMU_CCIC0, 10, 5, 0, &ccic0_lock},
205*4882a593Smuzhiyun };
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun static struct mmp_param_gate_clk apmu_gate_clks[] = {
208*4882a593Smuzhiyun 	{PXA910_CLK_DFC, "dfc_clk", "pll1_4", CLK_SET_RATE_PARENT, APMU_DFC, 0x19b, 0x19b, 0x0, 0, NULL},
209*4882a593Smuzhiyun 	{PXA910_CLK_USB, "usb_clk", "usb_pll", 0, APMU_USB, 0x9, 0x9, 0x0, 0, &usb_lock},
210*4882a593Smuzhiyun 	{PXA910_CLK_SPH, "sph_clk", "usb_pll", 0, APMU_USB, 0x12, 0x12, 0x0, 0, &usb_lock},
211*4882a593Smuzhiyun 	/* The gate clocks has mux parent. */
212*4882a593Smuzhiyun 	{PXA910_CLK_SDH0, "sdh0_clk", "sdh0_mux", CLK_SET_RATE_PARENT, APMU_SDH0, 0x1b, 0x1b, 0x0, 0, &sdh0_lock},
213*4882a593Smuzhiyun 	{PXA910_CLK_SDH1, "sdh1_clk", "sdh1_mux", CLK_SET_RATE_PARENT, APMU_SDH1, 0x1b, 0x1b, 0x0, 0, &sdh1_lock},
214*4882a593Smuzhiyun 	{PXA910_CLK_DISP0, "disp0_clk", "disp0_mux", CLK_SET_RATE_PARENT, APMU_DISP0, 0x1b, 0x1b, 0x0, 0, &disp0_lock},
215*4882a593Smuzhiyun 	{PXA910_CLK_CCIC0, "ccic0_clk", "ccic0_mux", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x1b, 0x1b, 0x0, 0, &ccic0_lock},
216*4882a593Smuzhiyun 	{PXA910_CLK_CCIC0_PHY, "ccic0_phy_clk", "ccic0_phy_mux", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x24, 0x24, 0x0, 0, &ccic0_lock},
217*4882a593Smuzhiyun 	{PXA910_CLK_CCIC0_SPHY, "ccic0_sphy_clk", "ccic0_sphy_div", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x300, 0x300, 0x0, 0, &ccic0_lock},
218*4882a593Smuzhiyun };
219*4882a593Smuzhiyun 
pxa910_axi_periph_clk_init(struct pxa910_clk_unit * pxa_unit)220*4882a593Smuzhiyun static void pxa910_axi_periph_clk_init(struct pxa910_clk_unit *pxa_unit)
221*4882a593Smuzhiyun {
222*4882a593Smuzhiyun 	struct mmp_clk_unit *unit = &pxa_unit->unit;
223*4882a593Smuzhiyun 
224*4882a593Smuzhiyun 	mmp_register_mux_clks(unit, apmu_mux_clks, pxa_unit->apmu_base,
225*4882a593Smuzhiyun 				ARRAY_SIZE(apmu_mux_clks));
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun 	mmp_register_div_clks(unit, apmu_div_clks, pxa_unit->apmu_base,
228*4882a593Smuzhiyun 				ARRAY_SIZE(apmu_div_clks));
229*4882a593Smuzhiyun 
230*4882a593Smuzhiyun 	mmp_register_gate_clks(unit, apmu_gate_clks, pxa_unit->apmu_base,
231*4882a593Smuzhiyun 				ARRAY_SIZE(apmu_gate_clks));
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun 
pxa910_clk_reset_init(struct device_node * np,struct pxa910_clk_unit * pxa_unit)234*4882a593Smuzhiyun static void pxa910_clk_reset_init(struct device_node *np,
235*4882a593Smuzhiyun 				struct pxa910_clk_unit *pxa_unit)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun 	struct mmp_clk_reset_cell *cells;
238*4882a593Smuzhiyun 	int i, base, nr_resets_apbc, nr_resets_apbcp, nr_resets;
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun 	nr_resets_apbc = ARRAY_SIZE(apbc_gate_clks);
241*4882a593Smuzhiyun 	nr_resets_apbcp = ARRAY_SIZE(apbcp_gate_clks);
242*4882a593Smuzhiyun 	nr_resets = nr_resets_apbc + nr_resets_apbcp;
243*4882a593Smuzhiyun 	cells = kcalloc(nr_resets, sizeof(*cells), GFP_KERNEL);
244*4882a593Smuzhiyun 	if (!cells)
245*4882a593Smuzhiyun 		return;
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	base = 0;
248*4882a593Smuzhiyun 	for (i = 0; i < nr_resets_apbc; i++) {
249*4882a593Smuzhiyun 		cells[base + i].clk_id = apbc_gate_clks[i].id;
250*4882a593Smuzhiyun 		cells[base + i].reg =
251*4882a593Smuzhiyun 			pxa_unit->apbc_base + apbc_gate_clks[i].offset;
252*4882a593Smuzhiyun 		cells[base + i].flags = 0;
253*4882a593Smuzhiyun 		cells[base + i].lock = apbc_gate_clks[i].lock;
254*4882a593Smuzhiyun 		cells[base + i].bits = 0x4;
255*4882a593Smuzhiyun 	}
256*4882a593Smuzhiyun 
257*4882a593Smuzhiyun 	base = nr_resets_apbc;
258*4882a593Smuzhiyun 	for (i = 0; i < nr_resets_apbcp; i++) {
259*4882a593Smuzhiyun 		cells[base + i].clk_id = apbcp_gate_clks[i].id;
260*4882a593Smuzhiyun 		cells[base + i].reg =
261*4882a593Smuzhiyun 			pxa_unit->apbc_base + apbc_gate_clks[i].offset;
262*4882a593Smuzhiyun 		cells[base + i].flags = 0;
263*4882a593Smuzhiyun 		cells[base + i].lock = apbc_gate_clks[i].lock;
264*4882a593Smuzhiyun 		cells[base + i].bits = 0x4;
265*4882a593Smuzhiyun 	}
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 	mmp_clk_reset_register(np, cells, nr_resets);
268*4882a593Smuzhiyun }
269*4882a593Smuzhiyun 
pxa910_clk_init(struct device_node * np)270*4882a593Smuzhiyun static void __init pxa910_clk_init(struct device_node *np)
271*4882a593Smuzhiyun {
272*4882a593Smuzhiyun 	struct pxa910_clk_unit *pxa_unit;
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun 	pxa_unit = kzalloc(sizeof(*pxa_unit), GFP_KERNEL);
275*4882a593Smuzhiyun 	if (!pxa_unit)
276*4882a593Smuzhiyun 		return;
277*4882a593Smuzhiyun 
278*4882a593Smuzhiyun 	pxa_unit->mpmu_base = of_iomap(np, 0);
279*4882a593Smuzhiyun 	if (!pxa_unit->mpmu_base) {
280*4882a593Smuzhiyun 		pr_err("failed to map mpmu registers\n");
281*4882a593Smuzhiyun 		goto free_memory;
282*4882a593Smuzhiyun 	}
283*4882a593Smuzhiyun 
284*4882a593Smuzhiyun 	pxa_unit->apmu_base = of_iomap(np, 1);
285*4882a593Smuzhiyun 	if (!pxa_unit->apmu_base) {
286*4882a593Smuzhiyun 		pr_err("failed to map apmu registers\n");
287*4882a593Smuzhiyun 		goto unmap_mpmu_region;
288*4882a593Smuzhiyun 	}
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 	pxa_unit->apbc_base = of_iomap(np, 2);
291*4882a593Smuzhiyun 	if (!pxa_unit->apbc_base) {
292*4882a593Smuzhiyun 		pr_err("failed to map apbc registers\n");
293*4882a593Smuzhiyun 		goto unmap_apmu_region;
294*4882a593Smuzhiyun 	}
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	pxa_unit->apbcp_base = of_iomap(np, 3);
297*4882a593Smuzhiyun 	if (!pxa_unit->apbcp_base) {
298*4882a593Smuzhiyun 		pr_err("failed to map apbcp registers\n");
299*4882a593Smuzhiyun 		goto unmap_apbc_region;
300*4882a593Smuzhiyun 	}
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 	mmp_clk_init(np, &pxa_unit->unit, PXA910_NR_CLKS);
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	pxa910_pll_init(pxa_unit);
305*4882a593Smuzhiyun 
306*4882a593Smuzhiyun 	pxa910_apb_periph_clk_init(pxa_unit);
307*4882a593Smuzhiyun 
308*4882a593Smuzhiyun 	pxa910_axi_periph_clk_init(pxa_unit);
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	pxa910_clk_reset_init(np, pxa_unit);
311*4882a593Smuzhiyun 
312*4882a593Smuzhiyun 	return;
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun unmap_apbc_region:
315*4882a593Smuzhiyun 	iounmap(pxa_unit->apbc_base);
316*4882a593Smuzhiyun unmap_apmu_region:
317*4882a593Smuzhiyun 	iounmap(pxa_unit->apmu_base);
318*4882a593Smuzhiyun unmap_mpmu_region:
319*4882a593Smuzhiyun 	iounmap(pxa_unit->mpmu_base);
320*4882a593Smuzhiyun free_memory:
321*4882a593Smuzhiyun 	kfree(pxa_unit);
322*4882a593Smuzhiyun }
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun CLK_OF_DECLARE(pxa910_clk, "marvell,pxa910-clock", pxa910_clk_init);
325