u-boot/arch/arm/mach-imx/cmd_bmode.c
Fedor Ross a41c9ddb30 ARM: imx: Add support for detecting primary/secondary bmode on MX8M
Implement the 'getprisec' subcommand of 'bmode' command for i.MX8M by
reading out the ROM log events. This event is set by the BootROM if it
switched to the secondary copy due to primary copy being corrupted.

Signed-off-by: Fedor Ross <fedor.ross@ifm.com>
Signed-off-by: Marek Vasut <marex@denx.de>
2023-10-17 23:55:10 +02:00

121 lines
2.1 KiB
C

// SPDX-License-Identifier: GPL-2.0+
/*
* Copyright (C) 2012 Boundary Devices Inc.
*/
#include <common.h>
#include <linux/errno.h>
#include <asm/io.h>
#include <asm/mach-imx/boot_mode.h>
#include <malloc.h>
#include <command.h>
static const struct boot_mode *modes[2];
static const struct boot_mode *search_modes(char *arg)
{
int i;
for (i = 0; i < ARRAY_SIZE(modes); i++) {
const struct boot_mode *p = modes[i];
if (p) {
while (p->name) {
if (!strcmp(p->name, arg))
return p;
p++;
}
}
}
return NULL;
}
static int create_usage(char *dest)
{
int i;
int size = 0;
for (i = 0; i < ARRAY_SIZE(modes); i++) {
const struct boot_mode *p = modes[i];
if (p) {
while (p->name) {
int len = strlen(p->name);
if (dest) {
memcpy(dest, p->name, len);
dest += len;
*dest++ = '|';
}
size += len + 1;
p++;
}
}
}
if (dest)
memcpy(dest - 1, " [noreset]", 11); /* include trailing 0 */
size += 10;
if (dest)
memcpy(dest - 1, "\nbmode - getprisec", 19);
size += 18;
return size;
}
__weak int boot_mode_getprisec(void)
{
return 0;
}
static int do_boot_mode(struct cmd_tbl *cmdtp, int flag, int argc,
char *const argv[])
{
const struct boot_mode *p;
int reset_requested = 1;
if (argc < 2)
return CMD_RET_USAGE;
if (!strcmp(argv[1], "getprisec"))
return boot_mode_getprisec();
p = search_modes(argv[1]);
if (!p)
return CMD_RET_USAGE;
if (argc == 3) {
if (strcmp(argv[2], "noreset"))
return CMD_RET_USAGE;
reset_requested = 0;
}
/* No longer applicable to i.MX8M */
#if IS_ENABLED(CONFIG_MX53) || IS_ENABLED(CONFIG_MX6) || IS_ENABLED(CONFIG_MX7)
boot_mode_apply(p->cfg_val);
#endif
if (reset_requested && p->cfg_val)
do_reset(NULL, 0, 0, NULL);
return 0;
}
U_BOOT_CMD(
bmode, 3, 0, do_boot_mode,
NULL,
"");
void add_board_boot_modes(const struct boot_mode *p)
{
int size;
char *dest;
struct cmd_tbl *entry = ll_entry_get(struct cmd_tbl, bmode, cmd);
if (entry->usage) {
free(entry->usage);
entry->usage = NULL;
}
modes[0] = p;
modes[1] = soc_boot_modes;
size = create_usage(NULL);
dest = malloc(size);
if (dest) {
create_usage(dest);
entry->usage = dest;
}
}