0d0887844501d3f99347bd4c1646a3fcca3cdb8c
[safe/jmp/linux-2.6] / arch / powerpc / kernel / prom_init.c
1 /*
2  * Procedures for interfacing to Open Firmware.
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_PROM
17
18 #include <stdarg.h>
19 #include <linux/config.h>
20 #include <linux/kernel.h>
21 #include <linux/string.h>
22 #include <linux/init.h>
23 #include <linux/threads.h>
24 #include <linux/spinlock.h>
25 #include <linux/types.h>
26 #include <linux/pci.h>
27 #include <linux/proc_fs.h>
28 #include <linux/stringify.h>
29 #include <linux/delay.h>
30 #include <linux/initrd.h>
31 #include <linux/bitops.h>
32 #include <asm/prom.h>
33 #include <asm/rtas.h>
34 #include <asm/page.h>
35 #include <asm/processor.h>
36 #include <asm/irq.h>
37 #include <asm/io.h>
38 #include <asm/smp.h>
39 #include <asm/system.h>
40 #include <asm/mmu.h>
41 #include <asm/pgtable.h>
42 #include <asm/pci.h>
43 #include <asm/iommu.h>
44 #include <asm/btext.h>
45 #include <asm/sections.h>
46 #include <asm/machdep.h>
47
48 #ifdef CONFIG_LOGO_LINUX_CLUT224
49 #include <linux/linux_logo.h>
50 extern const struct linux_logo logo_linux_clut224;
51 #endif
52
53 /*
54  * Properties whose value is longer than this get excluded from our
55  * copy of the device tree. This value does need to be big enough to
56  * ensure that we don't lose things like the interrupt-map property
57  * on a PCI-PCI bridge.
58  */
59 #define MAX_PROPERTY_LENGTH     (1UL * 1024 * 1024)
60
61 /*
62  * Eventually bump that one up
63  */
64 #define DEVTREE_CHUNK_SIZE      0x100000
65
66 /*
67  * This is the size of the local memory reserve map that gets copied
68  * into the boot params passed to the kernel. That size is totally
69  * flexible as the kernel just reads the list until it encounters an
70  * entry with size 0, so it can be changed without breaking binary
71  * compatibility
72  */
73 #define MEM_RESERVE_MAP_SIZE    8
74
75 /*
76  * prom_init() is called very early on, before the kernel text
77  * and data have been mapped to KERNELBASE.  At this point the code
78  * is running at whatever address it has been loaded at.
79  * On ppc32 we compile with -mrelocatable, which means that references
80  * to extern and static variables get relocated automatically.
81  * On ppc64 we have to relocate the references explicitly with
82  * RELOC.  (Note that strings count as static variables.)
83  *
84  * Because OF may have mapped I/O devices into the area starting at
85  * KERNELBASE, particularly on CHRP machines, we can't safely call
86  * OF once the kernel has been mapped to KERNELBASE.  Therefore all
87  * OF calls must be done within prom_init().
88  *
89  * ADDR is used in calls to call_prom.  The 4th and following
90  * arguments to call_prom should be 32-bit values.
91  * On ppc64, 64 bit values are truncated to 32 bits (and
92  * fortunately don't get interpreted as two arguments).
93  */
94 #ifdef CONFIG_PPC64
95 #define RELOC(x)        (*PTRRELOC(&(x)))
96 #define ADDR(x)         (u32) add_reloc_offset((unsigned long)(x))
97 #define OF_WORKAROUNDS  0
98 #else
99 #define RELOC(x)        (x)
100 #define ADDR(x)         (u32) (x)
101 #define OF_WORKAROUNDS  of_workarounds
102 int of_workarounds;
103 #endif
104
105 #define OF_WA_CLAIM     1       /* do phys/virt claim separately, then map */
106 #define OF_WA_LONGTRAIL 2       /* work around longtrail bugs */
107
108 #define PROM_BUG() do {                                         \
109         prom_printf("kernel BUG at %s line 0x%x!\n",            \
110                     RELOC(__FILE__), __LINE__);                 \
111         __asm__ __volatile__(".long " BUG_ILLEGAL_INSTR);       \
112 } while (0)
113
114 #ifdef DEBUG_PROM
115 #define prom_debug(x...)        prom_printf(x)
116 #else
117 #define prom_debug(x...)
118 #endif
119
120
121 typedef u32 prom_arg_t;
122
123 struct prom_args {
124         u32 service;
125         u32 nargs;
126         u32 nret;
127         prom_arg_t args[10];
128 };
129
130 struct prom_t {
131         ihandle root;
132         phandle chosen;
133         int cpu;
134         ihandle stdout;
135         ihandle mmumap;
136         ihandle memory;
137 };
138
139 struct mem_map_entry {
140         u64     base;
141         u64     size;
142 };
143
144 typedef u32 cell_t;
145
146 extern void __start(unsigned long r3, unsigned long r4, unsigned long r5);
147
148 #ifdef CONFIG_PPC64
149 extern int enter_prom(struct prom_args *args, unsigned long entry);
150 #else
151 static inline int enter_prom(struct prom_args *args, unsigned long entry)
152 {
153         return ((int (*)(struct prom_args *))entry)(args);
154 }
155 #endif
156
157 extern void copy_and_flush(unsigned long dest, unsigned long src,
158                            unsigned long size, unsigned long offset);
159
160 /* prom structure */
161 static struct prom_t __initdata prom;
162
163 static unsigned long prom_entry __initdata;
164
165 #define PROM_SCRATCH_SIZE 256
166
167 static char __initdata of_stdout_device[256];
168 static char __initdata prom_scratch[PROM_SCRATCH_SIZE];
169
170 static unsigned long __initdata dt_header_start;
171 static unsigned long __initdata dt_struct_start, dt_struct_end;
172 static unsigned long __initdata dt_string_start, dt_string_end;
173
174 static unsigned long __initdata prom_initrd_start, prom_initrd_end;
175
176 #ifdef CONFIG_PPC64
177 static int __initdata iommu_force_on;
178 static int __initdata ppc64_iommu_off;
179 static unsigned long __initdata prom_tce_alloc_start;
180 static unsigned long __initdata prom_tce_alloc_end;
181 #endif
182
183 static int __initdata of_platform;
184
185 static char __initdata prom_cmd_line[COMMAND_LINE_SIZE];
186
187 static unsigned long __initdata prom_memory_limit;
188
189 static unsigned long __initdata alloc_top;
190 static unsigned long __initdata alloc_top_high;
191 static unsigned long __initdata alloc_bottom;
192 static unsigned long __initdata rmo_top;
193 static unsigned long __initdata ram_top;
194
195 #ifdef CONFIG_KEXEC
196 static unsigned long __initdata prom_crashk_base;
197 static unsigned long __initdata prom_crashk_size;
198 #endif
199
200 static struct mem_map_entry __initdata mem_reserve_map[MEM_RESERVE_MAP_SIZE];
201 static int __initdata mem_reserve_cnt;
202
203 static cell_t __initdata regbuf[1024];
204
205
206 #define MAX_CPU_THREADS 2
207
208 /*
209  * Error results ... some OF calls will return "-1" on error, some
210  * will return 0, some will return either. To simplify, here are
211  * macros to use with any ihandle or phandle return value to check if
212  * it is valid
213  */
214
215 #define PROM_ERROR              (-1u)
216 #define PHANDLE_VALID(p)        ((p) != 0 && (p) != PROM_ERROR)
217 #define IHANDLE_VALID(i)        ((i) != 0 && (i) != PROM_ERROR)
218
219
220 /* This is the one and *ONLY* place where we actually call open
221  * firmware.
222  */
223
224 static int __init call_prom(const char *service, int nargs, int nret, ...)
225 {
226         int i;
227         struct prom_args args;
228         va_list list;
229
230         args.service = ADDR(service);
231         args.nargs = nargs;
232         args.nret = nret;
233
234         va_start(list, nret);
235         for (i = 0; i < nargs; i++)
236                 args.args[i] = va_arg(list, prom_arg_t);
237         va_end(list);
238
239         for (i = 0; i < nret; i++)
240                 args.args[nargs+i] = 0;
241
242         if (enter_prom(&args, RELOC(prom_entry)) < 0)
243                 return PROM_ERROR;
244
245         return (nret > 0) ? args.args[nargs] : 0;
246 }
247
248 static int __init call_prom_ret(const char *service, int nargs, int nret,
249                                 prom_arg_t *rets, ...)
250 {
251         int i;
252         struct prom_args args;
253         va_list list;
254
255         args.service = ADDR(service);
256         args.nargs = nargs;
257         args.nret = nret;
258
259         va_start(list, rets);
260         for (i = 0; i < nargs; i++)
261                 args.args[i] = va_arg(list, prom_arg_t);
262         va_end(list);
263
264         for (i = 0; i < nret; i++)
265                 args.args[nargs+i] = 0;
266
267         if (enter_prom(&args, RELOC(prom_entry)) < 0)
268                 return PROM_ERROR;
269
270         if (rets != NULL)
271                 for (i = 1; i < nret; ++i)
272                         rets[i-1] = args.args[nargs+i];
273
274         return (nret > 0) ? args.args[nargs] : 0;
275 }
276
277
278 static void __init prom_print(const char *msg)
279 {
280         const char *p, *q;
281         struct prom_t *_prom = &RELOC(prom);
282
283         if (_prom->stdout == 0)
284                 return;
285
286         for (p = msg; *p != 0; p = q) {
287                 for (q = p; *q != 0 && *q != '\n'; ++q)
288                         ;
289                 if (q > p)
290                         call_prom("write", 3, 1, _prom->stdout, p, q - p);
291                 if (*q == 0)
292                         break;
293                 ++q;
294                 call_prom("write", 3, 1, _prom->stdout, ADDR("\r\n"), 2);
295         }
296 }
297
298
299 static void __init prom_print_hex(unsigned long val)
300 {
301         int i, nibbles = sizeof(val)*2;
302         char buf[sizeof(val)*2+1];
303         struct prom_t *_prom = &RELOC(prom);
304
305         for (i = nibbles-1;  i >= 0;  i--) {
306                 buf[i] = (val & 0xf) + '0';
307                 if (buf[i] > '9')
308                         buf[i] += ('a'-'0'-10);
309                 val >>= 4;
310         }
311         buf[nibbles] = '\0';
312         call_prom("write", 3, 1, _prom->stdout, buf, nibbles);
313 }
314
315
316 static void __init prom_printf(const char *format, ...)
317 {
318         const char *p, *q, *s;
319         va_list args;
320         unsigned long v;
321         struct prom_t *_prom = &RELOC(prom);
322
323         va_start(args, format);
324 #ifdef CONFIG_PPC64
325         format = PTRRELOC(format);
326 #endif
327         for (p = format; *p != 0; p = q) {
328                 for (q = p; *q != 0 && *q != '\n' && *q != '%'; ++q)
329                         ;
330                 if (q > p)
331                         call_prom("write", 3, 1, _prom->stdout, p, q - p);
332                 if (*q == 0)
333                         break;
334                 if (*q == '\n') {
335                         ++q;
336                         call_prom("write", 3, 1, _prom->stdout,
337                                   ADDR("\r\n"), 2);
338                         continue;
339                 }
340                 ++q;
341                 if (*q == 0)
342                         break;
343                 switch (*q) {
344                 case 's':
345                         ++q;
346                         s = va_arg(args, const char *);
347                         prom_print(s);
348                         break;
349                 case 'x':
350                         ++q;
351                         v = va_arg(args, unsigned long);
352                         prom_print_hex(v);
353                         break;
354                 }
355         }
356 }
357
358
359 static unsigned int __init prom_claim(unsigned long virt, unsigned long size,
360                                 unsigned long align)
361 {
362         struct prom_t *_prom = &RELOC(prom);
363
364         if (align == 0 && (OF_WORKAROUNDS & OF_WA_CLAIM)) {
365                 /*
366                  * Old OF requires we claim physical and virtual separately
367                  * and then map explicitly (assuming virtual mode)
368                  */
369                 int ret;
370                 prom_arg_t result;
371
372                 ret = call_prom_ret("call-method", 5, 2, &result,
373                                     ADDR("claim"), _prom->memory,
374                                     align, size, virt);
375                 if (ret != 0 || result == -1)
376                         return -1;
377                 ret = call_prom_ret("call-method", 5, 2, &result,
378                                     ADDR("claim"), _prom->mmumap,
379                                     align, size, virt);
380                 if (ret != 0) {
381                         call_prom("call-method", 4, 1, ADDR("release"),
382                                   _prom->memory, size, virt);
383                         return -1;
384                 }
385                 /* the 0x12 is M (coherence) + PP == read/write */
386                 call_prom("call-method", 6, 1,
387                           ADDR("map"), _prom->mmumap, 0x12, size, virt, virt);
388                 return virt;
389         }
390         return call_prom("claim", 3, 1, (prom_arg_t)virt, (prom_arg_t)size,
391                          (prom_arg_t)align);
392 }
393
394 static void __init __attribute__((noreturn)) prom_panic(const char *reason)
395 {
396 #ifdef CONFIG_PPC64
397         reason = PTRRELOC(reason);
398 #endif
399         prom_print(reason);
400         /* Do not call exit because it clears the screen on pmac
401          * it also causes some sort of double-fault on early pmacs */
402         if (RELOC(of_platform) == PLATFORM_POWERMAC)
403                 asm("trap\n");
404
405         /* ToDo: should put up an SRC here on p/iSeries */
406         call_prom("exit", 0, 0);
407
408         for (;;)                        /* should never get here */
409                 ;
410 }
411
412
413 static int __init prom_next_node(phandle *nodep)
414 {
415         phandle node;
416
417         if ((node = *nodep) != 0
418             && (*nodep = call_prom("child", 1, 1, node)) != 0)
419                 return 1;
420         if ((*nodep = call_prom("peer", 1, 1, node)) != 0)
421                 return 1;
422         for (;;) {
423                 if ((node = call_prom("parent", 1, 1, node)) == 0)
424                         return 0;
425                 if ((*nodep = call_prom("peer", 1, 1, node)) != 0)
426                         return 1;
427         }
428 }
429
430 static int inline prom_getprop(phandle node, const char *pname,
431                                void *value, size_t valuelen)
432 {
433         return call_prom("getprop", 4, 1, node, ADDR(pname),
434                          (u32)(unsigned long) value, (u32) valuelen);
435 }
436
437 static int inline prom_getproplen(phandle node, const char *pname)
438 {
439         return call_prom("getproplen", 2, 1, node, ADDR(pname));
440 }
441
442 static void add_string(char **str, const char *q)
443 {
444         char *p = *str;
445
446         while (*q)
447                 *p++ = *q++;
448         *p++ = ' ';
449         *str = p;
450 }
451
452 static char *tohex(unsigned int x)
453 {
454         static char digits[] = "0123456789abcdef";
455         static char result[9];
456         int i;
457
458         result[8] = 0;
459         i = 8;
460         do {
461                 --i;
462                 result[i] = digits[x & 0xf];
463                 x >>= 4;
464         } while (x != 0 && i > 0);
465         return &result[i];
466 }
467
468 static int __init prom_setprop(phandle node, const char *nodename,
469                                const char *pname, void *value, size_t valuelen)
470 {
471         char cmd[256], *p;
472
473         if (!(OF_WORKAROUNDS & OF_WA_LONGTRAIL))
474                 return call_prom("setprop", 4, 1, node, ADDR(pname),
475                                  (u32)(unsigned long) value, (u32) valuelen);
476
477         /* gah... setprop doesn't work on longtrail, have to use interpret */
478         p = cmd;
479         add_string(&p, "dev");
480         add_string(&p, nodename);
481         add_string(&p, tohex((u32)(unsigned long) value));
482         add_string(&p, tohex(valuelen));
483         add_string(&p, tohex(ADDR(pname)));
484         add_string(&p, tohex(strlen(RELOC(pname))));
485         add_string(&p, "property");
486         *p = 0;
487         return call_prom("interpret", 1, 1, (u32)(unsigned long) cmd);
488 }
489
490 /* We can't use the standard versions because of RELOC headaches. */
491 #define isxdigit(c)     (('0' <= (c) && (c) <= '9') \
492                          || ('a' <= (c) && (c) <= 'f') \
493                          || ('A' <= (c) && (c) <= 'F'))
494
495 #define isdigit(c)      ('0' <= (c) && (c) <= '9')
496 #define islower(c)      ('a' <= (c) && (c) <= 'z')
497 #define toupper(c)      (islower(c) ? ((c) - 'a' + 'A') : (c))
498
499 unsigned long prom_strtoul(const char *cp, const char **endp)
500 {
501         unsigned long result = 0, base = 10, value;
502
503         if (*cp == '0') {
504                 base = 8;
505                 cp++;
506                 if (toupper(*cp) == 'X') {
507                         cp++;
508                         base = 16;
509                 }
510         }
511
512         while (isxdigit(*cp) &&
513                (value = isdigit(*cp) ? *cp - '0' : toupper(*cp) - 'A' + 10) < base) {
514                 result = result * base + value;
515                 cp++;
516         }
517
518         if (endp)
519                 *endp = cp;
520
521         return result;
522 }
523
524 unsigned long prom_memparse(const char *ptr, const char **retptr)
525 {
526         unsigned long ret = prom_strtoul(ptr, retptr);
527         int shift = 0;
528
529         /*
530          * We can't use a switch here because GCC *may* generate a
531          * jump table which won't work, because we're not running at
532          * the address we're linked at.
533          */
534         if ('G' == **retptr || 'g' == **retptr)
535                 shift = 30;
536
537         if ('M' == **retptr || 'm' == **retptr)
538                 shift = 20;
539
540         if ('K' == **retptr || 'k' == **retptr)
541                 shift = 10;
542
543         if (shift) {
544                 ret <<= shift;
545                 (*retptr)++;
546         }
547
548         return ret;
549 }
550
551 /*
552  * Early parsing of the command line passed to the kernel, used for
553  * "mem=x" and the options that affect the iommu
554  */
555 static void __init early_cmdline_parse(void)
556 {
557         struct prom_t *_prom = &RELOC(prom);
558         const char *opt;
559         char *p;
560         int l = 0;
561
562         RELOC(prom_cmd_line[0]) = 0;
563         p = RELOC(prom_cmd_line);
564         if ((long)_prom->chosen > 0)
565                 l = prom_getprop(_prom->chosen, "bootargs", p, COMMAND_LINE_SIZE-1);
566 #ifdef CONFIG_CMDLINE
567         if (l == 0) /* dbl check */
568                 strlcpy(RELOC(prom_cmd_line),
569                         RELOC(CONFIG_CMDLINE), sizeof(prom_cmd_line));
570 #endif /* CONFIG_CMDLINE */
571         prom_printf("command line: %s\n", RELOC(prom_cmd_line));
572
573 #ifdef CONFIG_PPC64
574         opt = strstr(RELOC(prom_cmd_line), RELOC("iommu="));
575         if (opt) {
576                 prom_printf("iommu opt is: %s\n", opt);
577                 opt += 6;
578                 while (*opt && *opt == ' ')
579                         opt++;
580                 if (!strncmp(opt, RELOC("off"), 3))
581                         RELOC(ppc64_iommu_off) = 1;
582                 else if (!strncmp(opt, RELOC("force"), 5))
583                         RELOC(iommu_force_on) = 1;
584         }
585 #endif
586
587         opt = strstr(RELOC(prom_cmd_line), RELOC("mem="));
588         if (opt) {
589                 opt += 4;
590                 RELOC(prom_memory_limit) = prom_memparse(opt, (const char **)&opt);
591 #ifdef CONFIG_PPC64
592                 /* Align to 16 MB == size of ppc64 large page */
593                 RELOC(prom_memory_limit) = ALIGN(RELOC(prom_memory_limit), 0x1000000);
594 #endif
595         }
596
597 #ifdef CONFIG_KEXEC
598         /*
599          * crashkernel=size@addr specifies the location to reserve for
600          * crash kernel.
601          */
602         opt = strstr(RELOC(prom_cmd_line), RELOC("crashkernel="));
603         if (opt) {
604                 opt += 12;
605                 RELOC(prom_crashk_size) = 
606                         prom_memparse(opt, (const char **)&opt);
607
608                 if (ALIGN(RELOC(prom_crashk_size), 0x1000000) !=
609                         RELOC(prom_crashk_size)) {
610                         prom_printf("Warning: crashkernel size is not "
611                                         "aligned to 16MB\n");
612                 }
613
614                 /*
615                  * At present, the crash kernel always run at 32MB.
616                  * Just ignore whatever user passed.
617                  */
618                 RELOC(prom_crashk_base) = 0x2000000;
619                 if (*opt == '@') {
620                         prom_printf("Warning: PPC64 kdump kernel always runs "
621                                         "at 32 MB\n");
622                 }
623         }
624 #endif
625 }
626
627 #ifdef CONFIG_PPC_PSERIES
628 /*
629  * To tell the firmware what our capabilities are, we have to pass
630  * it a fake 32-bit ELF header containing a couple of PT_NOTE sections
631  * that contain structures that contain the actual values.
632  */
633 static struct fake_elf {
634         Elf32_Ehdr      elfhdr;
635         Elf32_Phdr      phdr[2];
636         struct chrpnote {
637                 u32     namesz;
638                 u32     descsz;
639                 u32     type;
640                 char    name[8];        /* "PowerPC" */
641                 struct chrpdesc {
642                         u32     real_mode;
643                         u32     real_base;
644                         u32     real_size;
645                         u32     virt_base;
646                         u32     virt_size;
647                         u32     load_base;
648                 } chrpdesc;
649         } chrpnote;
650         struct rpanote {
651                 u32     namesz;
652                 u32     descsz;
653                 u32     type;
654                 char    name[24];       /* "IBM,RPA-Client-Config" */
655                 struct rpadesc {
656                         u32     lpar_affinity;
657                         u32     min_rmo_size;
658                         u32     min_rmo_percent;
659                         u32     max_pft_size;
660                         u32     splpar;
661                         u32     min_load;
662                         u32     new_mem_def;
663                         u32     ignore_me;
664                 } rpadesc;
665         } rpanote;
666 } fake_elf = {
667         .elfhdr = {
668                 .e_ident = { 0x7f, 'E', 'L', 'F',
669                              ELFCLASS32, ELFDATA2MSB, EV_CURRENT },
670                 .e_type = ET_EXEC,      /* yeah right */
671                 .e_machine = EM_PPC,
672                 .e_version = EV_CURRENT,
673                 .e_phoff = offsetof(struct fake_elf, phdr),
674                 .e_phentsize = sizeof(Elf32_Phdr),
675                 .e_phnum = 2
676         },
677         .phdr = {
678                 [0] = {
679                         .p_type = PT_NOTE,
680                         .p_offset = offsetof(struct fake_elf, chrpnote),
681                         .p_filesz = sizeof(struct chrpnote)
682                 }, [1] = {
683                         .p_type = PT_NOTE,
684                         .p_offset = offsetof(struct fake_elf, rpanote),
685                         .p_filesz = sizeof(struct rpanote)
686                 }
687         },
688         .chrpnote = {
689                 .namesz = sizeof("PowerPC"),
690                 .descsz = sizeof(struct chrpdesc),
691                 .type = 0x1275,
692                 .name = "PowerPC",
693                 .chrpdesc = {
694                         .real_mode = ~0U,       /* ~0 means "don't care" */
695                         .real_base = ~0U,
696                         .real_size = ~0U,
697                         .virt_base = ~0U,
698                         .virt_size = ~0U,
699                         .load_base = ~0U
700                 },
701         },
702         .rpanote = {
703                 .namesz = sizeof("IBM,RPA-Client-Config"),
704                 .descsz = sizeof(struct rpadesc),
705                 .type = 0x12759999,
706                 .name = "IBM,RPA-Client-Config",
707                 .rpadesc = {
708                         .lpar_affinity = 0,
709                         .min_rmo_size = 64,     /* in megabytes */
710                         .min_rmo_percent = 0,
711                         .max_pft_size = 48,     /* 2^48 bytes max PFT size */
712                         .splpar = 1,
713                         .min_load = ~0U,
714                         .new_mem_def = 0
715                 }
716         }
717 };
718
719 static void __init prom_send_capabilities(void)
720 {
721         ihandle elfloader;
722
723         elfloader = call_prom("open", 1, 1, ADDR("/packages/elf-loader"));
724         if (elfloader == 0) {
725                 prom_printf("couldn't open /packages/elf-loader\n");
726                 return;
727         }
728         call_prom("call-method", 3, 1, ADDR("process-elf-header"),
729                         elfloader, ADDR(&fake_elf));
730         call_prom("close", 1, 0, elfloader);
731 }
732 #endif
733
734 /*
735  * Memory allocation strategy... our layout is normally:
736  *
737  *  at 14Mb or more we have vmlinux, then a gap and initrd.  In some
738  *  rare cases, initrd might end up being before the kernel though.
739  *  We assume this won't override the final kernel at 0, we have no
740  *  provision to handle that in this version, but it should hopefully
741  *  never happen.
742  *
743  *  alloc_top is set to the top of RMO, eventually shrink down if the
744  *  TCEs overlap
745  *
746  *  alloc_bottom is set to the top of kernel/initrd
747  *
748  *  from there, allocations are done this way : rtas is allocated
749  *  topmost, and the device-tree is allocated from the bottom. We try
750  *  to grow the device-tree allocation as we progress. If we can't,
751  *  then we fail, we don't currently have a facility to restart
752  *  elsewhere, but that shouldn't be necessary.
753  *
754  *  Note that calls to reserve_mem have to be done explicitly, memory
755  *  allocated with either alloc_up or alloc_down isn't automatically
756  *  reserved.
757  */
758
759
760 /*
761  * Allocates memory in the RMO upward from the kernel/initrd
762  *
763  * When align is 0, this is a special case, it means to allocate in place
764  * at the current location of alloc_bottom or fail (that is basically
765  * extending the previous allocation). Used for the device-tree flattening
766  */
767 static unsigned long __init alloc_up(unsigned long size, unsigned long align)
768 {
769         unsigned long base = RELOC(alloc_bottom);
770         unsigned long addr = 0;
771
772         if (align)
773                 base = _ALIGN_UP(base, align);
774         prom_debug("alloc_up(%x, %x)\n", size, align);
775         if (RELOC(ram_top) == 0)
776                 prom_panic("alloc_up() called with mem not initialized\n");
777
778         if (align)
779                 base = _ALIGN_UP(RELOC(alloc_bottom), align);
780         else
781                 base = RELOC(alloc_bottom);
782
783         for(; (base + size) <= RELOC(alloc_top); 
784             base = _ALIGN_UP(base + 0x100000, align)) {
785                 prom_debug("    trying: 0x%x\n\r", base);
786                 addr = (unsigned long)prom_claim(base, size, 0);
787                 if (addr != PROM_ERROR && addr != 0)
788                         break;
789                 addr = 0;
790                 if (align == 0)
791                         break;
792         }
793         if (addr == 0)
794                 return 0;
795         RELOC(alloc_bottom) = addr;
796
797         prom_debug(" -> %x\n", addr);
798         prom_debug("  alloc_bottom : %x\n", RELOC(alloc_bottom));
799         prom_debug("  alloc_top    : %x\n", RELOC(alloc_top));
800         prom_debug("  alloc_top_hi : %x\n", RELOC(alloc_top_high));
801         prom_debug("  rmo_top      : %x\n", RELOC(rmo_top));
802         prom_debug("  ram_top      : %x\n", RELOC(ram_top));
803
804         return addr;
805 }
806
807 /*
808  * Allocates memory downward, either from top of RMO, or if highmem
809  * is set, from the top of RAM.  Note that this one doesn't handle
810  * failures.  It does claim memory if highmem is not set.
811  */
812 static unsigned long __init alloc_down(unsigned long size, unsigned long align,
813                                        int highmem)
814 {
815         unsigned long base, addr = 0;
816
817         prom_debug("alloc_down(%x, %x, %s)\n", size, align,
818                    highmem ? RELOC("(high)") : RELOC("(low)"));
819         if (RELOC(ram_top) == 0)
820                 prom_panic("alloc_down() called with mem not initialized\n");
821
822         if (highmem) {
823                 /* Carve out storage for the TCE table. */
824                 addr = _ALIGN_DOWN(RELOC(alloc_top_high) - size, align);
825                 if (addr <= RELOC(alloc_bottom))
826                         return 0;
827                 /* Will we bump into the RMO ? If yes, check out that we
828                  * didn't overlap existing allocations there, if we did,
829                  * we are dead, we must be the first in town !
830                  */
831                 if (addr < RELOC(rmo_top)) {
832                         /* Good, we are first */
833                         if (RELOC(alloc_top) == RELOC(rmo_top))
834                                 RELOC(alloc_top) = RELOC(rmo_top) = addr;
835                         else
836                                 return 0;
837                 }
838                 RELOC(alloc_top_high) = addr;
839                 goto bail;
840         }
841
842         base = _ALIGN_DOWN(RELOC(alloc_top) - size, align);
843         for (; base > RELOC(alloc_bottom);
844              base = _ALIGN_DOWN(base - 0x100000, align))  {
845                 prom_debug("    trying: 0x%x\n\r", base);
846                 addr = (unsigned long)prom_claim(base, size, 0);
847                 if (addr != PROM_ERROR && addr != 0)
848                         break;
849                 addr = 0;
850         }
851         if (addr == 0)
852                 return 0;
853         RELOC(alloc_top) = addr;
854
855  bail:
856         prom_debug(" -> %x\n", addr);
857         prom_debug("  alloc_bottom : %x\n", RELOC(alloc_bottom));
858         prom_debug("  alloc_top    : %x\n", RELOC(alloc_top));
859         prom_debug("  alloc_top_hi : %x\n", RELOC(alloc_top_high));
860         prom_debug("  rmo_top      : %x\n", RELOC(rmo_top));
861         prom_debug("  ram_top      : %x\n", RELOC(ram_top));
862
863         return addr;
864 }
865
866 /*
867  * Parse a "reg" cell
868  */
869 static unsigned long __init prom_next_cell(int s, cell_t **cellp)
870 {
871         cell_t *p = *cellp;
872         unsigned long r = 0;
873
874         /* Ignore more than 2 cells */
875         while (s > sizeof(unsigned long) / 4) {
876                 p++;
877                 s--;
878         }
879         r = *p++;
880 #ifdef CONFIG_PPC64
881         if (s > 1) {
882                 r <<= 32;
883                 r |= *(p++);
884         }
885 #endif
886         *cellp = p;
887         return r;
888 }
889
890 /*
891  * Very dumb function for adding to the memory reserve list, but
892  * we don't need anything smarter at this point
893  *
894  * XXX Eventually check for collisions.  They should NEVER happen.
895  * If problems seem to show up, it would be a good start to track
896  * them down.
897  */
898 static void reserve_mem(u64 base, u64 size)
899 {
900         u64 top = base + size;
901         unsigned long cnt = RELOC(mem_reserve_cnt);
902
903         if (size == 0)
904                 return;
905
906         /* We need to always keep one empty entry so that we
907          * have our terminator with "size" set to 0 since we are
908          * dumb and just copy this entire array to the boot params
909          */
910         base = _ALIGN_DOWN(base, PAGE_SIZE);
911         top = _ALIGN_UP(top, PAGE_SIZE);
912         size = top - base;
913
914         if (cnt >= (MEM_RESERVE_MAP_SIZE - 1))
915                 prom_panic("Memory reserve map exhausted !\n");
916         RELOC(mem_reserve_map)[cnt].base = base;
917         RELOC(mem_reserve_map)[cnt].size = size;
918         RELOC(mem_reserve_cnt) = cnt + 1;
919 }
920
921 /*
922  * Initialize memory allocation mecanism, parse "memory" nodes and
923  * obtain that way the top of memory and RMO to setup out local allocator
924  */
925 static void __init prom_init_mem(void)
926 {
927         phandle node;
928         char *path, type[64];
929         unsigned int plen;
930         cell_t *p, *endp;
931         struct prom_t *_prom = &RELOC(prom);
932         u32 rac, rsc;
933
934         /*
935          * We iterate the memory nodes to find
936          * 1) top of RMO (first node)
937          * 2) top of memory
938          */
939         rac = 2;
940         prom_getprop(_prom->root, "#address-cells", &rac, sizeof(rac));
941         rsc = 1;
942         prom_getprop(_prom->root, "#size-cells", &rsc, sizeof(rsc));
943         prom_debug("root_addr_cells: %x\n", (unsigned long) rac);
944         prom_debug("root_size_cells: %x\n", (unsigned long) rsc);
945
946         prom_debug("scanning memory:\n");
947         path = RELOC(prom_scratch);
948
949         for (node = 0; prom_next_node(&node); ) {
950                 type[0] = 0;
951                 prom_getprop(node, "device_type", type, sizeof(type));
952
953                 if (type[0] == 0) {
954                         /*
955                          * CHRP Longtrail machines have no device_type
956                          * on the memory node, so check the name instead...
957                          */
958                         prom_getprop(node, "name", type, sizeof(type));
959                 }
960                 if (strcmp(type, RELOC("memory")))
961                         continue;
962
963                 plen = prom_getprop(node, "reg", RELOC(regbuf), sizeof(regbuf));
964                 if (plen > sizeof(regbuf)) {
965                         prom_printf("memory node too large for buffer !\n");
966                         plen = sizeof(regbuf);
967                 }
968                 p = RELOC(regbuf);
969                 endp = p + (plen / sizeof(cell_t));
970
971 #ifdef DEBUG_PROM
972                 memset(path, 0, PROM_SCRATCH_SIZE);
973                 call_prom("package-to-path", 3, 1, node, path, PROM_SCRATCH_SIZE-1);
974                 prom_debug("  node %s :\n", path);
975 #endif /* DEBUG_PROM */
976
977                 while ((endp - p) >= (rac + rsc)) {
978                         unsigned long base, size;
979
980                         base = prom_next_cell(rac, &p);
981                         size = prom_next_cell(rsc, &p);
982
983                         if (size == 0)
984                                 continue;
985                         prom_debug("    %x %x\n", base, size);
986                         if (base == 0 && (RELOC(of_platform) & PLATFORM_LPAR))
987                                 RELOC(rmo_top) = size;
988                         if ((base + size) > RELOC(ram_top))
989                                 RELOC(ram_top) = base + size;
990                 }
991         }
992
993         RELOC(alloc_bottom) = PAGE_ALIGN((unsigned long)&RELOC(_end) + 0x4000);
994
995         /* Check if we have an initrd after the kernel, if we do move our bottom
996          * point to after it
997          */
998         if (RELOC(prom_initrd_start)) {
999                 if (RELOC(prom_initrd_end) > RELOC(alloc_bottom))
1000                         RELOC(alloc_bottom) = PAGE_ALIGN(RELOC(prom_initrd_end));
1001         }
1002
1003         /*
1004          * If prom_memory_limit is set we reduce the upper limits *except* for
1005          * alloc_top_high. This must be the real top of RAM so we can put
1006          * TCE's up there.
1007          */
1008
1009         RELOC(alloc_top_high) = RELOC(ram_top);
1010
1011         if (RELOC(prom_memory_limit)) {
1012                 if (RELOC(prom_memory_limit) <= RELOC(alloc_bottom)) {
1013                         prom_printf("Ignoring mem=%x <= alloc_bottom.\n",
1014                                 RELOC(prom_memory_limit));
1015                         RELOC(prom_memory_limit) = 0;
1016                 } else if (RELOC(prom_memory_limit) >= RELOC(ram_top)) {
1017                         prom_printf("Ignoring mem=%x >= ram_top.\n",
1018                                 RELOC(prom_memory_limit));
1019                         RELOC(prom_memory_limit) = 0;
1020                 } else {
1021                         RELOC(ram_top) = RELOC(prom_memory_limit);
1022                         RELOC(rmo_top) = min(RELOC(rmo_top), RELOC(prom_memory_limit));
1023                 }
1024         }
1025
1026         /*
1027          * Setup our top alloc point, that is top of RMO or top of
1028          * segment 0 when running non-LPAR.
1029          * Some RS64 machines have buggy firmware where claims up at
1030          * 1GB fail.  Cap at 768MB as a workaround.
1031          * Since 768MB is plenty of room, and we need to cap to something
1032          * reasonable on 32-bit, cap at 768MB on all machines.
1033          */
1034         if (!RELOC(rmo_top))
1035                 RELOC(rmo_top) = RELOC(ram_top);
1036         RELOC(rmo_top) = min(0x30000000ul, RELOC(rmo_top));
1037         RELOC(alloc_top) = RELOC(rmo_top);
1038
1039         prom_printf("memory layout at init:\n");
1040         prom_printf("  memory_limit : %x (16 MB aligned)\n", RELOC(prom_memory_limit));
1041         prom_printf("  alloc_bottom : %x\n", RELOC(alloc_bottom));
1042         prom_printf("  alloc_top    : %x\n", RELOC(alloc_top));
1043         prom_printf("  alloc_top_hi : %x\n", RELOC(alloc_top_high));
1044         prom_printf("  rmo_top      : %x\n", RELOC(rmo_top));
1045         prom_printf("  ram_top      : %x\n", RELOC(ram_top));
1046 #ifdef CONFIG_KEXEC
1047         if (RELOC(prom_crashk_base)) {
1048                 prom_printf("  crashk_base  : %x\n",  RELOC(prom_crashk_base));
1049                 prom_printf("  crashk_size  : %x\n", RELOC(prom_crashk_size));
1050         }
1051 #endif
1052 }
1053
1054
1055 /*
1056  * Allocate room for and instantiate RTAS
1057  */
1058 static void __init prom_instantiate_rtas(void)
1059 {
1060         phandle rtas_node;
1061         ihandle rtas_inst;
1062         u32 base, entry = 0;
1063         u32 size = 0;
1064
1065         prom_debug("prom_instantiate_rtas: start...\n");
1066
1067         rtas_node = call_prom("finddevice", 1, 1, ADDR("/rtas"));
1068         prom_debug("rtas_node: %x\n", rtas_node);
1069         if (!PHANDLE_VALID(rtas_node))
1070                 return;
1071
1072         prom_getprop(rtas_node, "rtas-size", &size, sizeof(size));
1073         if (size == 0)
1074                 return;
1075
1076         base = alloc_down(size, PAGE_SIZE, 0);
1077         if (base == 0) {
1078                 prom_printf("RTAS allocation failed !\n");
1079                 return;
1080         }
1081
1082         rtas_inst = call_prom("open", 1, 1, ADDR("/rtas"));
1083         if (!IHANDLE_VALID(rtas_inst)) {
1084                 prom_printf("opening rtas package failed (%x)\n", rtas_inst);
1085                 return;
1086         }
1087
1088         prom_printf("instantiating rtas at 0x%x ...", base);
1089
1090         if (call_prom_ret("call-method", 3, 2, &entry,
1091                           ADDR("instantiate-rtas"),
1092                           rtas_inst, base) != 0
1093             || entry == 0) {
1094                 prom_printf(" failed\n");
1095                 return;
1096         }
1097         prom_printf(" done\n");
1098
1099         reserve_mem(base, size);
1100
1101         prom_setprop(rtas_node, "/rtas", "linux,rtas-base",
1102                      &base, sizeof(base));
1103         prom_setprop(rtas_node, "/rtas", "linux,rtas-entry",
1104                      &entry, sizeof(entry));
1105
1106         prom_debug("rtas base     = 0x%x\n", base);
1107         prom_debug("rtas entry    = 0x%x\n", entry);
1108         prom_debug("rtas size     = 0x%x\n", (long)size);
1109
1110         prom_debug("prom_instantiate_rtas: end...\n");
1111 }
1112
1113 #ifdef CONFIG_PPC64
1114 /*
1115  * Allocate room for and initialize TCE tables
1116  */
1117 static void __init prom_initialize_tce_table(void)
1118 {
1119         phandle node;
1120         ihandle phb_node;
1121         char compatible[64], type[64], model[64];
1122         char *path = RELOC(prom_scratch);
1123         u64 base, align;
1124         u32 minalign, minsize;
1125         u64 tce_entry, *tce_entryp;
1126         u64 local_alloc_top, local_alloc_bottom;
1127         u64 i;
1128
1129         if (RELOC(ppc64_iommu_off))
1130                 return;
1131
1132         prom_debug("starting prom_initialize_tce_table\n");
1133
1134         /* Cache current top of allocs so we reserve a single block */
1135         local_alloc_top = RELOC(alloc_top_high);
1136         local_alloc_bottom = local_alloc_top;
1137
1138         /* Search all nodes looking for PHBs. */
1139         for (node = 0; prom_next_node(&node); ) {
1140                 compatible[0] = 0;
1141                 type[0] = 0;
1142                 model[0] = 0;
1143                 prom_getprop(node, "compatible",
1144                              compatible, sizeof(compatible));
1145                 prom_getprop(node, "device_type", type, sizeof(type));
1146                 prom_getprop(node, "model", model, sizeof(model));
1147
1148                 if ((type[0] == 0) || (strstr(type, RELOC("pci")) == NULL))
1149                         continue;
1150
1151                 /* Keep the old logic in tack to avoid regression. */
1152                 if (compatible[0] != 0) {
1153                         if ((strstr(compatible, RELOC("python")) == NULL) &&
1154                             (strstr(compatible, RELOC("Speedwagon")) == NULL) &&
1155                             (strstr(compatible, RELOC("Winnipeg")) == NULL))
1156                                 continue;
1157                 } else if (model[0] != 0) {
1158                         if ((strstr(model, RELOC("ython")) == NULL) &&
1159                             (strstr(model, RELOC("peedwagon")) == NULL) &&
1160                             (strstr(model, RELOC("innipeg")) == NULL))
1161                                 continue;
1162                 }
1163
1164                 if (prom_getprop(node, "tce-table-minalign", &minalign,
1165                                  sizeof(minalign)) == PROM_ERROR)
1166                         minalign = 0;
1167                 if (prom_getprop(node, "tce-table-minsize", &minsize,
1168                                  sizeof(minsize)) == PROM_ERROR)
1169                         minsize = 4UL << 20;
1170
1171                 /*
1172                  * Even though we read what OF wants, we just set the table
1173                  * size to 4 MB.  This is enough to map 2GB of PCI DMA space.
1174                  * By doing this, we avoid the pitfalls of trying to DMA to
1175                  * MMIO space and the DMA alias hole.
1176                  *
1177                  * On POWER4, firmware sets the TCE region by assuming
1178                  * each TCE table is 8MB. Using this memory for anything
1179                  * else will impact performance, so we always allocate 8MB.
1180                  * Anton
1181                  */
1182                 if (__is_processor(PV_POWER4) || __is_processor(PV_POWER4p))
1183                         minsize = 8UL << 20;
1184                 else
1185                         minsize = 4UL << 20;
1186
1187                 /* Align to the greater of the align or size */
1188                 align = max(minalign, minsize);
1189                 base = alloc_down(minsize, align, 1);
1190                 if (base == 0)
1191                         prom_panic("ERROR, cannot find space for TCE table.\n");
1192                 if (base < local_alloc_bottom)
1193                         local_alloc_bottom = base;
1194
1195                 /* It seems OF doesn't null-terminate the path :-( */
1196                 memset(path, 0, sizeof(path));
1197                 /* Call OF to setup the TCE hardware */
1198                 if (call_prom("package-to-path", 3, 1, node,
1199                               path, PROM_SCRATCH_SIZE-1) == PROM_ERROR) {
1200                         prom_printf("package-to-path failed\n");
1201                 }
1202
1203                 /* Save away the TCE table attributes for later use. */
1204                 prom_setprop(node, path, "linux,tce-base", &base, sizeof(base));
1205                 prom_setprop(node, path, "linux,tce-size", &minsize, sizeof(minsize));
1206
1207                 prom_debug("TCE table: %s\n", path);
1208                 prom_debug("\tnode = 0x%x\n", node);
1209                 prom_debug("\tbase = 0x%x\n", base);
1210                 prom_debug("\tsize = 0x%x\n", minsize);
1211
1212                 /* Initialize the table to have a one-to-one mapping
1213                  * over the allocated size.
1214                  */
1215                 tce_entryp = (unsigned long *)base;
1216                 for (i = 0; i < (minsize >> 3) ;tce_entryp++, i++) {
1217                         tce_entry = (i << PAGE_SHIFT);
1218                         tce_entry |= 0x3;
1219                         *tce_entryp = tce_entry;
1220                 }
1221
1222                 prom_printf("opening PHB %s", path);
1223                 phb_node = call_prom("open", 1, 1, path);
1224                 if (phb_node == 0)
1225                         prom_printf("... failed\n");
1226                 else
1227                         prom_printf("... done\n");
1228
1229                 call_prom("call-method", 6, 0, ADDR("set-64-bit-addressing"),
1230                           phb_node, -1, minsize,
1231                           (u32) base, (u32) (base >> 32));
1232                 call_prom("close", 1, 0, phb_node);
1233         }
1234
1235         reserve_mem(local_alloc_bottom, local_alloc_top - local_alloc_bottom);
1236
1237         if (RELOC(prom_memory_limit)) {
1238                 /*
1239                  * We align the start to a 16MB boundary so we can map
1240                  * the TCE area using large pages if possible.
1241                  * The end should be the top of RAM so no need to align it.
1242                  */
1243                 RELOC(prom_tce_alloc_start) = _ALIGN_DOWN(local_alloc_bottom,
1244                                                           0x1000000);
1245                 RELOC(prom_tce_alloc_end) = local_alloc_top;
1246         }
1247
1248         /* Flag the first invalid entry */
1249         prom_debug("ending prom_initialize_tce_table\n");
1250 }
1251 #endif
1252
1253 /*
1254  * With CHRP SMP we need to use the OF to start the other processors.
1255  * We can't wait until smp_boot_cpus (the OF is trashed by then)
1256  * so we have to put the processors into a holding pattern controlled
1257  * by the kernel (not OF) before we destroy the OF.
1258  *
1259  * This uses a chunk of low memory, puts some holding pattern
1260  * code there and sends the other processors off to there until
1261  * smp_boot_cpus tells them to do something.  The holding pattern
1262  * checks that address until its cpu # is there, when it is that
1263  * cpu jumps to __secondary_start().  smp_boot_cpus() takes care
1264  * of setting those values.
1265  *
1266  * We also use physical address 0x4 here to tell when a cpu
1267  * is in its holding pattern code.
1268  *
1269  * -- Cort
1270  */
1271 extern void __secondary_hold(void);
1272 extern unsigned long __secondary_hold_spinloop;
1273 extern unsigned long __secondary_hold_acknowledge;
1274
1275 /*
1276  * We want to reference the copy of __secondary_hold_* in the
1277  * 0 - 0x100 address range
1278  */
1279 #define LOW_ADDR(x)     (((unsigned long) &(x)) & 0xff)
1280
1281 static void __init prom_hold_cpus(void)
1282 {
1283         unsigned long i;
1284         unsigned int reg;
1285         phandle node;
1286         char type[64];
1287         int cpuid = 0;
1288         unsigned int interrupt_server[MAX_CPU_THREADS];
1289         unsigned int cpu_threads, hw_cpu_num;
1290         int propsize;
1291         struct prom_t *_prom = &RELOC(prom);
1292         unsigned long *spinloop
1293                 = (void *) LOW_ADDR(__secondary_hold_spinloop);
1294         unsigned long *acknowledge
1295                 = (void *) LOW_ADDR(__secondary_hold_acknowledge);
1296 #ifdef CONFIG_PPC64
1297         /* __secondary_hold is actually a descriptor, not the text address */
1298         unsigned long secondary_hold
1299                 = __pa(*PTRRELOC((unsigned long *)__secondary_hold));
1300 #else
1301         unsigned long secondary_hold = LOW_ADDR(__secondary_hold);
1302 #endif
1303
1304         prom_debug("prom_hold_cpus: start...\n");
1305         prom_debug("    1) spinloop       = 0x%x\n", (unsigned long)spinloop);
1306         prom_debug("    1) *spinloop      = 0x%x\n", *spinloop);
1307         prom_debug("    1) acknowledge    = 0x%x\n",
1308                    (unsigned long)acknowledge);
1309         prom_debug("    1) *acknowledge   = 0x%x\n", *acknowledge);
1310         prom_debug("    1) secondary_hold = 0x%x\n", secondary_hold);
1311
1312         /* Set the common spinloop variable, so all of the secondary cpus
1313          * will block when they are awakened from their OF spinloop.
1314          * This must occur for both SMP and non SMP kernels, since OF will
1315          * be trashed when we move the kernel.
1316          */
1317         *spinloop = 0;
1318
1319         /* look for cpus */
1320         for (node = 0; prom_next_node(&node); ) {
1321                 type[0] = 0;
1322                 prom_getprop(node, "device_type", type, sizeof(type));
1323                 if (strcmp(type, RELOC("cpu")) != 0)
1324                         continue;
1325
1326                 /* Skip non-configured cpus. */
1327                 if (prom_getprop(node, "status", type, sizeof(type)) > 0)
1328                         if (strcmp(type, RELOC("okay")) != 0)
1329                                 continue;
1330
1331                 reg = -1;
1332                 prom_getprop(node, "reg", &reg, sizeof(reg));
1333
1334                 prom_debug("\ncpuid        = 0x%x\n", cpuid);
1335                 prom_debug("cpu hw idx   = 0x%x\n", reg);
1336
1337                 /* Init the acknowledge var which will be reset by
1338                  * the secondary cpu when it awakens from its OF
1339                  * spinloop.
1340                  */
1341                 *acknowledge = (unsigned long)-1;
1342
1343                 propsize = prom_getprop(node, "ibm,ppc-interrupt-server#s",
1344                                         &interrupt_server,
1345                                         sizeof(interrupt_server));
1346                 if (propsize < 0) {
1347                         /* no property.  old hardware has no SMT */
1348                         cpu_threads = 1;
1349                         interrupt_server[0] = reg; /* fake it with phys id */
1350                 } else {
1351                         /* We have a threaded processor */
1352                         cpu_threads = propsize / sizeof(u32);
1353                         if (cpu_threads > MAX_CPU_THREADS) {
1354                                 prom_printf("SMT: too many threads!\n"
1355                                             "SMT: found %x, max is %x\n",
1356                                             cpu_threads, MAX_CPU_THREADS);
1357                                 cpu_threads = 1; /* ToDo: panic? */
1358                         }
1359                 }
1360
1361                 hw_cpu_num = interrupt_server[0];
1362                 if (hw_cpu_num != _prom->cpu) {
1363                         /* Primary Thread of non-boot cpu */
1364                         prom_printf("%x : starting cpu hw idx %x... ", cpuid, reg);
1365                         call_prom("start-cpu", 3, 0, node,
1366                                   secondary_hold, reg);
1367
1368                         for (i = 0; (i < 100000000) && 
1369                              (*acknowledge == ((unsigned long)-1)); i++ )
1370                                 mb();
1371
1372                         if (*acknowledge == reg)
1373                                 prom_printf("done\n");
1374                         else
1375                                 prom_printf("failed: %x\n", *acknowledge);
1376                 }
1377 #ifdef CONFIG_SMP
1378                 else
1379                         prom_printf("%x : boot cpu     %x\n", cpuid, reg);
1380 #endif /* CONFIG_SMP */
1381
1382                 /* Reserve cpu #s for secondary threads.   They start later. */
1383                 cpuid += cpu_threads;
1384         }
1385
1386         if (cpuid > NR_CPUS)
1387                 prom_printf("WARNING: maximum CPUs (" __stringify(NR_CPUS)
1388                             ") exceeded: ignoring extras\n");
1389
1390         prom_debug("prom_hold_cpus: end...\n");
1391 }
1392
1393
1394 static void __init prom_init_client_services(unsigned long pp)
1395 {
1396         struct prom_t *_prom = &RELOC(prom);
1397
1398         /* Get a handle to the prom entry point before anything else */
1399         RELOC(prom_entry) = pp;
1400
1401         /* get a handle for the stdout device */
1402         _prom->chosen = call_prom("finddevice", 1, 1, ADDR("/chosen"));
1403         if (!PHANDLE_VALID(_prom->chosen))
1404                 prom_panic("cannot find chosen"); /* msg won't be printed :( */
1405
1406         /* get device tree root */
1407         _prom->root = call_prom("finddevice", 1, 1, ADDR("/"));
1408         if (!PHANDLE_VALID(_prom->root))
1409                 prom_panic("cannot find device tree root"); /* msg won't be printed :( */
1410
1411         _prom->mmumap = 0;
1412 }
1413
1414 #ifdef CONFIG_PPC32
1415 /*
1416  * For really old powermacs, we need to map things we claim.
1417  * For that, we need the ihandle of the mmu.
1418  * Also, on the longtrail, we need to work around other bugs.
1419  */
1420 static void __init prom_find_mmu(void)
1421 {
1422         struct prom_t *_prom = &RELOC(prom);
1423         phandle oprom;
1424         char version[64];
1425
1426         oprom = call_prom("finddevice", 1, 1, ADDR("/openprom"));
1427         if (!PHANDLE_VALID(oprom))
1428                 return;
1429         if (prom_getprop(oprom, "model", version, sizeof(version)) <= 0)
1430                 return;
1431         version[sizeof(version) - 1] = 0;
1432         /* XXX might need to add other versions here */
1433         if (strcmp(version, "Open Firmware, 1.0.5") == 0)
1434                 of_workarounds = OF_WA_CLAIM;
1435         else if (strncmp(version, "FirmWorks,3.", 12) == 0) {
1436                 of_workarounds = OF_WA_CLAIM | OF_WA_LONGTRAIL;
1437                 call_prom("interpret", 1, 1, "dev /memory 0 to allow-reclaim");
1438         } else
1439                 return;
1440         _prom->memory = call_prom("open", 1, 1, ADDR("/memory"));
1441         prom_getprop(_prom->chosen, "mmu", &_prom->mmumap,
1442                      sizeof(_prom->mmumap));
1443         if (!IHANDLE_VALID(_prom->memory) || !IHANDLE_VALID(_prom->mmumap))
1444                 of_workarounds &= ~OF_WA_CLAIM;         /* hmmm */
1445 }
1446 #else
1447 #define prom_find_mmu()
1448 #endif
1449
1450 static void __init prom_init_stdout(void)
1451 {
1452         struct prom_t *_prom = &RELOC(prom);
1453         char *path = RELOC(of_stdout_device);
1454         char type[16];
1455         u32 val;
1456
1457         if (prom_getprop(_prom->chosen, "stdout", &val, sizeof(val)) <= 0)
1458                 prom_panic("cannot find stdout");
1459
1460         _prom->stdout = val;
1461
1462         /* Get the full OF pathname of the stdout device */
1463         memset(path, 0, 256);
1464         call_prom("instance-to-path", 3, 1, _prom->stdout, path, 255);
1465         val = call_prom("instance-to-package", 1, 1, _prom->stdout);
1466         prom_setprop(_prom->chosen, "/chosen", "linux,stdout-package",
1467                      &val, sizeof(val));
1468         prom_printf("OF stdout device is: %s\n", RELOC(of_stdout_device));
1469         prom_setprop(_prom->chosen, "/chosen", "linux,stdout-path",
1470                      path, strlen(path) + 1);
1471
1472         /* If it's a display, note it */
1473         memset(type, 0, sizeof(type));
1474         prom_getprop(val, "device_type", type, sizeof(type));
1475         if (strcmp(type, RELOC("display")) == 0)
1476                 prom_setprop(val, path, "linux,boot-display", NULL, 0);
1477 }
1478
1479 static void __init prom_close_stdin(void)
1480 {
1481         struct prom_t *_prom = &RELOC(prom);
1482         ihandle val;
1483
1484         if (prom_getprop(_prom->chosen, "stdin", &val, sizeof(val)) > 0)
1485                 call_prom("close", 1, 0, val);
1486 }
1487
1488 static int __init prom_find_machine_type(void)
1489 {
1490         struct prom_t *_prom = &RELOC(prom);
1491         char compat[256];
1492         int len, i = 0;
1493 #ifdef CONFIG_PPC64
1494         phandle rtas;
1495 #endif
1496         len = prom_getprop(_prom->root, "compatible",
1497                            compat, sizeof(compat)-1);
1498         if (len > 0) {
1499                 compat[len] = 0;
1500                 while (i < len) {
1501                         char *p = &compat[i];
1502                         int sl = strlen(p);
1503                         if (sl == 0)
1504                                 break;
1505                         if (strstr(p, RELOC("Power Macintosh")) ||
1506                             strstr(p, RELOC("MacRISC")))
1507                                 return PLATFORM_POWERMAC;
1508 #ifdef CONFIG_PPC64
1509                         if (strstr(p, RELOC("Momentum,Maple")))
1510                                 return PLATFORM_MAPLE;
1511                         if (strstr(p, RELOC("IBM,CPB")))
1512                                 return PLATFORM_CELL;
1513 #endif
1514                         i += sl + 1;
1515                 }
1516         }
1517 #ifdef CONFIG_PPC64
1518         /* Default to pSeries. We need to know if we are running LPAR */
1519         rtas = call_prom("finddevice", 1, 1, ADDR("/rtas"));
1520         if (PHANDLE_VALID(rtas)) {
1521                 int x = prom_getproplen(rtas, "ibm,hypertas-functions");
1522                 if (x != PROM_ERROR) {
1523                         prom_printf("Hypertas detected, assuming LPAR !\n");
1524                         return PLATFORM_PSERIES_LPAR;
1525                 }
1526         }
1527         return PLATFORM_PSERIES;
1528 #else
1529         return PLATFORM_CHRP;
1530 #endif
1531 }
1532
1533 static int __init prom_set_color(ihandle ih, int i, int r, int g, int b)
1534 {
1535         return call_prom("call-method", 6, 1, ADDR("color!"), ih, i, b, g, r);
1536 }
1537
1538 /*
1539  * If we have a display that we don't know how to drive,
1540  * we will want to try to execute OF's open method for it
1541  * later.  However, OF will probably fall over if we do that
1542  * we've taken over the MMU.
1543  * So we check whether we will need to open the display,
1544  * and if so, open it now.
1545  */
1546 static void __init prom_check_displays(void)
1547 {
1548         char type[16], *path;
1549         phandle node;
1550         ihandle ih;
1551         int i;
1552
1553         static unsigned char default_colors[] = {
1554                 0x00, 0x00, 0x00,
1555                 0x00, 0x00, 0xaa,
1556                 0x00, 0xaa, 0x00,
1557                 0x00, 0xaa, 0xaa,
1558                 0xaa, 0x00, 0x00,
1559                 0xaa, 0x00, 0xaa,
1560                 0xaa, 0xaa, 0x00,
1561                 0xaa, 0xaa, 0xaa,
1562                 0x55, 0x55, 0x55,
1563                 0x55, 0x55, 0xff,
1564                 0x55, 0xff, 0x55,
1565                 0x55, 0xff, 0xff,
1566                 0xff, 0x55, 0x55,
1567                 0xff, 0x55, 0xff,
1568                 0xff, 0xff, 0x55,
1569                 0xff, 0xff, 0xff
1570         };
1571         const unsigned char *clut;
1572
1573         prom_printf("Looking for displays\n");
1574         for (node = 0; prom_next_node(&node); ) {
1575                 memset(type, 0, sizeof(type));
1576                 prom_getprop(node, "device_type", type, sizeof(type));
1577                 if (strcmp(type, RELOC("display")) != 0)
1578                         continue;
1579
1580                 /* It seems OF doesn't null-terminate the path :-( */
1581                 path = RELOC(prom_scratch);
1582                 memset(path, 0, PROM_SCRATCH_SIZE);
1583
1584                 /*
1585                  * leave some room at the end of the path for appending extra
1586                  * arguments
1587                  */
1588                 if (call_prom("package-to-path", 3, 1, node, path,
1589                               PROM_SCRATCH_SIZE-10) == PROM_ERROR)
1590                         continue;
1591                 prom_printf("found display   : %s, opening ... ", path);
1592                 
1593                 ih = call_prom("open", 1, 1, path);
1594                 if (ih == 0) {
1595                         prom_printf("failed\n");
1596                         continue;
1597                 }
1598
1599                 /* Success */
1600                 prom_printf("done\n");
1601                 prom_setprop(node, path, "linux,opened", NULL, 0);
1602
1603                 /* Setup a usable color table when the appropriate
1604                  * method is available. Should update this to set-colors */
1605                 clut = RELOC(default_colors);
1606                 for (i = 0; i < 32; i++, clut += 3)
1607                         if (prom_set_color(ih, i, clut[0], clut[1],
1608                                            clut[2]) != 0)
1609                                 break;
1610
1611 #ifdef CONFIG_LOGO_LINUX_CLUT224
1612                 clut = PTRRELOC(RELOC(logo_linux_clut224.clut));
1613                 for (i = 0; i < RELOC(logo_linux_clut224.clutsize); i++, clut += 3)
1614                         if (prom_set_color(ih, i + 32, clut[0], clut[1],
1615                                            clut[2]) != 0)
1616                                 break;
1617 #endif /* CONFIG_LOGO_LINUX_CLUT224 */
1618         }
1619 }
1620
1621
1622 /* Return (relocated) pointer to this much memory: moves initrd if reqd. */
1623 static void __init *make_room(unsigned long *mem_start, unsigned long *mem_end,
1624                               unsigned long needed, unsigned long align)
1625 {
1626         void *ret;
1627
1628         *mem_start = _ALIGN(*mem_start, align);
1629         while ((*mem_start + needed) > *mem_end) {
1630                 unsigned long room, chunk;
1631
1632                 prom_debug("Chunk exhausted, claiming more at %x...\n",
1633                            RELOC(alloc_bottom));
1634                 room = RELOC(alloc_top) - RELOC(alloc_bottom);
1635                 if (room > DEVTREE_CHUNK_SIZE)
1636                         room = DEVTREE_CHUNK_SIZE;
1637                 if (room < PAGE_SIZE)
1638                         prom_panic("No memory for flatten_device_tree (no room)");
1639                 chunk = alloc_up(room, 0);
1640                 if (chunk == 0)
1641                         prom_panic("No memory for flatten_device_tree (claim failed)");
1642                 *mem_end = RELOC(alloc_top);
1643         }
1644
1645         ret = (void *)*mem_start;
1646         *mem_start += needed;
1647
1648         return ret;
1649 }
1650
1651 #define dt_push_token(token, mem_start, mem_end) \
1652         do { *((u32 *)make_room(mem_start, mem_end, 4, 4)) = token; } while(0)
1653
1654 static unsigned long __init dt_find_string(char *str)
1655 {
1656         char *s, *os;
1657
1658         s = os = (char *)RELOC(dt_string_start);
1659         s += 4;
1660         while (s <  (char *)RELOC(dt_string_end)) {
1661                 if (strcmp(s, str) == 0)
1662                         return s - os;
1663                 s += strlen(s) + 1;
1664         }
1665         return 0;
1666 }
1667
1668 /*
1669  * The Open Firmware 1275 specification states properties must be 31 bytes or
1670  * less, however not all firmwares obey this. Make it 64 bytes to be safe.
1671  */
1672 #define MAX_PROPERTY_NAME 64
1673
1674 static void __init scan_dt_build_strings(phandle node,
1675                                          unsigned long *mem_start,
1676                                          unsigned long *mem_end)
1677 {
1678         char *prev_name, *namep, *sstart;
1679         unsigned long soff;
1680         phandle child;
1681
1682         sstart =  (char *)RELOC(dt_string_start);
1683
1684         /* get and store all property names */
1685         prev_name = RELOC("");
1686         for (;;) {
1687                 /* 64 is max len of name including nul. */
1688                 namep = make_room(mem_start, mem_end, MAX_PROPERTY_NAME, 1);
1689                 if (call_prom("nextprop", 3, 1, node, prev_name, namep) != 1) {
1690                         /* No more nodes: unwind alloc */
1691                         *mem_start = (unsigned long)namep;
1692                         break;
1693                 }
1694
1695                 /* skip "name" */
1696                 if (strcmp(namep, RELOC("name")) == 0) {
1697                         *mem_start = (unsigned long)namep;
1698                         prev_name = RELOC("name");
1699                         continue;
1700                 }
1701                 /* get/create string entry */
1702                 soff = dt_find_string(namep);
1703                 if (soff != 0) {
1704                         *mem_start = (unsigned long)namep;
1705                         namep = sstart + soff;
1706                 } else {
1707                         /* Trim off some if we can */
1708                         *mem_start = (unsigned long)namep + strlen(namep) + 1;
1709                         RELOC(dt_string_end) = *mem_start;
1710                 }
1711                 prev_name = namep;
1712         }
1713
1714         /* do all our children */
1715         child = call_prom("child", 1, 1, node);
1716         while (child != 0) {
1717                 scan_dt_build_strings(child, mem_start, mem_end);
1718                 child = call_prom("peer", 1, 1, child);
1719         }
1720 }
1721
1722 static void __init scan_dt_build_struct(phandle node, unsigned long *mem_start,
1723                                         unsigned long *mem_end)
1724 {
1725         phandle child;
1726         char *namep, *prev_name, *sstart, *p, *ep, *lp, *path;
1727         unsigned long soff;
1728         unsigned char *valp;
1729         static char pname[MAX_PROPERTY_NAME];
1730         int l, room;
1731
1732         dt_push_token(OF_DT_BEGIN_NODE, mem_start, mem_end);
1733
1734         /* get the node's full name */
1735         namep = (char *)*mem_start;
1736         room = *mem_end - *mem_start;
1737         if (room > 255)
1738                 room = 255;
1739         l = call_prom("package-to-path", 3, 1, node, namep, room);
1740         if (l >= 0) {
1741                 /* Didn't fit?  Get more room. */
1742                 if (l >= room) {
1743                         if (l >= *mem_end - *mem_start)
1744                                 namep = make_room(mem_start, mem_end, l+1, 1);
1745                         call_prom("package-to-path", 3, 1, node, namep, l);
1746                 }
1747                 namep[l] = '\0';
1748
1749                 /* Fixup an Apple bug where they have bogus \0 chars in the
1750                  * middle of the path in some properties, and extract
1751                  * the unit name (everything after the last '/').
1752                  */
1753                 for (lp = p = namep, ep = namep + l; p < ep; p++) {
1754                         if (*p == '/')
1755                                 lp = namep;
1756                         else if (*p != 0)
1757                                 *lp++ = *p;
1758                 }
1759                 *lp = 0;
1760                 *mem_start = _ALIGN((unsigned long)lp + 1, 4);
1761         }
1762
1763         /* get it again for debugging */
1764         path = RELOC(prom_scratch);
1765         memset(path, 0, PROM_SCRATCH_SIZE);
1766         call_prom("package-to-path", 3, 1, node, path, PROM_SCRATCH_SIZE-1);
1767
1768         /* get and store all properties */
1769         prev_name = RELOC("");
1770         sstart = (char *)RELOC(dt_string_start);
1771         for (;;) {
1772                 if (call_prom("nextprop", 3, 1, node, prev_name,
1773                               RELOC(pname)) != 1)
1774                         break;
1775
1776                 /* skip "name" */
1777                 if (strcmp(RELOC(pname), RELOC("name")) == 0) {
1778                         prev_name = RELOC("name");
1779                         continue;
1780                 }
1781
1782                 /* find string offset */
1783                 soff = dt_find_string(RELOC(pname));
1784                 if (soff == 0) {
1785                         prom_printf("WARNING: Can't find string index for"
1786                                     " <%s>, node %s\n", RELOC(pname), path);
1787                         break;
1788                 }
1789                 prev_name = sstart + soff;
1790
1791                 /* get length */
1792                 l = call_prom("getproplen", 2, 1, node, RELOC(pname));
1793
1794                 /* sanity checks */
1795                 if (l == PROM_ERROR)
1796                         continue;
1797                 if (l > MAX_PROPERTY_LENGTH) {
1798                         prom_printf("WARNING: ignoring large property ");
1799                         /* It seems OF doesn't null-terminate the path :-( */
1800                         prom_printf("[%s] ", path);
1801                         prom_printf("%s length 0x%x\n", RELOC(pname), l);
1802                         continue;
1803                 }
1804
1805                 /* push property head */
1806                 dt_push_token(OF_DT_PROP, mem_start, mem_end);
1807                 dt_push_token(l, mem_start, mem_end);
1808                 dt_push_token(soff, mem_start, mem_end);
1809
1810                 /* push property content */
1811                 valp = make_room(mem_start, mem_end, l, 4);
1812                 call_prom("getprop", 4, 1, node, RELOC(pname), valp, l);
1813                 *mem_start = _ALIGN(*mem_start, 4);
1814         }
1815
1816         /* Add a "linux,phandle" property. */
1817         soff = dt_find_string(RELOC("linux,phandle"));
1818         if (soff == 0)
1819                 prom_printf("WARNING: Can't find string index for"
1820                             " <linux-phandle> node %s\n", path);
1821         else {
1822                 dt_push_token(OF_DT_PROP, mem_start, mem_end);
1823                 dt_push_token(4, mem_start, mem_end);
1824                 dt_push_token(soff, mem_start, mem_end);
1825                 valp = make_room(mem_start, mem_end, 4, 4);
1826                 *(u32 *)valp = node;
1827         }
1828
1829         /* do all our children */
1830         child = call_prom("child", 1, 1, node);
1831         while (child != 0) {
1832                 scan_dt_build_struct(child, mem_start, mem_end);
1833                 child = call_prom("peer", 1, 1, child);
1834         }
1835
1836         dt_push_token(OF_DT_END_NODE, mem_start, mem_end);
1837 }
1838
1839 static void __init flatten_device_tree(void)
1840 {
1841         phandle root;
1842         unsigned long mem_start, mem_end, room;
1843         struct boot_param_header *hdr;
1844         struct prom_t *_prom = &RELOC(prom);
1845         char *namep;
1846         u64 *rsvmap;
1847
1848         /*
1849          * Check how much room we have between alloc top & bottom (+/- a
1850          * few pages), crop to 4Mb, as this is our "chuck" size
1851          */
1852         room = RELOC(alloc_top) - RELOC(alloc_bottom) - 0x4000;
1853         if (room > DEVTREE_CHUNK_SIZE)
1854                 room = DEVTREE_CHUNK_SIZE;
1855         prom_debug("starting device tree allocs at %x\n", RELOC(alloc_bottom));
1856
1857         /* Now try to claim that */
1858         mem_start = (unsigned long)alloc_up(room, PAGE_SIZE);
1859         if (mem_start == 0)
1860                 prom_panic("Can't allocate initial device-tree chunk\n");
1861         mem_end = RELOC(alloc_top);
1862
1863         /* Get root of tree */
1864         root = call_prom("peer", 1, 1, (phandle)0);
1865         if (root == (phandle)0)
1866                 prom_panic ("couldn't get device tree root\n");
1867
1868         /* Build header and make room for mem rsv map */ 
1869         mem_start = _ALIGN(mem_start, 4);
1870         hdr = make_room(&mem_start, &mem_end,
1871                         sizeof(struct boot_param_header), 4);
1872         RELOC(dt_header_start) = (unsigned long)hdr;
1873         rsvmap = make_room(&mem_start, &mem_end, sizeof(mem_reserve_map), 8);
1874
1875         /* Start of strings */
1876         mem_start = PAGE_ALIGN(mem_start);
1877         RELOC(dt_string_start) = mem_start;
1878         mem_start += 4; /* hole */
1879
1880         /* Add "linux,phandle" in there, we'll need it */
1881         namep = make_room(&mem_start, &mem_end, 16, 1);
1882         strcpy(namep, RELOC("linux,phandle"));
1883         mem_start = (unsigned long)namep + strlen(namep) + 1;
1884
1885         /* Build string array */
1886         prom_printf("Building dt strings...\n"); 
1887         scan_dt_build_strings(root, &mem_start, &mem_end);
1888         RELOC(dt_string_end) = mem_start;
1889
1890         /* Build structure */
1891         mem_start = PAGE_ALIGN(mem_start);
1892         RELOC(dt_struct_start) = mem_start;
1893         prom_printf("Building dt structure...\n"); 
1894         scan_dt_build_struct(root, &mem_start, &mem_end);
1895         dt_push_token(OF_DT_END, &mem_start, &mem_end);
1896         RELOC(dt_struct_end) = PAGE_ALIGN(mem_start);
1897
1898         /* Finish header */
1899         hdr->boot_cpuid_phys = _prom->cpu;
1900         hdr->magic = OF_DT_HEADER;
1901         hdr->totalsize = RELOC(dt_struct_end) - RELOC(dt_header_start);
1902         hdr->off_dt_struct = RELOC(dt_struct_start) - RELOC(dt_header_start);
1903         hdr->off_dt_strings = RELOC(dt_string_start) - RELOC(dt_header_start);
1904         hdr->dt_strings_size = RELOC(dt_string_end) - RELOC(dt_string_start);
1905         hdr->off_mem_rsvmap = ((unsigned long)rsvmap) - RELOC(dt_header_start);
1906         hdr->version = OF_DT_VERSION;
1907         /* Version 16 is not backward compatible */
1908         hdr->last_comp_version = 0x10;
1909
1910         /* Reserve the whole thing and copy the reserve map in, we
1911          * also bump mem_reserve_cnt to cause further reservations to
1912          * fail since it's too late.
1913          */
1914         reserve_mem(RELOC(dt_header_start), hdr->totalsize);
1915         memcpy(rsvmap, RELOC(mem_reserve_map), sizeof(mem_reserve_map));
1916
1917 #ifdef DEBUG_PROM
1918         {
1919                 int i;
1920                 prom_printf("reserved memory map:\n");
1921                 for (i = 0; i < RELOC(mem_reserve_cnt); i++)
1922                         prom_printf("  %x - %x\n",
1923                                     RELOC(mem_reserve_map)[i].base,
1924                                     RELOC(mem_reserve_map)[i].size);
1925         }
1926 #endif
1927         RELOC(mem_reserve_cnt) = MEM_RESERVE_MAP_SIZE;
1928
1929         prom_printf("Device tree strings 0x%x -> 0x%x\n",
1930                     RELOC(dt_string_start), RELOC(dt_string_end)); 
1931         prom_printf("Device tree struct  0x%x -> 0x%x\n",
1932                     RELOC(dt_struct_start), RELOC(dt_struct_end));
1933
1934 }
1935
1936
1937 static void __init fixup_device_tree(void)
1938 {
1939 #if defined(CONFIG_PPC64) && defined(CONFIG_PPC_PMAC)
1940         phandle u3, i2c, mpic;
1941         u32 u3_rev;
1942         u32 interrupts[2];
1943         u32 parent;
1944
1945         /* Some G5s have a missing interrupt definition, fix it up here */
1946         u3 = call_prom("finddevice", 1, 1, ADDR("/u3@0,f8000000"));
1947         if (!PHANDLE_VALID(u3))
1948                 return;
1949         i2c = call_prom("finddevice", 1, 1, ADDR("/u3@0,f8000000/i2c@f8001000"));
1950         if (!PHANDLE_VALID(i2c))
1951                 return;
1952         mpic = call_prom("finddevice", 1, 1, ADDR("/u3@0,f8000000/mpic@f8040000"));
1953         if (!PHANDLE_VALID(mpic))
1954                 return;
1955
1956         /* check if proper rev of u3 */
1957         if (prom_getprop(u3, "device-rev", &u3_rev, sizeof(u3_rev))
1958             == PROM_ERROR)
1959                 return;
1960         if (u3_rev < 0x35 || u3_rev > 0x39)
1961                 return;
1962         /* does it need fixup ? */
1963         if (prom_getproplen(i2c, "interrupts") > 0)
1964                 return;
1965
1966         prom_printf("fixing up bogus interrupts for u3 i2c...\n");
1967
1968         /* interrupt on this revision of u3 is number 0 and level */
1969         interrupts[0] = 0;
1970         interrupts[1] = 1;
1971         prom_setprop(i2c, "/u3@0,f8000000/i2c@f8001000", "interrupts",
1972                      &interrupts, sizeof(interrupts));
1973         parent = (u32)mpic;
1974         prom_setprop(i2c, "/u3@0,f8000000/i2c@f8001000", "interrupt-parent",
1975                      &parent, sizeof(parent));
1976 #endif
1977 }
1978
1979
1980 static void __init prom_find_boot_cpu(void)
1981 {
1982         struct prom_t *_prom = &RELOC(prom);
1983         u32 getprop_rval;
1984         ihandle prom_cpu;
1985         phandle cpu_pkg;
1986
1987         _prom->cpu = 0;
1988         if (prom_getprop(_prom->chosen, "cpu", &prom_cpu, sizeof(prom_cpu)) <= 0)
1989                 return;
1990
1991         cpu_pkg = call_prom("instance-to-package", 1, 1, prom_cpu);
1992
1993         prom_getprop(cpu_pkg, "reg", &getprop_rval, sizeof(getprop_rval));
1994         _prom->cpu = getprop_rval;
1995
1996         prom_debug("Booting CPU hw index = 0x%x\n", _prom->cpu);
1997 }
1998
1999 static void __init prom_check_initrd(unsigned long r3, unsigned long r4)
2000 {
2001 #ifdef CONFIG_BLK_DEV_INITRD
2002         struct prom_t *_prom = &RELOC(prom);
2003
2004         if (r3 && r4 && r4 != 0xdeadbeef) {
2005                 unsigned long val;
2006
2007                 RELOC(prom_initrd_start) = is_kernel_addr(r3) ? __pa(r3) : r3;
2008                 RELOC(prom_initrd_end) = RELOC(prom_initrd_start) + r4;
2009
2010                 val = RELOC(prom_initrd_start);
2011                 prom_setprop(_prom->chosen, "/chosen", "linux,initrd-start",
2012                              &val, sizeof(val));
2013                 val = RELOC(prom_initrd_end);
2014                 prom_setprop(_prom->chosen, "/chosen", "linux,initrd-end",
2015                              &val, sizeof(val));
2016
2017                 reserve_mem(RELOC(prom_initrd_start),
2018                             RELOC(prom_initrd_end) - RELOC(prom_initrd_start));
2019
2020                 prom_debug("initrd_start=0x%x\n", RELOC(prom_initrd_start));
2021                 prom_debug("initrd_end=0x%x\n", RELOC(prom_initrd_end));
2022         }
2023 #endif /* CONFIG_BLK_DEV_INITRD */
2024 }
2025
2026 /*
2027  * We enter here early on, when the Open Firmware prom is still
2028  * handling exceptions and the MMU hash table for us.
2029  */
2030
2031 unsigned long __init prom_init(unsigned long r3, unsigned long r4,
2032                                unsigned long pp,
2033                                unsigned long r6, unsigned long r7)
2034 {       
2035         struct prom_t *_prom;
2036         unsigned long hdr;
2037         u32 getprop_rval;
2038         unsigned long offset = reloc_offset();
2039
2040 #ifdef CONFIG_PPC32
2041         reloc_got2(offset);
2042 #endif
2043
2044         _prom = &RELOC(prom);
2045
2046         /*
2047          * First zero the BSS
2048          */
2049         memset(&RELOC(__bss_start), 0, __bss_stop - __bss_start);
2050
2051         /*
2052          * Init interface to Open Firmware, get some node references,
2053          * like /chosen
2054          */
2055         prom_init_client_services(pp);
2056
2057         /*
2058          * See if this OF is old enough that we need to do explicit maps
2059          * and other workarounds
2060          */
2061         prom_find_mmu();
2062
2063         /*
2064          * Init prom stdout device
2065          */
2066         prom_init_stdout();
2067
2068         /*
2069          * Get default machine type. At this point, we do not differentiate
2070          * between pSeries SMP and pSeries LPAR
2071          */
2072         RELOC(of_platform) = prom_find_machine_type();
2073         getprop_rval = RELOC(of_platform);
2074         prom_setprop(_prom->chosen, "/chosen", "linux,platform",
2075                      &getprop_rval, sizeof(getprop_rval));
2076
2077         /* Bail if this is a kdump kernel. */
2078         if (PHYSICAL_START > 0)
2079                 prom_panic("Error: You can't boot a kdump kernel from OF!\n");
2080
2081         /*
2082          * Check for an initrd
2083          */
2084         prom_check_initrd(r3, r4);
2085
2086 #ifdef CONFIG_PPC_PSERIES
2087         /*
2088          * On pSeries, inform the firmware about our capabilities
2089          */
2090         if (RELOC(of_platform) == PLATFORM_PSERIES ||
2091             RELOC(of_platform) == PLATFORM_PSERIES_LPAR)
2092                 prom_send_capabilities();
2093 #endif
2094
2095         /*
2096          * Copy the CPU hold code
2097          */
2098         if (RELOC(of_platform) != PLATFORM_POWERMAC)
2099                 copy_and_flush(0, KERNELBASE + offset, 0x100, 0);
2100
2101         /*
2102          * Do early parsing of command line
2103          */
2104         early_cmdline_parse();
2105
2106         /*
2107          * Initialize memory management within prom_init
2108          */
2109         prom_init_mem();
2110
2111 #ifdef CONFIG_KEXEC
2112         if (RELOC(prom_crashk_base))
2113                 reserve_mem(RELOC(prom_crashk_base), RELOC(prom_crashk_size));
2114 #endif
2115         /*
2116          * Determine which cpu is actually running right _now_
2117          */
2118         prom_find_boot_cpu();
2119
2120         /* 
2121          * Initialize display devices
2122          */
2123         prom_check_displays();
2124
2125 #ifdef CONFIG_PPC64
2126         /*
2127          * Initialize IOMMU (TCE tables) on pSeries. Do that before anything else
2128          * that uses the allocator, we need to make sure we get the top of memory
2129          * available for us here...
2130          */
2131         if (RELOC(of_platform) == PLATFORM_PSERIES)
2132                 prom_initialize_tce_table();
2133 #endif
2134
2135         /*
2136          * On non-powermacs, try to instantiate RTAS and puts all CPUs
2137          * in spin-loops. PowerMacs don't have a working RTAS and use
2138          * a different way to spin CPUs
2139          */
2140         if (RELOC(of_platform) != PLATFORM_POWERMAC) {
2141                 prom_instantiate_rtas();
2142                 prom_hold_cpus();
2143         }
2144
2145         /*
2146          * Fill in some infos for use by the kernel later on
2147          */
2148         if (RELOC(prom_memory_limit))
2149                 prom_setprop(_prom->chosen, "/chosen", "linux,memory-limit",
2150                              &RELOC(prom_memory_limit),
2151                              sizeof(prom_memory_limit));
2152 #ifdef CONFIG_PPC64
2153         if (RELOC(ppc64_iommu_off))
2154                 prom_setprop(_prom->chosen, "/chosen", "linux,iommu-off",
2155                              NULL, 0);
2156
2157         if (RELOC(iommu_force_on))
2158                 prom_setprop(_prom->chosen, "/chosen", "linux,iommu-force-on",
2159                              NULL, 0);
2160
2161         if (RELOC(prom_tce_alloc_start)) {
2162                 prom_setprop(_prom->chosen, "/chosen", "linux,tce-alloc-start",
2163                              &RELOC(prom_tce_alloc_start),
2164                              sizeof(prom_tce_alloc_start));
2165                 prom_setprop(_prom->chosen, "/chosen", "linux,tce-alloc-end",
2166                              &RELOC(prom_tce_alloc_end),
2167                              sizeof(prom_tce_alloc_end));
2168         }
2169 #endif
2170
2171 #ifdef CONFIG_KEXEC
2172         if (RELOC(prom_crashk_base)) {
2173                 prom_setprop(_prom->chosen, "/chosen", "linux,crashkernel-base",
2174                         PTRRELOC(&prom_crashk_base),
2175                         sizeof(RELOC(prom_crashk_base)));
2176                 prom_setprop(_prom->chosen, "/chosen", "linux,crashkernel-size",
2177                         PTRRELOC(&prom_crashk_size),
2178                         sizeof(RELOC(prom_crashk_size)));
2179         }
2180 #endif
2181         /*
2182          * Fixup any known bugs in the device-tree
2183          */
2184         fixup_device_tree();
2185
2186         /*
2187          * Now finally create the flattened device-tree
2188          */
2189         prom_printf("copying OF device tree ...\n");
2190         flatten_device_tree();
2191
2192         /*
2193          * in case stdin is USB and still active on IBM machines...
2194          * Unfortunately quiesce crashes on some powermacs if we have
2195          * closed stdin already (in particular the powerbook 101).
2196          */
2197         if (RELOC(of_platform) != PLATFORM_POWERMAC)
2198                 prom_close_stdin();
2199
2200         /*
2201          * Call OF "quiesce" method to shut down pending DMA's from
2202          * devices etc...
2203          */
2204         prom_printf("Calling quiesce ...\n");
2205         call_prom("quiesce", 0, 0);
2206
2207         /*
2208          * And finally, call the kernel passing it the flattened device
2209          * tree and NULL as r5, thus triggering the new entry point which
2210          * is common to us and kexec
2211          */
2212         hdr = RELOC(dt_header_start);
2213         prom_printf("returning from prom_init\n");
2214         prom_debug("->dt_header_start=0x%x\n", hdr);
2215
2216 #ifdef CONFIG_PPC32
2217         reloc_got2(-offset);
2218 #endif
2219
2220         __start(hdr, KERNELBASE + offset, 0);
2221
2222         return 0;
2223 }