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