1 // SPDX-License-Identifier: GPL-2.0
3 * (C) Copyright 2018 Xilinx, Inc.
4 * Siva Durga Prasad Paladugu <siva.durga.paladugu@xilinx.com>
10 #include <zynqmp_firmware.h>
11 #include <asm/arch/hardware.h>
12 #include <asm/arch/sys_proto.h>
15 static int do_zynqmp_verify_secure(cmd_tbl_t *cmdtp, int flag, int argc,
19 u32 len, src_lo, src_hi;
24 u32 ret_payload[PAYLOAD_ARG_CNT];
29 src_addr = simple_strtoull(argv[2], NULL, 16);
30 len = simple_strtoul(argv[3], NULL, 16);
33 key_ptr = (uint8_t *)(uintptr_t)simple_strtoull(argv[4],
36 if ((ulong)src_addr != ALIGN((ulong)src_addr,
37 CONFIG_SYS_CACHELINE_SIZE)) {
38 printf("Failed: source address not aligned:%lx\n",
43 src_lo = lower_32_bits((ulong)src_addr);
44 src_hi = upper_32_bits((ulong)src_addr);
45 flush_dcache_range((ulong)src_addr, (ulong)(src_addr + len));
48 key_lo = lower_32_bits((ulong)key_ptr);
49 key_hi = upper_32_bits((ulong)key_ptr);
50 flush_dcache_range((ulong)key_ptr,
51 (ulong)(key_ptr + KEY_PTR_LEN));
54 ret = invoke_smc(ZYNQMP_SIP_SVC_PM_SECURE_IMG_LOAD, src_lo, src_hi,
55 key_lo, key_hi, ret_payload);
57 printf("Failed: secure op status:0x%x\n", ret);
59 addr = (u64)ret_payload[1] << 32 | ret_payload[2];
60 printf("Verified image at 0x%llx\n", addr);
61 env_set_hex("zynqmp_verified_img_addr", addr);
67 static int do_zynqmp_mmio_read(cmd_tbl_t *cmdtp, int flag, int argc,
73 if (argc != cmdtp->maxargs)
76 addr = simple_strtoul(argv[2], NULL, 16);
78 ret = zynqmp_mmio_read(addr, &read_val);
80 printf("mmio read value at 0x%x = 0x%x\n",
83 printf("Failed: mmio read\n");
88 static int do_zynqmp_mmio_write(cmd_tbl_t *cmdtp, int flag, int argc,
94 if (argc != cmdtp->maxargs)
97 addr = simple_strtoul(argv[2], NULL, 16);
98 mask = simple_strtoul(argv[3], NULL, 16);
99 val = simple_strtoul(argv[4], NULL, 16);
101 ret = zynqmp_mmio_write(addr, mask, val);
103 printf("Failed: mmio write\n");
108 #ifdef CONFIG_DEFINE_TCM_OCM_MMAP
109 static int do_zynqmp_tcm_init(cmd_tbl_t *cmdtp, int flag, int argc,
114 if (argc != cmdtp->maxargs)
115 return CMD_RET_USAGE;
117 mode = simple_strtoul(argv[2], NULL, 16);
118 if (mode != TCM_LOCK && mode != TCM_SPLIT) {
119 printf("Mode should be either 0(lock)/1(split)\n");
120 return CMD_RET_FAILURE;
127 return CMD_RET_SUCCESS;
131 static cmd_tbl_t cmd_zynqmp_sub[] = {
132 U_BOOT_CMD_MKENT(secure, 5, 0, do_zynqmp_verify_secure, "", ""),
133 U_BOOT_CMD_MKENT(mmio_read, 3, 0, do_zynqmp_mmio_read, "", ""),
134 U_BOOT_CMD_MKENT(mmio_write, 5, 0, do_zynqmp_mmio_write, "", ""),
135 #ifdef CONFIG_DEFINE_TCM_OCM_MMAP
136 U_BOOT_CMD_MKENT(tcminit, 3, 0, do_zynqmp_tcm_init, "", ""),
141 * do_zynqmp - Handle the "zynqmp" command-line command
142 * @cmdtp: Command data struct pointer
143 * @flag: Command flag
144 * @argc: Command-line argument count
145 * @argv: Array of command-line arguments
147 * Processes the zynqmp specific commands
149 * Return: return 0 on success and CMD_RET_USAGE incase of misuse and error
151 static int do_zynqmp(cmd_tbl_t *cmdtp, int flag, int argc,
157 return CMD_RET_USAGE;
159 c = find_cmd_tbl(argv[1], &cmd_zynqmp_sub[0],
160 ARRAY_SIZE(cmd_zynqmp_sub));
163 return c->cmd(c, flag, argc, argv);
165 return CMD_RET_USAGE;
168 /***************************************************/
169 #ifdef CONFIG_SYS_LONGHELP
170 static char zynqmp_help_text[] =
171 "secure src len [key_addr] - verifies secure images of $len bytes\n"
172 " long at address $src. Optional key_addr\n"
173 " can be specified if user key needs to\n"
174 " be used for decryption\n"
175 "zynqmp mmio_read address - read from address\n"
176 "zynqmp mmio_write address mask value - write value after masking to\n"
178 #ifdef CONFIG_DEFINE_TCM_OCM_MMAP
179 "zynqmp tcminit mode - Initialize the TCM with zeros. TCM needs to be\n"
180 " initialized before accessing to avoid ECC\n"
181 " errors. mode specifies in which mode TCM has\n"
182 " to be initialized. Supported modes will be\n"
183 " lock(0)/split(1)\n"
189 zynqmp, 5, 1, do_zynqmp,