u-boot/arch/arm/mach-imx/cmd_bmode.c
Marek Vasut 3c0fbbfd95 ARM: imx: Add support for reading out the primary/secondary bmode
Add new 'getprisec' subcommand to 'bmode' command, which sets the return
value of the 'bmode' command to either 0 if the system booted from primary
copy or to 1 if the system booted from secondary copy. This can be used
e.g. in 'test' command to determine which copy of the system is running.

Signed-off-by: Marek Vasut <marex@denx.de>
Cc: Fabio Estevam <festevam@gmail.com>
Cc: NXP i.MX U-Boot Team <uboot-imx@nxp.com>
Cc: Peng Fan <peng.fan@nxp.com>
Cc: Stefano Babic <sbabic@denx.de>
Reviewed-by: Stefano Babic <sbabic@denx.de>
2020-08-17 17:55:17 +02:00

117 lines
2 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;
}
boot_mode_apply(p->cfg_val);
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;
}
}