1
2
3
4
5
6
7
8#include <common.h>
9#include <command.h>
10#include <malloc.h>
11#include <asm/byteorder.h>
12#include <linux/compiler.h>
13#include <fsl_sec.h>
14#include <asm/arch/clock.h>
15#include <mapmem.h>
16
17
18
19
20
21
22
23
24
25static int blob_encap_dek(const u8 *src, u8 *dst, u32 len)
26{
27 int ret = 0;
28 u32 jr_size = 4;
29
30 u32 out_jr_size = sec_in32(CONFIG_SYS_FSL_JR0_ADDR + 0x102c);
31 if (out_jr_size != jr_size) {
32 hab_caam_clock_enable(1);
33 sec_init();
34 }
35
36 if (!((len == 128) | (len == 192) | (len == 256))) {
37 debug("Invalid DEK size. Valid sizes are 128, 192 and 256b\n");
38 return -1;
39 }
40
41 len /= 8;
42 ret = blob_dek(src, dst, len);
43
44 return ret;
45}
46
47
48
49
50
51
52
53
54
55
56
57static int do_dek_blob(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
58{
59 uint32_t src_addr, dst_addr, len;
60 uint8_t *src_ptr, *dst_ptr;
61 int ret = 0;
62
63 if (argc != 4)
64 return CMD_RET_USAGE;
65
66 src_addr = simple_strtoul(argv[1], NULL, 16);
67 dst_addr = simple_strtoul(argv[2], NULL, 16);
68 len = simple_strtoul(argv[3], NULL, 10);
69
70 src_ptr = map_sysmem(src_addr, len/8);
71 dst_ptr = map_sysmem(dst_addr, BLOB_SIZE(len/8));
72
73 ret = blob_encap_dek(src_ptr, dst_ptr, len);
74
75 return ret;
76}
77
78
79static char dek_blob_help_text[] =
80 "src dst len - Encapsulate and create blob of data\n"
81 " $len bits long at address $src and\n"
82 " store the result at address $dst.\n";
83
84U_BOOT_CMD(
85 dek_blob, 4, 1, do_dek_blob,
86 "Data Encryption Key blob encapsulation",
87 dek_blob_help_text
88);
89