static void _vip_hw_set_clock(int module, struct nxp_backward_camera_platform_data *param, bool on)
{
if (on) {
volatile u32 *clkgen_base = (volatile u32 *)IO_ADDRESS(NX_CLKGEN_GetPhysicalAddress(NX_VIP_GetClockNumber(module)));
NX_CLKGEN_SetBaseAddress(NX_VIP_GetClockNumber(module), (U32)clkgen_base);
NX_CLKGEN_SetClockDivisorEnable(NX_VIP_GetClockNumber(module), CTRUE);
NX_CLKGEN_SetClockBClkMode(NX_VIP_GetClockNumber(module), NX_BCLKMODE_DYNAMIC);
/* printk("RSTCON Base: 0x%x\n", NX_RSTCON_GetBaseAddress()); */
/* printk("RSTCON VIP %d Reset Number %d, REG Number %d\n", module, NX_VIP_GetResetNumber(module), NX_VIP_GetResetNumber(module)>>5); */
/* printk("CLKGEN Base: 0x%x\n", clkgen_base); */
NX_RSTCON_SetnRST(NX_VIP_GetResetNumber(module), RSTCON_nDISABLE);
NX_RSTCON_SetnRST(NX_VIP_GetResetNumber(module), RSTCON_nENABLE);
if (param->is_mipi) {
printk("%s: apply mipi csi clock!!!\n", __func__);
NX_CLKGEN_SetClockSource(NX_VIP_GetClockNumber(module), 0, 2); /* external PCLK */
NX_CLKGEN_SetClockDivisor(NX_VIP_GetClockNumber(module), 0, 2);
NX_CLKGEN_SetClockDivisorEnable(NX_VIP_GetClockNumber(module), CTRUE);
} else {
NX_CLKGEN_SetClockSource(NX_VIP_GetClockNumber(module), 0, 4 + param->port); /* external PCLK */
NX_CLKGEN_SetClockDivisor(NX_VIP_GetClockNumber(module), 0, 1);
NX_CLKGEN_SetClockDivisorEnable(NX_VIP_GetClockNumber(module), CTRUE);
}
printk("VIP CLK GEN VAL: 0x%x\n", *clkgen_base);
NX_VIP_SetBaseAddress(module, IO_ADDRESS(NX_VIP_GetPhysicalAddress(module)));
}
}
static void cpu_base_init(void)
{
int i = 0;
NX_RSTCON_Initialize();
NX_RSTCON_SetBaseAddress((void*)IO_ADDRESS(NX_RSTCON_GetPhysicalAddress()));
NX_TIEOFF_Initialize();
NX_TIEOFF_SetBaseAddress((void*)IO_ADDRESS(NX_TIEOFF_GetPhysicalAddress()));
NX_CLKGEN_Initialize();
for (i = 0; NX_CLKGEN_GetNumberOfModule() > i; i++)
NX_CLKGEN_SetBaseAddress(i, (void*)IO_ADDRESS(NX_CLKGEN_GetPhysicalAddress(i)));
NX_GPIO_Initialize();
for (i = 0; NX_GPIO_GetNumberOfModule() > i; i++) {
NX_GPIO_SetBaseAddress(i, (void*)IO_ADDRESS(NX_GPIO_GetPhysicalAddress(i)));
NX_GPIO_OpenModule(i);
}
NX_ALIVE_Initialize();
NX_ALIVE_SetBaseAddress((void*)IO_ADDRESS(NX_ALIVE_GetPhysicalAddress()));
NX_ALIVE_OpenModule();
NX_CLKPWR_Initialize();
NX_CLKPWR_SetBaseAddress((void*)IO_ADDRESS(NX_CLKPWR_GetPhysicalAddress()));
NX_CLKPWR_OpenModule();
/*
* NOTE> ALIVE Power Gate must enable for RTC register access.
* must be clear wfi jump address
*/
NX_ALIVE_SetWriteEnable(CTRUE);
__raw_writel(0xFFFFFFFF, SCR_ARM_SECOND_BOOT);
// write 0xf0 on alive scratchpad reg for boot success check
NX_ALIVE_SetScratchReg(NX_ALIVE_GetScratchReg() | 0xF0);
NX_WDT_Initialize();
NX_WDT_SetBaseAddress(0, (void*)IO_ADDRESS(NX_WDT_GetPhysicalAddress(0)));
NX_WDT_OpenModule(0);
// watchdog disable
if (NX_WDT_GetEnable(0)) {
NX_WDT_SetEnable(0, CFALSE);
NX_WDT_SetResetEnable(0, CFALSE);
NX_WDT_ClearInterruptPending(0, NX_WDT_GetInterruptNumber(0));
}
}
int bd_eth_init(void)
{
#if defined(CONFIG_DESIGNWARE_ETH)
u32 addr;
// Clock control
NX_CLKGEN_Initialize();
addr = NX_CLKGEN_GetPhysicalAddress(CLOCKINDEX_OF_DWC_GMAC_MODULE);
NX_CLKGEN_SetBaseAddress( CLOCKINDEX_OF_DWC_GMAC_MODULE, (u32)IO_ADDRESS(addr) );
NX_CLKGEN_SetClockSource( CLOCKINDEX_OF_DWC_GMAC_MODULE, 0, 4); // Sync mode for 100 & 10Base-T : External RX_clk
NX_CLKGEN_SetClockDivisor( CLOCKINDEX_OF_DWC_GMAC_MODULE, 0, 1); // Sync mode for 100 & 10Base-T
NX_CLKGEN_SetClockOutInv( CLOCKINDEX_OF_DWC_GMAC_MODULE, 0, CFALSE); // TX Clk invert off : 100 & 10Base-T
// NX_CLKGEN_SetClockOutInv( CLOCKINDEX_OF_DWC_GMAC_MODULE, 0, CTRUE); // TX clk invert on : 100 & 10Base-T
NX_CLKGEN_SetClockDivisorEnable( CLOCKINDEX_OF_DWC_GMAC_MODULE, CTRUE);
// Reset control
NX_RSTCON_Initialize();
addr = NX_RSTCON_GetPhysicalAddress();
NX_RSTCON_SetBaseAddress( (u32)IO_ADDRESS(addr) );
NX_RSTCON_SetnRST(RESETINDEX_OF_DWC_GMAC_MODULE_aresetn_i, RSTCON_ENABLE);
udelay(100);
NX_RSTCON_SetnRST(RESETINDEX_OF_DWC_GMAC_MODULE_aresetn_i, RSTCON_DISABLE);
udelay(100);
NX_RSTCON_SetnRST(RESETINDEX_OF_DWC_GMAC_MODULE_aresetn_i, RSTCON_ENABLE);
udelay(100);
// Set interrupt config.
//nxp_gpio_set_pull_sel(CFG_ETHER_GMAC_PHY_IRQ_NUM, CTRUE);
//nxp_gpio_set_pull_enb(CFG_ETHER_GMAC_PHY_IRQ_NUM, CTRUE);
gpio_direction_input(CFG_ETHER_GMAC_PHY_IRQ_NUM);
// Set GPIO nReset
//nxp_gpio_set_pull_enb(CFG_ETHER_GMAC_PHY_RST_NUM, CFALSE);
gpio_direction_output(CFG_ETHER_GMAC_PHY_RST_NUM, 1 );
udelay( 100 );
gpio_set_value(CFG_ETHER_GMAC_PHY_RST_NUM, 0 );
udelay( 100 );
gpio_set_value(CFG_ETHER_GMAC_PHY_RST_NUM, 1 );
#endif // #if defined(CONFIG_DESIGNWARE_ETH)
return 0;
}
static void cpu_base_init(void)
{
U32 tie_reg, val;
int i = 0;
NX_RSTCON_Initialize();
NX_RSTCON_SetBaseAddress((void*)IO_ADDRESS(NX_RSTCON_GetPhysicalAddress()));
NX_TIEOFF_Initialize();
NX_TIEOFF_SetBaseAddress((void*)IO_ADDRESS(NX_TIEOFF_GetPhysicalAddress()));
NX_CLKGEN_Initialize();
for (i = 0; NX_CLKGEN_GetNumberOfModule() > i; i++)
NX_CLKGEN_SetBaseAddress(i, (void*)IO_ADDRESS(NX_CLKGEN_GetPhysicalAddress(i)));
NX_GPIO_Initialize();
for (i = 0; NX_GPIO_GetNumberOfModule() > i; i++) {
NX_GPIO_SetBaseAddress(i, (void*)IO_ADDRESS(NX_GPIO_GetPhysicalAddress(i)));
NX_GPIO_OpenModule(i);
}
NX_ALIVE_Initialize();
NX_ALIVE_SetBaseAddress((void*)IO_ADDRESS(NX_ALIVE_GetPhysicalAddress()));
NX_ALIVE_OpenModule();
NX_CLKPWR_Initialize();
NX_CLKPWR_SetBaseAddress((void*)IO_ADDRESS(NX_CLKPWR_GetPhysicalAddress()));
NX_CLKPWR_OpenModule();
/*
* NOTE> ALIVE Power Gate must enable for RTC register access.
* must be clear wfi jump address
*/
NX_ALIVE_SetWriteEnable(CTRUE);
__raw_writel(0xFFFFFFFF, SCR_ARM_SECOND_BOOT);
/*
* NOTE> Control for ACP register access.
*/
tie_reg = (U32)IO_ADDRESS(NX_TIEOFF_GetPhysicalAddress());
val = __raw_readl(tie_reg + 0x70) & ~((3 << 30) | (3 << 10));
writel(val, (tie_reg + 0X70));
val = __raw_readl(tie_reg + 0x80) & ~(3 << 3);
writel(val, (tie_reg + 0x80));
/* add by cym 20150811 */
#ifdef CONFIG_MACH_S5P6818
/* end add */
// write 0xf0 on alive scratchpad reg for boot success check
NX_ALIVE_SetScratchReg(NX_ALIVE_GetScratchReg() | 0xF0);
NX_WDT_Initialize();
NX_WDT_SetBaseAddress(0, (void*)IO_ADDRESS(NX_WDT_GetPhysicalAddress(0)));
NX_WDT_OpenModule(0);
// watchdog disable
if (NX_WDT_GetEnable(0)) {
NX_WDT_SetEnable(0, CFALSE);
NX_WDT_SetResetEnable(0, CFALSE);
NX_WDT_ClearInterruptPending(0, NX_WDT_GetInterruptNumber(0));
}
/* add by cym 20150811 */
#endif
/* end add */
}