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