395 lines
		
	
	
		
			11 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			395 lines
		
	
	
		
			11 KiB
		
	
	
	
		
			C
		
	
	
	
// SPDX-License-Identifier: GPL-2.0+
 | 
						|
/*
 | 
						|
 * Copyright (C) 2014 Gateworks Corporation
 | 
						|
 * Copyright (C) 2011-2012 Freescale Semiconductor, Inc.
 | 
						|
 *
 | 
						|
 * Author: Tim Harvey <tharvey@gateworks.com>
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <hang.h>
 | 
						|
#include <init.h>
 | 
						|
#include <log.h>
 | 
						|
#include <asm/global_data.h>
 | 
						|
#include <asm/io.h>
 | 
						|
#include <asm/arch/imx-regs.h>
 | 
						|
#include <asm/arch/sys_proto.h>
 | 
						|
#include <asm/spl.h>
 | 
						|
#include <spl.h>
 | 
						|
#include <asm/mach-imx/hab.h>
 | 
						|
#include <asm/mach-imx/boot_mode.h>
 | 
						|
#include <g_dnl.h>
 | 
						|
#include <linux/libfdt.h>
 | 
						|
 | 
						|
DECLARE_GLOBAL_DATA_PTR;
 | 
						|
 | 
						|
__weak int spl_board_boot_device(enum boot_device boot_dev_spl)
 | 
						|
{
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
#if defined(CONFIG_MX6)
 | 
						|
/* determine boot device from SRC_SBMR1 (BOOT_CFG[4:1]) or SRC_GPR9 register */
 | 
						|
u32 spl_boot_device(void)
 | 
						|
{
 | 
						|
	unsigned int bmode = readl(&src_base->sbmr2);
 | 
						|
	u32 reg = imx6_src_get_boot_mode();
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Check for BMODE if serial downloader is enabled
 | 
						|
	 * BOOT_MODE - see IMX6DQRM Table 8-1
 | 
						|
	 */
 | 
						|
	if (((bmode >> 24) & 0x03) == 0x01) /* Serial Downloader */
 | 
						|
		return BOOT_DEVICE_BOARD;
 | 
						|
 | 
						|
	/*
 | 
						|
	 * The above method does not detect that the boot ROM used
 | 
						|
	 * serial downloader in case the boot ROM decided to use the
 | 
						|
	 * serial downloader as a fall back (primary boot source failed).
 | 
						|
	 *
 | 
						|
	 * Infer that the boot ROM used the USB serial downloader by
 | 
						|
	 * checking whether the USB PHY is currently active... This
 | 
						|
	 * assumes that SPL did not (yet) initialize the USB PHY...
 | 
						|
	 */
 | 
						|
	if (is_usbotg_phy_active())
 | 
						|
		return BOOT_DEVICE_BOARD;
 | 
						|
 | 
						|
	/* BOOT_CFG1[7:4] - see IMX6DQRM Table 8-8 */
 | 
						|
	switch ((reg & IMX6_BMODE_MASK) >> IMX6_BMODE_SHIFT) {
 | 
						|
	 /* EIM: See 8.5.1, Table 8-9 */
 | 
						|
	case IMX6_BMODE_EMI:
 | 
						|
		/* BOOT_CFG1[3]: NOR/OneNAND Selection */
 | 
						|
		switch ((reg & IMX6_BMODE_EMI_MASK) >> IMX6_BMODE_EMI_SHIFT) {
 | 
						|
		case IMX6_BMODE_ONENAND:
 | 
						|
			return BOOT_DEVICE_ONENAND;
 | 
						|
		case IMX6_BMODE_NOR:
 | 
						|
			return BOOT_DEVICE_NOR;
 | 
						|
		break;
 | 
						|
		}
 | 
						|
	/* Reserved: Used to force Serial Downloader */
 | 
						|
	case IMX6_BMODE_RESERVED:
 | 
						|
		return BOOT_DEVICE_BOARD;
 | 
						|
	/* SATA: See 8.5.4, Table 8-20 */
 | 
						|
#if !defined(CONFIG_MX6UL) && !defined(CONFIG_MX6ULL)
 | 
						|
	case IMX6_BMODE_SATA:
 | 
						|
		return BOOT_DEVICE_SATA;
 | 
						|
#endif
 | 
						|
	/* Serial ROM: See 8.5.5.1, Table 8-22 */
 | 
						|
	case IMX6_BMODE_SERIAL_ROM:
 | 
						|
		/* BOOT_CFG4[2:0] */
 | 
						|
		switch ((reg & IMX6_BMODE_SERIAL_ROM_MASK) >>
 | 
						|
			IMX6_BMODE_SERIAL_ROM_SHIFT) {
 | 
						|
		case IMX6_BMODE_ECSPI1:
 | 
						|
		case IMX6_BMODE_ECSPI2:
 | 
						|
		case IMX6_BMODE_ECSPI3:
 | 
						|
		case IMX6_BMODE_ECSPI4:
 | 
						|
		case IMX6_BMODE_ECSPI5:
 | 
						|
			return BOOT_DEVICE_SPI;
 | 
						|
		case IMX6_BMODE_I2C1:
 | 
						|
		case IMX6_BMODE_I2C2:
 | 
						|
		case IMX6_BMODE_I2C3:
 | 
						|
			return BOOT_DEVICE_I2C;
 | 
						|
		}
 | 
						|
		break;
 | 
						|
	/* SD/eSD: 8.5.3, Table 8-15  */
 | 
						|
	case IMX6_BMODE_SD:
 | 
						|
	case IMX6_BMODE_ESD:
 | 
						|
		return BOOT_DEVICE_MMC1;
 | 
						|
	/* MMC/eMMC: 8.5.3 */
 | 
						|
	case IMX6_BMODE_MMC:
 | 
						|
	case IMX6_BMODE_EMMC:
 | 
						|
		return BOOT_DEVICE_MMC1;
 | 
						|
	/* NAND Flash: 8.5.2, Table 8-10 */
 | 
						|
	case IMX6_BMODE_NAND_MIN ... IMX6_BMODE_NAND_MAX:
 | 
						|
		return BOOT_DEVICE_NAND;
 | 
						|
#if defined(CONFIG_MX6UL) || defined(CONFIG_MX6ULL)
 | 
						|
	/* QSPI boot */
 | 
						|
	case IMX6_BMODE_QSPI:
 | 
						|
		return BOOT_DEVICE_SPI;
 | 
						|
#endif
 | 
						|
	}
 | 
						|
	return BOOT_DEVICE_NONE;
 | 
						|
}
 | 
						|
 | 
						|
#elif defined(CONFIG_MX7) || defined(CONFIG_IMX8M) || defined(CONFIG_IMX8)
 | 
						|
/* Translate iMX7/i.MX8M boot device to the SPL boot device enumeration */
 | 
						|
u32 spl_boot_device(void)
 | 
						|
{
 | 
						|
#if defined(CONFIG_MX7)
 | 
						|
	unsigned int bmode = readl(&src_base->sbmr2);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Check for BMODE if serial downloader is enabled
 | 
						|
	 * BOOT_MODE - see IMX7DRM Table 6-24
 | 
						|
	 */
 | 
						|
	if (((bmode >> 24) & 0x03) == 0x01) /* Serial Downloader */
 | 
						|
		return BOOT_DEVICE_BOARD;
 | 
						|
 | 
						|
	/*
 | 
						|
	 * The above method does not detect that the boot ROM used
 | 
						|
	 * serial downloader in case the boot ROM decided to use the
 | 
						|
	 * serial downloader as a fall back (primary boot source failed).
 | 
						|
	 *
 | 
						|
	 * Infer that the boot ROM used the USB serial downloader by
 | 
						|
	 * checking whether the USB PHY is currently active... This
 | 
						|
	 * assumes that SPL did not (yet) initialize the USB PHY...
 | 
						|
	 */
 | 
						|
	if (is_boot_from_usb())
 | 
						|
		return BOOT_DEVICE_BOARD;
 | 
						|
#endif
 | 
						|
 | 
						|
	enum boot_device boot_device_spl = get_boot_device();
 | 
						|
 | 
						|
	if (IS_ENABLED(CONFIG_IMX8MM) || IS_ENABLED(CONFIG_IMX8MN) ||
 | 
						|
	    IS_ENABLED(CONFIG_IMX8MP))
 | 
						|
		return spl_board_boot_device(boot_device_spl);
 | 
						|
 | 
						|
	switch (boot_device_spl) {
 | 
						|
#if defined(CONFIG_MX7)
 | 
						|
	case SD1_BOOT:
 | 
						|
	case MMC1_BOOT:
 | 
						|
	case SD2_BOOT:
 | 
						|
	case MMC2_BOOT:
 | 
						|
	case SD3_BOOT:
 | 
						|
	case MMC3_BOOT:
 | 
						|
		return BOOT_DEVICE_MMC1;
 | 
						|
#elif defined(CONFIG_IMX8)
 | 
						|
	case MMC1_BOOT:
 | 
						|
		return BOOT_DEVICE_MMC1;
 | 
						|
	case SD2_BOOT:
 | 
						|
		return BOOT_DEVICE_MMC2_2;
 | 
						|
	case SD3_BOOT:
 | 
						|
		return BOOT_DEVICE_MMC1;
 | 
						|
	case FLEXSPI_BOOT:
 | 
						|
		return BOOT_DEVICE_SPI;
 | 
						|
#elif defined(CONFIG_IMX8M)
 | 
						|
	case SD1_BOOT:
 | 
						|
	case MMC1_BOOT:
 | 
						|
		return BOOT_DEVICE_MMC1;
 | 
						|
	case SD2_BOOT:
 | 
						|
	case MMC2_BOOT:
 | 
						|
		return BOOT_DEVICE_MMC2;
 | 
						|
#endif
 | 
						|
	case NAND_BOOT:
 | 
						|
		return BOOT_DEVICE_NAND;
 | 
						|
	case SPI_NOR_BOOT:
 | 
						|
		return BOOT_DEVICE_SPI;
 | 
						|
	case QSPI_BOOT:
 | 
						|
		return BOOT_DEVICE_NOR;
 | 
						|
	case USB_BOOT:
 | 
						|
		return BOOT_DEVICE_USB;
 | 
						|
	default:
 | 
						|
		return BOOT_DEVICE_NONE;
 | 
						|
	}
 | 
						|
}
 | 
						|
#endif /* CONFIG_MX7 || CONFIG_IMX8M || CONFIG_IMX8 */
 | 
						|
 | 
						|
#ifdef CONFIG_SPL_USB_GADGET
 | 
						|
int g_dnl_bind_fixup(struct usb_device_descriptor *dev, const char *name)
 | 
						|
{
 | 
						|
	put_unaligned(CONFIG_USB_GADGET_PRODUCT_NUM + 0xfff, &dev->idProduct);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
#define SDPV_BCD_DEVICE 0x500
 | 
						|
int g_dnl_get_board_bcd_device_number(int gcnum)
 | 
						|
{
 | 
						|
	return SDPV_BCD_DEVICE;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#if defined(CONFIG_SPL_MMC)
 | 
						|
/* called from spl_mmc to see type of boot mode for storage (RAW or FAT) */
 | 
						|
u32 spl_mmc_boot_mode(const u32 boot_device)
 | 
						|
{
 | 
						|
#if defined(CONFIG_MX7) || defined(CONFIG_IMX8M) || defined(CONFIG_IMX8)
 | 
						|
	switch (get_boot_device()) {
 | 
						|
	/* for MMC return either RAW or FAT mode */
 | 
						|
	case SD1_BOOT:
 | 
						|
	case SD2_BOOT:
 | 
						|
	case SD3_BOOT:
 | 
						|
		if (IS_ENABLED(CONFIG_SPL_FS_FAT))
 | 
						|
			return MMCSD_MODE_FS;
 | 
						|
		else
 | 
						|
			return MMCSD_MODE_RAW;
 | 
						|
	case MMC1_BOOT:
 | 
						|
	case MMC2_BOOT:
 | 
						|
	case MMC3_BOOT:
 | 
						|
		if (IS_ENABLED(CONFIG_SPL_FS_FAT))
 | 
						|
			return MMCSD_MODE_FS;
 | 
						|
		else if (IS_ENABLED(CONFIG_SUPPORT_EMMC_BOOT))
 | 
						|
			return MMCSD_MODE_EMMCBOOT;
 | 
						|
		else
 | 
						|
			return MMCSD_MODE_RAW;
 | 
						|
	default:
 | 
						|
		puts("spl: ERROR:  unsupported device\n");
 | 
						|
		hang();
 | 
						|
	}
 | 
						|
#else
 | 
						|
	switch (boot_device) {
 | 
						|
	/* for MMC return either RAW or FAT mode */
 | 
						|
	case BOOT_DEVICE_MMC1:
 | 
						|
	case BOOT_DEVICE_MMC2:
 | 
						|
	case BOOT_DEVICE_MMC2_2:
 | 
						|
		if (IS_ENABLED(CONFIG_SPL_FS_FAT))
 | 
						|
			return MMCSD_MODE_FS;
 | 
						|
		else if (IS_ENABLED(CONFIG_SUPPORT_EMMC_BOOT))
 | 
						|
			return MMCSD_MODE_EMMCBOOT;
 | 
						|
		else
 | 
						|
			return MMCSD_MODE_RAW;
 | 
						|
	default:
 | 
						|
		puts("spl: ERROR:  unsupported device\n");
 | 
						|
		hang();
 | 
						|
	}
 | 
						|
#endif
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#if defined(CONFIG_IMX_HAB)
 | 
						|
 | 
						|
/*
 | 
						|
 * +------------+  0x0 (DDR_UIMAGE_START) -
 | 
						|
 * |   Header   |                          |
 | 
						|
 * +------------+  0x40                    |
 | 
						|
 * |            |                          |
 | 
						|
 * |            |                          |
 | 
						|
 * |            |                          |
 | 
						|
 * |            |                          |
 | 
						|
 * | Image Data |                          |
 | 
						|
 * .            |                          |
 | 
						|
 * .            |                           > Stuff to be authenticated ----+
 | 
						|
 * .            |                          |                                |
 | 
						|
 * |            |                          |                                |
 | 
						|
 * |            |                          |                                |
 | 
						|
 * +------------+                          |                                |
 | 
						|
 * |            |                          |                                |
 | 
						|
 * | Fill Data  |                          |                                |
 | 
						|
 * |            |                          |                                |
 | 
						|
 * +------------+ Align to ALIGN_SIZE      |                                |
 | 
						|
 * |    IVT     |                          |                                |
 | 
						|
 * +------------+ + IVT_SIZE              -                                 |
 | 
						|
 * |            |                                                           |
 | 
						|
 * |  CSF DATA  | <---------------------------------------------------------+
 | 
						|
 * |            |
 | 
						|
 * +------------+
 | 
						|
 * |            |
 | 
						|
 * | Fill Data  |
 | 
						|
 * |            |
 | 
						|
 * +------------+ + CSF_PAD_SIZE
 | 
						|
 */
 | 
						|
 | 
						|
__weak void __noreturn jump_to_image_no_args(struct spl_image_info *spl_image)
 | 
						|
{
 | 
						|
	typedef void __noreturn (*image_entry_noargs_t)(void);
 | 
						|
	uint32_t offset;
 | 
						|
 | 
						|
	image_entry_noargs_t image_entry =
 | 
						|
		(image_entry_noargs_t)(unsigned long)spl_image->entry_point;
 | 
						|
 | 
						|
	debug("image entry point: 0x%lX\n", spl_image->entry_point);
 | 
						|
 | 
						|
	if (spl_image->flags & SPL_FIT_FOUND) {
 | 
						|
		image_entry();
 | 
						|
	} else {
 | 
						|
		/*
 | 
						|
		 * HAB looks for the CSF at the end of the authenticated
 | 
						|
		 * data therefore, we need to subtract the size of the
 | 
						|
		 * CSF from the actual filesize
 | 
						|
		 */
 | 
						|
		offset = spl_image->size - CONFIG_CSF_SIZE;
 | 
						|
		if (!imx_hab_authenticate_image(spl_image->load_addr,
 | 
						|
						offset + IVT_SIZE +
 | 
						|
						CSF_PAD_SIZE, offset)) {
 | 
						|
			image_entry();
 | 
						|
		} else {
 | 
						|
			panic("spl: ERROR:  image authentication fail\n");
 | 
						|
		}
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
#if !defined(CONFIG_SPL_FIT_SIGNATURE)
 | 
						|
ulong board_spl_fit_size_align(ulong size)
 | 
						|
{
 | 
						|
	/*
 | 
						|
	 * HAB authenticate_image requests the IVT offset is
 | 
						|
	 * aligned to 0x1000
 | 
						|
	 */
 | 
						|
 | 
						|
	size = ALIGN(size, 0x1000);
 | 
						|
	size += CONFIG_CSF_SIZE;
 | 
						|
 | 
						|
	return size;
 | 
						|
}
 | 
						|
 | 
						|
void board_spl_fit_post_load(const void *fit)
 | 
						|
{
 | 
						|
	u32 offset = ALIGN(fdt_totalsize(fit), 0x1000);
 | 
						|
 | 
						|
	if (imx_hab_authenticate_image((uintptr_t)fit,
 | 
						|
				       offset + IVT_SIZE + CSF_PAD_SIZE,
 | 
						|
				       offset)) {
 | 
						|
		panic("spl: ERROR:  image authentication unsuccessful\n");
 | 
						|
	}
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
void *board_spl_fit_buffer_addr(ulong fit_size, int sectors, int bl_len)
 | 
						|
{
 | 
						|
	int align_len = ARCH_DMA_MINALIGN - 1;
 | 
						|
 | 
						|
	/* Some devices like SDP, NOR, NAND, SPI are using bl_len =1, so their fit address
 | 
						|
	 * is different with SD/MMC, this cause mismatch with signed address. Thus, adjust
 | 
						|
	 * the bl_len to align with SD/MMC.
 | 
						|
	 */
 | 
						|
	if (bl_len < 512)
 | 
						|
		bl_len = 512;
 | 
						|
 | 
						|
	return  (void *)((CONFIG_SYS_TEXT_BASE - fit_size - bl_len -
 | 
						|
			align_len) & ~align_len);
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#if defined(CONFIG_MX6) && defined(CONFIG_SPL_OS_BOOT)
 | 
						|
int dram_init_banksize(void)
 | 
						|
{
 | 
						|
	gd->bd->bi_dram[0].start = CONFIG_SYS_SDRAM_BASE;
 | 
						|
	gd->bd->bi_dram[0].size = imx_ddr_size();
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*
 | 
						|
 * read the address where the IVT header must sit
 | 
						|
 * from IVT image header, loaded from SPL into
 | 
						|
 * an malloced buffer and copy the IVT header
 | 
						|
 * to this address
 | 
						|
 */
 | 
						|
void *spl_load_simple_fit_fix_load(const void *fit)
 | 
						|
{
 | 
						|
	struct ivt *ivt;
 | 
						|
	unsigned long new;
 | 
						|
	unsigned long offset;
 | 
						|
	unsigned long size;
 | 
						|
	u8 *tmp = (u8 *)fit;
 | 
						|
 | 
						|
	offset = ALIGN(fdt_totalsize(fit), 0x1000);
 | 
						|
	size = ALIGN(fdt_totalsize(fit), 4);
 | 
						|
	size = board_spl_fit_size_align(size);
 | 
						|
	tmp += offset;
 | 
						|
	ivt = (struct ivt *)tmp;
 | 
						|
	if (ivt->hdr.magic != IVT_HEADER_MAGIC) {
 | 
						|
		debug("no IVT header found\n");
 | 
						|
		return (void *)fit;
 | 
						|
	}
 | 
						|
	debug("%s: ivt: %p offset: %lx size: %lx\n", __func__, ivt, offset, size);
 | 
						|
	debug("%s: ivt self: %x\n", __func__, ivt->self);
 | 
						|
	new = ivt->self;
 | 
						|
	new -= offset;
 | 
						|
	debug("%s: new %lx\n", __func__, new);
 | 
						|
	memcpy((void *)new, fit, size);
 | 
						|
 | 
						|
	return (void *)new;
 | 
						|
}
 |