blob: f30e8d038f01f7c4cb803a65e09b5a8c9ff3bda3 [file] [log] [blame]
Adrian Bunk88278ca2008-05-19 16:53:02 -07001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 * tree.c: Basic device tree traversal/scanning for the Linux
3 * prom library.
4 *
5 * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
6 */
7
Linus Torvalds1da177e2005-04-16 15:20:36 -07008#include <linux/string.h>
9#include <linux/types.h>
10#include <linux/kernel.h>
11#include <linux/sched.h>
12#include <linux/ctype.h>
Sam Ravnborg6943f3d2009-01-08 16:58:05 -080013#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014
15#include <asm/openprom.h>
16#include <asm/oplib.h>
17
18extern void restore_current(void);
19
20static char promlib_buf[128];
21
22/* Internal version of prom_getchild that does not alter return values. */
Sam Ravnborg1f42be42011-01-01 12:53:11 +000023static phandle __prom_getchild(phandle node)
Linus Torvalds1da177e2005-04-16 15:20:36 -070024{
25 unsigned long flags;
Andres Salomon8d125562010-10-08 14:18:11 -070026 phandle cnode;
Linus Torvalds1da177e2005-04-16 15:20:36 -070027
28 spin_lock_irqsave(&prom_lock, flags);
29 cnode = prom_nodeops->no_child(node);
30 restore_current();
31 spin_unlock_irqrestore(&prom_lock, flags);
32
33 return cnode;
34}
35
36/* Return the child of node 'node' or zero if no this node has no
37 * direct descendent.
38 */
Andres Salomon8d125562010-10-08 14:18:11 -070039phandle prom_getchild(phandle node)
Linus Torvalds1da177e2005-04-16 15:20:36 -070040{
Andres Salomon8d125562010-10-08 14:18:11 -070041 phandle cnode;
Linus Torvalds1da177e2005-04-16 15:20:36 -070042
Andres Salomon4a3a2552010-11-11 22:42:06 -080043 if ((s32)node == -1)
Linus Torvalds1da177e2005-04-16 15:20:36 -070044 return 0;
45
46 cnode = __prom_getchild(node);
Andres Salomon4a3a2552010-11-11 22:42:06 -080047 if (cnode == 0 || (s32)cnode == -1)
Linus Torvalds1da177e2005-04-16 15:20:36 -070048 return 0;
49
50 return cnode;
51}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -080052EXPORT_SYMBOL(prom_getchild);
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
54/* Internal version of prom_getsibling that does not alter return values. */
Sam Ravnborg1f42be42011-01-01 12:53:11 +000055static phandle __prom_getsibling(phandle node)
Linus Torvalds1da177e2005-04-16 15:20:36 -070056{
57 unsigned long flags;
Andres Salomon8d125562010-10-08 14:18:11 -070058 phandle cnode;
Linus Torvalds1da177e2005-04-16 15:20:36 -070059
60 spin_lock_irqsave(&prom_lock, flags);
61 cnode = prom_nodeops->no_nextnode(node);
62 restore_current();
63 spin_unlock_irqrestore(&prom_lock, flags);
64
65 return cnode;
66}
67
68/* Return the next sibling of node 'node' or zero if no more siblings
69 * at this level of depth in the tree.
70 */
Andres Salomon8d125562010-10-08 14:18:11 -070071phandle prom_getsibling(phandle node)
Linus Torvalds1da177e2005-04-16 15:20:36 -070072{
Andres Salomon8d125562010-10-08 14:18:11 -070073 phandle sibnode;
Linus Torvalds1da177e2005-04-16 15:20:36 -070074
Andres Salomon4a3a2552010-11-11 22:42:06 -080075 if ((s32)node == -1)
Linus Torvalds1da177e2005-04-16 15:20:36 -070076 return 0;
77
78 sibnode = __prom_getsibling(node);
Andres Salomon4a3a2552010-11-11 22:42:06 -080079 if (sibnode == 0 || (s32)sibnode == -1)
Linus Torvalds1da177e2005-04-16 15:20:36 -070080 return 0;
81
82 return sibnode;
83}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -080084EXPORT_SYMBOL(prom_getsibling);
Linus Torvalds1da177e2005-04-16 15:20:36 -070085
86/* Return the length in bytes of property 'prop' at node 'node'.
87 * Return -1 on error.
88 */
Andres Salomon8d125562010-10-08 14:18:11 -070089int prom_getproplen(phandle node, const char *prop)
Linus Torvalds1da177e2005-04-16 15:20:36 -070090{
91 int ret;
92 unsigned long flags;
93
94 if((!node) || (!prop))
95 return -1;
96
97 spin_lock_irqsave(&prom_lock, flags);
98 ret = prom_nodeops->no_proplen(node, prop);
99 restore_current();
100 spin_unlock_irqrestore(&prom_lock, flags);
101 return ret;
102}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800103EXPORT_SYMBOL(prom_getproplen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700104
105/* Acquire a property 'prop' at node 'node' and place it in
106 * 'buffer' which has a size of 'bufsize'. If the acquisition
107 * was successful the length will be returned, else -1 is returned.
108 */
Andres Salomon8d125562010-10-08 14:18:11 -0700109int prom_getproperty(phandle node, const char *prop, char *buffer, int bufsize)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110{
111 int plen, ret;
112 unsigned long flags;
113
114 plen = prom_getproplen(node, prop);
115 if((plen > bufsize) || (plen == 0) || (plen == -1))
116 return -1;
117 /* Ok, things seem all right. */
118 spin_lock_irqsave(&prom_lock, flags);
119 ret = prom_nodeops->no_getprop(node, prop, buffer);
120 restore_current();
121 spin_unlock_irqrestore(&prom_lock, flags);
122 return ret;
123}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800124EXPORT_SYMBOL(prom_getproperty);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125
126/* Acquire an integer property and return its value. Returns -1
127 * on failure.
128 */
Andres Salomon8d125562010-10-08 14:18:11 -0700129int prom_getint(phandle node, char *prop)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130{
131 static int intprop;
132
133 if(prom_getproperty(node, prop, (char *) &intprop, sizeof(int)) != -1)
134 return intprop;
135
136 return -1;
137}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800138EXPORT_SYMBOL(prom_getint);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700139
140/* Acquire an integer property, upon error return the passed default
141 * integer.
142 */
Andres Salomon8d125562010-10-08 14:18:11 -0700143int prom_getintdefault(phandle node, char *property, int deflt)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700144{
145 int retval;
146
147 retval = prom_getint(node, property);
148 if(retval == -1) return deflt;
149
150 return retval;
151}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800152EXPORT_SYMBOL(prom_getintdefault);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153
154/* Acquire a boolean property, 1=TRUE 0=FALSE. */
Andres Salomon8d125562010-10-08 14:18:11 -0700155int prom_getbool(phandle node, char *prop)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156{
157 int retval;
158
159 retval = prom_getproplen(node, prop);
160 if(retval == -1) return 0;
161 return 1;
162}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800163EXPORT_SYMBOL(prom_getbool);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164
165/* Acquire a property whose value is a string, returns a null
166 * string on error. The char pointer is the user supplied string
167 * buffer.
168 */
Andres Salomon8d125562010-10-08 14:18:11 -0700169void prom_getstring(phandle node, char *prop, char *user_buf, int ubuf_size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170{
171 int len;
172
173 len = prom_getproperty(node, prop, user_buf, ubuf_size);
174 if(len != -1) return;
175 user_buf[0] = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800177EXPORT_SYMBOL(prom_getstring);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700178
179
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180/* Search siblings at 'node_start' for a node with name
181 * 'nodename'. Return node if successful, zero if not.
182 */
Andres Salomon8d125562010-10-08 14:18:11 -0700183phandle prom_searchsiblings(phandle node_start, char *nodename)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184{
185
Andres Salomon8d125562010-10-08 14:18:11 -0700186 phandle thisnode;
187 int error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188
189 for(thisnode = node_start; thisnode;
190 thisnode=prom_getsibling(thisnode)) {
191 error = prom_getproperty(thisnode, "name", promlib_buf,
192 sizeof(promlib_buf));
193 /* Should this ever happen? */
194 if(error == -1) continue;
195 if(strcmp(nodename, promlib_buf)==0) return thisnode;
196 }
197
198 return 0;
199}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800200EXPORT_SYMBOL(prom_searchsiblings);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202/* Interal version of nextprop that does not alter return values. */
Sam Ravnborg1f42be42011-01-01 12:53:11 +0000203static char *__prom_nextprop(phandle node, char * oprop)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204{
205 unsigned long flags;
206 char *prop;
207
208 spin_lock_irqsave(&prom_lock, flags);
209 prop = prom_nodeops->no_nextprop(node, oprop);
210 restore_current();
211 spin_unlock_irqrestore(&prom_lock, flags);
212
213 return prop;
214}
215
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216/* Return the property type string after property type 'oprop'
217 * at node 'node' . Returns empty string if no more
218 * property types for this node.
219 */
Andres Salomon8d125562010-10-08 14:18:11 -0700220char *prom_nextprop(phandle node, char *oprop, char *buffer)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221{
Andres Salomon4a3a2552010-11-11 22:42:06 -0800222 if (node == 0 || (s32)node == -1)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223 return "";
224
225 return __prom_nextprop(node, oprop);
226}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800227EXPORT_SYMBOL(prom_nextprop);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228
Andres Salomon8d125562010-10-08 14:18:11 -0700229phandle prom_finddevice(char *name)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230{
231 char nbuf[128];
232 char *s = name, *d;
Andres Salomon8d125562010-10-08 14:18:11 -0700233 phandle node = prom_root_node, node2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234 unsigned int which_io, phys_addr;
235 struct linux_prom_registers reg[PROMREG_MAX];
236
237 while (*s++) {
238 if (!*s) return node; /* path '.../' is legal */
239 node = prom_getchild(node);
240
241 for (d = nbuf; *s != 0 && *s != '@' && *s != '/';)
242 *d++ = *s++;
243 *d = 0;
244
245 node = prom_searchsiblings(node, nbuf);
246 if (!node)
247 return 0;
248
249 if (*s == '@') {
250 if (isxdigit(s[1]) && s[2] == ',') {
251 which_io = simple_strtoul(s+1, NULL, 16);
252 phys_addr = simple_strtoul(s+3, &d, 16);
253 if (d != s + 3 && (!*d || *d == '/')
254 && d <= s + 3 + 8) {
255 node2 = node;
Andres Salomon4a3a2552010-11-11 22:42:06 -0800256 while (node2 && (s32)node2 != -1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257 if (prom_getproperty (node2, "reg", (char *)reg, sizeof (reg)) > 0) {
258 if (which_io == reg[0].which_io && phys_addr == reg[0].phys_addr) {
259 node = node2;
260 break;
261 }
262 }
263 node2 = prom_getsibling(node2);
Andres Salomon4a3a2552010-11-11 22:42:06 -0800264 if (!node2 || (s32)node2 == -1)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265 break;
266 node2 = prom_searchsiblings(prom_getsibling(node2), nbuf);
267 }
268 }
269 }
270 while (*s != 0 && *s != '/') s++;
271 }
272 }
273 return node;
274}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800275EXPORT_SYMBOL(prom_finddevice);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277/* Set property 'pname' at node 'node' to value 'value' which has a length
278 * of 'size' bytes. Return the number of bytes the prom accepted.
279 */
Andres Salomon8d125562010-10-08 14:18:11 -0700280int prom_setprop(phandle node, const char *pname, char *value, int size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700281{
282 unsigned long flags;
283 int ret;
284
Sam Ravnborg5f66dd32011-01-03 08:27:55 +0000285 if (size == 0)
286 return 0;
287 if ((pname == NULL) || (value == NULL))
288 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700289 spin_lock_irqsave(&prom_lock, flags);
290 ret = prom_nodeops->no_setprop(node, pname, value, size);
291 restore_current();
292 spin_unlock_irqrestore(&prom_lock, flags);
293 return ret;
294}
Sam Ravnborg6943f3d2009-01-08 16:58:05 -0800295EXPORT_SYMBOL(prom_setprop);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296
Andres Salomon8d125562010-10-08 14:18:11 -0700297phandle prom_inst2pkg(int inst)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298{
Andres Salomon8d125562010-10-08 14:18:11 -0700299 phandle node;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 unsigned long flags;
301
302 spin_lock_irqsave(&prom_lock, flags);
303 node = (*romvec->pv_v2devops.v2_inst2pkg)(inst);
304 restore_current();
305 spin_unlock_irqrestore(&prom_lock, flags);
Andres Salomon4a3a2552010-11-11 22:42:06 -0800306 if ((s32)node == -1)
307 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700308 return node;
309}