1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Copyright 2015 Vladimir Zapolskiy <vz@mleia.com>
4  */
5 
6 #include <linux/clk.h>
7 #include <linux/clk-provider.h>
8 #include <linux/io.h>
9 #include <linux/of_address.h>
10 #include <linux/regmap.h>
11 
12 #include <dt-bindings/clock/lpc32xx-clock.h>
13 
14 #undef pr_fmt
15 #define pr_fmt(fmt) "%s: " fmt, __func__
16 
17 /* Common bitfield definitions for x397 PLL (lock), USB PLL and HCLK PLL */
18 #define PLL_CTRL_ENABLE			BIT(16)
19 #define PLL_CTRL_BYPASS			BIT(15)
20 #define PLL_CTRL_DIRECT			BIT(14)
21 #define PLL_CTRL_FEEDBACK		BIT(13)
22 #define PLL_CTRL_POSTDIV		(BIT(12)|BIT(11))
23 #define PLL_CTRL_PREDIV			(BIT(10)|BIT(9))
24 #define PLL_CTRL_FEEDDIV		(0xFF << 1)
25 #define PLL_CTRL_LOCK			BIT(0)
26 
27 /* Clock registers on System Control Block */
28 #define LPC32XX_CLKPWR_DEBUG_CTRL	0x00
29 #define LPC32XX_CLKPWR_USB_DIV		0x1C
30 #define LPC32XX_CLKPWR_HCLKDIV_CTRL	0x40
31 #define LPC32XX_CLKPWR_PWR_CTRL		0x44
32 #define LPC32XX_CLKPWR_PLL397_CTRL	0x48
33 #define LPC32XX_CLKPWR_OSC_CTRL		0x4C
34 #define LPC32XX_CLKPWR_SYSCLK_CTRL	0x50
35 #define LPC32XX_CLKPWR_LCDCLK_CTRL	0x54
36 #define LPC32XX_CLKPWR_HCLKPLL_CTRL	0x58
37 #define LPC32XX_CLKPWR_ADCCLK_CTRL1	0x60
38 #define LPC32XX_CLKPWR_USB_CTRL		0x64
39 #define LPC32XX_CLKPWR_SSP_CTRL		0x78
40 #define LPC32XX_CLKPWR_I2S_CTRL		0x7C
41 #define LPC32XX_CLKPWR_MS_CTRL		0x80
42 #define LPC32XX_CLKPWR_MACCLK_CTRL	0x90
43 #define LPC32XX_CLKPWR_TEST_CLK_CTRL	0xA4
44 #define LPC32XX_CLKPWR_I2CCLK_CTRL	0xAC
45 #define LPC32XX_CLKPWR_KEYCLK_CTRL	0xB0
46 #define LPC32XX_CLKPWR_ADCCLK_CTRL	0xB4
47 #define LPC32XX_CLKPWR_PWMCLK_CTRL	0xB8
48 #define LPC32XX_CLKPWR_TIMCLK_CTRL	0xBC
49 #define LPC32XX_CLKPWR_TIMCLK_CTRL1	0xC0
50 #define LPC32XX_CLKPWR_SPI_CTRL		0xC4
51 #define LPC32XX_CLKPWR_FLASHCLK_CTRL	0xC8
52 #define LPC32XX_CLKPWR_UART3_CLK_CTRL	0xD0
53 #define LPC32XX_CLKPWR_UART4_CLK_CTRL	0xD4
54 #define LPC32XX_CLKPWR_UART5_CLK_CTRL	0xD8
55 #define LPC32XX_CLKPWR_UART6_CLK_CTRL	0xDC
56 #define LPC32XX_CLKPWR_IRDA_CLK_CTRL	0xE0
57 #define LPC32XX_CLKPWR_UART_CLK_CTRL	0xE4
58 #define LPC32XX_CLKPWR_DMA_CLK_CTRL	0xE8
59 
60 /* Clock registers on USB controller */
61 #define LPC32XX_USB_CLK_CTRL		0xF4
62 #define LPC32XX_USB_CLK_STS		0xF8
63 
64 static struct regmap_config lpc32xx_scb_regmap_config = {
65 	.name = "scb",
66 	.reg_bits = 32,
67 	.val_bits = 32,
68 	.reg_stride = 4,
69 	.val_format_endian = REGMAP_ENDIAN_LITTLE,
70 	.max_register = 0x114,
71 	.fast_io = true,
72 };
73 
74 static struct regmap *clk_regmap;
75 static void __iomem *usb_clk_vbase;
76 
77 enum {
78 	LPC32XX_USB_CLK_OTG = LPC32XX_USB_CLK_HOST + 1,
79 	LPC32XX_USB_CLK_AHB,
80 
81 	LPC32XX_USB_CLK_MAX = LPC32XX_USB_CLK_AHB + 1,
82 };
83 
84 enum {
85 	/* Start from the last defined clock in dt bindings */
86 	LPC32XX_CLK_ADC_DIV = LPC32XX_CLK_PERIPH + 1,
87 	LPC32XX_CLK_ADC_RTC,
88 	LPC32XX_CLK_TEST1,
89 	LPC32XX_CLK_TEST2,
90 
91 	/* System clocks, PLL 397x and HCLK PLL clocks */
92 	LPC32XX_CLK_OSC,
93 	LPC32XX_CLK_SYS,
94 	LPC32XX_CLK_PLL397X,
95 	LPC32XX_CLK_HCLK_DIV_PERIPH,
96 	LPC32XX_CLK_HCLK_DIV,
97 	LPC32XX_CLK_HCLK,
98 	LPC32XX_CLK_ARM,
99 	LPC32XX_CLK_ARM_VFP,
100 
101 	/* USB clocks */
102 	LPC32XX_CLK_USB_PLL,
103 	LPC32XX_CLK_USB_DIV,
104 	LPC32XX_CLK_USB,
105 
106 	/* Only one control PWR_CTRL[10] for both muxes */
107 	LPC32XX_CLK_PERIPH_HCLK_MUX,
108 	LPC32XX_CLK_PERIPH_ARM_MUX,
109 
110 	/* Only one control PWR_CTRL[2] for all three muxes */
111 	LPC32XX_CLK_SYSCLK_PERIPH_MUX,
112 	LPC32XX_CLK_SYSCLK_HCLK_MUX,
113 	LPC32XX_CLK_SYSCLK_ARM_MUX,
114 
115 	/* Two clock sources external to the driver */
116 	LPC32XX_CLK_XTAL_32K,
117 	LPC32XX_CLK_XTAL,
118 
119 	/* Renumbered USB clocks, may have a parent from SCB table */
120 	LPC32XX_CLK_USB_OFFSET,
121 	LPC32XX_CLK_USB_I2C = LPC32XX_USB_CLK_I2C + LPC32XX_CLK_USB_OFFSET,
122 	LPC32XX_CLK_USB_DEV = LPC32XX_USB_CLK_DEVICE + LPC32XX_CLK_USB_OFFSET,
123 	LPC32XX_CLK_USB_HOST = LPC32XX_USB_CLK_HOST + LPC32XX_CLK_USB_OFFSET,
124 	LPC32XX_CLK_USB_OTG = LPC32XX_USB_CLK_OTG + LPC32XX_CLK_USB_OFFSET,
125 	LPC32XX_CLK_USB_AHB = LPC32XX_USB_CLK_AHB + LPC32XX_CLK_USB_OFFSET,
126 
127 	/* Stub for composite clocks */
128 	LPC32XX_CLK__NULL,
129 
130 	/* Subclocks of composite clocks, clocks above are for CCF */
131 	LPC32XX_CLK_PWM1_MUX,
132 	LPC32XX_CLK_PWM1_DIV,
133 	LPC32XX_CLK_PWM1_GATE,
134 	LPC32XX_CLK_PWM2_MUX,
135 	LPC32XX_CLK_PWM2_DIV,
136 	LPC32XX_CLK_PWM2_GATE,
137 	LPC32XX_CLK_UART3_MUX,
138 	LPC32XX_CLK_UART3_DIV,
139 	LPC32XX_CLK_UART3_GATE,
140 	LPC32XX_CLK_UART4_MUX,
141 	LPC32XX_CLK_UART4_DIV,
142 	LPC32XX_CLK_UART4_GATE,
143 	LPC32XX_CLK_UART5_MUX,
144 	LPC32XX_CLK_UART5_DIV,
145 	LPC32XX_CLK_UART5_GATE,
146 	LPC32XX_CLK_UART6_MUX,
147 	LPC32XX_CLK_UART6_DIV,
148 	LPC32XX_CLK_UART6_GATE,
149 	LPC32XX_CLK_TEST1_MUX,
150 	LPC32XX_CLK_TEST1_GATE,
151 	LPC32XX_CLK_TEST2_MUX,
152 	LPC32XX_CLK_TEST2_GATE,
153 	LPC32XX_CLK_USB_DIV_DIV,
154 	LPC32XX_CLK_USB_DIV_GATE,
155 	LPC32XX_CLK_SD_DIV,
156 	LPC32XX_CLK_SD_GATE,
157 	LPC32XX_CLK_LCD_DIV,
158 	LPC32XX_CLK_LCD_GATE,
159 
160 	LPC32XX_CLK_HW_MAX,
161 	LPC32XX_CLK_MAX = LPC32XX_CLK_SYSCLK_ARM_MUX + 1,
162 	LPC32XX_CLK_CCF_MAX = LPC32XX_CLK_USB_AHB + 1,
163 };
164 
165 static struct clk *clk[LPC32XX_CLK_MAX];
166 static struct clk_onecell_data clk_data = {
167 	.clks = clk,
168 	.clk_num = LPC32XX_CLK_MAX,
169 };
170 
171 static struct clk *usb_clk[LPC32XX_USB_CLK_MAX];
172 static struct clk_onecell_data usb_clk_data = {
173 	.clks = usb_clk,
174 	.clk_num = LPC32XX_USB_CLK_MAX,
175 };
176 
177 #define LPC32XX_CLK_PARENTS_MAX			5
178 
179 struct clk_proto_t {
180 	const char *name;
181 	const u8 parents[LPC32XX_CLK_PARENTS_MAX];
182 	u8 num_parents;
183 	unsigned long flags;
184 };
185 
186 #define CLK_PREFIX(LITERAL)		LPC32XX_CLK_ ## LITERAL
187 #define NUMARGS(...)	(sizeof((int[]){__VA_ARGS__})/sizeof(int))
188 
189 #define LPC32XX_CLK_DEFINE(_idx, _name, _flags, ...)		\
190 	[CLK_PREFIX(_idx)] = {					\
191 		.name = _name,					\
192 		.flags = _flags,				\
193 		.parents = { __VA_ARGS__ },			\
194 		.num_parents = NUMARGS(__VA_ARGS__),		\
195 	 }
196 
197 static const struct clk_proto_t clk_proto[LPC32XX_CLK_CCF_MAX] __initconst = {
198 	LPC32XX_CLK_DEFINE(XTAL, "xtal", 0x0),
199 	LPC32XX_CLK_DEFINE(XTAL_32K, "xtal_32k", 0x0),
200 
201 	LPC32XX_CLK_DEFINE(RTC, "rtc", 0x0, LPC32XX_CLK_XTAL_32K),
202 	LPC32XX_CLK_DEFINE(OSC, "osc", CLK_IGNORE_UNUSED, LPC32XX_CLK_XTAL),
203 	LPC32XX_CLK_DEFINE(SYS, "sys", CLK_IGNORE_UNUSED,
204 		LPC32XX_CLK_OSC, LPC32XX_CLK_PLL397X),
205 	LPC32XX_CLK_DEFINE(PLL397X, "pll_397x", CLK_IGNORE_UNUSED,
206 		LPC32XX_CLK_RTC),
207 	LPC32XX_CLK_DEFINE(HCLK_PLL, "hclk_pll", CLK_IGNORE_UNUSED,
208 		LPC32XX_CLK_SYS),
209 	LPC32XX_CLK_DEFINE(HCLK_DIV_PERIPH, "hclk_div_periph",
210 		CLK_IGNORE_UNUSED, LPC32XX_CLK_HCLK_PLL),
211 	LPC32XX_CLK_DEFINE(HCLK_DIV, "hclk_div", CLK_IGNORE_UNUSED,
212 		LPC32XX_CLK_HCLK_PLL),
213 	LPC32XX_CLK_DEFINE(HCLK, "hclk", CLK_IGNORE_UNUSED,
214 		LPC32XX_CLK_PERIPH_HCLK_MUX),
215 	LPC32XX_CLK_DEFINE(PERIPH, "pclk", CLK_IGNORE_UNUSED,
216 		LPC32XX_CLK_SYSCLK_PERIPH_MUX),
217 	LPC32XX_CLK_DEFINE(ARM, "arm", CLK_IGNORE_UNUSED,
218 		LPC32XX_CLK_PERIPH_ARM_MUX),
219 
220 	LPC32XX_CLK_DEFINE(PERIPH_HCLK_MUX, "periph_hclk_mux",
221 		CLK_IGNORE_UNUSED,
222 		LPC32XX_CLK_SYSCLK_HCLK_MUX, LPC32XX_CLK_SYSCLK_PERIPH_MUX),
223 	LPC32XX_CLK_DEFINE(PERIPH_ARM_MUX, "periph_arm_mux", CLK_IGNORE_UNUSED,
224 		LPC32XX_CLK_SYSCLK_ARM_MUX, LPC32XX_CLK_SYSCLK_PERIPH_MUX),
225 	LPC32XX_CLK_DEFINE(SYSCLK_PERIPH_MUX, "sysclk_periph_mux",
226 		CLK_IGNORE_UNUSED,
227 		LPC32XX_CLK_SYS, LPC32XX_CLK_HCLK_DIV_PERIPH),
228 	LPC32XX_CLK_DEFINE(SYSCLK_HCLK_MUX, "sysclk_hclk_mux",
229 		CLK_IGNORE_UNUSED,
230 		LPC32XX_CLK_SYS, LPC32XX_CLK_HCLK_DIV),
231 	LPC32XX_CLK_DEFINE(SYSCLK_ARM_MUX, "sysclk_arm_mux", CLK_IGNORE_UNUSED,
232 		LPC32XX_CLK_SYS, LPC32XX_CLK_HCLK_PLL),
233 
234 	LPC32XX_CLK_DEFINE(ARM_VFP, "vfp9", CLK_IGNORE_UNUSED,
235 		LPC32XX_CLK_ARM),
236 	LPC32XX_CLK_DEFINE(USB_PLL, "usb_pll",
237 		CLK_SET_RATE_GATE | CLK_SET_RATE_PARENT, LPC32XX_CLK_USB_DIV),
238 	LPC32XX_CLK_DEFINE(USB_DIV, "usb_div", 0x0, LPC32XX_CLK_OSC),
239 	LPC32XX_CLK_DEFINE(USB, "usb", 0x0, LPC32XX_CLK_USB_PLL),
240 	LPC32XX_CLK_DEFINE(DMA, "dma", 0x0, LPC32XX_CLK_HCLK),
241 	LPC32XX_CLK_DEFINE(MLC, "mlc", 0x0, LPC32XX_CLK_HCLK),
242 	LPC32XX_CLK_DEFINE(SLC, "slc", 0x0, LPC32XX_CLK_HCLK),
243 	LPC32XX_CLK_DEFINE(LCD, "lcd", 0x0, LPC32XX_CLK_HCLK),
244 	LPC32XX_CLK_DEFINE(MAC, "mac", 0x0, LPC32XX_CLK_HCLK),
245 	LPC32XX_CLK_DEFINE(SD, "sd", 0x0, LPC32XX_CLK_ARM),
246 	LPC32XX_CLK_DEFINE(DDRAM, "ddram", CLK_GET_RATE_NOCACHE,
247 		LPC32XX_CLK_SYSCLK_ARM_MUX),
248 	LPC32XX_CLK_DEFINE(SSP0, "ssp0", 0x0, LPC32XX_CLK_HCLK),
249 	LPC32XX_CLK_DEFINE(SSP1, "ssp1", 0x0, LPC32XX_CLK_HCLK),
250 
251 	/*
252 	 * CLK_GET_RATE_NOCACHE is needed, if UART clock is disabled, its
253 	 * divider register does not contain information about selected rate.
254 	 */
255 	LPC32XX_CLK_DEFINE(UART3, "uart3", CLK_GET_RATE_NOCACHE,
256 		LPC32XX_CLK_PERIPH, LPC32XX_CLK_HCLK),
257 	LPC32XX_CLK_DEFINE(UART4, "uart4", CLK_GET_RATE_NOCACHE,
258 		LPC32XX_CLK_PERIPH, LPC32XX_CLK_HCLK),
259 	LPC32XX_CLK_DEFINE(UART5, "uart5", CLK_GET_RATE_NOCACHE,
260 		LPC32XX_CLK_PERIPH, LPC32XX_CLK_HCLK),
261 	LPC32XX_CLK_DEFINE(UART6, "uart6", CLK_GET_RATE_NOCACHE,
262 		LPC32XX_CLK_PERIPH, LPC32XX_CLK_HCLK),
263 	LPC32XX_CLK_DEFINE(IRDA, "irda", 0x0, LPC32XX_CLK_PERIPH),
264 	LPC32XX_CLK_DEFINE(I2C1, "i2c1", 0x0, LPC32XX_CLK_HCLK),
265 	LPC32XX_CLK_DEFINE(I2C2, "i2c2", 0x0, LPC32XX_CLK_HCLK),
266 	LPC32XX_CLK_DEFINE(TIMER0, "timer0", 0x0, LPC32XX_CLK_PERIPH),
267 	LPC32XX_CLK_DEFINE(TIMER1, "timer1", 0x0, LPC32XX_CLK_PERIPH),
268 	LPC32XX_CLK_DEFINE(TIMER2, "timer2", 0x0, LPC32XX_CLK_PERIPH),
269 	LPC32XX_CLK_DEFINE(TIMER3, "timer3", 0x0, LPC32XX_CLK_PERIPH),
270 	LPC32XX_CLK_DEFINE(TIMER4, "timer4", 0x0, LPC32XX_CLK_PERIPH),
271 	LPC32XX_CLK_DEFINE(TIMER5, "timer5", 0x0, LPC32XX_CLK_PERIPH),
272 	LPC32XX_CLK_DEFINE(WDOG, "watchdog", 0x0, LPC32XX_CLK_PERIPH),
273 	LPC32XX_CLK_DEFINE(I2S0, "i2s0", 0x0, LPC32XX_CLK_HCLK),
274 	LPC32XX_CLK_DEFINE(I2S1, "i2s1", 0x0, LPC32XX_CLK_HCLK),
275 	LPC32XX_CLK_DEFINE(SPI1, "spi1", 0x0, LPC32XX_CLK_HCLK),
276 	LPC32XX_CLK_DEFINE(SPI2, "spi2", 0x0, LPC32XX_CLK_HCLK),
277 	LPC32XX_CLK_DEFINE(MCPWM, "mcpwm", 0x0, LPC32XX_CLK_HCLK),
278 	LPC32XX_CLK_DEFINE(HSTIMER, "hstimer", 0x0, LPC32XX_CLK_PERIPH),
279 	LPC32XX_CLK_DEFINE(KEY, "key", 0x0, LPC32XX_CLK_RTC),
280 	LPC32XX_CLK_DEFINE(PWM1, "pwm1", 0x0,
281 		LPC32XX_CLK_RTC, LPC32XX_CLK_PERIPH),
282 	LPC32XX_CLK_DEFINE(PWM2, "pwm2", 0x0,
283 		LPC32XX_CLK_RTC, LPC32XX_CLK_PERIPH),
284 	LPC32XX_CLK_DEFINE(ADC, "adc", 0x0,
285 		LPC32XX_CLK_ADC_RTC, LPC32XX_CLK_ADC_DIV),
286 	LPC32XX_CLK_DEFINE(ADC_DIV, "adc_div", 0x0, LPC32XX_CLK_PERIPH),
287 	LPC32XX_CLK_DEFINE(ADC_RTC, "adc_rtc", 0x0, LPC32XX_CLK_RTC),
288 	LPC32XX_CLK_DEFINE(TEST1, "test1", 0x0,
289 		LPC32XX_CLK_PERIPH, LPC32XX_CLK_RTC, LPC32XX_CLK_OSC),
290 	LPC32XX_CLK_DEFINE(TEST2, "test2", 0x0,
291 		LPC32XX_CLK_HCLK, LPC32XX_CLK_PERIPH, LPC32XX_CLK_USB,
292 		LPC32XX_CLK_OSC, LPC32XX_CLK_PLL397X),
293 
294 	/* USB controller clocks */
295 	LPC32XX_CLK_DEFINE(USB_AHB, "usb_ahb", 0x0, LPC32XX_CLK_USB),
296 	LPC32XX_CLK_DEFINE(USB_OTG, "usb_otg", 0x0, LPC32XX_CLK_USB_AHB),
297 	LPC32XX_CLK_DEFINE(USB_I2C, "usb_i2c", 0x0, LPC32XX_CLK_USB_AHB),
298 	LPC32XX_CLK_DEFINE(USB_DEV, "usb_dev", 0x0, LPC32XX_CLK_USB_OTG),
299 	LPC32XX_CLK_DEFINE(USB_HOST, "usb_host", 0x0, LPC32XX_CLK_USB_OTG),
300 };
301 
302 struct lpc32xx_clk {
303 	struct clk_hw hw;
304 	u32 reg;
305 	u32 enable;
306 	u32 enable_mask;
307 	u32 disable;
308 	u32 disable_mask;
309 	u32 busy;
310 	u32 busy_mask;
311 };
312 
313 enum clk_pll_mode {
314 	PLL_UNKNOWN,
315 	PLL_DIRECT,
316 	PLL_BYPASS,
317 	PLL_DIRECT_BYPASS,
318 	PLL_INTEGER,
319 	PLL_NON_INTEGER,
320 };
321 
322 struct lpc32xx_pll_clk {
323 	struct clk_hw hw;
324 	u32 reg;
325 	u32 enable;
326 	unsigned long m_div;
327 	unsigned long n_div;
328 	unsigned long p_div;
329 	enum clk_pll_mode mode;
330 };
331 
332 struct lpc32xx_usb_clk {
333 	struct clk_hw hw;
334 	u32 ctrl_enable;
335 	u32 ctrl_disable;
336 	u32 ctrl_mask;
337 	u32 enable;
338 	u32 busy;
339 };
340 
341 struct lpc32xx_clk_mux {
342 	struct clk_hw	hw;
343 	u32		reg;
344 	u32		mask;
345 	u8		shift;
346 	u32		*table;
347 	u8		flags;
348 };
349 
350 struct lpc32xx_clk_div {
351 	struct clk_hw	hw;
352 	u32		reg;
353 	u8		shift;
354 	u8		width;
355 	const struct clk_div_table	*table;
356 	u8		flags;
357 };
358 
359 struct lpc32xx_clk_gate {
360 	struct clk_hw	hw;
361 	u32		reg;
362 	u8		bit_idx;
363 	u8		flags;
364 };
365 
366 #define to_lpc32xx_clk(_hw)	container_of(_hw, struct lpc32xx_clk, hw)
367 #define to_lpc32xx_pll_clk(_hw)	container_of(_hw, struct lpc32xx_pll_clk, hw)
368 #define to_lpc32xx_usb_clk(_hw)	container_of(_hw, struct lpc32xx_usb_clk, hw)
369 #define to_lpc32xx_mux(_hw)	container_of(_hw, struct lpc32xx_clk_mux, hw)
370 #define to_lpc32xx_div(_hw)	container_of(_hw, struct lpc32xx_clk_div, hw)
371 #define to_lpc32xx_gate(_hw)	container_of(_hw, struct lpc32xx_clk_gate, hw)
372 
pll_is_valid(u64 val0,u64 val1,u64 min,u64 max)373 static inline bool pll_is_valid(u64 val0, u64 val1, u64 min, u64 max)
374 {
375 	return (val0 >= (val1 * min) && val0 <= (val1 * max));
376 }
377 
lpc32xx_usb_clk_read(struct lpc32xx_usb_clk * clk)378 static inline u32 lpc32xx_usb_clk_read(struct lpc32xx_usb_clk *clk)
379 {
380 	return readl(usb_clk_vbase + LPC32XX_USB_CLK_STS);
381 }
382 
lpc32xx_usb_clk_write(struct lpc32xx_usb_clk * clk,u32 val)383 static inline void lpc32xx_usb_clk_write(struct lpc32xx_usb_clk *clk, u32 val)
384 {
385 	writel(val, usb_clk_vbase + LPC32XX_USB_CLK_CTRL);
386 }
387 
clk_mask_enable(struct clk_hw * hw)388 static int clk_mask_enable(struct clk_hw *hw)
389 {
390 	struct lpc32xx_clk *clk = to_lpc32xx_clk(hw);
391 	u32 val;
392 
393 	regmap_read(clk_regmap, clk->reg, &val);
394 
395 	if (clk->busy_mask && (val & clk->busy_mask) == clk->busy)
396 		return -EBUSY;
397 
398 	return regmap_update_bits(clk_regmap, clk->reg,
399 				  clk->enable_mask, clk->enable);
400 }
401 
clk_mask_disable(struct clk_hw * hw)402 static void clk_mask_disable(struct clk_hw *hw)
403 {
404 	struct lpc32xx_clk *clk = to_lpc32xx_clk(hw);
405 
406 	regmap_update_bits(clk_regmap, clk->reg,
407 			   clk->disable_mask, clk->disable);
408 }
409 
clk_mask_is_enabled(struct clk_hw * hw)410 static int clk_mask_is_enabled(struct clk_hw *hw)
411 {
412 	struct lpc32xx_clk *clk = to_lpc32xx_clk(hw);
413 	u32 val;
414 
415 	regmap_read(clk_regmap, clk->reg, &val);
416 
417 	return ((val & clk->enable_mask) == clk->enable);
418 }
419 
420 static const struct clk_ops clk_mask_ops = {
421 	.enable = clk_mask_enable,
422 	.disable = clk_mask_disable,
423 	.is_enabled = clk_mask_is_enabled,
424 };
425 
clk_pll_enable(struct clk_hw * hw)426 static int clk_pll_enable(struct clk_hw *hw)
427 {
428 	struct lpc32xx_pll_clk *clk = to_lpc32xx_pll_clk(hw);
429 	u32 val, count;
430 
431 	regmap_update_bits(clk_regmap, clk->reg, clk->enable, clk->enable);
432 
433 	for (count = 0; count < 1000; count++) {
434 		regmap_read(clk_regmap, clk->reg, &val);
435 		if (val & PLL_CTRL_LOCK)
436 			break;
437 	}
438 
439 	if (val & PLL_CTRL_LOCK)
440 		return 0;
441 
442 	return -ETIMEDOUT;
443 }
444 
clk_pll_disable(struct clk_hw * hw)445 static void clk_pll_disable(struct clk_hw *hw)
446 {
447 	struct lpc32xx_pll_clk *clk = to_lpc32xx_pll_clk(hw);
448 
449 	regmap_update_bits(clk_regmap, clk->reg, clk->enable, 0x0);
450 }
451 
clk_pll_is_enabled(struct clk_hw * hw)452 static int clk_pll_is_enabled(struct clk_hw *hw)
453 {
454 	struct lpc32xx_pll_clk *clk = to_lpc32xx_pll_clk(hw);
455 	u32 val;
456 
457 	regmap_read(clk_regmap, clk->reg, &val);
458 
459 	val &= clk->enable | PLL_CTRL_LOCK;
460 	if (val == (clk->enable | PLL_CTRL_LOCK))
461 		return 1;
462 
463 	return 0;
464 }
465 
clk_pll_397x_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)466 static unsigned long clk_pll_397x_recalc_rate(struct clk_hw *hw,
467 					      unsigned long parent_rate)
468 {
469 	return parent_rate * 397;
470 }
471 
clk_pll_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)472 static unsigned long clk_pll_recalc_rate(struct clk_hw *hw,
473 					 unsigned long parent_rate)
474 {
475 	struct lpc32xx_pll_clk *clk = to_lpc32xx_pll_clk(hw);
476 	bool is_direct, is_bypass, is_feedback;
477 	unsigned long rate, cco_rate, ref_rate;
478 	u32 val;
479 
480 	regmap_read(clk_regmap, clk->reg, &val);
481 	is_direct = val & PLL_CTRL_DIRECT;
482 	is_bypass = val & PLL_CTRL_BYPASS;
483 	is_feedback = val & PLL_CTRL_FEEDBACK;
484 
485 	clk->m_div = ((val & PLL_CTRL_FEEDDIV) >> 1) + 1;
486 	clk->n_div = ((val & PLL_CTRL_PREDIV) >> 9) + 1;
487 	clk->p_div = ((val & PLL_CTRL_POSTDIV) >> 11) + 1;
488 
489 	if (is_direct && is_bypass) {
490 		clk->p_div = 0;
491 		clk->mode = PLL_DIRECT_BYPASS;
492 		return parent_rate;
493 	}
494 	if (is_bypass) {
495 		clk->mode = PLL_BYPASS;
496 		return parent_rate / (1 << clk->p_div);
497 	}
498 	if (is_direct) {
499 		clk->p_div = 0;
500 		clk->mode = PLL_DIRECT;
501 	}
502 
503 	ref_rate = parent_rate / clk->n_div;
504 	rate = cco_rate = ref_rate * clk->m_div;
505 
506 	if (!is_direct) {
507 		if (is_feedback) {
508 			cco_rate *= (1 << clk->p_div);
509 			clk->mode = PLL_INTEGER;
510 		} else {
511 			rate /= (1 << clk->p_div);
512 			clk->mode = PLL_NON_INTEGER;
513 		}
514 	}
515 
516 	pr_debug("%s: %lu: 0x%x: %d/%d/%d, %lu/%lu/%d => %lu\n",
517 		 clk_hw_get_name(hw),
518 		 parent_rate, val, is_direct, is_bypass, is_feedback,
519 		 clk->n_div, clk->m_div, (1 << clk->p_div), rate);
520 
521 	if (clk_pll_is_enabled(hw) &&
522 	    !(pll_is_valid(parent_rate, 1, 1000000, 20000000)
523 	      && pll_is_valid(cco_rate, 1, 156000000, 320000000)
524 	      && pll_is_valid(ref_rate, 1, 1000000, 27000000)))
525 		pr_err("%s: PLL clocks are not in valid ranges: %lu/%lu/%lu\n",
526 		       clk_hw_get_name(hw),
527 		       parent_rate, cco_rate, ref_rate);
528 
529 	return rate;
530 }
531 
clk_pll_set_rate(struct clk_hw * hw,unsigned long rate,unsigned long parent_rate)532 static int clk_pll_set_rate(struct clk_hw *hw, unsigned long rate,
533 			    unsigned long parent_rate)
534 {
535 	struct lpc32xx_pll_clk *clk = to_lpc32xx_pll_clk(hw);
536 	u32 val;
537 	unsigned long new_rate;
538 
539 	/* Validate PLL clock parameters computed on round rate stage */
540 	switch (clk->mode) {
541 	case PLL_DIRECT:
542 		val = PLL_CTRL_DIRECT;
543 		val |= (clk->m_div - 1) << 1;
544 		val |= (clk->n_div - 1) << 9;
545 		new_rate = (parent_rate * clk->m_div) / clk->n_div;
546 		break;
547 	case PLL_BYPASS:
548 		val = PLL_CTRL_BYPASS;
549 		val |= (clk->p_div - 1) << 11;
550 		new_rate = parent_rate / (1 << (clk->p_div));
551 		break;
552 	case PLL_DIRECT_BYPASS:
553 		val = PLL_CTRL_DIRECT | PLL_CTRL_BYPASS;
554 		new_rate = parent_rate;
555 		break;
556 	case PLL_INTEGER:
557 		val = PLL_CTRL_FEEDBACK;
558 		val |= (clk->m_div - 1) << 1;
559 		val |= (clk->n_div - 1) << 9;
560 		val |= (clk->p_div - 1) << 11;
561 		new_rate = (parent_rate * clk->m_div) / clk->n_div;
562 		break;
563 	case PLL_NON_INTEGER:
564 		val = 0x0;
565 		val |= (clk->m_div - 1) << 1;
566 		val |= (clk->n_div - 1) << 9;
567 		val |= (clk->p_div - 1) << 11;
568 		new_rate = (parent_rate * clk->m_div) /
569 				(clk->n_div * (1 << clk->p_div));
570 		break;
571 	default:
572 		return -EINVAL;
573 	}
574 
575 	/* Sanity check that round rate is equal to the requested one */
576 	if (new_rate != rate)
577 		return -EINVAL;
578 
579 	return regmap_update_bits(clk_regmap, clk->reg, 0x1FFFF, val);
580 }
581 
clk_hclk_pll_round_rate(struct clk_hw * hw,unsigned long rate,unsigned long * parent_rate)582 static long clk_hclk_pll_round_rate(struct clk_hw *hw, unsigned long rate,
583 				    unsigned long *parent_rate)
584 {
585 	struct lpc32xx_pll_clk *clk = to_lpc32xx_pll_clk(hw);
586 	u64 m_i, o = rate, i = *parent_rate, d = (u64)rate << 6;
587 	u64 m = 0, n = 0, p = 0;
588 	int p_i, n_i;
589 
590 	pr_debug("%s: %lu/%lu\n", clk_hw_get_name(hw), *parent_rate, rate);
591 
592 	if (rate > 266500000)
593 		return -EINVAL;
594 
595 	/* Have to check all 20 possibilities to find the minimal M */
596 	for (p_i = 4; p_i >= 0; p_i--) {
597 		for (n_i = 4; n_i > 0; n_i--) {
598 			m_i = div64_u64(o * n_i * (1 << p_i), i);
599 
600 			/* Check for valid PLL parameter constraints */
601 			if (!(m_i && m_i <= 256
602 			      && pll_is_valid(i, n_i, 1000000, 27000000)
603 			      && pll_is_valid(i * m_i * (1 << p_i), n_i,
604 					      156000000, 320000000)))
605 				continue;
606 
607 			/* Store some intermediate valid parameters */
608 			if (o * n_i * (1 << p_i) - i * m_i <= d) {
609 				m = m_i;
610 				n = n_i;
611 				p = p_i;
612 				d = o * n_i * (1 << p_i) - i * m_i;
613 			}
614 		}
615 	}
616 
617 	if (d == (u64)rate << 6) {
618 		pr_err("%s: %lu: no valid PLL parameters are found\n",
619 		       clk_hw_get_name(hw), rate);
620 		return -EINVAL;
621 	}
622 
623 	clk->m_div = m;
624 	clk->n_div = n;
625 	clk->p_div = p;
626 
627 	/* Set only direct or non-integer mode of PLL */
628 	if (!p)
629 		clk->mode = PLL_DIRECT;
630 	else
631 		clk->mode = PLL_NON_INTEGER;
632 
633 	o = div64_u64(i * m, n * (1 << p));
634 
635 	if (!d)
636 		pr_debug("%s: %lu: found exact match: %llu/%llu/%llu\n",
637 			 clk_hw_get_name(hw), rate, m, n, p);
638 	else
639 		pr_debug("%s: %lu: found closest: %llu/%llu/%llu - %llu\n",
640 			 clk_hw_get_name(hw), rate, m, n, p, o);
641 
642 	return o;
643 }
644 
clk_usb_pll_round_rate(struct clk_hw * hw,unsigned long rate,unsigned long * parent_rate)645 static long clk_usb_pll_round_rate(struct clk_hw *hw, unsigned long rate,
646 				   unsigned long *parent_rate)
647 {
648 	struct lpc32xx_pll_clk *clk = to_lpc32xx_pll_clk(hw);
649 	struct clk_hw *usb_div_hw, *osc_hw;
650 	u64 d_i, n_i, m, o;
651 
652 	pr_debug("%s: %lu/%lu\n", clk_hw_get_name(hw), *parent_rate, rate);
653 
654 	/*
655 	 * The only supported USB clock is 48MHz, with PLL internal constraints
656 	 * on Fclkin, Fcco and Fref this implies that Fcco must be 192MHz
657 	 * and post-divider must be 4, this slightly simplifies calculation of
658 	 * USB divider, USB PLL N and M parameters.
659 	 */
660 	if (rate != 48000000)
661 		return -EINVAL;
662 
663 	/* USB divider clock */
664 	usb_div_hw = clk_hw_get_parent_by_index(hw, 0);
665 	if (!usb_div_hw)
666 		return -EINVAL;
667 
668 	/* Main oscillator clock */
669 	osc_hw = clk_hw_get_parent_by_index(usb_div_hw, 0);
670 	if (!osc_hw)
671 		return -EINVAL;
672 	o = clk_hw_get_rate(osc_hw);	/* must be in range 1..20 MHz */
673 
674 	/* Check if valid USB divider and USB PLL parameters exists */
675 	for (d_i = 16; d_i >= 1; d_i--) {
676 		for (n_i = 1; n_i <= 4; n_i++) {
677 			m = div64_u64(192000000 * d_i * n_i, o);
678 			if (!(m && m <= 256
679 			      && m * o == 192000000 * d_i * n_i
680 			      && pll_is_valid(o, d_i, 1000000, 20000000)
681 			      && pll_is_valid(o, d_i * n_i, 1000000, 27000000)))
682 				continue;
683 
684 			clk->n_div = n_i;
685 			clk->m_div = m;
686 			clk->p_div = 2;
687 			clk->mode = PLL_NON_INTEGER;
688 			*parent_rate = div64_u64(o, d_i);
689 
690 			return rate;
691 		}
692 	}
693 
694 	return -EINVAL;
695 }
696 
697 #define LPC32XX_DEFINE_PLL_OPS(_name, _rc, _sr, _rr)			\
698 	static const struct clk_ops clk_ ##_name ## _ops = {		\
699 		.enable = clk_pll_enable,				\
700 		.disable = clk_pll_disable,				\
701 		.is_enabled = clk_pll_is_enabled,			\
702 		.recalc_rate = _rc,					\
703 		.set_rate = _sr,					\
704 		.round_rate = _rr,					\
705 	}
706 
707 LPC32XX_DEFINE_PLL_OPS(pll_397x, clk_pll_397x_recalc_rate, NULL, NULL);
708 LPC32XX_DEFINE_PLL_OPS(hclk_pll, clk_pll_recalc_rate,
709 		       clk_pll_set_rate, clk_hclk_pll_round_rate);
710 LPC32XX_DEFINE_PLL_OPS(usb_pll,  clk_pll_recalc_rate,
711 		       clk_pll_set_rate, clk_usb_pll_round_rate);
712 
clk_ddram_is_enabled(struct clk_hw * hw)713 static int clk_ddram_is_enabled(struct clk_hw *hw)
714 {
715 	struct lpc32xx_clk *clk = to_lpc32xx_clk(hw);
716 	u32 val;
717 
718 	regmap_read(clk_regmap, clk->reg, &val);
719 	val &= clk->enable_mask | clk->busy_mask;
720 
721 	return (val == (BIT(7) | BIT(0)) ||
722 		val == (BIT(8) | BIT(1)));
723 }
724 
clk_ddram_enable(struct clk_hw * hw)725 static int clk_ddram_enable(struct clk_hw *hw)
726 {
727 	struct lpc32xx_clk *clk = to_lpc32xx_clk(hw);
728 	u32 val, hclk_div;
729 
730 	regmap_read(clk_regmap, clk->reg, &val);
731 	hclk_div = val & clk->busy_mask;
732 
733 	/*
734 	 * DDRAM clock must be 2 times higher than HCLK,
735 	 * this implies DDRAM clock can not be enabled,
736 	 * if HCLK clock rate is equal to ARM clock rate
737 	 */
738 	if (hclk_div == 0x0 || hclk_div == (BIT(1) | BIT(0)))
739 		return -EINVAL;
740 
741 	return regmap_update_bits(clk_regmap, clk->reg,
742 				  clk->enable_mask, hclk_div << 7);
743 }
744 
clk_ddram_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)745 static unsigned long clk_ddram_recalc_rate(struct clk_hw *hw,
746 					   unsigned long parent_rate)
747 {
748 	struct lpc32xx_clk *clk = to_lpc32xx_clk(hw);
749 	u32 val;
750 
751 	if (!clk_ddram_is_enabled(hw))
752 		return 0;
753 
754 	regmap_read(clk_regmap, clk->reg, &val);
755 	val &= clk->enable_mask;
756 
757 	return parent_rate / (val >> 7);
758 }
759 
760 static const struct clk_ops clk_ddram_ops = {
761 	.enable = clk_ddram_enable,
762 	.disable = clk_mask_disable,
763 	.is_enabled = clk_ddram_is_enabled,
764 	.recalc_rate = clk_ddram_recalc_rate,
765 };
766 
lpc32xx_clk_uart_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)767 static unsigned long lpc32xx_clk_uart_recalc_rate(struct clk_hw *hw,
768 						  unsigned long parent_rate)
769 {
770 	struct lpc32xx_clk *clk = to_lpc32xx_clk(hw);
771 	u32 val, x, y;
772 
773 	regmap_read(clk_regmap, clk->reg, &val);
774 	x = (val & 0xFF00) >> 8;
775 	y = val & 0xFF;
776 
777 	if (x && y)
778 		return (parent_rate * x) / y;
779 	else
780 		return 0;
781 }
782 
783 static const struct clk_ops lpc32xx_uart_div_ops = {
784 	.recalc_rate = lpc32xx_clk_uart_recalc_rate,
785 };
786 
787 static const struct clk_div_table clk_hclk_div_table[] = {
788 	{ .val = 0, .div = 1 },
789 	{ .val = 1, .div = 2 },
790 	{ .val = 2, .div = 4 },
791 	{ },
792 };
793 
794 static u32 test1_mux_table[] = { 0, 1, 2, };
795 static u32 test2_mux_table[] = { 0, 1, 2, 5, 7, };
796 
clk_usb_enable(struct clk_hw * hw)797 static int clk_usb_enable(struct clk_hw *hw)
798 {
799 	struct lpc32xx_usb_clk *clk = to_lpc32xx_usb_clk(hw);
800 	u32 val, ctrl_val, count;
801 
802 	pr_debug("%s: 0x%x\n", clk_hw_get_name(hw), clk->enable);
803 
804 	if (clk->ctrl_mask) {
805 		regmap_read(clk_regmap, LPC32XX_CLKPWR_USB_CTRL, &ctrl_val);
806 		regmap_update_bits(clk_regmap, LPC32XX_CLKPWR_USB_CTRL,
807 				   clk->ctrl_mask, clk->ctrl_enable);
808 	}
809 
810 	val = lpc32xx_usb_clk_read(clk);
811 	if (clk->busy && (val & clk->busy) == clk->busy) {
812 		if (clk->ctrl_mask)
813 			regmap_write(clk_regmap, LPC32XX_CLKPWR_USB_CTRL,
814 				     ctrl_val);
815 		return -EBUSY;
816 	}
817 
818 	val |= clk->enable;
819 	lpc32xx_usb_clk_write(clk, val);
820 
821 	for (count = 0; count < 1000; count++) {
822 		val = lpc32xx_usb_clk_read(clk);
823 		if ((val & clk->enable) == clk->enable)
824 			break;
825 	}
826 
827 	if ((val & clk->enable) == clk->enable)
828 		return 0;
829 
830 	if (clk->ctrl_mask)
831 		regmap_write(clk_regmap, LPC32XX_CLKPWR_USB_CTRL, ctrl_val);
832 
833 	return -ETIMEDOUT;
834 }
835 
clk_usb_disable(struct clk_hw * hw)836 static void clk_usb_disable(struct clk_hw *hw)
837 {
838 	struct lpc32xx_usb_clk *clk = to_lpc32xx_usb_clk(hw);
839 	u32 val = lpc32xx_usb_clk_read(clk);
840 
841 	val &= ~clk->enable;
842 	lpc32xx_usb_clk_write(clk, val);
843 
844 	if (clk->ctrl_mask)
845 		regmap_update_bits(clk_regmap, LPC32XX_CLKPWR_USB_CTRL,
846 				   clk->ctrl_mask, clk->ctrl_disable);
847 }
848 
clk_usb_is_enabled(struct clk_hw * hw)849 static int clk_usb_is_enabled(struct clk_hw *hw)
850 {
851 	struct lpc32xx_usb_clk *clk = to_lpc32xx_usb_clk(hw);
852 	u32 ctrl_val, val;
853 
854 	if (clk->ctrl_mask) {
855 		regmap_read(clk_regmap, LPC32XX_CLKPWR_USB_CTRL, &ctrl_val);
856 		if ((ctrl_val & clk->ctrl_mask) != clk->ctrl_enable)
857 			return 0;
858 	}
859 
860 	val = lpc32xx_usb_clk_read(clk);
861 
862 	return ((val & clk->enable) == clk->enable);
863 }
864 
clk_usb_i2c_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)865 static unsigned long clk_usb_i2c_recalc_rate(struct clk_hw *hw,
866 					     unsigned long parent_rate)
867 {
868 	return clk_get_rate(clk[LPC32XX_CLK_PERIPH]);
869 }
870 
871 static const struct clk_ops clk_usb_ops = {
872 	.enable = clk_usb_enable,
873 	.disable = clk_usb_disable,
874 	.is_enabled = clk_usb_is_enabled,
875 };
876 
877 static const struct clk_ops clk_usb_i2c_ops = {
878 	.enable = clk_usb_enable,
879 	.disable = clk_usb_disable,
880 	.is_enabled = clk_usb_is_enabled,
881 	.recalc_rate = clk_usb_i2c_recalc_rate,
882 };
883 
lpc32xx_clk_gate_enable(struct clk_hw * hw)884 static int lpc32xx_clk_gate_enable(struct clk_hw *hw)
885 {
886 	struct lpc32xx_clk_gate *clk = to_lpc32xx_gate(hw);
887 	u32 mask = BIT(clk->bit_idx);
888 	u32 val = (clk->flags & CLK_GATE_SET_TO_DISABLE ? 0x0 : mask);
889 
890 	return regmap_update_bits(clk_regmap, clk->reg, mask, val);
891 }
892 
lpc32xx_clk_gate_disable(struct clk_hw * hw)893 static void lpc32xx_clk_gate_disable(struct clk_hw *hw)
894 {
895 	struct lpc32xx_clk_gate *clk = to_lpc32xx_gate(hw);
896 	u32 mask = BIT(clk->bit_idx);
897 	u32 val = (clk->flags & CLK_GATE_SET_TO_DISABLE ? mask : 0x0);
898 
899 	regmap_update_bits(clk_regmap, clk->reg, mask, val);
900 }
901 
lpc32xx_clk_gate_is_enabled(struct clk_hw * hw)902 static int lpc32xx_clk_gate_is_enabled(struct clk_hw *hw)
903 {
904 	struct lpc32xx_clk_gate *clk = to_lpc32xx_gate(hw);
905 	u32 val;
906 	bool is_set;
907 
908 	regmap_read(clk_regmap, clk->reg, &val);
909 	is_set = val & BIT(clk->bit_idx);
910 
911 	return (clk->flags & CLK_GATE_SET_TO_DISABLE ? !is_set : is_set);
912 }
913 
914 static const struct clk_ops lpc32xx_clk_gate_ops = {
915 	.enable = lpc32xx_clk_gate_enable,
916 	.disable = lpc32xx_clk_gate_disable,
917 	.is_enabled = lpc32xx_clk_gate_is_enabled,
918 };
919 
920 #define div_mask(width)	((1 << (width)) - 1)
921 
_get_table_div(const struct clk_div_table * table,unsigned int val)922 static unsigned int _get_table_div(const struct clk_div_table *table,
923 							unsigned int val)
924 {
925 	const struct clk_div_table *clkt;
926 
927 	for (clkt = table; clkt->div; clkt++)
928 		if (clkt->val == val)
929 			return clkt->div;
930 	return 0;
931 }
932 
_get_div(const struct clk_div_table * table,unsigned int val,unsigned long flags,u8 width)933 static unsigned int _get_div(const struct clk_div_table *table,
934 			     unsigned int val, unsigned long flags, u8 width)
935 {
936 	if (flags & CLK_DIVIDER_ONE_BASED)
937 		return val;
938 	if (table)
939 		return _get_table_div(table, val);
940 	return val + 1;
941 }
942 
clk_divider_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)943 static unsigned long clk_divider_recalc_rate(struct clk_hw *hw,
944 		unsigned long parent_rate)
945 {
946 	struct lpc32xx_clk_div *divider = to_lpc32xx_div(hw);
947 	unsigned int val;
948 
949 	regmap_read(clk_regmap, divider->reg, &val);
950 
951 	val >>= divider->shift;
952 	val &= div_mask(divider->width);
953 
954 	return divider_recalc_rate(hw, parent_rate, val, divider->table,
955 				   divider->flags, divider->width);
956 }
957 
clk_divider_round_rate(struct clk_hw * hw,unsigned long rate,unsigned long * prate)958 static long clk_divider_round_rate(struct clk_hw *hw, unsigned long rate,
959 				unsigned long *prate)
960 {
961 	struct lpc32xx_clk_div *divider = to_lpc32xx_div(hw);
962 	unsigned int bestdiv;
963 
964 	/* if read only, just return current value */
965 	if (divider->flags & CLK_DIVIDER_READ_ONLY) {
966 		regmap_read(clk_regmap, divider->reg, &bestdiv);
967 		bestdiv >>= divider->shift;
968 		bestdiv &= div_mask(divider->width);
969 		bestdiv = _get_div(divider->table, bestdiv, divider->flags,
970 			divider->width);
971 		return DIV_ROUND_UP(*prate, bestdiv);
972 	}
973 
974 	return divider_round_rate(hw, rate, prate, divider->table,
975 				  divider->width, divider->flags);
976 }
977 
clk_divider_set_rate(struct clk_hw * hw,unsigned long rate,unsigned long parent_rate)978 static int clk_divider_set_rate(struct clk_hw *hw, unsigned long rate,
979 				unsigned long parent_rate)
980 {
981 	struct lpc32xx_clk_div *divider = to_lpc32xx_div(hw);
982 	unsigned int value;
983 
984 	value = divider_get_val(rate, parent_rate, divider->table,
985 				divider->width, divider->flags);
986 
987 	return regmap_update_bits(clk_regmap, divider->reg,
988 				  div_mask(divider->width) << divider->shift,
989 				  value << divider->shift);
990 }
991 
992 static const struct clk_ops lpc32xx_clk_divider_ops = {
993 	.recalc_rate = clk_divider_recalc_rate,
994 	.round_rate = clk_divider_round_rate,
995 	.set_rate = clk_divider_set_rate,
996 };
997 
clk_mux_get_parent(struct clk_hw * hw)998 static u8 clk_mux_get_parent(struct clk_hw *hw)
999 {
1000 	struct lpc32xx_clk_mux *mux = to_lpc32xx_mux(hw);
1001 	u32 num_parents = clk_hw_get_num_parents(hw);
1002 	u32 val;
1003 
1004 	regmap_read(clk_regmap, mux->reg, &val);
1005 	val >>= mux->shift;
1006 	val &= mux->mask;
1007 
1008 	if (mux->table) {
1009 		u32 i;
1010 
1011 		for (i = 0; i < num_parents; i++)
1012 			if (mux->table[i] == val)
1013 				return i;
1014 		return -EINVAL;
1015 	}
1016 
1017 	if (val >= num_parents)
1018 		return -EINVAL;
1019 
1020 	return val;
1021 }
1022 
clk_mux_set_parent(struct clk_hw * hw,u8 index)1023 static int clk_mux_set_parent(struct clk_hw *hw, u8 index)
1024 {
1025 	struct lpc32xx_clk_mux *mux = to_lpc32xx_mux(hw);
1026 
1027 	if (mux->table)
1028 		index = mux->table[index];
1029 
1030 	return regmap_update_bits(clk_regmap, mux->reg,
1031 			  mux->mask << mux->shift, index << mux->shift);
1032 }
1033 
1034 static const struct clk_ops lpc32xx_clk_mux_ro_ops = {
1035 	.get_parent = clk_mux_get_parent,
1036 };
1037 
1038 static const struct clk_ops lpc32xx_clk_mux_ops = {
1039 	.get_parent = clk_mux_get_parent,
1040 	.set_parent = clk_mux_set_parent,
1041 	.determine_rate = __clk_mux_determine_rate,
1042 };
1043 
1044 enum lpc32xx_clk_type {
1045 	CLK_FIXED,
1046 	CLK_MUX,
1047 	CLK_DIV,
1048 	CLK_GATE,
1049 	CLK_COMPOSITE,
1050 	CLK_LPC32XX,
1051 	CLK_LPC32XX_PLL,
1052 	CLK_LPC32XX_USB,
1053 };
1054 
1055 struct clk_hw_proto0 {
1056 	const struct clk_ops *ops;
1057 	union {
1058 		struct lpc32xx_pll_clk pll;
1059 		struct lpc32xx_clk clk;
1060 		struct lpc32xx_usb_clk usb_clk;
1061 		struct lpc32xx_clk_mux mux;
1062 		struct lpc32xx_clk_div div;
1063 		struct lpc32xx_clk_gate gate;
1064 	};
1065 };
1066 
1067 struct clk_hw_proto1 {
1068 	struct clk_hw_proto0 *mux;
1069 	struct clk_hw_proto0 *div;
1070 	struct clk_hw_proto0 *gate;
1071 };
1072 
1073 struct clk_hw_proto {
1074 	enum lpc32xx_clk_type type;
1075 
1076 	union {
1077 		struct clk_fixed_rate f;
1078 		struct clk_hw_proto0 hw0;
1079 		struct clk_hw_proto1 hw1;
1080 	};
1081 };
1082 
1083 #define LPC32XX_DEFINE_FIXED(_idx, _rate)			\
1084 [CLK_PREFIX(_idx)] = {							\
1085 	.type = CLK_FIXED,						\
1086 	{								\
1087 		.f = {							\
1088 			.fixed_rate = (_rate),				\
1089 		},							\
1090 	},								\
1091 }
1092 
1093 #define LPC32XX_DEFINE_PLL(_idx, _name, _reg, _enable)			\
1094 [CLK_PREFIX(_idx)] = {							\
1095 	.type = CLK_LPC32XX_PLL,					\
1096 	{								\
1097 		.hw0 = {						\
1098 			.ops = &clk_ ##_name ## _ops,			\
1099 			{						\
1100 				.pll = {				\
1101 					.reg = LPC32XX_CLKPWR_ ## _reg,	\
1102 					.enable = (_enable),		\
1103 				},					\
1104 			},						\
1105 		},							\
1106 	},								\
1107 }
1108 
1109 #define LPC32XX_DEFINE_MUX(_idx, _reg, _shift, _mask, _table, _flags)	\
1110 [CLK_PREFIX(_idx)] = {							\
1111 	.type = CLK_MUX,						\
1112 	{								\
1113 		.hw0 = {						\
1114 			.ops = (_flags & CLK_MUX_READ_ONLY ?		\
1115 				&lpc32xx_clk_mux_ro_ops :		\
1116 				&lpc32xx_clk_mux_ops),			\
1117 			{						\
1118 				.mux = {				\
1119 					.reg = LPC32XX_CLKPWR_ ## _reg,	\
1120 					.mask = (_mask),		\
1121 					.shift = (_shift),		\
1122 					.table = (_table),		\
1123 					.flags = (_flags),		\
1124 				},					\
1125 			},						\
1126 		},							\
1127 	},								\
1128 }
1129 
1130 #define LPC32XX_DEFINE_DIV(_idx, _reg, _shift, _width, _table, _flags)	\
1131 [CLK_PREFIX(_idx)] = {							\
1132 	.type = CLK_DIV,						\
1133 	{								\
1134 		.hw0 = {						\
1135 			.ops = &lpc32xx_clk_divider_ops,		\
1136 			{						\
1137 				.div = {				\
1138 					.reg = LPC32XX_CLKPWR_ ## _reg,	\
1139 					.shift = (_shift),		\
1140 					.width = (_width),		\
1141 					.table = (_table),		\
1142 					.flags = (_flags),		\
1143 				 },					\
1144 			},						\
1145 		 },							\
1146 	},								\
1147 }
1148 
1149 #define LPC32XX_DEFINE_GATE(_idx, _reg, _bit, _flags)			\
1150 [CLK_PREFIX(_idx)] = {							\
1151 	.type = CLK_GATE,						\
1152 	{								\
1153 		.hw0 = {						\
1154 			.ops = &lpc32xx_clk_gate_ops,			\
1155 			{						\
1156 				.gate = {				\
1157 					.reg = LPC32XX_CLKPWR_ ## _reg,	\
1158 					.bit_idx = (_bit),		\
1159 					.flags = (_flags),		\
1160 				},					\
1161 			},						\
1162 		},							\
1163 	},								\
1164 }
1165 
1166 #define LPC32XX_DEFINE_CLK(_idx, _reg, _e, _em, _d, _dm, _b, _bm, _ops)	\
1167 [CLK_PREFIX(_idx)] = {							\
1168 	.type = CLK_LPC32XX,						\
1169 	{								\
1170 		.hw0 = {						\
1171 			.ops = &(_ops),					\
1172 			{						\
1173 				.clk = {				\
1174 					.reg = LPC32XX_CLKPWR_ ## _reg,	\
1175 					.enable = (_e),			\
1176 					.enable_mask = (_em),		\
1177 					.disable = (_d),		\
1178 					.disable_mask = (_dm),		\
1179 					.busy = (_b),			\
1180 					.busy_mask = (_bm),		\
1181 				},					\
1182 			},						\
1183 		},							\
1184 	},								\
1185 }
1186 
1187 #define LPC32XX_DEFINE_USB(_idx, _ce, _cd, _cm, _e, _b, _ops)		\
1188 [CLK_PREFIX(_idx)] = {							\
1189 	.type = CLK_LPC32XX_USB,					\
1190 	{								\
1191 		.hw0 = {						\
1192 			.ops = &(_ops),					\
1193 			{						\
1194 				.usb_clk = {				\
1195 					.ctrl_enable = (_ce),		\
1196 					.ctrl_disable = (_cd),		\
1197 					.ctrl_mask = (_cm),		\
1198 					.enable = (_e),			\
1199 					.busy = (_b),			\
1200 				}					\
1201 			},						\
1202 		}							\
1203 	},								\
1204 }
1205 
1206 #define LPC32XX_DEFINE_COMPOSITE(_idx, _mux, _div, _gate)		\
1207 [CLK_PREFIX(_idx)] = {							\
1208 	.type = CLK_COMPOSITE,						\
1209 	{								\
1210 		.hw1 = {						\
1211 		.mux = (CLK_PREFIX(_mux) == LPC32XX_CLK__NULL ? NULL :	\
1212 			&clk_hw_proto[CLK_PREFIX(_mux)].hw0),		\
1213 		.div = (CLK_PREFIX(_div) == LPC32XX_CLK__NULL ? NULL :	\
1214 			&clk_hw_proto[CLK_PREFIX(_div)].hw0),		\
1215 		.gate = (CLK_PREFIX(_gate) == LPC32XX_CLK__NULL ? NULL :\
1216 			 &clk_hw_proto[CLK_PREFIX(_gate)].hw0),		\
1217 		},							\
1218 	},								\
1219 }
1220 
1221 static struct clk_hw_proto clk_hw_proto[LPC32XX_CLK_HW_MAX] = {
1222 	LPC32XX_DEFINE_FIXED(RTC, 32768),
1223 	LPC32XX_DEFINE_PLL(PLL397X, pll_397x, HCLKPLL_CTRL, BIT(1)),
1224 	LPC32XX_DEFINE_PLL(HCLK_PLL, hclk_pll, HCLKPLL_CTRL, PLL_CTRL_ENABLE),
1225 	LPC32XX_DEFINE_PLL(USB_PLL, usb_pll, USB_CTRL, PLL_CTRL_ENABLE),
1226 	LPC32XX_DEFINE_GATE(OSC, OSC_CTRL, 0, CLK_GATE_SET_TO_DISABLE),
1227 	LPC32XX_DEFINE_GATE(USB, USB_CTRL, 18, 0),
1228 
1229 	LPC32XX_DEFINE_DIV(HCLK_DIV_PERIPH, HCLKDIV_CTRL, 2, 5, NULL,
1230 			   CLK_DIVIDER_READ_ONLY),
1231 	LPC32XX_DEFINE_DIV(HCLK_DIV, HCLKDIV_CTRL, 0, 2, clk_hclk_div_table,
1232 			   CLK_DIVIDER_READ_ONLY),
1233 
1234 	/* Register 3 read-only muxes with a single control PWR_CTRL[2] */
1235 	LPC32XX_DEFINE_MUX(SYSCLK_PERIPH_MUX, PWR_CTRL, 2, 0x1, NULL,
1236 			   CLK_MUX_READ_ONLY),
1237 	LPC32XX_DEFINE_MUX(SYSCLK_HCLK_MUX, PWR_CTRL, 2, 0x1, NULL,
1238 			   CLK_MUX_READ_ONLY),
1239 	LPC32XX_DEFINE_MUX(SYSCLK_ARM_MUX, PWR_CTRL, 2, 0x1, NULL,
1240 			   CLK_MUX_READ_ONLY),
1241 	/* Register 2 read-only muxes with a single control PWR_CTRL[10] */
1242 	LPC32XX_DEFINE_MUX(PERIPH_HCLK_MUX, PWR_CTRL, 10, 0x1, NULL,
1243 			   CLK_MUX_READ_ONLY),
1244 	LPC32XX_DEFINE_MUX(PERIPH_ARM_MUX, PWR_CTRL, 10, 0x1, NULL,
1245 			   CLK_MUX_READ_ONLY),
1246 
1247 	/* 3 always on gates with a single control PWR_CTRL[0] same as OSC */
1248 	LPC32XX_DEFINE_GATE(PERIPH, PWR_CTRL, 0, CLK_GATE_SET_TO_DISABLE),
1249 	LPC32XX_DEFINE_GATE(HCLK, PWR_CTRL, 0, CLK_GATE_SET_TO_DISABLE),
1250 	LPC32XX_DEFINE_GATE(ARM, PWR_CTRL, 0, CLK_GATE_SET_TO_DISABLE),
1251 
1252 	LPC32XX_DEFINE_GATE(ARM_VFP, DEBUG_CTRL, 4, 0),
1253 	LPC32XX_DEFINE_GATE(DMA, DMA_CLK_CTRL, 0, 0),
1254 	LPC32XX_DEFINE_CLK(DDRAM, HCLKDIV_CTRL, 0x0, BIT(8) | BIT(7),
1255 		   0x0, BIT(8) | BIT(7), 0x0, BIT(1) | BIT(0), clk_ddram_ops),
1256 
1257 	LPC32XX_DEFINE_GATE(TIMER0, TIMCLK_CTRL1, 2, 0),
1258 	LPC32XX_DEFINE_GATE(TIMER1, TIMCLK_CTRL1, 3, 0),
1259 	LPC32XX_DEFINE_GATE(TIMER2, TIMCLK_CTRL1, 4, 0),
1260 	LPC32XX_DEFINE_GATE(TIMER3, TIMCLK_CTRL1, 5, 0),
1261 	LPC32XX_DEFINE_GATE(TIMER4, TIMCLK_CTRL1, 0, 0),
1262 	LPC32XX_DEFINE_GATE(TIMER5, TIMCLK_CTRL1, 1, 0),
1263 
1264 	LPC32XX_DEFINE_GATE(SSP0, SSP_CTRL, 0, 0),
1265 	LPC32XX_DEFINE_GATE(SSP1, SSP_CTRL, 1, 0),
1266 	LPC32XX_DEFINE_GATE(SPI1, SPI_CTRL, 0, 0),
1267 	LPC32XX_DEFINE_GATE(SPI2, SPI_CTRL, 4, 0),
1268 	LPC32XX_DEFINE_GATE(I2S0, I2S_CTRL, 0, 0),
1269 	LPC32XX_DEFINE_GATE(I2S1, I2S_CTRL, 1, 0),
1270 	LPC32XX_DEFINE_GATE(I2C1, I2CCLK_CTRL, 0, 0),
1271 	LPC32XX_DEFINE_GATE(I2C2, I2CCLK_CTRL, 1, 0),
1272 	LPC32XX_DEFINE_GATE(WDOG, TIMCLK_CTRL, 0, 0),
1273 	LPC32XX_DEFINE_GATE(HSTIMER, TIMCLK_CTRL, 1, 0),
1274 
1275 	LPC32XX_DEFINE_GATE(KEY, KEYCLK_CTRL, 0, 0),
1276 	LPC32XX_DEFINE_GATE(MCPWM, TIMCLK_CTRL1, 6, 0),
1277 
1278 	LPC32XX_DEFINE_MUX(PWM1_MUX, PWMCLK_CTRL, 1, 0x1, NULL, 0),
1279 	LPC32XX_DEFINE_DIV(PWM1_DIV, PWMCLK_CTRL, 4, 4, NULL,
1280 			   CLK_DIVIDER_ONE_BASED),
1281 	LPC32XX_DEFINE_GATE(PWM1_GATE, PWMCLK_CTRL, 0, 0),
1282 	LPC32XX_DEFINE_COMPOSITE(PWM1, PWM1_MUX, PWM1_DIV, PWM1_GATE),
1283 
1284 	LPC32XX_DEFINE_MUX(PWM2_MUX, PWMCLK_CTRL, 3, 0x1, NULL, 0),
1285 	LPC32XX_DEFINE_DIV(PWM2_DIV, PWMCLK_CTRL, 8, 4, NULL,
1286 			   CLK_DIVIDER_ONE_BASED),
1287 	LPC32XX_DEFINE_GATE(PWM2_GATE, PWMCLK_CTRL, 2, 0),
1288 	LPC32XX_DEFINE_COMPOSITE(PWM2, PWM2_MUX, PWM2_DIV, PWM2_GATE),
1289 
1290 	LPC32XX_DEFINE_MUX(UART3_MUX, UART3_CLK_CTRL, 16, 0x1, NULL, 0),
1291 	LPC32XX_DEFINE_CLK(UART3_DIV, UART3_CLK_CTRL,
1292 			   0, 0, 0, 0, 0, 0, lpc32xx_uart_div_ops),
1293 	LPC32XX_DEFINE_GATE(UART3_GATE, UART_CLK_CTRL, 0, 0),
1294 	LPC32XX_DEFINE_COMPOSITE(UART3, UART3_MUX, UART3_DIV, UART3_GATE),
1295 
1296 	LPC32XX_DEFINE_MUX(UART4_MUX, UART4_CLK_CTRL, 16, 0x1, NULL, 0),
1297 	LPC32XX_DEFINE_CLK(UART4_DIV, UART4_CLK_CTRL,
1298 			   0, 0, 0, 0, 0, 0, lpc32xx_uart_div_ops),
1299 	LPC32XX_DEFINE_GATE(UART4_GATE, UART_CLK_CTRL, 1, 0),
1300 	LPC32XX_DEFINE_COMPOSITE(UART4, UART4_MUX, UART4_DIV, UART4_GATE),
1301 
1302 	LPC32XX_DEFINE_MUX(UART5_MUX, UART5_CLK_CTRL, 16, 0x1, NULL, 0),
1303 	LPC32XX_DEFINE_CLK(UART5_DIV, UART5_CLK_CTRL,
1304 			   0, 0, 0, 0, 0, 0, lpc32xx_uart_div_ops),
1305 	LPC32XX_DEFINE_GATE(UART5_GATE, UART_CLK_CTRL, 2, 0),
1306 	LPC32XX_DEFINE_COMPOSITE(UART5, UART5_MUX, UART5_DIV, UART5_GATE),
1307 
1308 	LPC32XX_DEFINE_MUX(UART6_MUX, UART6_CLK_CTRL, 16, 0x1, NULL, 0),
1309 	LPC32XX_DEFINE_CLK(UART6_DIV, UART6_CLK_CTRL,
1310 			   0, 0, 0, 0, 0, 0, lpc32xx_uart_div_ops),
1311 	LPC32XX_DEFINE_GATE(UART6_GATE, UART_CLK_CTRL, 3, 0),
1312 	LPC32XX_DEFINE_COMPOSITE(UART6, UART6_MUX, UART6_DIV, UART6_GATE),
1313 
1314 	LPC32XX_DEFINE_CLK(IRDA, IRDA_CLK_CTRL,
1315 			   0, 0, 0, 0, 0, 0, lpc32xx_uart_div_ops),
1316 
1317 	LPC32XX_DEFINE_MUX(TEST1_MUX, TEST_CLK_CTRL, 5, 0x3,
1318 			   test1_mux_table, 0),
1319 	LPC32XX_DEFINE_GATE(TEST1_GATE, TEST_CLK_CTRL, 4, 0),
1320 	LPC32XX_DEFINE_COMPOSITE(TEST1, TEST1_MUX, _NULL, TEST1_GATE),
1321 
1322 	LPC32XX_DEFINE_MUX(TEST2_MUX, TEST_CLK_CTRL, 1, 0x7,
1323 			   test2_mux_table, 0),
1324 	LPC32XX_DEFINE_GATE(TEST2_GATE, TEST_CLK_CTRL, 0, 0),
1325 	LPC32XX_DEFINE_COMPOSITE(TEST2, TEST2_MUX, _NULL, TEST2_GATE),
1326 
1327 	LPC32XX_DEFINE_MUX(SYS, SYSCLK_CTRL, 0, 0x1, NULL, CLK_MUX_READ_ONLY),
1328 
1329 	LPC32XX_DEFINE_DIV(USB_DIV_DIV, USB_DIV, 0, 4, NULL, 0),
1330 	LPC32XX_DEFINE_GATE(USB_DIV_GATE, USB_CTRL, 17, 0),
1331 	LPC32XX_DEFINE_COMPOSITE(USB_DIV, _NULL, USB_DIV_DIV, USB_DIV_GATE),
1332 
1333 	LPC32XX_DEFINE_DIV(SD_DIV, MS_CTRL, 0, 4, NULL, CLK_DIVIDER_ONE_BASED),
1334 	LPC32XX_DEFINE_CLK(SD_GATE, MS_CTRL, BIT(5) | BIT(9), BIT(5) | BIT(9),
1335 			   0x0, BIT(5) | BIT(9), 0x0, 0x0, clk_mask_ops),
1336 	LPC32XX_DEFINE_COMPOSITE(SD, _NULL, SD_DIV, SD_GATE),
1337 
1338 	LPC32XX_DEFINE_DIV(LCD_DIV, LCDCLK_CTRL, 0, 5, NULL, 0),
1339 	LPC32XX_DEFINE_GATE(LCD_GATE, LCDCLK_CTRL, 5, 0),
1340 	LPC32XX_DEFINE_COMPOSITE(LCD, _NULL, LCD_DIV, LCD_GATE),
1341 
1342 	LPC32XX_DEFINE_CLK(MAC, MACCLK_CTRL,
1343 			   BIT(2) | BIT(1) | BIT(0), BIT(2) | BIT(1) | BIT(0),
1344 			   BIT(2) | BIT(1) | BIT(0), BIT(2) | BIT(1) | BIT(0),
1345 			   0x0, 0x0, clk_mask_ops),
1346 	LPC32XX_DEFINE_CLK(SLC, FLASHCLK_CTRL,
1347 			   BIT(2) | BIT(0), BIT(2) | BIT(0), 0x0,
1348 			   BIT(0), BIT(1), BIT(2) | BIT(1), clk_mask_ops),
1349 	LPC32XX_DEFINE_CLK(MLC, FLASHCLK_CTRL,
1350 			   BIT(1), BIT(2) | BIT(1), 0x0, BIT(1),
1351 			   BIT(2) | BIT(0), BIT(2) | BIT(0), clk_mask_ops),
1352 	/*
1353 	 * ADC/TS clock unfortunately cannot be registered as a composite one
1354 	 * due to a different connection of gate, div and mux, e.g. gating it
1355 	 * won't mean that the clock is off, if peripheral clock is its parent:
1356 	 *
1357 	 * rtc-->[gate]-->|     |
1358 	 *                | mux |--> adc/ts
1359 	 * pclk-->[div]-->|     |
1360 	 *
1361 	 * Constraints:
1362 	 * ADC --- resulting clock must be <= 4.5 MHz
1363 	 * TS  --- resulting clock must be <= 400 KHz
1364 	 */
1365 	LPC32XX_DEFINE_DIV(ADC_DIV, ADCCLK_CTRL1, 0, 8, NULL, 0),
1366 	LPC32XX_DEFINE_GATE(ADC_RTC, ADCCLK_CTRL, 0, 0),
1367 	LPC32XX_DEFINE_MUX(ADC, ADCCLK_CTRL1, 8, 0x1, NULL, 0),
1368 
1369 	/* USB controller clocks */
1370 	LPC32XX_DEFINE_USB(USB_AHB,
1371 			   BIT(24), 0x0, BIT(24), BIT(4), 0, clk_usb_ops),
1372 	LPC32XX_DEFINE_USB(USB_OTG,
1373 			   0x0, 0x0, 0x0, BIT(3), 0, clk_usb_ops),
1374 	LPC32XX_DEFINE_USB(USB_I2C,
1375 			   0x0, BIT(23), BIT(23), BIT(2), 0, clk_usb_i2c_ops),
1376 	LPC32XX_DEFINE_USB(USB_DEV,
1377 			   BIT(22), 0x0, BIT(22), BIT(1), BIT(0), clk_usb_ops),
1378 	LPC32XX_DEFINE_USB(USB_HOST,
1379 			   BIT(21), 0x0, BIT(21), BIT(0), BIT(1), clk_usb_ops),
1380 };
1381 
lpc32xx_clk_register(u32 id)1382 static struct clk * __init lpc32xx_clk_register(u32 id)
1383 {
1384 	const struct clk_proto_t *lpc32xx_clk = &clk_proto[id];
1385 	struct clk_hw_proto *clk_hw = &clk_hw_proto[id];
1386 	const char *parents[LPC32XX_CLK_PARENTS_MAX];
1387 	struct clk *clk;
1388 	unsigned int i;
1389 
1390 	for (i = 0; i < lpc32xx_clk->num_parents; i++)
1391 		parents[i] = clk_proto[lpc32xx_clk->parents[i]].name;
1392 
1393 	pr_debug("%s: derived from '%s', clock type %d\n", lpc32xx_clk->name,
1394 		 parents[0], clk_hw->type);
1395 
1396 	switch (clk_hw->type) {
1397 	case CLK_LPC32XX:
1398 	case CLK_LPC32XX_PLL:
1399 	case CLK_LPC32XX_USB:
1400 	case CLK_MUX:
1401 	case CLK_DIV:
1402 	case CLK_GATE:
1403 	{
1404 		struct clk_init_data clk_init = {
1405 			.name = lpc32xx_clk->name,
1406 			.parent_names = parents,
1407 			.num_parents = lpc32xx_clk->num_parents,
1408 			.flags = lpc32xx_clk->flags,
1409 			.ops = clk_hw->hw0.ops,
1410 		};
1411 		struct clk_hw *hw;
1412 
1413 		if (clk_hw->type == CLK_LPC32XX)
1414 			hw = &clk_hw->hw0.clk.hw;
1415 		else if (clk_hw->type == CLK_LPC32XX_PLL)
1416 			hw = &clk_hw->hw0.pll.hw;
1417 		else if (clk_hw->type == CLK_LPC32XX_USB)
1418 			hw = &clk_hw->hw0.usb_clk.hw;
1419 		else if (clk_hw->type == CLK_MUX)
1420 			hw = &clk_hw->hw0.mux.hw;
1421 		else if (clk_hw->type == CLK_DIV)
1422 			hw = &clk_hw->hw0.div.hw;
1423 		else if (clk_hw->type == CLK_GATE)
1424 			hw = &clk_hw->hw0.gate.hw;
1425 		else
1426 			return ERR_PTR(-EINVAL);
1427 
1428 		hw->init = &clk_init;
1429 		clk = clk_register(NULL, hw);
1430 		break;
1431 	}
1432 	case CLK_COMPOSITE:
1433 	{
1434 		struct clk_hw *mux_hw = NULL, *div_hw = NULL, *gate_hw = NULL;
1435 		const struct clk_ops *mops = NULL, *dops = NULL, *gops = NULL;
1436 		struct clk_hw_proto0 *mux0, *div0, *gate0;
1437 
1438 		mux0 = clk_hw->hw1.mux;
1439 		div0 = clk_hw->hw1.div;
1440 		gate0 = clk_hw->hw1.gate;
1441 		if (mux0) {
1442 			mops = mux0->ops;
1443 			mux_hw = &mux0->clk.hw;
1444 		}
1445 		if (div0) {
1446 			dops = div0->ops;
1447 			div_hw = &div0->clk.hw;
1448 		}
1449 		if (gate0) {
1450 			gops = gate0->ops;
1451 			gate_hw = &gate0->clk.hw;
1452 		}
1453 
1454 		clk = clk_register_composite(NULL, lpc32xx_clk->name,
1455 				parents, lpc32xx_clk->num_parents,
1456 				mux_hw, mops, div_hw, dops,
1457 				gate_hw, gops, lpc32xx_clk->flags);
1458 		break;
1459 	}
1460 	case CLK_FIXED:
1461 	{
1462 		struct clk_fixed_rate *fixed = &clk_hw->f;
1463 
1464 		clk = clk_register_fixed_rate(NULL, lpc32xx_clk->name,
1465 			parents[0], 0, fixed->fixed_rate);
1466 		break;
1467 	}
1468 	default:
1469 		clk = ERR_PTR(-EINVAL);
1470 	}
1471 
1472 	return clk;
1473 }
1474 
lpc32xx_clk_div_quirk(u32 reg,u32 div_mask,u32 gate)1475 static void __init lpc32xx_clk_div_quirk(u32 reg, u32 div_mask, u32 gate)
1476 {
1477 	u32 val;
1478 
1479 	regmap_read(clk_regmap, reg, &val);
1480 
1481 	if (!(val & div_mask)) {
1482 		val &= ~gate;
1483 		val |= BIT(__ffs(div_mask));
1484 	}
1485 
1486 	regmap_update_bits(clk_regmap, reg, gate | div_mask, val);
1487 }
1488 
lpc32xx_clk_init(struct device_node * np)1489 static void __init lpc32xx_clk_init(struct device_node *np)
1490 {
1491 	unsigned int i;
1492 	struct clk *clk_osc, *clk_32k;
1493 	void __iomem *base = NULL;
1494 
1495 	/* Ensure that parent clocks are available and valid */
1496 	clk_32k = of_clk_get_by_name(np, clk_proto[LPC32XX_CLK_XTAL_32K].name);
1497 	if (IS_ERR(clk_32k)) {
1498 		pr_err("failed to find external 32KHz clock: %ld\n",
1499 		       PTR_ERR(clk_32k));
1500 		return;
1501 	}
1502 	if (clk_get_rate(clk_32k) != 32768) {
1503 		pr_err("invalid clock rate of external 32KHz oscillator\n");
1504 		return;
1505 	}
1506 
1507 	clk_osc = of_clk_get_by_name(np, clk_proto[LPC32XX_CLK_XTAL].name);
1508 	if (IS_ERR(clk_osc)) {
1509 		pr_err("failed to find external main oscillator clock: %ld\n",
1510 		       PTR_ERR(clk_osc));
1511 		return;
1512 	}
1513 
1514 	base = of_iomap(np, 0);
1515 	if (!base) {
1516 		pr_err("failed to map system control block registers\n");
1517 		return;
1518 	}
1519 
1520 	clk_regmap = regmap_init_mmio(NULL, base, &lpc32xx_scb_regmap_config);
1521 	if (IS_ERR(clk_regmap)) {
1522 		pr_err("failed to regmap system control block: %ld\n",
1523 			PTR_ERR(clk_regmap));
1524 		iounmap(base);
1525 		return;
1526 	}
1527 
1528 	/*
1529 	 * Divider part of PWM and MS clocks requires a quirk to avoid
1530 	 * a misinterpretation of formally valid zero value in register
1531 	 * bitfield, which indicates another clock gate. Instead of
1532 	 * adding complexity to a gate clock ensure that zero value in
1533 	 * divider clock is never met in runtime.
1534 	 */
1535 	lpc32xx_clk_div_quirk(LPC32XX_CLKPWR_PWMCLK_CTRL, 0xf0, BIT(0));
1536 	lpc32xx_clk_div_quirk(LPC32XX_CLKPWR_PWMCLK_CTRL, 0xf00, BIT(2));
1537 	lpc32xx_clk_div_quirk(LPC32XX_CLKPWR_MS_CTRL, 0xf, BIT(5) | BIT(9));
1538 
1539 	for (i = 1; i < LPC32XX_CLK_MAX; i++) {
1540 		clk[i] = lpc32xx_clk_register(i);
1541 		if (IS_ERR(clk[i])) {
1542 			pr_err("failed to register %s clock: %ld\n",
1543 				clk_proto[i].name, PTR_ERR(clk[i]));
1544 			clk[i] = NULL;
1545 		}
1546 	}
1547 
1548 	of_clk_add_provider(np, of_clk_src_onecell_get, &clk_data);
1549 
1550 	/* Set 48MHz rate of USB PLL clock */
1551 	clk_set_rate(clk[LPC32XX_CLK_USB_PLL], 48000000);
1552 
1553 	/* These two clocks must be always on independently on consumers */
1554 	clk_prepare_enable(clk[LPC32XX_CLK_ARM]);
1555 	clk_prepare_enable(clk[LPC32XX_CLK_HCLK]);
1556 
1557 	/* Enable ARM VFP by default */
1558 	clk_prepare_enable(clk[LPC32XX_CLK_ARM_VFP]);
1559 
1560 	/* Disable enabled by default clocks for NAND MLC and SLC */
1561 	clk_mask_disable(&clk_hw_proto[LPC32XX_CLK_SLC].hw0.clk.hw);
1562 	clk_mask_disable(&clk_hw_proto[LPC32XX_CLK_MLC].hw0.clk.hw);
1563 }
1564 CLK_OF_DECLARE(lpc32xx_clk, "nxp,lpc3220-clk", lpc32xx_clk_init);
1565 
lpc32xx_usb_clk_init(struct device_node * np)1566 static void __init lpc32xx_usb_clk_init(struct device_node *np)
1567 {
1568 	unsigned int i;
1569 
1570 	usb_clk_vbase = of_iomap(np, 0);
1571 	if (!usb_clk_vbase) {
1572 		pr_err("failed to map address range\n");
1573 		return;
1574 	}
1575 
1576 	for (i = 1; i < LPC32XX_USB_CLK_MAX; i++) {
1577 		usb_clk[i] = lpc32xx_clk_register(i + LPC32XX_CLK_USB_OFFSET);
1578 		if (IS_ERR(usb_clk[i])) {
1579 			pr_err("failed to register %s clock: %ld\n",
1580 				clk_proto[i].name, PTR_ERR(usb_clk[i]));
1581 			usb_clk[i] = NULL;
1582 		}
1583 	}
1584 
1585 	of_clk_add_provider(np, of_clk_src_onecell_get, &usb_clk_data);
1586 }
1587 CLK_OF_DECLARE(lpc32xx_usb_clk, "nxp,lpc3220-usb-clk", lpc32xx_usb_clk_init);
1588