1 // SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
2 /*
3 * Copyright (C) 2019, STMicroelectronics - All Rights Reserved
4 */
5
6 #include <common.h>
7 #include <command.h>
8 #include <console.h>
9 #include <log.h>
10 #include <misc.h>
11 #include <dm/device.h>
12 #include <dm/uclass.h>
13
14 #define STM32_OTP_HASH_KEY_START 24
15 #define STM32_OTP_HASH_KEY_SIZE 8
16
read_hash_value(u32 addr)17 static void read_hash_value(u32 addr)
18 {
19 int i;
20
21 for (i = 0; i < STM32_OTP_HASH_KEY_SIZE; i++) {
22 printf("OTP value %i: %x\n", STM32_OTP_HASH_KEY_START + i,
23 __be32_to_cpu(*(u32 *)addr));
24 addr += 4;
25 }
26 }
27
fuse_hash_value(u32 addr,bool print)28 static void fuse_hash_value(u32 addr, bool print)
29 {
30 struct udevice *dev;
31 u32 word, val;
32 int i, ret;
33
34 ret = uclass_get_device_by_driver(UCLASS_MISC,
35 DM_DRIVER_GET(stm32mp_bsec),
36 &dev);
37 if (ret) {
38 log_err("Can't find stm32mp_bsec driver\n");
39 return;
40 }
41
42 for (i = 0; i < STM32_OTP_HASH_KEY_SIZE; i++) {
43 if (print)
44 printf("Fuse OTP %i : %x\n",
45 STM32_OTP_HASH_KEY_START + i,
46 __be32_to_cpu(*(u32 *)addr));
47
48 word = STM32_OTP_HASH_KEY_START + i;
49 val = __be32_to_cpu(*(u32 *)addr);
50 misc_write(dev, STM32_BSEC_OTP(word), &val, 4);
51
52 addr += 4;
53 }
54 }
55
confirm_prog(void)56 static int confirm_prog(void)
57 {
58 puts("Warning: Programming fuses is an irreversible operation!\n"
59 " This may brick your system.\n"
60 " Use this command only if you are sure of what you are doing!\n"
61 "\nReally perform this fuse programming? <y/N>\n");
62
63 if (confirm_yesno())
64 return 1;
65
66 puts("Fuse programming aborted\n");
67 return 0;
68 }
69
do_stm32key(struct cmd_tbl * cmdtp,int flag,int argc,char * const argv[])70 static int do_stm32key(struct cmd_tbl *cmdtp, int flag, int argc,
71 char *const argv[])
72 {
73 u32 addr;
74 const char *op = argc >= 2 ? argv[1] : NULL;
75 int confirmed = argc > 3 && !strcmp(argv[2], "-y");
76
77 argc -= 2 + confirmed;
78 argv += 2 + confirmed;
79
80 if (argc < 1)
81 return CMD_RET_USAGE;
82
83 addr = simple_strtoul(argv[0], NULL, 16);
84 if (!addr)
85 return CMD_RET_USAGE;
86
87 if (!strcmp(op, "read"))
88 read_hash_value(addr);
89
90 if (!strcmp(op, "fuse")) {
91 if (!confirmed && !confirm_prog())
92 return CMD_RET_FAILURE;
93 fuse_hash_value(addr, !confirmed);
94 }
95
96 return CMD_RET_SUCCESS;
97 }
98
99 U_BOOT_CMD(stm32key, 4, 1, do_stm32key,
100 "Fuse ST Hash key",
101 "read <addr>: Read the hash store at addr in memory\n"
102 "stm32key fuse [-y] <addr> : Fuse hash store at addr in otp\n");
103