[people/ms/u-boot.git] / arch / arm / cpu / armv7 / omap3 / board.c

/*
 *
 * Common board functions for OMAP3 based boards.
 *
 * (C) Copyright 2004-2008
 * Texas Instruments, <www.ti.com>
 *
 * Author :
 *      Sunil Kumar <sunilsaini05@gmail.com>
 *      Shashi Ranjan <shashiranjanmca05@gmail.com>
 *
 * Derived from Beagle Board and 3430 SDP code by
 *      Richard Woodruff <r-woodruff2@ti.com>
 *      Syed Mohammed Khasim <khasim@ti.com>
 *
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */
#include <common.h>
#include <spl.h>
#include <asm/io.h>
#include <asm/arch/sys_proto.h>
#include <asm/arch/mem.h>
#include <asm/cache.h>
#include <asm/armv7.h>
#include <asm/arch/gpio.h>
#include <asm/omap_common.h>
#include <asm/arch/mmc_host_def.h>
#include <i2c.h>
#include <linux/compiler.h>

DECLARE_GLOBAL_DATA_PTR;

/* Declarations */
extern omap3_sysinfo sysinfo;
static void omap3_setup_aux_cr(void);
static void omap3_invalidate_l2_cache_secure(void);

static const struct gpio_bank gpio_bank_34xx[6] = {
	{ (void *)OMAP34XX_GPIO1_BASE, METHOD_GPIO_24XX },
	{ (void *)OMAP34XX_GPIO2_BASE, METHOD_GPIO_24XX },
	{ (void *)OMAP34XX_GPIO3_BASE, METHOD_GPIO_24XX },
	{ (void *)OMAP34XX_GPIO4_BASE, METHOD_GPIO_24XX },
	{ (void *)OMAP34XX_GPIO5_BASE, METHOD_GPIO_24XX },
	{ (void *)OMAP34XX_GPIO6_BASE, METHOD_GPIO_24XX },
};

const struct gpio_bank *const omap_gpio_bank = gpio_bank_34xx;

#ifdef CONFIG_SPL_BUILD
/*
* We use static variables because global data is not ready yet.
* Initialized data is available in SPL right from the beginning.
* We would not typically need to save these parameters in regular
* U-Boot. This is needed only in SPL at the moment.
*/
u32 omap3_boot_device = BOOT_DEVICE_NAND;

/* auto boot mode detection is not possible for OMAP3 - hard code */
u32 spl_boot_mode(void)
{
	switch (spl_boot_device()) {
	case BOOT_DEVICE_MMC2:
		return MMCSD_MODE_RAW;
	case BOOT_DEVICE_MMC1:
		return MMCSD_MODE_FAT;
		break;
	default:
		puts("spl: ERROR:  unknown device - can't select boot mode\n");
		hang();
	}
}

u32 spl_boot_device(void)
{
	return omap3_boot_device;
}

int board_mmc_init(bd_t *bis)
{
	switch (spl_boot_device()) {
	case BOOT_DEVICE_MMC1:
		omap_mmc_init(0, 0, 0);
		break;
	case BOOT_DEVICE_MMC2:
	case BOOT_DEVICE_MMC2_2:
		omap_mmc_init(1, 0, 0);
		break;
	}
	return 0;
}

void spl_board_init(void)
{
#ifdef CONFIG_SPL_NAND_SUPPORT
	gpmc_init();
#endif
#ifdef CONFIG_SPL_I2C_SUPPORT
	i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
#endif
}
#endif /* CONFIG_SPL_BUILD */


/******************************************************************************
 * Routine: secure_unlock
 * Description: Setup security registers for access
 *              (GP Device only)
 *****************************************************************************/
void secure_unlock_mem(void)
{
	struct pm *pm_rt_ape_base = (struct pm *)PM_RT_APE_BASE_ADDR_ARM;
	struct pm *pm_gpmc_base = (struct pm *)PM_GPMC_BASE_ADDR_ARM;
	struct pm *pm_ocm_ram_base = (struct pm *)PM_OCM_RAM_BASE_ADDR_ARM;
	struct pm *pm_iva2_base = (struct pm *)PM_IVA2_BASE_ADDR_ARM;
	struct sms *sms_base = (struct sms *)OMAP34XX_SMS_BASE;

	/* Protection Module Register Target APE (PM_RT) */
	writel(UNLOCK_1, &pm_rt_ape_base->req_info_permission_1);
	writel(UNLOCK_1, &pm_rt_ape_base->read_permission_0);
	writel(UNLOCK_1, &pm_rt_ape_base->wirte_permission_0);
	writel(UNLOCK_2, &pm_rt_ape_base->addr_match_1);

	writel(UNLOCK_3, &pm_gpmc_base->req_info_permission_0);
	writel(UNLOCK_3, &pm_gpmc_base->read_permission_0);
	writel(UNLOCK_3, &pm_gpmc_base->wirte_permission_0);

	writel(UNLOCK_3, &pm_ocm_ram_base->req_info_permission_0);
	writel(UNLOCK_3, &pm_ocm_ram_base->read_permission_0);
	writel(UNLOCK_3, &pm_ocm_ram_base->wirte_permission_0);
	writel(UNLOCK_2, &pm_ocm_ram_base->addr_match_2);

	/* IVA Changes */
	writel(UNLOCK_3, &pm_iva2_base->req_info_permission_0);
	writel(UNLOCK_3, &pm_iva2_base->read_permission_0);
	writel(UNLOCK_3, &pm_iva2_base->wirte_permission_0);

	/* SDRC region 0 public */
	writel(UNLOCK_1, &sms_base->rg_att0);
}

/******************************************************************************
 * Routine: secureworld_exit()
 * Description: If chip is EMU and boot type is external
 *		configure secure registers and exit secure world
 *              general use.
 *****************************************************************************/
void secureworld_exit()
{
	unsigned long i;

	/* configure non-secure access control register */
	__asm__ __volatile__("mrc p15, 0, %0, c1, c1, 2":"=r"(i));
	/* enabling co-processor CP10 and CP11 accesses in NS world */
	__asm__ __volatile__("orr %0, %0, #0xC00":"=r"(i));
	/*
	 * allow allocation of locked TLBs and L2 lines in NS world
	 * allow use of PLE registers in NS world also
	 */
	__asm__ __volatile__("orr %0, %0, #0x70000":"=r"(i));
	__asm__ __volatile__("mcr p15, 0, %0, c1, c1, 2":"=r"(i));

	/* Enable ASA in ACR register */
	__asm__ __volatile__("mrc p15, 0, %0, c1, c0, 1":"=r"(i));
	__asm__ __volatile__("orr %0, %0, #0x10":"=r"(i));
	__asm__ __volatile__("mcr p15, 0, %0, c1, c0, 1":"=r"(i));

	/* Exiting secure world */
	__asm__ __volatile__("mrc p15, 0, %0, c1, c1, 0":"=r"(i));
	__asm__ __volatile__("orr %0, %0, #0x31":"=r"(i));
	__asm__ __volatile__("mcr p15, 0, %0, c1, c1, 0":"=r"(i));
}

/******************************************************************************
 * Routine: try_unlock_sram()
 * Description: If chip is GP/EMU(special) type, unlock the SRAM for
 *              general use.
 *****************************************************************************/
void try_unlock_memory()
{
	int mode;
	int in_sdram = is_running_in_sdram();

	/*
	 * if GP device unlock device SRAM for general use
	 * secure code breaks for Secure/Emulation device - HS/E/T
	 */
	mode = get_device_type();
	if (mode == GP_DEVICE)
		secure_unlock_mem();

	/*
	 * If device is EMU and boot is XIP external booting
	 * Unlock firewalls and disable L2 and put chip
	 * out of secure world
	 *
	 * Assuming memories are unlocked by the demon who put us in SDRAM
	 */
	if ((mode <= EMU_DEVICE) && (get_boot_type() == 0x1F)
	    && (!in_sdram)) {
		secure_unlock_mem();
		secureworld_exit();
	}

	return;
}

/******************************************************************************
 * Routine: s_init
 * Description: Does early system init of muxing and clocks.
 *              - Called path is with SRAM stack.
 *****************************************************************************/
void s_init(void)
{
	int in_sdram = is_running_in_sdram();

	watchdog_init();

	try_unlock_memory();

	/* Errata workarounds */
	omap3_setup_aux_cr();

#ifndef CONFIG_SYS_L2CACHE_OFF
	/* Invalidate L2-cache from secure mode */
	omap3_invalidate_l2_cache_secure();
#endif

	set_muxconf_regs();
	sdelay(100);

	prcm_init();

	per_clocks_enable();

#ifdef CONFIG_USB_EHCI_OMAP
	ehci_clocks_enable();
#endif

#ifdef CONFIG_SPL_BUILD
	gd = &gdata;

	preloader_console_init();

	timer_init();
#endif

	if (!in_sdram)
		mem_init();
}

/*
 * Routine: misc_init_r
 * Description: A basic misc_init_r that just displays the die ID
 */
int __weak misc_init_r(void)
{
	dieid_num_r();

	return 0;
}

/******************************************************************************
 * Routine: wait_for_command_complete
 * Description: Wait for posting to finish on watchdog
 *****************************************************************************/
void wait_for_command_complete(struct watchdog *wd_base)
{
	int pending = 1;
	do {
		pending = readl(&wd_base->wwps);
	} while (pending);
}

/******************************************************************************
 * Routine: watchdog_init
 * Description: Shut down watch dogs
 *****************************************************************************/
void watchdog_init(void)
{
	struct watchdog *wd2_base = (struct watchdog *)WD2_BASE;
	struct prcm *prcm_base = (struct prcm *)PRCM_BASE;

	/*
	 * There are 3 watch dogs WD1=Secure, WD2=MPU, WD3=IVA. WD1 is
	 * either taken care of by ROM (HS/EMU) or not accessible (GP).
	 * We need to take care of WD2-MPU or take a PRCM reset. WD3
	 * should not be running and does not generate a PRCM reset.
	 */

	sr32(&prcm_base->fclken_wkup, 5, 1, 1);
	sr32(&prcm_base->iclken_wkup, 5, 1, 1);
	wait_on_value(ST_WDT2, 0x20, &prcm_base->idlest_wkup, 5);

	writel(WD_UNLOCK1, &wd2_base->wspr);
	wait_for_command_complete(wd2_base);
	writel(WD_UNLOCK2, &wd2_base->wspr);
}

/******************************************************************************
 * Dummy function to handle errors for EABI incompatibility
 *****************************************************************************/
void abort(void)
{
}

#if defined(CONFIG_NAND_OMAP_GPMC) & !defined(CONFIG_SPL_BUILD)
/******************************************************************************
 * OMAP3 specific command to switch between NAND HW and SW ecc
 *****************************************************************************/
static int do_switch_ecc(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
{
	if (argc != 2)
		goto usage;
	if (strncmp(argv[1], "hw", 2) == 0)
		omap_nand_switch_ecc(1);
	else if (strncmp(argv[1], "sw", 2) == 0)
		omap_nand_switch_ecc(0);
	else
		goto usage;

	return 0;

usage:
	printf ("Usage: nandecc %s\n", cmdtp->usage);
	return 1;
}

U_BOOT_CMD(
	nandecc, 2, 1,	do_switch_ecc,
	"switch OMAP3 NAND ECC calculation algorithm",
	"[hw/sw] - Switch between NAND hardware (hw) or software (sw) ecc algorithm"
);

#endif /* CONFIG_NAND_OMAP_GPMC & !CONFIG_SPL_BUILD */

#ifdef CONFIG_DISPLAY_BOARDINFO
/**
 * Print board information
 */
int checkboard (void)
{
	char *mem_s ;

	if (is_mem_sdr())
		mem_s = "mSDR";
	else
		mem_s = "LPDDR";

	printf("%s + %s/%s\n", sysinfo.board_string, mem_s,
			sysinfo.nand_string);

	return 0;
}
#endif	/* CONFIG_DISPLAY_BOARDINFO */

static void omap3_emu_romcode_call(u32 service_id, u32 *parameters)
{
	u32 i, num_params = *parameters;
	u32 *sram_scratch_space = (u32 *)OMAP3_PUBLIC_SRAM_SCRATCH_AREA;

	/*
	 * copy the parameters to an un-cached area to avoid coherency
	 * issues
	 */
	for (i = 0; i < num_params; i++) {
		__raw_writel(*parameters, sram_scratch_space);
		parameters++;
		sram_scratch_space++;
	}

	/* Now make the PPA call */
	do_omap3_emu_romcode_call(service_id, OMAP3_PUBLIC_SRAM_SCRATCH_AREA);
}

static void omap3_update_aux_cr_secure(u32 set_bits, u32 clear_bits)
{
	u32 acr;

	/* Read ACR */
	asm volatile ("mrc p15, 0, %0, c1, c0, 1" : "=r" (acr));
	acr &= ~clear_bits;
	acr |= set_bits;

	if (get_device_type() == GP_DEVICE) {
		omap3_gp_romcode_call(OMAP3_GP_ROMCODE_API_WRITE_ACR,
				       acr);
	} else {
		struct emu_hal_params emu_romcode_params;
		emu_romcode_params.num_params = 1;
		emu_romcode_params.param1 = acr;
		omap3_emu_romcode_call(OMAP3_EMU_HAL_API_WRITE_ACR,
				       (u32 *)&emu_romcode_params);
	}
}

static void omap3_update_aux_cr(u32 set_bits, u32 clear_bits)
{
	u32 acr;

	/* Read ACR */
	asm volatile ("mrc p15, 0, %0, c1, c0, 1" : "=r" (acr));
	acr &= ~clear_bits;
	acr |= set_bits;

	/* Write ACR - affects non-secure banked bits */
	asm volatile ("mcr p15, 0, %0, c1, c0, 1" : : "r" (acr));
}

static void omap3_setup_aux_cr(void)
{
	/* Workaround for Cortex-A8 errata: #454179 #430973
	 *	Set "IBE" bit
	 *	Set "Disable Branch Size Mispredicts" bit
	 * Workaround for erratum #621766
	 *	Enable L1NEON bit
	 * ACR |= (IBE | DBSM | L1NEON) => ACR |= 0xE0
	 */
	omap3_update_aux_cr_secure(0xE0, 0);
}

#ifndef CONFIG_SYS_L2CACHE_OFF
/* Invalidate the entire L2 cache from secure mode */
static void omap3_invalidate_l2_cache_secure(void)
{
	if (get_device_type() == GP_DEVICE) {
		omap3_gp_romcode_call(OMAP3_GP_ROMCODE_API_L2_INVAL,
				      0);
	} else {
		struct emu_hal_params emu_romcode_params;
		emu_romcode_params.num_params = 1;
		emu_romcode_params.param1 = 0;
		omap3_emu_romcode_call(OMAP3_EMU_HAL_API_L2_INVAL,
				       (u32 *)&emu_romcode_params);
	}
}

void v7_outer_cache_enable(void)
{
	/* Set L2EN */
	omap3_update_aux_cr_secure(0x2, 0);

	/*
	 * On some revisions L2EN bit is banked on some revisions it's not
	 * No harm in setting both banked bits(in fact this is required
	 * by an erratum)
	 */
	omap3_update_aux_cr(0x2, 0);
}

void omap3_outer_cache_disable(void)
{
	/* Clear L2EN */
	omap3_update_aux_cr_secure(0, 0x2);

	/*
	 * On some revisions L2EN bit is banked on some revisions it's not
	 * No harm in clearing both banked bits(in fact this is required
	 * by an erratum)
	 */
	omap3_update_aux_cr(0, 0x2);
}
#endif

#ifndef CONFIG_SYS_DCACHE_OFF
void enable_caches(void)
{
	/* Enable D-cache. I-cache is already enabled in start.S */
	dcache_enable();
}
#endif
Commit	Line	Data
91eee546 DB	1	/*
	2	*
	3	* Common board functions for OMAP3 based boards.
	4	*
	5	* (C) Copyright 2004-2008
	6	* Texas Instruments, <www.ti.com>
	7	*
	8	* Author :
	9	* Sunil Kumar <sunilsaini05@gmail.com>
	10	* Shashi Ranjan <shashiranjanmca05@gmail.com>
	11	*
	12	* Derived from Beagle Board and 3430 SDP code by
	13	* Richard Woodruff <r-woodruff2@ti.com>
	14	* Syed Mohammed Khasim <khasim@ti.com>
	15	*
	16	*
	17	* See file CREDITS for list of people who contributed to this
	18	* project.
	19	*
	20	* This program is free software; you can redistribute it and/or
	21	* modify it under the terms of the GNU General Public License as
	22	* published by the Free Software Foundation; either version 2 of
	23	* the License, or (at your option) any later version.
	24	*
	25	* This program is distributed in the hope that it will be useful,
	26	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	27	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	28	* GNU General Public License for more details.
	29	*
	30	* You should have received a copy of the GNU General Public License
	31	* along with this program; if not, write to the Free Software
	32	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	33	* MA 02111-1307 USA
	34	*/
	35	#include <common.h>
47f7bcae	36	#include <spl.h>
91eee546 DB	37	#include <asm/io.h>
	38	#include <asm/arch/sys_proto.h>
	39	#include <asm/arch/mem.h>
06e758e7	40	#include <asm/cache.h>
45bf0585	41	#include <asm/armv7.h>
080a46ea	42	#include <asm/arch/gpio.h>
bb085b87	43	#include <asm/omap_common.h>
f0881250	44	#include <asm/arch/mmc_host_def.h>
ee08a826	45	#include <i2c.h>
8a87a3d7	46	#include <linux/compiler.h>
91eee546	47
6507f133 TR	48	DECLARE_GLOBAL_DATA_PTR;
6507f133 TR	49
45bf0585	50	/* Declarations */
91eee546	51	extern omap3_sysinfo sysinfo;
45bf0585 A	52	static void omap3_setup_aux_cr(void);
45bf0585 A	53	static void omap3_invalidate_l2_cache_secure(void);
91eee546	54
25223a68 A	55	static const struct gpio_bank gpio_bank_34xx[6] = {
	56	{ (void *)OMAP34XX_GPIO1_BASE, METHOD_GPIO_24XX },
	57	{ (void *)OMAP34XX_GPIO2_BASE, METHOD_GPIO_24XX },
	58	{ (void *)OMAP34XX_GPIO3_BASE, METHOD_GPIO_24XX },
	59	{ (void *)OMAP34XX_GPIO4_BASE, METHOD_GPIO_24XX },
	60	{ (void *)OMAP34XX_GPIO5_BASE, METHOD_GPIO_24XX },
	61	{ (void *)OMAP34XX_GPIO6_BASE, METHOD_GPIO_24XX },
	62	};
	63
	64	const struct gpio_bank *const omap_gpio_bank = gpio_bank_34xx;
	65
bb085b87 SS	66	#ifdef CONFIG_SPL_BUILD
	67	/*
	68	* We use static variables because global data is not ready yet.
	69	* Initialized data is available in SPL right from the beginning.
	70	* We would not typically need to save these parameters in regular
	71	* U-Boot. This is needed only in SPL at the moment.
	72	*/
	73	u32 omap3_boot_device = BOOT_DEVICE_NAND;
	74
	75	/* auto boot mode detection is not possible for OMAP3 - hard code */
37189a19	76	u32 spl_boot_mode(void)
bb085b87	77	{
8e1b836e	78	switch (spl_boot_device()) {
bb085b87 SS	79	case BOOT_DEVICE_MMC2:
	80	return MMCSD_MODE_RAW;
	81	case BOOT_DEVICE_MMC1:
	82	return MMCSD_MODE_FAT;
	83	break;
bb085b87 SS	84	default:
	85	puts("spl: ERROR: unknown device - can't select boot mode\n");
	86	hang();
	87	}
	88	}
	89
8e1b836e	90	u32 spl_boot_device(void)
bb085b87 SS	91	{
	92	return omap3_boot_device;
	93	}
	94
f0881250 TR	95	int board_mmc_init(bd_t *bis)
	96	{
	97	switch (spl_boot_device()) {
	98	case BOOT_DEVICE_MMC1:
	99	omap_mmc_init(0, 0, 0);
	100	break;
	101	case BOOT_DEVICE_MMC2:
	102	case BOOT_DEVICE_MMC2_2:
	103	omap_mmc_init(1, 0, 0);
	104	break;
	105	}
	106	return 0;
	107	}
	108
ee08a826 TR	109	void spl_board_init(void)
ee08a826 TR	110	{
d7cb93b2 TR	111	#ifdef CONFIG_SPL_NAND_SUPPORT
	112	gpmc_init();
	113	#endif
da521387	114	#ifdef CONFIG_SPL_I2C_SUPPORT
ee08a826	115	i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
da521387	116	#endif
ee08a826	117	}
bb085b87 SS	118	#endif /* CONFIG_SPL_BUILD */
	119
	120
91eee546 DB	121	/******************************************************************************
	122	* Routine: secure_unlock
	123	* Description: Setup security registers for access
	124	* (GP Device only)
	125	*****************************************************************************/
	126	void secure_unlock_mem(void)
	127	{
97a099ea DB	128	struct pm pm_rt_ape_base = (struct pm )PM_RT_APE_BASE_ADDR_ARM;
	129	struct pm pm_gpmc_base = (struct pm )PM_GPMC_BASE_ADDR_ARM;
	130	struct pm pm_ocm_ram_base = (struct pm )PM_OCM_RAM_BASE_ADDR_ARM;
	131	struct pm pm_iva2_base = (struct pm )PM_IVA2_BASE_ADDR_ARM;
	132	struct sms sms_base = (struct sms )OMAP34XX_SMS_BASE;
91eee546 DB	133
	134	/* Protection Module Register Target APE (PM_RT) */
	135	writel(UNLOCK_1, &pm_rt_ape_base->req_info_permission_1);
	136	writel(UNLOCK_1, &pm_rt_ape_base->read_permission_0);
	137	writel(UNLOCK_1, &pm_rt_ape_base->wirte_permission_0);
	138	writel(UNLOCK_2, &pm_rt_ape_base->addr_match_1);
	139
	140	writel(UNLOCK_3, &pm_gpmc_base->req_info_permission_0);
	141	writel(UNLOCK_3, &pm_gpmc_base->read_permission_0);
	142	writel(UNLOCK_3, &pm_gpmc_base->wirte_permission_0);
	143
	144	writel(UNLOCK_3, &pm_ocm_ram_base->req_info_permission_0);
	145	writel(UNLOCK_3, &pm_ocm_ram_base->read_permission_0);
	146	writel(UNLOCK_3, &pm_ocm_ram_base->wirte_permission_0);
	147	writel(UNLOCK_2, &pm_ocm_ram_base->addr_match_2);
	148
	149	/* IVA Changes */
	150	writel(UNLOCK_3, &pm_iva2_base->req_info_permission_0);
	151	writel(UNLOCK_3, &pm_iva2_base->read_permission_0);
	152	writel(UNLOCK_3, &pm_iva2_base->wirte_permission_0);
	153
	154	/* SDRC region 0 public */
	155	writel(UNLOCK_1, &sms_base->rg_att0);
	156	}
	157
	158	/******************************************************************************
	159	* Routine: secureworld_exit()
	160	* Description: If chip is EMU and boot type is external
	161	* configure secure registers and exit secure world
	162	* general use.
	163	*****************************************************************************/
	164	void secureworld_exit()
	165	{
	166	unsigned long i;
	167
a4958313	168	/* configure non-secure access control register */
91eee546 DB	169	__asm__ __volatile__("mrc p15, 0, %0, c1, c1, 2":"=r"(i));
	170	/* enabling co-processor CP10 and CP11 accesses in NS world */
	171	__asm__ __volatile__("orr %0, %0, #0xC00":"=r"(i));
	172	/*
	173	* allow allocation of locked TLBs and L2 lines in NS world
	174	* allow use of PLE registers in NS world also
	175	*/
	176	__asm__ __volatile__("orr %0, %0, #0x70000":"=r"(i));
	177	__asm__ __volatile__("mcr p15, 0, %0, c1, c1, 2":"=r"(i));
	178
	179	/* Enable ASA in ACR register */
	180	__asm__ __volatile__("mrc p15, 0, %0, c1, c0, 1":"=r"(i));
	181	__asm__ __volatile__("orr %0, %0, #0x10":"=r"(i));
	182	__asm__ __volatile__("mcr p15, 0, %0, c1, c0, 1":"=r"(i));
	183
	184	/* Exiting secure world */
	185	__asm__ __volatile__("mrc p15, 0, %0, c1, c1, 0":"=r"(i));
	186	__asm__ __volatile__("orr %0, %0, #0x31":"=r"(i));
	187	__asm__ __volatile__("mcr p15, 0, %0, c1, c1, 0":"=r"(i));
	188	}
	189
91eee546 DB	190	/******************************************************************************
	191	* Routine: try_unlock_sram()
	192	* Description: If chip is GP/EMU(special) type, unlock the SRAM for
	193	* general use.
	194	*****************************************************************************/
	195	void try_unlock_memory()
	196	{
	197	int mode;
	198	int in_sdram = is_running_in_sdram();
	199
	200	/*
	201	* if GP device unlock device SRAM for general use
	202	* secure code breaks for Secure/Emulation device - HS/E/T
	203	*/
	204	mode = get_device_type();
	205	if (mode == GP_DEVICE)
	206	secure_unlock_mem();
	207
	208	/*
	209	* If device is EMU and boot is XIP external booting
	210	* Unlock firewalls and disable L2 and put chip
	211	* out of secure world
	212	*
	213	* Assuming memories are unlocked by the demon who put us in SDRAM
	214	*/
	215	if ((mode <= EMU_DEVICE) && (get_boot_type() == 0x1F)
	216	&& (!in_sdram)) {
	217	secure_unlock_mem();
	218	secureworld_exit();
	219	}
	220
	221	return;
	222	}
	223
	224	/******************************************************************************
	225	* Routine: s_init
	226	* Description: Does early system init of muxing and clocks.
	227	* - Called path is with SRAM stack.
	228	*****************************************************************************/
	229	void s_init(void)
	230	{
	231	int in_sdram = is_running_in_sdram();
	232
	233	watchdog_init();
	234
	235	try_unlock_memory();
	236
45bf0585 A	237	/* Errata workarounds */
45bf0585 A	238	omap3_setup_aux_cr();
91eee546	239
45bf0585 A	240	#ifndef CONFIG_SYS_L2CACHE_OFF
	241	/* Invalidate L2-cache from secure mode */
	242	omap3_invalidate_l2_cache_secure();
91eee546	243	#endif
91eee546 DB	244
91eee546 DB	245	set_muxconf_regs();
86623add	246	sdelay(100);
91eee546 DB	247
	248	prcm_init();
	249
	250	per_clocks_enable();
	251
95f87910 G	252	#ifdef CONFIG_USB_EHCI_OMAP
	253	ehci_clocks_enable();
	254	#endif
	255
bb085b87	256	#ifdef CONFIG_SPL_BUILD
6507f133 TR	257	gd = &gdata;
6507f133 TR	258
bb085b87	259	preloader_console_init();
8775471b AM	260
8775471b AM	261	timer_init();
bb085b87 SS	262	#endif
bb085b87 SS	263
91eee546	264	if (!in_sdram)
cae377b5	265	mem_init();
91eee546 DB	266	}
91eee546 DB	267
8a87a3d7 TR	268	/*
	269	* Routine: misc_init_r
	270	* Description: A basic misc_init_r that just displays the die ID
	271	*/
	272	int __weak misc_init_r(void)
	273	{
	274	dieid_num_r();
	275
	276	return 0;
	277	}
	278
91eee546 DB	279	/******************************************************************************
	280	* Routine: wait_for_command_complete
	281	* Description: Wait for posting to finish on watchdog
	282	*****************************************************************************/
97a099ea	283	void wait_for_command_complete(struct watchdog *wd_base)
91eee546 DB	284	{
	285	int pending = 1;
	286	do {
	287	pending = readl(&wd_base->wwps);
	288	} while (pending);
	289	}
	290
	291	/******************************************************************************
	292	* Routine: watchdog_init
	293	* Description: Shut down watch dogs
	294	*****************************************************************************/
	295	void watchdog_init(void)
	296	{
97a099ea DB	297	struct watchdog wd2_base = (struct watchdog )WD2_BASE;
97a099ea DB	298	struct prcm prcm_base = (struct prcm )PRCM_BASE;
91eee546 DB	299
	300	/*
	301	* There are 3 watch dogs WD1=Secure, WD2=MPU, WD3=IVA. WD1 is
	302	* either taken care of by ROM (HS/EMU) or not accessible (GP).
	303	* We need to take care of WD2-MPU or take a PRCM reset. WD3
	304	* should not be running and does not generate a PRCM reset.
	305	*/
	306
	307	sr32(&prcm_base->fclken_wkup, 5, 1, 1);
	308	sr32(&prcm_base->iclken_wkup, 5, 1, 1);
	309	wait_on_value(ST_WDT2, 0x20, &prcm_base->idlest_wkup, 5);
	310
	311	writel(WD_UNLOCK1, &wd2_base->wspr);
	312	wait_for_command_complete(wd2_base);
	313	writel(WD_UNLOCK2, &wd2_base->wspr);
	314	}
	315
91eee546 DB	316	/******************************************************************************
	317	* Dummy function to handle errors for EABI incompatibility
	318	*****************************************************************************/
	319	void abort(void)
	320	{
	321	}
	322
bb085b87	323	#if defined(CONFIG_NAND_OMAP_GPMC) & !defined(CONFIG_SPL_BUILD)
91eee546 DB	324	/******************************************************************************
	325	* OMAP3 specific command to switch between NAND HW and SW ecc
	326	*****************************************************************************/
54841ab5	327	static int do_switch_ecc(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
91eee546 DB	328	{
	329	if (argc != 2)
	330	goto usage;
	331	if (strncmp(argv[1], "hw", 2) == 0)
	332	omap_nand_switch_ecc(1);
	333	else if (strncmp(argv[1], "sw", 2) == 0)
	334	omap_nand_switch_ecc(0);
	335	else
	336	goto usage;
	337
	338	return 0;
	339
	340	usage:
36003268	341	printf ("Usage: nandecc %s\n", cmdtp->usage);
91eee546 DB	342	return 1;
	343	}
	344
	345	U_BOOT_CMD(
	346	nandecc, 2, 1, do_switch_ecc,
a93c92cd	347	"switch OMAP3 NAND ECC calculation algorithm",
a89c33db WD	348	"[hw/sw] - Switch between NAND hardware (hw) or software (sw) ecc algorithm"
a89c33db WD	349	);
91eee546	350
bb085b87	351	#endif /* CONFIG_NAND_OMAP_GPMC & !CONFIG_SPL_BUILD */
6a6b62e3 SP	352
	353	#ifdef CONFIG_DISPLAY_BOARDINFO
	354	/**
	355	* Print board information
	356	*/
	357	int checkboard (void)
	358	{
	359	char *mem_s ;
	360
	361	if (is_mem_sdr())
	362	mem_s = "mSDR";
	363	else
	364	mem_s = "LPDDR";
	365
	366	printf("%s + %s/%s\n", sysinfo.board_string, mem_s,
	367	sysinfo.nand_string);
	368
	369	return 0;
	370	}
	371	#endif /* CONFIG_DISPLAY_BOARDINFO */
45bf0585 A	372
	373	static void omap3_emu_romcode_call(u32 service_id, u32 *parameters)
	374	{
	375	u32 i, num_params = *parameters;
	376	u32 sram_scratch_space = (u32 )OMAP3_PUBLIC_SRAM_SCRATCH_AREA;
	377
	378	/*
	379	* copy the parameters to an un-cached area to avoid coherency
	380	* issues
	381	*/
	382	for (i = 0; i < num_params; i++) {
	383	__raw_writel(*parameters, sram_scratch_space);
	384	parameters++;
	385	sram_scratch_space++;
	386	}
	387
	388	/* Now make the PPA call */
	389	do_omap3_emu_romcode_call(service_id, OMAP3_PUBLIC_SRAM_SCRATCH_AREA);
	390	}
	391
	392	static void omap3_update_aux_cr_secure(u32 set_bits, u32 clear_bits)
	393	{
	394	u32 acr;
	395
	396	/* Read ACR */
	397	asm volatile ("mrc p15, 0, %0, c1, c0, 1" : "=r" (acr));
	398	acr &= ~clear_bits;
	399	acr \|= set_bits;
	400
	401	if (get_device_type() == GP_DEVICE) {
	402	omap3_gp_romcode_call(OMAP3_GP_ROMCODE_API_WRITE_ACR,
	403	acr);
	404	} else {
	405	struct emu_hal_params emu_romcode_params;
	406	emu_romcode_params.num_params = 1;
	407	emu_romcode_params.param1 = acr;
	408	omap3_emu_romcode_call(OMAP3_EMU_HAL_API_WRITE_ACR,
	409	(u32 *)&emu_romcode_params);
	410	}
	411	}
	412
	413	static void omap3_update_aux_cr(u32 set_bits, u32 clear_bits)
	414	{
	415	u32 acr;
	416
	417	/* Read ACR */
	418	asm volatile ("mrc p15, 0, %0, c1, c0, 1" : "=r" (acr));
	419	acr &= ~clear_bits;
	420	acr \|= set_bits;
	421
	422	/* Write ACR - affects non-secure banked bits */
	423	asm volatile ("mcr p15, 0, %0, c1, c0, 1" : : "r" (acr));
	424	}
	425
	426	static void omap3_setup_aux_cr(void)
	427	{
	428	/* Workaround for Cortex-A8 errata: #454179 #430973
	429	* Set "IBE" bit
a4958313	430	* Set "Disable Branch Size Mispredicts" bit
45bf0585 A	431	* Workaround for erratum #621766
	432	* Enable L1NEON bit
	433	* ACR \|= (IBE \| DBSM \| L1NEON) => ACR \|= 0xE0
	434	*/
	435	omap3_update_aux_cr_secure(0xE0, 0);
	436	}
	437
	438	#ifndef CONFIG_SYS_L2CACHE_OFF
	439	/* Invalidate the entire L2 cache from secure mode */
	440	static void omap3_invalidate_l2_cache_secure(void)
	441	{
	442	if (get_device_type() == GP_DEVICE) {
	443	omap3_gp_romcode_call(OMAP3_GP_ROMCODE_API_L2_INVAL,
	444	0);
	445	} else {
	446	struct emu_hal_params emu_romcode_params;
	447	emu_romcode_params.num_params = 1;
	448	emu_romcode_params.param1 = 0;
	449	omap3_emu_romcode_call(OMAP3_EMU_HAL_API_L2_INVAL,
	450	(u32 *)&emu_romcode_params);
	451	}
	452	}
	453
	454	void v7_outer_cache_enable(void)
	455	{
	456	/* Set L2EN */
	457	omap3_update_aux_cr_secure(0x2, 0);
	458
	459	/*
	460	* On some revisions L2EN bit is banked on some revisions it's not
	461	* No harm in setting both banked bits(in fact this is required
	462	* by an erratum)
	463	*/
	464	omap3_update_aux_cr(0x2, 0);
	465	}
	466
f1f2c3ca	467	void omap3_outer_cache_disable(void)
45bf0585 A	468	{
	469	/* Clear L2EN */
	470	omap3_update_aux_cr_secure(0, 0x2);
	471
	472	/*
	473	* On some revisions L2EN bit is banked on some revisions it's not
	474	* No harm in clearing both banked bits(in fact this is required
	475	* by an erratum)
	476	*/
	477	omap3_update_aux_cr(0, 0x2);
	478	}
	479	#endif
13d4f9bd A	480
	481	#ifndef CONFIG_SYS_DCACHE_OFF
	482	void enable_caches(void)
	483	{
	484	/* Enable D-cache. I-cache is already enabled in start.S */
	485	dcache_enable();
	486	}
	487	#endif