mirror of
https://github.com/smaeul/u-boot.git
synced 2025-11-04 14:00:19 +00:00
03de305ec4
As part of bringing the master branch back in to next, we need to allow for all of these changes to exist here. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
121 lines
2.1 KiB
C
121 lines
2.1 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2012 Boundary Devices Inc.
|
|
*/
|
|
#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;
|
|
}
|
|
}
|