]> git.karo-electronics.de Git - mv-sheeva.git/blob - arch/sparc/kernel/prom_32.c
sparc: Make sparc32's create_node() assign parent pointer.
[mv-sheeva.git] / arch / sparc / kernel / prom_32.c
1 /*
2  * Procedures for creating, accessing and interpreting the device tree.
3  *
4  * Paul Mackerras       August 1996.
5  * Copyright (C) 1996-2005 Paul Mackerras.
6  * 
7  *  Adapted for 64bit PowerPC by Dave Engebretsen and Peter Bergner.
8  *    {engebret|bergner}@us.ibm.com 
9  *
10  *  Adapted for sparc32 by David S. Miller davem@davemloft.net
11  *
12  *      This program is free software; you can redistribute it and/or
13  *      modify it under the terms of the GNU General Public License
14  *      as published by the Free Software Foundation; either version
15  *      2 of the License, or (at your option) any later version.
16  */
17
18 #include <linux/kernel.h>
19 #include <linux/types.h>
20 #include <linux/string.h>
21 #include <linux/mm.h>
22 #include <linux/bootmem.h>
23 #include <linux/module.h>
24
25 #include <asm/prom.h>
26 #include <asm/oplib.h>
27
28 #include "prom.h"
29
30 static unsigned int prom_early_allocated;
31
32 void * __init prom_early_alloc(unsigned long size)
33 {
34         void *ret;
35
36         ret = __alloc_bootmem(size, SMP_CACHE_BYTES, 0UL);
37         if (ret != NULL)
38                 memset(ret, 0, size);
39
40         prom_early_allocated += size;
41
42         return ret;
43 }
44
45 static int is_root_node(const struct device_node *dp)
46 {
47         if (!dp)
48                 return 0;
49
50         return (dp->parent == NULL);
51 }
52
53 /* The following routines deal with the black magic of fully naming a
54  * node.
55  *
56  * Certain well known named nodes are just the simple name string.
57  *
58  * Actual devices have an address specifier appended to the base name
59  * string, like this "foo@addr".  The "addr" can be in any number of
60  * formats, and the platform plus the type of the node determine the
61  * format and how it is constructed.
62  *
63  * For children of the ROOT node, the naming convention is fixed and
64  * determined by whether this is a sun4u or sun4v system.
65  *
66  * For children of other nodes, it is bus type specific.  So
67  * we walk up the tree until we discover a "device_type" property
68  * we recognize and we go from there.
69  */
70 static void __init sparc32_path_component(struct device_node *dp, char *tmp_buf)
71 {
72         struct linux_prom_registers *regs;
73         struct property *rprop;
74
75         rprop = of_find_property(dp, "reg", NULL);
76         if (!rprop)
77                 return;
78
79         regs = rprop->value;
80         sprintf(tmp_buf, "%s@%x,%x",
81                 dp->name,
82                 regs->which_io, regs->phys_addr);
83 }
84
85 /* "name@slot,offset"  */
86 static void __init sbus_path_component(struct device_node *dp, char *tmp_buf)
87 {
88         struct linux_prom_registers *regs;
89         struct property *prop;
90
91         prop = of_find_property(dp, "reg", NULL);
92         if (!prop)
93                 return;
94
95         regs = prop->value;
96         sprintf(tmp_buf, "%s@%x,%x",
97                 dp->name,
98                 regs->which_io,
99                 regs->phys_addr);
100 }
101
102 /* "name@devnum[,func]" */
103 static void __init pci_path_component(struct device_node *dp, char *tmp_buf)
104 {
105         struct linux_prom_pci_registers *regs;
106         struct property *prop;
107         unsigned int devfn;
108
109         prop = of_find_property(dp, "reg", NULL);
110         if (!prop)
111                 return;
112
113         regs = prop->value;
114         devfn = (regs->phys_hi >> 8) & 0xff;
115         if (devfn & 0x07) {
116                 sprintf(tmp_buf, "%s@%x,%x",
117                         dp->name,
118                         devfn >> 3,
119                         devfn & 0x07);
120         } else {
121                 sprintf(tmp_buf, "%s@%x",
122                         dp->name,
123                         devfn >> 3);
124         }
125 }
126
127 /* "name@addrhi,addrlo" */
128 static void __init ebus_path_component(struct device_node *dp, char *tmp_buf)
129 {
130         struct linux_prom_registers *regs;
131         struct property *prop;
132
133         prop = of_find_property(dp, "reg", NULL);
134         if (!prop)
135                 return;
136
137         regs = prop->value;
138
139         sprintf(tmp_buf, "%s@%x,%x",
140                 dp->name,
141                 regs->which_io, regs->phys_addr);
142 }
143
144 static void __init __build_path_component(struct device_node *dp, char *tmp_buf)
145 {
146         struct device_node *parent = dp->parent;
147
148         if (parent != NULL) {
149                 if (!strcmp(parent->type, "pci") ||
150                     !strcmp(parent->type, "pciex"))
151                         return pci_path_component(dp, tmp_buf);
152                 if (!strcmp(parent->type, "sbus"))
153                         return sbus_path_component(dp, tmp_buf);
154                 if (!strcmp(parent->type, "ebus"))
155                         return ebus_path_component(dp, tmp_buf);
156
157                 /* "isa" is handled with platform naming */
158         }
159
160         /* Use platform naming convention.  */
161         return sparc32_path_component(dp, tmp_buf);
162 }
163
164 static char * __init build_path_component(struct device_node *dp)
165 {
166         char tmp_buf[64], *n;
167
168         tmp_buf[0] = '\0';
169         __build_path_component(dp, tmp_buf);
170         if (tmp_buf[0] == '\0')
171                 strcpy(tmp_buf, dp->name);
172
173         n = prom_early_alloc(strlen(tmp_buf) + 1);
174         strcpy(n, tmp_buf);
175
176         return n;
177 }
178
179 static char * __init build_full_name(struct device_node *dp)
180 {
181         int len, ourlen, plen;
182         char *n;
183
184         plen = strlen(dp->parent->full_name);
185         ourlen = strlen(dp->path_component_name);
186         len = ourlen + plen + 2;
187
188         n = prom_early_alloc(len);
189         strcpy(n, dp->parent->full_name);
190         if (!is_root_node(dp->parent)) {
191                 strcpy(n + plen, "/");
192                 plen++;
193         }
194         strcpy(n + plen, dp->path_component_name);
195
196         return n;
197 }
198
199 static char * __init get_one_property(phandle node, const char *name)
200 {
201         char *buf = "<NULL>";
202         int len;
203
204         len = prom_getproplen(node, name);
205         if (len > 0) {
206                 buf = prom_early_alloc(len);
207                 len = prom_getproperty(node, name, buf, len);
208         }
209
210         return buf;
211 }
212
213 static struct device_node * __init create_node(phandle node, struct device_node *parent)
214 {
215         struct device_node *dp;
216
217         if (!node)
218                 return NULL;
219
220         dp = prom_early_alloc(sizeof(*dp));
221         dp->unique_id = prom_unique_id++;
222         dp->parent = parent;
223
224         kref_init(&dp->kref);
225
226         dp->name = get_one_property(node, "name");
227         dp->type = get_one_property(node, "device_type");
228         dp->node = node;
229
230         /* Build interrupts later... */
231
232         dp->properties = build_prop_list(node);
233
234         return dp;
235 }
236
237 static struct device_node * __init build_tree(struct device_node *parent, phandle node, struct device_node ***nextp)
238 {
239         struct device_node *dp;
240
241         dp = create_node(node, parent);
242         if (dp) {
243                 *(*nextp) = dp;
244                 *nextp = &dp->allnext;
245
246                 dp->parent = parent;
247                 dp->path_component_name = build_path_component(dp);
248                 dp->full_name = build_full_name(dp);
249
250                 dp->child = build_tree(dp, prom_getchild(node), nextp);
251
252                 dp->sibling = build_tree(parent, prom_getsibling(node), nextp);
253         }
254
255         return dp;
256 }
257
258 struct device_node *of_console_device;
259 EXPORT_SYMBOL(of_console_device);
260
261 char *of_console_path;
262 EXPORT_SYMBOL(of_console_path);
263
264 char *of_console_options;
265 EXPORT_SYMBOL(of_console_options);
266
267 extern void restore_current(void);
268
269 static void __init of_console_init(void)
270 {
271         char *msg = "OF stdout device is: %s\n";
272         struct device_node *dp;
273         unsigned long flags;
274         const char *type;
275         phandle node;
276         int skip, tmp, fd;
277
278         of_console_path = prom_early_alloc(256);
279
280         switch (prom_vers) {
281         case PROM_V0:
282                 skip = 0;
283                 switch (*romvec->pv_stdout) {
284                 case PROMDEV_SCREEN:
285                         type = "display";
286                         break;
287
288                 case PROMDEV_TTYB:
289                         skip = 1;
290                         /* FALLTHRU */
291
292                 case PROMDEV_TTYA:
293                         type = "serial";
294                         break;
295
296                 default:
297                         prom_printf("Invalid PROM_V0 stdout value %u\n",
298                                     *romvec->pv_stdout);
299                         prom_halt();
300                 }
301
302                 tmp = skip;
303                 for_each_node_by_type(dp, type) {
304                         if (!tmp--)
305                                 break;
306                 }
307                 if (!dp) {
308                         prom_printf("Cannot find PROM_V0 console node.\n");
309                         prom_halt();
310                 }
311                 of_console_device = dp;
312
313                 strcpy(of_console_path, dp->full_name);
314                 if (!strcmp(type, "serial")) {
315                         strcat(of_console_path,
316                                (skip ? ":b" : ":a"));
317                 }
318                 break;
319
320         default:
321         case PROM_V2:
322         case PROM_V3:
323                 fd = *romvec->pv_v2bootargs.fd_stdout;
324
325                 spin_lock_irqsave(&prom_lock, flags);
326                 node = (*romvec->pv_v2devops.v2_inst2pkg)(fd);
327                 restore_current();
328                 spin_unlock_irqrestore(&prom_lock, flags);
329
330                 if (!node) {
331                         prom_printf("Cannot resolve stdout node from "
332                                     "instance %08x.\n", fd);
333                         prom_halt();
334                 }
335                 dp = of_find_node_by_phandle(node);
336                 type = of_get_property(dp, "device_type", NULL);
337
338                 if (!type) {
339                         prom_printf("Console stdout lacks "
340                                     "device_type property.\n");
341                         prom_halt();
342                 }
343
344                 if (strcmp(type, "display") && strcmp(type, "serial")) {
345                         prom_printf("Console device_type is neither display "
346                                     "nor serial.\n");
347                         prom_halt();
348                 }
349
350                 of_console_device = dp;
351
352                 if (prom_vers == PROM_V2) {
353                         strcpy(of_console_path, dp->full_name);
354                         switch (*romvec->pv_stdout) {
355                         case PROMDEV_TTYA:
356                                 strcat(of_console_path, ":a");
357                                 break;
358                         case PROMDEV_TTYB:
359                                 strcat(of_console_path, ":b");
360                                 break;
361                         }
362                 } else {
363                         const char *path;
364
365                         dp = of_find_node_by_path("/");
366                         path = of_get_property(dp, "stdout-path", NULL);
367                         if (!path) {
368                                 prom_printf("No stdout-path in root node.\n");
369                                 prom_halt();
370                         }
371                         strcpy(of_console_path, path);
372                 }
373                 break;
374         }
375
376         of_console_options = strrchr(of_console_path, ':');
377         if (of_console_options) {
378                 of_console_options++;
379                 if (*of_console_options == '\0')
380                         of_console_options = NULL;
381         }
382
383         prom_printf(msg, of_console_path);
384         printk(msg, of_console_path);
385 }
386
387 void __init prom_build_devicetree(void)
388 {
389         struct device_node **nextp;
390
391         allnodes = create_node(prom_root_node, NULL);
392         allnodes->path_component_name = "";
393         allnodes->full_name = "/";
394
395         nextp = &allnodes->allnext;
396         allnodes->child = build_tree(allnodes,
397                                      prom_getchild(allnodes->node),
398                                      &nextp);
399         of_console_init();
400
401         printk("PROM: Built device tree with %u bytes of memory.\n",
402                prom_early_allocated);
403 }