1
2
3
4
5
6
7
8
9
10
11
12
13
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/export.h>
31#include <linux/kexec.h>
32#include <linux/irq.h>
33#include <linux/memblock.h>
34#include <linux/of.h>
35#include <linux/of_fdt.h>
36#include <linux/libfdt.h>
37
38#include <asm/prom.h>
39#include <asm/rtas.h>
40#include <asm/page.h>
41#include <asm/processor.h>
42#include <asm/irq.h>
43#include <asm/io.h>
44#include <asm/kdump.h>
45#include <asm/smp.h>
46#include <asm/mmu.h>
47#include <asm/paca.h>
48#include <asm/pgtable.h>
49#include <asm/iommu.h>
50#include <asm/btext.h>
51#include <asm/sections.h>
52#include <asm/machdep.h>
53#include <asm/pci-bridge.h>
54#include <asm/kexec.h>
55#include <asm/opal.h>
56#include <asm/fadump.h>
57#include <asm/debug.h>
58
59#include <mm/mmu_decl.h>
60
61#ifdef DEBUG
62#define DBG(fmt...) printk(KERN_ERR fmt)
63#else
64#define DBG(fmt...)
65#endif
66
67#ifdef CONFIG_PPC64
68int __initdata iommu_is_off;
69int __initdata iommu_force_on;
70unsigned long tce_alloc_start, tce_alloc_end;
71u64 ppc64_rma_size;
72#endif
73static phys_addr_t first_memblock_size;
74static int __initdata boot_cpu_count;
75
76static int __init early_parse_mem(char *p)
77{
78 if (!p)
79 return 1;
80
81 memory_limit = PAGE_ALIGN(memparse(p, &p));
82 DBG("memory limit = 0x%llx\n", memory_limit);
83
84 return 0;
85}
86early_param("mem", early_parse_mem);
87
88
89
90
91
92static inline int overlaps_initrd(unsigned long start, unsigned long size)
93{
94#ifdef CONFIG_BLK_DEV_INITRD
95 if (!initrd_start)
96 return 0;
97
98 return (start + size) > _ALIGN_DOWN(initrd_start, PAGE_SIZE) &&
99 start <= _ALIGN_UP(initrd_end, PAGE_SIZE);
100#else
101 return 0;
102#endif
103}
104
105
106
107
108
109
110
111
112static void __init move_device_tree(void)
113{
114 unsigned long start, size;
115 void *p;
116
117 DBG("-> move_device_tree\n");
118
119 start = __pa(initial_boot_params);
120 size = fdt_totalsize(initial_boot_params);
121
122 if ((memory_limit && (start + size) > PHYSICAL_START + memory_limit) ||
123 overlaps_crashkernel(start, size) ||
124 overlaps_initrd(start, size)) {
125 p = __va(memblock_alloc(size, PAGE_SIZE));
126 memcpy(p, initial_boot_params, size);
127 initial_boot_params = p;
128 DBG("Moved device tree to 0x%p\n", p);
129 }
130
131 DBG("<- move_device_tree\n");
132}
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147static struct ibm_pa_feature {
148 unsigned long cpu_features;
149 unsigned long mmu_features;
150 unsigned int cpu_user_ftrs;
151 unsigned char pabyte;
152 unsigned char pabit;
153 unsigned char invert;
154} ibm_pa_features[] __initdata = {
155 {0, 0, PPC_FEATURE_HAS_MMU, 0, 0, 0},
156 {0, 0, PPC_FEATURE_HAS_FPU, 0, 1, 0},
157 {CPU_FTR_CTRL, 0, 0, 0, 3, 0},
158 {CPU_FTR_NOEXECUTE, 0, 0, 0, 6, 0},
159 {CPU_FTR_NODSISRALIGN, 0, 0, 1, 1, 1},
160 {0, MMU_FTR_CI_LARGE_PAGE, 0, 1, 2, 0},
161 {CPU_FTR_REAL_LE, PPC_FEATURE_TRUE_LE, 5, 0, 0},
162
163
164
165
166
167 {CPU_FTR_TM_COMP, 0, 0, 22, 0, 0},
168};
169
170static void __init scan_features(unsigned long node, const unsigned char *ftrs,
171 unsigned long tablelen,
172 struct ibm_pa_feature *fp,
173 unsigned long ft_size)
174{
175 unsigned long i, len, bit;
176
177
178 for (;;) {
179 if (tablelen < 3)
180 return;
181 len = 2 + ftrs[0];
182 if (tablelen < len)
183 return;
184 if (ftrs[1] == 0)
185 break;
186 tablelen -= len;
187 ftrs += len;
188 }
189
190
191 for (i = 0; i < ft_size; ++i, ++fp) {
192 if (fp->pabyte >= ftrs[0])
193 continue;
194 bit = (ftrs[2 + fp->pabyte] >> (7 - fp->pabit)) & 1;
195 if (bit ^ fp->invert) {
196 cur_cpu_spec->cpu_features |= fp->cpu_features;
197 cur_cpu_spec->cpu_user_features |= fp->cpu_user_ftrs;
198 cur_cpu_spec->mmu_features |= fp->mmu_features;
199 } else {
200 cur_cpu_spec->cpu_features &= ~fp->cpu_features;
201 cur_cpu_spec->cpu_user_features &= ~fp->cpu_user_ftrs;
202 cur_cpu_spec->mmu_features &= ~fp->mmu_features;
203 }
204 }
205}
206
207static void __init check_cpu_pa_features(unsigned long node)
208{
209 const unsigned char *pa_ftrs;
210 int tablelen;
211
212 pa_ftrs = of_get_flat_dt_prop(node, "ibm,pa-features", &tablelen);
213 if (pa_ftrs == NULL)
214 return;
215
216 scan_features(node, pa_ftrs, tablelen,
217 ibm_pa_features, ARRAY_SIZE(ibm_pa_features));
218}
219
220#ifdef CONFIG_PPC_STD_MMU_64
221static void __init check_cpu_slb_size(unsigned long node)
222{
223 const __be32 *slb_size_ptr;
224
225 slb_size_ptr = of_get_flat_dt_prop(node, "slb-size", NULL);
226 if (slb_size_ptr != NULL) {
227 mmu_slb_size = be32_to_cpup(slb_size_ptr);
228 return;
229 }
230 slb_size_ptr = of_get_flat_dt_prop(node, "ibm,slb-size", NULL);
231 if (slb_size_ptr != NULL) {
232 mmu_slb_size = be32_to_cpup(slb_size_ptr);
233 }
234}
235#else
236#define check_cpu_slb_size(node) do { } while(0)
237#endif
238
239static struct feature_property {
240 const char *name;
241 u32 min_value;
242 unsigned long cpu_feature;
243 unsigned long cpu_user_ftr;
244} feature_properties[] __initdata = {
245#ifdef CONFIG_ALTIVEC
246 {"altivec", 0, CPU_FTR_ALTIVEC, PPC_FEATURE_HAS_ALTIVEC},
247 {"ibm,vmx", 1, CPU_FTR_ALTIVEC, PPC_FEATURE_HAS_ALTIVEC},
248#endif
249#ifdef CONFIG_VSX
250
251 {"ibm,vmx", 2, CPU_FTR_VSX, PPC_FEATURE_HAS_VSX},
252#endif
253#ifdef CONFIG_PPC64
254 {"ibm,dfp", 1, 0, PPC_FEATURE_HAS_DFP},
255 {"ibm,purr", 1, CPU_FTR_PURR, 0},
256 {"ibm,spurr", 1, CPU_FTR_SPURR, 0},
257#endif
258};
259
260#if defined(CONFIG_44x) && defined(CONFIG_PPC_FPU)
261static inline void identical_pvr_fixup(unsigned long node)
262{
263 unsigned int pvr;
264 const char *model = of_get_flat_dt_prop(node, "model", NULL);
265
266
267
268
269
270
271
272
273 if (model && strstr(model, "440EP")) {
274 pvr = cur_cpu_spec->pvr_value | 0x8;
275 identify_cpu(0, pvr);
276 DBG("Using logical pvr %x for %s\n", pvr, model);
277 }
278}
279#else
280#define identical_pvr_fixup(node) do { } while(0)
281#endif
282
283static void __init check_cpu_feature_properties(unsigned long node)
284{
285 unsigned long i;
286 struct feature_property *fp = feature_properties;
287 const __be32 *prop;
288
289 for (i = 0; i < ARRAY_SIZE(feature_properties); ++i, ++fp) {
290 prop = of_get_flat_dt_prop(node, fp->name, NULL);
291 if (prop && be32_to_cpup(prop) >= fp->min_value) {
292 cur_cpu_spec->cpu_features |= fp->cpu_feature;
293 cur_cpu_spec->cpu_user_features |= fp->cpu_user_ftr;
294 }
295 }
296}
297
298static int __init early_init_dt_scan_cpus(unsigned long node,
299 const char *uname, int depth,
300 void *data)
301{
302 const char *type = of_get_flat_dt_prop(node, "device_type", NULL);
303 const __be32 *prop;
304 const __be32 *intserv;
305 int i, nthreads;
306 int len;
307 int found = -1;
308 int found_thread = 0;
309
310
311 if (type == NULL || strcmp(type, "cpu") != 0)
312 return 0;
313
314
315 intserv = of_get_flat_dt_prop(node, "ibm,ppc-interrupt-server#s", &len);
316 if (!intserv)
317 intserv = of_get_flat_dt_prop(node, "reg", &len);
318
319 nthreads = len / sizeof(int);
320
321
322
323
324
325 for (i = 0; i < nthreads; i++) {
326
327
328
329
330 if (fdt_version(initial_boot_params) >= 2) {
331 if (be32_to_cpu(intserv[i]) ==
332 fdt_boot_cpuid_phys(initial_boot_params)) {
333 found = boot_cpu_count;
334 found_thread = i;
335 }
336 } else {
337
338
339
340
341
342 if (of_get_flat_dt_prop(node,
343 "linux,boot-cpu", NULL) != NULL)
344 found = boot_cpu_count;
345 }
346#ifdef CONFIG_SMP
347
348 boot_cpu_count++;
349#endif
350 }
351
352
353 if (found < 0)
354 return 0;
355
356 DBG("boot cpu: logical %d physical %d\n", found,
357 be32_to_cpu(intserv[found_thread]));
358 boot_cpuid = found;
359 set_hard_smp_processor_id(found, be32_to_cpu(intserv[found_thread]));
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375 prop = of_get_flat_dt_prop(node, "cpu-version", NULL);
376 if (prop && (be32_to_cpup(prop) & 0xff000000) == 0x0f000000)
377 identify_cpu(0, be32_to_cpup(prop));
378
379 identical_pvr_fixup(node);
380
381 check_cpu_feature_properties(node);
382 check_cpu_pa_features(node);
383 check_cpu_slb_size(node);
384
385#ifdef CONFIG_PPC64
386 if (nthreads > 1)
387 cur_cpu_spec->cpu_features |= CPU_FTR_SMT;
388 else
389 cur_cpu_spec->cpu_features &= ~CPU_FTR_SMT;
390#endif
391 return 0;
392}
393
394static int __init early_init_dt_scan_chosen_ppc(unsigned long node,
395 const char *uname,
396 int depth, void *data)
397{
398 const unsigned long *lprop;
399
400
401 if (early_init_dt_scan_chosen(node, uname, depth, data) == 0)
402 return 0;
403
404#ifdef CONFIG_PPC64
405
406 if (of_get_flat_dt_prop(node, "linux,iommu-off", NULL) != NULL)
407 iommu_is_off = 1;
408 if (of_get_flat_dt_prop(node, "linux,iommu-force-on", NULL) != NULL)
409 iommu_force_on = 1;
410#endif
411
412
413 lprop = of_get_flat_dt_prop(node, "linux,memory-limit", NULL);
414 if (lprop)
415 memory_limit = *lprop;
416
417#ifdef CONFIG_PPC64
418 lprop = of_get_flat_dt_prop(node, "linux,tce-alloc-start", NULL);
419 if (lprop)
420 tce_alloc_start = *lprop;
421 lprop = of_get_flat_dt_prop(node, "linux,tce-alloc-end", NULL);
422 if (lprop)
423 tce_alloc_end = *lprop;
424#endif
425
426#ifdef CONFIG_KEXEC
427 lprop = of_get_flat_dt_prop(node, "linux,crashkernel-base", NULL);
428 if (lprop)
429 crashk_res.start = *lprop;
430
431 lprop = of_get_flat_dt_prop(node, "linux,crashkernel-size", NULL);
432 if (lprop)
433 crashk_res.end = crashk_res.start + *lprop - 1;
434#endif
435
436
437 return 1;
438}
439
440#ifdef CONFIG_PPC_PSERIES
441
442
443
444
445
446
447static int __init early_init_dt_scan_drconf_memory(unsigned long node)
448{
449 const __be32 *dm, *ls, *usm;
450 int l;
451 unsigned long n, flags;
452 u64 base, size, memblock_size;
453 unsigned int is_kexec_kdump = 0, rngs;
454
455 ls = of_get_flat_dt_prop(node, "ibm,lmb-size", &l);
456 if (ls == NULL || l < dt_root_size_cells * sizeof(__be32))
457 return 0;
458 memblock_size = dt_mem_next_cell(dt_root_size_cells, &ls);
459
460 dm = of_get_flat_dt_prop(node, "ibm,dynamic-memory", &l);
461 if (dm == NULL || l < sizeof(__be32))
462 return 0;
463
464 n = of_read_number(dm++, 1);
465 if (l < (n * (dt_root_addr_cells + 4) + 1) * sizeof(__be32))
466 return 0;
467
468
469 usm = of_get_flat_dt_prop(node, "linux,drconf-usable-memory",
470 &l);
471 if (usm != NULL)
472 is_kexec_kdump = 1;
473
474 for (; n != 0; --n) {
475 base = dt_mem_next_cell(dt_root_addr_cells, &dm);
476 flags = of_read_number(&dm[3], 1);
477
478 dm += 4;
479
480
481 if ((flags & 0x80) || !(flags & 0x8))
482 continue;
483 size = memblock_size;
484 rngs = 1;
485 if (is_kexec_kdump) {
486
487
488
489
490
491
492
493 rngs = dt_mem_next_cell(dt_root_size_cells, &usm);
494 if (!rngs)
495 continue;
496 }
497 do {
498 if (is_kexec_kdump) {
499 base = dt_mem_next_cell(dt_root_addr_cells,
500 &usm);
501 size = dt_mem_next_cell(dt_root_size_cells,
502 &usm);
503 }
504 if (iommu_is_off) {
505 if (base >= 0x80000000ul)
506 continue;
507 if ((base + size) > 0x80000000ul)
508 size = 0x80000000ul - base;
509 }
510 memblock_add(base, size);
511 } while (--rngs);
512 }
513 memblock_dump_all();
514 return 0;
515}
516#else
517#define early_init_dt_scan_drconf_memory(node) 0
518#endif
519
520static int __init early_init_dt_scan_memory_ppc(unsigned long node,
521 const char *uname,
522 int depth, void *data)
523{
524 if (depth == 1 &&
525 strcmp(uname, "ibm,dynamic-reconfiguration-memory") == 0)
526 return early_init_dt_scan_drconf_memory(node);
527
528 return early_init_dt_scan_memory(node, uname, depth, data);
529}
530
531
532
533
534
535
536
537
538
539#ifdef CONFIG_RELOCATABLE
540static int add_mem_to_memblock = 1;
541#else
542#define add_mem_to_memblock 1
543#endif
544
545void __init early_init_dt_add_memory_arch(u64 base, u64 size)
546{
547#ifdef CONFIG_PPC64
548 if (iommu_is_off) {
549 if (base >= 0x80000000ul)
550 return;
551 if ((base + size) > 0x80000000ul)
552 size = 0x80000000ul - base;
553 }
554#endif
555
556
557
558
559 if (base < memstart_addr) {
560 memstart_addr = base;
561 first_memblock_size = size;
562 }
563
564
565 if (add_mem_to_memblock)
566 memblock_add(base, size);
567}
568
569static void __init early_reserve_mem_dt(void)
570{
571 unsigned long i, dt_root;
572 int len;
573 const __be32 *prop;
574
575 early_init_fdt_reserve_self();
576 early_init_fdt_scan_reserved_mem();
577
578 dt_root = of_get_flat_dt_root();
579
580 prop = of_get_flat_dt_prop(dt_root, "reserved-ranges", &len);
581
582 if (!prop)
583 return;
584
585 DBG("Found new-style reserved-ranges\n");
586
587
588
589 for (i = 0; i < len / (sizeof(*prop) * 4); i++) {
590 u64 base, size;
591
592 base = of_read_number(prop + (i * 4) + 0, 2);
593 size = of_read_number(prop + (i * 4) + 2, 2);
594
595 if (size) {
596 DBG("reserving: %llx -> %llx\n", base, size);
597 memblock_reserve(base, size);
598 }
599 }
600}
601
602static void __init early_reserve_mem(void)
603{
604 __be64 *reserve_map;
605
606 reserve_map = (__be64 *)(((unsigned long)initial_boot_params) +
607 fdt_off_mem_rsvmap(initial_boot_params));
608
609
610 early_reserve_mem_dt();
611
612#ifdef CONFIG_BLK_DEV_INITRD
613
614 if (initrd_start && (initrd_end > initrd_start)) {
615 memblock_reserve(_ALIGN_DOWN(__pa(initrd_start), PAGE_SIZE),
616 _ALIGN_UP(initrd_end, PAGE_SIZE) -
617 _ALIGN_DOWN(initrd_start, PAGE_SIZE));
618 }
619#endif
620
621#ifdef CONFIG_PPC32
622
623
624
625
626 if (be64_to_cpup(reserve_map) > 0xffffffffull) {
627 u32 base_32, size_32;
628 __be32 *reserve_map_32 = (__be32 *)reserve_map;
629
630 DBG("Found old 32-bit reserve map\n");
631
632 while (1) {
633 base_32 = be32_to_cpup(reserve_map_32++);
634 size_32 = be32_to_cpup(reserve_map_32++);
635 if (size_32 == 0)
636 break;
637 DBG("reserving: %x -> %x\n", base_32, size_32);
638 memblock_reserve(base_32, size_32);
639 }
640 return;
641 }
642#endif
643}
644
645void __init early_init_devtree(void *params)
646{
647 phys_addr_t limit;
648
649 DBG(" -> early_init_devtree(%p)\n", params);
650
651
652 if (!early_init_dt_verify(params))
653 panic("BUG: Failed verifying flat device tree, bad version?");
654
655#ifdef CONFIG_PPC_RTAS
656
657 of_scan_flat_dt(early_init_dt_scan_rtas, NULL);
658#endif
659
660#ifdef CONFIG_PPC_POWERNV
661
662 of_scan_flat_dt(early_init_dt_scan_opal, NULL);
663#endif
664
665#ifdef CONFIG_FA_DUMP
666
667 of_scan_flat_dt(early_init_dt_scan_fw_dump, NULL);
668#endif
669
670
671
672
673
674 of_scan_flat_dt(early_init_dt_scan_chosen_ppc, boot_command_line);
675
676
677 of_scan_flat_dt(early_init_dt_scan_root, NULL);
678 of_scan_flat_dt(early_init_dt_scan_memory_ppc, NULL);
679
680 parse_early_param();
681
682
683 if (memory_limit)
684 first_memblock_size = min_t(u64, first_memblock_size, memory_limit);
685 setup_initial_memory_limit(memstart_addr, first_memblock_size);
686
687 memblock_reserve(PHYSICAL_START, __pa(klimit) - PHYSICAL_START);
688
689 if (PHYSICAL_START > MEMORY_START)
690 memblock_reserve(MEMORY_START, 0x8000);
691 reserve_kdump_trampoline();
692#ifdef CONFIG_FA_DUMP
693
694
695
696
697 if (fadump_reserve_mem() == 0)
698#endif
699 reserve_crashkernel();
700 early_reserve_mem();
701
702
703 limit = ALIGN(memory_limit ?: memblock_phys_mem_size(), PAGE_SIZE);
704 memblock_enforce_memory_limit(limit);
705
706 memblock_allow_resize();
707 memblock_dump_all();
708
709 DBG("Phys. mem: %llx\n", memblock_phys_mem_size());
710
711
712
713 move_device_tree();
714
715 allocate_pacas();
716
717 DBG("Scanning CPUs ...\n");
718
719
720
721
722 of_scan_flat_dt(early_init_dt_scan_cpus, NULL);
723 if (boot_cpuid < 0) {
724 printk("Failed to identify boot CPU !\n");
725 BUG();
726 }
727
728#if defined(CONFIG_SMP) && defined(CONFIG_PPC64)
729
730
731
732 spinning_secondaries = boot_cpu_count - 1;
733#endif
734
735#ifdef CONFIG_PPC_POWERNV
736
737 of_scan_flat_dt(early_init_dt_scan_recoverable_ranges, NULL);
738#endif
739
740 DBG(" <- early_init_devtree()\n");
741}
742
743#ifdef CONFIG_RELOCATABLE
744
745
746
747
748void __init early_get_first_memblock_info(void *params, phys_addr_t *size)
749{
750
751 initial_boot_params = params;
752
753
754
755
756
757 add_mem_to_memblock = 0;
758 of_scan_flat_dt(early_init_dt_scan_root, NULL);
759 of_scan_flat_dt(early_init_dt_scan_memory_ppc, NULL);
760 add_mem_to_memblock = 1;
761
762 if (size)
763 *size = first_memblock_size;
764}
765#endif
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786int of_get_ibm_chip_id(struct device_node *np)
787{
788 of_node_get(np);
789 while(np) {
790 struct device_node *old = np;
791 const __be32 *prop;
792
793 prop = of_get_property(np, "ibm,chip-id", NULL);
794 if (prop) {
795 of_node_put(np);
796 return be32_to_cpup(prop);
797 }
798 np = of_get_parent(np);
799 of_node_put(old);
800 }
801 return -1;
802}
803EXPORT_SYMBOL(of_get_ibm_chip_id);
804
805
806
807
808
809
810
811
812int cpu_to_chip_id(int cpu)
813{
814 struct device_node *np;
815
816 np = of_get_cpu_node(cpu, NULL);
817 if (!np)
818 return -1;
819
820 of_node_put(np);
821 return of_get_ibm_chip_id(np);
822}
823EXPORT_SYMBOL(cpu_to_chip_id);
824
825bool arch_match_cpu_phys_id(int cpu, u64 phys_id)
826{
827 return (int)phys_id == get_hard_smp_processor_id(cpu);
828}
829