ahab.c 7.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2018-2019 NXP
  4. */
  5. #include <common.h>
  6. #include <command.h>
  7. #include <errno.h>
  8. #include <log.h>
  9. #include <asm/io.h>
  10. #include <asm/arch/sci/sci.h>
  11. #include <asm/mach-imx/sys_proto.h>
  12. #include <asm/arch-imx/cpu.h>
  13. #include <asm/arch/sys_proto.h>
  14. #include <asm/arch/image.h>
  15. #include <console.h>
  16. DECLARE_GLOBAL_DATA_PTR;
  17. #define SEC_SECURE_RAM_BASE (0x31800000UL)
  18. #define SEC_SECURE_RAM_END_BASE (SEC_SECURE_RAM_BASE + 0xFFFFUL)
  19. #define SECO_LOCAL_SEC_SEC_SECURE_RAM_BASE (0x60000000UL)
  20. #define SECO_PT 2U
  21. static inline bool check_in_dram(ulong addr)
  22. {
  23. int i;
  24. struct bd_info *bd = gd->bd;
  25. for (i = 0; i < CONFIG_NR_DRAM_BANKS; ++i) {
  26. if (bd->bi_dram[i].size) {
  27. if (addr >= bd->bi_dram[i].start &&
  28. addr < (bd->bi_dram[i].start + bd->bi_dram[i].size))
  29. return true;
  30. }
  31. }
  32. return false;
  33. }
  34. int authenticate_os_container(ulong addr)
  35. {
  36. struct container_hdr *phdr;
  37. int i, ret = 0;
  38. int err;
  39. sc_rm_mr_t mr;
  40. sc_faddr_t start, end;
  41. u16 length;
  42. struct boot_img_t *img;
  43. unsigned long s, e;
  44. if (addr % 4) {
  45. puts("Error: Image's address is not 4 byte aligned\n");
  46. return -EINVAL;
  47. }
  48. if (!check_in_dram(addr)) {
  49. puts("Error: Image's address is invalid\n");
  50. return -EINVAL;
  51. }
  52. phdr = (struct container_hdr *)addr;
  53. if (phdr->tag != 0x87 && phdr->version != 0x0) {
  54. printf("Error: Wrong container header\n");
  55. return -EFAULT;
  56. }
  57. if (!phdr->num_images) {
  58. printf("Error: Wrong container, no image found\n");
  59. return -EFAULT;
  60. }
  61. length = phdr->length_lsb + (phdr->length_msb << 8);
  62. debug("container length %u\n", length);
  63. memcpy((void *)SEC_SECURE_RAM_BASE, (const void *)addr,
  64. ALIGN(length, CONFIG_SYS_CACHELINE_SIZE));
  65. err = sc_seco_authenticate(-1, SC_SECO_AUTH_CONTAINER,
  66. SECO_LOCAL_SEC_SEC_SECURE_RAM_BASE);
  67. if (err) {
  68. printf("Authenticate container hdr failed, return %d\n",
  69. err);
  70. ret = -EIO;
  71. goto exit;
  72. }
  73. /* Copy images to dest address */
  74. for (i = 0; i < phdr->num_images; i++) {
  75. img = (struct boot_img_t *)(addr +
  76. sizeof(struct container_hdr) +
  77. i * sizeof(struct boot_img_t));
  78. debug("img %d, dst 0x%x, src 0x%x, size 0x%x\n",
  79. i, (uint32_t) img->dst, img->offset + addr, img->size);
  80. memcpy((void *)img->dst, (const void *)(img->offset + addr),
  81. img->size);
  82. s = img->dst & ~(CONFIG_SYS_CACHELINE_SIZE - 1);
  83. e = ALIGN(img->dst + img->size, CONFIG_SYS_CACHELINE_SIZE) - 1;
  84. flush_dcache_range(s, e);
  85. /* Find the memreg and set permission for seco pt */
  86. err = sc_rm_find_memreg(-1, &mr, s, e);
  87. if (err) {
  88. printf("Error: can't find memreg for image load address 0x%x, error %d\n", img->dst, err);
  89. ret = -ENOMEM;
  90. goto exit;
  91. }
  92. err = sc_rm_get_memreg_info(-1, mr, &start, &end);
  93. if (!err)
  94. debug("memreg %u 0x%llx -- 0x%llx\n", mr, start, end);
  95. err = sc_rm_set_memreg_permissions(-1, mr, SECO_PT,
  96. SC_RM_PERM_FULL);
  97. if (err) {
  98. printf("Set permission failed for img %d, error %d\n",
  99. i, err);
  100. ret = -EPERM;
  101. goto exit;
  102. }
  103. err = sc_seco_authenticate(-1, SC_SECO_VERIFY_IMAGE,
  104. (1 << i));
  105. if (err) {
  106. printf("Authenticate img %d failed, return %d\n",
  107. i, err);
  108. ret = -EIO;
  109. }
  110. err = sc_rm_set_memreg_permissions(-1, mr, SECO_PT,
  111. SC_RM_PERM_NONE);
  112. if (err) {
  113. printf("Remove permission failed for img %d, err %d\n",
  114. i, err);
  115. ret = -EPERM;
  116. }
  117. if (ret)
  118. goto exit;
  119. }
  120. exit:
  121. if (sc_seco_authenticate(-1, SC_SECO_REL_CONTAINER, 0) != SC_ERR_NONE)
  122. printf("Error: release container failed!\n");
  123. return ret;
  124. }
  125. static int do_authenticate(struct cmd_tbl *cmdtp, int flag, int argc,
  126. char *const argv[])
  127. {
  128. ulong addr;
  129. if (argc < 2)
  130. return CMD_RET_USAGE;
  131. addr = simple_strtoul(argv[1], NULL, 16);
  132. printf("Authenticate OS container at 0x%lx\n", addr);
  133. if (authenticate_os_container(addr))
  134. return CMD_RET_FAILURE;
  135. return CMD_RET_SUCCESS;
  136. }
  137. static void display_life_cycle(u16 lc)
  138. {
  139. printf("Lifecycle: 0x%04X, ", lc);
  140. switch (lc) {
  141. case 0x1:
  142. printf("Pristine\n\n");
  143. break;
  144. case 0x2:
  145. printf("Fab\n\n");
  146. break;
  147. case 0x8:
  148. printf("Open\n\n");
  149. break;
  150. case 0x20:
  151. printf("NXP closed\n\n");
  152. break;
  153. case 0x80:
  154. printf("OEM closed\n\n");
  155. break;
  156. case 0x100:
  157. printf("Partial field return\n\n");
  158. break;
  159. case 0x200:
  160. printf("Full field return\n\n");
  161. break;
  162. case 0x400:
  163. printf("No return\n\n");
  164. break;
  165. default:
  166. printf("Unknown\n\n");
  167. break;
  168. }
  169. }
  170. #define AHAB_AUTH_CONTAINER_REQ 0x87
  171. #define AHAB_VERIFY_IMAGE_REQ 0x88
  172. #define AHAB_NO_AUTHENTICATION_IND 0xee
  173. #define AHAB_BAD_KEY_HASH_IND 0xfa
  174. #define AHAB_INVALID_KEY_IND 0xf9
  175. #define AHAB_BAD_SIGNATURE_IND 0xf0
  176. #define AHAB_BAD_HASH_IND 0xf1
  177. static void display_ahab_auth_event(u32 event)
  178. {
  179. u8 cmd = (event >> 16) & 0xff;
  180. u8 resp_ind = (event >> 8) & 0xff;
  181. switch (cmd) {
  182. case AHAB_AUTH_CONTAINER_REQ:
  183. printf("\tCMD = AHAB_AUTH_CONTAINER_REQ (0x%02X)\n", cmd);
  184. printf("\tIND = ");
  185. break;
  186. case AHAB_VERIFY_IMAGE_REQ:
  187. printf("\tCMD = AHAB_VERIFY_IMAGE_REQ (0x%02X)\n", cmd);
  188. printf("\tIND = ");
  189. break;
  190. default:
  191. return;
  192. }
  193. switch (resp_ind) {
  194. case AHAB_NO_AUTHENTICATION_IND:
  195. printf("AHAB_NO_AUTHENTICATION_IND (0x%02X)\n\n", resp_ind);
  196. break;
  197. case AHAB_BAD_KEY_HASH_IND:
  198. printf("AHAB_BAD_KEY_HASH_IND (0x%02X)\n\n", resp_ind);
  199. break;
  200. case AHAB_INVALID_KEY_IND:
  201. printf("AHAB_INVALID_KEY_IND (0x%02X)\n\n", resp_ind);
  202. break;
  203. case AHAB_BAD_SIGNATURE_IND:
  204. printf("AHAB_BAD_SIGNATURE_IND (0x%02X)\n\n", resp_ind);
  205. break;
  206. case AHAB_BAD_HASH_IND:
  207. printf("AHAB_BAD_HASH_IND (0x%02X)\n\n", resp_ind);
  208. break;
  209. default:
  210. printf("Unknown Indicator (0x%02X)\n\n", resp_ind);
  211. break;
  212. }
  213. }
  214. static int do_ahab_status(struct cmd_tbl *cmdtp, int flag, int argc,
  215. char *const argv[])
  216. {
  217. int err;
  218. u8 idx = 0U;
  219. u32 event;
  220. u16 lc;
  221. err = sc_seco_chip_info(-1, &lc, NULL, NULL, NULL);
  222. if (err != SC_ERR_NONE) {
  223. printf("Error in get lifecycle\n");
  224. return -EIO;
  225. }
  226. display_life_cycle(lc);
  227. err = sc_seco_get_event(-1, idx, &event);
  228. while (err == SC_ERR_NONE) {
  229. printf("SECO Event[%u] = 0x%08X\n", idx, event);
  230. display_ahab_auth_event(event);
  231. idx++;
  232. err = sc_seco_get_event(-1, idx, &event);
  233. }
  234. if (idx == 0)
  235. printf("No SECO Events Found!\n\n");
  236. return 0;
  237. }
  238. static int confirm_close(void)
  239. {
  240. puts("Warning: Please ensure your sample is in NXP closed state, "
  241. "OEM SRK hash has been fused, \n"
  242. " and you are able to boot a signed image successfully "
  243. "without any SECO events reported.\n"
  244. " If not, your sample will be unrecoverable.\n"
  245. "\nReally perform this operation? <y/N>\n");
  246. if (confirm_yesno())
  247. return 1;
  248. puts("Ahab close aborted\n");
  249. return 0;
  250. }
  251. static int do_ahab_close(struct cmd_tbl *cmdtp, int flag, int argc,
  252. char *const argv[])
  253. {
  254. int err;
  255. u16 lc;
  256. if (!confirm_close())
  257. return -EACCES;
  258. err = sc_seco_chip_info(-1, &lc, NULL, NULL, NULL);
  259. if (err != SC_ERR_NONE) {
  260. printf("Error in get lifecycle\n");
  261. return -EIO;
  262. }
  263. if (lc != 0x20) {
  264. puts("Current lifecycle is NOT NXP closed, can't move to OEM closed\n");
  265. display_life_cycle(lc);
  266. return -EPERM;
  267. }
  268. err = sc_seco_forward_lifecycle(-1, 16);
  269. if (err != SC_ERR_NONE) {
  270. printf("Error in forward lifecycle to OEM closed\n");
  271. return -EIO;
  272. }
  273. printf("Change to OEM closed successfully\n");
  274. return 0;
  275. }
  276. U_BOOT_CMD(auth_cntr, CONFIG_SYS_MAXARGS, 1, do_authenticate,
  277. "autenticate OS container via AHAB",
  278. "addr\n"
  279. "addr - OS container hex address\n"
  280. );
  281. U_BOOT_CMD(ahab_status, CONFIG_SYS_MAXARGS, 1, do_ahab_status,
  282. "display AHAB lifecycle and events from seco",
  283. ""
  284. );
  285. U_BOOT_CMD(ahab_close, CONFIG_SYS_MAXARGS, 1, do_ahab_close,
  286. "Change AHAB lifecycle to OEM closed",
  287. ""
  288. );