1 // SPDX-License-Identifier: GPL-2.0+
3 * (C) Copyright 2014, Cavium Inc.
10 #include <asm/ptrace.h>
12 #include <asm/system.h>
13 #include <cavium/thunderx_svc.h>
14 #include <cavium/atf.h>
15 #include <cavium/atf_part.h>
21 ssize_t atf_read_mmc(uintptr_t offset, void *buffer, size_t size)
24 regs.regs[0] = THUNDERX_MMC_READ;
25 regs.regs[1] = offset;
27 regs.regs[3] = (uintptr_t)buffer;
34 ssize_t atf_read_nor(uintptr_t offset, void *buffer, size_t size)
37 regs.regs[0] = THUNDERX_NOR_READ;
38 regs.regs[1] = offset;
40 regs.regs[3] = (uintptr_t)buffer;
47 ssize_t atf_get_pcount(void)
50 regs.regs[0] = THUNDERX_PART_COUNT;
57 ssize_t atf_get_part(struct storage_partition *part, unsigned int index)
60 regs.regs[0] = THUNDERX_GET_PART;
61 regs.regs[1] = (uintptr_t)part;
69 ssize_t atf_erase_nor(uintptr_t offset, size_t size)
73 regs.regs[0] = THUNDERX_NOR_ERASE;
74 regs.regs[1] = offset;
81 ssize_t atf_write_nor(uintptr_t offset, const void *buffer, size_t size)
85 regs.regs[0] = THUNDERX_NOR_WRITE;
86 regs.regs[1] = offset;
88 regs.regs[3] = (uintptr_t)buffer;
95 ssize_t atf_write_mmc(uintptr_t offset, const void *buffer, size_t size)
99 regs.regs[0] = THUNDERX_MMC_WRITE;
100 regs.regs[1] = offset;
102 regs.regs[3] = (uintptr_t)buffer;
109 ssize_t atf_dram_size(unsigned int node)
112 regs.regs[0] = THUNDERX_DRAM_SIZE;
120 ssize_t atf_node_count(void)
123 regs.regs[0] = THUNDERX_NODE_COUNT;
130 ssize_t atf_env_count(void)
133 regs.regs[0] = THUNDERX_ENV_COUNT;
140 ssize_t atf_env_string(size_t index, char *str)
142 uint64_t *buf = (void *)str;
144 regs.regs[0] = THUNDERX_ENV_STRING;
145 regs.regs[1] = index;
150 buf[0] = regs.regs[0];
151 buf[1] = regs.regs[1];
152 buf[2] = regs.regs[2];
153 buf[3] = regs.regs[3];
161 #ifdef CONFIG_CMD_ATF
163 static void atf_print_ver(void)
166 regs.regs[0] = ARM_STD_SVC_VERSION;
170 printf("ARM Std FW version: %ld.%ld\n", regs.regs[0], regs.regs[1]);
172 regs.regs[0] = THUNDERX_SVC_VERSION;
176 printf("ThunderX OEM ver: %ld.%ld\n", regs.regs[0], regs.regs[1]);
179 static void atf_print_uid(void)
183 static void atf_print_part_table(void)
190 struct storage_partition *part = (void *)CONFIG_SYS_LOWMEM_BASE;
192 pcount = atf_get_pcount();
194 printf("Partition count: %lu\n\n", pcount);
195 printf("%10s %10s %10s\n", "Type", "Size", "Offset");
197 for (i = 0; i < pcount; i++) {
198 ret = atf_get_part(part, i);
201 printf("Uknown error while reading partition: %d\n",
206 switch (part->type) {
207 case PARTITION_NBL1FW_REST:
210 case PARTITION_BL2_BL31:
213 case PARTITION_UBOOT:
216 case PARTITION_KERNEL:
219 case PARTITION_DEVICE_TREE:
225 printf("%10s %10d %10lx\n", ptype, part->size, part->offset);
229 int do_atf(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
234 unsigned int index, node;
235 char str[4 * sizeof(uint64_t)];
237 if ((argc == 5) && !strcmp(argv[1], "readmmc")) {
238 buffer = (void *)hextoul(argv[2], NULL);
239 offset = simple_strtoul(argv[3], NULL, 10);
240 size = simple_strtoul(argv[4], NULL, 10);
242 ret = atf_read_mmc(offset, buffer, size);
243 } else if ((argc == 5) && !strcmp(argv[1], "readnor")) {
244 buffer = (void *)hextoul(argv[2], NULL);
245 offset = simple_strtoul(argv[3], NULL, 10);
246 size = simple_strtoul(argv[4], NULL, 10);
248 ret = atf_read_nor(offset, buffer, size);
249 } else if ((argc == 5) && !strcmp(argv[1], "writemmc")) {
250 buffer = (void *)hextoul(argv[2], NULL);
251 offset = simple_strtoul(argv[3], NULL, 10);
252 size = simple_strtoul(argv[4], NULL, 10);
254 ret = atf_write_mmc(offset, buffer, size);
255 } else if ((argc == 5) && !strcmp(argv[1], "writenor")) {
256 buffer = (void *)hextoul(argv[2], NULL);
257 offset = simple_strtoul(argv[3], NULL, 10);
258 size = simple_strtoul(argv[4], NULL, 10);
260 ret = atf_write_nor(offset, buffer, size);
261 } else if ((argc == 2) && !strcmp(argv[1], "part")) {
262 atf_print_part_table();
263 } else if ((argc == 4) && !strcmp(argv[1], "erasenor")) {
264 offset = simple_strtoul(argv[2], NULL, 10);
265 size = simple_strtoul(argv[3], NULL, 10);
267 ret = atf_erase_nor(offset, size);
268 } else if ((argc == 2) && !strcmp(argv[1], "envcount")) {
269 ret = atf_env_count();
270 printf("Number of environment strings: %zd\n", ret);
271 } else if ((argc == 3) && !strcmp(argv[1], "envstring")) {
272 index = simple_strtoul(argv[2], NULL, 10);
273 ret = atf_env_string(index, str);
275 printf("Environment string %d: %s\n", index, str);
277 printf("Return code: %zd\n", ret);
278 } else if ((argc == 3) && !strcmp(argv[1], "dramsize")) {
279 node = simple_strtoul(argv[2], NULL, 10);
280 ret = atf_dram_size(node);
281 printf("DRAM size: %zd Mbytes\n", ret >> 20);
282 } else if ((argc == 2) && !strcmp(argv[1], "nodes")) {
283 ret = atf_node_count();
284 printf("Nodes count: %zd\n", ret);
285 } else if ((argc == 2) && !strcmp(argv[1], "ver")) {
287 } else if ((argc == 2) && !strcmp(argv[1], "uid")) {
290 return CMD_RET_USAGE;
298 "issue calls to ATF",
299 "\t readmmc addr offset size - read MMC card\n"
300 "\t readnor addr offset size - read NOR flash\n"
301 "\t writemmc addr offset size - write MMC card\n"
302 "\t writenor addr offset size - write NOR flash\n"
303 "\t erasenor offset size - erase NOR flash\n"
304 "\t nodes - number of nodes\n"
305 "\t dramsize node - size of DRAM attached to node\n"
306 "\t envcount - number of environment strings\n"
307 "\t envstring index - print the environment string\n"
308 "\t part - print MMC partition table\n"
309 "\t ver - print ATF call set versions\n"