xref: /OK3568_Linux_fs/kernel/drivers/clk/at91/sama5d2.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun #include <linux/clk-provider.h>
3*4882a593Smuzhiyun #include <linux/mfd/syscon.h>
4*4882a593Smuzhiyun #include <linux/slab.h>
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun #include <dt-bindings/clock/at91.h>
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #include "pmc.h"
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun static const struct clk_master_characteristics mck_characteristics = {
11*4882a593Smuzhiyun 	.output = { .min = 124000000, .max = 166000000 },
12*4882a593Smuzhiyun 	.divisors = { 1, 2, 4, 3 },
13*4882a593Smuzhiyun };
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun static u8 plla_out[] = { 0 };
16*4882a593Smuzhiyun 
17*4882a593Smuzhiyun static u16 plla_icpll[] = { 0 };
18*4882a593Smuzhiyun 
19*4882a593Smuzhiyun static const struct clk_range plla_outputs[] = {
20*4882a593Smuzhiyun 	{ .min = 600000000, .max = 1200000000 },
21*4882a593Smuzhiyun };
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun static const struct clk_pll_characteristics plla_characteristics = {
24*4882a593Smuzhiyun 	.input = { .min = 12000000, .max = 24000000 },
25*4882a593Smuzhiyun 	.num_output = ARRAY_SIZE(plla_outputs),
26*4882a593Smuzhiyun 	.output = plla_outputs,
27*4882a593Smuzhiyun 	.icpll = plla_icpll,
28*4882a593Smuzhiyun 	.out = plla_out,
29*4882a593Smuzhiyun };
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun static const struct clk_pcr_layout sama5d2_pcr_layout = {
32*4882a593Smuzhiyun 	.offset = 0x10c,
33*4882a593Smuzhiyun 	.cmd = BIT(12),
34*4882a593Smuzhiyun 	.gckcss_mask = GENMASK(10, 8),
35*4882a593Smuzhiyun 	.pid_mask = GENMASK(6, 0),
36*4882a593Smuzhiyun };
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun static const struct {
39*4882a593Smuzhiyun 	char *n;
40*4882a593Smuzhiyun 	char *p;
41*4882a593Smuzhiyun 	u8 id;
42*4882a593Smuzhiyun } sama5d2_systemck[] = {
43*4882a593Smuzhiyun 	{ .n = "ddrck", .p = "masterck", .id = 2 },
44*4882a593Smuzhiyun 	{ .n = "lcdck", .p = "masterck", .id = 3 },
45*4882a593Smuzhiyun 	{ .n = "uhpck", .p = "usbck",    .id = 6 },
46*4882a593Smuzhiyun 	{ .n = "udpck", .p = "usbck",    .id = 7 },
47*4882a593Smuzhiyun 	{ .n = "pck0",  .p = "prog0",    .id = 8 },
48*4882a593Smuzhiyun 	{ .n = "pck1",  .p = "prog1",    .id = 9 },
49*4882a593Smuzhiyun 	{ .n = "pck2",  .p = "prog2",    .id = 10 },
50*4882a593Smuzhiyun 	{ .n = "iscck", .p = "masterck", .id = 18 },
51*4882a593Smuzhiyun };
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun static const struct {
54*4882a593Smuzhiyun 	char *n;
55*4882a593Smuzhiyun 	u8 id;
56*4882a593Smuzhiyun 	struct clk_range r;
57*4882a593Smuzhiyun } sama5d2_periph32ck[] = {
58*4882a593Smuzhiyun 	{ .n = "macb0_clk",   .id = 5,  .r = { .min = 0, .max = 83000000 }, },
59*4882a593Smuzhiyun 	{ .n = "tdes_clk",    .id = 11, .r = { .min = 0, .max = 83000000 }, },
60*4882a593Smuzhiyun 	{ .n = "matrix1_clk", .id = 14, },
61*4882a593Smuzhiyun 	{ .n = "hsmc_clk",    .id = 17, },
62*4882a593Smuzhiyun 	{ .n = "pioA_clk",    .id = 18, .r = { .min = 0, .max = 83000000 }, },
63*4882a593Smuzhiyun 	{ .n = "flx0_clk",    .id = 19, .r = { .min = 0, .max = 83000000 }, },
64*4882a593Smuzhiyun 	{ .n = "flx1_clk",    .id = 20, .r = { .min = 0, .max = 83000000 }, },
65*4882a593Smuzhiyun 	{ .n = "flx2_clk",    .id = 21, .r = { .min = 0, .max = 83000000 }, },
66*4882a593Smuzhiyun 	{ .n = "flx3_clk",    .id = 22, .r = { .min = 0, .max = 83000000 }, },
67*4882a593Smuzhiyun 	{ .n = "flx4_clk",    .id = 23, .r = { .min = 0, .max = 83000000 }, },
68*4882a593Smuzhiyun 	{ .n = "uart0_clk",   .id = 24, .r = { .min = 0, .max = 83000000 }, },
69*4882a593Smuzhiyun 	{ .n = "uart1_clk",   .id = 25, .r = { .min = 0, .max = 83000000 }, },
70*4882a593Smuzhiyun 	{ .n = "uart2_clk",   .id = 26, .r = { .min = 0, .max = 83000000 }, },
71*4882a593Smuzhiyun 	{ .n = "uart3_clk",   .id = 27, .r = { .min = 0, .max = 83000000 }, },
72*4882a593Smuzhiyun 	{ .n = "uart4_clk",   .id = 28, .r = { .min = 0, .max = 83000000 }, },
73*4882a593Smuzhiyun 	{ .n = "twi0_clk",    .id = 29, .r = { .min = 0, .max = 83000000 }, },
74*4882a593Smuzhiyun 	{ .n = "twi1_clk",    .id = 30, .r = { .min = 0, .max = 83000000 }, },
75*4882a593Smuzhiyun 	{ .n = "spi0_clk",    .id = 33, .r = { .min = 0, .max = 83000000 }, },
76*4882a593Smuzhiyun 	{ .n = "spi1_clk",    .id = 34, .r = { .min = 0, .max = 83000000 }, },
77*4882a593Smuzhiyun 	{ .n = "tcb0_clk",    .id = 35, .r = { .min = 0, .max = 83000000 }, },
78*4882a593Smuzhiyun 	{ .n = "tcb1_clk",    .id = 36, .r = { .min = 0, .max = 83000000 }, },
79*4882a593Smuzhiyun 	{ .n = "pwm_clk",     .id = 38, .r = { .min = 0, .max = 83000000 }, },
80*4882a593Smuzhiyun 	{ .n = "adc_clk",     .id = 40, .r = { .min = 0, .max = 83000000 }, },
81*4882a593Smuzhiyun 	{ .n = "uhphs_clk",   .id = 41, .r = { .min = 0, .max = 83000000 }, },
82*4882a593Smuzhiyun 	{ .n = "udphs_clk",   .id = 42, .r = { .min = 0, .max = 83000000 }, },
83*4882a593Smuzhiyun 	{ .n = "ssc0_clk",    .id = 43, .r = { .min = 0, .max = 83000000 }, },
84*4882a593Smuzhiyun 	{ .n = "ssc1_clk",    .id = 44, .r = { .min = 0, .max = 83000000 }, },
85*4882a593Smuzhiyun 	{ .n = "trng_clk",    .id = 47, .r = { .min = 0, .max = 83000000 }, },
86*4882a593Smuzhiyun 	{ .n = "pdmic_clk",   .id = 48, .r = { .min = 0, .max = 83000000 }, },
87*4882a593Smuzhiyun 	{ .n = "securam_clk", .id = 51, },
88*4882a593Smuzhiyun 	{ .n = "i2s0_clk",    .id = 54, .r = { .min = 0, .max = 83000000 }, },
89*4882a593Smuzhiyun 	{ .n = "i2s1_clk",    .id = 55, .r = { .min = 0, .max = 83000000 }, },
90*4882a593Smuzhiyun 	{ .n = "can0_clk",    .id = 56, .r = { .min = 0, .max = 83000000 }, },
91*4882a593Smuzhiyun 	{ .n = "can1_clk",    .id = 57, .r = { .min = 0, .max = 83000000 }, },
92*4882a593Smuzhiyun 	{ .n = "ptc_clk",     .id = 58, .r = { .min = 0, .max = 83000000 }, },
93*4882a593Smuzhiyun 	{ .n = "classd_clk",  .id = 59, .r = { .min = 0, .max = 83000000 }, },
94*4882a593Smuzhiyun };
95*4882a593Smuzhiyun 
96*4882a593Smuzhiyun static const struct {
97*4882a593Smuzhiyun 	char *n;
98*4882a593Smuzhiyun 	u8 id;
99*4882a593Smuzhiyun } sama5d2_periphck[] = {
100*4882a593Smuzhiyun 	{ .n = "dma0_clk",    .id = 6, },
101*4882a593Smuzhiyun 	{ .n = "dma1_clk",    .id = 7, },
102*4882a593Smuzhiyun 	{ .n = "aes_clk",     .id = 9, },
103*4882a593Smuzhiyun 	{ .n = "aesb_clk",    .id = 10, },
104*4882a593Smuzhiyun 	{ .n = "sha_clk",     .id = 12, },
105*4882a593Smuzhiyun 	{ .n = "mpddr_clk",   .id = 13, },
106*4882a593Smuzhiyun 	{ .n = "matrix0_clk", .id = 15, },
107*4882a593Smuzhiyun 	{ .n = "sdmmc0_hclk", .id = 31, },
108*4882a593Smuzhiyun 	{ .n = "sdmmc1_hclk", .id = 32, },
109*4882a593Smuzhiyun 	{ .n = "lcdc_clk",    .id = 45, },
110*4882a593Smuzhiyun 	{ .n = "isc_clk",     .id = 46, },
111*4882a593Smuzhiyun 	{ .n = "qspi0_clk",   .id = 52, },
112*4882a593Smuzhiyun 	{ .n = "qspi1_clk",   .id = 53, },
113*4882a593Smuzhiyun };
114*4882a593Smuzhiyun 
115*4882a593Smuzhiyun static const struct {
116*4882a593Smuzhiyun 	char *n;
117*4882a593Smuzhiyun 	u8 id;
118*4882a593Smuzhiyun 	struct clk_range r;
119*4882a593Smuzhiyun 	int chg_pid;
120*4882a593Smuzhiyun } sama5d2_gck[] = {
121*4882a593Smuzhiyun 	{ .n = "sdmmc0_gclk", .id = 31, .chg_pid = INT_MIN, },
122*4882a593Smuzhiyun 	{ .n = "sdmmc1_gclk", .id = 32, .chg_pid = INT_MIN, },
123*4882a593Smuzhiyun 	{ .n = "tcb0_gclk",   .id = 35, .chg_pid = INT_MIN, .r = { .min = 0, .max = 83000000 }, },
124*4882a593Smuzhiyun 	{ .n = "tcb1_gclk",   .id = 36, .chg_pid = INT_MIN, .r = { .min = 0, .max = 83000000 }, },
125*4882a593Smuzhiyun 	{ .n = "pwm_gclk",    .id = 38, .chg_pid = INT_MIN, .r = { .min = 0, .max = 83000000 }, },
126*4882a593Smuzhiyun 	{ .n = "isc_gclk",    .id = 46, .chg_pid = INT_MIN, },
127*4882a593Smuzhiyun 	{ .n = "pdmic_gclk",  .id = 48, .chg_pid = INT_MIN, },
128*4882a593Smuzhiyun 	{ .n = "i2s0_gclk",   .id = 54, .chg_pid = 5, },
129*4882a593Smuzhiyun 	{ .n = "i2s1_gclk",   .id = 55, .chg_pid = 5, },
130*4882a593Smuzhiyun 	{ .n = "can0_gclk",   .id = 56, .chg_pid = INT_MIN, .r = { .min = 0, .max = 80000000 }, },
131*4882a593Smuzhiyun 	{ .n = "can1_gclk",   .id = 57, .chg_pid = INT_MIN, .r = { .min = 0, .max = 80000000 }, },
132*4882a593Smuzhiyun 	{ .n = "classd_gclk", .id = 59, .chg_pid = 5, .r = { .min = 0, .max = 100000000 }, },
133*4882a593Smuzhiyun };
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun static const struct clk_programmable_layout sama5d2_programmable_layout = {
136*4882a593Smuzhiyun 	.pres_mask = 0xff,
137*4882a593Smuzhiyun 	.pres_shift = 4,
138*4882a593Smuzhiyun 	.css_mask = 0x7,
139*4882a593Smuzhiyun 	.have_slck_mck = 0,
140*4882a593Smuzhiyun 	.is_pres_direct = 1,
141*4882a593Smuzhiyun };
142*4882a593Smuzhiyun 
sama5d2_pmc_setup(struct device_node * np)143*4882a593Smuzhiyun static void __init sama5d2_pmc_setup(struct device_node *np)
144*4882a593Smuzhiyun {
145*4882a593Smuzhiyun 	struct clk_range range = CLK_RANGE(0, 0);
146*4882a593Smuzhiyun 	const char *slck_name, *mainxtal_name;
147*4882a593Smuzhiyun 	struct pmc_data *sama5d2_pmc;
148*4882a593Smuzhiyun 	const char *parent_names[6];
149*4882a593Smuzhiyun 	struct regmap *regmap, *regmap_sfr;
150*4882a593Smuzhiyun 	struct clk_hw *hw;
151*4882a593Smuzhiyun 	int i;
152*4882a593Smuzhiyun 	bool bypass;
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun 	i = of_property_match_string(np, "clock-names", "slow_clk");
155*4882a593Smuzhiyun 	if (i < 0)
156*4882a593Smuzhiyun 		return;
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun 	slck_name = of_clk_get_parent_name(np, i);
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 	i = of_property_match_string(np, "clock-names", "main_xtal");
161*4882a593Smuzhiyun 	if (i < 0)
162*4882a593Smuzhiyun 		return;
163*4882a593Smuzhiyun 	mainxtal_name = of_clk_get_parent_name(np, i);
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 	regmap = device_node_to_regmap(np);
166*4882a593Smuzhiyun 	if (IS_ERR(regmap))
167*4882a593Smuzhiyun 		return;
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 	sama5d2_pmc = pmc_data_allocate(PMC_AUDIOPLLCK + 1,
170*4882a593Smuzhiyun 					nck(sama5d2_systemck),
171*4882a593Smuzhiyun 					nck(sama5d2_periph32ck),
172*4882a593Smuzhiyun 					nck(sama5d2_gck), 3);
173*4882a593Smuzhiyun 	if (!sama5d2_pmc)
174*4882a593Smuzhiyun 		return;
175*4882a593Smuzhiyun 
176*4882a593Smuzhiyun 	hw = at91_clk_register_main_rc_osc(regmap, "main_rc_osc", 12000000,
177*4882a593Smuzhiyun 					   100000000);
178*4882a593Smuzhiyun 	if (IS_ERR(hw))
179*4882a593Smuzhiyun 		goto err_free;
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	bypass = of_property_read_bool(np, "atmel,osc-bypass");
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	hw = at91_clk_register_main_osc(regmap, "main_osc", mainxtal_name,
184*4882a593Smuzhiyun 					bypass);
185*4882a593Smuzhiyun 	if (IS_ERR(hw))
186*4882a593Smuzhiyun 		goto err_free;
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun 	parent_names[0] = "main_rc_osc";
189*4882a593Smuzhiyun 	parent_names[1] = "main_osc";
190*4882a593Smuzhiyun 	hw = at91_clk_register_sam9x5_main(regmap, "mainck", parent_names, 2);
191*4882a593Smuzhiyun 	if (IS_ERR(hw))
192*4882a593Smuzhiyun 		goto err_free;
193*4882a593Smuzhiyun 
194*4882a593Smuzhiyun 	sama5d2_pmc->chws[PMC_MAIN] = hw;
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun 	hw = at91_clk_register_pll(regmap, "pllack", "mainck", 0,
197*4882a593Smuzhiyun 				   &sama5d3_pll_layout, &plla_characteristics);
198*4882a593Smuzhiyun 	if (IS_ERR(hw))
199*4882a593Smuzhiyun 		goto err_free;
200*4882a593Smuzhiyun 
201*4882a593Smuzhiyun 	hw = at91_clk_register_plldiv(regmap, "plladivck", "pllack");
202*4882a593Smuzhiyun 	if (IS_ERR(hw))
203*4882a593Smuzhiyun 		goto err_free;
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun 	sama5d2_pmc->chws[PMC_PLLACK] = hw;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	hw = at91_clk_register_audio_pll_frac(regmap, "audiopll_fracck",
208*4882a593Smuzhiyun 					      "mainck");
209*4882a593Smuzhiyun 	if (IS_ERR(hw))
210*4882a593Smuzhiyun 		goto err_free;
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	hw = at91_clk_register_audio_pll_pad(regmap, "audiopll_padck",
213*4882a593Smuzhiyun 					     "audiopll_fracck");
214*4882a593Smuzhiyun 	if (IS_ERR(hw))
215*4882a593Smuzhiyun 		goto err_free;
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun 	hw = at91_clk_register_audio_pll_pmc(regmap, "audiopll_pmcck",
218*4882a593Smuzhiyun 					     "audiopll_fracck");
219*4882a593Smuzhiyun 	if (IS_ERR(hw))
220*4882a593Smuzhiyun 		goto err_free;
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 	sama5d2_pmc->chws[PMC_AUDIOPLLCK] = hw;
223*4882a593Smuzhiyun 
224*4882a593Smuzhiyun 	regmap_sfr = syscon_regmap_lookup_by_compatible("atmel,sama5d2-sfr");
225*4882a593Smuzhiyun 	if (IS_ERR(regmap_sfr))
226*4882a593Smuzhiyun 		regmap_sfr = NULL;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	hw = at91_clk_register_utmi(regmap, regmap_sfr, "utmick", "mainck");
229*4882a593Smuzhiyun 	if (IS_ERR(hw))
230*4882a593Smuzhiyun 		goto err_free;
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	sama5d2_pmc->chws[PMC_UTMI] = hw;
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	parent_names[0] = slck_name;
235*4882a593Smuzhiyun 	parent_names[1] = "mainck";
236*4882a593Smuzhiyun 	parent_names[2] = "plladivck";
237*4882a593Smuzhiyun 	parent_names[3] = "utmick";
238*4882a593Smuzhiyun 	hw = at91_clk_register_master(regmap, "masterck", 4, parent_names,
239*4882a593Smuzhiyun 				      &at91sam9x5_master_layout,
240*4882a593Smuzhiyun 				      &mck_characteristics);
241*4882a593Smuzhiyun 	if (IS_ERR(hw))
242*4882a593Smuzhiyun 		goto err_free;
243*4882a593Smuzhiyun 
244*4882a593Smuzhiyun 	sama5d2_pmc->chws[PMC_MCK] = hw;
245*4882a593Smuzhiyun 
246*4882a593Smuzhiyun 	hw = at91_clk_register_h32mx(regmap, "h32mxck", "masterck");
247*4882a593Smuzhiyun 	if (IS_ERR(hw))
248*4882a593Smuzhiyun 		goto err_free;
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 	sama5d2_pmc->chws[PMC_MCK2] = hw;
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun 	parent_names[0] = "plladivck";
253*4882a593Smuzhiyun 	parent_names[1] = "utmick";
254*4882a593Smuzhiyun 	hw = at91sam9x5_clk_register_usb(regmap, "usbck", parent_names, 2);
255*4882a593Smuzhiyun 	if (IS_ERR(hw))
256*4882a593Smuzhiyun 		goto err_free;
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 	parent_names[0] = slck_name;
259*4882a593Smuzhiyun 	parent_names[1] = "mainck";
260*4882a593Smuzhiyun 	parent_names[2] = "plladivck";
261*4882a593Smuzhiyun 	parent_names[3] = "utmick";
262*4882a593Smuzhiyun 	parent_names[4] = "masterck";
263*4882a593Smuzhiyun 	parent_names[5] = "audiopll_pmcck";
264*4882a593Smuzhiyun 	for (i = 0; i < 3; i++) {
265*4882a593Smuzhiyun 		char name[6];
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 		snprintf(name, sizeof(name), "prog%d", i);
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 		hw = at91_clk_register_programmable(regmap, name,
270*4882a593Smuzhiyun 						    parent_names, 6, i,
271*4882a593Smuzhiyun 						    &sama5d2_programmable_layout,
272*4882a593Smuzhiyun 						    NULL);
273*4882a593Smuzhiyun 		if (IS_ERR(hw))
274*4882a593Smuzhiyun 			goto err_free;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 		sama5d2_pmc->pchws[i] = hw;
277*4882a593Smuzhiyun 	}
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(sama5d2_systemck); i++) {
280*4882a593Smuzhiyun 		hw = at91_clk_register_system(regmap, sama5d2_systemck[i].n,
281*4882a593Smuzhiyun 					      sama5d2_systemck[i].p,
282*4882a593Smuzhiyun 					      sama5d2_systemck[i].id);
283*4882a593Smuzhiyun 		if (IS_ERR(hw))
284*4882a593Smuzhiyun 			goto err_free;
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 		sama5d2_pmc->shws[sama5d2_systemck[i].id] = hw;
287*4882a593Smuzhiyun 	}
288*4882a593Smuzhiyun 
289*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(sama5d2_periphck); i++) {
290*4882a593Smuzhiyun 		hw = at91_clk_register_sam9x5_peripheral(regmap, &pmc_pcr_lock,
291*4882a593Smuzhiyun 							 &sama5d2_pcr_layout,
292*4882a593Smuzhiyun 							 sama5d2_periphck[i].n,
293*4882a593Smuzhiyun 							 "masterck",
294*4882a593Smuzhiyun 							 sama5d2_periphck[i].id,
295*4882a593Smuzhiyun 							 &range, INT_MIN);
296*4882a593Smuzhiyun 		if (IS_ERR(hw))
297*4882a593Smuzhiyun 			goto err_free;
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 		sama5d2_pmc->phws[sama5d2_periphck[i].id] = hw;
300*4882a593Smuzhiyun 	}
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(sama5d2_periph32ck); i++) {
303*4882a593Smuzhiyun 		hw = at91_clk_register_sam9x5_peripheral(regmap, &pmc_pcr_lock,
304*4882a593Smuzhiyun 							 &sama5d2_pcr_layout,
305*4882a593Smuzhiyun 							 sama5d2_periph32ck[i].n,
306*4882a593Smuzhiyun 							 "h32mxck",
307*4882a593Smuzhiyun 							 sama5d2_periph32ck[i].id,
308*4882a593Smuzhiyun 							 &sama5d2_periph32ck[i].r,
309*4882a593Smuzhiyun 							 INT_MIN);
310*4882a593Smuzhiyun 		if (IS_ERR(hw))
311*4882a593Smuzhiyun 			goto err_free;
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 		sama5d2_pmc->phws[sama5d2_periph32ck[i].id] = hw;
314*4882a593Smuzhiyun 	}
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun 	parent_names[0] = slck_name;
317*4882a593Smuzhiyun 	parent_names[1] = "mainck";
318*4882a593Smuzhiyun 	parent_names[2] = "plladivck";
319*4882a593Smuzhiyun 	parent_names[3] = "utmick";
320*4882a593Smuzhiyun 	parent_names[4] = "masterck";
321*4882a593Smuzhiyun 	parent_names[5] = "audiopll_pmcck";
322*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(sama5d2_gck); i++) {
323*4882a593Smuzhiyun 		hw = at91_clk_register_generated(regmap, &pmc_pcr_lock,
324*4882a593Smuzhiyun 						 &sama5d2_pcr_layout,
325*4882a593Smuzhiyun 						 sama5d2_gck[i].n,
326*4882a593Smuzhiyun 						 parent_names, NULL, 6,
327*4882a593Smuzhiyun 						 sama5d2_gck[i].id,
328*4882a593Smuzhiyun 						 &sama5d2_gck[i].r,
329*4882a593Smuzhiyun 						 sama5d2_gck[i].chg_pid);
330*4882a593Smuzhiyun 		if (IS_ERR(hw))
331*4882a593Smuzhiyun 			goto err_free;
332*4882a593Smuzhiyun 
333*4882a593Smuzhiyun 		sama5d2_pmc->ghws[sama5d2_gck[i].id] = hw;
334*4882a593Smuzhiyun 	}
335*4882a593Smuzhiyun 
336*4882a593Smuzhiyun 	if (regmap_sfr) {
337*4882a593Smuzhiyun 		parent_names[0] = "i2s0_clk";
338*4882a593Smuzhiyun 		parent_names[1] = "i2s0_gclk";
339*4882a593Smuzhiyun 		hw = at91_clk_i2s_mux_register(regmap_sfr, "i2s0_muxclk",
340*4882a593Smuzhiyun 					       parent_names, 2, 0);
341*4882a593Smuzhiyun 		if (IS_ERR(hw))
342*4882a593Smuzhiyun 			goto err_free;
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 		sama5d2_pmc->chws[PMC_I2S0_MUX] = hw;
345*4882a593Smuzhiyun 
346*4882a593Smuzhiyun 		parent_names[0] = "i2s1_clk";
347*4882a593Smuzhiyun 		parent_names[1] = "i2s1_gclk";
348*4882a593Smuzhiyun 		hw = at91_clk_i2s_mux_register(regmap_sfr, "i2s1_muxclk",
349*4882a593Smuzhiyun 					       parent_names, 2, 1);
350*4882a593Smuzhiyun 		if (IS_ERR(hw))
351*4882a593Smuzhiyun 			goto err_free;
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun 		sama5d2_pmc->chws[PMC_I2S1_MUX] = hw;
354*4882a593Smuzhiyun 	}
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 	of_clk_add_hw_provider(np, of_clk_hw_pmc_get, sama5d2_pmc);
357*4882a593Smuzhiyun 
358*4882a593Smuzhiyun 	return;
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun err_free:
361*4882a593Smuzhiyun 	kfree(sama5d2_pmc);
362*4882a593Smuzhiyun }
363*4882a593Smuzhiyun CLK_OF_DECLARE_DRIVER(sama5d2_pmc, "atmel,sama5d2-pmc", sama5d2_pmc_setup);
364