cmd_fdt.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844
  1. /*
  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. #include <common.h>
  27. #include <command.h>
  28. #include <linux/ctype.h>
  29. #include <linux/types.h>
  30. #include <asm/global_data.h>
  31. #include <fdt.h>
  32. #include <libfdt.h>
  33. #include <fdt_support.h>
  34. #define MAX_LEVEL 32 /* how deeply nested we will go */
  35. #define SCRATCHPAD 1024 /* bytes of scratchpad memory */
  36. /*
  37. * Global data (for the gd->bd)
  38. */
  39. DECLARE_GLOBAL_DATA_PTR;
  40. static int fdt_valid(void);
  41. static int fdt_parse_prop(char **newval, int count, char *data, int *len);
  42. static int fdt_print(const char *pathp, char *prop, int depth);
  43. /*
  44. * The working_fdt points to our working flattened device tree.
  45. */
  46. struct fdt_header *working_fdt;
  47. void set_working_fdt_addr(void *addr)
  48. {
  49. char buf[17];
  50. working_fdt = addr;
  51. sprintf(buf, "%lx", (unsigned long)addr);
  52. setenv("fdtaddr", buf);
  53. }
  54. /*
  55. * Flattened Device Tree command, see the help for parameter definitions.
  56. */
  57. int do_fdt (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
  58. {
  59. if (argc < 2) {
  60. cmd_usage(cmdtp);
  61. return 1;
  62. }
  63. /********************************************************************
  64. * Set the address of the fdt
  65. ********************************************************************/
  66. if (argv[1][0] == 'a') {
  67. unsigned long addr;
  68. /*
  69. * Set the address [and length] of the fdt.
  70. */
  71. if (argc == 2) {
  72. if (!fdt_valid()) {
  73. return 1;
  74. }
  75. printf("The address of the fdt is %p\n", working_fdt);
  76. return 0;
  77. }
  78. addr = simple_strtoul(argv[2], NULL, 16);
  79. set_working_fdt_addr((void *)addr);
  80. if (!fdt_valid()) {
  81. return 1;
  82. }
  83. if (argc >= 4) {
  84. int len;
  85. int err;
  86. /*
  87. * Optional new length
  88. */
  89. len = simple_strtoul(argv[3], NULL, 16);
  90. if (len < fdt_totalsize(working_fdt)) {
  91. printf ("New length %d < existing length %d, "
  92. "ignoring.\n",
  93. len, fdt_totalsize(working_fdt));
  94. } else {
  95. /*
  96. * Open in place with a new length.
  97. */
  98. err = fdt_open_into(working_fdt, working_fdt, len);
  99. if (err != 0) {
  100. printf ("libfdt fdt_open_into(): %s\n",
  101. fdt_strerror(err));
  102. }
  103. }
  104. }
  105. /********************************************************************
  106. * Move the working_fdt
  107. ********************************************************************/
  108. } else if (strncmp(argv[1], "mo", 2) == 0) {
  109. struct fdt_header *newaddr;
  110. int len;
  111. int err;
  112. if (argc < 4) {
  113. cmd_usage(cmdtp);
  114. return 1;
  115. }
  116. /*
  117. * Set the address and length of the fdt.
  118. */
  119. working_fdt = (struct fdt_header *)simple_strtoul(argv[2], NULL, 16);
  120. if (!fdt_valid()) {
  121. return 1;
  122. }
  123. newaddr = (struct fdt_header *)simple_strtoul(argv[3],NULL,16);
  124. /*
  125. * If the user specifies a length, use that. Otherwise use the
  126. * current length.
  127. */
  128. if (argc <= 4) {
  129. len = fdt_totalsize(working_fdt);
  130. } else {
  131. len = simple_strtoul(argv[4], NULL, 16);
  132. if (len < fdt_totalsize(working_fdt)) {
  133. printf ("New length 0x%X < existing length "
  134. "0x%X, aborting.\n",
  135. len, fdt_totalsize(working_fdt));
  136. return 1;
  137. }
  138. }
  139. /*
  140. * Copy to the new location.
  141. */
  142. err = fdt_open_into(working_fdt, newaddr, len);
  143. if (err != 0) {
  144. printf ("libfdt fdt_open_into(): %s\n",
  145. fdt_strerror(err));
  146. return 1;
  147. }
  148. working_fdt = newaddr;
  149. /********************************************************************
  150. * Make a new node
  151. ********************************************************************/
  152. } else if (strncmp(argv[1], "mk", 2) == 0) {
  153. char *pathp; /* path */
  154. char *nodep; /* new node to add */
  155. int nodeoffset; /* node offset from libfdt */
  156. int err;
  157. /*
  158. * Parameters: Node path, new node to be appended to the path.
  159. */
  160. if (argc < 4) {
  161. cmd_usage(cmdtp);
  162. return 1;
  163. }
  164. pathp = argv[2];
  165. nodep = argv[3];
  166. nodeoffset = fdt_path_offset (working_fdt, pathp);
  167. if (nodeoffset < 0) {
  168. /*
  169. * Not found or something else bad happened.
  170. */
  171. printf ("libfdt fdt_path_offset() returned %s\n",
  172. fdt_strerror(nodeoffset));
  173. return 1;
  174. }
  175. err = fdt_add_subnode(working_fdt, nodeoffset, nodep);
  176. if (err < 0) {
  177. printf ("libfdt fdt_add_subnode(): %s\n",
  178. fdt_strerror(err));
  179. return 1;
  180. }
  181. /********************************************************************
  182. * Set the value of a property in the working_fdt.
  183. ********************************************************************/
  184. } else if (argv[1][0] == 's') {
  185. char *pathp; /* path */
  186. char *prop; /* property */
  187. int nodeoffset; /* node offset from libfdt */
  188. static char data[SCRATCHPAD]; /* storage for the property */
  189. int len; /* new length of the property */
  190. int ret; /* return value */
  191. /*
  192. * Parameters: Node path, property, optional value.
  193. */
  194. if (argc < 4) {
  195. cmd_usage(cmdtp);
  196. return 1;
  197. }
  198. pathp = argv[2];
  199. prop = argv[3];
  200. if (argc == 4) {
  201. len = 0;
  202. } else {
  203. ret = fdt_parse_prop(&argv[4], argc - 4, data, &len);
  204. if (ret != 0)
  205. return ret;
  206. }
  207. nodeoffset = fdt_path_offset (working_fdt, pathp);
  208. if (nodeoffset < 0) {
  209. /*
  210. * Not found or something else bad happened.
  211. */
  212. printf ("libfdt fdt_path_offset() returned %s\n",
  213. fdt_strerror(nodeoffset));
  214. return 1;
  215. }
  216. ret = fdt_setprop(working_fdt, nodeoffset, prop, data, len);
  217. if (ret < 0) {
  218. printf ("libfdt fdt_setprop(): %s\n", fdt_strerror(ret));
  219. return 1;
  220. }
  221. /********************************************************************
  222. * Print (recursive) / List (single level)
  223. ********************************************************************/
  224. } else if ((argv[1][0] == 'p') || (argv[1][0] == 'l')) {
  225. int depth = MAX_LEVEL; /* how deep to print */
  226. char *pathp; /* path */
  227. char *prop; /* property */
  228. int ret; /* return value */
  229. static char root[2] = "/";
  230. /*
  231. * list is an alias for print, but limited to 1 level
  232. */
  233. if (argv[1][0] == 'l') {
  234. depth = 1;
  235. }
  236. /*
  237. * Get the starting path. The root node is an oddball,
  238. * the offset is zero and has no name.
  239. */
  240. if (argc == 2)
  241. pathp = root;
  242. else
  243. pathp = argv[2];
  244. if (argc > 3)
  245. prop = argv[3];
  246. else
  247. prop = NULL;
  248. ret = fdt_print(pathp, prop, depth);
  249. if (ret != 0)
  250. return ret;
  251. /********************************************************************
  252. * Remove a property/node
  253. ********************************************************************/
  254. } else if (strncmp(argv[1], "rm", 2) == 0) {
  255. int nodeoffset; /* node offset from libfdt */
  256. int err;
  257. /*
  258. * Get the path. The root node is an oddball, the offset
  259. * is zero and has no name.
  260. */
  261. nodeoffset = fdt_path_offset (working_fdt, argv[2]);
  262. if (nodeoffset < 0) {
  263. /*
  264. * Not found or something else bad happened.
  265. */
  266. printf ("libfdt fdt_path_offset() returned %s\n",
  267. fdt_strerror(nodeoffset));
  268. return 1;
  269. }
  270. /*
  271. * Do the delete. A fourth parameter means delete a property,
  272. * otherwise delete the node.
  273. */
  274. if (argc > 3) {
  275. err = fdt_delprop(working_fdt, nodeoffset, argv[3]);
  276. if (err < 0) {
  277. printf("libfdt fdt_delprop(): %s\n",
  278. fdt_strerror(err));
  279. return err;
  280. }
  281. } else {
  282. err = fdt_del_node(working_fdt, nodeoffset);
  283. if (err < 0) {
  284. printf("libfdt fdt_del_node(): %s\n",
  285. fdt_strerror(err));
  286. return err;
  287. }
  288. }
  289. /********************************************************************
  290. * Display header info
  291. ********************************************************************/
  292. } else if (argv[1][0] == 'h') {
  293. u32 version = fdt_version(working_fdt);
  294. printf("magic:\t\t\t0x%x\n", fdt_magic(working_fdt));
  295. printf("totalsize:\t\t0x%x (%d)\n", fdt_totalsize(working_fdt),
  296. fdt_totalsize(working_fdt));
  297. printf("off_dt_struct:\t\t0x%x\n",
  298. fdt_off_dt_struct(working_fdt));
  299. printf("off_dt_strings:\t\t0x%x\n",
  300. fdt_off_dt_strings(working_fdt));
  301. printf("off_mem_rsvmap:\t\t0x%x\n",
  302. fdt_off_mem_rsvmap(working_fdt));
  303. printf("version:\t\t%d\n", version);
  304. printf("last_comp_version:\t%d\n",
  305. fdt_last_comp_version(working_fdt));
  306. if (version >= 2)
  307. printf("boot_cpuid_phys:\t0x%x\n",
  308. fdt_boot_cpuid_phys(working_fdt));
  309. if (version >= 3)
  310. printf("size_dt_strings:\t0x%x\n",
  311. fdt_size_dt_strings(working_fdt));
  312. if (version >= 17)
  313. printf("size_dt_struct:\t\t0x%x\n",
  314. fdt_size_dt_struct(working_fdt));
  315. printf("number mem_rsv:\t\t0x%x\n",
  316. fdt_num_mem_rsv(working_fdt));
  317. printf("\n");
  318. /********************************************************************
  319. * Set boot cpu id
  320. ********************************************************************/
  321. } else if (strncmp(argv[1], "boo", 3) == 0) {
  322. unsigned long tmp = simple_strtoul(argv[2], NULL, 16);
  323. fdt_set_boot_cpuid_phys(working_fdt, tmp);
  324. /********************************************************************
  325. * memory command
  326. ********************************************************************/
  327. } else if (strncmp(argv[1], "me", 2) == 0) {
  328. uint64_t addr, size;
  329. int err;
  330. #ifdef CONFIG_SYS_64BIT_STRTOUL
  331. addr = simple_strtoull(argv[2], NULL, 16);
  332. size = simple_strtoull(argv[3], NULL, 16);
  333. #else
  334. addr = simple_strtoul(argv[2], NULL, 16);
  335. size = simple_strtoul(argv[3], NULL, 16);
  336. #endif
  337. err = fdt_fixup_memory(working_fdt, addr, size);
  338. if (err < 0)
  339. return err;
  340. /********************************************************************
  341. * mem reserve commands
  342. ********************************************************************/
  343. } else if (strncmp(argv[1], "rs", 2) == 0) {
  344. if (argv[2][0] == 'p') {
  345. uint64_t addr, size;
  346. int total = fdt_num_mem_rsv(working_fdt);
  347. int j, err;
  348. printf("index\t\t start\t\t size\n");
  349. printf("-------------------------------"
  350. "-----------------\n");
  351. for (j = 0; j < total; j++) {
  352. err = fdt_get_mem_rsv(working_fdt, j, &addr, &size);
  353. if (err < 0) {
  354. printf("libfdt fdt_get_mem_rsv(): %s\n",
  355. fdt_strerror(err));
  356. return err;
  357. }
  358. printf(" %x\t%08x%08x\t%08x%08x\n", j,
  359. (u32)(addr >> 32),
  360. (u32)(addr & 0xffffffff),
  361. (u32)(size >> 32),
  362. (u32)(size & 0xffffffff));
  363. }
  364. } else if (argv[2][0] == 'a') {
  365. uint64_t addr, size;
  366. int err;
  367. #ifdef CONFIG_SYS_64BIT_STRTOUL
  368. addr = simple_strtoull(argv[3], NULL, 16);
  369. size = simple_strtoull(argv[4], NULL, 16);
  370. #else
  371. addr = simple_strtoul(argv[3], NULL, 16);
  372. size = simple_strtoul(argv[4], NULL, 16);
  373. #endif
  374. err = fdt_add_mem_rsv(working_fdt, addr, size);
  375. if (err < 0) {
  376. printf("libfdt fdt_add_mem_rsv(): %s\n",
  377. fdt_strerror(err));
  378. return err;
  379. }
  380. } else if (argv[2][0] == 'd') {
  381. unsigned long idx = simple_strtoul(argv[3], NULL, 16);
  382. int err = fdt_del_mem_rsv(working_fdt, idx);
  383. if (err < 0) {
  384. printf("libfdt fdt_del_mem_rsv(): %s\n",
  385. fdt_strerror(err));
  386. return err;
  387. }
  388. } else {
  389. /* Unrecognized command */
  390. cmd_usage(cmdtp);
  391. return 1;
  392. }
  393. }
  394. #ifdef CONFIG_OF_BOARD_SETUP
  395. /* Call the board-specific fixup routine */
  396. else if (strncmp(argv[1], "boa", 3) == 0)
  397. ft_board_setup(working_fdt, gd->bd);
  398. #endif
  399. /* Create a chosen node */
  400. else if (argv[1][0] == 'c') {
  401. unsigned long initrd_start = 0, initrd_end = 0;
  402. if ((argc != 2) && (argc != 4)) {
  403. cmd_usage(cmdtp);
  404. return 1;
  405. }
  406. if (argc == 4) {
  407. initrd_start = simple_strtoul(argv[2], NULL, 16);
  408. initrd_end = simple_strtoul(argv[3], NULL, 16);
  409. }
  410. fdt_chosen(working_fdt, 1);
  411. fdt_initrd(working_fdt, initrd_start, initrd_end, 1);
  412. }
  413. /* resize the fdt */
  414. else if (strncmp(argv[1], "re", 2) == 0) {
  415. fdt_resize(working_fdt);
  416. }
  417. else {
  418. /* Unrecognized command */
  419. cmd_usage(cmdtp);
  420. return 1;
  421. }
  422. return 0;
  423. }
  424. /****************************************************************************/
  425. static int fdt_valid(void)
  426. {
  427. int err;
  428. if (working_fdt == NULL) {
  429. printf ("The address of the fdt is invalid (NULL).\n");
  430. return 0;
  431. }
  432. err = fdt_check_header(working_fdt);
  433. if (err == 0)
  434. return 1; /* valid */
  435. if (err < 0) {
  436. printf("libfdt fdt_check_header(): %s", fdt_strerror(err));
  437. /*
  438. * Be more informative on bad version.
  439. */
  440. if (err == -FDT_ERR_BADVERSION) {
  441. if (fdt_version(working_fdt) <
  442. FDT_FIRST_SUPPORTED_VERSION) {
  443. printf (" - too old, fdt %d < %d",
  444. fdt_version(working_fdt),
  445. FDT_FIRST_SUPPORTED_VERSION);
  446. working_fdt = NULL;
  447. }
  448. if (fdt_last_comp_version(working_fdt) >
  449. FDT_LAST_SUPPORTED_VERSION) {
  450. printf (" - too new, fdt %d > %d",
  451. fdt_version(working_fdt),
  452. FDT_LAST_SUPPORTED_VERSION);
  453. working_fdt = NULL;
  454. }
  455. return 0;
  456. }
  457. printf("\n");
  458. return 0;
  459. }
  460. return 1;
  461. }
  462. /****************************************************************************/
  463. /*
  464. * Parse the user's input, partially heuristic. Valid formats:
  465. * <0x00112233 4 05> - an array of cells. Numbers follow standard
  466. * C conventions.
  467. * [00 11 22 .. nn] - byte stream
  468. * "string" - If the the value doesn't start with "<" or "[", it is
  469. * treated as a string. Note that the quotes are
  470. * stripped by the parser before we get the string.
  471. * newval: An array of strings containing the new property as specified
  472. * on the command line
  473. * count: The number of strings in the array
  474. * data: A bytestream to be placed in the property
  475. * len: The length of the resulting bytestream
  476. */
  477. static int fdt_parse_prop(char **newval, int count, char *data, int *len)
  478. {
  479. char *cp; /* temporary char pointer */
  480. char *newp; /* temporary newval char pointer */
  481. unsigned long tmp; /* holds converted values */
  482. int stridx = 0;
  483. *len = 0;
  484. newp = newval[0];
  485. /* An array of cells */
  486. if (*newp == '<') {
  487. newp++;
  488. while ((*newp != '>') && (stridx < count)) {
  489. /*
  490. * Keep searching until we find that last ">"
  491. * That way users don't have to escape the spaces
  492. */
  493. if (*newp == '\0') {
  494. newp = newval[++stridx];
  495. continue;
  496. }
  497. cp = newp;
  498. tmp = simple_strtoul(cp, &newp, 0);
  499. *(uint32_t *)data = __cpu_to_be32(tmp);
  500. data += 4;
  501. *len += 4;
  502. /* If the ptr didn't advance, something went wrong */
  503. if ((newp - cp) <= 0) {
  504. printf("Sorry, I could not convert \"%s\"\n",
  505. cp);
  506. return 1;
  507. }
  508. while (*newp == ' ')
  509. newp++;
  510. }
  511. if (*newp != '>') {
  512. printf("Unexpected character '%c'\n", *newp);
  513. return 1;
  514. }
  515. } else if (*newp == '[') {
  516. /*
  517. * Byte stream. Convert the values.
  518. */
  519. newp++;
  520. while ((*newp != ']') && (stridx < count)) {
  521. tmp = simple_strtoul(newp, &newp, 16);
  522. *data++ = tmp & 0xFF;
  523. *len = *len + 1;
  524. while (*newp == ' ')
  525. newp++;
  526. if (*newp != '\0')
  527. newp = newval[++stridx];
  528. }
  529. if (*newp != ']') {
  530. printf("Unexpected character '%c'\n", *newp);
  531. return 1;
  532. }
  533. } else {
  534. /*
  535. * Assume it is a string. Copy it into our data area for
  536. * convenience (including the terminating '\0').
  537. */
  538. while (stridx < count) {
  539. *len = strlen(newp) + 1;
  540. strcpy(data, newp);
  541. newp = newval[++stridx];
  542. }
  543. }
  544. return 0;
  545. }
  546. /****************************************************************************/
  547. /*
  548. * Heuristic to guess if this is a string or concatenated strings.
  549. */
  550. static int is_printable_string(const void *data, int len)
  551. {
  552. const char *s = data;
  553. /* zero length is not */
  554. if (len == 0)
  555. return 0;
  556. /* must terminate with zero */
  557. if (s[len - 1] != '\0')
  558. return 0;
  559. /* printable or a null byte (concatenated strings) */
  560. while (((*s == '\0') || isprint(*s)) && (len > 0)) {
  561. /*
  562. * If we see a null, there are three possibilities:
  563. * 1) If len == 1, it is the end of the string, printable
  564. * 2) Next character also a null, not printable.
  565. * 3) Next character not a null, continue to check.
  566. */
  567. if (s[0] == '\0') {
  568. if (len == 1)
  569. return 1;
  570. if (s[1] == '\0')
  571. return 0;
  572. }
  573. s++;
  574. len--;
  575. }
  576. /* Not the null termination, or not done yet: not printable */
  577. if (*s != '\0' || (len != 0))
  578. return 0;
  579. return 1;
  580. }
  581. /*
  582. * Print the property in the best format, a heuristic guess. Print as
  583. * a string, concatenated strings, a byte, word, double word, or (if all
  584. * else fails) it is printed as a stream of bytes.
  585. */
  586. static void print_data(const void *data, int len)
  587. {
  588. int j;
  589. /* no data, don't print */
  590. if (len == 0)
  591. return;
  592. /*
  593. * It is a string, but it may have multiple strings (embedded '\0's).
  594. */
  595. if (is_printable_string(data, len)) {
  596. puts("\"");
  597. j = 0;
  598. while (j < len) {
  599. if (j > 0)
  600. puts("\", \"");
  601. puts(data);
  602. j += strlen(data) + 1;
  603. data += strlen(data) + 1;
  604. }
  605. puts("\"");
  606. return;
  607. }
  608. if ((len %4) == 0) {
  609. const u32 *p;
  610. printf("<");
  611. for (j = 0, p = data; j < len/4; j ++)
  612. printf("0x%x%s", p[j], j < (len/4 - 1) ? " " : "");
  613. printf(">");
  614. } else { /* anything else... hexdump */
  615. const u8 *s;
  616. printf("[");
  617. for (j = 0, s = data; j < len; j++)
  618. printf("%02x%s", s[j], j < len - 1 ? " " : "");
  619. printf("]");
  620. }
  621. }
  622. /****************************************************************************/
  623. /*
  624. * Recursively print (a portion of) the working_fdt. The depth parameter
  625. * determines how deeply nested the fdt is printed.
  626. */
  627. static int fdt_print(const char *pathp, char *prop, int depth)
  628. {
  629. static char tabs[MAX_LEVEL+1] =
  630. "\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t"
  631. "\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t\t";
  632. const void *nodep; /* property node pointer */
  633. int nodeoffset; /* node offset from libfdt */
  634. int nextoffset; /* next node offset from libfdt */
  635. uint32_t tag; /* tag */
  636. int len; /* length of the property */
  637. int level = 0; /* keep track of nesting level */
  638. const struct fdt_property *fdt_prop;
  639. nodeoffset = fdt_path_offset (working_fdt, pathp);
  640. if (nodeoffset < 0) {
  641. /*
  642. * Not found or something else bad happened.
  643. */
  644. printf ("libfdt fdt_path_offset() returned %s\n",
  645. fdt_strerror(nodeoffset));
  646. return 1;
  647. }
  648. /*
  649. * The user passed in a property as well as node path.
  650. * Print only the given property and then return.
  651. */
  652. if (prop) {
  653. nodep = fdt_getprop (working_fdt, nodeoffset, prop, &len);
  654. if (len == 0) {
  655. /* no property value */
  656. printf("%s %s\n", pathp, prop);
  657. return 0;
  658. } else if (len > 0) {
  659. printf("%s = ", prop);
  660. print_data (nodep, len);
  661. printf("\n");
  662. return 0;
  663. } else {
  664. printf ("libfdt fdt_getprop(): %s\n",
  665. fdt_strerror(len));
  666. return 1;
  667. }
  668. }
  669. /*
  670. * The user passed in a node path and no property,
  671. * print the node and all subnodes.
  672. */
  673. while(level >= 0) {
  674. tag = fdt_next_tag(working_fdt, nodeoffset, &nextoffset);
  675. switch(tag) {
  676. case FDT_BEGIN_NODE:
  677. pathp = fdt_get_name(working_fdt, nodeoffset, NULL);
  678. if (level <= depth) {
  679. if (pathp == NULL)
  680. pathp = "/* NULL pointer error */";
  681. if (*pathp == '\0')
  682. pathp = "/"; /* root is nameless */
  683. printf("%s%s {\n",
  684. &tabs[MAX_LEVEL - level], pathp);
  685. }
  686. level++;
  687. if (level >= MAX_LEVEL) {
  688. printf("Nested too deep, aborting.\n");
  689. return 1;
  690. }
  691. break;
  692. case FDT_END_NODE:
  693. level--;
  694. if (level <= depth)
  695. printf("%s};\n", &tabs[MAX_LEVEL - level]);
  696. if (level == 0) {
  697. level = -1; /* exit the loop */
  698. }
  699. break;
  700. case FDT_PROP:
  701. fdt_prop = fdt_offset_ptr(working_fdt, nodeoffset,
  702. sizeof(*fdt_prop));
  703. pathp = fdt_string(working_fdt,
  704. fdt32_to_cpu(fdt_prop->nameoff));
  705. len = fdt32_to_cpu(fdt_prop->len);
  706. nodep = fdt_prop->data;
  707. if (len < 0) {
  708. printf ("libfdt fdt_getprop(): %s\n",
  709. fdt_strerror(len));
  710. return 1;
  711. } else if (len == 0) {
  712. /* the property has no value */
  713. if (level <= depth)
  714. printf("%s%s;\n",
  715. &tabs[MAX_LEVEL - level],
  716. pathp);
  717. } else {
  718. if (level <= depth) {
  719. printf("%s%s = ",
  720. &tabs[MAX_LEVEL - level],
  721. pathp);
  722. print_data (nodep, len);
  723. printf(";\n");
  724. }
  725. }
  726. break;
  727. case FDT_NOP:
  728. printf("%s/* NOP */\n", &tabs[MAX_LEVEL - level]);
  729. break;
  730. case FDT_END:
  731. return 1;
  732. default:
  733. if (level <= depth)
  734. printf("Unknown tag 0x%08X\n", tag);
  735. return 1;
  736. }
  737. nodeoffset = nextoffset;
  738. }
  739. return 0;
  740. }
  741. /********************************************************************/
  742. U_BOOT_CMD(
  743. fdt, 255, 0, do_fdt,
  744. "flattened device tree utility commands",
  745. "addr <addr> [<length>] - Set the fdt location to <addr>\n"
  746. #ifdef CONFIG_OF_BOARD_SETUP
  747. "fdt boardsetup - Do board-specific set up\n"
  748. #endif
  749. "fdt move <fdt> <newaddr> <length> - Copy the fdt to <addr> and make it active\n"
  750. "fdt resize - Resize fdt to size + padding to 4k addr\n"
  751. "fdt print <path> [<prop>] - Recursive print starting at <path>\n"
  752. "fdt list <path> [<prop>] - Print one level starting at <path>\n"
  753. "fdt set <path> <prop> [<val>] - Set <property> [to <val>]\n"
  754. "fdt mknode <path> <node> - Create a new node after <path>\n"
  755. "fdt rm <path> [<prop>] - Delete the node or <property>\n"
  756. "fdt header - Display header info\n"
  757. "fdt bootcpu <id> - Set boot cpuid\n"
  758. "fdt memory <addr> <size> - Add/Update memory node\n"
  759. "fdt rsvmem print - Show current mem reserves\n"
  760. "fdt rsvmem add <addr> <size> - Add a mem reserve\n"
  761. "fdt rsvmem delete <index> - Delete a mem reserves\n"
  762. "fdt chosen [<start> <end>] - Add/update the /chosen branch in the tree\n"
  763. " <start>/<end> - initrd start/end addr\n"
  764. "NOTE: Dereference aliases by omiting the leading '/', "
  765. "e.g. fdt print ethernet0.\n"
  766. );