mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-26 04:53:42 +00:00
cb5fe9e336
Bitwise operations on signed integers are not defined, replace them with per-call checks. Reviewed-by: Peng Fan <peng.fan@nxp.com> Signed-off-by: Marek Vasut <marex@denx.de> Reviewed-by: Fabio Estevam <festevam@denx.de> Reviewed-by: Heiko Schocher <hs@denx.de>
387 lines
8.2 KiB
C
387 lines
8.2 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright 2019 NXP
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <errno.h>
|
|
#include <image.h>
|
|
#include <log.h>
|
|
#include <asm/global_data.h>
|
|
#include <linux/libfdt.h>
|
|
#include <spl.h>
|
|
#include <asm/mach-imx/image.h>
|
|
#include <asm/arch/sys_proto.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
/* Caller need ensure the offset and size to align with page size */
|
|
ulong spl_romapi_raw_seekable_read(u32 offset, u32 size, void *buf)
|
|
{
|
|
int ret;
|
|
|
|
debug("%s 0x%x, size 0x%x\n", __func__, offset, size);
|
|
|
|
ret = rom_api_download_image(buf, offset, size);
|
|
|
|
if (ret == ROM_API_OKAY)
|
|
return size;
|
|
|
|
printf("%s Failure when load 0x%x, size 0x%x\n", __func__, offset, size);
|
|
|
|
return 0;
|
|
}
|
|
|
|
ulong __weak spl_romapi_get_uboot_base(u32 image_offset, u32 rom_bt_dev)
|
|
{
|
|
return image_offset +
|
|
(CONFIG_SYS_MMCSD_RAW_MODE_U_BOOT_SECTOR * 512 - 0x8000);
|
|
}
|
|
|
|
static int is_boot_from_stream_device(u32 boot)
|
|
{
|
|
u32 interface;
|
|
|
|
interface = boot >> 16;
|
|
if (interface >= BT_DEV_TYPE_USB)
|
|
return 1;
|
|
|
|
if (interface == BT_DEV_TYPE_MMC && (boot & 1))
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static ulong spl_romapi_read_seekable(struct spl_load_info *load,
|
|
ulong sector, ulong count,
|
|
void *buf)
|
|
{
|
|
u32 pagesize = *(u32 *)load->priv;
|
|
ulong byte = count * pagesize;
|
|
u32 offset;
|
|
|
|
offset = sector * pagesize;
|
|
|
|
return spl_romapi_raw_seekable_read(offset, byte, buf) / pagesize;
|
|
}
|
|
|
|
static int spl_romapi_load_image_seekable(struct spl_image_info *spl_image,
|
|
struct spl_boot_device *bootdev,
|
|
u32 rom_bt_dev)
|
|
{
|
|
int ret;
|
|
u32 offset;
|
|
u32 pagesize, size;
|
|
struct legacy_img_hdr *header;
|
|
u32 image_offset;
|
|
|
|
ret = rom_api_query_boot_infor(QUERY_IVT_OFF, &offset);
|
|
if (ret != ROM_API_OKAY)
|
|
goto err;
|
|
|
|
ret = rom_api_query_boot_infor(QUERY_PAGE_SZ, &pagesize);
|
|
if (ret != ROM_API_OKAY)
|
|
goto err;
|
|
|
|
ret = rom_api_query_boot_infor(QUERY_IMG_OFF, &image_offset);
|
|
if (ret != ROM_API_OKAY)
|
|
goto err;
|
|
|
|
header = (struct legacy_img_hdr *)(CONFIG_SPL_IMX_ROMAPI_LOADADDR);
|
|
|
|
printf("image offset 0x%x, pagesize 0x%x, ivt offset 0x%x\n",
|
|
image_offset, pagesize, offset);
|
|
|
|
offset = spl_romapi_get_uboot_base(image_offset, rom_bt_dev);
|
|
|
|
size = ALIGN(sizeof(struct legacy_img_hdr), pagesize);
|
|
ret = rom_api_download_image((u8 *)header, offset, size);
|
|
|
|
if (ret != ROM_API_OKAY) {
|
|
printf("ROMAPI: download failure offset 0x%x size 0x%x\n",
|
|
offset, size);
|
|
return -1;
|
|
}
|
|
|
|
if (IS_ENABLED(CONFIG_SPL_LOAD_FIT) && image_get_magic(header) == FDT_MAGIC) {
|
|
struct spl_load_info load;
|
|
|
|
memset(&load, 0, sizeof(load));
|
|
load.bl_len = pagesize;
|
|
load.read = spl_romapi_read_seekable;
|
|
load.priv = &pagesize;
|
|
return spl_load_simple_fit(spl_image, &load, offset / pagesize, header);
|
|
} else if (IS_ENABLED(CONFIG_SPL_LOAD_IMX_CONTAINER)) {
|
|
struct spl_load_info load;
|
|
|
|
memset(&load, 0, sizeof(load));
|
|
load.bl_len = pagesize;
|
|
load.read = spl_romapi_read_seekable;
|
|
load.priv = &pagesize;
|
|
|
|
ret = spl_load_imx_container(spl_image, &load, offset / pagesize);
|
|
} else {
|
|
/* TODO */
|
|
puts("Can't support legacy image\n");
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
|
|
err:
|
|
puts("ROMAPI: Failure query boot infor pagesize/offset\n");
|
|
return -1;
|
|
}
|
|
|
|
static ulong spl_ram_load_read(struct spl_load_info *load, ulong sector,
|
|
ulong count, void *buf)
|
|
{
|
|
memcpy(buf, (void *)(sector), count);
|
|
|
|
if (load->priv) {
|
|
ulong *p = (ulong *)load->priv;
|
|
ulong total = sector + count;
|
|
|
|
if (total > *p)
|
|
*p = total;
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
static ulong get_fit_image_size(void *fit)
|
|
{
|
|
struct spl_image_info spl_image;
|
|
struct spl_load_info spl_load_info;
|
|
ulong last = (ulong)fit;
|
|
|
|
memset(&spl_load_info, 0, sizeof(spl_load_info));
|
|
spl_load_info.bl_len = 1;
|
|
spl_load_info.read = spl_ram_load_read;
|
|
spl_load_info.priv = &last;
|
|
|
|
spl_load_simple_fit(&spl_image, &spl_load_info,
|
|
(uintptr_t)fit, fit);
|
|
|
|
return last - (ulong)fit;
|
|
}
|
|
|
|
static u8 *search_fit_header(u8 *p, int size)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < size; i += 4)
|
|
if (genimg_get_format(p + i) == IMAGE_FORMAT_FIT)
|
|
return p + i;
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static u8 *search_container_header(u8 *p, int size)
|
|
{
|
|
int i = 0;
|
|
u8 *hdr;
|
|
|
|
for (i = 0; i < size; i += 4) {
|
|
hdr = p + i;
|
|
if (*(hdr + 3) == 0x87 && *hdr == 0 && (*(hdr + 1) != 0 || *(hdr + 2) != 0))
|
|
return p + i;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static u8 *search_img_header(u8 *p, int size)
|
|
{
|
|
if (IS_ENABLED(CONFIG_SPL_LOAD_FIT))
|
|
return search_fit_header(p, size);
|
|
else if (IS_ENABLED(CONFIG_SPL_LOAD_IMX_CONTAINER))
|
|
return search_container_header(p, size);
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static u32 img_header_size(void)
|
|
{
|
|
if (IS_ENABLED(CONFIG_SPL_LOAD_FIT))
|
|
return sizeof(struct fdt_header);
|
|
else if (IS_ENABLED(CONFIG_SPL_LOAD_IMX_CONTAINER))
|
|
return sizeof(struct container_hdr);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int img_info_size(void *img_hdr)
|
|
{
|
|
#ifdef CONFIG_SPL_LOAD_FIT
|
|
return fit_get_size(img_hdr);
|
|
#elif defined CONFIG_SPL_LOAD_IMX_CONTAINER
|
|
struct container_hdr *container = img_hdr;
|
|
|
|
return (container->length_lsb + (container->length_msb << 8));
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
static int img_total_size(void *img_hdr)
|
|
{
|
|
if (IS_ENABLED(CONFIG_SPL_LOAD_FIT)) {
|
|
return get_fit_image_size(img_hdr);
|
|
} else if (IS_ENABLED(CONFIG_SPL_LOAD_IMX_CONTAINER)) {
|
|
int total = get_container_size((ulong)img_hdr, NULL);
|
|
|
|
if (total < 0) {
|
|
printf("invalid container image\n");
|
|
return 0;
|
|
}
|
|
|
|
return total;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int spl_romapi_load_image_stream(struct spl_image_info *spl_image,
|
|
struct spl_boot_device *bootdev)
|
|
{
|
|
struct spl_load_info load;
|
|
u32 pagesize, pg;
|
|
int ret;
|
|
int i = 0;
|
|
u8 *p = (u8 *)CONFIG_SPL_IMX_ROMAPI_LOADADDR;
|
|
u8 *phdr = NULL;
|
|
int imagesize;
|
|
int total;
|
|
|
|
ret = rom_api_query_boot_infor(QUERY_PAGE_SZ, &pagesize);
|
|
|
|
if (ret != ROM_API_OKAY)
|
|
puts("failure at query_boot_info\n");
|
|
|
|
pg = pagesize;
|
|
if (pg < 1024)
|
|
pg = 1024;
|
|
|
|
for (i = 0; i < 640; i++) {
|
|
ret = rom_api_download_image(p, 0, pg);
|
|
|
|
if (ret != ROM_API_OKAY) {
|
|
puts("Steam(USB) download failure\n");
|
|
return -1;
|
|
}
|
|
|
|
phdr = search_img_header(p, pg);
|
|
p += pg;
|
|
|
|
if (phdr)
|
|
break;
|
|
}
|
|
|
|
if (!phdr) {
|
|
puts("Can't found uboot image in 640K range\n");
|
|
return -1;
|
|
}
|
|
|
|
if (p - phdr < img_header_size()) {
|
|
ret = rom_api_download_image(p, 0, pg);
|
|
|
|
if (ret != ROM_API_OKAY) {
|
|
puts("Steam(USB) download failure\n");
|
|
return -1;
|
|
}
|
|
|
|
p += pg;
|
|
}
|
|
|
|
imagesize = img_info_size(phdr);
|
|
printf("Find img info 0x%p, size %d\n", phdr, imagesize);
|
|
|
|
if (p - phdr < imagesize) {
|
|
imagesize -= p - phdr;
|
|
/*need pagesize hear after ROM fix USB problme*/
|
|
imagesize += pg - 1;
|
|
imagesize /= pg;
|
|
imagesize *= pg;
|
|
|
|
printf("Need continue download %d\n", imagesize);
|
|
|
|
ret = rom_api_download_image(p, 0, imagesize);
|
|
|
|
p += imagesize;
|
|
|
|
if (ret != ROM_API_OKAY) {
|
|
printf("Failure download %d\n", imagesize);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
total = img_total_size(phdr);
|
|
total += 3;
|
|
total &= ~0x3;
|
|
|
|
imagesize = total - (p - phdr);
|
|
|
|
imagesize += pagesize - 1;
|
|
imagesize /= pagesize;
|
|
imagesize *= pagesize;
|
|
|
|
printf("Download %d, Total size %d\n", imagesize, total);
|
|
|
|
ret = rom_api_download_image(p, 0, imagesize);
|
|
if (ret != ROM_API_OKAY)
|
|
printf("ROM download failure %d\n", imagesize);
|
|
|
|
memset(&load, 0, sizeof(load));
|
|
load.bl_len = 1;
|
|
load.read = spl_ram_load_read;
|
|
|
|
if (IS_ENABLED(CONFIG_SPL_LOAD_FIT))
|
|
return spl_load_simple_fit(spl_image, &load, (ulong)phdr, phdr);
|
|
else if (IS_ENABLED(CONFIG_SPL_LOAD_IMX_CONTAINER))
|
|
return spl_load_imx_container(spl_image, &load, (ulong)phdr);
|
|
|
|
return -1;
|
|
}
|
|
|
|
int board_return_to_bootrom(struct spl_image_info *spl_image,
|
|
struct spl_boot_device *bootdev)
|
|
{
|
|
int ret;
|
|
u32 boot, bstage;
|
|
|
|
ret = rom_api_query_boot_infor(QUERY_BT_DEV, &boot);
|
|
if (ret != ROM_API_OKAY)
|
|
goto err;
|
|
|
|
ret = rom_api_query_boot_infor(QUERY_BT_STAGE, &bstage);
|
|
if (ret != ROM_API_OKAY)
|
|
goto err;
|
|
|
|
printf("Boot Stage: ");
|
|
|
|
switch (bstage) {
|
|
case BT_STAGE_PRIMARY:
|
|
printf("Primary boot\n");
|
|
break;
|
|
case BT_STAGE_SECONDARY:
|
|
printf("Secondary boot\n");
|
|
break;
|
|
case BT_STAGE_RECOVERY:
|
|
printf("Recovery boot\n");
|
|
break;
|
|
case BT_STAGE_USB:
|
|
printf("USB boot\n");
|
|
break;
|
|
default:
|
|
printf("Unknown (0x%x)\n", bstage);
|
|
}
|
|
|
|
if (is_boot_from_stream_device(boot))
|
|
return spl_romapi_load_image_stream(spl_image, bootdev);
|
|
|
|
return spl_romapi_load_image_seekable(spl_image, bootdev, boot);
|
|
err:
|
|
puts("ROMAPI: failure at query_boot_info\n");
|
|
return -1;
|
|
}
|