mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-11-17 02:08:38 +00:00
83d290c56f
When U-Boot started using SPDX tags we were among the early adopters and there weren't a lot of other examples to borrow from. So we picked the area of the file that usually had a full license text and replaced it with an appropriate SPDX-License-Identifier: entry. Since then, the Linux Kernel has adopted SPDX tags and they place it as the very first line in a file (except where shebangs are used, then it's second line) and with slightly different comment styles than us. In part due to community overlap, in part due to better tag visibility and in part for other minor reasons, switch over to that style. This commit changes all instances where we have a single declared license in the tag as both the before and after are identical in tag contents. There's also a few places where I found we did not have a tag and have introduced one. Signed-off-by: Tom Rini <trini@konsulko.com>
667 lines
16 KiB
C
667 lines
16 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* (C) Copyright 2007
|
|
* Sascha Hauer, Pengutronix
|
|
*
|
|
* (C) Copyright 2009 Freescale Semiconductor, Inc.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <linux/errno.h>
|
|
#include <asm/io.h>
|
|
#include <asm/arch/imx-regs.h>
|
|
#include <asm/arch/clock.h>
|
|
#include <asm/arch/sys_proto.h>
|
|
#include <asm/bootm.h>
|
|
#include <asm/mach-imx/boot_mode.h>
|
|
#include <asm/mach-imx/dma.h>
|
|
#include <asm/mach-imx/hab.h>
|
|
#include <stdbool.h>
|
|
#include <asm/arch/mxc_hdmi.h>
|
|
#include <asm/arch/crm_regs.h>
|
|
#include <dm.h>
|
|
#include <imx_thermal.h>
|
|
#include <mmc.h>
|
|
|
|
enum ldo_reg {
|
|
LDO_ARM,
|
|
LDO_SOC,
|
|
LDO_PU,
|
|
};
|
|
|
|
struct scu_regs {
|
|
u32 ctrl;
|
|
u32 config;
|
|
u32 status;
|
|
u32 invalidate;
|
|
u32 fpga_rev;
|
|
};
|
|
|
|
#if defined(CONFIG_IMX_THERMAL)
|
|
static const struct imx_thermal_plat imx6_thermal_plat = {
|
|
.regs = (void *)ANATOP_BASE_ADDR,
|
|
.fuse_bank = 1,
|
|
.fuse_word = 6,
|
|
};
|
|
|
|
U_BOOT_DEVICE(imx6_thermal) = {
|
|
.name = "imx_thermal",
|
|
.platdata = &imx6_thermal_plat,
|
|
};
|
|
#endif
|
|
|
|
#if defined(CONFIG_SECURE_BOOT)
|
|
struct imx_sec_config_fuse_t const imx_sec_config_fuse = {
|
|
.bank = 0,
|
|
.word = 6,
|
|
};
|
|
#endif
|
|
|
|
u32 get_nr_cpus(void)
|
|
{
|
|
struct scu_regs *scu = (struct scu_regs *)SCU_BASE_ADDR;
|
|
return readl(&scu->config) & 3;
|
|
}
|
|
|
|
u32 get_cpu_rev(void)
|
|
{
|
|
struct anatop_regs *anatop = (struct anatop_regs *)ANATOP_BASE_ADDR;
|
|
u32 reg = readl(&anatop->digprog_sololite);
|
|
u32 type = ((reg >> 16) & 0xff);
|
|
u32 major, cfg = 0;
|
|
|
|
if (type != MXC_CPU_MX6SL) {
|
|
reg = readl(&anatop->digprog);
|
|
struct scu_regs *scu = (struct scu_regs *)SCU_BASE_ADDR;
|
|
cfg = readl(&scu->config) & 3;
|
|
type = ((reg >> 16) & 0xff);
|
|
if (type == MXC_CPU_MX6DL) {
|
|
if (!cfg)
|
|
type = MXC_CPU_MX6SOLO;
|
|
}
|
|
|
|
if (type == MXC_CPU_MX6Q) {
|
|
if (cfg == 1)
|
|
type = MXC_CPU_MX6D;
|
|
}
|
|
|
|
}
|
|
major = ((reg >> 8) & 0xff);
|
|
if ((major >= 1) &&
|
|
((type == MXC_CPU_MX6Q) || (type == MXC_CPU_MX6D))) {
|
|
major--;
|
|
type = MXC_CPU_MX6QP;
|
|
if (cfg == 1)
|
|
type = MXC_CPU_MX6DP;
|
|
}
|
|
reg &= 0xff; /* mx6 silicon revision */
|
|
return (type << 12) | (reg + (0x10 * (major + 1)));
|
|
}
|
|
|
|
/*
|
|
* OCOTP_CFG3[17:16] (see Fusemap Description Table offset 0x440)
|
|
* defines a 2-bit SPEED_GRADING
|
|
*/
|
|
#define OCOTP_CFG3_SPEED_SHIFT 16
|
|
#define OCOTP_CFG3_SPEED_800MHZ 0
|
|
#define OCOTP_CFG3_SPEED_850MHZ 1
|
|
#define OCOTP_CFG3_SPEED_1GHZ 2
|
|
#define OCOTP_CFG3_SPEED_1P2GHZ 3
|
|
|
|
/*
|
|
* For i.MX6UL
|
|
*/
|
|
#define OCOTP_CFG3_SPEED_528MHZ 1
|
|
#define OCOTP_CFG3_SPEED_696MHZ 2
|
|
|
|
/*
|
|
* For i.MX6ULL
|
|
*/
|
|
#define OCOTP_CFG3_SPEED_792MHZ 2
|
|
#define OCOTP_CFG3_SPEED_900MHZ 3
|
|
|
|
u32 get_cpu_speed_grade_hz(void)
|
|
{
|
|
struct ocotp_regs *ocotp = (struct ocotp_regs *)OCOTP_BASE_ADDR;
|
|
struct fuse_bank *bank = &ocotp->bank[0];
|
|
struct fuse_bank0_regs *fuse =
|
|
(struct fuse_bank0_regs *)bank->fuse_regs;
|
|
uint32_t val;
|
|
|
|
val = readl(&fuse->cfg3);
|
|
val >>= OCOTP_CFG3_SPEED_SHIFT;
|
|
val &= 0x3;
|
|
|
|
if (is_mx6ul()) {
|
|
if (val == OCOTP_CFG3_SPEED_528MHZ)
|
|
return 528000000;
|
|
else if (val == OCOTP_CFG3_SPEED_696MHZ)
|
|
return 696000000;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
if (is_mx6ull()) {
|
|
if (val == OCOTP_CFG3_SPEED_528MHZ)
|
|
return 528000000;
|
|
else if (val == OCOTP_CFG3_SPEED_792MHZ)
|
|
return 792000000;
|
|
else if (val == OCOTP_CFG3_SPEED_900MHZ)
|
|
return 900000000;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
switch (val) {
|
|
/* Valid for IMX6DQ */
|
|
case OCOTP_CFG3_SPEED_1P2GHZ:
|
|
if (is_mx6dq() || is_mx6dqp())
|
|
return 1200000000;
|
|
/* Valid for IMX6SX/IMX6SDL/IMX6DQ */
|
|
case OCOTP_CFG3_SPEED_1GHZ:
|
|
return 996000000;
|
|
/* Valid for IMX6DQ */
|
|
case OCOTP_CFG3_SPEED_850MHZ:
|
|
if (is_mx6dq() || is_mx6dqp())
|
|
return 852000000;
|
|
/* Valid for IMX6SX/IMX6SDL/IMX6DQ */
|
|
case OCOTP_CFG3_SPEED_800MHZ:
|
|
return 792000000;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* OCOTP_MEM0[7:6] (see Fusemap Description Table offset 0x480)
|
|
* defines a 2-bit Temperature Grade
|
|
*
|
|
* return temperature grade and min/max temperature in Celsius
|
|
*/
|
|
#define OCOTP_MEM0_TEMP_SHIFT 6
|
|
|
|
u32 get_cpu_temp_grade(int *minc, int *maxc)
|
|
{
|
|
struct ocotp_regs *ocotp = (struct ocotp_regs *)OCOTP_BASE_ADDR;
|
|
struct fuse_bank *bank = &ocotp->bank[1];
|
|
struct fuse_bank1_regs *fuse =
|
|
(struct fuse_bank1_regs *)bank->fuse_regs;
|
|
uint32_t val;
|
|
|
|
val = readl(&fuse->mem0);
|
|
val >>= OCOTP_MEM0_TEMP_SHIFT;
|
|
val &= 0x3;
|
|
|
|
if (minc && maxc) {
|
|
if (val == TEMP_AUTOMOTIVE) {
|
|
*minc = -40;
|
|
*maxc = 125;
|
|
} else if (val == TEMP_INDUSTRIAL) {
|
|
*minc = -40;
|
|
*maxc = 105;
|
|
} else if (val == TEMP_EXTCOMMERCIAL) {
|
|
*minc = -20;
|
|
*maxc = 105;
|
|
} else {
|
|
*minc = 0;
|
|
*maxc = 95;
|
|
}
|
|
}
|
|
return val;
|
|
}
|
|
|
|
#ifdef CONFIG_REVISION_TAG
|
|
u32 __weak get_board_rev(void)
|
|
{
|
|
u32 cpurev = get_cpu_rev();
|
|
u32 type = ((cpurev >> 12) & 0xff);
|
|
if (type == MXC_CPU_MX6SOLO)
|
|
cpurev = (MXC_CPU_MX6DL) << 12 | (cpurev & 0xFFF);
|
|
|
|
if (type == MXC_CPU_MX6D)
|
|
cpurev = (MXC_CPU_MX6Q) << 12 | (cpurev & 0xFFF);
|
|
|
|
return cpurev;
|
|
}
|
|
#endif
|
|
|
|
static void clear_ldo_ramp(void)
|
|
{
|
|
struct anatop_regs *anatop = (struct anatop_regs *)ANATOP_BASE_ADDR;
|
|
int reg;
|
|
|
|
/* ROM may modify LDO ramp up time according to fuse setting, so in
|
|
* order to be in the safe side we neeed to reset these settings to
|
|
* match the reset value: 0'b00
|
|
*/
|
|
reg = readl(&anatop->ana_misc2);
|
|
reg &= ~(0x3f << 24);
|
|
writel(reg, &anatop->ana_misc2);
|
|
}
|
|
|
|
/*
|
|
* Set the PMU_REG_CORE register
|
|
*
|
|
* Set LDO_SOC/PU/ARM regulators to the specified millivolt level.
|
|
* Possible values are from 0.725V to 1.450V in steps of
|
|
* 0.025V (25mV).
|
|
*/
|
|
static int set_ldo_voltage(enum ldo_reg ldo, u32 mv)
|
|
{
|
|
struct anatop_regs *anatop = (struct anatop_regs *)ANATOP_BASE_ADDR;
|
|
u32 val, step, old, reg = readl(&anatop->reg_core);
|
|
u8 shift;
|
|
|
|
/* No LDO_SOC/PU/ARM */
|
|
if (is_mx6sll())
|
|
return 0;
|
|
|
|
if (mv < 725)
|
|
val = 0x00; /* Power gated off */
|
|
else if (mv > 1450)
|
|
val = 0x1F; /* Power FET switched full on. No regulation */
|
|
else
|
|
val = (mv - 700) / 25;
|
|
|
|
clear_ldo_ramp();
|
|
|
|
switch (ldo) {
|
|
case LDO_SOC:
|
|
shift = 18;
|
|
break;
|
|
case LDO_PU:
|
|
shift = 9;
|
|
break;
|
|
case LDO_ARM:
|
|
shift = 0;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
old = (reg & (0x1F << shift)) >> shift;
|
|
step = abs(val - old);
|
|
if (step == 0)
|
|
return 0;
|
|
|
|
reg = (reg & ~(0x1F << shift)) | (val << shift);
|
|
writel(reg, &anatop->reg_core);
|
|
|
|
/*
|
|
* The LDO ramp-up is based on 64 clock cycles of 24 MHz = 2.6 us per
|
|
* step
|
|
*/
|
|
udelay(3 * step);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void set_ahb_rate(u32 val)
|
|
{
|
|
struct mxc_ccm_reg *mxc_ccm = (struct mxc_ccm_reg *)CCM_BASE_ADDR;
|
|
u32 reg, div;
|
|
|
|
div = get_periph_clk() / val - 1;
|
|
reg = readl(&mxc_ccm->cbcdr);
|
|
|
|
writel((reg & (~MXC_CCM_CBCDR_AHB_PODF_MASK)) |
|
|
(div << MXC_CCM_CBCDR_AHB_PODF_OFFSET), &mxc_ccm->cbcdr);
|
|
}
|
|
|
|
static void clear_mmdc_ch_mask(void)
|
|
{
|
|
struct mxc_ccm_reg *mxc_ccm = (struct mxc_ccm_reg *)CCM_BASE_ADDR;
|
|
u32 reg;
|
|
reg = readl(&mxc_ccm->ccdr);
|
|
|
|
/* Clear MMDC channel mask */
|
|
if (is_mx6sx() || is_mx6ul() || is_mx6ull() || is_mx6sl() || is_mx6sll())
|
|
reg &= ~(MXC_CCM_CCDR_MMDC_CH1_HS_MASK);
|
|
else
|
|
reg &= ~(MXC_CCM_CCDR_MMDC_CH1_HS_MASK | MXC_CCM_CCDR_MMDC_CH0_HS_MASK);
|
|
writel(reg, &mxc_ccm->ccdr);
|
|
}
|
|
|
|
#define OCOTP_MEM0_REFTOP_TRIM_SHIFT 8
|
|
|
|
static void init_bandgap(void)
|
|
{
|
|
struct anatop_regs *anatop = (struct anatop_regs *)ANATOP_BASE_ADDR;
|
|
struct ocotp_regs *ocotp = (struct ocotp_regs *)OCOTP_BASE_ADDR;
|
|
struct fuse_bank *bank = &ocotp->bank[1];
|
|
struct fuse_bank1_regs *fuse =
|
|
(struct fuse_bank1_regs *)bank->fuse_regs;
|
|
uint32_t val;
|
|
|
|
/*
|
|
* Ensure the bandgap has stabilized.
|
|
*/
|
|
while (!(readl(&anatop->ana_misc0) & 0x80))
|
|
;
|
|
/*
|
|
* For best noise performance of the analog blocks using the
|
|
* outputs of the bandgap, the reftop_selfbiasoff bit should
|
|
* be set.
|
|
*/
|
|
writel(BM_ANADIG_ANA_MISC0_REFTOP_SELBIASOFF, &anatop->ana_misc0_set);
|
|
/*
|
|
* On i.MX6ULL,we need to set VBGADJ bits according to the
|
|
* REFTOP_TRIM[3:0] in fuse table
|
|
* 000 - set REFTOP_VBGADJ[2:0] to 3b'110,
|
|
* 110 - set REFTOP_VBGADJ[2:0] to 3b'000,
|
|
* 001 - set REFTOP_VBGADJ[2:0] to 3b'001,
|
|
* 010 - set REFTOP_VBGADJ[2:0] to 3b'010,
|
|
* 011 - set REFTOP_VBGADJ[2:0] to 3b'011,
|
|
* 100 - set REFTOP_VBGADJ[2:0] to 3b'100,
|
|
* 101 - set REFTOP_VBGADJ[2:0] to 3b'101,
|
|
* 111 - set REFTOP_VBGADJ[2:0] to 3b'111,
|
|
*/
|
|
if (is_mx6ull()) {
|
|
val = readl(&fuse->mem0);
|
|
val >>= OCOTP_MEM0_REFTOP_TRIM_SHIFT;
|
|
val &= 0x7;
|
|
|
|
writel(val << BM_ANADIG_ANA_MISC0_REFTOP_VBGADJ_SHIFT,
|
|
&anatop->ana_misc0_set);
|
|
}
|
|
}
|
|
|
|
int arch_cpu_init(void)
|
|
{
|
|
struct mxc_ccm_reg *ccm = (struct mxc_ccm_reg *)CCM_BASE_ADDR;
|
|
|
|
init_aips();
|
|
|
|
/* Need to clear MMDC_CHx_MASK to make warm reset work. */
|
|
clear_mmdc_ch_mask();
|
|
|
|
/*
|
|
* Disable self-bias circuit in the analog bandap.
|
|
* The self-bias circuit is used by the bandgap during startup.
|
|
* This bit should be set after the bandgap has initialized.
|
|
*/
|
|
init_bandgap();
|
|
|
|
if (!is_mx6ul() && !is_mx6ull()) {
|
|
/*
|
|
* When low freq boot is enabled, ROM will not set AHB
|
|
* freq, so we need to ensure AHB freq is 132MHz in such
|
|
* scenario.
|
|
*
|
|
* To i.MX6UL, when power up, default ARM core and
|
|
* AHB rate is 396M and 132M.
|
|
*/
|
|
if (mxc_get_clock(MXC_ARM_CLK) == 396000000)
|
|
set_ahb_rate(132000000);
|
|
}
|
|
|
|
if (is_mx6ul()) {
|
|
if (is_soc_rev(CHIP_REV_1_0) == 0) {
|
|
/*
|
|
* According to the design team's requirement on
|
|
* i.MX6UL,the PMIC_STBY_REQ PAD should be configured
|
|
* as open drain 100K (0x0000b8a0).
|
|
* Only exists on TO1.0
|
|
*/
|
|
writel(0x0000b8a0, IOMUXC_BASE_ADDR + 0x29c);
|
|
} else {
|
|
/*
|
|
* From TO1.1, SNVS adds internal pull up control
|
|
* for POR_B, the register filed is GPBIT[1:0],
|
|
* after system boot up, it can be set to 2b'01
|
|
* to disable internal pull up.It can save about
|
|
* 30uA power in SNVS mode.
|
|
*/
|
|
writel((readl(MX6UL_SNVS_LP_BASE_ADDR + 0x10) &
|
|
(~0x1400)) | 0x400,
|
|
MX6UL_SNVS_LP_BASE_ADDR + 0x10);
|
|
}
|
|
}
|
|
|
|
if (is_mx6ull()) {
|
|
/*
|
|
* GPBIT[1:0] is suggested to set to 2'b11:
|
|
* 2'b00 : always PUP100K
|
|
* 2'b01 : PUP100K when PMIC_ON_REQ or SOC_NOT_FAIL
|
|
* 2'b10 : always disable PUP100K
|
|
* 2'b11 : PDN100K when SOC_FAIL, PUP100K when SOC_NOT_FAIL
|
|
* register offset is different from i.MX6UL, since
|
|
* i.MX6UL is fixed by ECO.
|
|
*/
|
|
writel(readl(MX6UL_SNVS_LP_BASE_ADDR) |
|
|
0x3, MX6UL_SNVS_LP_BASE_ADDR);
|
|
}
|
|
|
|
/* Set perclk to source from OSC 24MHz */
|
|
if (is_mx6sl())
|
|
setbits_le32(&ccm->cscmr1, MXC_CCM_CSCMR1_PER_CLK_SEL_MASK);
|
|
|
|
imx_wdog_disable_powerdown(); /* Disable PDE bit of WMCR register */
|
|
|
|
if (is_mx6sx())
|
|
setbits_le32(&ccm->cscdr1, MXC_CCM_CSCDR1_UART_CLK_SEL);
|
|
|
|
init_src();
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_ENV_IS_IN_MMC
|
|
__weak int board_mmc_get_env_dev(int devno)
|
|
{
|
|
return CONFIG_SYS_MMC_ENV_DEV;
|
|
}
|
|
|
|
static int mmc_get_boot_dev(void)
|
|
{
|
|
struct src *src_regs = (struct src *)SRC_BASE_ADDR;
|
|
u32 soc_sbmr = readl(&src_regs->sbmr1);
|
|
u32 bootsel;
|
|
int devno;
|
|
|
|
/*
|
|
* Refer to
|
|
* "i.MX 6Dual/6Quad Applications Processor Reference Manual"
|
|
* Chapter "8.5.3.1 Expansion Device eFUSE Configuration"
|
|
* i.MX6SL/SX/UL has same layout.
|
|
*/
|
|
bootsel = (soc_sbmr & 0x000000FF) >> 6;
|
|
|
|
/* No boot from sd/mmc */
|
|
if (bootsel != 1)
|
|
return -1;
|
|
|
|
/* BOOT_CFG2[3] and BOOT_CFG2[4] */
|
|
devno = (soc_sbmr & 0x00001800) >> 11;
|
|
|
|
return devno;
|
|
}
|
|
|
|
int mmc_get_env_dev(void)
|
|
{
|
|
int devno = mmc_get_boot_dev();
|
|
|
|
/* If not boot from sd/mmc, use default value */
|
|
if (devno < 0)
|
|
return CONFIG_SYS_MMC_ENV_DEV;
|
|
|
|
return board_mmc_get_env_dev(devno);
|
|
}
|
|
|
|
#ifdef CONFIG_SYS_MMC_ENV_PART
|
|
__weak int board_mmc_get_env_part(int devno)
|
|
{
|
|
return CONFIG_SYS_MMC_ENV_PART;
|
|
}
|
|
|
|
uint mmc_get_env_part(struct mmc *mmc)
|
|
{
|
|
int devno = mmc_get_boot_dev();
|
|
|
|
/* If not boot from sd/mmc, use default value */
|
|
if (devno < 0)
|
|
return CONFIG_SYS_MMC_ENV_PART;
|
|
|
|
return board_mmc_get_env_part(devno);
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
int board_postclk_init(void)
|
|
{
|
|
/* NO LDO SOC on i.MX6SLL */
|
|
if (is_mx6sll())
|
|
return 0;
|
|
|
|
set_ldo_voltage(LDO_SOC, 1175); /* Set VDDSOC to 1.175V */
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifndef CONFIG_SPL_BUILD
|
|
/*
|
|
* cfg_val will be used for
|
|
* Boot_cfg4[7:0]:Boot_cfg3[7:0]:Boot_cfg2[7:0]:Boot_cfg1[7:0]
|
|
* After reset, if GPR10[28] is 1, ROM will use GPR9[25:0]
|
|
* instead of SBMR1 to determine the boot device.
|
|
*/
|
|
const struct boot_mode soc_boot_modes[] = {
|
|
{"normal", MAKE_CFGVAL(0x00, 0x00, 0x00, 0x00)},
|
|
/* reserved value should start rom usb */
|
|
#if defined(CONFIG_MX6UL) || defined(CONFIG_MX6ULL)
|
|
{"usb", MAKE_CFGVAL(0x20, 0x00, 0x00, 0x00)},
|
|
#else
|
|
{"usb", MAKE_CFGVAL(0x10, 0x00, 0x00, 0x00)},
|
|
#endif
|
|
{"sata", MAKE_CFGVAL(0x20, 0x00, 0x00, 0x00)},
|
|
{"ecspi1:0", MAKE_CFGVAL(0x30, 0x00, 0x00, 0x08)},
|
|
{"ecspi1:1", MAKE_CFGVAL(0x30, 0x00, 0x00, 0x18)},
|
|
{"ecspi1:2", MAKE_CFGVAL(0x30, 0x00, 0x00, 0x28)},
|
|
{"ecspi1:3", MAKE_CFGVAL(0x30, 0x00, 0x00, 0x38)},
|
|
/* 4 bit bus width */
|
|
{"esdhc1", MAKE_CFGVAL(0x40, 0x20, 0x00, 0x00)},
|
|
{"esdhc2", MAKE_CFGVAL(0x40, 0x28, 0x00, 0x00)},
|
|
{"esdhc3", MAKE_CFGVAL(0x40, 0x30, 0x00, 0x00)},
|
|
{"esdhc4", MAKE_CFGVAL(0x40, 0x38, 0x00, 0x00)},
|
|
{NULL, 0},
|
|
};
|
|
#endif
|
|
|
|
void reset_misc(void)
|
|
{
|
|
#ifdef CONFIG_VIDEO_MXS
|
|
lcdif_power_down();
|
|
#endif
|
|
}
|
|
|
|
void s_init(void)
|
|
{
|
|
struct anatop_regs *anatop = (struct anatop_regs *)ANATOP_BASE_ADDR;
|
|
struct mxc_ccm_reg *ccm = (struct mxc_ccm_reg *)CCM_BASE_ADDR;
|
|
u32 mask480;
|
|
u32 mask528;
|
|
u32 reg, periph1, periph2;
|
|
|
|
if (is_mx6sx() || is_mx6ul() || is_mx6ull() || is_mx6sll())
|
|
return;
|
|
|
|
/* Due to hardware limitation, on MX6Q we need to gate/ungate all PFDs
|
|
* to make sure PFD is working right, otherwise, PFDs may
|
|
* not output clock after reset, MX6DL and MX6SL have added 396M pfd
|
|
* workaround in ROM code, as bus clock need it
|
|
*/
|
|
|
|
mask480 = ANATOP_PFD_CLKGATE_MASK(0) |
|
|
ANATOP_PFD_CLKGATE_MASK(1) |
|
|
ANATOP_PFD_CLKGATE_MASK(2) |
|
|
ANATOP_PFD_CLKGATE_MASK(3);
|
|
mask528 = ANATOP_PFD_CLKGATE_MASK(1) |
|
|
ANATOP_PFD_CLKGATE_MASK(3);
|
|
|
|
reg = readl(&ccm->cbcmr);
|
|
periph2 = ((reg & MXC_CCM_CBCMR_PRE_PERIPH2_CLK_SEL_MASK)
|
|
>> MXC_CCM_CBCMR_PRE_PERIPH2_CLK_SEL_OFFSET);
|
|
periph1 = ((reg & MXC_CCM_CBCMR_PRE_PERIPH_CLK_SEL_MASK)
|
|
>> MXC_CCM_CBCMR_PRE_PERIPH_CLK_SEL_OFFSET);
|
|
|
|
/* Checking if PLL2 PFD0 or PLL2 PFD2 is using for periph clock */
|
|
if ((periph2 != 0x2) && (periph1 != 0x2))
|
|
mask528 |= ANATOP_PFD_CLKGATE_MASK(0);
|
|
|
|
if ((periph2 != 0x1) && (periph1 != 0x1) &&
|
|
(periph2 != 0x3) && (periph1 != 0x3))
|
|
mask528 |= ANATOP_PFD_CLKGATE_MASK(2);
|
|
|
|
writel(mask480, &anatop->pfd_480_set);
|
|
writel(mask528, &anatop->pfd_528_set);
|
|
writel(mask480, &anatop->pfd_480_clr);
|
|
writel(mask528, &anatop->pfd_528_clr);
|
|
}
|
|
|
|
#ifdef CONFIG_IMX_HDMI
|
|
void imx_enable_hdmi_phy(void)
|
|
{
|
|
struct hdmi_regs *hdmi = (struct hdmi_regs *)HDMI_ARB_BASE_ADDR;
|
|
u8 reg;
|
|
reg = readb(&hdmi->phy_conf0);
|
|
reg |= HDMI_PHY_CONF0_PDZ_MASK;
|
|
writeb(reg, &hdmi->phy_conf0);
|
|
udelay(3000);
|
|
reg |= HDMI_PHY_CONF0_ENTMDS_MASK;
|
|
writeb(reg, &hdmi->phy_conf0);
|
|
udelay(3000);
|
|
reg |= HDMI_PHY_CONF0_GEN2_TXPWRON_MASK;
|
|
writeb(reg, &hdmi->phy_conf0);
|
|
writeb(HDMI_MC_PHYRSTZ_ASSERT, &hdmi->mc_phyrstz);
|
|
}
|
|
|
|
void imx_setup_hdmi(void)
|
|
{
|
|
struct mxc_ccm_reg *mxc_ccm = (struct mxc_ccm_reg *)CCM_BASE_ADDR;
|
|
struct hdmi_regs *hdmi = (struct hdmi_regs *)HDMI_ARB_BASE_ADDR;
|
|
int reg, count;
|
|
u8 val;
|
|
|
|
/* Turn on HDMI PHY clock */
|
|
reg = readl(&mxc_ccm->CCGR2);
|
|
reg |= MXC_CCM_CCGR2_HDMI_TX_IAHBCLK_MASK|
|
|
MXC_CCM_CCGR2_HDMI_TX_ISFRCLK_MASK;
|
|
writel(reg, &mxc_ccm->CCGR2);
|
|
writeb(HDMI_MC_PHYRSTZ_DEASSERT, &hdmi->mc_phyrstz);
|
|
reg = readl(&mxc_ccm->chsccdr);
|
|
reg &= ~(MXC_CCM_CHSCCDR_IPU1_DI0_PRE_CLK_SEL_MASK|
|
|
MXC_CCM_CHSCCDR_IPU1_DI0_PODF_MASK|
|
|
MXC_CCM_CHSCCDR_IPU1_DI0_CLK_SEL_MASK);
|
|
reg |= (CHSCCDR_PODF_DIVIDE_BY_3
|
|
<< MXC_CCM_CHSCCDR_IPU1_DI0_PODF_OFFSET)
|
|
|(CHSCCDR_IPU_PRE_CLK_540M_PFD
|
|
<< MXC_CCM_CHSCCDR_IPU1_DI0_PRE_CLK_SEL_OFFSET);
|
|
writel(reg, &mxc_ccm->chsccdr);
|
|
|
|
/* Clear the overflow condition */
|
|
if (readb(&hdmi->ih_fc_stat2) & HDMI_IH_FC_STAT2_OVERFLOW_MASK) {
|
|
/* TMDS software reset */
|
|
writeb((u8)~HDMI_MC_SWRSTZ_TMDSSWRST_REQ, &hdmi->mc_swrstz);
|
|
val = readb(&hdmi->fc_invidconf);
|
|
/* Need minimum 3 times to write to clear the register */
|
|
for (count = 0 ; count < 5 ; count++)
|
|
writeb(val, &hdmi->fc_invidconf);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
void gpr_init(void)
|
|
{
|
|
struct iomuxc *iomux = (struct iomuxc *)IOMUXC_BASE_ADDR;
|
|
|
|
/* enable AXI cache for VDOA/VPU/IPU */
|
|
writel(0xF00000CF, &iomux->gpr[4]);
|
|
if (is_mx6dqp()) {
|
|
/* set IPU AXI-id1 Qos=0x1 AXI-id0/2/3 Qos=0x7 */
|
|
writel(0x77177717, &iomux->gpr[6]);
|
|
writel(0x77177717, &iomux->gpr[7]);
|
|
} else {
|
|
/* set IPU AXI-id0 Qos=0xf(bypass) AXI-id1 Qos=0x7 */
|
|
writel(0x007F007F, &iomux->gpr[6]);
|
|
writel(0x007F007F, &iomux->gpr[7]);
|
|
}
|
|
}
|