initial oftree command support

This adds basic device tree command support. So far we can
parse a flat device tree (-p), which also stores the tree
in memory, dump it (-d) and free (-f) the internally stored tree.

The chosen node can be updated with barebox bootargs, no other
device tree manipulation is implemented yet.

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>

1 files changed, 135 insertions, 0 deletions

diff --git a/commands/oftree.c b/commands/oftree.c
new file mode 100644
index 0000000000..d8deb36edc
--- /dev/null
+++ b/commands/oftree.c
@@ -0,0 +1,135 @@
+/*
+ * oftree.c - device tree command support
+ *
+ * Copyright (c) 2011 Sascha Hauer <s.hauer@pengutronix.de>, Pengutronix
+ *
+ * based on U-Boot code by:
+ *
+ * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com
+ * Pantelis Antoniou <pantelis.antoniou@gmail.com> and
+ * Matthew McClintock <msm@freescale.com>
+ *
+ * See file CREDITS for list of people who contributed to this
+ * project.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2
+ * as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+
+#include <common.h>
+#include <environment.h>
+#include <fdt.h>
+#include <of.h>
+#include <command.h>
+#include <fs.h>
+#include <malloc.h>
+#include <libfdt.h>
+#include <linux/ctype.h>
+#include <asm/byteorder.h>
+#include <errno.h>
+#include <getopt.h>
+#include <init.h>
+
+static int do_oftree(struct command *cmdtp, int argc, char *argv[])
+{
+	struct fdt_header *fdt;
+	int size;
+	int opt;
+	char *file = NULL;
+	const char *node = "/";
+	int dump = 0;
+	int parse = 0;
+
+	while ((opt = getopt(argc, argv, "dpfn:")) > 0) {
+		switch (opt) {
+		case 'd':
+			dump = 1;
+			break;
+		case 'p':
+			parse = 1;
+			break;
+		case 'f':
+			free(barebox_fdt);
+			barebox_fdt = NULL;
+			return 0;
+		case 'n':
+			node = optarg;
+			break;
+		}
+	}
+
+	if (optind < argc)
+		file = argv[optind];
+
+	if (!dump && !parse)
+		return COMMAND_ERROR_USAGE;
+
+	if (dump) {
+		if (file) {
+			fdt = read_file(file, &size);
+			if (!fdt) {
+				printf("unable to read %s\n", file);
+				return 1;
+			}
+
+			fdt_print(fdt, node);
+			free(fdt);
+		} else {
+			if (barebox_fdt) {
+				fdt_print(barebox_fdt, node);
+				return 0;
+			} else {
+				return 1;
+			}
+		}
+		return 0;
+	}
+
+	if (parse) {
+		if (!file)
+			return COMMAND_ERROR_USAGE;
+
+		fdt = read_file(file, &size);
+		if (!fdt) {
+			perror("open");
+			return 1;
+		}
+
+		fdt = xrealloc(fdt, size + 0x8000);
+		fdt_open_into(fdt, fdt, size + 0x8000);
+		if (!fdt) {
+			printf("unable to read %s\n", file);
+			return 1;
+		}
+
+		if (barebox_fdt)
+			free(barebox_fdt);
+
+		barebox_fdt = fdt;
+	}
+
+	return 0;
+}
+
+BAREBOX_CMD_HELP_START(oftree)
+BAREBOX_CMD_HELP_USAGE("oftree [OPTIONS]\n")
+BAREBOX_CMD_HELP_OPT  ("-p <FILE>",  "parse and store oftree from <file>\n")
+BAREBOX_CMD_HELP_OPT  ("-d [FILE]",  "dump oftree from [FILE] or the parsed tree if no file is given\n")
+BAREBOX_CMD_HELP_OPT  ("-f",  "free stored oftree\n")
+BAREBOX_CMD_HELP_END
+
+BAREBOX_CMD_START(oftree)
+	.cmd		= do_oftree,
+	.usage		= "handle oftrees",
+	BAREBOX_CMD_HELP(cmd_oftree_help)
+BAREBOX_CMD_END