[people/ms/u-boot.git] / arch / arm / cpu / armv8 / zynqmp / spl.c

/*
 * Copyright 2015 - 2016 Xilinx, Inc.
 *
 * Michal Simek <michal.simek@xilinx.com>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <debug_uart.h>
#include <spl.h>

#include <asm/io.h>
#include <asm/spl.h>
#include <asm/arch/hardware.h>
#include <asm/arch/sys_proto.h>

void board_init_f(ulong dummy)
{
	psu_init();
	board_early_init_r();

#ifdef CONFIG_DEBUG_UART
	/* Uart debug for sure */
	debug_uart_init();
	puts("Debug uart enabled\n"); /* or printch() */
#endif
	/* Delay is required for clocks to be propagated */
	udelay(1000000);

	/* Clear the BSS */
	memset(__bss_start, 0, __bss_end - __bss_start);

	/* No need to call timer init - it is empty for ZynqMP */
	board_init_r(NULL, 0);
}

static void ps_mode_reset(ulong mode)
{
	writel(mode << ZYNQMP_CRL_APB_BOOT_PIN_CTRL_OUT_EN_SHIFT,
	       &crlapb_base->boot_pin_ctrl);
	udelay(5);
	writel(mode << ZYNQMP_CRL_APB_BOOT_PIN_CTRL_OUT_VAL_SHIFT |
	       mode << ZYNQMP_CRL_APB_BOOT_PIN_CTRL_OUT_EN_SHIFT,
	       &crlapb_base->boot_pin_ctrl);
}

/*
 * Set default PS_MODE1 which is used for USB ULPI phy reset
 * Also other resets can be connected to this certain pin
 */
#ifndef MODE_RESET
# define MODE_RESET	PS_MODE1
#endif

#ifdef CONFIG_SPL_BOARD_INIT
void spl_board_init(void)
{
	preloader_console_init();
	ps_mode_reset(MODE_RESET);
	board_init();
}
#endif

u32 spl_boot_device(void)
{
	u32 reg = 0;
	u8 bootmode;

#if defined(CONFIG_SPL_ZYNQMP_ALT_BOOTMODE_ENABLED)
	/* Change default boot mode at run-time */
	writel(CONFIG_SPL_ZYNQMP_ALT_BOOTMODE << BOOT_MODE_ALT_SHIFT,
	       &crlapb_base->boot_mode);
#endif

	reg = readl(&crlapb_base->boot_mode);
	if (reg >> BOOT_MODE_ALT_SHIFT)
		reg >>= BOOT_MODE_ALT_SHIFT;

	bootmode = reg & BOOT_MODES_MASK;

	switch (bootmode) {
	case JTAG_MODE:
		return BOOT_DEVICE_RAM;
#ifdef CONFIG_SPL_MMC_SUPPORT
	case SD1_LSHFT_MODE:
	case EMMC_MODE:
	case SD_MODE:
	case SD_MODE1:
		return BOOT_DEVICE_MMC1;
#endif
#ifdef CONFIG_SPL_DFU_SUPPORT
	case USB_MODE:
		return BOOT_DEVICE_DFU;
#endif
#ifdef CONFIG_SPL_SATA_SUPPORT
	case SW_SATA_MODE:
		return BOOT_DEVICE_SATA;
#endif
	default:
		printf("Invalid Boot Mode:0x%x\n", bootmode);
		break;
	}

	return 0;
}

u32 spl_boot_mode(const u32 boot_device)
{
	switch (spl_boot_device()) {
	case BOOT_DEVICE_RAM:
		return 0;
	case BOOT_DEVICE_MMC1:
		return MMCSD_MODE_FS;
	default:
		puts("spl: error: unsupported device\n");
		hang();
	}
}

__weak void psu_init(void)
{
	 /*
	  * This function is overridden by the one in
	  * board/xilinx/zynqmp/(platform)/psu_init_gpl.c, if it exists.
	  */
}

#ifdef CONFIG_SPL_OS_BOOT
int spl_start_uboot(void)
{
	handoff_setup();

	return 0;
}
#endif

#ifdef CONFIG_SPL_LOAD_FIT
int board_fit_config_name_match(const char *name)
{
	/* Just empty function now - can't decide what to choose */
	debug("%s: %s\n", __func__, name);

	return 0;
}
#endif
Commit	Line	Data
e6a9ed04 MS	1	/*
	2	* Copyright 2015 - 2016 Xilinx, Inc.
	3	*
	4	* Michal Simek <michal.simek@xilinx.com>
	5	*
	6	* SPDX-License-Identifier: GPL-2.0+
	7	*/
	8
	9	#include <common.h>
	10	#include <debug_uart.h>
	11	#include <spl.h>
	12
	13	#include <asm/io.h>
	14	#include <asm/spl.h>
	15	#include <asm/arch/hardware.h>
	16	#include <asm/arch/sys_proto.h>
	17
	18	void board_init_f(ulong dummy)
	19	{
	20	psu_init();
	21	board_early_init_r();
	22
	23	#ifdef CONFIG_DEBUG_UART
	24	/* Uart debug for sure */
	25	debug_uart_init();
	26	puts("Debug uart enabled\n"); /* or printch() */
	27	#endif
	28	/* Delay is required for clocks to be propagated */
	29	udelay(1000000);
	30
	31	/* Clear the BSS */
	32	memset(__bss_start, 0, __bss_end - __bss_start);
	33
	34	/* No need to call timer init - it is empty for ZynqMP */
	35	board_init_r(NULL, 0);
	36	}
	37
48255f52 MS	38	static void ps_mode_reset(ulong mode)
48255f52 MS	39	{
48255f52 MS	40	writel(mode << ZYNQMP_CRL_APB_BOOT_PIN_CTRL_OUT_EN_SHIFT,
	41	&crlapb_base->boot_pin_ctrl);
	42	udelay(5);
	43	writel(mode << ZYNQMP_CRL_APB_BOOT_PIN_CTRL_OUT_VAL_SHIFT \|
	44	mode << ZYNQMP_CRL_APB_BOOT_PIN_CTRL_OUT_EN_SHIFT,
	45	&crlapb_base->boot_pin_ctrl);
	46	}
	47
	48	/*
	49	* Set default PS_MODE1 which is used for USB ULPI phy reset
	50	* Also other resets can be connected to this certain pin
	51	*/
	52	#ifndef MODE_RESET
	53	# define MODE_RESET PS_MODE1
	54	#endif
	55
e6a9ed04 MS	56	#ifdef CONFIG_SPL_BOARD_INIT
	57	void spl_board_init(void)
	58	{
	59	preloader_console_init();
48255f52	60	ps_mode_reset(MODE_RESET);
e6a9ed04 MS	61	board_init();
	62	}
	63	#endif
	64
	65	u32 spl_boot_device(void)
	66	{
	67	u32 reg = 0;
	68	u8 bootmode;
	69
7f491d7b MS	70	#if defined(CONFIG_SPL_ZYNQMP_ALT_BOOTMODE_ENABLED)
7f491d7b MS	71	/* Change default boot mode at run-time */
47359a03	72	writel(CONFIG_SPL_ZYNQMP_ALT_BOOTMODE << BOOT_MODE_ALT_SHIFT,
7f491d7b MS	73	&crlapb_base->boot_mode);
	74	#endif
	75
e6a9ed04	76	reg = readl(&crlapb_base->boot_mode);
47359a03 MS	77	if (reg >> BOOT_MODE_ALT_SHIFT)
	78	reg >>= BOOT_MODE_ALT_SHIFT;
	79
e6a9ed04 MS	80	bootmode = reg & BOOT_MODES_MASK;
	81
	82	switch (bootmode) {
	83	case JTAG_MODE:
	84	return BOOT_DEVICE_RAM;
	85	#ifdef CONFIG_SPL_MMC_SUPPORT
bd89fba2	86	case SD1_LSHFT_MODE:
e6a9ed04 MS	87	case EMMC_MODE:
	88	case SD_MODE:
	89	case SD_MODE1:
	90	return BOOT_DEVICE_MMC1;
d58fc12e MS	91	#endif
	92	#ifdef CONFIG_SPL_DFU_SUPPORT
	93	case USB_MODE:
	94	return BOOT_DEVICE_DFU;
2661081c MS	95	#endif
	96	#ifdef CONFIG_SPL_SATA_SUPPORT
	97	case SW_SATA_MODE:
	98	return BOOT_DEVICE_SATA;
e6a9ed04 MS	99	#endif
	100	default:
	101	printf("Invalid Boot Mode:0x%x\n", bootmode);
	102	break;
	103	}
	104
	105	return 0;
	106	}
	107
2b1cdafa	108	u32 spl_boot_mode(const u32 boot_device)
e6a9ed04 MS	109	{
	110	switch (spl_boot_device()) {
	111	case BOOT_DEVICE_RAM:
	112	return 0;
	113	case BOOT_DEVICE_MMC1:
	114	return MMCSD_MODE_FS;
	115	default:
	116	puts("spl: error: unsupported device\n");
	117	hang();
	118	}
	119	}
	120
	121	__weak void psu_init(void)
	122	{
	123	/*
	124	* This function is overridden by the one in
	125	* board/xilinx/zynqmp/(platform)/psu_init_gpl.c, if it exists.
	126	*/
	127	}
	128
	129	#ifdef CONFIG_SPL_OS_BOOT
	130	int spl_start_uboot(void)
	131	{
509d4b95 MS	132	handoff_setup();
509d4b95 MS	133
e6a9ed04 MS	134	return 0;
	135	}
	136	#endif
	137
	138	#ifdef CONFIG_SPL_LOAD_FIT
	139	int board_fit_config_name_match(const char *name)
	140	{
	141	/* Just empty function now - can't decide what to choose */
	142	debug("%s: %s\n", __func__, name);
	143
	144	return 0;
	145	}
	146	#endif