blob: 919a0bf6e780c8d609e3145a01dd161626be4521 [file] [log] [blame]
Gerald Van Baren781e09e2007-03-31 12:22:10 -04001/*
2 * (C) Copyright 2007
3 * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com
4 * Based on code written by:
5 * Pantelis Antoniou <pantelis.antoniou@gmail.com> and
6 * Matthew McClintock <msm@freescale.com>
7 *
8 * See file CREDITS for list of people who contributed to this
9 * project.
10 *
11 * This program is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU General Public License as
13 * published by the Free Software Foundation; either version 2 of
14 * the License, or (at your option) any later version.
15 *
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
24 * MA 02111-1307 USA
25 */
26
27#include <common.h>
28#include <command.h>
29#include <linux/ctype.h>
30#include <linux/types.h>
Gerald Van Baren781e09e2007-03-31 12:22:10 -040031#include <asm/global_data.h>
32#include <fdt.h>
33#include <libfdt.h>
Gerald Van Baren64dbbd42007-04-06 14:19:43 -040034#include <fdt_support.h>
Gerald Van Baren781e09e2007-03-31 12:22:10 -040035
36#define MAX_LEVEL 32 /* how deeply nested we will go */
Gerald Van Barenfd61e552007-06-25 23:25:28 -040037#define SCRATCHPAD 1024 /* bytes of scratchpad memory */
Gerald Van Baren781e09e2007-03-31 12:22:10 -040038
39/*
40 * Global data (for the gd->bd)
41 */
42DECLARE_GLOBAL_DATA_PTR;
43
Gerald Van Baren781e09e2007-03-31 12:22:10 -040044static int fdt_valid(void);
Andy Fleming4abd8442008-03-31 20:45:56 -050045static int fdt_parse_prop(char **newval, int count, char *data, int *len);
Kumar Galadbaf07c2007-11-21 14:07:46 -060046static int fdt_print(const char *pathp, char *prop, int depth);
Gerald Van Baren781e09e2007-03-31 12:22:10 -040047
Gerald Van Baren781e09e2007-03-31 12:22:10 -040048/*
Gerald Van Barenae9e97f2008-06-10 22:15:58 -040049 * The working_fdt points to our working flattened device tree.
50 */
51struct fdt_header *working_fdt;
52
Kumar Gala54f9c862008-08-15 08:24:39 -050053void set_working_fdt_addr(void *addr)
54{
55 char buf[17];
56
57 working_fdt = addr;
58
59 sprintf(buf, "%lx", (unsigned long)addr);
60 setenv("fdtaddr", buf);
61}
62
Gerald Van Barenae9e97f2008-06-10 22:15:58 -040063/*
Gerald Van Baren781e09e2007-03-31 12:22:10 -040064 * Flattened Device Tree command, see the help for parameter definitions.
65 */
66int do_fdt (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
67{
Gerald Van Baren781e09e2007-03-31 12:22:10 -040068 if (argc < 2) {
Peter Tyser62c3ae72009-01-27 18:03:10 -060069 cmd_usage(cmdtp);
Gerald Van Baren781e09e2007-03-31 12:22:10 -040070 return 1;
71 }
72
Gerald Van Baren781e09e2007-03-31 12:22:10 -040073 /********************************************************************
74 * Set the address of the fdt
75 ********************************************************************/
Gerald Van Baren25114032007-05-12 09:47:25 -040076 if (argv[1][0] == 'a') {
Kumar Gala54f9c862008-08-15 08:24:39 -050077 unsigned long addr;
Gerald Van Baren781e09e2007-03-31 12:22:10 -040078 /*
79 * Set the address [and length] of the fdt.
80 */
Kumar Gala7dbc38a2008-08-15 08:24:35 -050081 if (argc == 2) {
82 if (!fdt_valid()) {
83 return 1;
84 }
85 printf("The address of the fdt is %p\n", working_fdt);
86 return 0;
87 }
88
Kumar Gala54f9c862008-08-15 08:24:39 -050089 addr = simple_strtoul(argv[2], NULL, 16);
90 set_working_fdt_addr((void *)addr);
Gerald Van Baren781e09e2007-03-31 12:22:10 -040091
92 if (!fdt_valid()) {
93 return 1;
94 }
95
96 if (argc >= 4) {
97 int len;
98 int err;
99 /*
100 * Optional new length
101 */
Gerald Van Baren91623522007-11-22 17:23:23 -0500102 len = simple_strtoul(argv[3], NULL, 16);
Kim Phillipse489b9c2008-06-10 11:06:17 -0500103 if (len < fdt_totalsize(working_fdt)) {
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400104 printf ("New length %d < existing length %d, "
105 "ignoring.\n",
Kim Phillipse489b9c2008-06-10 11:06:17 -0500106 len, fdt_totalsize(working_fdt));
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400107 } else {
108 /*
109 * Open in place with a new length.
110 */
Kim Phillipse489b9c2008-06-10 11:06:17 -0500111 err = fdt_open_into(working_fdt, working_fdt, len);
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400112 if (err != 0) {
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400113 printf ("libfdt fdt_open_into(): %s\n",
114 fdt_strerror(err));
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400115 }
116 }
117 }
118
119 /********************************************************************
Kim Phillipse489b9c2008-06-10 11:06:17 -0500120 * Move the working_fdt
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400121 ********************************************************************/
Gerald Van Baren2fb698b2008-06-09 21:02:17 -0400122 } else if (strncmp(argv[1], "mo", 2) == 0) {
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400123 struct fdt_header *newaddr;
124 int len;
125 int err;
126
Gerald Van Baren6be07cc2007-04-25 22:47:15 -0400127 if (argc < 4) {
Peter Tyser62c3ae72009-01-27 18:03:10 -0600128 cmd_usage(cmdtp);
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400129 return 1;
130 }
131
132 /*
133 * Set the address and length of the fdt.
134 */
Kim Phillipse489b9c2008-06-10 11:06:17 -0500135 working_fdt = (struct fdt_header *)simple_strtoul(argv[2], NULL, 16);
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400136 if (!fdt_valid()) {
137 return 1;
138 }
139
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400140 newaddr = (struct fdt_header *)simple_strtoul(argv[3],NULL,16);
Gerald Van Baren6be07cc2007-04-25 22:47:15 -0400141
142 /*
143 * If the user specifies a length, use that. Otherwise use the
144 * current length.
145 */
146 if (argc <= 4) {
Kim Phillipse489b9c2008-06-10 11:06:17 -0500147 len = fdt_totalsize(working_fdt);
Gerald Van Baren6be07cc2007-04-25 22:47:15 -0400148 } else {
149 len = simple_strtoul(argv[4], NULL, 16);
Kim Phillipse489b9c2008-06-10 11:06:17 -0500150 if (len < fdt_totalsize(working_fdt)) {
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400151 printf ("New length 0x%X < existing length "
152 "0x%X, aborting.\n",
Kim Phillipse489b9c2008-06-10 11:06:17 -0500153 len, fdt_totalsize(working_fdt));
Gerald Van Baren6be07cc2007-04-25 22:47:15 -0400154 return 1;
155 }
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400156 }
157
158 /*
159 * Copy to the new location.
160 */
Kim Phillipse489b9c2008-06-10 11:06:17 -0500161 err = fdt_open_into(working_fdt, newaddr, len);
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400162 if (err != 0) {
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400163 printf ("libfdt fdt_open_into(): %s\n",
164 fdt_strerror(err));
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400165 return 1;
166 }
Kim Phillipse489b9c2008-06-10 11:06:17 -0500167 working_fdt = newaddr;
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400168
169 /********************************************************************
Gerald Van Baren25114032007-05-12 09:47:25 -0400170 * Make a new node
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400171 ********************************************************************/
Gerald Van Baren2fb698b2008-06-09 21:02:17 -0400172 } else if (strncmp(argv[1], "mk", 2) == 0) {
Gerald Van Baren25114032007-05-12 09:47:25 -0400173 char *pathp; /* path */
174 char *nodep; /* new node to add */
175 int nodeoffset; /* node offset from libfdt */
176 int err;
177
178 /*
179 * Parameters: Node path, new node to be appended to the path.
180 */
181 if (argc < 4) {
Peter Tyser62c3ae72009-01-27 18:03:10 -0600182 cmd_usage(cmdtp);
Gerald Van Baren25114032007-05-12 09:47:25 -0400183 return 1;
184 }
185
186 pathp = argv[2];
187 nodep = argv[3];
188
Kim Phillipse489b9c2008-06-10 11:06:17 -0500189 nodeoffset = fdt_path_offset (working_fdt, pathp);
Gerald Van Baren25114032007-05-12 09:47:25 -0400190 if (nodeoffset < 0) {
191 /*
192 * Not found or something else bad happened.
193 */
Kumar Gala8d04f022007-10-24 11:04:22 -0500194 printf ("libfdt fdt_path_offset() returned %s\n",
Gerald Van Baren06e19a02007-05-21 23:27:16 -0400195 fdt_strerror(nodeoffset));
Gerald Van Baren25114032007-05-12 09:47:25 -0400196 return 1;
197 }
Kim Phillipse489b9c2008-06-10 11:06:17 -0500198 err = fdt_add_subnode(working_fdt, nodeoffset, nodep);
Gerald Van Baren25114032007-05-12 09:47:25 -0400199 if (err < 0) {
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400200 printf ("libfdt fdt_add_subnode(): %s\n",
201 fdt_strerror(err));
Gerald Van Baren25114032007-05-12 09:47:25 -0400202 return 1;
203 }
204
205 /********************************************************************
Kim Phillipse489b9c2008-06-10 11:06:17 -0500206 * Set the value of a property in the working_fdt.
Gerald Van Baren25114032007-05-12 09:47:25 -0400207 ********************************************************************/
208 } else if (argv[1][0] == 's') {
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400209 char *pathp; /* path */
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400210 char *prop; /* property */
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400211 int nodeoffset; /* node offset from libfdt */
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400212 static char data[SCRATCHPAD]; /* storage for the property */
213 int len; /* new length of the property */
214 int ret; /* return value */
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400215
216 /*
Gerald Van Barenea6d8be2008-01-05 14:52:04 -0500217 * Parameters: Node path, property, optional value.
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400218 */
Gerald Van Barenea6d8be2008-01-05 14:52:04 -0500219 if (argc < 4) {
Peter Tyser62c3ae72009-01-27 18:03:10 -0600220 cmd_usage(cmdtp);
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400221 return 1;
222 }
223
224 pathp = argv[2];
225 prop = argv[3];
Gerald Van Barenea6d8be2008-01-05 14:52:04 -0500226 if (argc == 4) {
227 len = 0;
228 } else {
Andy Fleming4abd8442008-03-31 20:45:56 -0500229 ret = fdt_parse_prop(&argv[4], argc - 4, data, &len);
Gerald Van Barenea6d8be2008-01-05 14:52:04 -0500230 if (ret != 0)
231 return ret;
232 }
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400233
Kim Phillipse489b9c2008-06-10 11:06:17 -0500234 nodeoffset = fdt_path_offset (working_fdt, pathp);
Gerald Van Baren25114032007-05-12 09:47:25 -0400235 if (nodeoffset < 0) {
236 /*
237 * Not found or something else bad happened.
238 */
Kumar Gala8d04f022007-10-24 11:04:22 -0500239 printf ("libfdt fdt_path_offset() returned %s\n",
Gerald Van Baren06e19a02007-05-21 23:27:16 -0400240 fdt_strerror(nodeoffset));
Gerald Van Baren25114032007-05-12 09:47:25 -0400241 return 1;
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400242 }
Gerald Van Baren25114032007-05-12 09:47:25 -0400243
Kim Phillipse489b9c2008-06-10 11:06:17 -0500244 ret = fdt_setprop(working_fdt, nodeoffset, prop, data, len);
Gerald Van Baren25114032007-05-12 09:47:25 -0400245 if (ret < 0) {
246 printf ("libfdt fdt_setprop(): %s\n", fdt_strerror(ret));
247 return 1;
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400248 }
249
250 /********************************************************************
251 * Print (recursive) / List (single level)
252 ********************************************************************/
Gerald Van Baren25114032007-05-12 09:47:25 -0400253 } else if ((argv[1][0] == 'p') || (argv[1][0] == 'l')) {
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400254 int depth = MAX_LEVEL; /* how deep to print */
255 char *pathp; /* path */
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400256 char *prop; /* property */
257 int ret; /* return value */
Kumar Galaf738b4a2007-10-25 16:15:07 -0500258 static char root[2] = "/";
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400259
260 /*
261 * list is an alias for print, but limited to 1 level
262 */
Gerald Van Baren25114032007-05-12 09:47:25 -0400263 if (argv[1][0] == 'l') {
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400264 depth = 1;
265 }
266
267 /*
268 * Get the starting path. The root node is an oddball,
269 * the offset is zero and has no name.
270 */
Kumar Galaf738b4a2007-10-25 16:15:07 -0500271 if (argc == 2)
272 pathp = root;
273 else
274 pathp = argv[2];
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400275 if (argc > 3)
276 prop = argv[3];
277 else
278 prop = NULL;
279
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400280 ret = fdt_print(pathp, prop, depth);
281 if (ret != 0)
282 return ret;
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400283
284 /********************************************************************
285 * Remove a property/node
286 ********************************************************************/
Gerald Van Baren2fb698b2008-06-09 21:02:17 -0400287 } else if (strncmp(argv[1], "rm", 2) == 0) {
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400288 int nodeoffset; /* node offset from libfdt */
289 int err;
290
291 /*
292 * Get the path. The root node is an oddball, the offset
293 * is zero and has no name.
294 */
Kim Phillipse489b9c2008-06-10 11:06:17 -0500295 nodeoffset = fdt_path_offset (working_fdt, argv[2]);
Gerald Van Baren25114032007-05-12 09:47:25 -0400296 if (nodeoffset < 0) {
297 /*
298 * Not found or something else bad happened.
299 */
Kumar Gala8d04f022007-10-24 11:04:22 -0500300 printf ("libfdt fdt_path_offset() returned %s\n",
Gerald Van Baren06e19a02007-05-21 23:27:16 -0400301 fdt_strerror(nodeoffset));
Gerald Van Baren25114032007-05-12 09:47:25 -0400302 return 1;
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400303 }
304 /*
305 * Do the delete. A fourth parameter means delete a property,
306 * otherwise delete the node.
307 */
308 if (argc > 3) {
Kim Phillipse489b9c2008-06-10 11:06:17 -0500309 err = fdt_delprop(working_fdt, nodeoffset, argv[3]);
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400310 if (err < 0) {
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400311 printf("libfdt fdt_delprop(): %s\n",
312 fdt_strerror(err));
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400313 return err;
314 }
315 } else {
Kim Phillipse489b9c2008-06-10 11:06:17 -0500316 err = fdt_del_node(working_fdt, nodeoffset);
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400317 if (err < 0) {
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400318 printf("libfdt fdt_del_node(): %s\n",
319 fdt_strerror(err));
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400320 return err;
321 }
322 }
Kumar Gala804887e2008-02-15 03:34:36 -0600323
324 /********************************************************************
325 * Display header info
326 ********************************************************************/
327 } else if (argv[1][0] == 'h') {
Kim Phillipse489b9c2008-06-10 11:06:17 -0500328 u32 version = fdt_version(working_fdt);
329 printf("magic:\t\t\t0x%x\n", fdt_magic(working_fdt));
330 printf("totalsize:\t\t0x%x (%d)\n", fdt_totalsize(working_fdt),
331 fdt_totalsize(working_fdt));
332 printf("off_dt_struct:\t\t0x%x\n",
333 fdt_off_dt_struct(working_fdt));
334 printf("off_dt_strings:\t\t0x%x\n",
335 fdt_off_dt_strings(working_fdt));
336 printf("off_mem_rsvmap:\t\t0x%x\n",
337 fdt_off_mem_rsvmap(working_fdt));
Kumar Gala804887e2008-02-15 03:34:36 -0600338 printf("version:\t\t%d\n", version);
Kim Phillipse489b9c2008-06-10 11:06:17 -0500339 printf("last_comp_version:\t%d\n",
340 fdt_last_comp_version(working_fdt));
Kumar Gala804887e2008-02-15 03:34:36 -0600341 if (version >= 2)
342 printf("boot_cpuid_phys:\t0x%x\n",
Kim Phillipse489b9c2008-06-10 11:06:17 -0500343 fdt_boot_cpuid_phys(working_fdt));
Kumar Gala804887e2008-02-15 03:34:36 -0600344 if (version >= 3)
345 printf("size_dt_strings:\t0x%x\n",
Kim Phillipse489b9c2008-06-10 11:06:17 -0500346 fdt_size_dt_strings(working_fdt));
Kumar Gala804887e2008-02-15 03:34:36 -0600347 if (version >= 17)
348 printf("size_dt_struct:\t\t0x%x\n",
Kim Phillipse489b9c2008-06-10 11:06:17 -0500349 fdt_size_dt_struct(working_fdt));
350 printf("number mem_rsv:\t\t0x%x\n",
351 fdt_num_mem_rsv(working_fdt));
Kumar Gala804887e2008-02-15 03:34:36 -0600352 printf("\n");
353
354 /********************************************************************
355 * Set boot cpu id
356 ********************************************************************/
Gerald Van Baren2fb698b2008-06-09 21:02:17 -0400357 } else if (strncmp(argv[1], "boo", 3) == 0) {
Kumar Gala804887e2008-02-15 03:34:36 -0600358 unsigned long tmp = simple_strtoul(argv[2], NULL, 16);
Kim Phillipse489b9c2008-06-10 11:06:17 -0500359 fdt_set_boot_cpuid_phys(working_fdt, tmp);
Kumar Gala804887e2008-02-15 03:34:36 -0600360
361 /********************************************************************
362 * memory command
363 ********************************************************************/
Gerald Van Baren2fb698b2008-06-09 21:02:17 -0400364 } else if (strncmp(argv[1], "me", 2) == 0) {
Kumar Gala804887e2008-02-15 03:34:36 -0600365 uint64_t addr, size;
366 int err;
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200367#ifdef CONFIG_SYS_64BIT_STRTOUL
Kumar Gala804887e2008-02-15 03:34:36 -0600368 addr = simple_strtoull(argv[2], NULL, 16);
369 size = simple_strtoull(argv[3], NULL, 16);
370#else
371 addr = simple_strtoul(argv[2], NULL, 16);
372 size = simple_strtoul(argv[3], NULL, 16);
373#endif
Kim Phillipse489b9c2008-06-10 11:06:17 -0500374 err = fdt_fixup_memory(working_fdt, addr, size);
Kumar Gala804887e2008-02-15 03:34:36 -0600375 if (err < 0)
376 return err;
377
378 /********************************************************************
379 * mem reserve commands
380 ********************************************************************/
Gerald Van Baren2fb698b2008-06-09 21:02:17 -0400381 } else if (strncmp(argv[1], "rs", 2) == 0) {
Kumar Gala804887e2008-02-15 03:34:36 -0600382 if (argv[2][0] == 'p') {
383 uint64_t addr, size;
Kim Phillipse489b9c2008-06-10 11:06:17 -0500384 int total = fdt_num_mem_rsv(working_fdt);
Kumar Gala804887e2008-02-15 03:34:36 -0600385 int j, err;
386 printf("index\t\t start\t\t size\n");
387 printf("-------------------------------"
388 "-----------------\n");
389 for (j = 0; j < total; j++) {
Kim Phillipse489b9c2008-06-10 11:06:17 -0500390 err = fdt_get_mem_rsv(working_fdt, j, &addr, &size);
Kumar Gala804887e2008-02-15 03:34:36 -0600391 if (err < 0) {
392 printf("libfdt fdt_get_mem_rsv(): %s\n",
393 fdt_strerror(err));
394 return err;
395 }
396 printf(" %x\t%08x%08x\t%08x%08x\n", j,
397 (u32)(addr >> 32),
398 (u32)(addr & 0xffffffff),
399 (u32)(size >> 32),
400 (u32)(size & 0xffffffff));
401 }
402 } else if (argv[2][0] == 'a') {
403 uint64_t addr, size;
404 int err;
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200405#ifdef CONFIG_SYS_64BIT_STRTOUL
Kumar Gala804887e2008-02-15 03:34:36 -0600406 addr = simple_strtoull(argv[3], NULL, 16);
407 size = simple_strtoull(argv[4], NULL, 16);
408#else
409 addr = simple_strtoul(argv[3], NULL, 16);
410 size = simple_strtoul(argv[4], NULL, 16);
411#endif
Kim Phillipse489b9c2008-06-10 11:06:17 -0500412 err = fdt_add_mem_rsv(working_fdt, addr, size);
Kumar Gala804887e2008-02-15 03:34:36 -0600413
414 if (err < 0) {
415 printf("libfdt fdt_add_mem_rsv(): %s\n",
416 fdt_strerror(err));
417 return err;
418 }
419 } else if (argv[2][0] == 'd') {
420 unsigned long idx = simple_strtoul(argv[3], NULL, 16);
Kim Phillipse489b9c2008-06-10 11:06:17 -0500421 int err = fdt_del_mem_rsv(working_fdt, idx);
Kumar Gala804887e2008-02-15 03:34:36 -0600422
423 if (err < 0) {
424 printf("libfdt fdt_del_mem_rsv(): %s\n",
425 fdt_strerror(err));
426 return err;
427 }
428 } else {
429 /* Unrecognized command */
Peter Tyser62c3ae72009-01-27 18:03:10 -0600430 cmd_usage(cmdtp);
Kumar Gala804887e2008-02-15 03:34:36 -0600431 return 1;
432 }
Kim Phillips99dffca2007-07-17 13:57:04 -0500433 }
Gerald Van Barenfd61e552007-06-25 23:25:28 -0400434#ifdef CONFIG_OF_BOARD_SETUP
Kim Phillips99dffca2007-07-17 13:57:04 -0500435 /* Call the board-specific fixup routine */
Gerald Van Baren2fb698b2008-06-09 21:02:17 -0400436 else if (strncmp(argv[1], "boa", 3) == 0)
Kim Phillipse489b9c2008-06-10 11:06:17 -0500437 ft_board_setup(working_fdt, gd->bd);
Gerald Van Barenfd61e552007-06-25 23:25:28 -0400438#endif
Kim Phillips99dffca2007-07-17 13:57:04 -0500439 /* Create a chosen node */
Kumar Galaf953d992008-08-15 08:24:34 -0500440 else if (argv[1][0] == 'c') {
441 unsigned long initrd_start = 0, initrd_end = 0;
442
443 if ((argc != 2) && (argc != 4)) {
Peter Tyser62c3ae72009-01-27 18:03:10 -0600444 cmd_usage(cmdtp);
Kumar Galaf953d992008-08-15 08:24:34 -0500445 return 1;
446 }
447
448 if (argc == 4) {
449 initrd_start = simple_strtoul(argv[2], NULL, 16);
450 initrd_end = simple_strtoul(argv[3], NULL, 16);
451 }
452
Heiko Schocher56844a22008-09-11 08:11:23 +0200453 fdt_chosen(working_fdt, 1);
454 fdt_initrd(working_fdt, initrd_start, initrd_end, 1);
Kumar Gala40afac22008-08-15 08:24:44 -0500455 }
456 /* resize the fdt */
457 else if (strncmp(argv[1], "re", 2) == 0) {
458 fdt_resize(working_fdt);
459 }
460 else {
Kim Phillips99dffca2007-07-17 13:57:04 -0500461 /* Unrecognized command */
Peter Tyser62c3ae72009-01-27 18:03:10 -0600462 cmd_usage(cmdtp);
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400463 return 1;
464 }
465
466 return 0;
467}
468
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400469/****************************************************************************/
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400470
471static int fdt_valid(void)
472{
Gerald Van Baren64dbbd42007-04-06 14:19:43 -0400473 int err;
474
Kim Phillipse489b9c2008-06-10 11:06:17 -0500475 if (working_fdt == NULL) {
Gerald Van Baren64dbbd42007-04-06 14:19:43 -0400476 printf ("The address of the fdt is invalid (NULL).\n");
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400477 return 0;
478 }
Gerald Van Baren64dbbd42007-04-06 14:19:43 -0400479
Kim Phillipse489b9c2008-06-10 11:06:17 -0500480 err = fdt_check_header(working_fdt);
Gerald Van Baren64dbbd42007-04-06 14:19:43 -0400481 if (err == 0)
482 return 1; /* valid */
483
484 if (err < 0) {
Gerald Van Baren25114032007-05-12 09:47:25 -0400485 printf("libfdt fdt_check_header(): %s", fdt_strerror(err));
Gerald Van Baren64dbbd42007-04-06 14:19:43 -0400486 /*
487 * Be more informative on bad version.
488 */
489 if (err == -FDT_ERR_BADVERSION) {
Kim Phillipse489b9c2008-06-10 11:06:17 -0500490 if (fdt_version(working_fdt) <
491 FDT_FIRST_SUPPORTED_VERSION) {
Andrew Klossnerdc4b0b32008-07-07 06:41:14 -0700492 printf (" - too old, fdt %d < %d",
Kim Phillipse489b9c2008-06-10 11:06:17 -0500493 fdt_version(working_fdt),
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400494 FDT_FIRST_SUPPORTED_VERSION);
Kim Phillipse489b9c2008-06-10 11:06:17 -0500495 working_fdt = NULL;
Gerald Van Baren64dbbd42007-04-06 14:19:43 -0400496 }
Kim Phillipse489b9c2008-06-10 11:06:17 -0500497 if (fdt_last_comp_version(working_fdt) >
498 FDT_LAST_SUPPORTED_VERSION) {
Andrew Klossnerdc4b0b32008-07-07 06:41:14 -0700499 printf (" - too new, fdt %d > %d",
Kim Phillipse489b9c2008-06-10 11:06:17 -0500500 fdt_version(working_fdt),
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400501 FDT_LAST_SUPPORTED_VERSION);
Kim Phillipse489b9c2008-06-10 11:06:17 -0500502 working_fdt = NULL;
Gerald Van Baren64dbbd42007-04-06 14:19:43 -0400503 }
504 return 0;
505 }
506 printf("\n");
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400507 return 0;
508 }
509 return 1;
510}
511
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400512/****************************************************************************/
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400513
514/*
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400515 * Parse the user's input, partially heuristic. Valid formats:
Andy Fleming4abd8442008-03-31 20:45:56 -0500516 * <0x00112233 4 05> - an array of cells. Numbers follow standard
Wolfgang Denk53677ef2008-05-20 16:00:29 +0200517 * C conventions.
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400518 * [00 11 22 .. nn] - byte stream
519 * "string" - If the the value doesn't start with "<" or "[", it is
520 * treated as a string. Note that the quotes are
521 * stripped by the parser before we get the string.
Andy Fleming4abd8442008-03-31 20:45:56 -0500522 * newval: An array of strings containing the new property as specified
Wolfgang Denk53677ef2008-05-20 16:00:29 +0200523 * on the command line
Andy Fleming4abd8442008-03-31 20:45:56 -0500524 * count: The number of strings in the array
525 * data: A bytestream to be placed in the property
526 * len: The length of the resulting bytestream
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400527 */
Andy Fleming4abd8442008-03-31 20:45:56 -0500528static int fdt_parse_prop(char **newval, int count, char *data, int *len)
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400529{
530 char *cp; /* temporary char pointer */
Andy Fleming4abd8442008-03-31 20:45:56 -0500531 char *newp; /* temporary newval char pointer */
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400532 unsigned long tmp; /* holds converted values */
Andy Fleming4abd8442008-03-31 20:45:56 -0500533 int stridx = 0;
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400534
Andy Fleming4abd8442008-03-31 20:45:56 -0500535 *len = 0;
536 newp = newval[0];
537
538 /* An array of cells */
539 if (*newp == '<') {
540 newp++;
541 while ((*newp != '>') && (stridx < count)) {
542 /*
543 * Keep searching until we find that last ">"
544 * That way users don't have to escape the spaces
545 */
546 if (*newp == '\0') {
547 newp = newval[++stridx];
548 continue;
549 }
550
551 cp = newp;
552 tmp = simple_strtoul(cp, &newp, 0);
553 *(uint32_t *)data = __cpu_to_be32(tmp);
554 data += 4;
555 *len += 4;
556
557 /* If the ptr didn't advance, something went wrong */
558 if ((newp - cp) <= 0) {
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400559 printf("Sorry, I could not convert \"%s\"\n",
560 cp);
561 return 1;
562 }
Andy Fleming4abd8442008-03-31 20:45:56 -0500563
564 while (*newp == ' ')
565 newp++;
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400566 }
Andy Fleming4abd8442008-03-31 20:45:56 -0500567
568 if (*newp != '>') {
569 printf("Unexpected character '%c'\n", *newp);
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400570 return 1;
571 }
Andy Fleming4abd8442008-03-31 20:45:56 -0500572 } else if (*newp == '[') {
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400573 /*
574 * Byte stream. Convert the values.
575 */
Andy Fleming4abd8442008-03-31 20:45:56 -0500576 newp++;
Ken MacLeod6e748ea2009-09-11 15:16:18 -0500577 while ((stridx < count) && (*newp != ']')) {
578 while (*newp == ' ')
579 newp++;
580 if (*newp == '\0') {
581 newp = newval[++stridx];
582 continue;
583 }
584 if (!isxdigit(*newp))
585 break;
Andy Fleming4abd8442008-03-31 20:45:56 -0500586 tmp = simple_strtoul(newp, &newp, 16);
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400587 *data++ = tmp & 0xFF;
Gerald Van Barenfd61e552007-06-25 23:25:28 -0400588 *len = *len + 1;
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400589 }
Andy Fleming4abd8442008-03-31 20:45:56 -0500590 if (*newp != ']') {
Andrew Klossnerdc4b0b32008-07-07 06:41:14 -0700591 printf("Unexpected character '%c'\n", *newp);
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400592 return 1;
593 }
594 } else {
595 /*
Ken MacLeod6e748ea2009-09-11 15:16:18 -0500596 * Assume it is one or more strings. Copy it into our
597 * data area for convenience (including the
598 * terminating '\0's).
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400599 */
Andy Fleming4abd8442008-03-31 20:45:56 -0500600 while (stridx < count) {
Ken MacLeod6e748ea2009-09-11 15:16:18 -0500601 size_t length = strlen(newp) + 1;
Andy Fleming4abd8442008-03-31 20:45:56 -0500602 strcpy(data, newp);
Ken MacLeod6e748ea2009-09-11 15:16:18 -0500603 data += length;
604 *len += length;
Andy Fleming4abd8442008-03-31 20:45:56 -0500605 newp = newval[++stridx];
606 }
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400607 }
608 return 0;
609}
610
611/****************************************************************************/
612
613/*
614 * Heuristic to guess if this is a string or concatenated strings.
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400615 */
616
617static int is_printable_string(const void *data, int len)
618{
619 const char *s = data;
620
621 /* zero length is not */
622 if (len == 0)
623 return 0;
624
625 /* must terminate with zero */
626 if (s[len - 1] != '\0')
627 return 0;
628
629 /* printable or a null byte (concatenated strings) */
630 while (((*s == '\0') || isprint(*s)) && (len > 0)) {
631 /*
632 * If we see a null, there are three possibilities:
633 * 1) If len == 1, it is the end of the string, printable
634 * 2) Next character also a null, not printable.
635 * 3) Next character not a null, continue to check.
636 */
637 if (s[0] == '\0') {
638 if (len == 1)
639 return 1;
640 if (s[1] == '\0')
641 return 0;
642 }
643 s++;
644 len--;
645 }
646
647 /* Not the null termination, or not done yet: not printable */
648 if (*s != '\0' || (len != 0))
649 return 0;
650
651 return 1;
652}
653
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400654
655/*
656 * Print the property in the best format, a heuristic guess. Print as
657 * a string, concatenated strings, a byte, word, double word, or (if all
658 * else fails) it is printed as a stream of bytes.
659 */
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400660static void print_data(const void *data, int len)
661{
662 int j;
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400663
664 /* no data, don't print */
665 if (len == 0)
666 return;
667
668 /*
669 * It is a string, but it may have multiple strings (embedded '\0's).
670 */
671 if (is_printable_string(data, len)) {
672 puts("\"");
673 j = 0;
674 while (j < len) {
675 if (j > 0)
676 puts("\", \"");
677 puts(data);
678 j += strlen(data) + 1;
679 data += strlen(data) + 1;
680 }
681 puts("\"");
682 return;
683 }
684
Andy Fleming4abd8442008-03-31 20:45:56 -0500685 if ((len %4) == 0) {
686 const u32 *p;
687
688 printf("<");
689 for (j = 0, p = data; j < len/4; j ++)
690 printf("0x%x%s", p[j], j < (len/4 - 1) ? " " : "");
691 printf(">");
692 } else { /* anything else... hexdump */
693 const u8 *s;
694
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400695 printf("[");
696 for (j = 0, s = data; j < len; j++)
697 printf("%02x%s", s[j], j < len - 1 ? " " : "");
698 printf("]");
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400699 }
700}
701
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400702/****************************************************************************/
703
704/*
Kim Phillipse489b9c2008-06-10 11:06:17 -0500705 * Recursively print (a portion of) the working_fdt. The depth parameter
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400706 * determines how deeply nested the fdt is printed.
707 */
Kumar Galadbaf07c2007-11-21 14:07:46 -0600708static int fdt_print(const char *pathp, char *prop, int depth)
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400709{
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400710 static char tabs[MAX_LEVEL+1] =
711 "\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t"
712 "\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t";
Kumar Galadbaf07c2007-11-21 14:07:46 -0600713 const void *nodep; /* property node pointer */
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400714 int nodeoffset; /* node offset from libfdt */
715 int nextoffset; /* next node offset from libfdt */
716 uint32_t tag; /* tag */
717 int len; /* length of the property */
718 int level = 0; /* keep track of nesting level */
Gerald Van Baren91623522007-11-22 17:23:23 -0500719 const struct fdt_property *fdt_prop;
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400720
Kim Phillipse489b9c2008-06-10 11:06:17 -0500721 nodeoffset = fdt_path_offset (working_fdt, pathp);
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400722 if (nodeoffset < 0) {
723 /*
724 * Not found or something else bad happened.
725 */
Kumar Gala8d04f022007-10-24 11:04:22 -0500726 printf ("libfdt fdt_path_offset() returned %s\n",
Gerald Van Baren06e19a02007-05-21 23:27:16 -0400727 fdt_strerror(nodeoffset));
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400728 return 1;
729 }
730 /*
731 * The user passed in a property as well as node path.
732 * Print only the given property and then return.
733 */
734 if (prop) {
Kim Phillipse489b9c2008-06-10 11:06:17 -0500735 nodep = fdt_getprop (working_fdt, nodeoffset, prop, &len);
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400736 if (len == 0) {
737 /* no property value */
738 printf("%s %s\n", pathp, prop);
739 return 0;
740 } else if (len > 0) {
Gerald Van Baren28f384b2007-11-23 19:43:20 -0500741 printf("%s = ", prop);
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400742 print_data (nodep, len);
743 printf("\n");
744 return 0;
745 } else {
746 printf ("libfdt fdt_getprop(): %s\n",
747 fdt_strerror(len));
748 return 1;
749 }
750 }
751
752 /*
753 * The user passed in a node path and no property,
754 * print the node and all subnodes.
755 */
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400756 while(level >= 0) {
Kim Phillipse489b9c2008-06-10 11:06:17 -0500757 tag = fdt_next_tag(working_fdt, nodeoffset, &nextoffset);
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400758 switch(tag) {
759 case FDT_BEGIN_NODE:
Kim Phillipse489b9c2008-06-10 11:06:17 -0500760 pathp = fdt_get_name(working_fdt, nodeoffset, NULL);
Gerald Van Baren91623522007-11-22 17:23:23 -0500761 if (level <= depth) {
762 if (pathp == NULL)
763 pathp = "/* NULL pointer error */";
764 if (*pathp == '\0')
765 pathp = "/"; /* root is nameless */
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400766 printf("%s%s {\n",
767 &tabs[MAX_LEVEL - level], pathp);
Gerald Van Baren91623522007-11-22 17:23:23 -0500768 }
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400769 level++;
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400770 if (level >= MAX_LEVEL) {
Gerald Van Baren91623522007-11-22 17:23:23 -0500771 printf("Nested too deep, aborting.\n");
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400772 return 1;
773 }
774 break;
775 case FDT_END_NODE:
776 level--;
Gerald Van Baren91623522007-11-22 17:23:23 -0500777 if (level <= depth)
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400778 printf("%s};\n", &tabs[MAX_LEVEL - level]);
779 if (level == 0) {
780 level = -1; /* exit the loop */
781 }
782 break;
783 case FDT_PROP:
Kim Phillipse489b9c2008-06-10 11:06:17 -0500784 fdt_prop = fdt_offset_ptr(working_fdt, nodeoffset,
Gerald Van Baren91623522007-11-22 17:23:23 -0500785 sizeof(*fdt_prop));
Kim Phillipse489b9c2008-06-10 11:06:17 -0500786 pathp = fdt_string(working_fdt,
Gerald Van Baren91623522007-11-22 17:23:23 -0500787 fdt32_to_cpu(fdt_prop->nameoff));
788 len = fdt32_to_cpu(fdt_prop->len);
789 nodep = fdt_prop->data;
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400790 if (len < 0) {
791 printf ("libfdt fdt_getprop(): %s\n",
792 fdt_strerror(len));
793 return 1;
794 } else if (len == 0) {
795 /* the property has no value */
Gerald Van Baren91623522007-11-22 17:23:23 -0500796 if (level <= depth)
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400797 printf("%s%s;\n",
798 &tabs[MAX_LEVEL - level],
799 pathp);
800 } else {
Gerald Van Baren91623522007-11-22 17:23:23 -0500801 if (level <= depth) {
Gerald Van Baren28f384b2007-11-23 19:43:20 -0500802 printf("%s%s = ",
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400803 &tabs[MAX_LEVEL - level],
804 pathp);
805 print_data (nodep, len);
806 printf(";\n");
807 }
808 }
809 break;
810 case FDT_NOP:
Andrew Klossnerdc4b0b32008-07-07 06:41:14 -0700811 printf("%s/* NOP */\n", &tabs[MAX_LEVEL - level]);
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400812 break;
813 case FDT_END:
814 return 1;
815 default:
Gerald Van Baren91623522007-11-22 17:23:23 -0500816 if (level <= depth)
Gerald Van Barenaddd8ce2007-05-16 22:39:59 -0400817 printf("Unknown tag 0x%08X\n", tag);
818 return 1;
819 }
820 nodeoffset = nextoffset;
821 }
822 return 0;
823}
824
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400825/********************************************************************/
826
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400827U_BOOT_CMD(
Andy Fleming4abd8442008-03-31 20:45:56 -0500828 fdt, 255, 0, do_fdt,
Peter Tyser2fb26042009-01-27 18:03:12 -0600829 "flattened device tree utility commands",
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400830 "addr <addr> [<length>] - Set the fdt location to <addr>\n"
Gerald Van Barenfd61e552007-06-25 23:25:28 -0400831#ifdef CONFIG_OF_BOARD_SETUP
832 "fdt boardsetup - Do board-specific set up\n"
833#endif
Gerald Van Baren238cb7a2008-01-05 15:33:29 -0500834 "fdt move <fdt> <newaddr> <length> - Copy the fdt to <addr> and make it active\n"
Kumar Gala40afac22008-08-15 08:24:44 -0500835 "fdt resize - Resize fdt to size + padding to 4k addr\n"
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400836 "fdt print <path> [<prop>] - Recursive print starting at <path>\n"
837 "fdt list <path> [<prop>] - Print one level starting at <path>\n"
838 "fdt set <path> <prop> [<val>] - Set <property> [to <val>]\n"
839 "fdt mknode <path> <node> - Create a new node after <path>\n"
840 "fdt rm <path> [<prop>] - Delete the node or <property>\n"
Kumar Gala804887e2008-02-15 03:34:36 -0600841 "fdt header - Display header info\n"
842 "fdt bootcpu <id> - Set boot cpuid\n"
843 "fdt memory <addr> <size> - Add/Update memory node\n"
844 "fdt rsvmem print - Show current mem reserves\n"
845 "fdt rsvmem add <addr> <size> - Add a mem reserve\n"
846 "fdt rsvmem delete <index> - Delete a mem reserves\n"
Kumar Galaf953d992008-08-15 08:24:34 -0500847 "fdt chosen [<start> <end>] - Add/update the /chosen branch in the tree\n"
848 " <start>/<end> - initrd start/end addr\n"
Gerald Van Baren109c30f2008-08-22 14:37:05 -0400849 "NOTE: Dereference aliases by omiting the leading '/', "
Wolfgang Denka89c33d2009-05-24 17:06:54 +0200850 "e.g. fdt print ethernet0."
Gerald Van Baren781e09e2007-03-31 12:22:10 -0400851);