powerpc: Introduce VSX thread_struct and CONFIG_VSX
[deliverable/linux.git] / arch / powerpc / kernel / prom.c
CommitLineData
9b6b563c
PM
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 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * as published by the Free Software Foundation; either version
13 * 2 of the License, or (at your option) any later version.
14 */
15
16#undef DEBUG
17
18#include <stdarg.h>
9b6b563c
PM
19#include <linux/kernel.h>
20#include <linux/string.h>
21#include <linux/init.h>
22#include <linux/threads.h>
23#include <linux/spinlock.h>
24#include <linux/types.h>
25#include <linux/pci.h>
26#include <linux/stringify.h>
27#include <linux/delay.h>
28#include <linux/initrd.h>
29#include <linux/bitops.h>
30#include <linux/module.h>
dcee3036 31#include <linux/kexec.h>
7a4571ae 32#include <linux/debugfs.h>
0ebfff14 33#include <linux/irq.h>
d9b2b2a2 34#include <linux/lmb.h>
9b6b563c
PM
35
36#include <asm/prom.h>
37#include <asm/rtas.h>
9b6b563c
PM
38#include <asm/page.h>
39#include <asm/processor.h>
40#include <asm/irq.h>
41#include <asm/io.h>
0cc4746c 42#include <asm/kdump.h>
9b6b563c
PM
43#include <asm/smp.h>
44#include <asm/system.h>
45#include <asm/mmu.h>
46#include <asm/pgtable.h>
47#include <asm/pci.h>
48#include <asm/iommu.h>
49#include <asm/btext.h>
50#include <asm/sections.h>
51#include <asm/machdep.h>
52#include <asm/pSeries_reconfig.h>
40ef8cbc 53#include <asm/pci-bridge.h>
6ac26c8a 54#include <asm/phyp_dump.h>
2babf5c2 55#include <asm/kexec.h>
37dd2bad 56#include <mm/mmu_decl.h>
9b6b563c
PM
57
58#ifdef DEBUG
59#define DBG(fmt...) printk(KERN_ERR fmt)
60#else
61#define DBG(fmt...)
62#endif
63
9b6b563c 64
9b6b563c
PM
65static int __initdata dt_root_addr_cells;
66static int __initdata dt_root_size_cells;
67
68#ifdef CONFIG_PPC64
28897731 69int __initdata iommu_is_off;
9b6b563c 70int __initdata iommu_force_on;
cf00a8d1 71unsigned long tce_alloc_start, tce_alloc_end;
9b6b563c
PM
72#endif
73
74typedef u32 cell_t;
75
76#if 0
77static struct boot_param_header *initial_boot_params __initdata;
78#else
79struct boot_param_header *initial_boot_params;
80#endif
81
1ef4d424 82extern struct device_node *allnodes; /* temporary while merging */
9b6b563c 83
581b605a 84extern rwlock_t devtree_lock; /* temporary while merging */
9b6b563c
PM
85
86/* export that to outside world */
87struct device_node *of_chosen;
88
9b6b563c
PM
89static inline char *find_flat_dt_string(u32 offset)
90{
91 return ((char *)initial_boot_params) +
92 initial_boot_params->off_dt_strings + offset;
93}
94
95/**
96 * This function is used to scan the flattened device-tree, it is
97 * used to extract the memory informations at boot before we can
98 * unflatten the tree
99 */
3c726f8d
BH
100int __init of_scan_flat_dt(int (*it)(unsigned long node,
101 const char *uname, int depth,
102 void *data),
103 void *data)
9b6b563c
PM
104{
105 unsigned long p = ((unsigned long)initial_boot_params) +
106 initial_boot_params->off_dt_struct;
107 int rc = 0;
108 int depth = -1;
109
110 do {
111 u32 tag = *((u32 *)p);
112 char *pathp;
113
114 p += 4;
115 if (tag == OF_DT_END_NODE) {
116 depth --;
117 continue;
118 }
119 if (tag == OF_DT_NOP)
120 continue;
121 if (tag == OF_DT_END)
122 break;
123 if (tag == OF_DT_PROP) {
124 u32 sz = *((u32 *)p);
125 p += 8;
126 if (initial_boot_params->version < 0x10)
127 p = _ALIGN(p, sz >= 8 ? 8 : 4);
128 p += sz;
129 p = _ALIGN(p, 4);
130 continue;
131 }
132 if (tag != OF_DT_BEGIN_NODE) {
133 printk(KERN_WARNING "Invalid tag %x scanning flattened"
134 " device tree !\n", tag);
135 return -EINVAL;
136 }
137 depth++;
138 pathp = (char *)p;
139 p = _ALIGN(p + strlen(pathp) + 1, 4);
140 if ((*pathp) == '/') {
141 char *lp, *np;
142 for (lp = NULL, np = pathp; *np; np++)
143 if ((*np) == '/')
144 lp = np+1;
145 if (lp != NULL)
146 pathp = lp;
147 }
148 rc = it(p, pathp, depth, data);
149 if (rc != 0)
150 break;
151 } while(1);
152
153 return rc;
154}
155
e8222502
BH
156unsigned long __init of_get_flat_dt_root(void)
157{
158 unsigned long p = ((unsigned long)initial_boot_params) +
159 initial_boot_params->off_dt_struct;
160
161 while(*((u32 *)p) == OF_DT_NOP)
162 p += 4;
163 BUG_ON (*((u32 *)p) != OF_DT_BEGIN_NODE);
164 p += 4;
165 return _ALIGN(p + strlen((char *)p) + 1, 4);
166}
167
9b6b563c
PM
168/**
169 * This function can be used within scan_flattened_dt callback to get
170 * access to properties
171 */
3c726f8d
BH
172void* __init of_get_flat_dt_prop(unsigned long node, const char *name,
173 unsigned long *size)
9b6b563c
PM
174{
175 unsigned long p = node;
176
177 do {
178 u32 tag = *((u32 *)p);
179 u32 sz, noff;
180 const char *nstr;
181
182 p += 4;
183 if (tag == OF_DT_NOP)
184 continue;
185 if (tag != OF_DT_PROP)
186 return NULL;
187
188 sz = *((u32 *)p);
189 noff = *((u32 *)(p + 4));
190 p += 8;
191 if (initial_boot_params->version < 0x10)
192 p = _ALIGN(p, sz >= 8 ? 8 : 4);
193
194 nstr = find_flat_dt_string(noff);
195 if (nstr == NULL) {
196 printk(KERN_WARNING "Can't find property index"
197 " name !\n");
198 return NULL;
199 }
200 if (strcmp(name, nstr) == 0) {
201 if (size)
202 *size = sz;
203 return (void *)p;
204 }
205 p += sz;
206 p = _ALIGN(p, 4);
207 } while(1);
208}
209
e8222502
BH
210int __init of_flat_dt_is_compatible(unsigned long node, const char *compat)
211{
212 const char* cp;
213 unsigned long cplen, l;
214
215 cp = of_get_flat_dt_prop(node, "compatible", &cplen);
216 if (cp == NULL)
217 return 0;
218 while (cplen > 0) {
219 if (strncasecmp(cp, compat, strlen(compat)) == 0)
220 return 1;
221 l = strlen(cp) + 1;
222 cp += l;
223 cplen -= l;
224 }
225
226 return 0;
227}
228
9b6b563c
PM
229static void *__init unflatten_dt_alloc(unsigned long *mem, unsigned long size,
230 unsigned long align)
231{
232 void *res;
233
234 *mem = _ALIGN(*mem, align);
235 res = (void *)*mem;
236 *mem += size;
237
238 return res;
239}
240
241static unsigned long __init unflatten_dt_node(unsigned long mem,
242 unsigned long *p,
243 struct device_node *dad,
244 struct device_node ***allnextpp,
245 unsigned long fpsize)
246{
247 struct device_node *np;
248 struct property *pp, **prev_pp = NULL;
249 char *pathp;
250 u32 tag;
251 unsigned int l, allocl;
252 int has_name = 0;
253 int new_format = 0;
254
255 tag = *((u32 *)(*p));
256 if (tag != OF_DT_BEGIN_NODE) {
257 printk("Weird tag at start of node: %x\n", tag);
258 return mem;
259 }
260 *p += 4;
261 pathp = (char *)*p;
262 l = allocl = strlen(pathp) + 1;
263 *p = _ALIGN(*p + l, 4);
264
265 /* version 0x10 has a more compact unit name here instead of the full
266 * path. we accumulate the full path size using "fpsize", we'll rebuild
267 * it later. We detect this because the first character of the name is
268 * not '/'.
269 */
270 if ((*pathp) != '/') {
271 new_format = 1;
272 if (fpsize == 0) {
273 /* root node: special case. fpsize accounts for path
274 * plus terminating zero. root node only has '/', so
275 * fpsize should be 2, but we want to avoid the first
276 * level nodes to have two '/' so we use fpsize 1 here
277 */
278 fpsize = 1;
279 allocl = 2;
280 } else {
281 /* account for '/' and path size minus terminal 0
282 * already in 'l'
283 */
284 fpsize += l;
285 allocl = fpsize;
286 }
287 }
288
289
290 np = unflatten_dt_alloc(&mem, sizeof(struct device_node) + allocl,
291 __alignof__(struct device_node));
292 if (allnextpp) {
293 memset(np, 0, sizeof(*np));
294 np->full_name = ((char*)np) + sizeof(struct device_node);
295 if (new_format) {
296 char *p = np->full_name;
297 /* rebuild full path for new format */
298 if (dad && dad->parent) {
299 strcpy(p, dad->full_name);
300#ifdef DEBUG
301 if ((strlen(p) + l + 1) != allocl) {
302 DBG("%s: p: %d, l: %d, a: %d\n",
e8222502 303 pathp, (int)strlen(p), l, allocl);
9b6b563c
PM
304 }
305#endif
306 p += strlen(p);
307 }
308 *(p++) = '/';
309 memcpy(p, pathp, l);
310 } else
311 memcpy(np->full_name, pathp, l);
312 prev_pp = &np->properties;
313 **allnextpp = np;
314 *allnextpp = &np->allnext;
315 if (dad != NULL) {
316 np->parent = dad;
317 /* we temporarily use the next field as `last_child'*/
318 if (dad->next == 0)
319 dad->child = np;
320 else
321 dad->next->sibling = np;
322 dad->next = np;
323 }
324 kref_init(&np->kref);
325 }
326 while(1) {
327 u32 sz, noff;
328 char *pname;
329
330 tag = *((u32 *)(*p));
331 if (tag == OF_DT_NOP) {
332 *p += 4;
333 continue;
334 }
335 if (tag != OF_DT_PROP)
336 break;
337 *p += 4;
338 sz = *((u32 *)(*p));
339 noff = *((u32 *)((*p) + 4));
340 *p += 8;
341 if (initial_boot_params->version < 0x10)
342 *p = _ALIGN(*p, sz >= 8 ? 8 : 4);
343
344 pname = find_flat_dt_string(noff);
345 if (pname == NULL) {
346 printk("Can't find property name in list !\n");
347 break;
348 }
349 if (strcmp(pname, "name") == 0)
350 has_name = 1;
351 l = strlen(pname) + 1;
352 pp = unflatten_dt_alloc(&mem, sizeof(struct property),
353 __alignof__(struct property));
354 if (allnextpp) {
355 if (strcmp(pname, "linux,phandle") == 0) {
356 np->node = *((u32 *)*p);
357 if (np->linux_phandle == 0)
358 np->linux_phandle = np->node;
359 }
360 if (strcmp(pname, "ibm,phandle") == 0)
361 np->linux_phandle = *((u32 *)*p);
362 pp->name = pname;
363 pp->length = sz;
364 pp->value = (void *)*p;
365 *prev_pp = pp;
366 prev_pp = &pp->next;
367 }
368 *p = _ALIGN((*p) + sz, 4);
369 }
370 /* with version 0x10 we may not have the name property, recreate
371 * it here from the unit name if absent
372 */
373 if (!has_name) {
374 char *p = pathp, *ps = pathp, *pa = NULL;
375 int sz;
376
377 while (*p) {
378 if ((*p) == '@')
379 pa = p;
380 if ((*p) == '/')
381 ps = p + 1;
382 p++;
383 }
384 if (pa < ps)
385 pa = p;
386 sz = (pa - ps) + 1;
387 pp = unflatten_dt_alloc(&mem, sizeof(struct property) + sz,
388 __alignof__(struct property));
389 if (allnextpp) {
390 pp->name = "name";
391 pp->length = sz;
1a38147e 392 pp->value = pp + 1;
9b6b563c
PM
393 *prev_pp = pp;
394 prev_pp = &pp->next;
395 memcpy(pp->value, ps, sz - 1);
396 ((char *)pp->value)[sz - 1] = 0;
1a38147e
SR
397 DBG("fixed up name for %s -> %s\n", pathp,
398 (char *)pp->value);
9b6b563c
PM
399 }
400 }
401 if (allnextpp) {
402 *prev_pp = NULL;
0e56efc7
SR
403 np->name = of_get_property(np, "name", NULL);
404 np->type = of_get_property(np, "device_type", NULL);
9b6b563c
PM
405
406 if (!np->name)
407 np->name = "<NULL>";
408 if (!np->type)
409 np->type = "<NULL>";
410 }
411 while (tag == OF_DT_BEGIN_NODE) {
412 mem = unflatten_dt_node(mem, p, np, allnextpp, fpsize);
413 tag = *((u32 *)(*p));
414 }
415 if (tag != OF_DT_END_NODE) {
416 printk("Weird tag at end of node: %x\n", tag);
417 return mem;
418 }
419 *p += 4;
420 return mem;
421}
422
2babf5c2
ME
423static int __init early_parse_mem(char *p)
424{
425 if (!p)
426 return 1;
427
428 memory_limit = PAGE_ALIGN(memparse(p, &p));
429 DBG("memory limit = 0x%lx\n", memory_limit);
430
431 return 0;
432}
433early_param("mem", early_parse_mem);
434
3c607ce2
LV
435/**
436 * move_device_tree - move tree to an unused area, if needed.
437 *
438 * The device tree may be allocated beyond our memory limit, or inside the
439 * crash kernel region for kdump. If so, move it out of the way.
2babf5c2 440 */
18f032cb 441static void __init move_device_tree(void)
2babf5c2
ME
442{
443 unsigned long start, size;
444 void *p;
445
446 DBG("-> move_device_tree\n");
447
448 start = __pa(initial_boot_params);
449 size = initial_boot_params->totalsize;
450
451 if ((memory_limit && (start + size) > memory_limit) ||
452 overlaps_crashkernel(start, size)) {
453 p = __va(lmb_alloc_base(size, PAGE_SIZE, lmb.rmo_size));
454 memcpy(p, initial_boot_params, size);
455 initial_boot_params = (struct boot_param_header *)p;
456 DBG("Moved device tree to 0x%p\n", p);
457 }
458
459 DBG("<- move_device_tree\n");
460}
9b6b563c
PM
461
462/**
463 * unflattens the device-tree passed by the firmware, creating the
464 * tree of struct device_node. It also fills the "name" and "type"
465 * pointers of the nodes so the normal device-tree walking functions
466 * can be used (this used to be done by finish_device_tree)
467 */
468void __init unflatten_device_tree(void)
469{
470 unsigned long start, mem, size;
471 struct device_node **allnextp = &allnodes;
9b6b563c
PM
472
473 DBG(" -> unflatten_device_tree()\n");
474
475 /* First pass, scan for size */
476 start = ((unsigned long)initial_boot_params) +
477 initial_boot_params->off_dt_struct;
478 size = unflatten_dt_node(0, &start, NULL, NULL, 0);
479 size = (size | 3) + 1;
480
481 DBG(" size is %lx, allocating...\n", size);
482
483 /* Allocate memory for the expanded device tree */
484 mem = lmb_alloc(size + 4, __alignof__(struct device_node));
9b6b563c
PM
485 mem = (unsigned long) __va(mem);
486
487 ((u32 *)mem)[size / 4] = 0xdeadbeef;
488
489 DBG(" unflattening %lx...\n", mem);
490
491 /* Second pass, do actual unflattening */
492 start = ((unsigned long)initial_boot_params) +
493 initial_boot_params->off_dt_struct;
494 unflatten_dt_node(mem, &start, NULL, &allnextp, 0);
495 if (*((u32 *)start) != OF_DT_END)
496 printk(KERN_WARNING "Weird tag at end of tree: %08x\n", *((u32 *)start));
497 if (((u32 *)mem)[size / 4] != 0xdeadbeef)
498 printk(KERN_WARNING "End of tree marker overwritten: %08x\n",
499 ((u32 *)mem)[size / 4] );
500 *allnextp = NULL;
501
502 /* Get pointer to OF "/chosen" node for use everywhere */
503 of_chosen = of_find_node_by_path("/chosen");
a575b807
PM
504 if (of_chosen == NULL)
505 of_chosen = of_find_node_by_path("/chosen@0");
9b6b563c 506
9b6b563c
PM
507 DBG(" <- unflatten_device_tree()\n");
508}
509
d205819e
PM
510/*
511 * ibm,pa-features is a per-cpu property that contains a string of
512 * attribute descriptors, each of which has a 2 byte header plus up
513 * to 254 bytes worth of processor attribute bits. First header
514 * byte specifies the number of bytes following the header.
515 * Second header byte is an "attribute-specifier" type, of which
516 * zero is the only currently-defined value.
517 * Implementation: Pass in the byte and bit offset for the feature
518 * that we are interested in. The function will return -1 if the
519 * pa-features property is missing, or a 1/0 to indicate if the feature
520 * is supported/not supported. Note that the bit numbers are
521 * big-endian to match the definition in PAPR.
522 */
523static struct ibm_pa_feature {
524 unsigned long cpu_features; /* CPU_FTR_xxx bit */
525 unsigned int cpu_user_ftrs; /* PPC_FEATURE_xxx bit */
526 unsigned char pabyte; /* byte number in ibm,pa-features */
527 unsigned char pabit; /* bit number (big-endian) */
528 unsigned char invert; /* if 1, pa bit set => clear feature */
529} ibm_pa_features[] __initdata = {
530 {0, PPC_FEATURE_HAS_MMU, 0, 0, 0},
531 {0, PPC_FEATURE_HAS_FPU, 0, 1, 0},
532 {CPU_FTR_SLB, 0, 0, 2, 0},
533 {CPU_FTR_CTRL, 0, 0, 3, 0},
534 {CPU_FTR_NOEXECUTE, 0, 0, 6, 0},
535 {CPU_FTR_NODSISRALIGN, 0, 1, 1, 1},
536 {CPU_FTR_CI_LARGE_PAGE, 0, 1, 2, 0},
339d76c5 537 {CPU_FTR_REAL_LE, PPC_FEATURE_TRUE_LE, 5, 0, 0},
d205819e
PM
538};
539
974a76f5
PM
540static void __init scan_features(unsigned long node, unsigned char *ftrs,
541 unsigned long tablelen,
542 struct ibm_pa_feature *fp,
543 unsigned long ft_size)
d205819e 544{
974a76f5 545 unsigned long i, len, bit;
d205819e
PM
546
547 /* find descriptor with type == 0 */
548 for (;;) {
549 if (tablelen < 3)
550 return;
974a76f5 551 len = 2 + ftrs[0];
d205819e
PM
552 if (tablelen < len)
553 return; /* descriptor 0 not found */
974a76f5 554 if (ftrs[1] == 0)
d205819e
PM
555 break;
556 tablelen -= len;
974a76f5 557 ftrs += len;
d205819e
PM
558 }
559
560 /* loop over bits we know about */
974a76f5
PM
561 for (i = 0; i < ft_size; ++i, ++fp) {
562 if (fp->pabyte >= ftrs[0])
d205819e 563 continue;
974a76f5 564 bit = (ftrs[2 + fp->pabyte] >> (7 - fp->pabit)) & 1;
d205819e
PM
565 if (bit ^ fp->invert) {
566 cur_cpu_spec->cpu_features |= fp->cpu_features;
567 cur_cpu_spec->cpu_user_features |= fp->cpu_user_ftrs;
568 } else {
569 cur_cpu_spec->cpu_features &= ~fp->cpu_features;
570 cur_cpu_spec->cpu_user_features &= ~fp->cpu_user_ftrs;
571 }
572 }
573}
574
974a76f5
PM
575static void __init check_cpu_pa_features(unsigned long node)
576{
577 unsigned char *pa_ftrs;
578 unsigned long tablelen;
579
580 pa_ftrs = of_get_flat_dt_prop(node, "ibm,pa-features", &tablelen);
581 if (pa_ftrs == NULL)
582 return;
583
584 scan_features(node, pa_ftrs, tablelen,
585 ibm_pa_features, ARRAY_SIZE(ibm_pa_features));
586}
587
584f8b71
MN
588#ifdef CONFIG_PPC64
589static void __init check_cpu_slb_size(unsigned long node)
590{
591 u32 *slb_size_ptr;
592
593 slb_size_ptr = of_get_flat_dt_prop(node, "ibm,slb-size", NULL);
594 if (slb_size_ptr != NULL) {
595 mmu_slb_size = *slb_size_ptr;
596 }
597}
598#else
599#define check_cpu_slb_size(node) do { } while(0)
600#endif
601
974a76f5
PM
602static struct feature_property {
603 const char *name;
604 u32 min_value;
605 unsigned long cpu_feature;
606 unsigned long cpu_user_ftr;
607} feature_properties[] __initdata = {
608#ifdef CONFIG_ALTIVEC
609 {"altivec", 0, CPU_FTR_ALTIVEC, PPC_FEATURE_HAS_ALTIVEC},
610 {"ibm,vmx", 1, CPU_FTR_ALTIVEC, PPC_FEATURE_HAS_ALTIVEC},
611#endif /* CONFIG_ALTIVEC */
612#ifdef CONFIG_PPC64
613 {"ibm,dfp", 1, 0, PPC_FEATURE_HAS_DFP},
614 {"ibm,purr", 1, CPU_FTR_PURR, 0},
615 {"ibm,spurr", 1, CPU_FTR_SPURR, 0},
616#endif /* CONFIG_PPC64 */
617};
618
14b3d926
VB
619#if defined(CONFIG_44x) && defined(CONFIG_PPC_FPU)
620static inline void identical_pvr_fixup(unsigned long node)
621{
622 unsigned int pvr;
623 char *model = of_get_flat_dt_prop(node, "model", NULL);
624
625 /*
626 * Since 440GR(x)/440EP(x) processors have the same pvr,
627 * we check the node path and set bit 28 in the cur_cpu_spec
628 * pvr for EP(x) processor version. This bit is always 0 in
629 * the "real" pvr. Then we call identify_cpu again with
630 * the new logical pvr to enable FPU support.
631 */
632 if (model && strstr(model, "440EP")) {
633 pvr = cur_cpu_spec->pvr_value | 0x8;
634 identify_cpu(0, pvr);
635 DBG("Using logical pvr %x for %s\n", pvr, model);
636 }
637}
638#else
639#define identical_pvr_fixup(node) do { } while(0)
640#endif
641
974a76f5
PM
642static void __init check_cpu_feature_properties(unsigned long node)
643{
644 unsigned long i;
645 struct feature_property *fp = feature_properties;
646 const u32 *prop;
647
648 for (i = 0; i < ARRAY_SIZE(feature_properties); ++i, ++fp) {
649 prop = of_get_flat_dt_prop(node, fp->name, NULL);
650 if (prop && *prop >= fp->min_value) {
651 cur_cpu_spec->cpu_features |= fp->cpu_feature;
652 cur_cpu_spec->cpu_user_features |= fp->cpu_user_ftr;
653 }
654 }
655}
656
9b6b563c 657static int __init early_init_dt_scan_cpus(unsigned long node,
4df20460
AB
658 const char *uname, int depth,
659 void *data)
9b6b563c 660{
4df20460
AB
661 static int logical_cpuid = 0;
662 char *type = of_get_flat_dt_prop(node, "device_type", NULL);
974a76f5
PM
663 const u32 *prop;
664 const u32 *intserv;
4df20460
AB
665 int i, nthreads;
666 unsigned long len;
667 int found = 0;
9b6b563c
PM
668
669 /* We are scanning "cpu" nodes only */
670 if (type == NULL || strcmp(type, "cpu") != 0)
671 return 0;
672
4df20460
AB
673 /* Get physical cpuid */
674 intserv = of_get_flat_dt_prop(node, "ibm,ppc-interrupt-server#s", &len);
675 if (intserv) {
676 nthreads = len / sizeof(int);
9b6b563c 677 } else {
4df20460
AB
678 intserv = of_get_flat_dt_prop(node, "reg", NULL);
679 nthreads = 1;
680 }
681
682 /*
683 * Now see if any of these threads match our boot cpu.
684 * NOTE: This must match the parsing done in smp_setup_cpu_maps.
685 */
686 for (i = 0; i < nthreads; i++) {
687 /*
688 * version 2 of the kexec param format adds the phys cpuid of
689 * booted proc.
690 */
691 if (initial_boot_params && initial_boot_params->version >= 2) {
692 if (intserv[i] ==
693 initial_boot_params->boot_cpuid_phys) {
694 found = 1;
695 break;
696 }
697 } else {
698 /*
699 * Check if it's the boot-cpu, set it's hw index now,
700 * unfortunately this format did not support booting
701 * off secondary threads.
702 */
703 if (of_get_flat_dt_prop(node,
3c726f8d 704 "linux,boot-cpu", NULL) != NULL) {
4df20460
AB
705 found = 1;
706 break;
707 }
9b6b563c 708 }
4df20460
AB
709
710#ifdef CONFIG_SMP
711 /* logical cpu id is always 0 on UP kernels */
712 logical_cpuid++;
713#endif
714 }
715
716 if (found) {
717 DBG("boot cpu: logical %d physical %d\n", logical_cpuid,
718 intserv[i]);
719 boot_cpuid = logical_cpuid;
720 set_hard_smp_processor_id(boot_cpuid, intserv[i]);
9b6b563c 721
974a76f5
PM
722 /*
723 * PAPR defines "logical" PVR values for cpus that
724 * meet various levels of the architecture:
725 * 0x0f000001 Architecture version 2.04
726 * 0x0f000002 Architecture version 2.05
727 * If the cpu-version property in the cpu node contains
728 * such a value, we call identify_cpu again with the
729 * logical PVR value in order to use the cpu feature
730 * bits appropriate for the architecture level.
731 *
732 * A POWER6 partition in "POWER6 architected" mode
733 * uses the 0x0f000002 PVR value; in POWER5+ mode
734 * it uses 0x0f000001.
735 */
736 prop = of_get_flat_dt_prop(node, "cpu-version", NULL);
737 if (prop && (*prop & 0xff000000) == 0x0f000000)
738 identify_cpu(0, *prop);
14b3d926
VB
739
740 identical_pvr_fixup(node);
9b6b563c 741 }
9b6b563c 742
974a76f5 743 check_cpu_feature_properties(node);
d205819e 744 check_cpu_pa_features(node);
584f8b71 745 check_cpu_slb_size(node);
d205819e 746
9b6b563c 747#ifdef CONFIG_PPC_PSERIES
4df20460 748 if (nthreads > 1)
9b6b563c 749 cur_cpu_spec->cpu_features |= CPU_FTR_SMT;
4df20460
AB
750 else
751 cur_cpu_spec->cpu_features &= ~CPU_FTR_SMT;
9b6b563c
PM
752#endif
753
754 return 0;
755}
756
40472a55
ME
757#ifdef CONFIG_BLK_DEV_INITRD
758static void __init early_init_dt_check_for_initrd(unsigned long node)
759{
760 unsigned long l;
761 u32 *prop;
762
763 DBG("Looking for initrd properties... ");
764
765 prop = of_get_flat_dt_prop(node, "linux,initrd-start", &l);
766 if (prop) {
767 initrd_start = (unsigned long)__va(of_read_ulong(prop, l/4));
768
769 prop = of_get_flat_dt_prop(node, "linux,initrd-end", &l);
770 if (prop) {
771 initrd_end = (unsigned long)
772 __va(of_read_ulong(prop, l/4));
773 initrd_below_start_ok = 1;
774 } else {
775 initrd_start = 0;
776 }
777 }
778
779 DBG("initrd_start=0x%lx initrd_end=0x%lx\n", initrd_start, initrd_end);
780}
781#else
782static inline void early_init_dt_check_for_initrd(unsigned long node)
783{
784}
785#endif /* CONFIG_BLK_DEV_INITRD */
786
9b6b563c
PM
787static int __init early_init_dt_scan_chosen(unsigned long node,
788 const char *uname, int depth, void *data)
789{
9b6b563c 790 unsigned long *lprop;
329dda08
KG
791 unsigned long l;
792 char *p;
9b6b563c
PM
793
794 DBG("search \"chosen\", depth: %d, uname: %s\n", depth, uname);
795
a575b807
PM
796 if (depth != 1 ||
797 (strcmp(uname, "chosen") != 0 && strcmp(uname, "chosen@0") != 0))
9b6b563c
PM
798 return 0;
799
9b6b563c
PM
800#ifdef CONFIG_PPC64
801 /* check if iommu is forced on or off */
3c726f8d 802 if (of_get_flat_dt_prop(node, "linux,iommu-off", NULL) != NULL)
9b6b563c 803 iommu_is_off = 1;
3c726f8d 804 if (of_get_flat_dt_prop(node, "linux,iommu-force-on", NULL) != NULL)
9b6b563c
PM
805 iommu_force_on = 1;
806#endif
807
2babf5c2 808 /* mem=x on the command line is the preferred mechanism */
3c726f8d 809 lprop = of_get_flat_dt_prop(node, "linux,memory-limit", NULL);
9b6b563c
PM
810 if (lprop)
811 memory_limit = *lprop;
812
813#ifdef CONFIG_PPC64
3c726f8d 814 lprop = of_get_flat_dt_prop(node, "linux,tce-alloc-start", NULL);
9b6b563c
PM
815 if (lprop)
816 tce_alloc_start = *lprop;
3c726f8d 817 lprop = of_get_flat_dt_prop(node, "linux,tce-alloc-end", NULL);
9b6b563c
PM
818 if (lprop)
819 tce_alloc_end = *lprop;
820#endif
821
dcee3036 822#ifdef CONFIG_KEXEC
70c6cc37
LV
823 lprop = (u64*)of_get_flat_dt_prop(node, "linux,crashkernel-base", NULL);
824 if (lprop)
825 crashk_res.start = *lprop;
dcee3036 826
70c6cc37
LV
827 lprop = (u64*)of_get_flat_dt_prop(node, "linux,crashkernel-size", NULL);
828 if (lprop)
829 crashk_res.end = crashk_res.start + *lprop - 1;
dcee3036
ME
830#endif
831
40472a55 832 early_init_dt_check_for_initrd(node);
30437b3e 833
329dda08
KG
834 /* Retreive command line */
835 p = of_get_flat_dt_prop(node, "bootargs", &l);
836 if (p != NULL && l > 0)
837 strlcpy(cmd_line, p, min((int)l, COMMAND_LINE_SIZE));
838
839#ifdef CONFIG_CMDLINE
c1ce464d 840 if (p == NULL || l == 0 || (l == 1 && (*p) == 0))
329dda08
KG
841 strlcpy(cmd_line, CONFIG_CMDLINE, COMMAND_LINE_SIZE);
842#endif /* CONFIG_CMDLINE */
843
844 DBG("Command line is: %s\n", cmd_line);
845
9b6b563c
PM
846 /* break now */
847 return 1;
848}
849
850static int __init early_init_dt_scan_root(unsigned long node,
851 const char *uname, int depth, void *data)
852{
853 u32 *prop;
854
855 if (depth != 0)
856 return 0;
857
3c726f8d 858 prop = of_get_flat_dt_prop(node, "#size-cells", NULL);
9b6b563c
PM
859 dt_root_size_cells = (prop == NULL) ? 1 : *prop;
860 DBG("dt_root_size_cells = %x\n", dt_root_size_cells);
861
3c726f8d 862 prop = of_get_flat_dt_prop(node, "#address-cells", NULL);
9b6b563c
PM
863 dt_root_addr_cells = (prop == NULL) ? 2 : *prop;
864 DBG("dt_root_addr_cells = %x\n", dt_root_addr_cells);
865
866 /* break now */
867 return 1;
868}
869
abe76885 870static u64 __init dt_mem_next_cell(int s, cell_t **cellp)
9b6b563c
PM
871{
872 cell_t *p = *cellp;
9b6b563c 873
a4dc7ff0 874 *cellp = p + s;
abe76885 875 return of_read_number(p, s);
9b6b563c
PM
876}
877
0204568a
PM
878#ifdef CONFIG_PPC_PSERIES
879/*
880 * Interpret the ibm,dynamic-memory property in the
881 * /ibm,dynamic-reconfiguration-memory node.
882 * This contains a list of memory blocks along with NUMA affinity
883 * information.
884 */
885static int __init early_init_dt_scan_drconf_memory(unsigned long node)
886{
887 cell_t *dm, *ls;
abe76885
BB
888 unsigned long l, n, flags;
889 u64 base, size, lmb_size;
0204568a
PM
890
891 ls = (cell_t *)of_get_flat_dt_prop(node, "ibm,lmb-size", &l);
892 if (ls == NULL || l < dt_root_size_cells * sizeof(cell_t))
893 return 0;
894 lmb_size = dt_mem_next_cell(dt_root_size_cells, &ls);
895
896 dm = (cell_t *)of_get_flat_dt_prop(node, "ibm,dynamic-memory", &l);
897 if (dm == NULL || l < sizeof(cell_t))
898 return 0;
899
900 n = *dm++; /* number of entries */
901 if (l < (n * (dt_root_addr_cells + 4) + 1) * sizeof(cell_t))
902 return 0;
903
904 for (; n != 0; --n) {
905 base = dt_mem_next_cell(dt_root_addr_cells, &dm);
906 flags = dm[3];
907 /* skip DRC index, pad, assoc. list index, flags */
908 dm += 4;
909 /* skip this block if the reserved bit is set in flags (0x80)
910 or if the block is not assigned to this partition (0x8) */
911 if ((flags & 0x80) || !(flags & 0x8))
912 continue;
913 size = lmb_size;
914 if (iommu_is_off) {
915 if (base >= 0x80000000ul)
916 continue;
917 if ((base + size) > 0x80000000ul)
918 size = 0x80000000ul - base;
919 }
920 lmb_add(base, size);
921 }
922 lmb_dump_all();
923 return 0;
924}
925#else
926#define early_init_dt_scan_drconf_memory(node) 0
927#endif /* CONFIG_PPC_PSERIES */
9b6b563c
PM
928
929static int __init early_init_dt_scan_memory(unsigned long node,
930 const char *uname, int depth, void *data)
931{
3c726f8d 932 char *type = of_get_flat_dt_prop(node, "device_type", NULL);
9b6b563c
PM
933 cell_t *reg, *endp;
934 unsigned long l;
935
0204568a
PM
936 /* Look for the ibm,dynamic-reconfiguration-memory node */
937 if (depth == 1 &&
938 strcmp(uname, "ibm,dynamic-reconfiguration-memory") == 0)
939 return early_init_dt_scan_drconf_memory(node);
940
9b6b563c 941 /* We are scanning "memory" nodes only */
a23414be
PM
942 if (type == NULL) {
943 /*
944 * The longtrail doesn't have a device_type on the
945 * /memory node, so look for the node called /memory@0.
946 */
947 if (depth != 1 || strcmp(uname, "memory@0") != 0)
948 return 0;
949 } else if (strcmp(type, "memory") != 0)
9b6b563c
PM
950 return 0;
951
ba759485
ME
952 reg = (cell_t *)of_get_flat_dt_prop(node, "linux,usable-memory", &l);
953 if (reg == NULL)
954 reg = (cell_t *)of_get_flat_dt_prop(node, "reg", &l);
9b6b563c
PM
955 if (reg == NULL)
956 return 0;
957
958 endp = reg + (l / sizeof(cell_t));
959
358c86fd 960 DBG("memory scan node %s, reg size %ld, data: %x %x %x %x,\n",
9b6b563c
PM
961 uname, l, reg[0], reg[1], reg[2], reg[3]);
962
963 while ((endp - reg) >= (dt_root_addr_cells + dt_root_size_cells)) {
abe76885 964 u64 base, size;
9b6b563c
PM
965
966 base = dt_mem_next_cell(dt_root_addr_cells, &reg);
967 size = dt_mem_next_cell(dt_root_size_cells, &reg);
968
969 if (size == 0)
970 continue;
abe76885
BB
971 DBG(" - %llx , %llx\n", (unsigned long long)base,
972 (unsigned long long)size);
9b6b563c
PM
973#ifdef CONFIG_PPC64
974 if (iommu_is_off) {
975 if (base >= 0x80000000ul)
976 continue;
977 if ((base + size) > 0x80000000ul)
978 size = 0x80000000ul - base;
979 }
980#endif
981 lmb_add(base, size);
37dd2bad
KG
982
983 memstart_addr = min((u64)memstart_addr, base);
9b6b563c 984 }
37dd2bad 985
9b6b563c
PM
986 return 0;
987}
988
989static void __init early_reserve_mem(void)
990{
cbbcf340
KG
991 u64 base, size;
992 u64 *reserve_map;
8a300887
JL
993 unsigned long self_base;
994 unsigned long self_size;
9b6b563c 995
cbbcf340 996 reserve_map = (u64 *)(((unsigned long)initial_boot_params) +
9b6b563c 997 initial_boot_params->off_mem_rsvmap);
4d1f3f25
JX
998
999 /* before we do anything, lets reserve the dt blob */
8a300887
JL
1000 self_base = __pa((unsigned long)initial_boot_params);
1001 self_size = initial_boot_params->totalsize;
1002 lmb_reserve(self_base, self_size);
4d1f3f25 1003
30437b3e
DG
1004#ifdef CONFIG_BLK_DEV_INITRD
1005 /* then reserve the initrd, if any */
1006 if (initrd_start && (initrd_end > initrd_start))
1007 lmb_reserve(__pa(initrd_start), initrd_end - initrd_start);
1008#endif /* CONFIG_BLK_DEV_INITRD */
1009
cbbcf340
KG
1010#ifdef CONFIG_PPC32
1011 /*
1012 * Handle the case where we might be booting from an old kexec
1013 * image that setup the mem_rsvmap as pairs of 32-bit values
1014 */
1015 if (*reserve_map > 0xffffffffull) {
1016 u32 base_32, size_32;
1017 u32 *reserve_map_32 = (u32 *)reserve_map;
1018
1019 while (1) {
1020 base_32 = *(reserve_map_32++);
1021 size_32 = *(reserve_map_32++);
1022 if (size_32 == 0)
1023 break;
8a300887
JL
1024 /* skip if the reservation is for the blob */
1025 if (base_32 == self_base && size_32 == self_size)
1026 continue;
329dda08 1027 DBG("reserving: %x -> %x\n", base_32, size_32);
cbbcf340
KG
1028 lmb_reserve(base_32, size_32);
1029 }
1030 return;
1031 }
1032#endif
9b6b563c
PM
1033 while (1) {
1034 base = *(reserve_map++);
1035 size = *(reserve_map++);
1036 if (size == 0)
1037 break;
cbbcf340 1038 DBG("reserving: %llx -> %llx\n", base, size);
9b6b563c
PM
1039 lmb_reserve(base, size);
1040 }
1041
1042#if 0
1043 DBG("memory reserved, lmbs :\n");
1044 lmb_dump_all();
1045#endif
1046}
1047
6ac26c8a 1048#ifdef CONFIG_PHYP_DUMP
37ddd5d0
MA
1049/**
1050 * phyp_dump_calculate_reserve_size() - reserve variable boot area 5% or arg
1051 *
1052 * Function to find the largest size we need to reserve
1053 * during early boot process.
1054 *
1055 * It either looks for boot param and returns that OR
1056 * returns larger of 256 or 5% rounded down to multiples of 256MB.
1057 *
1058 */
1059static inline unsigned long phyp_dump_calculate_reserve_size(void)
1060{
1061 unsigned long tmp;
1062
1063 if (phyp_dump_info->reserve_bootvar)
1064 return phyp_dump_info->reserve_bootvar;
1065
1066 /* divide by 20 to get 5% of value */
1067 tmp = lmb_end_of_DRAM();
1068 do_div(tmp, 20);
1069
1070 /* round it down in multiples of 256 */
1071 tmp = tmp & ~0x0FFFFFFFUL;
1072
1073 return (tmp > PHYP_DUMP_RMR_END ? tmp : PHYP_DUMP_RMR_END);
1074}
1075
6ac26c8a
MA
1076/**
1077 * phyp_dump_reserve_mem() - reserve all not-yet-dumped mmemory
1078 *
1079 * This routine may reserve memory regions in the kernel only
1080 * if the system is supported and a dump was taken in last
1081 * boot instance or if the hardware is supported and the
1082 * scratch area needs to be setup. In other instances it returns
1083 * without reserving anything. The memory in case of dump being
1084 * active is freed when the dump is collected (by userland tools).
1085 */
1086static void __init phyp_dump_reserve_mem(void)
1087{
1088 unsigned long base, size;
37ddd5d0
MA
1089 unsigned long variable_reserve_size;
1090
6ac26c8a
MA
1091 if (!phyp_dump_info->phyp_dump_configured) {
1092 printk(KERN_ERR "Phyp-dump not supported on this hardware\n");
1093 return;
1094 }
1095
654f596d
MA
1096 if (!phyp_dump_info->phyp_dump_at_boot) {
1097 printk(KERN_INFO "Phyp-dump disabled at boot time\n");
1098 return;
1099 }
1100
37ddd5d0
MA
1101 variable_reserve_size = phyp_dump_calculate_reserve_size();
1102
6ac26c8a
MA
1103 if (phyp_dump_info->phyp_dump_is_active) {
1104 /* Reserve *everything* above RMR.Area freed by userland tools*/
37ddd5d0 1105 base = variable_reserve_size;
6ac26c8a
MA
1106 size = lmb_end_of_DRAM() - base;
1107
1108 /* XXX crashed_ram_end is wrong, since it may be beyond
1109 * the memory_limit, it will need to be adjusted. */
1110 lmb_reserve(base, size);
1111
1112 phyp_dump_info->init_reserve_start = base;
1113 phyp_dump_info->init_reserve_size = size;
1114 } else {
1115 size = phyp_dump_info->cpu_state_size +
1116 phyp_dump_info->hpte_region_size +
37ddd5d0 1117 variable_reserve_size;
6ac26c8a
MA
1118 base = lmb_end_of_DRAM() - size;
1119 lmb_reserve(base, size);
1120 phyp_dump_info->init_reserve_start = base;
1121 phyp_dump_info->init_reserve_size = size;
1122 }
1123}
1124#else
1125static inline void __init phyp_dump_reserve_mem(void) {}
1126#endif /* CONFIG_PHYP_DUMP && CONFIG_PPC_RTAS */
1127
1128
9b6b563c
PM
1129void __init early_init_devtree(void *params)
1130{
44348105 1131 DBG(" -> early_init_devtree(%p)\n", params);
9b6b563c
PM
1132
1133 /* Setup flat device-tree pointer */
1134 initial_boot_params = params;
1135
458148c0
ME
1136#ifdef CONFIG_PPC_RTAS
1137 /* Some machines might need RTAS info for debugging, grab it now. */
1138 of_scan_flat_dt(early_init_dt_scan_rtas, NULL);
1139#endif
1140
6ac26c8a
MA
1141#ifdef CONFIG_PHYP_DUMP
1142 /* scan tree to see if dump occured during last boot */
1143 of_scan_flat_dt(early_init_dt_scan_phyp_dump, NULL);
1144#endif
1145
9b6b563c
PM
1146 /* Retrieve various informations from the /chosen node of the
1147 * device-tree, including the platform type, initrd location and
1148 * size, TCE reserve, and more ...
1149 */
3c726f8d 1150 of_scan_flat_dt(early_init_dt_scan_chosen, NULL);
9b6b563c
PM
1151
1152 /* Scan memory nodes and rebuild LMBs */
1153 lmb_init();
3c726f8d
BH
1154 of_scan_flat_dt(early_init_dt_scan_root, NULL);
1155 of_scan_flat_dt(early_init_dt_scan_memory, NULL);
846f77b0
ME
1156
1157 /* Save command line for /proc/cmdline and then parse parameters */
b8757b21 1158 strlcpy(boot_command_line, cmd_line, COMMAND_LINE_SIZE);
846f77b0
ME
1159 parse_early_param();
1160
9b6b563c 1161 /* Reserve LMB regions used by kernel, initrd, dt, etc... */
0cc4746c 1162 lmb_reserve(PHYSICAL_START, __pa(klimit) - PHYSICAL_START);
47310413 1163 reserve_kdump_trampoline();
35dd5432 1164 reserve_crashkernel();
9b6b563c 1165 early_reserve_mem();
6ac26c8a 1166 phyp_dump_reserve_mem();
9b6b563c 1167
2babf5c2
ME
1168 lmb_enforce_memory_limit(memory_limit);
1169 lmb_analyze();
1170
1171 DBG("Phys. mem: %lx\n", lmb_phys_mem_size());
1172
1173 /* We may need to relocate the flat tree, do it now.
1174 * FIXME .. and the initrd too? */
1175 move_device_tree();
1176
9b6b563c
PM
1177 DBG("Scanning CPUs ...\n");
1178
3c726f8d
BH
1179 /* Retreive CPU related informations from the flat tree
1180 * (altivec support, boot CPU ID, ...)
9b6b563c 1181 */
3c726f8d 1182 of_scan_flat_dt(early_init_dt_scan_cpus, NULL);
9b6b563c 1183
9b6b563c
PM
1184 DBG(" <- early_init_devtree()\n");
1185}
1186
9b6b563c 1187
9b6b563c
PM
1188/**
1189 * Indicates whether the root node has a given value in its
1190 * compatible property.
1191 */
1192int machine_is_compatible(const char *compat)
1193{
1194 struct device_node *root;
1195 int rc = 0;
1196
1197 root = of_find_node_by_path("/");
1198 if (root) {
7a92f74f 1199 rc = of_device_is_compatible(root, compat);
9b6b563c
PM
1200 of_node_put(root);
1201 }
1202 return rc;
1203}
1204EXPORT_SYMBOL(machine_is_compatible);
1205
9b6b563c
PM
1206/*******
1207 *
1208 * New implementation of the OF "find" APIs, return a refcounted
1209 * object, call of_node_put() when done. The device tree and list
1210 * are protected by a rw_lock.
1211 *
1212 * Note that property management will need some locking as well,
1213 * this isn't dealt with yet.
1214 *
1215 *******/
1216
9b6b563c
PM
1217/**
1218 * of_find_node_by_phandle - Find a node given a phandle
1219 * @handle: phandle of the node to find
1220 *
1221 * Returns a node pointer with refcount incremented, use
1222 * of_node_put() on it when done.
1223 */
1224struct device_node *of_find_node_by_phandle(phandle handle)
1225{
1226 struct device_node *np;
1227
1228 read_lock(&devtree_lock);
1229 for (np = allnodes; np != 0; np = np->allnext)
1230 if (np->linux_phandle == handle)
1231 break;
b1374051 1232 of_node_get(np);
9b6b563c
PM
1233 read_unlock(&devtree_lock);
1234 return np;
1235}
1236EXPORT_SYMBOL(of_find_node_by_phandle);
1237
1238/**
1239 * of_find_all_nodes - Get next node in global list
1240 * @prev: Previous node or NULL to start iteration
1241 * of_node_put() will be called on it
1242 *
1243 * Returns a node pointer with refcount incremented, use
1244 * of_node_put() on it when done.
1245 */
1246struct device_node *of_find_all_nodes(struct device_node *prev)
1247{
1248 struct device_node *np;
1249
1250 read_lock(&devtree_lock);
1251 np = prev ? prev->allnext : allnodes;
1252 for (; np != 0; np = np->allnext)
1253 if (of_node_get(np))
1254 break;
b1374051 1255 of_node_put(prev);
9b6b563c
PM
1256 read_unlock(&devtree_lock);
1257 return np;
1258}
1259EXPORT_SYMBOL(of_find_all_nodes);
1260
9b6b563c
PM
1261/**
1262 * of_node_get - Increment refcount of a node
1263 * @node: Node to inc refcount, NULL is supported to
1264 * simplify writing of callers
1265 *
1266 * Returns node.
1267 */
1268struct device_node *of_node_get(struct device_node *node)
1269{
1270 if (node)
1271 kref_get(&node->kref);
1272 return node;
1273}
1274EXPORT_SYMBOL(of_node_get);
1275
1276static inline struct device_node * kref_to_device_node(struct kref *kref)
1277{
1278 return container_of(kref, struct device_node, kref);
1279}
1280
1281/**
1282 * of_node_release - release a dynamically allocated node
1283 * @kref: kref element of the node to be released
1284 *
1285 * In of_node_put() this function is passed to kref_put()
1286 * as the destructor.
1287 */
1288static void of_node_release(struct kref *kref)
1289{
1290 struct device_node *node = kref_to_device_node(kref);
1291 struct property *prop = node->properties;
1292
6a281856
ME
1293 /* We should never be releasing nodes that haven't been detached. */
1294 if (!of_node_check_flag(node, OF_DETACHED)) {
1295 printk("WARNING: Bad of_node_put() on %s\n", node->full_name);
1296 dump_stack();
1297 kref_init(&node->kref);
1298 return;
1299 }
1300
d3b814bb 1301 if (!of_node_check_flag(node, OF_DYNAMIC))
9b6b563c 1302 return;
6a281856 1303
9b6b563c
PM
1304 while (prop) {
1305 struct property *next = prop->next;
1306 kfree(prop->name);
1307 kfree(prop->value);
1308 kfree(prop);
1309 prop = next;
088186de
DB
1310
1311 if (!prop) {
1312 prop = node->deadprops;
1313 node->deadprops = NULL;
1314 }
9b6b563c 1315 }
9b6b563c
PM
1316 kfree(node->full_name);
1317 kfree(node->data);
1318 kfree(node);
1319}
1320
1321/**
1322 * of_node_put - Decrement refcount of a node
1323 * @node: Node to dec refcount, NULL is supported to
1324 * simplify writing of callers
1325 *
1326 */
1327void of_node_put(struct device_node *node)
1328{
1329 if (node)
1330 kref_put(&node->kref, of_node_release);
1331}
1332EXPORT_SYMBOL(of_node_put);
1333
1334/*
1335 * Plug a device node into the tree and global list.
1336 */
1337void of_attach_node(struct device_node *np)
1338{
f4ac7b5e
BH
1339 unsigned long flags;
1340
1341 write_lock_irqsave(&devtree_lock, flags);
9b6b563c
PM
1342 np->sibling = np->parent->child;
1343 np->allnext = allnodes;
1344 np->parent->child = np;
1345 allnodes = np;
f4ac7b5e 1346 write_unlock_irqrestore(&devtree_lock, flags);
9b6b563c
PM
1347}
1348
1349/*
1350 * "Unplug" a node from the device tree. The caller must hold
1351 * a reference to the node. The memory associated with the node
1352 * is not freed until its refcount goes to zero.
1353 */
34f329db 1354void of_detach_node(struct device_node *np)
9b6b563c
PM
1355{
1356 struct device_node *parent;
f4ac7b5e 1357 unsigned long flags;
9b6b563c 1358
f4ac7b5e 1359 write_lock_irqsave(&devtree_lock, flags);
9b6b563c
PM
1360
1361 parent = np->parent;
972d17c9
ME
1362 if (!parent)
1363 goto out_unlock;
9b6b563c
PM
1364
1365 if (allnodes == np)
1366 allnodes = np->allnext;
1367 else {
1368 struct device_node *prev;
1369 for (prev = allnodes;
1370 prev->allnext != np;
1371 prev = prev->allnext)
1372 ;
1373 prev->allnext = np->allnext;
1374 }
1375
1376 if (parent->child == np)
1377 parent->child = np->sibling;
1378 else {
1379 struct device_node *prevsib;
1380 for (prevsib = np->parent->child;
1381 prevsib->sibling != np;
1382 prevsib = prevsib->sibling)
1383 ;
1384 prevsib->sibling = np->sibling;
1385 }
1386
6a281856
ME
1387 of_node_set_flag(np, OF_DETACHED);
1388
972d17c9 1389out_unlock:
f4ac7b5e 1390 write_unlock_irqrestore(&devtree_lock, flags);
9b6b563c
PM
1391}
1392
1393#ifdef CONFIG_PPC_PSERIES
1394/*
1395 * Fix up the uninitialized fields in a new device node:
0ebfff14 1396 * name, type and pci-specific fields
9b6b563c
PM
1397 */
1398
cc5d0189 1399static int of_finish_dynamic_node(struct device_node *node)
9b6b563c
PM
1400{
1401 struct device_node *parent = of_get_parent(node);
1402 int err = 0;
a7f67bdf 1403 const phandle *ibm_phandle;
9b6b563c 1404
0e56efc7
SR
1405 node->name = of_get_property(node, "name", NULL);
1406 node->type = of_get_property(node, "device_type", NULL);
9b6b563c 1407
847f5976
BH
1408 if (!node->name)
1409 node->name = "<NULL>";
1410 if (!node->type)
1411 node->type = "<NULL>";
1412
9b6b563c
PM
1413 if (!parent) {
1414 err = -ENODEV;
1415 goto out;
1416 }
1417
1418 /* We don't support that function on PowerMac, at least
1419 * not yet
1420 */
e8222502 1421 if (machine_is(powermac))
9b6b563c
PM
1422 return -ENODEV;
1423
1424 /* fix up new node's linux_phandle field */
0e56efc7 1425 if ((ibm_phandle = of_get_property(node, "ibm,phandle", NULL)))
9b6b563c
PM
1426 node->linux_phandle = *ibm_phandle;
1427
1428out:
1429 of_node_put(parent);
1430 return err;
1431}
1432
1433static int prom_reconfig_notifier(struct notifier_block *nb,
1434 unsigned long action, void *node)
1435{
1436 int err;
1437
1438 switch (action) {
1439 case PSERIES_RECONFIG_ADD:
cc5d0189 1440 err = of_finish_dynamic_node(node);
9b6b563c
PM
1441 if (err < 0) {
1442 printk(KERN_ERR "finish_node returned %d\n", err);
1443 err = NOTIFY_BAD;
1444 }
1445 break;
1446 default:
1447 err = NOTIFY_DONE;
1448 break;
1449 }
1450 return err;
1451}
1452
1453static struct notifier_block prom_reconfig_nb = {
1454 .notifier_call = prom_reconfig_notifier,
1455 .priority = 10, /* This one needs to run first */
1456};
1457
1458static int __init prom_reconfig_setup(void)
1459{
1460 return pSeries_reconfig_notifier_register(&prom_reconfig_nb);
1461}
1462__initcall(prom_reconfig_setup);
1463#endif
1464
9b6b563c
PM
1465/*
1466 * Add a property to a node
1467 */
183d0202 1468int prom_add_property(struct device_node* np, struct property* prop)
9b6b563c 1469{
183d0202 1470 struct property **next;
f4ac7b5e 1471 unsigned long flags;
9b6b563c
PM
1472
1473 prop->next = NULL;
f4ac7b5e 1474 write_lock_irqsave(&devtree_lock, flags);
183d0202
BH
1475 next = &np->properties;
1476 while (*next) {
1477 if (strcmp(prop->name, (*next)->name) == 0) {
1478 /* duplicate ! don't insert it */
f4ac7b5e 1479 write_unlock_irqrestore(&devtree_lock, flags);
183d0202
BH
1480 return -1;
1481 }
9b6b563c 1482 next = &(*next)->next;
183d0202 1483 }
9b6b563c 1484 *next = prop;
f4ac7b5e 1485 write_unlock_irqrestore(&devtree_lock, flags);
183d0202 1486
799d6046 1487#ifdef CONFIG_PROC_DEVICETREE
183d0202
BH
1488 /* try to add to proc as well if it was initialized */
1489 if (np->pde)
1490 proc_device_tree_add_prop(np->pde, prop);
799d6046 1491#endif /* CONFIG_PROC_DEVICETREE */
183d0202
BH
1492
1493 return 0;
9b6b563c
PM
1494}
1495
088186de
DB
1496/*
1497 * Remove a property from a node. Note that we don't actually
1498 * remove it, since we have given out who-knows-how-many pointers
1499 * to the data using get-property. Instead we just move the property
1500 * to the "dead properties" list, so it won't be found any more.
1501 */
1502int prom_remove_property(struct device_node *np, struct property *prop)
1503{
1504 struct property **next;
f4ac7b5e 1505 unsigned long flags;
088186de
DB
1506 int found = 0;
1507
f4ac7b5e 1508 write_lock_irqsave(&devtree_lock, flags);
088186de
DB
1509 next = &np->properties;
1510 while (*next) {
1511 if (*next == prop) {
1512 /* found the node */
1513 *next = prop->next;
1514 prop->next = np->deadprops;
1515 np->deadprops = prop;
1516 found = 1;
1517 break;
1518 }
1519 next = &(*next)->next;
1520 }
f4ac7b5e 1521 write_unlock_irqrestore(&devtree_lock, flags);
088186de
DB
1522
1523 if (!found)
1524 return -ENODEV;
1525
1526#ifdef CONFIG_PROC_DEVICETREE
1527 /* try to remove the proc node as well */
1528 if (np->pde)
1529 proc_device_tree_remove_prop(np->pde, prop);
1530#endif /* CONFIG_PROC_DEVICETREE */
1531
1532 return 0;
1533}
1534
1535/*
1536 * Update a property in a node. Note that we don't actually
1537 * remove it, since we have given out who-knows-how-many pointers
1538 * to the data using get-property. Instead we just move the property
1539 * to the "dead properties" list, and add the new property to the
1540 * property list
1541 */
1542int prom_update_property(struct device_node *np,
1543 struct property *newprop,
1544 struct property *oldprop)
1545{
1546 struct property **next;
f4ac7b5e 1547 unsigned long flags;
088186de
DB
1548 int found = 0;
1549
f4ac7b5e 1550 write_lock_irqsave(&devtree_lock, flags);
088186de
DB
1551 next = &np->properties;
1552 while (*next) {
1553 if (*next == oldprop) {
1554 /* found the node */
1555 newprop->next = oldprop->next;
1556 *next = newprop;
1557 oldprop->next = np->deadprops;
1558 np->deadprops = oldprop;
1559 found = 1;
1560 break;
1561 }
1562 next = &(*next)->next;
1563 }
f4ac7b5e 1564 write_unlock_irqrestore(&devtree_lock, flags);
088186de
DB
1565
1566 if (!found)
1567 return -ENODEV;
9b6b563c 1568
088186de
DB
1569#ifdef CONFIG_PROC_DEVICETREE
1570 /* try to add to proc as well if it was initialized */
1571 if (np->pde)
1572 proc_device_tree_update_prop(np->pde, newprop, oldprop);
1573#endif /* CONFIG_PROC_DEVICETREE */
1574
1575 return 0;
1576}
b68239ee 1577
acf7d768
BH
1578
1579/* Find the device node for a given logical cpu number, also returns the cpu
1580 * local thread number (index in ibm,interrupt-server#s) if relevant and
1581 * asked for (non NULL)
1582 */
1583struct device_node *of_get_cpu_node(int cpu, unsigned int *thread)
1584{
1585 int hardid;
1586 struct device_node *np;
1587
1588 hardid = get_hard_smp_processor_id(cpu);
1589
1590 for_each_node_by_type(np, "cpu") {
a7f67bdf 1591 const u32 *intserv;
acf7d768
BH
1592 unsigned int plen, t;
1593
1594 /* Check for ibm,ppc-interrupt-server#s. If it doesn't exist
1595 * fallback to "reg" property and assume no threads
1596 */
0e56efc7 1597 intserv = of_get_property(np, "ibm,ppc-interrupt-server#s",
a7f67bdf 1598 &plen);
acf7d768 1599 if (intserv == NULL) {
0e56efc7 1600 const u32 *reg = of_get_property(np, "reg", NULL);
acf7d768
BH
1601 if (reg == NULL)
1602 continue;
1603 if (*reg == hardid) {
1604 if (thread)
1605 *thread = 0;
1606 return np;
1607 }
1608 } else {
1609 plen /= sizeof(u32);
1610 for (t = 0; t < plen; t++) {
1611 if (hardid == intserv[t]) {
1612 if (thread)
1613 *thread = t;
1614 return np;
1615 }
1616 }
1617 }
1618 }
1619 return NULL;
1620}
36ca4ba4 1621EXPORT_SYMBOL(of_get_cpu_node);
7a4571ae 1622
94a3807c 1623#if defined(CONFIG_DEBUG_FS) && defined(DEBUG)
7a4571ae
ME
1624static struct debugfs_blob_wrapper flat_dt_blob;
1625
1626static int __init export_flat_device_tree(void)
1627{
1628 struct dentry *d;
1629
7a4571ae
ME
1630 flat_dt_blob.data = initial_boot_params;
1631 flat_dt_blob.size = initial_boot_params->totalsize;
1632
1633 d = debugfs_create_blob("flat-device-tree", S_IFREG | S_IRUSR,
94a3807c 1634 powerpc_debugfs_root, &flat_dt_blob);
7a4571ae
ME
1635 if (!d)
1636 return 1;
1637
1638 return 0;
1639}
1640__initcall(export_flat_device_tree);
1641#endif
This page took 0.341732 seconds and 5 git commands to generate.