Merge remote-tracking branch 'spi/for-5.14' into spi-next
[linux-2.6-microblaze.git] / arch / powerpc / kernel / setup_64.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * 
4  * Common boot and setup code.
5  *
6  * Copyright (C) 2001 PPC64 Team, IBM Corp
7  */
8
9 #include <linux/export.h>
10 #include <linux/string.h>
11 #include <linux/sched.h>
12 #include <linux/init.h>
13 #include <linux/kernel.h>
14 #include <linux/reboot.h>
15 #include <linux/delay.h>
16 #include <linux/initrd.h>
17 #include <linux/seq_file.h>
18 #include <linux/ioport.h>
19 #include <linux/console.h>
20 #include <linux/utsname.h>
21 #include <linux/tty.h>
22 #include <linux/root_dev.h>
23 #include <linux/notifier.h>
24 #include <linux/cpu.h>
25 #include <linux/unistd.h>
26 #include <linux/serial.h>
27 #include <linux/serial_8250.h>
28 #include <linux/memblock.h>
29 #include <linux/pci.h>
30 #include <linux/lockdep.h>
31 #include <linux/memory.h>
32 #include <linux/nmi.h>
33 #include <linux/pgtable.h>
34
35 #include <asm/debugfs.h>
36 #include <asm/io.h>
37 #include <asm/kdump.h>
38 #include <asm/prom.h>
39 #include <asm/processor.h>
40 #include <asm/smp.h>
41 #include <asm/elf.h>
42 #include <asm/machdep.h>
43 #include <asm/paca.h>
44 #include <asm/time.h>
45 #include <asm/cputable.h>
46 #include <asm/dt_cpu_ftrs.h>
47 #include <asm/sections.h>
48 #include <asm/btext.h>
49 #include <asm/nvram.h>
50 #include <asm/setup.h>
51 #include <asm/rtas.h>
52 #include <asm/iommu.h>
53 #include <asm/serial.h>
54 #include <asm/cache.h>
55 #include <asm/page.h>
56 #include <asm/mmu.h>
57 #include <asm/firmware.h>
58 #include <asm/xmon.h>
59 #include <asm/udbg.h>
60 #include <asm/kexec.h>
61 #include <asm/code-patching.h>
62 #include <asm/livepatch.h>
63 #include <asm/opal.h>
64 #include <asm/cputhreads.h>
65 #include <asm/hw_irq.h>
66 #include <asm/feature-fixups.h>
67 #include <asm/kup.h>
68 #include <asm/early_ioremap.h>
69 #include <asm/pgalloc.h>
70 #include <asm/asm-prototypes.h>
71
72 #include "setup.h"
73
74 int spinning_secondaries;
75 u64 ppc64_pft_size;
76
77 struct ppc64_caches ppc64_caches = {
78         .l1d = {
79                 .block_size = 0x40,
80                 .log_block_size = 6,
81         },
82         .l1i = {
83                 .block_size = 0x40,
84                 .log_block_size = 6
85         },
86 };
87 EXPORT_SYMBOL_GPL(ppc64_caches);
88
89 #if defined(CONFIG_PPC_BOOK3E) && defined(CONFIG_SMP)
90 void __init setup_tlb_core_data(void)
91 {
92         int cpu;
93
94         BUILD_BUG_ON(offsetof(struct tlb_core_data, lock) != 0);
95
96         for_each_possible_cpu(cpu) {
97                 int first = cpu_first_thread_sibling(cpu);
98
99                 /*
100                  * If we boot via kdump on a non-primary thread,
101                  * make sure we point at the thread that actually
102                  * set up this TLB.
103                  */
104                 if (cpu_first_thread_sibling(boot_cpuid) == first)
105                         first = boot_cpuid;
106
107                 paca_ptrs[cpu]->tcd_ptr = &paca_ptrs[first]->tcd;
108
109                 /*
110                  * If we have threads, we need either tlbsrx.
111                  * or e6500 tablewalk mode, or else TLB handlers
112                  * will be racy and could produce duplicate entries.
113                  * Should we panic instead?
114                  */
115                 WARN_ONCE(smt_enabled_at_boot >= 2 &&
116                           !mmu_has_feature(MMU_FTR_USE_TLBRSRV) &&
117                           book3e_htw_mode != PPC_HTW_E6500,
118                           "%s: unsupported MMU configuration\n", __func__);
119         }
120 }
121 #endif
122
123 #ifdef CONFIG_SMP
124
125 static char *smt_enabled_cmdline;
126
127 /* Look for ibm,smt-enabled OF option */
128 void __init check_smt_enabled(void)
129 {
130         struct device_node *dn;
131         const char *smt_option;
132
133         /* Default to enabling all threads */
134         smt_enabled_at_boot = threads_per_core;
135
136         /* Allow the command line to overrule the OF option */
137         if (smt_enabled_cmdline) {
138                 if (!strcmp(smt_enabled_cmdline, "on"))
139                         smt_enabled_at_boot = threads_per_core;
140                 else if (!strcmp(smt_enabled_cmdline, "off"))
141                         smt_enabled_at_boot = 0;
142                 else {
143                         int smt;
144                         int rc;
145
146                         rc = kstrtoint(smt_enabled_cmdline, 10, &smt);
147                         if (!rc)
148                                 smt_enabled_at_boot =
149                                         min(threads_per_core, smt);
150                 }
151         } else {
152                 dn = of_find_node_by_path("/options");
153                 if (dn) {
154                         smt_option = of_get_property(dn, "ibm,smt-enabled",
155                                                      NULL);
156
157                         if (smt_option) {
158                                 if (!strcmp(smt_option, "on"))
159                                         smt_enabled_at_boot = threads_per_core;
160                                 else if (!strcmp(smt_option, "off"))
161                                         smt_enabled_at_boot = 0;
162                         }
163
164                         of_node_put(dn);
165                 }
166         }
167 }
168
169 /* Look for smt-enabled= cmdline option */
170 static int __init early_smt_enabled(char *p)
171 {
172         smt_enabled_cmdline = p;
173         return 0;
174 }
175 early_param("smt-enabled", early_smt_enabled);
176
177 #endif /* CONFIG_SMP */
178
179 /** Fix up paca fields required for the boot cpu */
180 static void __init fixup_boot_paca(void)
181 {
182         /* The boot cpu is started */
183         get_paca()->cpu_start = 1;
184         /* Allow percpu accesses to work until we setup percpu data */
185         get_paca()->data_offset = 0;
186         /* Mark interrupts disabled in PACA */
187         irq_soft_mask_set(IRQS_DISABLED);
188 }
189
190 static void __init configure_exceptions(void)
191 {
192         /*
193          * Setup the trampolines from the lowmem exception vectors
194          * to the kdump kernel when not using a relocatable kernel.
195          */
196         setup_kdump_trampoline();
197
198         /* Under a PAPR hypervisor, we need hypercalls */
199         if (firmware_has_feature(FW_FEATURE_SET_MODE)) {
200                 /* Enable AIL if possible */
201                 if (!pseries_enable_reloc_on_exc()) {
202                         init_task.thread.fscr &= ~FSCR_SCV;
203                         cur_cpu_spec->cpu_user_features2 &= ~PPC_FEATURE2_SCV;
204                 }
205
206                 /*
207                  * Tell the hypervisor that we want our exceptions to
208                  * be taken in little endian mode.
209                  *
210                  * We don't call this for big endian as our calling convention
211                  * makes us always enter in BE, and the call may fail under
212                  * some circumstances with kdump.
213                  */
214 #ifdef __LITTLE_ENDIAN__
215                 pseries_little_endian_exceptions();
216 #endif
217         } else {
218                 /* Set endian mode using OPAL */
219                 if (firmware_has_feature(FW_FEATURE_OPAL))
220                         opal_configure_cores();
221
222                 /* AIL on native is done in cpu_ready_for_interrupts() */
223         }
224 }
225
226 static void cpu_ready_for_interrupts(void)
227 {
228         /*
229          * Enable AIL if supported, and we are in hypervisor mode. This
230          * is called once for every processor.
231          *
232          * If we are not in hypervisor mode the job is done once for
233          * the whole partition in configure_exceptions().
234          */
235         if (cpu_has_feature(CPU_FTR_HVMODE)) {
236                 unsigned long lpcr = mfspr(SPRN_LPCR);
237                 unsigned long new_lpcr = lpcr;
238
239                 if (cpu_has_feature(CPU_FTR_ARCH_31)) {
240                         /* P10 DD1 does not have HAIL */
241                         if (pvr_version_is(PVR_POWER10) &&
242                                         (mfspr(SPRN_PVR) & 0xf00) == 0x100)
243                                 new_lpcr |= LPCR_AIL_3;
244                         else
245                                 new_lpcr |= LPCR_HAIL;
246                 } else if (cpu_has_feature(CPU_FTR_ARCH_207S)) {
247                         new_lpcr |= LPCR_AIL_3;
248                 }
249
250                 if (new_lpcr != lpcr)
251                         mtspr(SPRN_LPCR, new_lpcr);
252         }
253
254         /*
255          * Set HFSCR:TM based on CPU features:
256          * In the special case of TM no suspend (P9N DD2.1), Linux is
257          * told TM is off via the dt-ftrs but told to (partially) use
258          * it via OPAL_REINIT_CPUS_TM_SUSPEND_DISABLED. So HFSCR[TM]
259          * will be off from dt-ftrs but we need to turn it on for the
260          * no suspend case.
261          */
262         if (cpu_has_feature(CPU_FTR_HVMODE)) {
263                 if (cpu_has_feature(CPU_FTR_TM_COMP))
264                         mtspr(SPRN_HFSCR, mfspr(SPRN_HFSCR) | HFSCR_TM);
265                 else
266                         mtspr(SPRN_HFSCR, mfspr(SPRN_HFSCR) & ~HFSCR_TM);
267         }
268
269         /* Set IR and DR in PACA MSR */
270         get_paca()->kernel_msr = MSR_KERNEL;
271 }
272
273 unsigned long spr_default_dscr = 0;
274
275 static void __init record_spr_defaults(void)
276 {
277         if (early_cpu_has_feature(CPU_FTR_DSCR))
278                 spr_default_dscr = mfspr(SPRN_DSCR);
279 }
280
281 /*
282  * Early initialization entry point. This is called by head.S
283  * with MMU translation disabled. We rely on the "feature" of
284  * the CPU that ignores the top 2 bits of the address in real
285  * mode so we can access kernel globals normally provided we
286  * only toy with things in the RMO region. From here, we do
287  * some early parsing of the device-tree to setup out MEMBLOCK
288  * data structures, and allocate & initialize the hash table
289  * and segment tables so we can start running with translation
290  * enabled.
291  *
292  * It is this function which will call the probe() callback of
293  * the various platform types and copy the matching one to the
294  * global ppc_md structure. Your platform can eventually do
295  * some very early initializations from the probe() routine, but
296  * this is not recommended, be very careful as, for example, the
297  * device-tree is not accessible via normal means at this point.
298  */
299
300 void __init early_setup(unsigned long dt_ptr)
301 {
302         static __initdata struct paca_struct boot_paca;
303
304         /* -------- printk is _NOT_ safe to use here ! ------- */
305
306         /*
307          * Assume we're on cpu 0 for now.
308          *
309          * We need to load a PACA very early for a few reasons.
310          *
311          * The stack protector canary is stored in the paca, so as soon as we
312          * call any stack protected code we need r13 pointing somewhere valid.
313          *
314          * If we are using kcov it will call in_task() in its instrumentation,
315          * which relies on the current task from the PACA.
316          *
317          * dt_cpu_ftrs_init() calls into generic OF/fdt code, as well as
318          * printk(), which can trigger both stack protector and kcov.
319          *
320          * percpu variables and spin locks also use the paca.
321          *
322          * So set up a temporary paca. It will be replaced below once we know
323          * what CPU we are on.
324          */
325         initialise_paca(&boot_paca, 0);
326         setup_paca(&boot_paca);
327         fixup_boot_paca();
328
329         /* -------- printk is now safe to use ------- */
330
331         /* Try new device tree based feature discovery ... */
332         if (!dt_cpu_ftrs_init(__va(dt_ptr)))
333                 /* Otherwise use the old style CPU table */
334                 identify_cpu(0, mfspr(SPRN_PVR));
335
336         /* Enable early debugging if any specified (see udbg.h) */
337         udbg_early_init();
338
339         udbg_printf(" -> %s(), dt_ptr: 0x%lx\n", __func__, dt_ptr);
340
341         /*
342          * Do early initialization using the flattened device
343          * tree, such as retrieving the physical memory map or
344          * calculating/retrieving the hash table size.
345          */
346         early_init_devtree(__va(dt_ptr));
347
348         /* Now we know the logical id of our boot cpu, setup the paca. */
349         if (boot_cpuid != 0) {
350                 /* Poison paca_ptrs[0] again if it's not the boot cpu */
351                 memset(&paca_ptrs[0], 0x88, sizeof(paca_ptrs[0]));
352         }
353         setup_paca(paca_ptrs[boot_cpuid]);
354         fixup_boot_paca();
355
356         /*
357          * Configure exception handlers. This include setting up trampolines
358          * if needed, setting exception endian mode, etc...
359          */
360         configure_exceptions();
361
362         /*
363          * Configure Kernel Userspace Protection. This needs to happen before
364          * feature fixups for platforms that implement this using features.
365          */
366         setup_kup();
367
368         /* Apply all the dynamic patching */
369         apply_feature_fixups();
370         setup_feature_keys();
371
372         /* Initialize the hash table or TLB handling */
373         early_init_mmu();
374
375         early_ioremap_setup();
376
377         /*
378          * After firmware and early platform setup code has set things up,
379          * we note the SPR values for configurable control/performance
380          * registers, and use those as initial defaults.
381          */
382         record_spr_defaults();
383
384         /*
385          * At this point, we can let interrupts switch to virtual mode
386          * (the MMU has been setup), so adjust the MSR in the PACA to
387          * have IR and DR set and enable AIL if it exists
388          */
389         cpu_ready_for_interrupts();
390
391         /*
392          * We enable ftrace here, but since we only support DYNAMIC_FTRACE, it
393          * will only actually get enabled on the boot cpu much later once
394          * ftrace itself has been initialized.
395          */
396         this_cpu_enable_ftrace();
397
398         udbg_printf(" <- %s()\n", __func__);
399
400 #ifdef CONFIG_PPC_EARLY_DEBUG_BOOTX
401         /*
402          * This needs to be done *last* (after the above udbg_printf() even)
403          *
404          * Right after we return from this function, we turn on the MMU
405          * which means the real-mode access trick that btext does will
406          * no longer work, it needs to switch to using a real MMU
407          * mapping. This call will ensure that it does
408          */
409         btext_map();
410 #endif /* CONFIG_PPC_EARLY_DEBUG_BOOTX */
411 }
412
413 #ifdef CONFIG_SMP
414 void early_setup_secondary(void)
415 {
416         /* Mark interrupts disabled in PACA */
417         irq_soft_mask_set(IRQS_DISABLED);
418
419         /* Initialize the hash table or TLB handling */
420         early_init_mmu_secondary();
421
422         /* Perform any KUP setup that is per-cpu */
423         setup_kup();
424
425         /*
426          * At this point, we can let interrupts switch to virtual mode
427          * (the MMU has been setup), so adjust the MSR in the PACA to
428          * have IR and DR set.
429          */
430         cpu_ready_for_interrupts();
431 }
432
433 #endif /* CONFIG_SMP */
434
435 void panic_smp_self_stop(void)
436 {
437         hard_irq_disable();
438         spin_begin();
439         while (1)
440                 spin_cpu_relax();
441 }
442
443 #if defined(CONFIG_SMP) || defined(CONFIG_KEXEC_CORE)
444 static bool use_spinloop(void)
445 {
446         if (IS_ENABLED(CONFIG_PPC_BOOK3S)) {
447                 /*
448                  * See comments in head_64.S -- not all platforms insert
449                  * secondaries at __secondary_hold and wait at the spin
450                  * loop.
451                  */
452                 if (firmware_has_feature(FW_FEATURE_OPAL))
453                         return false;
454                 return true;
455         }
456
457         /*
458          * When book3e boots from kexec, the ePAPR spin table does
459          * not get used.
460          */
461         return of_property_read_bool(of_chosen, "linux,booted-from-kexec");
462 }
463
464 void smp_release_cpus(void)
465 {
466         unsigned long *ptr;
467         int i;
468
469         if (!use_spinloop())
470                 return;
471
472         /* All secondary cpus are spinning on a common spinloop, release them
473          * all now so they can start to spin on their individual paca
474          * spinloops. For non SMP kernels, the secondary cpus never get out
475          * of the common spinloop.
476          */
477
478         ptr  = (unsigned long *)((unsigned long)&__secondary_hold_spinloop
479                         - PHYSICAL_START);
480         *ptr = ppc_function_entry(generic_secondary_smp_init);
481
482         /* And wait a bit for them to catch up */
483         for (i = 0; i < 100000; i++) {
484                 mb();
485                 HMT_low();
486                 if (spinning_secondaries == 0)
487                         break;
488                 udelay(1);
489         }
490         pr_debug("spinning_secondaries = %d\n", spinning_secondaries);
491 }
492 #endif /* CONFIG_SMP || CONFIG_KEXEC_CORE */
493
494 /*
495  * Initialize some remaining members of the ppc64_caches and systemcfg
496  * structures
497  * (at least until we get rid of them completely). This is mostly some
498  * cache informations about the CPU that will be used by cache flush
499  * routines and/or provided to userland
500  */
501
502 static void init_cache_info(struct ppc_cache_info *info, u32 size, u32 lsize,
503                             u32 bsize, u32 sets)
504 {
505         info->size = size;
506         info->sets = sets;
507         info->line_size = lsize;
508         info->block_size = bsize;
509         info->log_block_size = __ilog2(bsize);
510         if (bsize)
511                 info->blocks_per_page = PAGE_SIZE / bsize;
512         else
513                 info->blocks_per_page = 0;
514
515         if (sets == 0)
516                 info->assoc = 0xffff;
517         else
518                 info->assoc = size / (sets * lsize);
519 }
520
521 static bool __init parse_cache_info(struct device_node *np,
522                                     bool icache,
523                                     struct ppc_cache_info *info)
524 {
525         static const char *ipropnames[] __initdata = {
526                 "i-cache-size",
527                 "i-cache-sets",
528                 "i-cache-block-size",
529                 "i-cache-line-size",
530         };
531         static const char *dpropnames[] __initdata = {
532                 "d-cache-size",
533                 "d-cache-sets",
534                 "d-cache-block-size",
535                 "d-cache-line-size",
536         };
537         const char **propnames = icache ? ipropnames : dpropnames;
538         const __be32 *sizep, *lsizep, *bsizep, *setsp;
539         u32 size, lsize, bsize, sets;
540         bool success = true;
541
542         size = 0;
543         sets = -1u;
544         lsize = bsize = cur_cpu_spec->dcache_bsize;
545         sizep = of_get_property(np, propnames[0], NULL);
546         if (sizep != NULL)
547                 size = be32_to_cpu(*sizep);
548         setsp = of_get_property(np, propnames[1], NULL);
549         if (setsp != NULL)
550                 sets = be32_to_cpu(*setsp);
551         bsizep = of_get_property(np, propnames[2], NULL);
552         lsizep = of_get_property(np, propnames[3], NULL);
553         if (bsizep == NULL)
554                 bsizep = lsizep;
555         if (lsizep == NULL)
556                 lsizep = bsizep;
557         if (lsizep != NULL)
558                 lsize = be32_to_cpu(*lsizep);
559         if (bsizep != NULL)
560                 bsize = be32_to_cpu(*bsizep);
561         if (sizep == NULL || bsizep == NULL || lsizep == NULL)
562                 success = false;
563
564         /*
565          * OF is weird .. it represents fully associative caches
566          * as "1 way" which doesn't make much sense and doesn't
567          * leave room for direct mapped. We'll assume that 0
568          * in OF means direct mapped for that reason.
569          */
570         if (sets == 1)
571                 sets = 0;
572         else if (sets == 0)
573                 sets = 1;
574
575         init_cache_info(info, size, lsize, bsize, sets);
576
577         return success;
578 }
579
580 void __init initialize_cache_info(void)
581 {
582         struct device_node *cpu = NULL, *l2, *l3 = NULL;
583         u32 pvr;
584
585         /*
586          * All shipping POWER8 machines have a firmware bug that
587          * puts incorrect information in the device-tree. This will
588          * be (hopefully) fixed for future chips but for now hard
589          * code the values if we are running on one of these
590          */
591         pvr = PVR_VER(mfspr(SPRN_PVR));
592         if (pvr == PVR_POWER8 || pvr == PVR_POWER8E ||
593             pvr == PVR_POWER8NVL) {
594                                                 /* size    lsize   blk  sets */
595                 init_cache_info(&ppc64_caches.l1i, 0x8000,   128,  128, 32);
596                 init_cache_info(&ppc64_caches.l1d, 0x10000,  128,  128, 64);
597                 init_cache_info(&ppc64_caches.l2,  0x80000,  128,  0,   512);
598                 init_cache_info(&ppc64_caches.l3,  0x800000, 128,  0,   8192);
599         } else
600                 cpu = of_find_node_by_type(NULL, "cpu");
601
602         /*
603          * We're assuming *all* of the CPUs have the same
604          * d-cache and i-cache sizes... -Peter
605          */
606         if (cpu) {
607                 if (!parse_cache_info(cpu, false, &ppc64_caches.l1d))
608                         pr_warn("Argh, can't find dcache properties !\n");
609
610                 if (!parse_cache_info(cpu, true, &ppc64_caches.l1i))
611                         pr_warn("Argh, can't find icache properties !\n");
612
613                 /*
614                  * Try to find the L2 and L3 if any. Assume they are
615                  * unified and use the D-side properties.
616                  */
617                 l2 = of_find_next_cache_node(cpu);
618                 of_node_put(cpu);
619                 if (l2) {
620                         parse_cache_info(l2, false, &ppc64_caches.l2);
621                         l3 = of_find_next_cache_node(l2);
622                         of_node_put(l2);
623                 }
624                 if (l3) {
625                         parse_cache_info(l3, false, &ppc64_caches.l3);
626                         of_node_put(l3);
627                 }
628         }
629
630         /* For use by binfmt_elf */
631         dcache_bsize = ppc64_caches.l1d.block_size;
632         icache_bsize = ppc64_caches.l1i.block_size;
633
634         cur_cpu_spec->dcache_bsize = dcache_bsize;
635         cur_cpu_spec->icache_bsize = icache_bsize;
636 }
637
638 /*
639  * This returns the limit below which memory accesses to the linear
640  * mapping are guarnateed not to cause an architectural exception (e.g.,
641  * TLB or SLB miss fault).
642  *
643  * This is used to allocate PACAs and various interrupt stacks that
644  * that are accessed early in interrupt handlers that must not cause
645  * re-entrant interrupts.
646  */
647 __init u64 ppc64_bolted_size(void)
648 {
649 #ifdef CONFIG_PPC_BOOK3E
650         /* Freescale BookE bolts the entire linear mapping */
651         /* XXX: BookE ppc64_rma_limit setup seems to disagree? */
652         if (early_mmu_has_feature(MMU_FTR_TYPE_FSL_E))
653                 return linear_map_top;
654         /* Other BookE, we assume the first GB is bolted */
655         return 1ul << 30;
656 #else
657         /* BookS radix, does not take faults on linear mapping */
658         if (early_radix_enabled())
659                 return ULONG_MAX;
660
661         /* BookS hash, the first segment is bolted */
662         if (early_mmu_has_feature(MMU_FTR_1T_SEGMENT))
663                 return 1UL << SID_SHIFT_1T;
664         return 1UL << SID_SHIFT;
665 #endif
666 }
667
668 static void *__init alloc_stack(unsigned long limit, int cpu)
669 {
670         void *ptr;
671
672         BUILD_BUG_ON(STACK_INT_FRAME_SIZE % 16);
673
674         ptr = memblock_alloc_try_nid(THREAD_SIZE, THREAD_ALIGN,
675                                      MEMBLOCK_LOW_LIMIT, limit,
676                                      early_cpu_to_node(cpu));
677         if (!ptr)
678                 panic("cannot allocate stacks");
679
680         return ptr;
681 }
682
683 void __init irqstack_early_init(void)
684 {
685         u64 limit = ppc64_bolted_size();
686         unsigned int i;
687
688         /*
689          * Interrupt stacks must be in the first segment since we
690          * cannot afford to take SLB misses on them. They are not
691          * accessed in realmode.
692          */
693         for_each_possible_cpu(i) {
694                 softirq_ctx[i] = alloc_stack(limit, i);
695                 hardirq_ctx[i] = alloc_stack(limit, i);
696         }
697 }
698
699 #ifdef CONFIG_PPC_BOOK3E
700 void __init exc_lvl_early_init(void)
701 {
702         unsigned int i;
703
704         for_each_possible_cpu(i) {
705                 void *sp;
706
707                 sp = alloc_stack(ULONG_MAX, i);
708                 critirq_ctx[i] = sp;
709                 paca_ptrs[i]->crit_kstack = sp + THREAD_SIZE;
710
711                 sp = alloc_stack(ULONG_MAX, i);
712                 dbgirq_ctx[i] = sp;
713                 paca_ptrs[i]->dbg_kstack = sp + THREAD_SIZE;
714
715                 sp = alloc_stack(ULONG_MAX, i);
716                 mcheckirq_ctx[i] = sp;
717                 paca_ptrs[i]->mc_kstack = sp + THREAD_SIZE;
718         }
719
720         if (cpu_has_feature(CPU_FTR_DEBUG_LVL_EXC))
721                 patch_exception(0x040, exc_debug_debug_book3e);
722 }
723 #endif
724
725 /*
726  * Stack space used when we detect a bad kernel stack pointer, and
727  * early in SMP boots before relocation is enabled. Exclusive emergency
728  * stack for machine checks.
729  */
730 void __init emergency_stack_init(void)
731 {
732         u64 limit, mce_limit;
733         unsigned int i;
734
735         /*
736          * Emergency stacks must be under 256MB, we cannot afford to take
737          * SLB misses on them. The ABI also requires them to be 128-byte
738          * aligned.
739          *
740          * Since we use these as temporary stacks during secondary CPU
741          * bringup, machine check, system reset, and HMI, we need to get
742          * at them in real mode. This means they must also be within the RMO
743          * region.
744          *
745          * The IRQ stacks allocated elsewhere in this file are zeroed and
746          * initialized in kernel/irq.c. These are initialized here in order
747          * to have emergency stacks available as early as possible.
748          */
749         limit = mce_limit = min(ppc64_bolted_size(), ppc64_rma_size);
750
751         /*
752          * Machine check on pseries calls rtas, but can't use the static
753          * rtas_args due to a machine check hitting while the lock is held.
754          * rtas args have to be under 4GB, so the machine check stack is
755          * limited to 4GB so args can be put on stack.
756          */
757         if (firmware_has_feature(FW_FEATURE_LPAR) && mce_limit > SZ_4G)
758                 mce_limit = SZ_4G;
759
760         for_each_possible_cpu(i) {
761                 paca_ptrs[i]->emergency_sp = alloc_stack(limit, i) + THREAD_SIZE;
762
763 #ifdef CONFIG_PPC_BOOK3S_64
764                 /* emergency stack for NMI exception handling. */
765                 paca_ptrs[i]->nmi_emergency_sp = alloc_stack(limit, i) + THREAD_SIZE;
766
767                 /* emergency stack for machine check exception handling. */
768                 paca_ptrs[i]->mc_emergency_sp = alloc_stack(mce_limit, i) + THREAD_SIZE;
769 #endif
770         }
771 }
772
773 #ifdef CONFIG_SMP
774 /**
775  * pcpu_alloc_bootmem - NUMA friendly alloc_bootmem wrapper for percpu
776  * @cpu: cpu to allocate for
777  * @size: size allocation in bytes
778  * @align: alignment
779  *
780  * Allocate @size bytes aligned at @align for cpu @cpu.  This wrapper
781  * does the right thing for NUMA regardless of the current
782  * configuration.
783  *
784  * RETURNS:
785  * Pointer to the allocated area on success, NULL on failure.
786  */
787 static void * __init pcpu_alloc_bootmem(unsigned int cpu, size_t size,
788                                         size_t align)
789 {
790         const unsigned long goal = __pa(MAX_DMA_ADDRESS);
791 #ifdef CONFIG_NEED_MULTIPLE_NODES
792         int node = early_cpu_to_node(cpu);
793         void *ptr;
794
795         if (!node_online(node) || !NODE_DATA(node)) {
796                 ptr = memblock_alloc_from(size, align, goal);
797                 pr_info("cpu %d has no node %d or node-local memory\n",
798                         cpu, node);
799                 pr_debug("per cpu data for cpu%d %lu bytes at %016lx\n",
800                          cpu, size, __pa(ptr));
801         } else {
802                 ptr = memblock_alloc_try_nid(size, align, goal,
803                                              MEMBLOCK_ALLOC_ACCESSIBLE, node);
804                 pr_debug("per cpu data for cpu%d %lu bytes on node%d at "
805                          "%016lx\n", cpu, size, node, __pa(ptr));
806         }
807         return ptr;
808 #else
809         return memblock_alloc_from(size, align, goal);
810 #endif
811 }
812
813 static void __init pcpu_free_bootmem(void *ptr, size_t size)
814 {
815         memblock_free(__pa(ptr), size);
816 }
817
818 static int pcpu_cpu_distance(unsigned int from, unsigned int to)
819 {
820         if (early_cpu_to_node(from) == early_cpu_to_node(to))
821                 return LOCAL_DISTANCE;
822         else
823                 return REMOTE_DISTANCE;
824 }
825
826 unsigned long __per_cpu_offset[NR_CPUS] __read_mostly;
827 EXPORT_SYMBOL(__per_cpu_offset);
828
829 static void __init pcpu_populate_pte(unsigned long addr)
830 {
831         pgd_t *pgd = pgd_offset_k(addr);
832         p4d_t *p4d;
833         pud_t *pud;
834         pmd_t *pmd;
835
836         p4d = p4d_offset(pgd, addr);
837         if (p4d_none(*p4d)) {
838                 pud_t *new;
839
840                 new = memblock_alloc(PUD_TABLE_SIZE, PUD_TABLE_SIZE);
841                 if (!new)
842                         goto err_alloc;
843                 p4d_populate(&init_mm, p4d, new);
844         }
845
846         pud = pud_offset(p4d, addr);
847         if (pud_none(*pud)) {
848                 pmd_t *new;
849
850                 new = memblock_alloc(PMD_TABLE_SIZE, PMD_TABLE_SIZE);
851                 if (!new)
852                         goto err_alloc;
853                 pud_populate(&init_mm, pud, new);
854         }
855
856         pmd = pmd_offset(pud, addr);
857         if (!pmd_present(*pmd)) {
858                 pte_t *new;
859
860                 new = memblock_alloc(PTE_TABLE_SIZE, PTE_TABLE_SIZE);
861                 if (!new)
862                         goto err_alloc;
863                 pmd_populate_kernel(&init_mm, pmd, new);
864         }
865
866         return;
867
868 err_alloc:
869         panic("%s: Failed to allocate %lu bytes align=%lx from=%lx\n",
870               __func__, PAGE_SIZE, PAGE_SIZE, PAGE_SIZE);
871 }
872
873
874 void __init setup_per_cpu_areas(void)
875 {
876         const size_t dyn_size = PERCPU_MODULE_RESERVE + PERCPU_DYNAMIC_RESERVE;
877         size_t atom_size;
878         unsigned long delta;
879         unsigned int cpu;
880         int rc = -EINVAL;
881
882         /*
883          * Linear mapping is one of 4K, 1M and 16M.  For 4K, no need
884          * to group units.  For larger mappings, use 1M atom which
885          * should be large enough to contain a number of units.
886          */
887         if (mmu_linear_psize == MMU_PAGE_4K)
888                 atom_size = PAGE_SIZE;
889         else
890                 atom_size = 1 << 20;
891
892         if (pcpu_chosen_fc != PCPU_FC_PAGE) {
893                 rc = pcpu_embed_first_chunk(0, dyn_size, atom_size, pcpu_cpu_distance,
894                                             pcpu_alloc_bootmem, pcpu_free_bootmem);
895                 if (rc)
896                         pr_warn("PERCPU: %s allocator failed (%d), "
897                                 "falling back to page size\n",
898                                 pcpu_fc_names[pcpu_chosen_fc], rc);
899         }
900
901         if (rc < 0)
902                 rc = pcpu_page_first_chunk(0, pcpu_alloc_bootmem, pcpu_free_bootmem,
903                                            pcpu_populate_pte);
904         if (rc < 0)
905                 panic("cannot initialize percpu area (err=%d)", rc);
906
907         delta = (unsigned long)pcpu_base_addr - (unsigned long)__per_cpu_start;
908         for_each_possible_cpu(cpu) {
909                 __per_cpu_offset[cpu] = delta + pcpu_unit_offsets[cpu];
910                 paca_ptrs[cpu]->data_offset = __per_cpu_offset[cpu];
911         }
912 }
913 #endif
914
915 #ifdef CONFIG_MEMORY_HOTPLUG_SPARSE
916 unsigned long memory_block_size_bytes(void)
917 {
918         if (ppc_md.memory_block_size)
919                 return ppc_md.memory_block_size();
920
921         return MIN_MEMORY_BLOCK_SIZE;
922 }
923 #endif
924
925 #if defined(CONFIG_PPC_INDIRECT_PIO) || defined(CONFIG_PPC_INDIRECT_MMIO)
926 struct ppc_pci_io ppc_pci_io;
927 EXPORT_SYMBOL(ppc_pci_io);
928 #endif
929
930 #ifdef CONFIG_HARDLOCKUP_DETECTOR_PERF
931 u64 hw_nmi_get_sample_period(int watchdog_thresh)
932 {
933         return ppc_proc_freq * watchdog_thresh;
934 }
935 #endif
936
937 /*
938  * The perf based hardlockup detector breaks PMU event based branches, so
939  * disable it by default. Book3S has a soft-nmi hardlockup detector based
940  * on the decrementer interrupt, so it does not suffer from this problem.
941  *
942  * It is likely to get false positives in VM guests, so disable it there
943  * by default too.
944  */
945 static int __init disable_hardlockup_detector(void)
946 {
947 #ifdef CONFIG_HARDLOCKUP_DETECTOR_PERF
948         hardlockup_detector_disable();
949 #else
950         if (firmware_has_feature(FW_FEATURE_LPAR))
951                 hardlockup_detector_disable();
952 #endif
953
954         return 0;
955 }
956 early_initcall(disable_hardlockup_detector);