3 * Sascha Hauer, Pengutronix
5 * (C) Copyright 2009 Freescale Semiconductor, Inc.
7 * SPDX-License-Identifier: GPL-2.0+
11 #include <asm/armv7.h>
12 #include <asm/bootm.h>
13 #include <asm/pl310.h>
14 #include <asm/errno.h>
16 #include <asm/arch/imx-regs.h>
17 #include <asm/arch/clock.h>
18 #include <asm/arch/sys_proto.h>
19 #include <asm/imx-common/boot_mode.h>
20 #include <asm/imx-common/dma.h>
22 #include <asm/arch/mxc_hdmi.h>
23 #include <asm/arch/crm_regs.h>
24 #include <asm/bootm.h>
26 #include <imx_thermal.h>
42 #if defined(CONFIG_IMX6_THERMAL)
43 static const struct imx_thermal_plat imx6_thermal_plat
= {
44 .regs
= (void *)ANATOP_BASE_ADDR
,
49 U_BOOT_DEVICE(imx6_thermal
) = {
50 .name
= "imx_thermal",
51 .platdata
= &imx6_thermal_plat
,
57 struct scu_regs
*scu
= (struct scu_regs
*)SCU_BASE_ADDR
;
58 return readl(&scu
->config
) & 3;
63 struct anatop_regs
*anatop
= (struct anatop_regs
*)ANATOP_BASE_ADDR
;
64 u32 reg
= readl(&anatop
->digprog_sololite
);
65 u32 type
= ((reg
>> 16) & 0xff);
67 if (type
!= MXC_CPU_MX6SL
) {
68 reg
= readl(&anatop
->digprog
);
69 struct scu_regs
*scu
= (struct scu_regs
*)SCU_BASE_ADDR
;
70 u32 cfg
= readl(&scu
->config
) & 3;
71 type
= ((reg
>> 16) & 0xff);
72 if (type
== MXC_CPU_MX6DL
) {
74 type
= MXC_CPU_MX6SOLO
;
77 if (type
== MXC_CPU_MX6Q
) {
83 reg
&= 0xff; /* mx6 silicon revision */
84 return (type
<< 12) | (reg
+ 0x10);
87 #ifdef CONFIG_REVISION_TAG
88 u32 __weak
get_board_rev(void)
90 u32 cpurev
= get_cpu_rev();
91 u32 type
= ((cpurev
>> 12) & 0xff);
92 if (type
== MXC_CPU_MX6SOLO
)
93 cpurev
= (MXC_CPU_MX6DL
) << 12 | (cpurev
& 0xFFF);
95 if (type
== MXC_CPU_MX6D
)
96 cpurev
= (MXC_CPU_MX6Q
) << 12 | (cpurev
& 0xFFF);
104 struct aipstz_regs
*aips1
, *aips2
;
106 struct aipstz_regs
*aips3
;
109 aips1
= (struct aipstz_regs
*)AIPS1_BASE_ADDR
;
110 aips2
= (struct aipstz_regs
*)AIPS2_BASE_ADDR
;
112 aips3
= (struct aipstz_regs
*)AIPS3_CONFIG_BASE_ADDR
;
116 * Set all MPROTx to be non-bufferable, trusted for R/W,
117 * not forced to user-mode.
119 writel(0x77777777, &aips1
->mprot0
);
120 writel(0x77777777, &aips1
->mprot1
);
121 writel(0x77777777, &aips2
->mprot0
);
122 writel(0x77777777, &aips2
->mprot1
);
125 * Set all OPACRx to be non-bufferable, not require
126 * supervisor privilege level for access,allow for
127 * write access and untrusted master access.
129 writel(0x00000000, &aips1
->opacr0
);
130 writel(0x00000000, &aips1
->opacr1
);
131 writel(0x00000000, &aips1
->opacr2
);
132 writel(0x00000000, &aips1
->opacr3
);
133 writel(0x00000000, &aips1
->opacr4
);
134 writel(0x00000000, &aips2
->opacr0
);
135 writel(0x00000000, &aips2
->opacr1
);
136 writel(0x00000000, &aips2
->opacr2
);
137 writel(0x00000000, &aips2
->opacr3
);
138 writel(0x00000000, &aips2
->opacr4
);
142 * Set all MPROTx to be non-bufferable, trusted for R/W,
143 * not forced to user-mode.
145 writel(0x77777777, &aips3
->mprot0
);
146 writel(0x77777777, &aips3
->mprot1
);
149 * Set all OPACRx to be non-bufferable, not require
150 * supervisor privilege level for access,allow for
151 * write access and untrusted master access.
153 writel(0x00000000, &aips3
->opacr0
);
154 writel(0x00000000, &aips3
->opacr1
);
155 writel(0x00000000, &aips3
->opacr2
);
156 writel(0x00000000, &aips3
->opacr3
);
157 writel(0x00000000, &aips3
->opacr4
);
161 static void clear_ldo_ramp(void)
163 struct anatop_regs
*anatop
= (struct anatop_regs
*)ANATOP_BASE_ADDR
;
166 /* ROM may modify LDO ramp up time according to fuse setting, so in
167 * order to be in the safe side we neeed to reset these settings to
168 * match the reset value: 0'b00
170 reg
= readl(&anatop
->ana_misc2
);
171 reg
&= ~(0x3f << 24);
172 writel(reg
, &anatop
->ana_misc2
);
176 * Set the PMU_REG_CORE register
178 * Set LDO_SOC/PU/ARM regulators to the specified millivolt level.
179 * Possible values are from 0.725V to 1.450V in steps of
182 static int set_ldo_voltage(enum ldo_reg ldo
, u32 mv
)
184 struct anatop_regs
*anatop
= (struct anatop_regs
*)ANATOP_BASE_ADDR
;
185 u32 val
, step
, old
, reg
= readl(&anatop
->reg_core
);
189 val
= 0x00; /* Power gated off */
191 val
= 0x1F; /* Power FET switched full on. No regulation */
193 val
= (mv
- 700) / 25;
211 old
= (reg
& (0x1F << shift
)) >> shift
;
212 step
= abs(val
- old
);
216 reg
= (reg
& ~(0x1F << shift
)) | (val
<< shift
);
217 writel(reg
, &anatop
->reg_core
);
220 * The LDO ramp-up is based on 64 clock cycles of 24 MHz = 2.6 us per
228 static void imx_set_wdog_powerdown(bool enable
)
230 struct wdog_regs
*wdog1
= (struct wdog_regs
*)WDOG1_BASE_ADDR
;
231 struct wdog_regs
*wdog2
= (struct wdog_regs
*)WDOG2_BASE_ADDR
;
234 struct wdog_regs
*wdog3
= (struct wdog_regs
*)WDOG3_BASE_ADDR
;
235 writew(enable
, &wdog3
->wmcr
);
238 /* Write to the PDE (Power Down Enable) bit */
239 writew(enable
, &wdog1
->wmcr
);
240 writew(enable
, &wdog2
->wmcr
);
243 static void set_ahb_rate(u32 val
)
245 struct mxc_ccm_reg
*mxc_ccm
= (struct mxc_ccm_reg
*)CCM_BASE_ADDR
;
248 div
= get_periph_clk() / val
- 1;
249 reg
= readl(&mxc_ccm
->cbcdr
);
251 writel((reg
& (~MXC_CCM_CBCDR_AHB_PODF_MASK
)) |
252 (div
<< MXC_CCM_CBCDR_AHB_PODF_OFFSET
), &mxc_ccm
->cbcdr
);
255 static void clear_mmdc_ch_mask(void)
257 struct mxc_ccm_reg
*mxc_ccm
= (struct mxc_ccm_reg
*)CCM_BASE_ADDR
;
259 /* Clear MMDC channel mask */
260 writel(0, &mxc_ccm
->ccdr
);
263 static void init_bandgap(void)
265 struct anatop_regs
*anatop
= (struct anatop_regs
*)ANATOP_BASE_ADDR
;
267 * Ensure the bandgap has stabilized.
269 while (!(readl(&anatop
->ana_misc0
) & 0x80))
272 * For best noise performance of the analog blocks using the
273 * outputs of the bandgap, the reftop_selfbiasoff bit should
276 writel(BM_ANADIG_ANA_MISC0_REFTOP_SELBIASOFF
, &anatop
->ana_misc0_set
);
281 static void set_preclk_from_osc(void)
283 struct mxc_ccm_reg
*mxc_ccm
= (struct mxc_ccm_reg
*)CCM_BASE_ADDR
;
286 reg
= readl(&mxc_ccm
->cscmr1
);
287 reg
|= MXC_CCM_CSCMR1_PER_CLK_SEL_MASK
;
288 writel(reg
, &mxc_ccm
->cscmr1
);
292 int arch_cpu_init(void)
296 /* Need to clear MMDC_CHx_MASK to make warm reset work. */
297 clear_mmdc_ch_mask();
300 * Disable self-bias circuit in the analog bandap.
301 * The self-bias circuit is used by the bandgap during startup.
302 * This bit should be set after the bandgap has initialized.
307 * When low freq boot is enabled, ROM will not set AHB
308 * freq, so we need to ensure AHB freq is 132MHz in such
311 if (mxc_get_clock(MXC_ARM_CLK
) == 396000000)
312 set_ahb_rate(132000000);
314 /* Set perclk to source from OSC 24MHz */
315 #if defined(CONFIG_MX6SL)
316 set_preclk_from_osc();
319 imx_set_wdog_powerdown(false); /* Disable PDE bit of WMCR register */
321 #ifdef CONFIG_APBH_DMA
329 int board_postclk_init(void)
331 set_ldo_voltage(LDO_SOC
, 1175); /* Set VDDSOC to 1.175V */
336 #ifndef CONFIG_SYS_DCACHE_OFF
337 void enable_caches(void)
339 #if defined(CONFIG_SYS_ARM_CACHE_WRITETHROUGH)
340 enum dcache_option option
= DCACHE_WRITETHROUGH
;
342 enum dcache_option option
= DCACHE_WRITEBACK
;
345 /* Avoid random hang when download by usb */
346 invalidate_dcache_all();
348 /* Enable D-cache. I-cache is already enabled in start.S */
351 /* Enable caching on OCRAM and ROM */
352 mmu_set_region_dcache_behaviour(ROMCP_ARB_BASE_ADDR
,
355 mmu_set_region_dcache_behaviour(IRAM_BASE_ADDR
,
361 #if defined(CONFIG_FEC_MXC)
362 void imx_get_mac_from_fuse(int dev_id
, unsigned char *mac
)
364 struct ocotp_regs
*ocotp
= (struct ocotp_regs
*)OCOTP_BASE_ADDR
;
365 struct fuse_bank
*bank
= &ocotp
->bank
[4];
366 struct fuse_bank4_regs
*fuse
=
367 (struct fuse_bank4_regs
*)bank
->fuse_regs
;
369 u32 value
= readl(&fuse
->mac_addr_high
);
370 mac
[0] = (value
>> 8);
373 value
= readl(&fuse
->mac_addr_low
);
374 mac
[2] = value
>> 24 ;
375 mac
[3] = value
>> 16 ;
376 mac
[4] = value
>> 8 ;
382 void boot_mode_apply(unsigned cfg_val
)
385 struct src
*psrc
= (struct src
*)SRC_BASE_ADDR
;
386 writel(cfg_val
, &psrc
->gpr9
);
387 reg
= readl(&psrc
->gpr10
);
392 writel(reg
, &psrc
->gpr10
);
395 * cfg_val will be used for
396 * Boot_cfg4[7:0]:Boot_cfg3[7:0]:Boot_cfg2[7:0]:Boot_cfg1[7:0]
397 * After reset, if GPR10[28] is 1, ROM will use GPR9[25:0]
398 * instead of SBMR1 to determine the boot device.
400 const struct boot_mode soc_boot_modes
[] = {
401 {"normal", MAKE_CFGVAL(0x00, 0x00, 0x00, 0x00)},
402 /* reserved value should start rom usb */
403 {"usb", MAKE_CFGVAL(0x01, 0x00, 0x00, 0x00)},
404 {"sata", MAKE_CFGVAL(0x20, 0x00, 0x00, 0x00)},
405 {"ecspi1:0", MAKE_CFGVAL(0x30, 0x00, 0x00, 0x08)},
406 {"ecspi1:1", MAKE_CFGVAL(0x30, 0x00, 0x00, 0x18)},
407 {"ecspi1:2", MAKE_CFGVAL(0x30, 0x00, 0x00, 0x28)},
408 {"ecspi1:3", MAKE_CFGVAL(0x30, 0x00, 0x00, 0x38)},
409 /* 4 bit bus width */
410 {"esdhc1", MAKE_CFGVAL(0x40, 0x20, 0x00, 0x00)},
411 {"esdhc2", MAKE_CFGVAL(0x40, 0x28, 0x00, 0x00)},
412 {"esdhc3", MAKE_CFGVAL(0x40, 0x30, 0x00, 0x00)},
413 {"esdhc4", MAKE_CFGVAL(0x40, 0x38, 0x00, 0x00)},
419 struct anatop_regs
*anatop
= (struct anatop_regs
*)ANATOP_BASE_ADDR
;
420 struct mxc_ccm_reg
*ccm
= (struct mxc_ccm_reg
*)CCM_BASE_ADDR
;
423 u32 reg
, periph1
, periph2
;
425 if (is_cpu_type(MXC_CPU_MX6SX
))
428 /* Due to hardware limitation, on MX6Q we need to gate/ungate all PFDs
429 * to make sure PFD is working right, otherwise, PFDs may
430 * not output clock after reset, MX6DL and MX6SL have added 396M pfd
431 * workaround in ROM code, as bus clock need it
434 mask480
= ANATOP_PFD_CLKGATE_MASK(0) |
435 ANATOP_PFD_CLKGATE_MASK(1) |
436 ANATOP_PFD_CLKGATE_MASK(2) |
437 ANATOP_PFD_CLKGATE_MASK(3);
438 mask528
= ANATOP_PFD_CLKGATE_MASK(1) |
439 ANATOP_PFD_CLKGATE_MASK(3);
441 reg
= readl(&ccm
->cbcmr
);
442 periph2
= ((reg
& MXC_CCM_CBCMR_PRE_PERIPH2_CLK_SEL_MASK
)
443 >> MXC_CCM_CBCMR_PRE_PERIPH2_CLK_SEL_OFFSET
);
444 periph1
= ((reg
& MXC_CCM_CBCMR_PRE_PERIPH_CLK_SEL_MASK
)
445 >> MXC_CCM_CBCMR_PRE_PERIPH_CLK_SEL_OFFSET
);
447 /* Checking if PLL2 PFD0 or PLL2 PFD2 is using for periph clock */
448 if ((periph2
!= 0x2) && (periph1
!= 0x2))
449 mask528
|= ANATOP_PFD_CLKGATE_MASK(0);
451 if ((periph2
!= 0x1) && (periph1
!= 0x1) &&
452 (periph2
!= 0x3) && (periph1
!= 0x3))
453 mask528
|= ANATOP_PFD_CLKGATE_MASK(2);
455 writel(mask480
, &anatop
->pfd_480_set
);
456 writel(mask528
, &anatop
->pfd_528_set
);
457 writel(mask480
, &anatop
->pfd_480_clr
);
458 writel(mask528
, &anatop
->pfd_528_clr
);
461 #ifdef CONFIG_IMX_HDMI
462 void imx_enable_hdmi_phy(void)
464 struct hdmi_regs
*hdmi
= (struct hdmi_regs
*)HDMI_ARB_BASE_ADDR
;
466 reg
= readb(&hdmi
->phy_conf0
);
467 reg
|= HDMI_PHY_CONF0_PDZ_MASK
;
468 writeb(reg
, &hdmi
->phy_conf0
);
470 reg
|= HDMI_PHY_CONF0_ENTMDS_MASK
;
471 writeb(reg
, &hdmi
->phy_conf0
);
473 reg
|= HDMI_PHY_CONF0_GEN2_TXPWRON_MASK
;
474 writeb(reg
, &hdmi
->phy_conf0
);
475 writeb(HDMI_MC_PHYRSTZ_ASSERT
, &hdmi
->mc_phyrstz
);
478 void imx_setup_hdmi(void)
480 struct mxc_ccm_reg
*mxc_ccm
= (struct mxc_ccm_reg
*)CCM_BASE_ADDR
;
481 struct hdmi_regs
*hdmi
= (struct hdmi_regs
*)HDMI_ARB_BASE_ADDR
;
484 /* Turn on HDMI PHY clock */
485 reg
= readl(&mxc_ccm
->CCGR2
);
486 reg
|= MXC_CCM_CCGR2_HDMI_TX_IAHBCLK_MASK
|
487 MXC_CCM_CCGR2_HDMI_TX_ISFRCLK_MASK
;
488 writel(reg
, &mxc_ccm
->CCGR2
);
489 writeb(HDMI_MC_PHYRSTZ_DEASSERT
, &hdmi
->mc_phyrstz
);
490 reg
= readl(&mxc_ccm
->chsccdr
);
491 reg
&= ~(MXC_CCM_CHSCCDR_IPU1_DI0_PRE_CLK_SEL_MASK
|
492 MXC_CCM_CHSCCDR_IPU1_DI0_PODF_MASK
|
493 MXC_CCM_CHSCCDR_IPU1_DI0_CLK_SEL_MASK
);
494 reg
|= (CHSCCDR_PODF_DIVIDE_BY_3
495 << MXC_CCM_CHSCCDR_IPU1_DI0_PODF_OFFSET
)
496 |(CHSCCDR_IPU_PRE_CLK_540M_PFD
497 << MXC_CCM_CHSCCDR_IPU1_DI0_PRE_CLK_SEL_OFFSET
);
498 writel(reg
, &mxc_ccm
->chsccdr
);
502 #ifndef CONFIG_SYS_L2CACHE_OFF
503 #define IOMUXC_GPR11_L2CACHE_AS_OCRAM 0x00000002
504 void v7_outer_cache_enable(void)
506 struct pl310_regs
*const pl310
= (struct pl310_regs
*)L2_PL310_BASE
;
509 #if defined CONFIG_MX6SL
510 struct iomuxc
*iomux
= (struct iomuxc
*)IOMUXC_BASE_ADDR
;
511 val
= readl(&iomux
->gpr
[11]);
512 if (val
& IOMUXC_GPR11_L2CACHE_AS_OCRAM
) {
513 /* L2 cache configured as OCRAM, reset it */
514 val
&= ~IOMUXC_GPR11_L2CACHE_AS_OCRAM
;
515 writel(val
, &iomux
->gpr
[11]);
519 /* Must disable the L2 before changing the latency parameters */
520 clrbits_le32(&pl310
->pl310_ctrl
, L2X0_CTRL_EN
);
522 writel(0x132, &pl310
->pl310_tag_latency_ctrl
);
523 writel(0x132, &pl310
->pl310_data_latency_ctrl
);
525 val
= readl(&pl310
->pl310_prefetch_ctrl
);
527 /* Turn on the L2 I/D prefetch */
531 * The L2 cache controller(PL310) version on the i.MX6D/Q is r3p1-50rel0
532 * The L2 cache controller(PL310) version on the i.MX6DL/SOLO/SL is r3p2
533 * But according to ARM PL310 errata: 752271
534 * ID: 752271: Double linefill feature can cause data corruption
535 * Fault Status: Present in: r3p0, r3p1, r3p1-50rel0. Fixed in r3p2
536 * Workaround: The only workaround to this erratum is to disable the
537 * double linefill feature. This is the default behavior.
543 writel(val
, &pl310
->pl310_prefetch_ctrl
);
545 val
= readl(&pl310
->pl310_power_ctrl
);
546 val
|= L2X0_DYNAMIC_CLK_GATING_EN
;
547 val
|= L2X0_STNDBY_MODE_EN
;
548 writel(val
, &pl310
->pl310_power_ctrl
);
550 setbits_le32(&pl310
->pl310_ctrl
, L2X0_CTRL_EN
);
553 void v7_outer_cache_disable(void)
555 struct pl310_regs
*const pl310
= (struct pl310_regs
*)L2_PL310_BASE
;
557 clrbits_le32(&pl310
->pl310_ctrl
, L2X0_CTRL_EN
);
559 #endif /* !CONFIG_SYS_L2CACHE_OFF */