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
106
107
108
109
110
111
112
113
|
/*
* Copyright (c) 2016 Toradex, Inc.
*
* SPDX-License-Identifier: GPL-2.0+
*/
#include <common.h>
#include <malloc.h>
#include <mmc.h>
#define SPL_IMX_MAX_SIZE (CONFIG_SPL_MAX_SIZE + 4096)
#ifdef CONFIG_TDX_CFG_BLOCK_IS_IN_MMC
static void get_spl_version(char *ver, size_t max_len, int dev, uint part)
{
unsigned int ivt_header;
struct mmc *mmc;
char * pch;
char *spl;
size_t spl_size;
char* spl_start;
const char * ver_start = "U-Boot SPL";
/* initialize ver, start with space to fail the min_ver check */
strcpy(ver, " Unknown");
spl = memalign(ARCH_DMA_MINALIGN, SPL_IMX_MAX_SIZE);
if (spl == NULL) {
puts("Could not allocate RAM\n");
return;
}
/* read a maximum SPL into RAM */
mmc = find_mmc_device(dev);
if (!mmc) {
puts("No MMC card found\n");
goto out;
}
if (mmc_init(mmc)) {
puts("MMC init failed\n");
goto out;
}
if (part != mmc->block_dev.hwpart) {
if (blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part)) {
puts("MMC partition switch failed\n");
goto out;
}
}
/* Read the eMMC for the maximum SPL size */
if (blk_dread(mmc_get_blk_desc(mmc), 2, SPL_IMX_MAX_SIZE / 512, spl) !=
(SPL_IMX_MAX_SIZE / 512)) {
puts("MMC read failed\n");
goto out;
}
spl_start = spl;
(void)memcpy(&ivt_header, &spl[0], sizeof(spl_size));
(void)memcpy(&spl_size, &spl[9 * 4], sizeof(spl_size));
/* sanity check, do we see a correct IVT header ? */
if ((ivt_header & ~(01000000)) != 0x402000d1) {
puts("Did not find IVT header, no SPL or U-Boot in eMMC\n");
goto out;
}
/* sanity check, SPL can't be > 68k */
if (spl_size > SPL_IMX_MAX_SIZE){
puts("Size of bootloader > 68k, likely no SPL installed\n");
goto out;
}
while (spl_size) {
pch = (char*) memchr(spl_start, ver_start[0], spl_size);
if (pch!=NULL && pch < spl_start + spl_size) {
spl_size = spl_size - (pch - spl_start);
spl_start = pch +1;
if (!memcmp(ver_start, pch, strlen(ver_start))) {
strncpy(ver, pch, max_len);
ver[max_len - 1] = 0;
spl_size = 0;
break;
}
} else {
spl_size = 0;
}
}
out:
free(spl);
spl = NULL;
/* Switch back to regular eMMC user partition */
blk_select_hwpart_devnum(IF_TYPE_MMC, 0, 0);
}
static int do_splver(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
{
char ver[256];
int res = 0;
ver[0] = 0;
get_spl_version(ver, ARRAY_SIZE(ver), 0, 1);
printf ("%s\n", ver);
if (argc > 1)
res = strncmp(ver, argv[1], strlen(argv[1]));
return (res < 0) ? CMD_RET_FAILURE : CMD_RET_SUCCESS;
}
U_BOOT_CMD(
splver, 2, 0, do_splver,
"Print and compare the SPL version",
"Parses the SPL version from eMMC\n"
"[min_ver] compares against the optional parameter 'min_ver' and\n"
"returns success if installed version is >= min_ver"
);
#endif
|
