cmd_bmode.c
1.82 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
// 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;
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;
}
}