Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 2 | /* |
| 3 | * Copyright (C) 2012 Boundary Devices Inc. |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 4 | */ |
| 5 | #include <common.h> |
Masahiro Yamada | 56a931c | 2016-09-21 11:28:55 +0900 | [diff] [blame] | 6 | #include <linux/errno.h> |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 7 | #include <asm/io.h> |
Stefano Babic | 33731bc | 2017-06-29 10:16:06 +0200 | [diff] [blame] | 8 | #include <asm/mach-imx/boot_mode.h> |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 9 | #include <malloc.h> |
Marek Vasut | 69c5e34 | 2012-10-12 10:27:04 +0000 | [diff] [blame] | 10 | #include <command.h> |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 11 | |
| 12 | static const struct boot_mode *modes[2]; |
| 13 | |
| 14 | static const struct boot_mode *search_modes(char *arg) |
| 15 | { |
| 16 | int i; |
| 17 | |
| 18 | for (i = 0; i < ARRAY_SIZE(modes); i++) { |
| 19 | const struct boot_mode *p = modes[i]; |
| 20 | if (p) { |
| 21 | while (p->name) { |
| 22 | if (!strcmp(p->name, arg)) |
| 23 | return p; |
| 24 | p++; |
| 25 | } |
| 26 | } |
| 27 | } |
| 28 | return NULL; |
| 29 | } |
| 30 | |
| 31 | static int create_usage(char *dest) |
| 32 | { |
| 33 | int i; |
| 34 | int size = 0; |
| 35 | |
| 36 | for (i = 0; i < ARRAY_SIZE(modes); i++) { |
| 37 | const struct boot_mode *p = modes[i]; |
| 38 | if (p) { |
| 39 | while (p->name) { |
| 40 | int len = strlen(p->name); |
| 41 | if (dest) { |
| 42 | memcpy(dest, p->name, len); |
| 43 | dest += len; |
| 44 | *dest++ = '|'; |
| 45 | } |
| 46 | size += len + 1; |
| 47 | p++; |
| 48 | } |
| 49 | } |
| 50 | } |
| 51 | if (dest) |
| 52 | memcpy(dest - 1, " [noreset]", 11); /* include trailing 0 */ |
| 53 | size += 10; |
Marek Vasut | 81e514f | 2020-08-05 15:34:06 +0200 | [diff] [blame] | 54 | |
| 55 | if (dest) |
| 56 | memcpy(dest - 1, "\nbmode - getprisec", 19); |
| 57 | size += 18; |
| 58 | |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 59 | return size; |
| 60 | } |
| 61 | |
Marek Vasut | 81e514f | 2020-08-05 15:34:06 +0200 | [diff] [blame] | 62 | __weak int boot_mode_getprisec(void) |
| 63 | { |
| 64 | return 0; |
| 65 | } |
| 66 | |
Simon Glass | ed38aef | 2020-05-10 11:40:03 -0600 | [diff] [blame] | 67 | static int do_boot_mode(struct cmd_tbl *cmdtp, int flag, int argc, |
| 68 | char *const argv[]) |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 69 | { |
| 70 | const struct boot_mode *p; |
| 71 | int reset_requested = 1; |
| 72 | |
| 73 | if (argc < 2) |
| 74 | return CMD_RET_USAGE; |
Marek Vasut | 81e514f | 2020-08-05 15:34:06 +0200 | [diff] [blame] | 75 | if (!strcmp(argv[1], "getprisec")) |
| 76 | return boot_mode_getprisec(); |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 77 | p = search_modes(argv[1]); |
| 78 | if (!p) |
| 79 | return CMD_RET_USAGE; |
| 80 | if (argc == 3) { |
| 81 | if (strcmp(argv[2], "noreset")) |
| 82 | return CMD_RET_USAGE; |
| 83 | reset_requested = 0; |
| 84 | } |
| 85 | |
Fedor Ross | c0b9484 | 2023-10-16 18:16:15 +0200 | [diff] [blame^] | 86 | /* No longer applicable to i.MX8M */ |
| 87 | #if IS_ENABLED(CONFIG_MX53) || IS_ENABLED(CONFIG_MX6) || IS_ENABLED(CONFIG_MX7) |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 88 | boot_mode_apply(p->cfg_val); |
Fedor Ross | c0b9484 | 2023-10-16 18:16:15 +0200 | [diff] [blame^] | 89 | #endif |
| 90 | |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 91 | if (reset_requested && p->cfg_val) |
| 92 | do_reset(NULL, 0, 0, NULL); |
| 93 | return 0; |
| 94 | } |
| 95 | |
| 96 | U_BOOT_CMD( |
| 97 | bmode, 3, 0, do_boot_mode, |
| 98 | NULL, |
| 99 | ""); |
| 100 | |
| 101 | void add_board_boot_modes(const struct boot_mode *p) |
| 102 | { |
| 103 | int size; |
| 104 | char *dest; |
| 105 | |
Simon Glass | ed38aef | 2020-05-10 11:40:03 -0600 | [diff] [blame] | 106 | struct cmd_tbl *entry = ll_entry_get(struct cmd_tbl, bmode, cmd); |
Marek Vasut | 69c5e34 | 2012-10-12 10:27:04 +0000 | [diff] [blame] | 107 | |
| 108 | if (entry->usage) { |
| 109 | free(entry->usage); |
| 110 | entry->usage = NULL; |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 111 | } |
| 112 | |
| 113 | modes[0] = p; |
| 114 | modes[1] = soc_boot_modes; |
| 115 | size = create_usage(NULL); |
| 116 | dest = malloc(size); |
| 117 | if (dest) { |
| 118 | create_usage(dest); |
Marek Vasut | 69c5e34 | 2012-10-12 10:27:04 +0000 | [diff] [blame] | 119 | entry->usage = dest; |
Troy Kisky | 0ca618c | 2012-08-15 10:31:20 +0000 | [diff] [blame] | 120 | } |
| 121 | } |