am335x_prcm.c revision 286692
1/*-
2 * Copyright (c) 2012 Damjan Marion <dmarion@Freebsd.org>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 *    notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 *    notice, this list of conditions and the following disclaimer in the
12 *    documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27#include <sys/cdefs.h>
28__FBSDID("$FreeBSD: head/sys/arm/ti/am335x/am335x_prcm.c 286692 2015-08-12 19:25:22Z ian $");
29
30#include <sys/param.h>
31#include <sys/systm.h>
32#include <sys/bus.h>
33#include <sys/kernel.h>
34#include <sys/module.h>
35#include <sys/malloc.h>
36#include <sys/rman.h>
37#include <sys/timeet.h>
38#include <sys/timetc.h>
39#include <sys/watchdog.h>
40#include <machine/bus.h>
41#include <machine/cpu.h>
42#include <machine/intr.h>
43
44#include <arm/ti/tivar.h>
45#include <arm/ti/ti_scm.h>
46#include <arm/ti/ti_prcm.h>
47
48#include <dev/fdt/fdt_common.h>
49#include <dev/ofw/openfirm.h>
50#include <dev/ofw/ofw_bus.h>
51#include <dev/ofw/ofw_bus_subr.h>
52
53#include <machine/bus.h>
54
55#define CM_PER				0
56#define CM_PER_L4LS_CLKSTCTRL		(CM_PER + 0x000)
57#define CM_PER_L3S_CLKSTCTRL		(CM_PER + 0x004)
58#define CM_PER_L3_CLKSTCTRL		(CM_PER + 0x00C)
59#define CM_PER_CPGMAC0_CLKCTRL		(CM_PER + 0x014)
60#define CM_PER_LCDC_CLKCTRL		(CM_PER + 0x018)
61#define CM_PER_USB0_CLKCTRL		(CM_PER + 0x01C)
62#define CM_PER_TPTC0_CLKCTRL		(CM_PER + 0x024)
63#define CM_PER_UART5_CLKCTRL		(CM_PER + 0x038)
64#define CM_PER_MMC0_CLKCTRL		(CM_PER + 0x03C)
65#define CM_PER_I2C2_CLKCTRL		(CM_PER + 0x044)
66#define CM_PER_I2C1_CLKCTRL		(CM_PER + 0x048)
67#define CM_PER_UART1_CLKCTRL		(CM_PER + 0x06C)
68#define CM_PER_UART2_CLKCTRL		(CM_PER + 0x070)
69#define CM_PER_UART3_CLKCTRL		(CM_PER + 0x074)
70#define CM_PER_UART4_CLKCTRL		(CM_PER + 0x078)
71#define CM_PER_TIMER7_CLKCTRL		(CM_PER + 0x07C)
72#define CM_PER_TIMER2_CLKCTRL		(CM_PER + 0x080)
73#define CM_PER_TIMER3_CLKCTRL		(CM_PER + 0x084)
74#define CM_PER_TIMER4_CLKCTRL		(CM_PER + 0x088)
75#define CM_PER_GPIO1_CLKCTRL		(CM_PER + 0x0AC)
76#define CM_PER_GPIO2_CLKCTRL		(CM_PER + 0x0B0)
77#define CM_PER_GPIO3_CLKCTRL		(CM_PER + 0x0B4)
78#define CM_PER_TPCC_CLKCTRL		(CM_PER + 0x0BC)
79#define CM_PER_EPWMSS1_CLKCTRL		(CM_PER + 0x0CC)
80#define CM_PER_EPWMSS0_CLKCTRL		(CM_PER + 0x0D4)
81#define CM_PER_EPWMSS2_CLKCTRL		(CM_PER + 0x0D8)
82#define CM_PER_L3_INSTR_CLKCTRL		(CM_PER + 0x0DC)
83#define CM_PER_L3_CLKCTRL		(CM_PER + 0x0E0)
84#define	CM_PER_PRUSS_CLKCTRL		(CM_PER + 0x0E8)
85#define CM_PER_TIMER5_CLKCTRL		(CM_PER + 0x0EC)
86#define CM_PER_TIMER6_CLKCTRL		(CM_PER + 0x0F0)
87#define CM_PER_MMC1_CLKCTRL		(CM_PER + 0x0F4)
88#define CM_PER_MMC2_CLKCTRL		(CM_PER + 0x0F8)
89#define CM_PER_TPTC1_CLKCTRL		(CM_PER + 0x0FC)
90#define CM_PER_TPTC2_CLKCTRL		(CM_PER + 0x100)
91#define	CM_PER_SPINLOCK0_CLKCTRL	(CM_PER + 0x10C)
92#define	CM_PER_MAILBOX0_CLKCTRL		(CM_PER + 0x110)
93#define CM_PER_OCPWP_L3_CLKSTCTRL	(CM_PER + 0x12C)
94#define CM_PER_OCPWP_CLKCTRL		(CM_PER + 0x130)
95#define CM_PER_CPSW_CLKSTCTRL		(CM_PER + 0x144)
96#define	CM_PER_PRUSS_CLKSTCTRL		(CM_PER + 0x140)
97
98#define CM_WKUP				0x400
99#define CM_WKUP_CLKSTCTRL		(CM_WKUP + 0x000)
100#define CM_WKUP_CONTROL_CLKCTRL		(CM_WKUP + 0x004)
101#define CM_WKUP_GPIO0_CLKCTRL		(CM_WKUP + 0x008)
102#define CM_WKUP_CM_L3_AON_CLKSTCTRL	(CM_WKUP + 0x01C)
103#define CM_WKUP_CM_CLKSEL_DPLL_MPU	(CM_WKUP + 0x02C)
104#define CM_WKUP_CM_IDLEST_DPLL_DISP	(CM_WKUP + 0x048)
105#define CM_WKUP_CM_CLKSEL_DPLL_DISP	(CM_WKUP + 0x054)
106#define CM_WKUP_CM_CLKDCOLDO_DPLL_PER	(CM_WKUP + 0x07C)
107#define CM_WKUP_CM_CLKMODE_DPLL_DISP	(CM_WKUP + 0x098)
108#define CM_WKUP_I2C0_CLKCTRL		(CM_WKUP + 0x0B8)
109#define CM_WKUP_ADC_TSC_CLKCTRL		(CM_WKUP + 0x0BC)
110
111#define CM_DPLL				0x500
112#define CLKSEL_TIMER7_CLK		(CM_DPLL + 0x004)
113#define CLKSEL_TIMER2_CLK		(CM_DPLL + 0x008)
114#define CLKSEL_TIMER3_CLK		(CM_DPLL + 0x00C)
115#define CLKSEL_TIMER4_CLK		(CM_DPLL + 0x010)
116#define CLKSEL_TIMER5_CLK		(CM_DPLL + 0x018)
117#define CLKSEL_TIMER6_CLK		(CM_DPLL + 0x01C)
118#define	CLKSEL_PRUSS_OCP_CLK		(CM_DPLL + 0x030)
119
120#define	CM_RTC				0x800
121#define	CM_RTC_RTC_CLKCTRL		(CM_RTC + 0x000)
122#define	CM_RTC_CLKSTCTRL		(CM_RTC + 0x004)
123
124#define	PRM_PER				0xC00
125#define	PRM_PER_RSTCTRL			(PRM_PER + 0x00)
126
127#define PRM_DEVICE_OFFSET		0xF00
128#define PRM_RSTCTRL			(PRM_DEVICE_OFFSET + 0x00)
129
130struct am335x_prcm_softc {
131	struct resource *	res[2];
132	bus_space_tag_t		bst;
133	bus_space_handle_t	bsh;
134};
135
136static struct resource_spec am335x_prcm_spec[] = {
137	{ SYS_RES_MEMORY,	0,	RF_ACTIVE },
138	{ -1, 0 }
139};
140
141static struct am335x_prcm_softc *am335x_prcm_sc = NULL;
142
143static int am335x_clk_noop_activate(struct ti_clock_dev *clkdev);
144static int am335x_clk_generic_activate(struct ti_clock_dev *clkdev);
145static int am335x_clk_gpio_activate(struct ti_clock_dev *clkdev);
146static int am335x_clk_noop_deactivate(struct ti_clock_dev *clkdev);
147static int am335x_clk_generic_deactivate(struct ti_clock_dev *clkdev);
148static int am335x_clk_noop_set_source(struct ti_clock_dev *clkdev, clk_src_t clksrc);
149static int am335x_clk_generic_set_source(struct ti_clock_dev *clkdev, clk_src_t clksrc);
150static int am335x_clk_hsmmc_get_source_freq(struct ti_clock_dev *clkdev,  unsigned int *freq);
151static int am335x_clk_get_sysclk_freq(struct ti_clock_dev *clkdev, unsigned int *freq);
152static int am335x_clk_get_arm_fclk_freq(struct ti_clock_dev *clkdev, unsigned int *freq);
153static int am335x_clk_get_arm_disp_freq(struct ti_clock_dev *clkdev, unsigned int *freq);
154static int am335x_clk_set_arm_disp_freq(struct ti_clock_dev *clkdev, unsigned int freq);
155static void am335x_prcm_reset(void);
156static int am335x_clk_cpsw_activate(struct ti_clock_dev *clkdev);
157static int am335x_clk_musb0_activate(struct ti_clock_dev *clkdev);
158static int am335x_clk_lcdc_activate(struct ti_clock_dev *clkdev);
159static int am335x_clk_pruss_activate(struct ti_clock_dev *clkdev);
160
161#define AM335X_NOOP_CLOCK_DEV(i) \
162	{	.id = (i), \
163		.clk_activate = am335x_clk_noop_activate, \
164		.clk_deactivate = am335x_clk_noop_deactivate, \
165		.clk_set_source = am335x_clk_noop_set_source, \
166		.clk_accessible = NULL, \
167		.clk_get_source_freq = NULL, \
168		.clk_set_source_freq = NULL \
169	}
170
171#define AM335X_GENERIC_CLOCK_DEV(i) \
172	{	.id = (i), \
173		.clk_activate = am335x_clk_generic_activate, \
174		.clk_deactivate = am335x_clk_generic_deactivate, \
175		.clk_set_source = am335x_clk_generic_set_source, \
176		.clk_accessible = NULL, \
177		.clk_get_source_freq = NULL, \
178		.clk_set_source_freq = NULL \
179	}
180
181#define AM335X_GPIO_CLOCK_DEV(i) \
182	{	.id = (i), \
183		.clk_activate = am335x_clk_gpio_activate, \
184		.clk_deactivate = am335x_clk_generic_deactivate, \
185		.clk_set_source = am335x_clk_generic_set_source, \
186		.clk_accessible = NULL, \
187		.clk_get_source_freq = NULL, \
188		.clk_set_source_freq = NULL \
189	}
190
191#define AM335X_MMCHS_CLOCK_DEV(i) \
192	{	.id = (i), \
193		.clk_activate = am335x_clk_generic_activate, \
194		.clk_deactivate = am335x_clk_generic_deactivate, \
195		.clk_set_source = am335x_clk_generic_set_source, \
196		.clk_accessible = NULL, \
197		.clk_get_source_freq = am335x_clk_hsmmc_get_source_freq, \
198		.clk_set_source_freq = NULL \
199	}
200
201struct ti_clock_dev ti_am335x_clk_devmap[] = {
202	/* System clocks */
203	{	.id                  = SYS_CLK,
204		.clk_activate        = NULL,
205		.clk_deactivate      = NULL,
206		.clk_set_source      = NULL,
207		.clk_accessible      = NULL,
208		.clk_get_source_freq = am335x_clk_get_sysclk_freq,
209		.clk_set_source_freq = NULL,
210	},
211	/* MPU (ARM) core clocks */
212	{	.id                  = MPU_CLK,
213		.clk_activate        = NULL,
214		.clk_deactivate      = NULL,
215		.clk_set_source      = NULL,
216		.clk_accessible      = NULL,
217		.clk_get_source_freq = am335x_clk_get_arm_fclk_freq,
218		.clk_set_source_freq = NULL,
219	},
220	/* CPSW Ethernet Switch core clocks */
221	{	.id                  = CPSW_CLK,
222		.clk_activate        = am335x_clk_cpsw_activate,
223		.clk_deactivate      = NULL,
224		.clk_set_source      = NULL,
225		.clk_accessible      = NULL,
226		.clk_get_source_freq = NULL,
227		.clk_set_source_freq = NULL,
228	},
229
230	/* Mentor USB HS controller core clocks */
231	{	.id                  = MUSB0_CLK,
232		.clk_activate        = am335x_clk_musb0_activate,
233		.clk_deactivate      = NULL,
234		.clk_set_source      = NULL,
235		.clk_accessible      = NULL,
236		.clk_get_source_freq = NULL,
237		.clk_set_source_freq = NULL,
238	},
239
240	/* LCD controller clocks */
241	{	.id                  = LCDC_CLK,
242		.clk_activate        = am335x_clk_lcdc_activate,
243		.clk_deactivate      = NULL,
244		.clk_set_source      = NULL,
245		.clk_accessible      = NULL,
246		.clk_get_source_freq = am335x_clk_get_arm_disp_freq,
247		.clk_set_source_freq = am335x_clk_set_arm_disp_freq,
248	},
249
250        /* UART */
251	AM335X_NOOP_CLOCK_DEV(UART1_CLK),
252	AM335X_GENERIC_CLOCK_DEV(UART2_CLK),
253	AM335X_GENERIC_CLOCK_DEV(UART3_CLK),
254	AM335X_GENERIC_CLOCK_DEV(UART4_CLK),
255	AM335X_GENERIC_CLOCK_DEV(UART5_CLK),
256	AM335X_GENERIC_CLOCK_DEV(UART6_CLK),
257
258	/* DMTimer */
259	AM335X_GENERIC_CLOCK_DEV(TIMER2_CLK),
260	AM335X_GENERIC_CLOCK_DEV(TIMER3_CLK),
261	AM335X_GENERIC_CLOCK_DEV(TIMER4_CLK),
262	AM335X_GENERIC_CLOCK_DEV(TIMER5_CLK),
263	AM335X_GENERIC_CLOCK_DEV(TIMER6_CLK),
264	AM335X_GENERIC_CLOCK_DEV(TIMER7_CLK),
265
266	/* GPIO, we use hwmods as reference, not units in spec */
267	AM335X_GPIO_CLOCK_DEV(GPIO1_CLK),
268	AM335X_GPIO_CLOCK_DEV(GPIO2_CLK),
269	AM335X_GPIO_CLOCK_DEV(GPIO3_CLK),
270	AM335X_GPIO_CLOCK_DEV(GPIO4_CLK),
271
272	/* I2C we use hwmods as reference, not units in spec */
273	AM335X_GENERIC_CLOCK_DEV(I2C1_CLK),
274	AM335X_GENERIC_CLOCK_DEV(I2C2_CLK),
275	AM335X_GENERIC_CLOCK_DEV(I2C3_CLK),
276
277	/* TSC_ADC */
278	AM335X_GENERIC_CLOCK_DEV(TSC_ADC_CLK),
279
280	/* EDMA */
281	AM335X_GENERIC_CLOCK_DEV(EDMA_TPCC_CLK),
282	AM335X_GENERIC_CLOCK_DEV(EDMA_TPTC0_CLK),
283	AM335X_GENERIC_CLOCK_DEV(EDMA_TPTC1_CLK),
284	AM335X_GENERIC_CLOCK_DEV(EDMA_TPTC2_CLK),
285
286	/* MMCHS */
287	AM335X_MMCHS_CLOCK_DEV(MMC1_CLK),
288	AM335X_MMCHS_CLOCK_DEV(MMC2_CLK),
289	AM335X_MMCHS_CLOCK_DEV(MMC3_CLK),
290
291	/* PWMSS */
292	AM335X_GENERIC_CLOCK_DEV(PWMSS0_CLK),
293	AM335X_GENERIC_CLOCK_DEV(PWMSS1_CLK),
294	AM335X_GENERIC_CLOCK_DEV(PWMSS2_CLK),
295
296	/* System Mailbox clock */
297	AM335X_GENERIC_CLOCK_DEV(MAILBOX0_CLK),
298
299	/* SPINLOCK */
300	AM335X_GENERIC_CLOCK_DEV(SPINLOCK0_CLK),
301
302	/* PRU-ICSS */
303	{	.id		     = PRUSS_CLK,
304		.clk_activate	     = am335x_clk_pruss_activate,
305		.clk_deactivate      = NULL,
306		.clk_set_source      = NULL,
307		.clk_accessible      = NULL,
308		.clk_get_source_freq = NULL,
309		.clk_set_source_freq = NULL,
310	},
311
312	/* RTC */
313	AM335X_GENERIC_CLOCK_DEV(RTC_CLK),
314
315	{  INVALID_CLK_IDENT, NULL, NULL, NULL, NULL }
316};
317
318struct am335x_clk_details {
319	clk_ident_t	id;
320	uint32_t	clkctrl_reg;
321	uint32_t	clksel_reg;
322};
323
324#define _CLK_DETAIL(i, c, s) \
325	{	.id = (i), \
326		.clkctrl_reg = (c), \
327		.clksel_reg = (s), \
328	}
329
330static struct am335x_clk_details g_am335x_clk_details[] = {
331
332        /* UART. UART0 clock not controllable. */
333	_CLK_DETAIL(UART1_CLK, 0, 0),
334	_CLK_DETAIL(UART2_CLK, CM_PER_UART1_CLKCTRL, 0),
335	_CLK_DETAIL(UART3_CLK, CM_PER_UART2_CLKCTRL, 0),
336	_CLK_DETAIL(UART4_CLK, CM_PER_UART3_CLKCTRL, 0),
337	_CLK_DETAIL(UART5_CLK, CM_PER_UART4_CLKCTRL, 0),
338	_CLK_DETAIL(UART6_CLK, CM_PER_UART5_CLKCTRL, 0),
339
340	/* DMTimer modules */
341	_CLK_DETAIL(TIMER2_CLK, CM_PER_TIMER2_CLKCTRL, CLKSEL_TIMER2_CLK),
342	_CLK_DETAIL(TIMER3_CLK, CM_PER_TIMER3_CLKCTRL, CLKSEL_TIMER3_CLK),
343	_CLK_DETAIL(TIMER4_CLK, CM_PER_TIMER4_CLKCTRL, CLKSEL_TIMER4_CLK),
344	_CLK_DETAIL(TIMER5_CLK, CM_PER_TIMER5_CLKCTRL, CLKSEL_TIMER5_CLK),
345	_CLK_DETAIL(TIMER6_CLK, CM_PER_TIMER6_CLKCTRL, CLKSEL_TIMER6_CLK),
346	_CLK_DETAIL(TIMER7_CLK, CM_PER_TIMER7_CLKCTRL, CLKSEL_TIMER7_CLK),
347
348	/* GPIO modules, hwmods start with gpio1 */
349	_CLK_DETAIL(GPIO1_CLK, CM_WKUP_GPIO0_CLKCTRL, 0),
350	_CLK_DETAIL(GPIO2_CLK, CM_PER_GPIO1_CLKCTRL, 0),
351	_CLK_DETAIL(GPIO3_CLK, CM_PER_GPIO2_CLKCTRL, 0),
352	_CLK_DETAIL(GPIO4_CLK, CM_PER_GPIO3_CLKCTRL, 0),
353
354	/* I2C modules, hwmods start with i2c1 */
355	_CLK_DETAIL(I2C1_CLK, CM_WKUP_I2C0_CLKCTRL, 0),
356	_CLK_DETAIL(I2C2_CLK, CM_PER_I2C1_CLKCTRL, 0),
357	_CLK_DETAIL(I2C3_CLK, CM_PER_I2C2_CLKCTRL, 0),
358
359	/* TSC_ADC module */
360	_CLK_DETAIL(TSC_ADC_CLK, CM_WKUP_ADC_TSC_CLKCTRL, 0),
361
362	/* EDMA modules */
363	_CLK_DETAIL(EDMA_TPCC_CLK, CM_PER_TPCC_CLKCTRL, 0),
364	_CLK_DETAIL(EDMA_TPTC0_CLK, CM_PER_TPTC0_CLKCTRL, 0),
365	_CLK_DETAIL(EDMA_TPTC1_CLK, CM_PER_TPTC1_CLKCTRL, 0),
366	_CLK_DETAIL(EDMA_TPTC2_CLK, CM_PER_TPTC2_CLKCTRL, 0),
367
368	/* MMCHS modules, hwmods start with mmc1*/
369	_CLK_DETAIL(MMC1_CLK, CM_PER_MMC0_CLKCTRL, 0),
370	_CLK_DETAIL(MMC2_CLK, CM_PER_MMC1_CLKCTRL, 0),
371	_CLK_DETAIL(MMC3_CLK, CM_PER_MMC1_CLKCTRL, 0),
372
373	/* PWMSS modules */
374	_CLK_DETAIL(PWMSS0_CLK, CM_PER_EPWMSS0_CLKCTRL, 0),
375	_CLK_DETAIL(PWMSS1_CLK, CM_PER_EPWMSS1_CLKCTRL, 0),
376	_CLK_DETAIL(PWMSS2_CLK, CM_PER_EPWMSS2_CLKCTRL, 0),
377
378	_CLK_DETAIL(MAILBOX0_CLK, CM_PER_MAILBOX0_CLKCTRL, 0),
379	_CLK_DETAIL(SPINLOCK0_CLK, CM_PER_SPINLOCK0_CLKCTRL, 0),
380
381	/* RTC module */
382	_CLK_DETAIL(RTC_CLK, CM_RTC_RTC_CLKCTRL, 0),
383
384	{ INVALID_CLK_IDENT, 0},
385};
386
387/* Read/Write macros */
388#define prcm_read_4(reg)		\
389	bus_space_read_4(am335x_prcm_sc->bst, am335x_prcm_sc->bsh, reg)
390#define prcm_write_4(reg, val)		\
391	bus_space_write_4(am335x_prcm_sc->bst, am335x_prcm_sc->bsh, reg, val)
392
393void am335x_prcm_setup_dmtimer(int);
394
395static int
396am335x_prcm_probe(device_t dev)
397{
398
399	if (!ofw_bus_status_okay(dev))
400		return (ENXIO);
401
402	if (ofw_bus_is_compatible(dev, "ti,am3-prcm")) {
403		device_set_desc(dev, "AM335x Power and Clock Management");
404		return(BUS_PROBE_DEFAULT);
405	}
406
407	return (ENXIO);
408}
409
410static int
411am335x_prcm_attach(device_t dev)
412{
413	struct am335x_prcm_softc *sc = device_get_softc(dev);
414	unsigned int sysclk, fclk;
415
416	if (am335x_prcm_sc)
417		return (ENXIO);
418
419	if (bus_alloc_resources(dev, am335x_prcm_spec, sc->res)) {
420		device_printf(dev, "could not allocate resources\n");
421		return (ENXIO);
422	}
423
424	sc->bst = rman_get_bustag(sc->res[0]);
425	sc->bsh = rman_get_bushandle(sc->res[0]);
426
427	am335x_prcm_sc = sc;
428	ti_cpu_reset = am335x_prcm_reset;
429
430	if (am335x_clk_get_sysclk_freq(NULL, &sysclk) != 0)
431		sysclk = 0;
432	if (am335x_clk_get_arm_fclk_freq(NULL, &fclk) != 0)
433		fclk = 0;
434	if (sysclk && fclk)
435		device_printf(dev, "Clocks: System %u.%01u MHz, CPU %u MHz\n",
436		    sysclk/1000000, (sysclk % 1000000)/100000, fclk/1000000);
437	else
438		device_printf(dev, "can't read frequencies yet (SCM device not ready?)\n");
439
440	return (0);
441}
442
443static device_method_t am335x_prcm_methods[] = {
444	DEVMETHOD(device_probe,		am335x_prcm_probe),
445	DEVMETHOD(device_attach,	am335x_prcm_attach),
446	{ 0, 0 }
447};
448
449static driver_t am335x_prcm_driver = {
450	"am335x_prcm",
451	am335x_prcm_methods,
452	sizeof(struct am335x_prcm_softc),
453};
454
455static devclass_t am335x_prcm_devclass;
456
457DRIVER_MODULE(am335x_prcm, simplebus, am335x_prcm_driver,
458	am335x_prcm_devclass, 0, 0);
459MODULE_VERSION(am335x_prcm, 1);
460MODULE_DEPEND(am335x_prcm, ti_scm, 1, 1, 1);
461
462static struct am335x_clk_details*
463am335x_clk_details(clk_ident_t id)
464{
465	struct am335x_clk_details *walker;
466
467	for (walker = g_am335x_clk_details; walker->id != INVALID_CLK_IDENT; walker++) {
468		if (id == walker->id)
469			return (walker);
470	}
471
472	return NULL;
473}
474
475static int
476am335x_clk_noop_activate(struct ti_clock_dev *clkdev)
477{
478
479	return (0);
480}
481
482static int
483am335x_clk_generic_activate(struct ti_clock_dev *clkdev)
484{
485	struct am335x_prcm_softc *sc = am335x_prcm_sc;
486	struct am335x_clk_details* clk_details;
487
488	if (sc == NULL)
489		return ENXIO;
490
491	clk_details = am335x_clk_details(clkdev->id);
492
493	if (clk_details == NULL)
494		return (ENXIO);
495
496	/* set *_CLKCTRL register MODULEMODE[1:0] to enable(2) */
497	prcm_write_4(clk_details->clkctrl_reg, 2);
498	while ((prcm_read_4(clk_details->clkctrl_reg) & 0x3) != 2)
499		DELAY(10);
500
501	return (0);
502}
503
504static int
505am335x_clk_gpio_activate(struct ti_clock_dev *clkdev)
506{
507	struct am335x_prcm_softc *sc = am335x_prcm_sc;
508	struct am335x_clk_details* clk_details;
509
510	if (sc == NULL)
511		return ENXIO;
512
513	clk_details = am335x_clk_details(clkdev->id);
514
515	if (clk_details == NULL)
516		return (ENXIO);
517
518	/* set *_CLKCTRL register MODULEMODE[1:0] to enable(2) */
519	/* set *_CLKCTRL register OPTFCLKEN_GPIO_1_G DBCLK[18] to FCLK_EN(1) */
520	prcm_write_4(clk_details->clkctrl_reg, 2 | (1 << 18));
521	while ((prcm_read_4(clk_details->clkctrl_reg) &
522	    (3 | (1 << 18) )) != (2 | (1 << 18)))
523		DELAY(10);
524
525	return (0);
526}
527
528static int
529am335x_clk_noop_deactivate(struct ti_clock_dev *clkdev)
530{
531
532	return(0);
533}
534
535static int
536am335x_clk_generic_deactivate(struct ti_clock_dev *clkdev)
537{
538	struct am335x_prcm_softc *sc = am335x_prcm_sc;
539	struct am335x_clk_details* clk_details;
540
541	if (sc == NULL)
542		return ENXIO;
543
544	clk_details = am335x_clk_details(clkdev->id);
545
546	if (clk_details == NULL)
547		return (ENXIO);
548
549	/* set *_CLKCTRL register MODULEMODE[1:0] to disable(0) */
550	prcm_write_4(clk_details->clkctrl_reg, 0);
551	while ((prcm_read_4(clk_details->clkctrl_reg) & 0x3) != 0)
552		DELAY(10);
553
554	return (0);
555}
556
557static int
558am335x_clk_noop_set_source(struct ti_clock_dev *clkdev, clk_src_t clksrc)
559{
560
561	return (0);
562}
563
564static int
565am335x_clk_generic_set_source(struct ti_clock_dev *clkdev, clk_src_t clksrc)
566{
567	struct am335x_prcm_softc *sc = am335x_prcm_sc;
568	struct am335x_clk_details* clk_details;
569	uint32_t reg;
570
571	if (sc == NULL)
572		return ENXIO;
573
574	clk_details = am335x_clk_details(clkdev->id);
575
576	if (clk_details == NULL)
577		return (ENXIO);
578
579	switch (clksrc) {
580		case EXT_CLK:
581			reg = 0; /* SEL2: TCLKIN clock */
582			break;
583		case SYSCLK_CLK:
584			reg = 1; /* SEL1: CLK_M_OSC clock */
585			break;
586		case F32KHZ_CLK:
587			reg = 2; /* SEL3: CLK_32KHZ clock */
588			break;
589		default:
590			return (ENXIO);
591	}
592
593	prcm_write_4(clk_details->clksel_reg, reg);
594	while ((prcm_read_4(clk_details->clksel_reg) & 0x3) != reg)
595		DELAY(10);
596
597	return (0);
598}
599
600static int
601am335x_clk_hsmmc_get_source_freq(struct ti_clock_dev *clkdev,  unsigned int *freq)
602{
603	*freq = 96000000;
604	return (0);
605}
606
607static int
608am335x_clk_get_sysclk_freq(struct ti_clock_dev *clkdev, unsigned int *freq)
609{
610	uint32_t ctrl_status;
611
612	/* Read the input clock freq from the control module */
613	/* control_status reg (0x40) */
614	if (ti_scm_reg_read_4(0x40, &ctrl_status))
615		return ENXIO;
616
617	switch ((ctrl_status>>22) & 0x3) {
618	case 0x0:
619		/* 19.2Mhz */
620		*freq = 19200000;
621		break;
622	case 0x1:
623		/* 24Mhz */
624		*freq = 24000000;
625		break;
626	case 0x2:
627		/* 25Mhz */
628		*freq = 25000000;
629		break;
630	case 0x3:
631		/* 26Mhz */
632		*freq = 26000000;
633		break;
634	}
635
636	return (0);
637}
638
639#define DPLL_BYP_CLKSEL(reg)	((reg>>23) & 1)
640#define DPLL_DIV(reg)		((reg & 0x7f)+1)
641#define DPLL_MULT(reg)		((reg>>8) & 0x7FF)
642#define	DPLL_MAX_MUL		0x800
643#define	DPLL_MAX_DIV		0x80
644
645static int
646am335x_clk_get_arm_fclk_freq(struct ti_clock_dev *clkdev, unsigned int *freq)
647{
648	uint32_t reg;
649	uint32_t sysclk;
650
651	reg = prcm_read_4(CM_WKUP_CM_CLKSEL_DPLL_MPU);
652
653	/*Check if we are running in bypass */
654	if (DPLL_BYP_CLKSEL(reg))
655		return ENXIO;
656
657	am335x_clk_get_sysclk_freq(NULL, &sysclk);
658	*freq = DPLL_MULT(reg) * (sysclk / DPLL_DIV(reg));
659	return(0);
660}
661
662static int
663am335x_clk_get_arm_disp_freq(struct ti_clock_dev *clkdev, unsigned int *freq)
664{
665	uint32_t reg;
666	uint32_t sysclk;
667
668	reg = prcm_read_4(CM_WKUP_CM_CLKSEL_DPLL_DISP);
669
670	/*Check if we are running in bypass */
671	if (DPLL_BYP_CLKSEL(reg))
672		return ENXIO;
673
674	am335x_clk_get_sysclk_freq(NULL, &sysclk);
675	*freq = DPLL_MULT(reg) * (sysclk / DPLL_DIV(reg));
676	return(0);
677}
678
679static int
680am335x_clk_set_arm_disp_freq(struct ti_clock_dev *clkdev, unsigned int freq)
681{
682	uint32_t sysclk;
683	uint32_t mul, div;
684	uint32_t i, j;
685	unsigned int delta, min_delta;
686
687	am335x_clk_get_sysclk_freq(NULL, &sysclk);
688
689	/* Bypass mode */
690	prcm_write_4(CM_WKUP_CM_CLKMODE_DPLL_DISP, 0x4);
691
692	/* Make sure it's in bypass mode */
693	while (!(prcm_read_4(CM_WKUP_CM_IDLEST_DPLL_DISP)
694	    & (1 << 8)))
695		DELAY(10);
696
697	/* Dumb and non-optimal implementation */
698	min_delta = freq;
699	for (i = 1; i < DPLL_MAX_MUL; i++) {
700		for (j = 1; j < DPLL_MAX_DIV; j++) {
701			delta = abs(freq - i*(sysclk/j));
702			if (delta < min_delta) {
703				mul = i;
704				div = j;
705				min_delta = delta;
706			}
707			if (min_delta == 0)
708				break;
709		}
710	}
711
712	prcm_write_4(CM_WKUP_CM_CLKSEL_DPLL_DISP, (mul << 8) | (div - 1));
713
714	/* Locked mode */
715	prcm_write_4(CM_WKUP_CM_CLKMODE_DPLL_DISP, 0x7);
716
717	int timeout = 10000;
718	while ((!(prcm_read_4(CM_WKUP_CM_IDLEST_DPLL_DISP)
719	    & (1 << 0))) && timeout--)
720		DELAY(10);
721
722	return(0);
723}
724
725static void
726am335x_prcm_reset(void)
727{
728	prcm_write_4(PRM_RSTCTRL, (1<<1));
729}
730
731static int
732am335x_clk_cpsw_activate(struct ti_clock_dev *clkdev)
733{
734	struct am335x_prcm_softc *sc = am335x_prcm_sc;
735
736	if (sc == NULL)
737		return ENXIO;
738
739	/* set MODULENAME to ENABLE */
740	prcm_write_4(CM_PER_CPGMAC0_CLKCTRL, 2);
741
742	/* wait for IDLEST to become Func(0) */
743	while(prcm_read_4(CM_PER_CPGMAC0_CLKCTRL) & (3<<16));
744
745	/*set CLKTRCTRL to SW_WKUP(2) */
746	prcm_write_4(CM_PER_CPSW_CLKSTCTRL, 2);
747
748	/* wait for 125 MHz OCP clock to become active */
749	while((prcm_read_4(CM_PER_CPSW_CLKSTCTRL) & (1<<4)) == 0);
750	return(0);
751}
752
753static int
754am335x_clk_musb0_activate(struct ti_clock_dev *clkdev)
755{
756	struct am335x_prcm_softc *sc = am335x_prcm_sc;
757
758	if (sc == NULL)
759		return ENXIO;
760
761	/* set ST_DPLL_CLKDCOLDO(9) to CLK_GATED(1) */
762	/* set DPLL_CLKDCOLDO_GATE_CTRL(8) to CLK_ENABLE(1)*/
763        prcm_write_4(CM_WKUP_CM_CLKDCOLDO_DPLL_PER, 0x300);
764
765	/*set MODULEMODE to ENABLE(2) */
766	prcm_write_4(CM_PER_USB0_CLKCTRL, 2);
767
768	/* wait for MODULEMODE to become ENABLE(2) */
769	while ((prcm_read_4(CM_PER_USB0_CLKCTRL) & 0x3) != 2)
770		DELAY(10);
771
772	/* wait for IDLEST to become Func(0) */
773	while(prcm_read_4(CM_PER_USB0_CLKCTRL) & (3<<16))
774		DELAY(10);
775
776	return(0);
777}
778
779static int
780am335x_clk_lcdc_activate(struct ti_clock_dev *clkdev)
781{
782	struct am335x_prcm_softc *sc = am335x_prcm_sc;
783
784	if (sc == NULL)
785		return (ENXIO);
786
787	/*
788	 * For now set frequency to 2*VGA_PIXEL_CLOCK
789	 */
790	am335x_clk_set_arm_disp_freq(clkdev, 25175000*2);
791
792	/*set MODULEMODE to ENABLE(2) */
793	prcm_write_4(CM_PER_LCDC_CLKCTRL, 2);
794
795	/* wait for MODULEMODE to become ENABLE(2) */
796	while ((prcm_read_4(CM_PER_LCDC_CLKCTRL) & 0x3) != 2)
797		DELAY(10);
798
799	/* wait for IDLEST to become Func(0) */
800	while(prcm_read_4(CM_PER_LCDC_CLKCTRL) & (3<<16))
801		DELAY(10);
802
803	return (0);
804}
805
806static int
807am335x_clk_pruss_activate(struct ti_clock_dev *clkdev)
808{
809	struct am335x_prcm_softc *sc = am335x_prcm_sc;
810
811	if (sc == NULL)
812		return (ENXIO);
813
814	/* Set MODULEMODE to ENABLE(2) */
815	prcm_write_4(CM_PER_PRUSS_CLKCTRL, 2);
816
817	/* Wait for MODULEMODE to become ENABLE(2) */
818	while ((prcm_read_4(CM_PER_PRUSS_CLKCTRL) & 0x3) != 2)
819		DELAY(10);
820
821	/* Set CLKTRCTRL to SW_WKUP(2) */
822	prcm_write_4(CM_PER_PRUSS_CLKSTCTRL, 2);
823
824	/* Wait for the 200 MHz OCP clock to become active */
825	while ((prcm_read_4(CM_PER_PRUSS_CLKSTCTRL) & (1<<4)) == 0)
826		DELAY(10);
827
828	/* Wait for the 200 MHz IEP clock to become active */
829	while ((prcm_read_4(CM_PER_PRUSS_CLKSTCTRL) & (1<<5)) == 0)
830		DELAY(10);
831
832	/* Wait for the 192 MHz UART clock to become active */
833	while ((prcm_read_4(CM_PER_PRUSS_CLKSTCTRL) & (1<<6)) == 0)
834		DELAY(10);
835
836	/* Select L3F as OCP clock */
837	prcm_write_4(CLKSEL_PRUSS_OCP_CLK, 0);
838	while ((prcm_read_4(CLKSEL_PRUSS_OCP_CLK) & 0x3) != 0)
839		DELAY(10);
840
841	/* Clear the RESET bit */
842	prcm_write_4(PRM_PER_RSTCTRL, prcm_read_4(PRM_PER_RSTCTRL) & ~2);
843
844	return (0);
845}
846