From 8cd24ed4f8031636fb5dacb04adee9e02556ecd5 Mon Sep 17 00:00:00 2001
From: "David S. Miller" <davem@sunset.davemloft.net>
Date: Thu, 22 Jun 2006 22:08:58 -0700
Subject: [PATCH] [SPARC64]: Expand of_*() interfaces some more.

Import some more stuff from powerpc.

Add of_device_is_compatible(), and of_find_compatible_node().
Export some more of the other routines to modules.

Signed-off-by: David S. Miller <davem@davemloft.net>
---
 arch/sparc64/kernel/prom.c | 43 ++++++++++++++++++++++++++++++++++++++
 include/asm-sparc64/prom.h |  3 +++
 2 files changed, 46 insertions(+)

diff --git a/arch/sparc64/kernel/prom.c b/arch/sparc64/kernel/prom.c
index 7809100034..e9d703eea8 100644
--- a/arch/sparc64/kernel/prom.c
+++ b/arch/sparc64/kernel/prom.c
@@ -27,6 +27,26 @@
 
 static struct device_node *allnodes;
 
+int of_device_is_compatible(struct device_node *device, const char *compat)
+{
+	const char* cp;
+	int cplen, l;
+
+	cp = (char *) of_get_property(device, "compatible", &cplen);
+	if (cp == NULL)
+		return 0;
+	while (cplen > 0) {
+		if (strncmp(cp, compat, strlen(compat)) == 0)
+			return 1;
+		l = strlen(cp) + 1;
+		cp += l;
+		cplen -= l;
+	}
+
+	return 0;
+}
+EXPORT_SYMBOL(of_device_is_compatible);
+
 struct device_node *of_get_parent(const struct device_node *node)
 {
 	struct device_node *np;
@@ -38,6 +58,7 @@ struct device_node *of_get_parent(const struct device_node *node)
 
 	return np;
 }
+EXPORT_SYMBOL(of_get_parent);
 
 struct device_node *of_get_next_child(const struct device_node *node,
 	struct device_node *prev)
@@ -51,6 +72,7 @@ struct device_node *of_get_next_child(const struct device_node *node,
 
 	return next;
 }
+EXPORT_SYMBOL(of_get_next_child);
 
 struct device_node *of_find_node_by_path(const char *path)
 {
@@ -75,6 +97,7 @@ struct device_node *of_find_node_by_phandle(phandle handle)
 
 	return np;
 }
+EXPORT_SYMBOL(of_find_node_by_phandle);
 
 struct device_node *of_find_node_by_name(struct device_node *from,
 	const char *name)
@@ -88,6 +111,7 @@ struct device_node *of_find_node_by_name(struct device_node *from,
 
 	return np;
 }
+EXPORT_SYMBOL(of_find_node_by_name);
 
 struct device_node *of_find_node_by_type(struct device_node *from,
 	const char *type)
@@ -101,6 +125,25 @@ struct device_node *of_find_node_by_type(struct device_node *from,
 
 	return np;
 }
+EXPORT_SYMBOL(of_find_node_by_type);
+
+struct device_node *of_find_compatible_node(struct device_node *from,
+	const char *type, const char *compatible)
+{
+	struct device_node *np;
+
+	np = from ? from->allnext : allnodes;
+	for (; np != 0; np = np->allnext) {
+		if (type != NULL
+		    && !(np->type != 0 && strcmp(np->type, type) == 0))
+			continue;
+		if (of_device_is_compatible(np, compatible))
+			break;
+	}
+
+	return np;
+}
+EXPORT_SYMBOL(of_find_compatible_node);
 
 struct property *of_find_property(struct device_node *np, const char *name,
 				  int *lenp)
diff --git a/include/asm-sparc64/prom.h b/include/asm-sparc64/prom.h
index 062ae6e121..6d1556c0c2 100644
--- a/include/asm-sparc64/prom.h
+++ b/include/asm-sparc64/prom.h
@@ -75,6 +75,8 @@ extern struct device_node *of_find_node_by_type(struct device_node *from,
 #define for_each_node_by_type(dn, type) \
 	for (dn = of_find_node_by_type(NULL, type); dn; \
 	     dn = of_find_node_by_type(dn, type))
+extern struct device_node *of_find_compatible_node(struct device_node *from,
+	const char *type, const char *compat);
 extern struct device_node *of_find_node_by_path(const char *path);
 extern struct device_node *of_find_node_by_phandle(phandle handle);
 extern struct device_node *of_get_parent(const struct device_node *node);
@@ -83,6 +85,7 @@ extern struct device_node *of_get_next_child(const struct device_node *node,
 extern struct property *of_find_property(struct device_node *np,
 					 const char *name,
 					 int *lenp);
+extern int of_device_is_compatible(struct device_node *device, const char *);
 extern void *of_get_property(struct device_node *node, const char *name,
 			     int *lenp);
 extern int of_getintprop_default(struct device_node *np,
-- 
2.39.5