| /* | |
| * Copyright (C) 2012 Boundary Devices Inc. | |
| * | |
| * SPDX-License-Identifier: GPL-2.0+ | |
| */ | |
| #include <common.h> | |
| #include <asm/errno.h> | |
| #include <asm/io.h> | |
| #include <asm/imx-common/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; | |
| return size; | |
| } | |
| static int do_boot_mode(cmd_tbl_t *cmdtp, int flag, int argc, | |
| char * const argv[]) | |
| { | |
| const struct boot_mode *p; | |
| int reset_requested = 1; | |
| if (argc < 2) | |
| return CMD_RET_USAGE; | |
| 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; | |
| cmd_tbl_t *entry = ll_entry_get(cmd_tbl_t, 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; | |
| } | |
| } |