[PATCH] powerpc: Fix platinumfb for some modes
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / powerpc / kernel / prom_init.c
CommitLineData
9b6b563c
PM
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>
9b6b563c
PM
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>
50extern 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))
a23414be 97#define OF_WORKAROUNDS 0
9b6b563c
PM
98#else
99#define RELOC(x) (x)
100#define ADDR(x) (u32) (x)
a23414be
PM
101#define OF_WORKAROUNDS of_workarounds
102int of_workarounds;
9b6b563c
PM
103#endif
104
a23414be
PM
105#define OF_WA_CLAIM 1 /* do phys/virt claim separately, then map */
106#define OF_WA_LONGTRAIL 2 /* work around longtrail bugs */
107
9b6b563c
PM
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
9b6b563c
PM
120
121typedef u32 prom_arg_t;
122
123struct prom_args {
124 u32 service;
125 u32 nargs;
126 u32 nret;
127 prom_arg_t args[10];
128};
129
130struct prom_t {
131 ihandle root;
a23414be 132 phandle chosen;
9b6b563c
PM
133 int cpu;
134 ihandle stdout;
a575b807 135 ihandle mmumap;
a23414be 136 ihandle memory;
9b6b563c
PM
137};
138
139struct mem_map_entry {
140 unsigned long base;
141 unsigned long size;
142};
143
144typedef u32 cell_t;
145
146extern void __start(unsigned long r3, unsigned long r4, unsigned long r5);
147
148#ifdef CONFIG_PPC64
c4988820 149extern int enter_prom(struct prom_args *args, unsigned long entry);
9b6b563c 150#else
c4988820 151static inline int enter_prom(struct prom_args *args, unsigned long entry)
9b6b563c 152{
c4988820 153 return ((int (*)(struct prom_args *))entry)(args);
9b6b563c
PM
154}
155#endif
156
157extern void copy_and_flush(unsigned long dest, unsigned long src,
158 unsigned long size, unsigned long offset);
159
160/* prom structure */
161static struct prom_t __initdata prom;
162
163static unsigned long prom_entry __initdata;
164
165#define PROM_SCRATCH_SIZE 256
166
167static char __initdata of_stdout_device[256];
168static char __initdata prom_scratch[PROM_SCRATCH_SIZE];
169
170static unsigned long __initdata dt_header_start;
171static unsigned long __initdata dt_struct_start, dt_struct_end;
172static unsigned long __initdata dt_string_start, dt_string_end;
173
174static unsigned long __initdata prom_initrd_start, prom_initrd_end;
175
176#ifdef CONFIG_PPC64
177static int __initdata iommu_force_on;
178static int __initdata ppc64_iommu_off;
179static unsigned long __initdata prom_tce_alloc_start;
180static unsigned long __initdata prom_tce_alloc_end;
181#endif
182
183static int __initdata of_platform;
184
185static char __initdata prom_cmd_line[COMMAND_LINE_SIZE];
186
187static unsigned long __initdata prom_memory_limit;
188
189static unsigned long __initdata alloc_top;
190static unsigned long __initdata alloc_top_high;
191static unsigned long __initdata alloc_bottom;
192static unsigned long __initdata rmo_top;
193static unsigned long __initdata ram_top;
194
dcee3036
ME
195#ifdef CONFIG_KEXEC
196static unsigned long __initdata prom_crashk_base;
197static unsigned long __initdata prom_crashk_size;
198#endif
199
9b6b563c
PM
200static struct mem_map_entry __initdata mem_reserve_map[MEM_RESERVE_MAP_SIZE];
201static int __initdata mem_reserve_cnt;
202
203static cell_t __initdata regbuf[1024];
204
205
206#define MAX_CPU_THREADS 2
207
208/* TO GO */
209#ifdef CONFIG_HMT
210struct {
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
232static 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
c4988820
PM
250 if (enter_prom(&args, RELOC(prom_entry)) < 0)
251 return PROM_ERROR;
9b6b563c
PM
252
253 return (nret > 0) ? args.args[nargs] : 0;
254}
255
256static 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++)
ed1189b7 273 args.args[nargs+i] = 0;
9b6b563c 274
c4988820
PM
275 if (enter_prom(&args, RELOC(prom_entry)) < 0)
276 return PROM_ERROR;
9b6b563c
PM
277
278 if (rets != NULL)
279 for (i = 1; i < nret; ++i)
c5200c90 280 rets[i-1] = args.args[nargs+i];
9b6b563c
PM
281
282 return (nret > 0) ? args.args[nargs] : 0;
283}
284
285
9b6b563c
PM
286static 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
307static 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
324static 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
a575b807
PM
367static unsigned int __init prom_claim(unsigned long virt, unsigned long size,
368 unsigned long align)
369{
a575b807
PM
370 struct prom_t *_prom = &RELOC(prom);
371
a23414be
PM
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 */
a575b807 394 call_prom("call-method", 6, 1,
a23414be
PM
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);
a575b807
PM
400}
401
9b6b563c
PM
402static 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
416static 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
21fe3301 433static int inline prom_getprop(phandle node, const char *pname,
9b6b563c
PM
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
21fe3301 440static int inline prom_getproplen(phandle node, const char *pname)
9b6b563c
PM
441{
442 return call_prom("getproplen", 2, 1, node, ADDR(pname));
443}
444
a23414be 445static void add_string(char **str, const char *q)
9b6b563c 446{
a23414be
PM
447 char *p = *str;
448
449 while (*q)
450 *p++ = *q++;
451 *p++ = ' ';
452 *str = p;
453}
454
455static 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
471static 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);
9b6b563c
PM
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
502unsigned 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
527unsigned 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 */
558static 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 }
dcee3036
ME
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
9b6b563c
PM
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 */
634static 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
720static 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 */
768static unsigned long __init alloc_up(unsigned long size, unsigned long align)
769{
c4988820 770 unsigned long base = RELOC(alloc_bottom);
9b6b563c
PM
771 unsigned long addr = 0;
772
c4988820
PM
773 if (align)
774 base = _ALIGN_UP(base, align);
9b6b563c
PM
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);
c4988820 788 if (addr != PROM_ERROR && addr != 0)
9b6b563c
PM
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 */
813static 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);
c4988820 848 if (addr != PROM_ERROR && addr != 0)
9b6b563c
PM
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 */
870static 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
35499c01 882 if (s > 1) {
9b6b563c
PM
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 */
899static 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 */
926static 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
c4988820
PM
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 }
9b6b563c
PM
961 if (strcmp(type, RELOC("memory")))
962 continue;
c4988820 963
9b6b563c
PM
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));
dcee3036
ME
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
9b6b563c
PM
1053}
1054
1055
1056/*
1057 * Allocate room for and instantiate RTAS
1058 */
1059static 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)) {
a23414be 1085 prom_printf("opening rtas package failed (%x)\n", rtas_inst);
9b6b563c
PM
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"),
a23414be 1093 rtas_inst, base) != 0
9b6b563c
PM
1094 || entry == 0) {
1095 prom_printf(" failed\n");
1096 return;
1097 }
1098 prom_printf(" done\n");
1099
1100 reserve_mem(base, size);
1101
a23414be
PM
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));
9b6b563c
PM
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 */
1118static 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
9b6b563c
PM
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
a23414be
PM
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
9b6b563c
PM
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 */
bbd0abda
PM
1272extern void __secondary_hold(void);
1273extern unsigned long __secondary_hold_spinloop;
1274extern 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
9b6b563c
PM
1282static void __init prom_hold_cpus(void)
1283{
9b6b563c
PM
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;
bbd0abda 1292 struct prom_t *_prom = &RELOC(prom);
9b6b563c 1293 unsigned long *spinloop
bbd0abda 1294 = (void *) LOW_ADDR(__secondary_hold_spinloop);
9b6b563c 1295 unsigned long *acknowledge
bbd0abda 1296 = (void *) LOW_ADDR(__secondary_hold_acknowledge);
9b6b563c 1297#ifdef CONFIG_PPC64
bbd0abda 1298 /* __secondary_hold is actually a descriptor, not the text address */
9b6b563c
PM
1299 unsigned long secondary_hold
1300 = __pa(*PTRRELOC((unsigned long *)__secondary_hold));
1301#else
bbd0abda 1302 unsigned long secondary_hold = LOW_ADDR(__secondary_hold);
9b6b563c 1303#endif
9b6b563c
PM
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
bbd0abda 1321 for (i = 0; i < NR_CPUS; i++)
9b6b563c 1322 RELOC(hmt_thread_data)[i].pir = 0xdeadbeef;
9b6b563c
PM
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
bbd0abda
PM
1373 for (i = 0; (i < 100000000) &&
1374 (*acknowledge == ((unsigned long)-1)); i++ )
9b6b563c
PM
1375 mb();
1376
bbd0abda 1377 if (*acknowledge == reg)
9b6b563c 1378 prom_printf("done\n");
bbd0abda 1379 else
9b6b563c 1380 prom_printf("failed: %x\n", *acknowledge);
9b6b563c
PM
1381 }
1382#ifdef CONFIG_SMP
1383 else
1384 prom_printf("%x : boot cpu %x\n", cpuid, reg);
9b6b563c 1385#endif /* CONFIG_SMP */
bbd0abda
PM
1386
1387 /* Reserve cpu #s for secondary threads. They start later. */
1388 cpuid += cpu_threads;
9b6b563c
PM
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");
9b6b563c
PM
1422}
1423
1424
1425static 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 :( */
a575b807
PM
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.
a23414be 1449 * Also, on the longtrail, we need to work around other bugs.
a575b807
PM
1450 */
1451static 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;
a575b807 1463 /* XXX might need to add other versions here */
a23414be
PM
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
a575b807 1470 return;
a23414be 1471 _prom->memory = call_prom("open", 1, 1, ADDR("/memory"));
a575b807
PM
1472 prom_getprop(_prom->chosen, "mmu", &_prom->mmumap,
1473 sizeof(_prom->mmumap));
a23414be
PM
1474 if (!IHANDLE_VALID(_prom->memory) || !IHANDLE_VALID(_prom->mmumap))
1475 of_workarounds &= ~OF_WA_CLAIM; /* hmmm */
9b6b563c 1476}
a575b807
PM
1477#else
1478#define prom_find_mmu()
1479#endif
9b6b563c
PM
1480
1481static 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);
a23414be
PM
1497 prom_setprop(_prom->chosen, "/chosen", "linux,stdout-package",
1498 &val, sizeof(val));
9b6b563c 1499 prom_printf("OF stdout device is: %s\n", RELOC(of_stdout_device));
a23414be
PM
1500 prom_setprop(_prom->chosen, "/chosen", "linux,stdout-path",
1501 path, strlen(path) + 1);
9b6b563c
PM
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)
a23414be 1507 prom_setprop(val, path, "linux,boot-display", NULL, 0);
9b6b563c
PM
1508}
1509
1510static 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
1519static int __init prom_find_machine_type(void)
1520{
1521 struct prom_t *_prom = &RELOC(prom);
1522 char compat[256];
1523 int len, i = 0;
21fe3301 1524#ifdef CONFIG_PPC64
9b6b563c 1525 phandle rtas;
21fe3301 1526#endif
9b6b563c
PM
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")) ||
a575b807 1537 strstr(p, RELOC("MacRISC")))
9b6b563c
PM
1538 return PLATFORM_POWERMAC;
1539#ifdef CONFIG_PPC64
1540 if (strstr(p, RELOC("Momentum,Maple")))
1541 return PLATFORM_MAPLE;
dad482c2
AB
1542 if (strstr(p, RELOC("IBM,CPB")))
1543 return PLATFORM_CELL;
9b6b563c
PM
1544#endif
1545 i += sl + 1;
1546 }
1547 }
1548#ifdef CONFIG_PPC64
1549 /* Default to pSeries. We need to know if we are running LPAR */
1550 rtas = call_prom("finddevice", 1, 1, ADDR("/rtas"));
1551 if (PHANDLE_VALID(rtas)) {
1552 int x = prom_getproplen(rtas, "ibm,hypertas-functions");
1553 if (x != PROM_ERROR) {
1554 prom_printf("Hypertas detected, assuming LPAR !\n");
1555 return PLATFORM_PSERIES_LPAR;
1556 }
1557 }
1558 return PLATFORM_PSERIES;
1559#else
1560 return PLATFORM_CHRP;
1561#endif
1562}
1563
9b6b563c
PM
1564static int __init prom_set_color(ihandle ih, int i, int r, int g, int b)
1565{
1566 return call_prom("call-method", 6, 1, ADDR("color!"), ih, i, b, g, r);
1567}
1568
1569/*
1570 * If we have a display that we don't know how to drive,
1571 * we will want to try to execute OF's open method for it
1572 * later. However, OF will probably fall over if we do that
1573 * we've taken over the MMU.
1574 * So we check whether we will need to open the display,
1575 * and if so, open it now.
1576 */
1577static void __init prom_check_displays(void)
1578{
1579 char type[16], *path;
1580 phandle node;
1581 ihandle ih;
1582 int i;
9b6b563c
PM
1583
1584 static unsigned char default_colors[] = {
1585 0x00, 0x00, 0x00,
1586 0x00, 0x00, 0xaa,
1587 0x00, 0xaa, 0x00,
1588 0x00, 0xaa, 0xaa,
1589 0xaa, 0x00, 0x00,
1590 0xaa, 0x00, 0xaa,
1591 0xaa, 0xaa, 0x00,
1592 0xaa, 0xaa, 0xaa,
1593 0x55, 0x55, 0x55,
1594 0x55, 0x55, 0xff,
1595 0x55, 0xff, 0x55,
1596 0x55, 0xff, 0xff,
1597 0xff, 0x55, 0x55,
1598 0xff, 0x55, 0xff,
1599 0xff, 0xff, 0x55,
1600 0xff, 0xff, 0xff
1601 };
1602 const unsigned char *clut;
1603
1604 prom_printf("Looking for displays\n");
1605 for (node = 0; prom_next_node(&node); ) {
1606 memset(type, 0, sizeof(type));
1607 prom_getprop(node, "device_type", type, sizeof(type));
1608 if (strcmp(type, RELOC("display")) != 0)
1609 continue;
1610
1611 /* It seems OF doesn't null-terminate the path :-( */
1612 path = RELOC(prom_scratch);
1613 memset(path, 0, PROM_SCRATCH_SIZE);
1614
1615 /*
1616 * leave some room at the end of the path for appending extra
1617 * arguments
1618 */
1619 if (call_prom("package-to-path", 3, 1, node, path,
1620 PROM_SCRATCH_SIZE-10) == PROM_ERROR)
1621 continue;
1622 prom_printf("found display : %s, opening ... ", path);
1623
1624 ih = call_prom("open", 1, 1, path);
1625 if (ih == 0) {
1626 prom_printf("failed\n");
1627 continue;
1628 }
1629
1630 /* Success */
1631 prom_printf("done\n");
a23414be 1632 prom_setprop(node, path, "linux,opened", NULL, 0);
9b6b563c
PM
1633
1634 /* Setup a usable color table when the appropriate
1635 * method is available. Should update this to set-colors */
1636 clut = RELOC(default_colors);
1637 for (i = 0; i < 32; i++, clut += 3)
1638 if (prom_set_color(ih, i, clut[0], clut[1],
1639 clut[2]) != 0)
1640 break;
1641
1642#ifdef CONFIG_LOGO_LINUX_CLUT224
1643 clut = PTRRELOC(RELOC(logo_linux_clut224.clut));
1644 for (i = 0; i < RELOC(logo_linux_clut224.clutsize); i++, clut += 3)
1645 if (prom_set_color(ih, i + 32, clut[0], clut[1],
1646 clut[2]) != 0)
1647 break;
1648#endif /* CONFIG_LOGO_LINUX_CLUT224 */
9b6b563c
PM
1649 }
1650}
1651
1652
1653/* Return (relocated) pointer to this much memory: moves initrd if reqd. */
1654static void __init *make_room(unsigned long *mem_start, unsigned long *mem_end,
1655 unsigned long needed, unsigned long align)
1656{
1657 void *ret;
1658
1659 *mem_start = _ALIGN(*mem_start, align);
1660 while ((*mem_start + needed) > *mem_end) {
1661 unsigned long room, chunk;
1662
1663 prom_debug("Chunk exhausted, claiming more at %x...\n",
1664 RELOC(alloc_bottom));
1665 room = RELOC(alloc_top) - RELOC(alloc_bottom);
1666 if (room > DEVTREE_CHUNK_SIZE)
1667 room = DEVTREE_CHUNK_SIZE;
1668 if (room < PAGE_SIZE)
1669 prom_panic("No memory for flatten_device_tree (no room)");
1670 chunk = alloc_up(room, 0);
1671 if (chunk == 0)
1672 prom_panic("No memory for flatten_device_tree (claim failed)");
1673 *mem_end = RELOC(alloc_top);
1674 }
1675
1676 ret = (void *)*mem_start;
1677 *mem_start += needed;
1678
1679 return ret;
1680}
1681
1682#define dt_push_token(token, mem_start, mem_end) \
1683 do { *((u32 *)make_room(mem_start, mem_end, 4, 4)) = token; } while(0)
1684
1685static unsigned long __init dt_find_string(char *str)
1686{
1687 char *s, *os;
1688
1689 s = os = (char *)RELOC(dt_string_start);
1690 s += 4;
1691 while (s < (char *)RELOC(dt_string_end)) {
1692 if (strcmp(s, str) == 0)
1693 return s - os;
1694 s += strlen(s) + 1;
1695 }
1696 return 0;
1697}
1698
1699/*
1700 * The Open Firmware 1275 specification states properties must be 31 bytes or
1701 * less, however not all firmwares obey this. Make it 64 bytes to be safe.
1702 */
1703#define MAX_PROPERTY_NAME 64
1704
1705static void __init scan_dt_build_strings(phandle node,
1706 unsigned long *mem_start,
1707 unsigned long *mem_end)
1708{
1709 char *prev_name, *namep, *sstart;
1710 unsigned long soff;
1711 phandle child;
1712
1713 sstart = (char *)RELOC(dt_string_start);
1714
1715 /* get and store all property names */
1716 prev_name = RELOC("");
1717 for (;;) {
1718 /* 64 is max len of name including nul. */
1719 namep = make_room(mem_start, mem_end, MAX_PROPERTY_NAME, 1);
1720 if (call_prom("nextprop", 3, 1, node, prev_name, namep) != 1) {
1721 /* No more nodes: unwind alloc */
1722 *mem_start = (unsigned long)namep;
1723 break;
1724 }
1725
1726 /* skip "name" */
1727 if (strcmp(namep, RELOC("name")) == 0) {
1728 *mem_start = (unsigned long)namep;
1729 prev_name = RELOC("name");
1730 continue;
1731 }
1732 /* get/create string entry */
1733 soff = dt_find_string(namep);
1734 if (soff != 0) {
1735 *mem_start = (unsigned long)namep;
1736 namep = sstart + soff;
1737 } else {
1738 /* Trim off some if we can */
1739 *mem_start = (unsigned long)namep + strlen(namep) + 1;
1740 RELOC(dt_string_end) = *mem_start;
1741 }
1742 prev_name = namep;
1743 }
1744
1745 /* do all our children */
1746 child = call_prom("child", 1, 1, node);
1747 while (child != 0) {
1748 scan_dt_build_strings(child, mem_start, mem_end);
1749 child = call_prom("peer", 1, 1, child);
1750 }
1751}
1752
1753static void __init scan_dt_build_struct(phandle node, unsigned long *mem_start,
1754 unsigned long *mem_end)
1755{
1756 phandle child;
1757 char *namep, *prev_name, *sstart, *p, *ep, *lp, *path;
1758 unsigned long soff;
1759 unsigned char *valp;
1760 static char pname[MAX_PROPERTY_NAME];
c4988820 1761 int l, room;
9b6b563c
PM
1762
1763 dt_push_token(OF_DT_BEGIN_NODE, mem_start, mem_end);
1764
1765 /* get the node's full name */
1766 namep = (char *)*mem_start;
c4988820
PM
1767 room = *mem_end - *mem_start;
1768 if (room > 255)
1769 room = 255;
1770 l = call_prom("package-to-path", 3, 1, node, namep, room);
9b6b563c
PM
1771 if (l >= 0) {
1772 /* Didn't fit? Get more room. */
c4988820
PM
1773 if (l >= room) {
1774 if (l >= *mem_end - *mem_start)
1775 namep = make_room(mem_start, mem_end, l+1, 1);
9b6b563c
PM
1776 call_prom("package-to-path", 3, 1, node, namep, l);
1777 }
1778 namep[l] = '\0';
1779
1780 /* Fixup an Apple bug where they have bogus \0 chars in the
a575b807
PM
1781 * middle of the path in some properties, and extract
1782 * the unit name (everything after the last '/').
9b6b563c 1783 */
a575b807 1784 for (lp = p = namep, ep = namep + l; p < ep; p++) {
9b6b563c 1785 if (*p == '/')
a575b807
PM
1786 lp = namep;
1787 else if (*p != 0)
1788 *lp++ = *p;
1789 }
1790 *lp = 0;
1791 *mem_start = _ALIGN((unsigned long)lp + 1, 4);
9b6b563c
PM
1792 }
1793
1794 /* get it again for debugging */
1795 path = RELOC(prom_scratch);
1796 memset(path, 0, PROM_SCRATCH_SIZE);
1797 call_prom("package-to-path", 3, 1, node, path, PROM_SCRATCH_SIZE-1);
1798
1799 /* get and store all properties */
1800 prev_name = RELOC("");
1801 sstart = (char *)RELOC(dt_string_start);
1802 for (;;) {
1803 if (call_prom("nextprop", 3, 1, node, prev_name,
1804 RELOC(pname)) != 1)
1805 break;
1806
1807 /* skip "name" */
1808 if (strcmp(RELOC(pname), RELOC("name")) == 0) {
1809 prev_name = RELOC("name");
1810 continue;
1811 }
1812
1813 /* find string offset */
1814 soff = dt_find_string(RELOC(pname));
1815 if (soff == 0) {
1816 prom_printf("WARNING: Can't find string index for"
1817 " <%s>, node %s\n", RELOC(pname), path);
1818 break;
1819 }
1820 prev_name = sstart + soff;
1821
1822 /* get length */
1823 l = call_prom("getproplen", 2, 1, node, RELOC(pname));
1824
1825 /* sanity checks */
1826 if (l == PROM_ERROR)
1827 continue;
1828 if (l > MAX_PROPERTY_LENGTH) {
1829 prom_printf("WARNING: ignoring large property ");
1830 /* It seems OF doesn't null-terminate the path :-( */
1831 prom_printf("[%s] ", path);
1832 prom_printf("%s length 0x%x\n", RELOC(pname), l);
1833 continue;
1834 }
1835
1836 /* push property head */
1837 dt_push_token(OF_DT_PROP, mem_start, mem_end);
1838 dt_push_token(l, mem_start, mem_end);
1839 dt_push_token(soff, mem_start, mem_end);
1840
1841 /* push property content */
1842 valp = make_room(mem_start, mem_end, l, 4);
1843 call_prom("getprop", 4, 1, node, RELOC(pname), valp, l);
1844 *mem_start = _ALIGN(*mem_start, 4);
1845 }
1846
1847 /* Add a "linux,phandle" property. */
1848 soff = dt_find_string(RELOC("linux,phandle"));
1849 if (soff == 0)
1850 prom_printf("WARNING: Can't find string index for"
1851 " <linux-phandle> node %s\n", path);
1852 else {
1853 dt_push_token(OF_DT_PROP, mem_start, mem_end);
1854 dt_push_token(4, mem_start, mem_end);
1855 dt_push_token(soff, mem_start, mem_end);
1856 valp = make_room(mem_start, mem_end, 4, 4);
1857 *(u32 *)valp = node;
1858 }
1859
1860 /* do all our children */
1861 child = call_prom("child", 1, 1, node);
1862 while (child != 0) {
1863 scan_dt_build_struct(child, mem_start, mem_end);
1864 child = call_prom("peer", 1, 1, child);
1865 }
1866
1867 dt_push_token(OF_DT_END_NODE, mem_start, mem_end);
1868}
1869
1870static void __init flatten_device_tree(void)
1871{
1872 phandle root;
1873 unsigned long mem_start, mem_end, room;
1874 struct boot_param_header *hdr;
1875 struct prom_t *_prom = &RELOC(prom);
1876 char *namep;
1877 u64 *rsvmap;
1878
1879 /*
1880 * Check how much room we have between alloc top & bottom (+/- a
1881 * few pages), crop to 4Mb, as this is our "chuck" size
1882 */
1883 room = RELOC(alloc_top) - RELOC(alloc_bottom) - 0x4000;
1884 if (room > DEVTREE_CHUNK_SIZE)
1885 room = DEVTREE_CHUNK_SIZE;
1886 prom_debug("starting device tree allocs at %x\n", RELOC(alloc_bottom));
1887
1888 /* Now try to claim that */
1889 mem_start = (unsigned long)alloc_up(room, PAGE_SIZE);
1890 if (mem_start == 0)
1891 prom_panic("Can't allocate initial device-tree chunk\n");
1892 mem_end = RELOC(alloc_top);
1893
1894 /* Get root of tree */
1895 root = call_prom("peer", 1, 1, (phandle)0);
1896 if (root == (phandle)0)
1897 prom_panic ("couldn't get device tree root\n");
1898
1899 /* Build header and make room for mem rsv map */
1900 mem_start = _ALIGN(mem_start, 4);
1901 hdr = make_room(&mem_start, &mem_end,
1902 sizeof(struct boot_param_header), 4);
1903 RELOC(dt_header_start) = (unsigned long)hdr;
1904 rsvmap = make_room(&mem_start, &mem_end, sizeof(mem_reserve_map), 8);
1905
1906 /* Start of strings */
1907 mem_start = PAGE_ALIGN(mem_start);
1908 RELOC(dt_string_start) = mem_start;
1909 mem_start += 4; /* hole */
1910
1911 /* Add "linux,phandle" in there, we'll need it */
1912 namep = make_room(&mem_start, &mem_end, 16, 1);
1913 strcpy(namep, RELOC("linux,phandle"));
1914 mem_start = (unsigned long)namep + strlen(namep) + 1;
1915
1916 /* Build string array */
1917 prom_printf("Building dt strings...\n");
1918 scan_dt_build_strings(root, &mem_start, &mem_end);
1919 RELOC(dt_string_end) = mem_start;
1920
1921 /* Build structure */
1922 mem_start = PAGE_ALIGN(mem_start);
1923 RELOC(dt_struct_start) = mem_start;
1924 prom_printf("Building dt structure...\n");
1925 scan_dt_build_struct(root, &mem_start, &mem_end);
1926 dt_push_token(OF_DT_END, &mem_start, &mem_end);
1927 RELOC(dt_struct_end) = PAGE_ALIGN(mem_start);
1928
1929 /* Finish header */
1930 hdr->boot_cpuid_phys = _prom->cpu;
1931 hdr->magic = OF_DT_HEADER;
1932 hdr->totalsize = RELOC(dt_struct_end) - RELOC(dt_header_start);
1933 hdr->off_dt_struct = RELOC(dt_struct_start) - RELOC(dt_header_start);
1934 hdr->off_dt_strings = RELOC(dt_string_start) - RELOC(dt_header_start);
1935 hdr->dt_strings_size = RELOC(dt_string_end) - RELOC(dt_string_start);
1936 hdr->off_mem_rsvmap = ((unsigned long)rsvmap) - RELOC(dt_header_start);
1937 hdr->version = OF_DT_VERSION;
1938 /* Version 16 is not backward compatible */
1939 hdr->last_comp_version = 0x10;
1940
1941 /* Reserve the whole thing and copy the reserve map in, we
1942 * also bump mem_reserve_cnt to cause further reservations to
1943 * fail since it's too late.
1944 */
1945 reserve_mem(RELOC(dt_header_start), hdr->totalsize);
1946 memcpy(rsvmap, RELOC(mem_reserve_map), sizeof(mem_reserve_map));
1947
1948#ifdef DEBUG_PROM
1949 {
1950 int i;
1951 prom_printf("reserved memory map:\n");
1952 for (i = 0; i < RELOC(mem_reserve_cnt); i++)
1953 prom_printf(" %x - %x\n",
1954 RELOC(mem_reserve_map)[i].base,
1955 RELOC(mem_reserve_map)[i].size);
1956 }
1957#endif
1958 RELOC(mem_reserve_cnt) = MEM_RESERVE_MAP_SIZE;
1959
1960 prom_printf("Device tree strings 0x%x -> 0x%x\n",
1961 RELOC(dt_string_start), RELOC(dt_string_end));
1962 prom_printf("Device tree struct 0x%x -> 0x%x\n",
1963 RELOC(dt_struct_start), RELOC(dt_struct_end));
1964
1965}
1966
1967
1968static void __init fixup_device_tree(void)
1969{
1970#if defined(CONFIG_PPC64) && defined(CONFIG_PPC_PMAC)
1971 phandle u3, i2c, mpic;
1972 u32 u3_rev;
1973 u32 interrupts[2];
1974 u32 parent;
1975
1976 /* Some G5s have a missing interrupt definition, fix it up here */
1977 u3 = call_prom("finddevice", 1, 1, ADDR("/u3@0,f8000000"));
1978 if (!PHANDLE_VALID(u3))
1979 return;
1980 i2c = call_prom("finddevice", 1, 1, ADDR("/u3@0,f8000000/i2c@f8001000"));
1981 if (!PHANDLE_VALID(i2c))
1982 return;
1983 mpic = call_prom("finddevice", 1, 1, ADDR("/u3@0,f8000000/mpic@f8040000"));
1984 if (!PHANDLE_VALID(mpic))
1985 return;
1986
1987 /* check if proper rev of u3 */
1988 if (prom_getprop(u3, "device-rev", &u3_rev, sizeof(u3_rev))
1989 == PROM_ERROR)
1990 return;
7d49697e 1991 if (u3_rev < 0x35 || u3_rev > 0x39)
9b6b563c
PM
1992 return;
1993 /* does it need fixup ? */
1994 if (prom_getproplen(i2c, "interrupts") > 0)
1995 return;
1996
1997 prom_printf("fixing up bogus interrupts for u3 i2c...\n");
1998
1999 /* interrupt on this revision of u3 is number 0 and level */
2000 interrupts[0] = 0;
2001 interrupts[1] = 1;
a23414be
PM
2002 prom_setprop(i2c, "/u3@0,f8000000/i2c@f8001000", "interrupts",
2003 &interrupts, sizeof(interrupts));
9b6b563c 2004 parent = (u32)mpic;
a23414be
PM
2005 prom_setprop(i2c, "/u3@0,f8000000/i2c@f8001000", "interrupt-parent",
2006 &parent, sizeof(parent));
9b6b563c
PM
2007#endif
2008}
2009
2010
2011static void __init prom_find_boot_cpu(void)
2012{
2013 struct prom_t *_prom = &RELOC(prom);
2014 u32 getprop_rval;
2015 ihandle prom_cpu;
2016 phandle cpu_pkg;
2017
a575b807 2018 _prom->cpu = 0;
9b6b563c 2019 if (prom_getprop(_prom->chosen, "cpu", &prom_cpu, sizeof(prom_cpu)) <= 0)
a575b807 2020 return;
9b6b563c
PM
2021
2022 cpu_pkg = call_prom("instance-to-package", 1, 1, prom_cpu);
2023
2024 prom_getprop(cpu_pkg, "reg", &getprop_rval, sizeof(getprop_rval));
2025 _prom->cpu = getprop_rval;
2026
2027 prom_debug("Booting CPU hw index = 0x%x\n", _prom->cpu);
2028}
2029
2030static void __init prom_check_initrd(unsigned long r3, unsigned long r4)
2031{
2032#ifdef CONFIG_BLK_DEV_INITRD
2033 struct prom_t *_prom = &RELOC(prom);
2034
2035 if (r3 && r4 && r4 != 0xdeadbeef) {
2036 unsigned long val;
2037
51fae6de 2038 RELOC(prom_initrd_start) = is_kernel_addr(r3) ? __pa(r3) : r3;
9b6b563c
PM
2039 RELOC(prom_initrd_end) = RELOC(prom_initrd_start) + r4;
2040
2041 val = RELOC(prom_initrd_start);
a23414be
PM
2042 prom_setprop(_prom->chosen, "/chosen", "linux,initrd-start",
2043 &val, sizeof(val));
9b6b563c 2044 val = RELOC(prom_initrd_end);
a23414be
PM
2045 prom_setprop(_prom->chosen, "/chosen", "linux,initrd-end",
2046 &val, sizeof(val));
9b6b563c
PM
2047
2048 reserve_mem(RELOC(prom_initrd_start),
2049 RELOC(prom_initrd_end) - RELOC(prom_initrd_start));
2050
2051 prom_debug("initrd_start=0x%x\n", RELOC(prom_initrd_start));
2052 prom_debug("initrd_end=0x%x\n", RELOC(prom_initrd_end));
2053 }
2054#endif /* CONFIG_BLK_DEV_INITRD */
2055}
2056
2057/*
2058 * We enter here early on, when the Open Firmware prom is still
2059 * handling exceptions and the MMU hash table for us.
2060 */
2061
2062unsigned long __init prom_init(unsigned long r3, unsigned long r4,
2063 unsigned long pp,
2064 unsigned long r6, unsigned long r7)
2065{
2066 struct prom_t *_prom;
9b6b563c
PM
2067 unsigned long hdr;
2068 u32 getprop_rval;
b42b6617 2069 unsigned long offset = reloc_offset();
9b6b563c
PM
2070
2071#ifdef CONFIG_PPC32
9b6b563c
PM
2072 reloc_got2(offset);
2073#endif
2074
2075 _prom = &RELOC(prom);
2076
2077 /*
2078 * First zero the BSS
2079 */
2080 memset(&RELOC(__bss_start), 0, __bss_stop - __bss_start);
2081
2082 /*
2083 * Init interface to Open Firmware, get some node references,
2084 * like /chosen
2085 */
2086 prom_init_client_services(pp);
2087
2088 /*
a23414be
PM
2089 * See if this OF is old enough that we need to do explicit maps
2090 * and other workarounds
9b6b563c 2091 */
a23414be 2092 prom_find_mmu();
9b6b563c 2093
a575b807 2094 /*
a23414be 2095 * Init prom stdout device
a575b807 2096 */
a23414be 2097 prom_init_stdout();
a575b807 2098
9b6b563c
PM
2099 /*
2100 * Check for an initrd
2101 */
2102 prom_check_initrd(r3, r4);
2103
2104 /*
2105 * Get default machine type. At this point, we do not differentiate
2106 * between pSeries SMP and pSeries LPAR
2107 */
2108 RELOC(of_platform) = prom_find_machine_type();
2109 getprop_rval = RELOC(of_platform);
a23414be 2110 prom_setprop(_prom->chosen, "/chosen", "linux,platform",
9b6b563c
PM
2111 &getprop_rval, sizeof(getprop_rval));
2112
2113#ifdef CONFIG_PPC_PSERIES
2114 /*
2115 * On pSeries, inform the firmware about our capabilities
2116 */
799d6046
PM
2117 if (RELOC(of_platform) == PLATFORM_PSERIES ||
2118 RELOC(of_platform) == PLATFORM_PSERIES_LPAR)
9b6b563c
PM
2119 prom_send_capabilities();
2120#endif
2121
9b6b563c 2122 /*
f3f66f59 2123 * Copy the CPU hold code
9b6b563c 2124 */
55d36339 2125 if (RELOC(of_platform) != PLATFORM_POWERMAC)
5a408329 2126 copy_and_flush(0, KERNELBASE + offset, 0x100, 0);
9b6b563c
PM
2127
2128 /*
2129 * Do early parsing of command line
2130 */
2131 early_cmdline_parse();
2132
2133 /*
2134 * Initialize memory management within prom_init
2135 */
2136 prom_init_mem();
2137
dcee3036
ME
2138#ifdef CONFIG_KEXEC
2139 if (RELOC(prom_crashk_base))
2140 reserve_mem(RELOC(prom_crashk_base), RELOC(prom_crashk_size));
2141#endif
9b6b563c
PM
2142 /*
2143 * Determine which cpu is actually running right _now_
2144 */
2145 prom_find_boot_cpu();
2146
2147 /*
2148 * Initialize display devices
2149 */
2150 prom_check_displays();
2151
2152#ifdef CONFIG_PPC64
2153 /*
2154 * Initialize IOMMU (TCE tables) on pSeries. Do that before anything else
2155 * that uses the allocator, we need to make sure we get the top of memory
2156 * available for us here...
2157 */
2158 if (RELOC(of_platform) == PLATFORM_PSERIES)
2159 prom_initialize_tce_table();
2160#endif
2161
2162 /*
2163 * On non-powermacs, try to instantiate RTAS and puts all CPUs
2164 * in spin-loops. PowerMacs don't have a working RTAS and use
2165 * a different way to spin CPUs
2166 */
2167 if (RELOC(of_platform) != PLATFORM_POWERMAC) {
2168 prom_instantiate_rtas();
2169 prom_hold_cpus();
2170 }
2171
2172 /*
2173 * Fill in some infos for use by the kernel later on
2174 */
2175 if (RELOC(prom_memory_limit))
a23414be 2176 prom_setprop(_prom->chosen, "/chosen", "linux,memory-limit",
9b6b563c
PM
2177 &RELOC(prom_memory_limit),
2178 sizeof(prom_memory_limit));
2179#ifdef CONFIG_PPC64
2180 if (RELOC(ppc64_iommu_off))
a23414be
PM
2181 prom_setprop(_prom->chosen, "/chosen", "linux,iommu-off",
2182 NULL, 0);
9b6b563c
PM
2183
2184 if (RELOC(iommu_force_on))
a23414be
PM
2185 prom_setprop(_prom->chosen, "/chosen", "linux,iommu-force-on",
2186 NULL, 0);
9b6b563c
PM
2187
2188 if (RELOC(prom_tce_alloc_start)) {
a23414be 2189 prom_setprop(_prom->chosen, "/chosen", "linux,tce-alloc-start",
9b6b563c
PM
2190 &RELOC(prom_tce_alloc_start),
2191 sizeof(prom_tce_alloc_start));
a23414be 2192 prom_setprop(_prom->chosen, "/chosen", "linux,tce-alloc-end",
9b6b563c
PM
2193 &RELOC(prom_tce_alloc_end),
2194 sizeof(prom_tce_alloc_end));
2195 }
2196#endif
2197
dcee3036
ME
2198#ifdef CONFIG_KEXEC
2199 if (RELOC(prom_crashk_base)) {
2200 prom_setprop(_prom->chosen, "/chosen", "linux,crashkernel-base",
2201 PTRRELOC(&prom_crashk_base),
2202 sizeof(RELOC(prom_crashk_base)));
2203 prom_setprop(_prom->chosen, "/chosen", "linux,crashkernel-size",
2204 PTRRELOC(&prom_crashk_size),
2205 sizeof(RELOC(prom_crashk_size)));
2206 }
2207#endif
9b6b563c
PM
2208 /*
2209 * Fixup any known bugs in the device-tree
2210 */
2211 fixup_device_tree();
2212
2213 /*
2214 * Now finally create the flattened device-tree
2215 */
2216 prom_printf("copying OF device tree ...\n");
2217 flatten_device_tree();
2218
3825ac0e
PM
2219 /*
2220 * in case stdin is USB and still active on IBM machines...
2221 * Unfortunately quiesce crashes on some powermacs if we have
2222 * closed stdin already (in particular the powerbook 101).
2223 */
2224 if (RELOC(of_platform) != PLATFORM_POWERMAC)
2225 prom_close_stdin();
9b6b563c
PM
2226
2227 /*
2228 * Call OF "quiesce" method to shut down pending DMA's from
2229 * devices etc...
2230 */
2231 prom_printf("Calling quiesce ...\n");
2232 call_prom("quiesce", 0, 0);
2233
2234 /*
2235 * And finally, call the kernel passing it the flattened device
2236 * tree and NULL as r5, thus triggering the new entry point which
2237 * is common to us and kexec
2238 */
2239 hdr = RELOC(dt_header_start);
2240 prom_printf("returning from prom_init\n");
2241 prom_debug("->dt_header_start=0x%x\n", hdr);
2242
2243#ifdef CONFIG_PPC32
2244 reloc_got2(-offset);
2245#endif
2246
35499c01 2247 __start(hdr, KERNELBASE + offset, 0);
9b6b563c
PM
2248
2249 return 0;
2250}