powerpc: Implement smp_release_cpus() in C not asm
[linux-2.6.git] / arch / powerpc / kernel / setup_64.c
1 /*
2  * 
3  * Common boot and setup code.
4  *
5  * Copyright (C) 2001 PPC64 Team, IBM Corp
6  *
7  *      This program is free software; you can redistribute it and/or
8  *      modify it under the terms of the GNU General Public License
9  *      as published by the Free Software Foundation; either version
10  *      2 of the License, or (at your option) any later version.
11  */
12
13 #undef DEBUG
14
15 #include <linux/config.h>
16 #include <linux/module.h>
17 #include <linux/string.h>
18 #include <linux/sched.h>
19 #include <linux/init.h>
20 #include <linux/kernel.h>
21 #include <linux/reboot.h>
22 #include <linux/delay.h>
23 #include <linux/initrd.h>
24 #include <linux/ide.h>
25 #include <linux/seq_file.h>
26 #include <linux/ioport.h>
27 #include <linux/console.h>
28 #include <linux/utsname.h>
29 #include <linux/tty.h>
30 #include <linux/root_dev.h>
31 #include <linux/notifier.h>
32 #include <linux/cpu.h>
33 #include <linux/unistd.h>
34 #include <linux/serial.h>
35 #include <linux/serial_8250.h>
36 #include <asm/io.h>
37 #include <asm/prom.h>
38 #include <asm/processor.h>
39 #include <asm/pgtable.h>
40 #include <asm/smp.h>
41 #include <asm/elf.h>
42 #include <asm/machdep.h>
43 #include <asm/paca.h>
44 #include <asm/ppcdebug.h>
45 #include <asm/time.h>
46 #include <asm/cputable.h>
47 #include <asm/sections.h>
48 #include <asm/btext.h>
49 #include <asm/nvram.h>
50 #include <asm/setup.h>
51 #include <asm/system.h>
52 #include <asm/rtas.h>
53 #include <asm/iommu.h>
54 #include <asm/serial.h>
55 #include <asm/cache.h>
56 #include <asm/page.h>
57 #include <asm/mmu.h>
58 #include <asm/lmb.h>
59 #include <asm/iseries/it_lp_naca.h>
60 #include <asm/firmware.h>
61 #include <asm/systemcfg.h>
62 #include <asm/xmon.h>
63
64 #ifdef DEBUG
65 #define DBG(fmt...) udbg_printf(fmt)
66 #else
67 #define DBG(fmt...)
68 #endif
69
70 /*
71  * Here are some early debugging facilities. You can enable one
72  * but your kernel will not boot on anything else if you do so
73  */
74
75 /* This one is for use on LPAR machines that support an HVC console
76  * on vterm 0
77  */
78 extern void udbg_init_debug_lpar(void);
79 /* This one is for use on Apple G5 machines
80  */
81 extern void udbg_init_pmac_realmode(void);
82 /* That's RTAS panel debug */
83 extern void call_rtas_display_status_delay(unsigned char c);
84 /* Here's maple real mode debug */
85 extern void udbg_init_maple_realmode(void);
86
87 #define EARLY_DEBUG_INIT() do {} while(0)
88
89 #if 0
90 #define EARLY_DEBUG_INIT() udbg_init_debug_lpar()
91 #define EARLY_DEBUG_INIT() udbg_init_maple_realmode()
92 #define EARLY_DEBUG_INIT() udbg_init_pmac_realmode()
93 #define EARLY_DEBUG_INIT()                                              \
94         do { udbg_putc = call_rtas_display_status_delay; } while(0)
95 #endif
96
97 /* extern void *stab; */
98 extern unsigned long klimit;
99
100 extern void mm_init_ppc64(void);
101 extern void stab_initialize(unsigned long stab);
102 extern void htab_initialize(void);
103 extern void early_init_devtree(void *flat_dt);
104 extern void unflatten_device_tree(void);
105
106 int have_of = 1;
107 int boot_cpuid = 0;
108 int boot_cpuid_phys = 0;
109 dev_t boot_dev;
110 u64 ppc64_pft_size;
111
112 struct ppc64_caches ppc64_caches;
113 EXPORT_SYMBOL_GPL(ppc64_caches);
114
115 /*
116  * These are used in binfmt_elf.c to put aux entries on the stack
117  * for each elf executable being started.
118  */
119 int dcache_bsize;
120 int icache_bsize;
121 int ucache_bsize;
122
123 /* The main machine-dep calls structure
124  */
125 struct machdep_calls ppc_md;
126 EXPORT_SYMBOL(ppc_md);
127
128 #ifdef CONFIG_MAGIC_SYSRQ
129 unsigned long SYSRQ_KEY;
130 #endif /* CONFIG_MAGIC_SYSRQ */
131
132
133 static int ppc64_panic_event(struct notifier_block *, unsigned long, void *);
134 static struct notifier_block ppc64_panic_block = {
135         .notifier_call = ppc64_panic_event,
136         .priority = INT_MIN /* may not return; must be done last */
137 };
138
139 #ifdef CONFIG_SMP
140
141 static int smt_enabled_cmdline;
142
143 /* Look for ibm,smt-enabled OF option */
144 static void check_smt_enabled(void)
145 {
146         struct device_node *dn;
147         char *smt_option;
148
149         /* Allow the command line to overrule the OF option */
150         if (smt_enabled_cmdline)
151                 return;
152
153         dn = of_find_node_by_path("/options");
154
155         if (dn) {
156                 smt_option = (char *)get_property(dn, "ibm,smt-enabled", NULL);
157
158                 if (smt_option) {
159                         if (!strcmp(smt_option, "on"))
160                                 smt_enabled_at_boot = 1;
161                         else if (!strcmp(smt_option, "off"))
162                                 smt_enabled_at_boot = 0;
163                 }
164         }
165 }
166
167 /* Look for smt-enabled= cmdline option */
168 static int __init early_smt_enabled(char *p)
169 {
170         smt_enabled_cmdline = 1;
171
172         if (!p)
173                 return 0;
174
175         if (!strcmp(p, "on") || !strcmp(p, "1"))
176                 smt_enabled_at_boot = 1;
177         else if (!strcmp(p, "off") || !strcmp(p, "0"))
178                 smt_enabled_at_boot = 0;
179
180         return 0;
181 }
182 early_param("smt-enabled", early_smt_enabled);
183
184 /**
185  * setup_cpu_maps - initialize the following cpu maps:
186  *                  cpu_possible_map
187  *                  cpu_present_map
188  *                  cpu_sibling_map
189  *
190  * Having the possible map set up early allows us to restrict allocations
191  * of things like irqstacks to num_possible_cpus() rather than NR_CPUS.
192  *
193  * We do not initialize the online map here; cpus set their own bits in
194  * cpu_online_map as they come up.
195  *
196  * This function is valid only for Open Firmware systems.  finish_device_tree
197  * must be called before using this.
198  *
199  * While we're here, we may as well set the "physical" cpu ids in the paca.
200  */
201 static void __init setup_cpu_maps(void)
202 {
203         struct device_node *dn = NULL;
204         int cpu = 0;
205         int swap_cpuid = 0;
206
207         check_smt_enabled();
208
209         while ((dn = of_find_node_by_type(dn, "cpu")) && cpu < NR_CPUS) {
210                 u32 *intserv;
211                 int j, len = sizeof(u32), nthreads;
212
213                 intserv = (u32 *)get_property(dn, "ibm,ppc-interrupt-server#s",
214                                               &len);
215                 if (!intserv)
216                         intserv = (u32 *)get_property(dn, "reg", NULL);
217
218                 nthreads = len / sizeof(u32);
219
220                 for (j = 0; j < nthreads && cpu < NR_CPUS; j++) {
221                         cpu_set(cpu, cpu_present_map);
222                         set_hard_smp_processor_id(cpu, intserv[j]);
223
224                         if (intserv[j] == boot_cpuid_phys)
225                                 swap_cpuid = cpu;
226                         cpu_set(cpu, cpu_possible_map);
227                         cpu++;
228                 }
229         }
230
231         /* Swap CPU id 0 with boot_cpuid_phys, so we can always assume that
232          * boot cpu is logical 0.
233          */
234         if (boot_cpuid_phys != get_hard_smp_processor_id(0)) {
235                 u32 tmp;
236                 tmp = get_hard_smp_processor_id(0);
237                 set_hard_smp_processor_id(0, boot_cpuid_phys);
238                 set_hard_smp_processor_id(swap_cpuid, tmp);
239         }
240
241         /*
242          * On pSeries LPAR, we need to know how many cpus
243          * could possibly be added to this partition.
244          */
245         if (systemcfg->platform == PLATFORM_PSERIES_LPAR &&
246                                 (dn = of_find_node_by_path("/rtas"))) {
247                 int num_addr_cell, num_size_cell, maxcpus;
248                 unsigned int *ireg;
249
250                 num_addr_cell = prom_n_addr_cells(dn);
251                 num_size_cell = prom_n_size_cells(dn);
252
253                 ireg = (unsigned int *)
254                         get_property(dn, "ibm,lrdr-capacity", NULL);
255
256                 if (!ireg)
257                         goto out;
258
259                 maxcpus = ireg[num_addr_cell + num_size_cell];
260
261                 /* Double maxcpus for processors which have SMT capability */
262                 if (cpu_has_feature(CPU_FTR_SMT))
263                         maxcpus *= 2;
264
265                 if (maxcpus > NR_CPUS) {
266                         printk(KERN_WARNING
267                                "Partition configured for %d cpus, "
268                                "operating system maximum is %d.\n",
269                                maxcpus, NR_CPUS);
270                         maxcpus = NR_CPUS;
271                 } else
272                         printk(KERN_INFO "Partition configured for %d cpus.\n",
273                                maxcpus);
274
275                 for (cpu = 0; cpu < maxcpus; cpu++)
276                         cpu_set(cpu, cpu_possible_map);
277         out:
278                 of_node_put(dn);
279         }
280
281         /*
282          * Do the sibling map; assume only two threads per processor.
283          */
284         for_each_cpu(cpu) {
285                 cpu_set(cpu, cpu_sibling_map[cpu]);
286                 if (cpu_has_feature(CPU_FTR_SMT))
287                         cpu_set(cpu ^ 0x1, cpu_sibling_map[cpu]);
288         }
289
290         systemcfg->processorCount = num_present_cpus();
291 }
292 #endif /* CONFIG_SMP */
293
294 extern struct machdep_calls pSeries_md;
295 extern struct machdep_calls pmac_md;
296 extern struct machdep_calls maple_md;
297 extern struct machdep_calls cell_md;
298 extern struct machdep_calls iseries_md;
299
300 /* Ultimately, stuff them in an elf section like initcalls... */
301 static struct machdep_calls __initdata *machines[] = {
302 #ifdef CONFIG_PPC_PSERIES
303         &pSeries_md,
304 #endif /* CONFIG_PPC_PSERIES */
305 #ifdef CONFIG_PPC_PMAC
306         &pmac_md,
307 #endif /* CONFIG_PPC_PMAC */
308 #ifdef CONFIG_PPC_MAPLE
309         &maple_md,
310 #endif /* CONFIG_PPC_MAPLE */
311 #ifdef CONFIG_PPC_CELL
312         &cell_md,
313 #endif
314 #ifdef CONFIG_PPC_ISERIES
315         &iseries_md,
316 #endif
317         NULL
318 };
319
320 /*
321  * Early initialization entry point. This is called by head.S
322  * with MMU translation disabled. We rely on the "feature" of
323  * the CPU that ignores the top 2 bits of the address in real
324  * mode so we can access kernel globals normally provided we
325  * only toy with things in the RMO region. From here, we do
326  * some early parsing of the device-tree to setup out LMB
327  * data structures, and allocate & initialize the hash table
328  * and segment tables so we can start running with translation
329  * enabled.
330  *
331  * It is this function which will call the probe() callback of
332  * the various platform types and copy the matching one to the
333  * global ppc_md structure. Your platform can eventually do
334  * some very early initializations from the probe() routine, but
335  * this is not recommended, be very careful as, for example, the
336  * device-tree is not accessible via normal means at this point.
337  */
338
339 void __init early_setup(unsigned long dt_ptr)
340 {
341         struct paca_struct *lpaca = get_paca();
342         static struct machdep_calls **mach;
343
344         /*
345          * Enable early debugging if any specified (see top of
346          * this file)
347          */
348         EARLY_DEBUG_INIT();
349
350         DBG(" -> early_setup()\n");
351
352         /*
353          * Fill the default DBG level (do we want to keep
354          * that old mecanism around forever ?)
355          */
356         ppcdbg_initialize();
357
358         /*
359          * Do early initializations using the flattened device
360          * tree, like retreiving the physical memory map or
361          * calculating/retreiving the hash table size
362          */
363         early_init_devtree(__va(dt_ptr));
364
365         /*
366          * Iterate all ppc_md structures until we find the proper
367          * one for the current machine type
368          */
369         DBG("Probing machine type for platform %x...\n",
370             systemcfg->platform);
371
372         for (mach = machines; *mach; mach++) {
373                 if ((*mach)->probe(systemcfg->platform))
374                         break;
375         }
376         /* What can we do if we didn't find ? */
377         if (*mach == NULL) {
378                 DBG("No suitable machine found !\n");
379                 for (;;);
380         }
381         ppc_md = **mach;
382
383         DBG("Found, Initializing memory management...\n");
384
385         /*
386          * Initialize stab / SLB management
387          */
388         if (!firmware_has_feature(FW_FEATURE_ISERIES))
389                 stab_initialize(lpaca->stab_real);
390
391         /*
392          * Initialize the MMU Hash table and create the linear mapping
393          * of memory
394          */
395         htab_initialize();
396
397         DBG(" <- early_setup()\n");
398 }
399
400
401 #if defined(CONFIG_SMP) || defined(CONFIG_KEXEC)
402 void smp_release_cpus(void)
403 {
404         extern unsigned long __secondary_hold_spinloop;
405
406         DBG(" -> smp_release_cpus()\n");
407
408         /* All secondary cpus are spinning on a common spinloop, release them
409          * all now so they can start to spin on their individual paca
410          * spinloops. For non SMP kernels, the secondary cpus never get out
411          * of the common spinloop.
412          * This is useless but harmless on iSeries, secondaries are already
413          * waiting on their paca spinloops. */
414
415         __secondary_hold_spinloop = 1;
416         mb();
417
418         DBG(" <- smp_release_cpus()\n");
419 }
420 #endif /* CONFIG_SMP || CONFIG_KEXEC */
421
422 /*
423  * Initialize some remaining members of the ppc64_caches and systemcfg structures
424  * (at least until we get rid of them completely). This is mostly some
425  * cache informations about the CPU that will be used by cache flush
426  * routines and/or provided to userland
427  */
428 static void __init initialize_cache_info(void)
429 {
430         struct device_node *np;
431         unsigned long num_cpus = 0;
432
433         DBG(" -> initialize_cache_info()\n");
434
435         for (np = NULL; (np = of_find_node_by_type(np, "cpu"));) {
436                 num_cpus += 1;
437
438                 /* We're assuming *all* of the CPUs have the same
439                  * d-cache and i-cache sizes... -Peter
440                  */
441
442                 if ( num_cpus == 1 ) {
443                         u32 *sizep, *lsizep;
444                         u32 size, lsize;
445                         const char *dc, *ic;
446
447                         /* Then read cache informations */
448                         if (systemcfg->platform == PLATFORM_POWERMAC) {
449                                 dc = "d-cache-block-size";
450                                 ic = "i-cache-block-size";
451                         } else {
452                                 dc = "d-cache-line-size";
453                                 ic = "i-cache-line-size";
454                         }
455
456                         size = 0;
457                         lsize = cur_cpu_spec->dcache_bsize;
458                         sizep = (u32 *)get_property(np, "d-cache-size", NULL);
459                         if (sizep != NULL)
460                                 size = *sizep;
461                         lsizep = (u32 *) get_property(np, dc, NULL);
462                         if (lsizep != NULL)
463                                 lsize = *lsizep;
464                         if (sizep == 0 || lsizep == 0)
465                                 DBG("Argh, can't find dcache properties ! "
466                                     "sizep: %p, lsizep: %p\n", sizep, lsizep);
467
468                         systemcfg->dcache_size = ppc64_caches.dsize = size;
469                         systemcfg->dcache_line_size =
470                                 ppc64_caches.dline_size = lsize;
471                         ppc64_caches.log_dline_size = __ilog2(lsize);
472                         ppc64_caches.dlines_per_page = PAGE_SIZE / lsize;
473
474                         size = 0;
475                         lsize = cur_cpu_spec->icache_bsize;
476                         sizep = (u32 *)get_property(np, "i-cache-size", NULL);
477                         if (sizep != NULL)
478                                 size = *sizep;
479                         lsizep = (u32 *)get_property(np, ic, NULL);
480                         if (lsizep != NULL)
481                                 lsize = *lsizep;
482                         if (sizep == 0 || lsizep == 0)
483                                 DBG("Argh, can't find icache properties ! "
484                                     "sizep: %p, lsizep: %p\n", sizep, lsizep);
485
486                         systemcfg->icache_size = ppc64_caches.isize = size;
487                         systemcfg->icache_line_size =
488                                 ppc64_caches.iline_size = lsize;
489                         ppc64_caches.log_iline_size = __ilog2(lsize);
490                         ppc64_caches.ilines_per_page = PAGE_SIZE / lsize;
491                 }
492         }
493
494         /* Add an eye catcher and the systemcfg layout version number */
495         strcpy(systemcfg->eye_catcher, "SYSTEMCFG:PPC64");
496         systemcfg->version.major = SYSTEMCFG_MAJOR;
497         systemcfg->version.minor = SYSTEMCFG_MINOR;
498         systemcfg->processor = mfspr(SPRN_PVR);
499
500         DBG(" <- initialize_cache_info()\n");
501 }
502
503 static void __init check_for_initrd(void)
504 {
505 #ifdef CONFIG_BLK_DEV_INITRD
506         u64 *prop;
507
508         DBG(" -> check_for_initrd()\n");
509
510         if (of_chosen) {
511                 prop = (u64 *)get_property(of_chosen,
512                                 "linux,initrd-start", NULL);
513                 if (prop != NULL) {
514                         initrd_start = (unsigned long)__va(*prop);
515                         prop = (u64 *)get_property(of_chosen,
516                                         "linux,initrd-end", NULL);
517                         if (prop != NULL) {
518                                 initrd_end = (unsigned long)__va(*prop);
519                                 initrd_below_start_ok = 1;
520                         } else
521                                 initrd_start = 0;
522                 }
523         }
524
525         /* If we were passed an initrd, set the ROOT_DEV properly if the values
526          * look sensible. If not, clear initrd reference.
527          */
528         if (initrd_start >= KERNELBASE && initrd_end >= KERNELBASE &&
529             initrd_end > initrd_start)
530                 ROOT_DEV = Root_RAM0;
531         else
532                 initrd_start = initrd_end = 0;
533
534         if (initrd_start)
535                 printk("Found initrd at 0x%lx:0x%lx\n", initrd_start, initrd_end);
536
537         DBG(" <- check_for_initrd()\n");
538 #endif /* CONFIG_BLK_DEV_INITRD */
539 }
540
541 /*
542  * Do some initial setup of the system.  The parameters are those which 
543  * were passed in from the bootloader.
544  */
545 void __init setup_system(void)
546 {
547         DBG(" -> setup_system()\n");
548
549         /*
550          * Unflatten the device-tree passed by prom_init or kexec
551          */
552         unflatten_device_tree();
553
554         /*
555          * Fill the ppc64_caches & systemcfg structures with informations
556          * retreived from the device-tree. Need to be called before
557          * finish_device_tree() since the later requires some of the
558          * informations filled up here to properly parse the interrupt
559          * tree.
560          * It also sets up the cache line sizes which allows to call
561          * routines like flush_icache_range (used by the hash init
562          * later on).
563          */
564         initialize_cache_info();
565
566 #ifdef CONFIG_PPC_RTAS
567         /*
568          * Initialize RTAS if available
569          */
570         rtas_initialize();
571 #endif /* CONFIG_PPC_RTAS */
572
573         /*
574          * Check if we have an initrd provided via the device-tree
575          */
576         check_for_initrd();
577
578         /*
579          * Do some platform specific early initializations, that includes
580          * setting up the hash table pointers. It also sets up some interrupt-mapping
581          * related options that will be used by finish_device_tree()
582          */
583         ppc_md.init_early();
584
585         /*
586          * "Finish" the device-tree, that is do the actual parsing of
587          * some of the properties like the interrupt map
588          */
589         finish_device_tree();
590
591 #ifdef CONFIG_BOOTX_TEXT
592         init_boot_display();
593 #endif
594
595         /*
596          * Initialize xmon
597          */
598 #ifdef CONFIG_XMON_DEFAULT
599         xmon_init(1);
600 #endif
601         /*
602          * Register early console
603          */
604         register_early_udbg_console();
605
606         /* Save unparsed command line copy for /proc/cmdline */
607         strlcpy(saved_command_line, cmd_line, COMMAND_LINE_SIZE);
608
609         parse_early_param();
610
611 #ifdef CONFIG_SMP
612         /*
613          * iSeries has already initialized the cpu maps at this point.
614          */
615         setup_cpu_maps();
616
617         /* Release secondary cpus out of their spinloops at 0x60 now that
618          * we can map physical -> logical CPU ids
619          */
620         smp_release_cpus();
621 #endif
622
623         printk("Starting Linux PPC64 %s\n", system_utsname.version);
624
625         printk("-----------------------------------------------------\n");
626         printk("ppc64_pft_size                = 0x%lx\n", ppc64_pft_size);
627         printk("ppc64_debug_switch            = 0x%lx\n", ppc64_debug_switch);
628         printk("ppc64_interrupt_controller    = 0x%ld\n", ppc64_interrupt_controller);
629         printk("systemcfg                     = 0x%p\n", systemcfg);
630         printk("systemcfg->platform           = 0x%x\n", systemcfg->platform);
631         printk("systemcfg->processorCount     = 0x%lx\n", systemcfg->processorCount);
632         printk("systemcfg->physicalMemorySize = 0x%lx\n", systemcfg->physicalMemorySize);
633         printk("ppc64_caches.dcache_line_size = 0x%x\n",
634                         ppc64_caches.dline_size);
635         printk("ppc64_caches.icache_line_size = 0x%x\n",
636                         ppc64_caches.iline_size);
637         printk("htab_address                  = 0x%p\n", htab_address);
638         printk("htab_hash_mask                = 0x%lx\n", htab_hash_mask);
639         printk("-----------------------------------------------------\n");
640
641         mm_init_ppc64();
642
643         DBG(" <- setup_system()\n");
644 }
645
646 static int ppc64_panic_event(struct notifier_block *this,
647                              unsigned long event, void *ptr)
648 {
649         ppc_md.panic((char *)ptr);  /* May not return */
650         return NOTIFY_DONE;
651 }
652
653 #ifdef CONFIG_IRQSTACKS
654 static void __init irqstack_early_init(void)
655 {
656         unsigned int i;
657
658         /*
659          * interrupt stacks must be under 256MB, we cannot afford to take
660          * SLB misses on them.
661          */
662         for_each_cpu(i) {
663                 softirq_ctx[i] = (struct thread_info *)__va(lmb_alloc_base(THREAD_SIZE,
664                                         THREAD_SIZE, 0x10000000));
665                 hardirq_ctx[i] = (struct thread_info *)__va(lmb_alloc_base(THREAD_SIZE,
666                                         THREAD_SIZE, 0x10000000));
667         }
668 }
669 #else
670 #define irqstack_early_init()
671 #endif
672
673 /*
674  * Stack space used when we detect a bad kernel stack pointer, and
675  * early in SMP boots before relocation is enabled.
676  */
677 static void __init emergency_stack_init(void)
678 {
679         unsigned long limit;
680         unsigned int i;
681
682         /*
683          * Emergency stacks must be under 256MB, we cannot afford to take
684          * SLB misses on them. The ABI also requires them to be 128-byte
685          * aligned.
686          *
687          * Since we use these as temporary stacks during secondary CPU
688          * bringup, we need to get at them in real mode. This means they
689          * must also be within the RMO region.
690          */
691         limit = min(0x10000000UL, lmb.rmo_size);
692
693         for_each_cpu(i)
694                 paca[i].emergency_sp = __va(lmb_alloc_base(PAGE_SIZE, 128,
695                                                 limit)) + PAGE_SIZE;
696 }
697
698 /*
699  * Called from setup_arch to initialize the bitmap of available
700  * syscalls in the systemcfg page
701  */
702 void __init setup_syscall_map(void)
703 {
704         unsigned int i, count64 = 0, count32 = 0;
705         extern unsigned long *sys_call_table;
706         extern unsigned long sys_ni_syscall;
707
708
709         for (i = 0; i < __NR_syscalls; i++) {
710                 if (sys_call_table[i*2] != sys_ni_syscall) {
711                         count64++;
712                         systemcfg->syscall_map_64[i >> 5] |=
713                                 0x80000000UL >> (i & 0x1f);
714                 }
715                 if (sys_call_table[i*2+1] != sys_ni_syscall) {
716                         count32++;
717                         systemcfg->syscall_map_32[i >> 5] |=
718                                 0x80000000UL >> (i & 0x1f);
719                 }
720         }
721         printk(KERN_INFO "Syscall map setup, %d 32-bit and %d 64-bit syscalls\n",
722                count32, count64);
723 }
724
725 /*
726  * Called into from start_kernel, after lock_kernel has been called.
727  * Initializes bootmem, which is unsed to manage page allocation until
728  * mem_init is called.
729  */
730 void __init setup_arch(char **cmdline_p)
731 {
732         extern void do_init_bootmem(void);
733
734         ppc64_boot_msg(0x12, "Setup Arch");
735
736         *cmdline_p = cmd_line;
737
738         /*
739          * Set cache line size based on type of cpu as a default.
740          * Systems with OF can look in the properties on the cpu node(s)
741          * for a possibly more accurate value.
742          */
743         dcache_bsize = ppc64_caches.dline_size;
744         icache_bsize = ppc64_caches.iline_size;
745
746         /* reboot on panic */
747         panic_timeout = 180;
748
749         if (ppc_md.panic)
750                 notifier_chain_register(&panic_notifier_list, &ppc64_panic_block);
751
752         init_mm.start_code = PAGE_OFFSET;
753         init_mm.end_code = (unsigned long) _etext;
754         init_mm.end_data = (unsigned long) _edata;
755         init_mm.brk = klimit;
756         
757         irqstack_early_init();
758         emergency_stack_init();
759
760         stabs_alloc();
761
762         /* set up the bootmem stuff with available memory */
763         do_init_bootmem();
764         sparse_init();
765
766         /* initialize the syscall map in systemcfg */
767         setup_syscall_map();
768
769 #ifdef CONFIG_DUMMY_CONSOLE
770         conswitchp = &dummy_con;
771 #endif
772
773         ppc_md.setup_arch();
774
775         /* Use the default idle loop if the platform hasn't provided one. */
776         if (NULL == ppc_md.idle_loop) {
777                 ppc_md.idle_loop = default_idle;
778                 printk(KERN_INFO "Using default idle loop\n");
779         }
780
781         paging_init();
782         ppc64_boot_msg(0x15, "Setup Done");
783 }
784
785
786 /* ToDo: do something useful if ppc_md is not yet setup. */
787 #define PPC64_LINUX_FUNCTION 0x0f000000
788 #define PPC64_IPL_MESSAGE 0xc0000000
789 #define PPC64_TERM_MESSAGE 0xb0000000
790
791 static void ppc64_do_msg(unsigned int src, const char *msg)
792 {
793         if (ppc_md.progress) {
794                 char buf[128];
795
796                 sprintf(buf, "%08X\n", src);
797                 ppc_md.progress(buf, 0);
798                 snprintf(buf, 128, "%s", msg);
799                 ppc_md.progress(buf, 0);
800         }
801 }
802
803 /* Print a boot progress message. */
804 void ppc64_boot_msg(unsigned int src, const char *msg)
805 {
806         ppc64_do_msg(PPC64_LINUX_FUNCTION|PPC64_IPL_MESSAGE|src, msg);
807         printk("[boot]%04x %s\n", src, msg);
808 }
809
810 /* Print a termination message (print only -- does not stop the kernel) */
811 void ppc64_terminate_msg(unsigned int src, const char *msg)
812 {
813         ppc64_do_msg(PPC64_LINUX_FUNCTION|PPC64_TERM_MESSAGE|src, msg);
814         printk("[terminate]%04x %s\n", src, msg);
815 }
816
817 #ifndef CONFIG_PPC_ISERIES
818 /*
819  * This function can be used by platforms to "find" legacy serial ports.
820  * It works for "serial" nodes under an "isa" node, and will try to
821  * respect the "ibm,aix-loc" property if any. It works with up to 8
822  * ports.
823  */
824
825 #define MAX_LEGACY_SERIAL_PORTS 8
826 static struct plat_serial8250_port serial_ports[MAX_LEGACY_SERIAL_PORTS+1];
827 static unsigned int old_serial_count;
828
829 void __init generic_find_legacy_serial_ports(u64 *physport,
830                 unsigned int *default_speed)
831 {
832         struct device_node *np;
833         u32 *sizeprop;
834
835         struct isa_reg_property {
836                 u32 space;
837                 u32 address;
838                 u32 size;
839         };
840         struct pci_reg_property {
841                 struct pci_address addr;
842                 u32 size_hi;
843                 u32 size_lo;
844         };                                                                        
845
846         DBG(" -> generic_find_legacy_serial_port()\n");
847
848         *physport = 0;
849         if (default_speed)
850                 *default_speed = 0;
851
852         np = of_find_node_by_path("/");
853         if (!np)
854                 return;
855
856         /* First fill our array */
857         for (np = NULL; (np = of_find_node_by_type(np, "serial"));) {
858                 struct device_node *isa, *pci;
859                 struct isa_reg_property *reg;
860                 unsigned long phys_size, addr_size, io_base;
861                 u32 *rangesp;
862                 u32 *interrupts, *clk, *spd;
863                 char *typep;
864                 int index, rlen, rentsize;
865
866                 /* Ok, first check if it's under an "isa" parent */
867                 isa = of_get_parent(np);
868                 if (!isa || strcmp(isa->name, "isa")) {
869                         DBG("%s: no isa parent found\n", np->full_name);
870                         continue;
871                 }
872                 
873                 /* Now look for an "ibm,aix-loc" property that gives us ordering
874                  * if any...
875                  */
876                 typep = (char *)get_property(np, "ibm,aix-loc", NULL);
877
878                 /* Get the ISA port number */
879                 reg = (struct isa_reg_property *)get_property(np, "reg", NULL); 
880                 if (reg == NULL)
881                         goto next_port;
882                 /* We assume the interrupt number isn't translated ... */
883                 interrupts = (u32 *)get_property(np, "interrupts", NULL);
884                 /* get clock freq. if present */
885                 clk = (u32 *)get_property(np, "clock-frequency", NULL);
886                 /* get default speed if present */
887                 spd = (u32 *)get_property(np, "current-speed", NULL);
888                 /* Default to locate at end of array */
889                 index = old_serial_count; /* end of the array by default */
890
891                 /* If we have a location index, then use it */
892                 if (typep && *typep == 'S') {
893                         index = simple_strtol(typep+1, NULL, 0) - 1;
894                         /* if index is out of range, use end of array instead */
895                         if (index >= MAX_LEGACY_SERIAL_PORTS)
896                                 index = old_serial_count;
897                         /* if our index is still out of range, that mean that
898                          * array is full, we could scan for a free slot but that
899                          * make little sense to bother, just skip the port
900                          */
901                         if (index >= MAX_LEGACY_SERIAL_PORTS)
902                                 goto next_port;
903                         if (index >= old_serial_count)
904                                 old_serial_count = index + 1;
905                         /* Check if there is a port who already claimed our slot */
906                         if (serial_ports[index].iobase != 0) {
907                                 /* if we still have some room, move it, else override */
908                                 if (old_serial_count < MAX_LEGACY_SERIAL_PORTS) {
909                                         DBG("Moved legacy port %d -> %d\n", index,
910                                             old_serial_count);
911                                         serial_ports[old_serial_count++] =
912                                                 serial_ports[index];
913                                 } else {
914                                         DBG("Replacing legacy port %d\n", index);
915                                 }
916                         }
917                 }
918                 if (index >= MAX_LEGACY_SERIAL_PORTS)
919                         goto next_port;
920                 if (index >= old_serial_count)
921                         old_serial_count = index + 1;
922
923                 /* Now fill the entry */
924                 memset(&serial_ports[index], 0, sizeof(struct plat_serial8250_port));
925                 serial_ports[index].uartclk = clk ? *clk : BASE_BAUD * 16;
926                 serial_ports[index].iobase = reg->address;
927                 serial_ports[index].irq = interrupts ? interrupts[0] : 0;
928                 serial_ports[index].flags = ASYNC_BOOT_AUTOCONF;
929
930                 DBG("Added legacy port, index: %d, port: %x, irq: %d, clk: %d\n",
931                     index,
932                     serial_ports[index].iobase,
933                     serial_ports[index].irq,
934                     serial_ports[index].uartclk);
935
936                 /* Get phys address of IO reg for port 1 */
937                 if (index != 0)
938                         goto next_port;
939
940                 pci = of_get_parent(isa);
941                 if (!pci) {
942                         DBG("%s: no pci parent found\n", np->full_name);
943                         goto next_port;
944                 }
945
946                 rangesp = (u32 *)get_property(pci, "ranges", &rlen);
947                 if (rangesp == NULL) {
948                         of_node_put(pci);
949                         goto next_port;
950                 }
951                 rlen /= 4;
952
953                 /* we need the #size-cells of the PCI bridge node itself */
954                 phys_size = 1;
955                 sizeprop = (u32 *)get_property(pci, "#size-cells", NULL);
956                 if (sizeprop != NULL)
957                         phys_size = *sizeprop;
958                 /* we need the parent #addr-cells */
959                 addr_size = prom_n_addr_cells(pci);
960                 rentsize = 3 + addr_size + phys_size;
961                 io_base = 0;
962                 for (;rlen >= rentsize; rlen -= rentsize,rangesp += rentsize) {
963                         if (((rangesp[0] >> 24) & 0x3) != 1)
964                                 continue; /* not IO space */
965                         io_base = rangesp[3];
966                         if (addr_size == 2)
967                                 io_base = (io_base << 32) | rangesp[4];
968                 }
969                 if (io_base != 0) {
970                         *physport = io_base + reg->address;
971                         if (default_speed && spd)
972                                 *default_speed = *spd;
973                 }
974                 of_node_put(pci);
975         next_port:
976                 of_node_put(isa);
977         }
978
979         DBG(" <- generic_find_legacy_serial_port()\n");
980 }
981
982 static struct platform_device serial_device = {
983         .name   = "serial8250",
984         .id     = PLAT8250_DEV_PLATFORM,
985         .dev    = {
986                 .platform_data = serial_ports,
987         },
988 };
989
990 static int __init serial_dev_init(void)
991 {
992         return platform_device_register(&serial_device);
993 }
994 arch_initcall(serial_dev_init);
995
996 #endif /* CONFIG_PPC_ISERIES */
997
998 int check_legacy_ioport(unsigned long base_port)
999 {
1000         if (ppc_md.check_legacy_ioport == NULL)
1001                 return 0;
1002         return ppc_md.check_legacy_ioport(base_port);
1003 }
1004 EXPORT_SYMBOL(check_legacy_ioport);
1005
1006 #ifdef CONFIG_XMON
1007 static int __init early_xmon(char *p)
1008 {
1009         /* ensure xmon is enabled */
1010         if (p) {
1011                 if (strncmp(p, "on", 2) == 0)
1012                         xmon_init(1);
1013                 if (strncmp(p, "off", 3) == 0)
1014                         xmon_init(0);
1015                 if (strncmp(p, "early", 5) != 0)
1016                         return 0;
1017         }
1018         xmon_init(1);
1019         debugger(NULL);
1020
1021         return 0;
1022 }
1023 early_param("xmon", early_xmon);
1024 #endif
1025
1026 void cpu_die(void)
1027 {
1028         if (ppc_md.cpu_die)
1029                 ppc_md.cpu_die();
1030 }