1 // SPDX-License-Identifier: GPL-2.0+
3 * (C) Copyright 2014, Cavium Inc.
11 #include <asm/system.h>
12 #include <cavium/thunderx_svc.h>
13 #include <cavium/atf.h>
14 #include <cavium/atf_part.h>
20 ssize_t atf_read_mmc(uintptr_t offset, void *buffer, size_t size)
23 regs.regs[0] = THUNDERX_MMC_READ;
24 regs.regs[1] = offset;
26 regs.regs[3] = (uintptr_t)buffer;
33 ssize_t atf_read_nor(uintptr_t offset, void *buffer, size_t size)
36 regs.regs[0] = THUNDERX_NOR_READ;
37 regs.regs[1] = offset;
39 regs.regs[3] = (uintptr_t)buffer;
46 ssize_t atf_get_pcount(void)
49 regs.regs[0] = THUNDERX_PART_COUNT;
56 ssize_t atf_get_part(struct storage_partition *part, unsigned int index)
59 regs.regs[0] = THUNDERX_GET_PART;
60 regs.regs[1] = (uintptr_t)part;
68 ssize_t atf_erase_nor(uintptr_t offset, size_t size)
72 regs.regs[0] = THUNDERX_NOR_ERASE;
73 regs.regs[1] = offset;
80 ssize_t atf_write_nor(uintptr_t offset, const void *buffer, size_t size)
84 regs.regs[0] = THUNDERX_NOR_WRITE;
85 regs.regs[1] = offset;
87 regs.regs[3] = (uintptr_t)buffer;
94 ssize_t atf_write_mmc(uintptr_t offset, const void *buffer, size_t size)
98 regs.regs[0] = THUNDERX_MMC_WRITE;
99 regs.regs[1] = offset;
101 regs.regs[3] = (uintptr_t)buffer;
108 ssize_t atf_dram_size(unsigned int node)
111 regs.regs[0] = THUNDERX_DRAM_SIZE;
119 ssize_t atf_node_count(void)
122 regs.regs[0] = THUNDERX_NODE_COUNT;
129 ssize_t atf_env_count(void)
132 regs.regs[0] = THUNDERX_ENV_COUNT;
139 ssize_t atf_env_string(size_t index, char *str)
141 uint64_t *buf = (void *)str;
143 regs.regs[0] = THUNDERX_ENV_STRING;
144 regs.regs[1] = index;
149 buf[0] = regs.regs[0];
150 buf[1] = regs.regs[1];
151 buf[2] = regs.regs[2];
152 buf[3] = regs.regs[3];
160 #ifdef CONFIG_CMD_ATF
162 static void atf_print_ver(void)
165 regs.regs[0] = ARM_STD_SVC_VERSION;
169 printf("ARM Std FW version: %ld.%ld\n", regs.regs[0], regs.regs[1]);
171 regs.regs[0] = THUNDERX_SVC_VERSION;
175 printf("ThunderX OEM ver: %ld.%ld\n", regs.regs[0], regs.regs[1]);
178 static void atf_print_uid(void)
182 static void atf_print_part_table(void)
189 struct storage_partition *part = (void *)CONFIG_SYS_LOWMEM_BASE;
191 pcount = atf_get_pcount();
193 printf("Partition count: %lu\n\n", pcount);
194 printf("%10s %10s %10s\n", "Type", "Size", "Offset");
196 for (i = 0; i < pcount; i++) {
197 ret = atf_get_part(part, i);
200 printf("Uknown error while reading partition: %d\n",
205 switch (part->type) {
206 case PARTITION_NBL1FW_REST:
209 case PARTITION_BL2_BL31:
212 case PARTITION_UBOOT:
215 case PARTITION_KERNEL:
218 case PARTITION_DEVICE_TREE:
224 printf("%10s %10d %10lx\n", ptype, part->size, part->offset);
228 int do_atf(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
233 unsigned int index, node;
234 char str[4 * sizeof(uint64_t)];
236 if ((argc == 5) && !strcmp(argv[1], "readmmc")) {
237 buffer = (void *)simple_strtoul(argv[2], NULL, 16);
238 offset = simple_strtoul(argv[3], NULL, 10);
239 size = simple_strtoul(argv[4], NULL, 10);
241 ret = atf_read_mmc(offset, buffer, size);
242 } else if ((argc == 5) && !strcmp(argv[1], "readnor")) {
243 buffer = (void *)simple_strtoul(argv[2], NULL, 16);
244 offset = simple_strtoul(argv[3], NULL, 10);
245 size = simple_strtoul(argv[4], NULL, 10);
247 ret = atf_read_nor(offset, buffer, size);
248 } else if ((argc == 5) && !strcmp(argv[1], "writemmc")) {
249 buffer = (void *)simple_strtoul(argv[2], NULL, 16);
250 offset = simple_strtoul(argv[3], NULL, 10);
251 size = simple_strtoul(argv[4], NULL, 10);
253 ret = atf_write_mmc(offset, buffer, size);
254 } else if ((argc == 5) && !strcmp(argv[1], "writenor")) {
255 buffer = (void *)simple_strtoul(argv[2], NULL, 16);
256 offset = simple_strtoul(argv[3], NULL, 10);
257 size = simple_strtoul(argv[4], NULL, 10);
259 ret = atf_write_nor(offset, buffer, size);
260 } else if ((argc == 2) && !strcmp(argv[1], "part")) {
261 atf_print_part_table();
262 } else if ((argc == 4) && !strcmp(argv[1], "erasenor")) {
263 offset = simple_strtoul(argv[2], NULL, 10);
264 size = simple_strtoul(argv[3], NULL, 10);
266 ret = atf_erase_nor(offset, size);
267 } else if ((argc == 2) && !strcmp(argv[1], "envcount")) {
268 ret = atf_env_count();
269 printf("Number of environment strings: %zd\n", ret);
270 } else if ((argc == 3) && !strcmp(argv[1], "envstring")) {
271 index = simple_strtoul(argv[2], NULL, 10);
272 ret = atf_env_string(index, str);
274 printf("Environment string %d: %s\n", index, str);
276 printf("Return code: %zd\n", ret);
277 } else if ((argc == 3) && !strcmp(argv[1], "dramsize")) {
278 node = simple_strtoul(argv[2], NULL, 10);
279 ret = atf_dram_size(node);
280 printf("DRAM size: %zd Mbytes\n", ret >> 20);
281 } else if ((argc == 2) && !strcmp(argv[1], "nodes")) {
282 ret = atf_node_count();
283 printf("Nodes count: %zd\n", ret);
284 } else if ((argc == 2) && !strcmp(argv[1], "ver")) {
286 } else if ((argc == 2) && !strcmp(argv[1], "uid")) {
289 return CMD_RET_USAGE;
297 "issue calls to ATF",
298 "\t readmmc addr offset size - read MMC card\n"
299 "\t readnor addr offset size - read NOR flash\n"
300 "\t writemmc addr offset size - write MMC card\n"
301 "\t writenor addr offset size - write NOR flash\n"
302 "\t erasenor offset size - erase NOR flash\n"
303 "\t nodes - number of nodes\n"
304 "\t dramsize node - size of DRAM attached to node\n"
305 "\t envcount - number of environment strings\n"
306 "\t envstring index - print the environment string\n"
307 "\t part - print MMC partition table\n"
308 "\t ver - print ATF call set versions\n"