1 // SPDX-License-Identifier: GPL-2.0+
3 * (C) Copyright 2014, Cavium Inc.
10 #include <asm/system.h>
11 #include <cavium/thunderx_svc.h>
12 #include <cavium/atf.h>
13 #include <cavium/atf_part.h>
19 ssize_t atf_read_mmc(uintptr_t offset, void *buffer, size_t size)
22 regs.regs[0] = THUNDERX_MMC_READ;
23 regs.regs[1] = offset;
25 regs.regs[3] = (uintptr_t)buffer;
32 ssize_t atf_read_nor(uintptr_t offset, void *buffer, size_t size)
35 regs.regs[0] = THUNDERX_NOR_READ;
36 regs.regs[1] = offset;
38 regs.regs[3] = (uintptr_t)buffer;
45 ssize_t atf_get_pcount(void)
48 regs.regs[0] = THUNDERX_PART_COUNT;
55 ssize_t atf_get_part(struct storage_partition *part, unsigned int index)
58 regs.regs[0] = THUNDERX_GET_PART;
59 regs.regs[1] = (uintptr_t)part;
67 ssize_t atf_erase_nor(uintptr_t offset, size_t size)
71 regs.regs[0] = THUNDERX_NOR_ERASE;
72 regs.regs[1] = offset;
79 ssize_t atf_write_nor(uintptr_t offset, const void *buffer, size_t size)
83 regs.regs[0] = THUNDERX_NOR_WRITE;
84 regs.regs[1] = offset;
86 regs.regs[3] = (uintptr_t)buffer;
93 ssize_t atf_write_mmc(uintptr_t offset, const void *buffer, size_t size)
97 regs.regs[0] = THUNDERX_MMC_WRITE;
98 regs.regs[1] = offset;
100 regs.regs[3] = (uintptr_t)buffer;
107 ssize_t atf_dram_size(unsigned int node)
110 regs.regs[0] = THUNDERX_DRAM_SIZE;
118 ssize_t atf_node_count(void)
121 regs.regs[0] = THUNDERX_NODE_COUNT;
128 ssize_t atf_env_count(void)
131 regs.regs[0] = THUNDERX_ENV_COUNT;
138 ssize_t atf_env_string(size_t index, char *str)
140 uint64_t *buf = (void *)str;
142 regs.regs[0] = THUNDERX_ENV_STRING;
143 regs.regs[1] = index;
148 buf[0] = regs.regs[0];
149 buf[1] = regs.regs[1];
150 buf[2] = regs.regs[2];
151 buf[3] = regs.regs[3];
159 #ifdef CONFIG_CMD_ATF
161 static void atf_print_ver(void)
164 regs.regs[0] = ARM_STD_SVC_VERSION;
168 printf("ARM Std FW version: %ld.%ld\n", regs.regs[0], regs.regs[1]);
170 regs.regs[0] = THUNDERX_SVC_VERSION;
174 printf("ThunderX OEM ver: %ld.%ld\n", regs.regs[0], regs.regs[1]);
177 static void atf_print_uid(void)
181 static void atf_print_part_table(void)
188 struct storage_partition *part = (void *)CONFIG_SYS_LOWMEM_BASE;
190 pcount = atf_get_pcount();
192 printf("Partition count: %lu\n\n", pcount);
193 printf("%10s %10s %10s\n", "Type", "Size", "Offset");
195 for (i = 0; i < pcount; i++) {
196 ret = atf_get_part(part, i);
199 printf("Uknown error while reading partition: %d\n",
204 switch (part->type) {
205 case PARTITION_NBL1FW_REST:
208 case PARTITION_BL2_BL31:
211 case PARTITION_UBOOT:
214 case PARTITION_KERNEL:
217 case PARTITION_DEVICE_TREE:
223 printf("%10s %10d %10lx\n", ptype, part->size, part->offset);
227 int do_atf(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
232 unsigned int index, node;
233 char str[4 * sizeof(uint64_t)];
235 if ((argc == 5) && !strcmp(argv[1], "readmmc")) {
236 buffer = (void *)simple_strtoul(argv[2], NULL, 16);
237 offset = simple_strtoul(argv[3], NULL, 10);
238 size = simple_strtoul(argv[4], NULL, 10);
240 ret = atf_read_mmc(offset, buffer, size);
241 } else if ((argc == 5) && !strcmp(argv[1], "readnor")) {
242 buffer = (void *)simple_strtoul(argv[2], NULL, 16);
243 offset = simple_strtoul(argv[3], NULL, 10);
244 size = simple_strtoul(argv[4], NULL, 10);
246 ret = atf_read_nor(offset, buffer, size);
247 } else if ((argc == 5) && !strcmp(argv[1], "writemmc")) {
248 buffer = (void *)simple_strtoul(argv[2], NULL, 16);
249 offset = simple_strtoul(argv[3], NULL, 10);
250 size = simple_strtoul(argv[4], NULL, 10);
252 ret = atf_write_mmc(offset, buffer, size);
253 } else if ((argc == 5) && !strcmp(argv[1], "writenor")) {
254 buffer = (void *)simple_strtoul(argv[2], NULL, 16);
255 offset = simple_strtoul(argv[3], NULL, 10);
256 size = simple_strtoul(argv[4], NULL, 10);
258 ret = atf_write_nor(offset, buffer, size);
259 } else if ((argc == 2) && !strcmp(argv[1], "part")) {
260 atf_print_part_table();
261 } else if ((argc == 4) && !strcmp(argv[1], "erasenor")) {
262 offset = simple_strtoul(argv[2], NULL, 10);
263 size = simple_strtoul(argv[3], NULL, 10);
265 ret = atf_erase_nor(offset, size);
266 } else if ((argc == 2) && !strcmp(argv[1], "envcount")) {
267 ret = atf_env_count();
268 printf("Number of environment strings: %zd\n", ret);
269 } else if ((argc == 3) && !strcmp(argv[1], "envstring")) {
270 index = simple_strtoul(argv[2], NULL, 10);
271 ret = atf_env_string(index, str);
273 printf("Environment string %d: %s\n", index, str);
275 printf("Return code: %zd\n", ret);
276 } else if ((argc == 3) && !strcmp(argv[1], "dramsize")) {
277 node = simple_strtoul(argv[2], NULL, 10);
278 ret = atf_dram_size(node);
279 printf("DRAM size: %zd Mbytes\n", ret >> 20);
280 } else if ((argc == 2) && !strcmp(argv[1], "nodes")) {
281 ret = atf_node_count();
282 printf("Nodes count: %zd\n", ret);
283 } else if ((argc == 2) && !strcmp(argv[1], "ver")) {
285 } else if ((argc == 2) && !strcmp(argv[1], "uid")) {
288 return CMD_RET_USAGE;
296 "issue calls to ATF",
297 "\t readmmc addr offset size - read MMC card\n"
298 "\t readnor addr offset size - read NOR flash\n"
299 "\t writemmc addr offset size - write MMC card\n"
300 "\t writenor addr offset size - write NOR flash\n"
301 "\t erasenor offset size - erase NOR flash\n"
302 "\t nodes - number of nodes\n"
303 "\t dramsize node - size of DRAM attached to node\n"
304 "\t envcount - number of environment strings\n"
305 "\t envstring index - print the environment string\n"
306 "\t part - print MMC partition table\n"
307 "\t ver - print ATF call set versions\n"