Blame view

cmd/blob.c 3.69 KB
d41ce506b   Eric Lee   Initial Release, ...
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
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
  /*
   *
   * Command for encapsulating/decapsulating blob of memory.
   *
   * SPDX-License-Identifier:	GPL-2.0+
   */
  
  #include <common.h>
  #include <command.h>
  #include <environment.h>
  #include <malloc.h>
  #include <asm/byteorder.h>
  #include <linux/compiler.h>
  #if defined(CONFIG_ARCH_MX6) || defined(CONFIG_ARCH_MX7) || \
  	defined(CONFIG_ARCH_MX7ULP) || defined(CONFIG_ARCH_IMX8M)
  #include <fsl_sec.h>
  #include <asm/arch/clock.h>
  #endif
  
  DECLARE_GLOBAL_DATA_PTR;
  
  /**
   * blob_decap() - Decapsulate the data as a blob
   * @key_mod:	- Pointer to key modifier/key
   * @src:	- Address of data to be decapsulated
   * @dst:	- Address of data to be decapsulated
   * @len:	- Size of data to be decapsulated
   *
   * Returns zero on success,and negative on error.
   */
  __weak int blob_decap(u8 *key_mod, u8 *src, u8 *dst, u32 len)
  {
  	return 0;
  }
  
  /**
   * blob_encap() - Encapsulate the data as a blob
   * @key_mod:	- Pointer to key modifier/key
   * @src:	- Address of data to be encapsulated
   * @dst:	- Address of data to be encapsulated
   * @len:	- Size of data to be encapsulated
   *
   * Returns zero on success,and negative on error.
   */
  __weak int blob_encap(u8 *key_mod, u8 *src, u8 *dst, u32 len)
  {
  	return 0;
  }
  
  /**
   * do_blob() - Handle the "blob" command-line command
   * @cmdtp:	Command data struct pointer
   * @flag:	Command flag
   * @argc:	Command-line argument count
   * @argv:	Array of command-line arguments
   *
   * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
   * on error.
   */
  static int do_blob(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
  {
  	ulong key_addr, src_addr, dst_addr, len;
  	uint8_t *km_ptr, *src_ptr, *dst_ptr;
  	int enc, ret = 0;
  
  	if (argc != 6)
  		return CMD_RET_USAGE;
  
  	if (!strncmp(argv[1], "enc", 3))
  		enc = 1;
  	else if (!strncmp(argv[1], "dec", 3))
  		enc = 0;
  	else
  		return CMD_RET_USAGE;
  
  	src_addr = simple_strtoul(argv[2], NULL, 16);
  	dst_addr = simple_strtoul(argv[3], NULL, 16);
  	len = simple_strtoul(argv[4], NULL, 16);
  	key_addr = simple_strtoul(argv[5], NULL, 16);
  
  	km_ptr = (uint8_t *)(uintptr_t)key_addr;
  	src_ptr = (uint8_t *)(uintptr_t)src_addr;
  	dst_ptr = (uint8_t *)(uintptr_t)dst_addr;
  
  #if defined(CONFIG_ARCH_MX6) || defined(CONFIG_ARCH_MX7) || \
  	defined(CONFIG_ARCH_MX7ULP) || defined(CONFIG_ARCH_IMX8M)
  
  	hab_caam_clock_enable(1);
  
  	u32 out_jr_size = sec_in32(CONFIG_SYS_FSL_JR0_ADDR +
  				   FSL_CAAM_ORSR_JRa_OFFSET);
  	if (out_jr_size != FSL_CAAM_MAX_JR_SIZE)
  		sec_init();
  #endif
  
  	if (enc)
  		ret = blob_encap(km_ptr, src_ptr, dst_ptr, len);
  	else
  		ret = blob_decap(km_ptr, src_ptr, dst_ptr, len);
  
  	return ret;
  }
  
  /***************************************************/
  static char blob_help_text[] =
  	"enc src dst len km - Encapsulate and create blob of data
  "
  	"                          $len bytes long at address $src and
  "
  	"                          store the result at address $dst.
  "
  	"                          $km is the address where the key
  "
  	"                          modifier is stored.
  "
  	"                          The modifier is required for generation
  "
  	"                          /use as key for cryptographic operation.
  "
  	"                          Key modifier should be 16 byte long.
  "
  	"blob dec src dst len km - Decapsulate the  blob of data at address
  "
  	"                          $src and store result of $len byte at
  "
  	"                          addr $dst.
  "
  	"                          $km is the address where the key
  "
  	"                          modifier is stored.
  "
  	"                          The modifier is required for generation
  "
  	"                          /use as key for cryptographic operation.
  "
  	"                          Key modifier should be 16 byte long.
  ";
  
  U_BOOT_CMD(
  	blob, 6, 1, do_blob,
  	"Blob encapsulation/decryption",
  	blob_help_text
  );