xref: /openbmc/u-boot/arch/arm/mach-omap2/omap5/hwinit.c (revision 983e37007da506e8145f9b3a9e1dce5c11116fb0)
1*983e3700STom Rini /*
2*983e3700STom Rini  *
3*983e3700STom Rini  * Functions for omap5 based boards.
4*983e3700STom Rini  *
5*983e3700STom Rini  * (C) Copyright 2011
6*983e3700STom Rini  * Texas Instruments, <www.ti.com>
7*983e3700STom Rini  *
8*983e3700STom Rini  * Author :
9*983e3700STom Rini  *	Aneesh V	<aneesh@ti.com>
10*983e3700STom Rini  *	Steve Sakoman	<steve@sakoman.com>
11*983e3700STom Rini  *	Sricharan	<r.sricharan@ti.com>
12*983e3700STom Rini  *
13*983e3700STom Rini  * SPDX-License-Identifier:	GPL-2.0+
14*983e3700STom Rini  */
15*983e3700STom Rini #include <common.h>
16*983e3700STom Rini #include <asm/armv7.h>
17*983e3700STom Rini #include <asm/arch/cpu.h>
18*983e3700STom Rini #include <asm/arch/sys_proto.h>
19*983e3700STom Rini #include <asm/arch/clock.h>
20*983e3700STom Rini #include <linux/sizes.h>
21*983e3700STom Rini #include <asm/utils.h>
22*983e3700STom Rini #include <asm/arch/gpio.h>
23*983e3700STom Rini #include <asm/emif.h>
24*983e3700STom Rini #include <asm/omap_common.h>
25*983e3700STom Rini 
26*983e3700STom Rini DECLARE_GLOBAL_DATA_PTR;
27*983e3700STom Rini 
28*983e3700STom Rini u32 *const omap_si_rev = (u32 *)OMAP_SRAM_SCRATCH_OMAP_REV;
29*983e3700STom Rini 
30*983e3700STom Rini #ifndef CONFIG_DM_GPIO
31*983e3700STom Rini static struct gpio_bank gpio_bank_54xx[8] = {
32*983e3700STom Rini 	{ (void *)OMAP54XX_GPIO1_BASE },
33*983e3700STom Rini 	{ (void *)OMAP54XX_GPIO2_BASE },
34*983e3700STom Rini 	{ (void *)OMAP54XX_GPIO3_BASE },
35*983e3700STom Rini 	{ (void *)OMAP54XX_GPIO4_BASE },
36*983e3700STom Rini 	{ (void *)OMAP54XX_GPIO5_BASE },
37*983e3700STom Rini 	{ (void *)OMAP54XX_GPIO6_BASE },
38*983e3700STom Rini 	{ (void *)OMAP54XX_GPIO7_BASE },
39*983e3700STom Rini 	{ (void *)OMAP54XX_GPIO8_BASE },
40*983e3700STom Rini };
41*983e3700STom Rini 
42*983e3700STom Rini const struct gpio_bank *const omap_gpio_bank = gpio_bank_54xx;
43*983e3700STom Rini #endif
44*983e3700STom Rini 
45*983e3700STom Rini void do_set_mux32(u32 base, struct pad_conf_entry const *array, int size)
46*983e3700STom Rini {
47*983e3700STom Rini 	int i;
48*983e3700STom Rini 	struct pad_conf_entry *pad = (struct pad_conf_entry *)array;
49*983e3700STom Rini 
50*983e3700STom Rini 	for (i = 0; i < size; i++, pad++)
51*983e3700STom Rini 		writel(pad->val, base + pad->offset);
52*983e3700STom Rini }
53*983e3700STom Rini 
54*983e3700STom Rini #ifdef CONFIG_SPL_BUILD
55*983e3700STom Rini /* LPDDR2 specific IO settings */
56*983e3700STom Rini static void io_settings_lpddr2(void)
57*983e3700STom Rini {
58*983e3700STom Rini 	const struct ctrl_ioregs *ioregs;
59*983e3700STom Rini 
60*983e3700STom Rini 	get_ioregs(&ioregs);
61*983e3700STom Rini 	writel(ioregs->ctrl_ddrch, (*ctrl)->control_ddrch1_0);
62*983e3700STom Rini 	writel(ioregs->ctrl_ddrch, (*ctrl)->control_ddrch1_1);
63*983e3700STom Rini 	writel(ioregs->ctrl_ddrch, (*ctrl)->control_ddrch2_0);
64*983e3700STom Rini 	writel(ioregs->ctrl_ddrch, (*ctrl)->control_ddrch2_1);
65*983e3700STom Rini 	writel(ioregs->ctrl_lpddr2ch, (*ctrl)->control_lpddr2ch1_0);
66*983e3700STom Rini 	writel(ioregs->ctrl_lpddr2ch, (*ctrl)->control_lpddr2ch1_1);
67*983e3700STom Rini 	writel(ioregs->ctrl_ddrio_0, (*ctrl)->control_ddrio_0);
68*983e3700STom Rini 	writel(ioregs->ctrl_ddrio_1, (*ctrl)->control_ddrio_1);
69*983e3700STom Rini 	writel(ioregs->ctrl_ddrio_2, (*ctrl)->control_ddrio_2);
70*983e3700STom Rini }
71*983e3700STom Rini 
72*983e3700STom Rini /* DDR3 specific IO settings */
73*983e3700STom Rini static void io_settings_ddr3(void)
74*983e3700STom Rini {
75*983e3700STom Rini 	u32 io_settings = 0;
76*983e3700STom Rini 	const struct ctrl_ioregs *ioregs;
77*983e3700STom Rini 
78*983e3700STom Rini 	get_ioregs(&ioregs);
79*983e3700STom Rini 	writel(ioregs->ctrl_ddr3ch, (*ctrl)->control_ddr3ch1_0);
80*983e3700STom Rini 	writel(ioregs->ctrl_ddrch, (*ctrl)->control_ddrch1_0);
81*983e3700STom Rini 	writel(ioregs->ctrl_ddrch, (*ctrl)->control_ddrch1_1);
82*983e3700STom Rini 
83*983e3700STom Rini 	writel(ioregs->ctrl_ddr3ch, (*ctrl)->control_ddr3ch2_0);
84*983e3700STom Rini 	writel(ioregs->ctrl_ddrch, (*ctrl)->control_ddrch2_0);
85*983e3700STom Rini 	writel(ioregs->ctrl_ddrch, (*ctrl)->control_ddrch2_1);
86*983e3700STom Rini 
87*983e3700STom Rini 	writel(ioregs->ctrl_ddrio_0, (*ctrl)->control_ddrio_0);
88*983e3700STom Rini 	writel(ioregs->ctrl_ddrio_1, (*ctrl)->control_ddrio_1);
89*983e3700STom Rini 
90*983e3700STom Rini 	if (!is_dra7xx()) {
91*983e3700STom Rini 		writel(ioregs->ctrl_ddrio_2, (*ctrl)->control_ddrio_2);
92*983e3700STom Rini 		writel(ioregs->ctrl_lpddr2ch, (*ctrl)->control_lpddr2ch1_1);
93*983e3700STom Rini 	}
94*983e3700STom Rini 
95*983e3700STom Rini 	/* omap5432 does not use lpddr2 */
96*983e3700STom Rini 	writel(ioregs->ctrl_lpddr2ch, (*ctrl)->control_lpddr2ch1_0);
97*983e3700STom Rini 
98*983e3700STom Rini 	writel(ioregs->ctrl_emif_sdram_config_ext,
99*983e3700STom Rini 	       (*ctrl)->control_emif1_sdram_config_ext);
100*983e3700STom Rini 	if (!is_dra72x())
101*983e3700STom Rini 		writel(ioregs->ctrl_emif_sdram_config_ext,
102*983e3700STom Rini 		       (*ctrl)->control_emif2_sdram_config_ext);
103*983e3700STom Rini 
104*983e3700STom Rini 	if (is_omap54xx()) {
105*983e3700STom Rini 		/* Disable DLL select */
106*983e3700STom Rini 		io_settings = (readl((*ctrl)->control_port_emif1_sdram_config)
107*983e3700STom Rini 							& 0xFFEFFFFF);
108*983e3700STom Rini 		writel(io_settings,
109*983e3700STom Rini 			(*ctrl)->control_port_emif1_sdram_config);
110*983e3700STom Rini 
111*983e3700STom Rini 		io_settings = (readl((*ctrl)->control_port_emif2_sdram_config)
112*983e3700STom Rini 							& 0xFFEFFFFF);
113*983e3700STom Rini 		writel(io_settings,
114*983e3700STom Rini 			(*ctrl)->control_port_emif2_sdram_config);
115*983e3700STom Rini 	} else {
116*983e3700STom Rini 		writel(ioregs->ctrl_ddr_ctrl_ext_0,
117*983e3700STom Rini 				(*ctrl)->control_ddr_control_ext_0);
118*983e3700STom Rini 	}
119*983e3700STom Rini }
120*983e3700STom Rini 
121*983e3700STom Rini /*
122*983e3700STom Rini  * Some tuning of IOs for optimal power and performance
123*983e3700STom Rini  */
124*983e3700STom Rini void do_io_settings(void)
125*983e3700STom Rini {
126*983e3700STom Rini 	u32 io_settings = 0, mask = 0;
127*983e3700STom Rini 	struct emif_reg_struct *emif = (struct emif_reg_struct *)EMIF1_BASE;
128*983e3700STom Rini 
129*983e3700STom Rini 	/* Impedance settings EMMC, C2C 1,2, hsi2 */
130*983e3700STom Rini 	mask = (ds_mask << 2) | (ds_mask << 8) |
131*983e3700STom Rini 		(ds_mask << 16) | (ds_mask << 18);
132*983e3700STom Rini 	io_settings = readl((*ctrl)->control_smart1io_padconf_0) &
133*983e3700STom Rini 				(~mask);
134*983e3700STom Rini 	io_settings |= (ds_60_ohm << 8) | (ds_45_ohm << 16) |
135*983e3700STom Rini 			(ds_45_ohm << 18) | (ds_60_ohm << 2);
136*983e3700STom Rini 	writel(io_settings, (*ctrl)->control_smart1io_padconf_0);
137*983e3700STom Rini 
138*983e3700STom Rini 	/* Impedance settings Mcspi2 */
139*983e3700STom Rini 	mask = (ds_mask << 30);
140*983e3700STom Rini 	io_settings = readl((*ctrl)->control_smart1io_padconf_1) &
141*983e3700STom Rini 			(~mask);
142*983e3700STom Rini 	io_settings |= (ds_60_ohm << 30);
143*983e3700STom Rini 	writel(io_settings, (*ctrl)->control_smart1io_padconf_1);
144*983e3700STom Rini 
145*983e3700STom Rini 	/* Impedance settings C2C 3,4 */
146*983e3700STom Rini 	mask = (ds_mask << 14) | (ds_mask << 16);
147*983e3700STom Rini 	io_settings = readl((*ctrl)->control_smart1io_padconf_2) &
148*983e3700STom Rini 			(~mask);
149*983e3700STom Rini 	io_settings |= (ds_45_ohm << 14) | (ds_45_ohm << 16);
150*983e3700STom Rini 	writel(io_settings, (*ctrl)->control_smart1io_padconf_2);
151*983e3700STom Rini 
152*983e3700STom Rini 	/* Slew rate settings EMMC, C2C 1,2 */
153*983e3700STom Rini 	mask = (sc_mask << 8) | (sc_mask << 16) | (sc_mask << 18);
154*983e3700STom Rini 	io_settings = readl((*ctrl)->control_smart2io_padconf_0) &
155*983e3700STom Rini 			(~mask);
156*983e3700STom Rini 	io_settings |= (sc_fast << 8) | (sc_na << 16) | (sc_na << 18);
157*983e3700STom Rini 	writel(io_settings, (*ctrl)->control_smart2io_padconf_0);
158*983e3700STom Rini 
159*983e3700STom Rini 	/* Slew rate settings hsi2, Mcspi2 */
160*983e3700STom Rini 	mask = (sc_mask << 24) | (sc_mask << 28);
161*983e3700STom Rini 	io_settings = readl((*ctrl)->control_smart2io_padconf_1) &
162*983e3700STom Rini 			(~mask);
163*983e3700STom Rini 	io_settings |= (sc_fast << 28) | (sc_fast << 24);
164*983e3700STom Rini 	writel(io_settings, (*ctrl)->control_smart2io_padconf_1);
165*983e3700STom Rini 
166*983e3700STom Rini 	/* Slew rate settings C2C 3,4 */
167*983e3700STom Rini 	mask = (sc_mask << 16) | (sc_mask << 18);
168*983e3700STom Rini 	io_settings = readl((*ctrl)->control_smart2io_padconf_2) &
169*983e3700STom Rini 			(~mask);
170*983e3700STom Rini 	io_settings |= (sc_na << 16) | (sc_na << 18);
171*983e3700STom Rini 	writel(io_settings, (*ctrl)->control_smart2io_padconf_2);
172*983e3700STom Rini 
173*983e3700STom Rini 	/* impedance and slew rate settings for usb */
174*983e3700STom Rini 	mask = (usb_i_mask << 29) | (usb_i_mask << 26) | (usb_i_mask << 23) |
175*983e3700STom Rini 		(usb_i_mask << 20) | (usb_i_mask << 17) | (usb_i_mask << 14);
176*983e3700STom Rini 	io_settings = readl((*ctrl)->control_smart3io_padconf_1) &
177*983e3700STom Rini 			(~mask);
178*983e3700STom Rini 	io_settings |= (ds_60_ohm << 29) | (ds_60_ohm << 26) |
179*983e3700STom Rini 		       (ds_60_ohm << 23) | (sc_fast << 20) |
180*983e3700STom Rini 		       (sc_fast << 17) | (sc_fast << 14);
181*983e3700STom Rini 	writel(io_settings, (*ctrl)->control_smart3io_padconf_1);
182*983e3700STom Rini 
183*983e3700STom Rini 	if (emif_sdram_type(emif->emif_sdram_config) == EMIF_SDRAM_TYPE_LPDDR2)
184*983e3700STom Rini 		io_settings_lpddr2();
185*983e3700STom Rini 	else
186*983e3700STom Rini 		io_settings_ddr3();
187*983e3700STom Rini }
188*983e3700STom Rini 
189*983e3700STom Rini static const struct srcomp_params srcomp_parameters[NUM_SYS_CLKS] = {
190*983e3700STom Rini 	{0x45, 0x1},	/* 12 MHz   */
191*983e3700STom Rini 	{-1, -1},	/* 13 MHz   */
192*983e3700STom Rini 	{0x63, 0x2},	/* 16.8 MHz */
193*983e3700STom Rini 	{0x57, 0x2},	/* 19.2 MHz */
194*983e3700STom Rini 	{0x20, 0x1},	/* 26 MHz   */
195*983e3700STom Rini 	{-1, -1},	/* 27 MHz   */
196*983e3700STom Rini 	{0x41, 0x3}	/* 38.4 MHz */
197*983e3700STom Rini };
198*983e3700STom Rini 
199*983e3700STom Rini void srcomp_enable(void)
200*983e3700STom Rini {
201*983e3700STom Rini 	u32 srcomp_value, mul_factor, div_factor, clk_val, i;
202*983e3700STom Rini 	u32 sysclk_ind	= get_sys_clk_index();
203*983e3700STom Rini 	u32 omap_rev	= omap_revision();
204*983e3700STom Rini 
205*983e3700STom Rini 	if (!is_omap54xx())
206*983e3700STom Rini 		return;
207*983e3700STom Rini 
208*983e3700STom Rini 	mul_factor = srcomp_parameters[sysclk_ind].multiply_factor;
209*983e3700STom Rini 	div_factor = srcomp_parameters[sysclk_ind].divide_factor;
210*983e3700STom Rini 
211*983e3700STom Rini 	for (i = 0; i < 4; i++) {
212*983e3700STom Rini 		srcomp_value = readl((*ctrl)->control_srcomp_north_side + i*4);
213*983e3700STom Rini 		srcomp_value &=
214*983e3700STom Rini 			~(MULTIPLY_FACTOR_XS_MASK | DIVIDE_FACTOR_XS_MASK);
215*983e3700STom Rini 		srcomp_value |= (mul_factor << MULTIPLY_FACTOR_XS_SHIFT) |
216*983e3700STom Rini 			(div_factor << DIVIDE_FACTOR_XS_SHIFT);
217*983e3700STom Rini 		writel(srcomp_value, (*ctrl)->control_srcomp_north_side + i*4);
218*983e3700STom Rini 	}
219*983e3700STom Rini 
220*983e3700STom Rini 	if ((omap_rev == OMAP5430_ES1_0) || (omap_rev == OMAP5432_ES1_0)) {
221*983e3700STom Rini 		clk_val = readl((*prcm)->cm_coreaon_io_srcomp_clkctrl);
222*983e3700STom Rini 		clk_val |= OPTFCLKEN_SRCOMP_FCLK_MASK;
223*983e3700STom Rini 		writel(clk_val, (*prcm)->cm_coreaon_io_srcomp_clkctrl);
224*983e3700STom Rini 
225*983e3700STom Rini 		for (i = 0; i < 4; i++) {
226*983e3700STom Rini 			srcomp_value =
227*983e3700STom Rini 				readl((*ctrl)->control_srcomp_north_side + i*4);
228*983e3700STom Rini 			srcomp_value &= ~PWRDWN_XS_MASK;
229*983e3700STom Rini 			writel(srcomp_value,
230*983e3700STom Rini 			       (*ctrl)->control_srcomp_north_side + i*4);
231*983e3700STom Rini 
232*983e3700STom Rini 			while (((readl((*ctrl)->control_srcomp_north_side + i*4)
233*983e3700STom Rini 				& SRCODE_READ_XS_MASK) >>
234*983e3700STom Rini 				SRCODE_READ_XS_SHIFT) == 0)
235*983e3700STom Rini 				;
236*983e3700STom Rini 
237*983e3700STom Rini 			srcomp_value =
238*983e3700STom Rini 				readl((*ctrl)->control_srcomp_north_side + i*4);
239*983e3700STom Rini 			srcomp_value &= ~OVERRIDE_XS_MASK;
240*983e3700STom Rini 			writel(srcomp_value,
241*983e3700STom Rini 			       (*ctrl)->control_srcomp_north_side + i*4);
242*983e3700STom Rini 		}
243*983e3700STom Rini 	} else {
244*983e3700STom Rini 		srcomp_value = readl((*ctrl)->control_srcomp_east_side_wkup);
245*983e3700STom Rini 		srcomp_value &= ~(MULTIPLY_FACTOR_XS_MASK |
246*983e3700STom Rini 				  DIVIDE_FACTOR_XS_MASK);
247*983e3700STom Rini 		srcomp_value |= (mul_factor << MULTIPLY_FACTOR_XS_SHIFT) |
248*983e3700STom Rini 				(div_factor << DIVIDE_FACTOR_XS_SHIFT);
249*983e3700STom Rini 		writel(srcomp_value, (*ctrl)->control_srcomp_east_side_wkup);
250*983e3700STom Rini 
251*983e3700STom Rini 		for (i = 0; i < 4; i++) {
252*983e3700STom Rini 			srcomp_value =
253*983e3700STom Rini 				readl((*ctrl)->control_srcomp_north_side + i*4);
254*983e3700STom Rini 			srcomp_value |= SRCODE_OVERRIDE_SEL_XS_MASK;
255*983e3700STom Rini 			writel(srcomp_value,
256*983e3700STom Rini 			       (*ctrl)->control_srcomp_north_side + i*4);
257*983e3700STom Rini 
258*983e3700STom Rini 			srcomp_value =
259*983e3700STom Rini 				readl((*ctrl)->control_srcomp_north_side + i*4);
260*983e3700STom Rini 			srcomp_value &= ~OVERRIDE_XS_MASK;
261*983e3700STom Rini 			writel(srcomp_value,
262*983e3700STom Rini 			       (*ctrl)->control_srcomp_north_side + i*4);
263*983e3700STom Rini 		}
264*983e3700STom Rini 
265*983e3700STom Rini 		srcomp_value =
266*983e3700STom Rini 			readl((*ctrl)->control_srcomp_east_side_wkup);
267*983e3700STom Rini 		srcomp_value |= SRCODE_OVERRIDE_SEL_XS_MASK;
268*983e3700STom Rini 		writel(srcomp_value, (*ctrl)->control_srcomp_east_side_wkup);
269*983e3700STom Rini 
270*983e3700STom Rini 		srcomp_value =
271*983e3700STom Rini 			readl((*ctrl)->control_srcomp_east_side_wkup);
272*983e3700STom Rini 		srcomp_value &= ~OVERRIDE_XS_MASK;
273*983e3700STom Rini 		writel(srcomp_value, (*ctrl)->control_srcomp_east_side_wkup);
274*983e3700STom Rini 
275*983e3700STom Rini 		clk_val = readl((*prcm)->cm_coreaon_io_srcomp_clkctrl);
276*983e3700STom Rini 		clk_val |= OPTFCLKEN_SRCOMP_FCLK_MASK;
277*983e3700STom Rini 		writel(clk_val, (*prcm)->cm_coreaon_io_srcomp_clkctrl);
278*983e3700STom Rini 
279*983e3700STom Rini 		clk_val = readl((*prcm)->cm_wkupaon_io_srcomp_clkctrl);
280*983e3700STom Rini 		clk_val |= OPTFCLKEN_SRCOMP_FCLK_MASK;
281*983e3700STom Rini 		writel(clk_val, (*prcm)->cm_wkupaon_io_srcomp_clkctrl);
282*983e3700STom Rini 
283*983e3700STom Rini 		for (i = 0; i < 4; i++) {
284*983e3700STom Rini 			while (((readl((*ctrl)->control_srcomp_north_side + i*4)
285*983e3700STom Rini 				& SRCODE_READ_XS_MASK) >>
286*983e3700STom Rini 				SRCODE_READ_XS_SHIFT) == 0)
287*983e3700STom Rini 				;
288*983e3700STom Rini 
289*983e3700STom Rini 			srcomp_value =
290*983e3700STom Rini 				readl((*ctrl)->control_srcomp_north_side + i*4);
291*983e3700STom Rini 			srcomp_value &= ~SRCODE_OVERRIDE_SEL_XS_MASK;
292*983e3700STom Rini 			writel(srcomp_value,
293*983e3700STom Rini 			       (*ctrl)->control_srcomp_north_side + i*4);
294*983e3700STom Rini 		}
295*983e3700STom Rini 
296*983e3700STom Rini 		while (((readl((*ctrl)->control_srcomp_east_side_wkup) &
297*983e3700STom Rini 			SRCODE_READ_XS_MASK) >> SRCODE_READ_XS_SHIFT) == 0)
298*983e3700STom Rini 			;
299*983e3700STom Rini 
300*983e3700STom Rini 		srcomp_value =
301*983e3700STom Rini 			readl((*ctrl)->control_srcomp_east_side_wkup);
302*983e3700STom Rini 		srcomp_value &= ~SRCODE_OVERRIDE_SEL_XS_MASK;
303*983e3700STom Rini 		writel(srcomp_value, (*ctrl)->control_srcomp_east_side_wkup);
304*983e3700STom Rini 	}
305*983e3700STom Rini }
306*983e3700STom Rini #endif
307*983e3700STom Rini 
308*983e3700STom Rini void config_data_eye_leveling_samples(u32 emif_base)
309*983e3700STom Rini {
310*983e3700STom Rini 	const struct ctrl_ioregs *ioregs;
311*983e3700STom Rini 
312*983e3700STom Rini 	get_ioregs(&ioregs);
313*983e3700STom Rini 
314*983e3700STom Rini 	/*EMIF_SDRAM_CONFIG_EXT-Read data eye leveling no of samples =4*/
315*983e3700STom Rini 	if (emif_base == EMIF1_BASE)
316*983e3700STom Rini 		writel(ioregs->ctrl_emif_sdram_config_ext_final,
317*983e3700STom Rini 		       (*ctrl)->control_emif1_sdram_config_ext);
318*983e3700STom Rini 	else if (emif_base == EMIF2_BASE)
319*983e3700STom Rini 		writel(ioregs->ctrl_emif_sdram_config_ext_final,
320*983e3700STom Rini 		       (*ctrl)->control_emif2_sdram_config_ext);
321*983e3700STom Rini }
322*983e3700STom Rini 
323*983e3700STom Rini void init_cpu_configuration(void)
324*983e3700STom Rini {
325*983e3700STom Rini 	u32 l2actlr;
326*983e3700STom Rini 
327*983e3700STom Rini 	asm volatile("mrc p15, 1, %0, c15, c0, 0" : "=r"(l2actlr));
328*983e3700STom Rini 	/*
329*983e3700STom Rini 	 * L2ACTLR: Ensure to enable the following:
330*983e3700STom Rini 	 * 3: Disable clean/evict push to external
331*983e3700STom Rini 	 * 4: Disable WriteUnique and WriteLineUnique transactions from master
332*983e3700STom Rini 	 * 8: Disable DVM/CMO message broadcast
333*983e3700STom Rini 	 */
334*983e3700STom Rini 	l2actlr |= 0x118;
335*983e3700STom Rini 	omap_smc1(OMAP5_SERVICE_L2ACTLR_SET, l2actlr);
336*983e3700STom Rini }
337*983e3700STom Rini 
338*983e3700STom Rini void init_omap_revision(void)
339*983e3700STom Rini {
340*983e3700STom Rini 	/*
341*983e3700STom Rini 	 * For some of the ES2/ES1 boards ID_CODE is not reliable:
342*983e3700STom Rini 	 * Also, ES1 and ES2 have different ARM revisions
343*983e3700STom Rini 	 * So use ARM revision for identification
344*983e3700STom Rini 	 */
345*983e3700STom Rini 	unsigned int rev = cortex_rev();
346*983e3700STom Rini 
347*983e3700STom Rini 	switch (readl(CONTROL_ID_CODE)) {
348*983e3700STom Rini 	case OMAP5430_CONTROL_ID_CODE_ES1_0:
349*983e3700STom Rini 		*omap_si_rev = OMAP5430_ES1_0;
350*983e3700STom Rini 		if (rev == MIDR_CORTEX_A15_R2P2)
351*983e3700STom Rini 			*omap_si_rev = OMAP5430_ES2_0;
352*983e3700STom Rini 		break;
353*983e3700STom Rini 	case OMAP5432_CONTROL_ID_CODE_ES1_0:
354*983e3700STom Rini 		*omap_si_rev = OMAP5432_ES1_0;
355*983e3700STom Rini 		if (rev == MIDR_CORTEX_A15_R2P2)
356*983e3700STom Rini 			*omap_si_rev = OMAP5432_ES2_0;
357*983e3700STom Rini 		break;
358*983e3700STom Rini 	case OMAP5430_CONTROL_ID_CODE_ES2_0:
359*983e3700STom Rini 		*omap_si_rev = OMAP5430_ES2_0;
360*983e3700STom Rini 		break;
361*983e3700STom Rini 	case OMAP5432_CONTROL_ID_CODE_ES2_0:
362*983e3700STom Rini 		*omap_si_rev = OMAP5432_ES2_0;
363*983e3700STom Rini 		break;
364*983e3700STom Rini 	case DRA752_CONTROL_ID_CODE_ES1_0:
365*983e3700STom Rini 		*omap_si_rev = DRA752_ES1_0;
366*983e3700STom Rini 		break;
367*983e3700STom Rini 	case DRA752_CONTROL_ID_CODE_ES1_1:
368*983e3700STom Rini 		*omap_si_rev = DRA752_ES1_1;
369*983e3700STom Rini 		break;
370*983e3700STom Rini 	case DRA752_CONTROL_ID_CODE_ES2_0:
371*983e3700STom Rini 		*omap_si_rev = DRA752_ES2_0;
372*983e3700STom Rini 		break;
373*983e3700STom Rini 	case DRA722_CONTROL_ID_CODE_ES1_0:
374*983e3700STom Rini 		*omap_si_rev = DRA722_ES1_0;
375*983e3700STom Rini 		break;
376*983e3700STom Rini 	case DRA722_CONTROL_ID_CODE_ES2_0:
377*983e3700STom Rini 		*omap_si_rev = DRA722_ES2_0;
378*983e3700STom Rini 		break;
379*983e3700STom Rini 	default:
380*983e3700STom Rini 		*omap_si_rev = OMAP5430_SILICON_ID_INVALID;
381*983e3700STom Rini 	}
382*983e3700STom Rini 	init_cpu_configuration();
383*983e3700STom Rini }
384*983e3700STom Rini 
385*983e3700STom Rini void omap_die_id(unsigned int *die_id)
386*983e3700STom Rini {
387*983e3700STom Rini 	die_id[0] = readl((*ctrl)->control_std_fuse_die_id_0);
388*983e3700STom Rini 	die_id[1] = readl((*ctrl)->control_std_fuse_die_id_1);
389*983e3700STom Rini 	die_id[2] = readl((*ctrl)->control_std_fuse_die_id_2);
390*983e3700STom Rini 	die_id[3] = readl((*ctrl)->control_std_fuse_die_id_3);
391*983e3700STom Rini }
392*983e3700STom Rini 
393*983e3700STom Rini void reset_cpu(ulong ignored)
394*983e3700STom Rini {
395*983e3700STom Rini 	u32 omap_rev = omap_revision();
396*983e3700STom Rini 
397*983e3700STom Rini 	/*
398*983e3700STom Rini 	 * WARM reset is not functional in case of OMAP5430 ES1.0 soc.
399*983e3700STom Rini 	 * So use cold reset in case instead.
400*983e3700STom Rini 	 */
401*983e3700STom Rini 	if (omap_rev == OMAP5430_ES1_0)
402*983e3700STom Rini 		writel(PRM_RSTCTRL_RESET << 0x1, (*prcm)->prm_rstctrl);
403*983e3700STom Rini 	else
404*983e3700STom Rini 		writel(PRM_RSTCTRL_RESET, (*prcm)->prm_rstctrl);
405*983e3700STom Rini }
406*983e3700STom Rini 
407*983e3700STom Rini u32 warm_reset(void)
408*983e3700STom Rini {
409*983e3700STom Rini 	return readl((*prcm)->prm_rstst) & PRM_RSTST_WARM_RESET_MASK;
410*983e3700STom Rini }
411*983e3700STom Rini 
412*983e3700STom Rini void setup_warmreset_time(void)
413*983e3700STom Rini {
414*983e3700STom Rini 	u32 rst_time, rst_val;
415*983e3700STom Rini 
416*983e3700STom Rini #ifndef CONFIG_OMAP_PLATFORM_RESET_TIME_MAX_USEC
417*983e3700STom Rini 	rst_time = CONFIG_DEFAULT_OMAP_RESET_TIME_MAX_USEC;
418*983e3700STom Rini #else
419*983e3700STom Rini 	rst_time = CONFIG_OMAP_PLATFORM_RESET_TIME_MAX_USEC;
420*983e3700STom Rini #endif
421*983e3700STom Rini 	rst_time = usec_to_32k(rst_time) << RSTTIME1_SHIFT;
422*983e3700STom Rini 
423*983e3700STom Rini 	if (rst_time > RSTTIME1_MASK)
424*983e3700STom Rini 		rst_time = RSTTIME1_MASK;
425*983e3700STom Rini 
426*983e3700STom Rini 	rst_val = readl((*prcm)->prm_rsttime) & ~RSTTIME1_MASK;
427*983e3700STom Rini 	rst_val |= rst_time;
428*983e3700STom Rini 	writel(rst_val, (*prcm)->prm_rsttime);
429*983e3700STom Rini }
430*983e3700STom Rini 
431*983e3700STom Rini void v7_arch_cp15_set_l2aux_ctrl(u32 l2auxctrl, u32 cpu_midr,
432*983e3700STom Rini 				 u32 cpu_rev_comb, u32 cpu_variant,
433*983e3700STom Rini 				 u32 cpu_rev)
434*983e3700STom Rini {
435*983e3700STom Rini 	omap_smc1(OMAP5_SERVICE_L2ACTLR_SET, l2auxctrl);
436*983e3700STom Rini }
437*983e3700STom Rini 
438*983e3700STom Rini void v7_arch_cp15_set_acr(u32 acr, u32 cpu_midr, u32 cpu_rev_comb,
439*983e3700STom Rini 			  u32 cpu_variant, u32 cpu_rev)
440*983e3700STom Rini {
441*983e3700STom Rini 
442*983e3700STom Rini #ifdef CONFIG_ARM_ERRATA_801819
443*983e3700STom Rini 	/*
444*983e3700STom Rini 	 * DRA72x processors are uniprocessors and DONOT have
445*983e3700STom Rini 	 * ACP (Accelerator Coherency Port) hooked to ACE (AXI Coherency
446*983e3700STom Rini 	 * Extensions) Hence the erratum workaround is not applicable for
447*983e3700STom Rini 	 * DRA72x processors.
448*983e3700STom Rini 	 */
449*983e3700STom Rini 	if (is_dra72x())
450*983e3700STom Rini 		acr &= ~((0x3 << 23) | (0x3 << 25));
451*983e3700STom Rini #endif
452*983e3700STom Rini 	omap_smc1(OMAP5_SERVICE_ACR_SET, acr);
453*983e3700STom Rini }
454