From aa9d092029e1a8e2ee21f04cd321e8c3368f6deb Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Fran=C3=A7ois=20Revol?= <revol@free.fr>
Date: Mon, 18 Feb 2013 02:40:16 +0100
Subject: [PATCH] U-Boot: implement of_get_next_device() in the OF wrapper

---
 .../kernel/platform/u-boot/openfirmware.cpp   | 33 ++++++++++++++++++-
 1 file changed, 32 insertions(+), 1 deletion(-)

diff --git a/src/system/kernel/platform/u-boot/openfirmware.cpp b/src/system/kernel/platform/u-boot/openfirmware.cpp
index 9a56ce93ce..cdf2d27eb6 100644
--- a/src/system/kernel/platform/u-boot/openfirmware.cpp
+++ b/src/system/kernel/platform/u-boot/openfirmware.cpp
@@ -112,7 +112,38 @@ status_t
 of_get_next_device(int *_cookie, int root, const char *type, char *path,
 	size_t pathSize)
 {
-	return B_ERROR;
+	int next;
+	int err;
+
+	int startoffset = *_cookie ? *_cookie : -1;
+//	if (startoffset < 0 && root != 0)
+//		startoffset = root;
+
+	// iterate by property value
+	next = fdt_node_offset_by_prop_value(gFDT, startoffset, "device_type",
+		type, strlen(type) + 1);
+	TRACE(("of_get_next_device(c:%d, %d, '%s', %p, %zd) soffset=%d next=%d\n",
+		*_cookie, root, type, path, pathSize, startoffset, fdt2of(next)));
+	if (next < 0)
+		return B_ENTRY_NOT_FOUND;
+
+	// make sure root is the parent
+	int parent = next;
+	while (root && parent) {
+		parent = fdt_parent_offset(gFDT, parent);
+		if (parent == root)
+			break;
+		if (parent <= 0)
+			return B_ENTRY_NOT_FOUND;
+	}
+
+	*_cookie = next;
+
+	err = fdt_get_path(gFDT, next, path, pathSize);
+	if (err < 0)
+		return B_ERROR;
+
+	return B_OK;
 }