linux/arch/powerpc/kernel/prom_init.c
<<
>>
Prefs
   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/kernel.h>
  20#include <linux/string.h>
  21#include <linux/init.h>
  22#include <linux/threads.h>
  23#include <linux/spinlock.h>
  24#include <linux/types.h>
  25#include <linux/pci.h>
  26#include <linux/proc_fs.h>
  27#include <linux/stringify.h>
  28#include <linux/delay.h>
  29#include <linux/initrd.h>
  30#include <linux/bitops.h>
  31#include <asm/prom.h>
  32#include <asm/rtas.h>
  33#include <asm/page.h>
  34#include <asm/processor.h>
  35#include <asm/irq.h>
  36#include <asm/io.h>
  37#include <asm/smp.h>
  38#include <asm/mmu.h>
  39#include <asm/pgtable.h>
  40#include <asm/pci.h>
  41#include <asm/iommu.h>
  42#include <asm/btext.h>
  43#include <asm/sections.h>
  44#include <asm/machdep.h>
  45#include <asm/opal.h>
  46
  47#include <linux/linux_logo.h>
  48
  49/*
  50 * Eventually bump that one up
  51 */
  52#define DEVTREE_CHUNK_SIZE      0x100000
  53
  54/*
  55 * This is the size of the local memory reserve map that gets copied
  56 * into the boot params passed to the kernel. That size is totally
  57 * flexible as the kernel just reads the list until it encounters an
  58 * entry with size 0, so it can be changed without breaking binary
  59 * compatibility
  60 */
  61#define MEM_RESERVE_MAP_SIZE    8
  62
  63/*
  64 * prom_init() is called very early on, before the kernel text
  65 * and data have been mapped to KERNELBASE.  At this point the code
  66 * is running at whatever address it has been loaded at.
  67 * On ppc32 we compile with -mrelocatable, which means that references
  68 * to extern and static variables get relocated automatically.
  69 * ppc64 objects are always relocatable, we just need to relocate the
  70 * TOC.
  71 *
  72 * Because OF may have mapped I/O devices into the area starting at
  73 * KERNELBASE, particularly on CHRP machines, we can't safely call
  74 * OF once the kernel has been mapped to KERNELBASE.  Therefore all
  75 * OF calls must be done within prom_init().
  76 *
  77 * ADDR is used in calls to call_prom.  The 4th and following
  78 * arguments to call_prom should be 32-bit values.
  79 * On ppc64, 64 bit values are truncated to 32 bits (and
  80 * fortunately don't get interpreted as two arguments).
  81 */
  82#define ADDR(x)         (u32)(unsigned long)(x)
  83
  84#ifdef CONFIG_PPC64
  85#define OF_WORKAROUNDS  0
  86#else
  87#define OF_WORKAROUNDS  of_workarounds
  88int of_workarounds;
  89#endif
  90
  91#define OF_WA_CLAIM     1       /* do phys/virt claim separately, then map */
  92#define OF_WA_LONGTRAIL 2       /* work around longtrail bugs */
  93
  94#define PROM_BUG() do {                                         \
  95        prom_printf("kernel BUG at %s line 0x%x!\n",            \
  96                    __FILE__, __LINE__);                        \
  97        __asm__ __volatile__(".long " BUG_ILLEGAL_INSTR);       \
  98} while (0)
  99
 100#ifdef DEBUG_PROM
 101#define prom_debug(x...)        prom_printf(x)
 102#else
 103#define prom_debug(x...)
 104#endif
 105
 106
 107typedef u32 prom_arg_t;
 108
 109struct prom_args {
 110        __be32 service;
 111        __be32 nargs;
 112        __be32 nret;
 113        __be32 args[10];
 114};
 115
 116struct prom_t {
 117        ihandle root;
 118        phandle chosen;
 119        int cpu;
 120        ihandle stdout;
 121        ihandle mmumap;
 122        ihandle memory;
 123};
 124
 125struct mem_map_entry {
 126        __be64  base;
 127        __be64  size;
 128};
 129
 130typedef __be32 cell_t;
 131
 132extern void __start(unsigned long r3, unsigned long r4, unsigned long r5,
 133                    unsigned long r6, unsigned long r7, unsigned long r8,
 134                    unsigned long r9);
 135
 136#ifdef CONFIG_PPC64
 137extern int enter_prom(struct prom_args *args, unsigned long entry);
 138#else
 139static inline int enter_prom(struct prom_args *args, unsigned long entry)
 140{
 141        return ((int (*)(struct prom_args *))entry)(args);
 142}
 143#endif
 144
 145extern void copy_and_flush(unsigned long dest, unsigned long src,
 146                           unsigned long size, unsigned long offset);
 147
 148/* prom structure */
 149static struct prom_t __initdata prom;
 150
 151static unsigned long prom_entry __initdata;
 152
 153#define PROM_SCRATCH_SIZE 256
 154
 155static char __initdata of_stdout_device[256];
 156static char __initdata prom_scratch[PROM_SCRATCH_SIZE];
 157
 158static unsigned long __initdata dt_header_start;
 159static unsigned long __initdata dt_struct_start, dt_struct_end;
 160static unsigned long __initdata dt_string_start, dt_string_end;
 161
 162static unsigned long __initdata prom_initrd_start, prom_initrd_end;
 163
 164#ifdef CONFIG_PPC64
 165static int __initdata prom_iommu_force_on;
 166static int __initdata prom_iommu_off;
 167static unsigned long __initdata prom_tce_alloc_start;
 168static unsigned long __initdata prom_tce_alloc_end;
 169#endif
 170
 171/* Platforms codes are now obsolete in the kernel. Now only used within this
 172 * file and ultimately gone too. Feel free to change them if you need, they
 173 * are not shared with anything outside of this file anymore
 174 */
 175#define PLATFORM_PSERIES        0x0100
 176#define PLATFORM_PSERIES_LPAR   0x0101
 177#define PLATFORM_LPAR           0x0001
 178#define PLATFORM_POWERMAC       0x0400
 179#define PLATFORM_GENERIC        0x0500
 180#define PLATFORM_OPAL           0x0600
 181
 182static int __initdata of_platform;
 183
 184static char __initdata prom_cmd_line[COMMAND_LINE_SIZE];
 185
 186static unsigned long __initdata prom_memory_limit;
 187
 188static unsigned long __initdata alloc_top;
 189static unsigned long __initdata alloc_top_high;
 190static unsigned long __initdata alloc_bottom;
 191static unsigned long __initdata rmo_top;
 192static unsigned long __initdata ram_top;
 193
 194static struct mem_map_entry __initdata mem_reserve_map[MEM_RESERVE_MAP_SIZE];
 195static int __initdata mem_reserve_cnt;
 196
 197static cell_t __initdata regbuf[1024];
 198
 199static bool rtas_has_query_cpu_stopped;
 200
 201
 202/*
 203 * Error results ... some OF calls will return "-1" on error, some
 204 * will return 0, some will return either. To simplify, here are
 205 * macros to use with any ihandle or phandle return value to check if
 206 * it is valid
 207 */
 208
 209#define PROM_ERROR              (-1u)
 210#define PHANDLE_VALID(p)        ((p) != 0 && (p) != PROM_ERROR)
 211#define IHANDLE_VALID(i)        ((i) != 0 && (i) != PROM_ERROR)
 212
 213
 214/* This is the one and *ONLY* place where we actually call open
 215 * firmware.
 216 */
 217
 218static int __init call_prom(const char *service, int nargs, int nret, ...)
 219{
 220        int i;
 221        struct prom_args args;
 222        va_list list;
 223
 224        args.service = cpu_to_be32(ADDR(service));
 225        args.nargs = cpu_to_be32(nargs);
 226        args.nret = cpu_to_be32(nret);
 227
 228        va_start(list, nret);
 229        for (i = 0; i < nargs; i++)
 230                args.args[i] = cpu_to_be32(va_arg(list, prom_arg_t));
 231        va_end(list);
 232
 233        for (i = 0; i < nret; i++)
 234                args.args[nargs+i] = 0;
 235
 236        if (enter_prom(&args, prom_entry) < 0)
 237                return PROM_ERROR;
 238
 239        return (nret > 0) ? be32_to_cpu(args.args[nargs]) : 0;
 240}
 241
 242static int __init call_prom_ret(const char *service, int nargs, int nret,
 243                                prom_arg_t *rets, ...)
 244{
 245        int i;
 246        struct prom_args args;
 247        va_list list;
 248
 249        args.service = cpu_to_be32(ADDR(service));
 250        args.nargs = cpu_to_be32(nargs);
 251        args.nret = cpu_to_be32(nret);
 252
 253        va_start(list, rets);
 254        for (i = 0; i < nargs; i++)
 255                args.args[i] = cpu_to_be32(va_arg(list, prom_arg_t));
 256        va_end(list);
 257
 258        for (i = 0; i < nret; i++)
 259                args.args[nargs+i] = 0;
 260
 261        if (enter_prom(&args, prom_entry) < 0)
 262                return PROM_ERROR;
 263
 264        if (rets != NULL)
 265                for (i = 1; i < nret; ++i)
 266                        rets[i-1] = be32_to_cpu(args.args[nargs+i]);
 267
 268        return (nret > 0) ? be32_to_cpu(args.args[nargs]) : 0;
 269}
 270
 271
 272static void __init prom_print(const char *msg)
 273{
 274        const char *p, *q;
 275
 276        if (prom.stdout == 0)
 277                return;
 278
 279        for (p = msg; *p != 0; p = q) {
 280                for (q = p; *q != 0 && *q != '\n'; ++q)
 281                        ;
 282                if (q > p)
 283                        call_prom("write", 3, 1, prom.stdout, p, q - p);
 284                if (*q == 0)
 285                        break;
 286                ++q;
 287                call_prom("write", 3, 1, prom.stdout, ADDR("\r\n"), 2);
 288        }
 289}
 290
 291
 292static void __init prom_print_hex(unsigned long val)
 293{
 294        int i, nibbles = sizeof(val)*2;
 295        char buf[sizeof(val)*2+1];
 296
 297        for (i = nibbles-1;  i >= 0;  i--) {
 298                buf[i] = (val & 0xf) + '0';
 299                if (buf[i] > '9')
 300                        buf[i] += ('a'-'0'-10);
 301                val >>= 4;
 302        }
 303        buf[nibbles] = '\0';
 304        call_prom("write", 3, 1, prom.stdout, buf, nibbles);
 305}
 306
 307/* max number of decimal digits in an unsigned long */
 308#define UL_DIGITS 21
 309static void __init prom_print_dec(unsigned long val)
 310{
 311        int i, size;
 312        char buf[UL_DIGITS+1];
 313
 314        for (i = UL_DIGITS-1; i >= 0;  i--) {
 315                buf[i] = (val % 10) + '0';
 316                val = val/10;
 317                if (val == 0)
 318                        break;
 319        }
 320        /* shift stuff down */
 321        size = UL_DIGITS - i;
 322        call_prom("write", 3, 1, prom.stdout, buf+i, size);
 323}
 324
 325static void __init prom_printf(const char *format, ...)
 326{
 327        const char *p, *q, *s;
 328        va_list args;
 329        unsigned long v;
 330        long vs;
 331
 332        va_start(args, format);
 333        for (p = format; *p != 0; p = q) {
 334                for (q = p; *q != 0 && *q != '\n' && *q != '%'; ++q)
 335                        ;
 336                if (q > p)
 337                        call_prom("write", 3, 1, prom.stdout, p, q - p);
 338                if (*q == 0)
 339                        break;
 340                if (*q == '\n') {
 341                        ++q;
 342                        call_prom("write", 3, 1, prom.stdout,
 343                                  ADDR("\r\n"), 2);
 344                        continue;
 345                }
 346                ++q;
 347                if (*q == 0)
 348                        break;
 349                switch (*q) {
 350                case 's':
 351                        ++q;
 352                        s = va_arg(args, const char *);
 353                        prom_print(s);
 354                        break;
 355                case 'x':
 356                        ++q;
 357                        v = va_arg(args, unsigned long);
 358                        prom_print_hex(v);
 359                        break;
 360                case 'd':
 361                        ++q;
 362                        vs = va_arg(args, int);
 363                        if (vs < 0) {
 364                                prom_print("-");
 365                                vs = -vs;
 366                        }
 367                        prom_print_dec(vs);
 368                        break;
 369                case 'l':
 370                        ++q;
 371                        if (*q == 0)
 372                                break;
 373                        else if (*q == 'x') {
 374                                ++q;
 375                                v = va_arg(args, unsigned long);
 376                                prom_print_hex(v);
 377                        } else if (*q == 'u') { /* '%lu' */
 378                                ++q;
 379                                v = va_arg(args, unsigned long);
 380                                prom_print_dec(v);
 381                        } else if (*q == 'd') { /* %ld */
 382                                ++q;
 383                                vs = va_arg(args, long);
 384                                if (vs < 0) {
 385                                        prom_print("-");
 386                                        vs = -vs;
 387                                }
 388                                prom_print_dec(vs);
 389                        }
 390                        break;
 391                }
 392        }
 393}
 394
 395
 396static unsigned int __init prom_claim(unsigned long virt, unsigned long size,
 397                                unsigned long align)
 398{
 399
 400        if (align == 0 && (OF_WORKAROUNDS & OF_WA_CLAIM)) {
 401                /*
 402                 * Old OF requires we claim physical and virtual separately
 403                 * and then map explicitly (assuming virtual mode)
 404                 */
 405                int ret;
 406                prom_arg_t result;
 407
 408                ret = call_prom_ret("call-method", 5, 2, &result,
 409                                    ADDR("claim"), prom.memory,
 410                                    align, size, virt);
 411                if (ret != 0 || result == -1)
 412                        return -1;
 413                ret = call_prom_ret("call-method", 5, 2, &result,
 414                                    ADDR("claim"), prom.mmumap,
 415                                    align, size, virt);
 416                if (ret != 0) {
 417                        call_prom("call-method", 4, 1, ADDR("release"),
 418                                  prom.memory, size, virt);
 419                        return -1;
 420                }
 421                /* the 0x12 is M (coherence) + PP == read/write */
 422                call_prom("call-method", 6, 1,
 423                          ADDR("map"), prom.mmumap, 0x12, size, virt, virt);
 424                return virt;
 425        }
 426        return call_prom("claim", 3, 1, (prom_arg_t)virt, (prom_arg_t)size,
 427                         (prom_arg_t)align);
 428}
 429
 430static void __init __attribute__((noreturn)) prom_panic(const char *reason)
 431{
 432        prom_print(reason);
 433        /* Do not call exit because it clears the screen on pmac
 434         * it also causes some sort of double-fault on early pmacs */
 435        if (of_platform == PLATFORM_POWERMAC)
 436                asm("trap\n");
 437
 438        /* ToDo: should put up an SRC here on pSeries */
 439        call_prom("exit", 0, 0);
 440
 441        for (;;)                        /* should never get here */
 442                ;
 443}
 444
 445
 446static int __init prom_next_node(phandle *nodep)
 447{
 448        phandle node;
 449
 450        if ((node = *nodep) != 0
 451            && (*nodep = call_prom("child", 1, 1, node)) != 0)
 452                return 1;
 453        if ((*nodep = call_prom("peer", 1, 1, node)) != 0)
 454                return 1;
 455        for (;;) {
 456                if ((node = call_prom("parent", 1, 1, node)) == 0)
 457                        return 0;
 458                if ((*nodep = call_prom("peer", 1, 1, node)) != 0)
 459                        return 1;
 460        }
 461}
 462
 463static int inline prom_getprop(phandle node, const char *pname,
 464                               void *value, size_t valuelen)
 465{
 466        return call_prom("getprop", 4, 1, node, ADDR(pname),
 467                         (u32)(unsigned long) value, (u32) valuelen);
 468}
 469
 470static int inline prom_getproplen(phandle node, const char *pname)
 471{
 472        return call_prom("getproplen", 2, 1, node, ADDR(pname));
 473}
 474
 475static void add_string(char **str, const char *q)
 476{
 477        char *p = *str;
 478
 479        while (*q)
 480                *p++ = *q++;
 481        *p++ = ' ';
 482        *str = p;
 483}
 484
 485static char *tohex(unsigned int x)
 486{
 487        static char digits[] = "0123456789abcdef";
 488        static char result[9];
 489        int i;
 490
 491        result[8] = 0;
 492        i = 8;
 493        do {
 494                --i;
 495                result[i] = digits[x & 0xf];
 496                x >>= 4;
 497        } while (x != 0 && i > 0);
 498        return &result[i];
 499}
 500
 501static int __init prom_setprop(phandle node, const char *nodename,
 502                               const char *pname, void *value, size_t valuelen)
 503{
 504        char cmd[256], *p;
 505
 506        if (!(OF_WORKAROUNDS & OF_WA_LONGTRAIL))
 507                return call_prom("setprop", 4, 1, node, ADDR(pname),
 508                                 (u32)(unsigned long) value, (u32) valuelen);
 509
 510        /* gah... setprop doesn't work on longtrail, have to use interpret */
 511        p = cmd;
 512        add_string(&p, "dev");
 513        add_string(&p, nodename);
 514        add_string(&p, tohex((u32)(unsigned long) value));
 515        add_string(&p, tohex(valuelen));
 516        add_string(&p, tohex(ADDR(pname)));
 517        add_string(&p, tohex(strlen(pname)));
 518        add_string(&p, "property");
 519        *p = 0;
 520        return call_prom("interpret", 1, 1, (u32)(unsigned long) cmd);
 521}
 522
 523/* We can't use the standard versions because of relocation headaches. */
 524#define isxdigit(c)     (('0' <= (c) && (c) <= '9') \
 525                         || ('a' <= (c) && (c) <= 'f') \
 526                         || ('A' <= (c) && (c) <= 'F'))
 527
 528#define isdigit(c)      ('0' <= (c) && (c) <= '9')
 529#define islower(c)      ('a' <= (c) && (c) <= 'z')
 530#define toupper(c)      (islower(c) ? ((c) - 'a' + 'A') : (c))
 531
 532static unsigned long prom_strtoul(const char *cp, const char **endp)
 533{
 534        unsigned long result = 0, base = 10, value;
 535
 536        if (*cp == '0') {
 537                base = 8;
 538                cp++;
 539                if (toupper(*cp) == 'X') {
 540                        cp++;
 541                        base = 16;
 542                }
 543        }
 544
 545        while (isxdigit(*cp) &&
 546               (value = isdigit(*cp) ? *cp - '0' : toupper(*cp) - 'A' + 10) < base) {
 547                result = result * base + value;
 548                cp++;
 549        }
 550
 551        if (endp)
 552                *endp = cp;
 553
 554        return result;
 555}
 556
 557static unsigned long prom_memparse(const char *ptr, const char **retptr)
 558{
 559        unsigned long ret = prom_strtoul(ptr, retptr);
 560        int shift = 0;
 561
 562        /*
 563         * We can't use a switch here because GCC *may* generate a
 564         * jump table which won't work, because we're not running at
 565         * the address we're linked at.
 566         */
 567        if ('G' == **retptr || 'g' == **retptr)
 568                shift = 30;
 569
 570        if ('M' == **retptr || 'm' == **retptr)
 571                shift = 20;
 572
 573        if ('K' == **retptr || 'k' == **retptr)
 574                shift = 10;
 575
 576        if (shift) {
 577                ret <<= shift;
 578                (*retptr)++;
 579        }
 580
 581        return ret;
 582}
 583
 584/*
 585 * Early parsing of the command line passed to the kernel, used for
 586 * "mem=x" and the options that affect the iommu
 587 */
 588static void __init early_cmdline_parse(void)
 589{
 590        const char *opt;
 591
 592        char *p;
 593        int l = 0;
 594
 595        prom_cmd_line[0] = 0;
 596        p = prom_cmd_line;
 597        if ((long)prom.chosen > 0)
 598                l = prom_getprop(prom.chosen, "bootargs", p, COMMAND_LINE_SIZE-1);
 599#ifdef CONFIG_CMDLINE
 600        if (l <= 0 || p[0] == '\0') /* dbl check */
 601                strlcpy(prom_cmd_line,
 602                        CONFIG_CMDLINE, sizeof(prom_cmd_line));
 603#endif /* CONFIG_CMDLINE */
 604        prom_printf("command line: %s\n", prom_cmd_line);
 605
 606#ifdef CONFIG_PPC64
 607        opt = strstr(prom_cmd_line, "iommu=");
 608        if (opt) {
 609                prom_printf("iommu opt is: %s\n", opt);
 610                opt += 6;
 611                while (*opt && *opt == ' ')
 612                        opt++;
 613                if (!strncmp(opt, "off", 3))
 614                        prom_iommu_off = 1;
 615                else if (!strncmp(opt, "force", 5))
 616                        prom_iommu_force_on = 1;
 617        }
 618#endif
 619        opt = strstr(prom_cmd_line, "mem=");
 620        if (opt) {
 621                opt += 4;
 622                prom_memory_limit = prom_memparse(opt, (const char **)&opt);
 623#ifdef CONFIG_PPC64
 624                /* Align to 16 MB == size of ppc64 large page */
 625                prom_memory_limit = ALIGN(prom_memory_limit, 0x1000000);
 626#endif
 627        }
 628}
 629
 630#if defined(CONFIG_PPC_PSERIES) || defined(CONFIG_PPC_POWERNV)
 631/*
 632 * The architecture vector has an array of PVR mask/value pairs,
 633 * followed by # option vectors - 1, followed by the option vectors.
 634 *
 635 * See prom.h for the definition of the bits specified in the
 636 * architecture vector.
 637 *
 638 * Because the description vector contains a mix of byte and word
 639 * values, we declare it as an unsigned char array, and use this
 640 * macro to put word values in.
 641 */
 642#define W(x)    ((x) >> 24) & 0xff, ((x) >> 16) & 0xff, \
 643                ((x) >> 8) & 0xff, (x) & 0xff
 644
 645unsigned char ibm_architecture_vec[] = {
 646        W(0xfffe0000), W(0x003a0000),   /* POWER5/POWER5+ */
 647        W(0xffff0000), W(0x003e0000),   /* POWER6 */
 648        W(0xffff0000), W(0x003f0000),   /* POWER7 */
 649        W(0xffff0000), W(0x004b0000),   /* POWER8E */
 650        W(0xffff0000), W(0x004d0000),   /* POWER8 */
 651        W(0xffffffff), W(0x0f000004),   /* all 2.07-compliant */
 652        W(0xffffffff), W(0x0f000003),   /* all 2.06-compliant */
 653        W(0xffffffff), W(0x0f000002),   /* all 2.05-compliant */
 654        W(0xfffffffe), W(0x0f000001),   /* all 2.04-compliant and earlier */
 655        6 - 1,                          /* 6 option vectors */
 656
 657        /* option vector 1: processor architectures supported */
 658        3 - 2,                          /* length */
 659        0,                              /* don't ignore, don't halt */
 660        OV1_PPC_2_00 | OV1_PPC_2_01 | OV1_PPC_2_02 | OV1_PPC_2_03 |
 661        OV1_PPC_2_04 | OV1_PPC_2_05 | OV1_PPC_2_06 | OV1_PPC_2_07,
 662
 663        /* option vector 2: Open Firmware options supported */
 664        34 - 2,                         /* length */
 665        OV2_REAL_MODE,
 666        0, 0,
 667        W(0xffffffff),                  /* real_base */
 668        W(0xffffffff),                  /* real_size */
 669        W(0xffffffff),                  /* virt_base */
 670        W(0xffffffff),                  /* virt_size */
 671        W(0xffffffff),                  /* load_base */
 672        W(256),                         /* 256MB min RMA */
 673        W(0xffffffff),                  /* full client load */
 674        0,                              /* min RMA percentage of total RAM */
 675        48,                             /* max log_2(hash table size) */
 676
 677        /* option vector 3: processor options supported */
 678        3 - 2,                          /* length */
 679        0,                              /* don't ignore, don't halt */
 680        OV3_FP | OV3_VMX | OV3_DFP,
 681
 682        /* option vector 4: IBM PAPR implementation */
 683        3 - 2,                          /* length */
 684        0,                              /* don't halt */
 685        OV4_MIN_ENT_CAP,                /* minimum VP entitled capacity */
 686
 687        /* option vector 5: PAPR/OF options */
 688        19 - 2,                         /* length */
 689        0,                              /* don't ignore, don't halt */
 690        OV5_FEAT(OV5_LPAR) | OV5_FEAT(OV5_SPLPAR) | OV5_FEAT(OV5_LARGE_PAGES) |
 691        OV5_FEAT(OV5_DRCONF_MEMORY) | OV5_FEAT(OV5_DONATE_DEDICATE_CPU) |
 692#ifdef CONFIG_PCI_MSI
 693        /* PCIe/MSI support.  Without MSI full PCIe is not supported */
 694        OV5_FEAT(OV5_MSI),
 695#else
 696        0,
 697#endif
 698        0,
 699#ifdef CONFIG_PPC_SMLPAR
 700        OV5_FEAT(OV5_CMO) | OV5_FEAT(OV5_XCMO),
 701#else
 702        0,
 703#endif
 704        OV5_FEAT(OV5_TYPE1_AFFINITY) | OV5_FEAT(OV5_PRRN),
 705        0,
 706        0,
 707        0,
 708        /* WARNING: The offset of the "number of cores" field below
 709         * must match by the macro below. Update the definition if
 710         * the structure layout changes.
 711         */
 712#define IBM_ARCH_VEC_NRCORES_OFFSET     125
 713        W(NR_CPUS),                     /* number of cores supported */
 714        0,
 715        0,
 716        0,
 717        0,
 718        OV5_FEAT(OV5_PFO_HW_RNG) | OV5_FEAT(OV5_PFO_HW_ENCR) |
 719        OV5_FEAT(OV5_PFO_HW_842),
 720        OV5_FEAT(OV5_SUB_PROCESSORS),
 721        /* option vector 6: IBM PAPR hints */
 722        4 - 2,                          /* length */
 723        0,
 724        0,
 725        OV6_LINUX,
 726
 727};
 728
 729/* Old method - ELF header with PT_NOTE sections only works on BE */
 730#ifdef __BIG_ENDIAN__
 731static struct fake_elf {
 732        Elf32_Ehdr      elfhdr;
 733        Elf32_Phdr      phdr[2];
 734        struct chrpnote {
 735                u32     namesz;
 736                u32     descsz;
 737                u32     type;
 738                char    name[8];        /* "PowerPC" */
 739                struct chrpdesc {
 740                        u32     real_mode;
 741                        u32     real_base;
 742                        u32     real_size;
 743                        u32     virt_base;
 744                        u32     virt_size;
 745                        u32     load_base;
 746                } chrpdesc;
 747        } chrpnote;
 748        struct rpanote {
 749                u32     namesz;
 750                u32     descsz;
 751                u32     type;
 752                char    name[24];       /* "IBM,RPA-Client-Config" */
 753                struct rpadesc {
 754                        u32     lpar_affinity;
 755                        u32     min_rmo_size;
 756                        u32     min_rmo_percent;
 757                        u32     max_pft_size;
 758                        u32     splpar;
 759                        u32     min_load;
 760                        u32     new_mem_def;
 761                        u32     ignore_me;
 762                } rpadesc;
 763        } rpanote;
 764} fake_elf = {
 765        .elfhdr = {
 766                .e_ident = { 0x7f, 'E', 'L', 'F',
 767                             ELFCLASS32, ELFDATA2MSB, EV_CURRENT },
 768                .e_type = ET_EXEC,      /* yeah right */
 769                .e_machine = EM_PPC,
 770                .e_version = EV_CURRENT,
 771                .e_phoff = offsetof(struct fake_elf, phdr),
 772                .e_phentsize = sizeof(Elf32_Phdr),
 773                .e_phnum = 2
 774        },
 775        .phdr = {
 776                [0] = {
 777                        .p_type = PT_NOTE,
 778                        .p_offset = offsetof(struct fake_elf, chrpnote),
 779                        .p_filesz = sizeof(struct chrpnote)
 780                }, [1] = {
 781                        .p_type = PT_NOTE,
 782                        .p_offset = offsetof(struct fake_elf, rpanote),
 783                        .p_filesz = sizeof(struct rpanote)
 784                }
 785        },
 786        .chrpnote = {
 787                .namesz = sizeof("PowerPC"),
 788                .descsz = sizeof(struct chrpdesc),
 789                .type = 0x1275,
 790                .name = "PowerPC",
 791                .chrpdesc = {
 792                        .real_mode = ~0U,       /* ~0 means "don't care" */
 793                        .real_base = ~0U,
 794                        .real_size = ~0U,
 795                        .virt_base = ~0U,
 796                        .virt_size = ~0U,
 797                        .load_base = ~0U
 798                },
 799        },
 800        .rpanote = {
 801                .namesz = sizeof("IBM,RPA-Client-Config"),
 802                .descsz = sizeof(struct rpadesc),
 803                .type = 0x12759999,
 804                .name = "IBM,RPA-Client-Config",
 805                .rpadesc = {
 806                        .lpar_affinity = 0,
 807                        .min_rmo_size = 64,     /* in megabytes */
 808                        .min_rmo_percent = 0,
 809                        .max_pft_size = 48,     /* 2^48 bytes max PFT size */
 810                        .splpar = 1,
 811                        .min_load = ~0U,
 812                        .new_mem_def = 0
 813                }
 814        }
 815};
 816#endif /* __BIG_ENDIAN__ */
 817
 818static int __init prom_count_smt_threads(void)
 819{
 820        phandle node;
 821        char type[64];
 822        unsigned int plen;
 823
 824        /* Pick up th first CPU node we can find */
 825        for (node = 0; prom_next_node(&node); ) {
 826                type[0] = 0;
 827                prom_getprop(node, "device_type", type, sizeof(type));
 828
 829                if (strcmp(type, "cpu"))
 830                        continue;
 831                /*
 832                 * There is an entry for each smt thread, each entry being
 833                 * 4 bytes long.  All cpus should have the same number of
 834                 * smt threads, so return after finding the first.
 835                 */
 836                plen = prom_getproplen(node, "ibm,ppc-interrupt-server#s");
 837                if (plen == PROM_ERROR)
 838                        break;
 839                plen >>= 2;
 840                prom_debug("Found %lu smt threads per core\n", (unsigned long)plen);
 841
 842                /* Sanity check */
 843                if (plen < 1 || plen > 64) {
 844                        prom_printf("Threads per core %lu out of bounds, assuming 1\n",
 845                                    (unsigned long)plen);
 846                        return 1;
 847                }
 848                return plen;
 849        }
 850        prom_debug("No threads found, assuming 1 per core\n");
 851
 852        return 1;
 853
 854}
 855
 856
 857static void __init prom_send_capabilities(void)
 858{
 859        ihandle root;
 860        prom_arg_t ret;
 861        u32 cores;
 862        unsigned char *ptcores;
 863
 864        root = call_prom("open", 1, 1, ADDR("/"));
 865        if (root != 0) {
 866                /* We need to tell the FW about the number of cores we support.
 867                 *
 868                 * To do that, we count the number of threads on the first core
 869                 * (we assume this is the same for all cores) and use it to
 870                 * divide NR_CPUS.
 871                 */
 872
 873                /* The core value may start at an odd address. If such a word
 874                 * access is made at a cache line boundary, this leads to an
 875                 * exception which may not be handled at this time.
 876                 * Forcing a per byte access to avoid exception.
 877                 */
 878                ptcores = &ibm_architecture_vec[IBM_ARCH_VEC_NRCORES_OFFSET];
 879                cores = 0;
 880                cores |= ptcores[0] << 24;
 881                cores |= ptcores[1] << 16;
 882                cores |= ptcores[2] << 8;
 883                cores |= ptcores[3];
 884                if (cores != NR_CPUS) {
 885                        prom_printf("WARNING ! "
 886                                    "ibm_architecture_vec structure inconsistent: %lu!\n",
 887                                    cores);
 888                } else {
 889                        cores = DIV_ROUND_UP(NR_CPUS, prom_count_smt_threads());
 890                        prom_printf("Max number of cores passed to firmware: %lu (NR_CPUS = %lu)\n",
 891                                    cores, NR_CPUS);
 892                        ptcores[0] = (cores >> 24) & 0xff;
 893                        ptcores[1] = (cores >> 16) & 0xff;
 894                        ptcores[2] = (cores >> 8) & 0xff;
 895                        ptcores[3] = cores & 0xff;
 896                }
 897
 898                /* try calling the ibm,client-architecture-support method */
 899                prom_printf("Calling ibm,client-architecture-support...");
 900                if (call_prom_ret("call-method", 3, 2, &ret,
 901                                  ADDR("ibm,client-architecture-support"),
 902                                  root,
 903                                  ADDR(ibm_architecture_vec)) == 0) {
 904                        /* the call exists... */
 905                        if (ret)
 906                                prom_printf("\nWARNING: ibm,client-architecture"
 907                                            "-support call FAILED!\n");
 908                        call_prom("close", 1, 0, root);
 909                        prom_printf(" done\n");
 910                        return;
 911                }
 912                call_prom("close", 1, 0, root);
 913                prom_printf(" not implemented\n");
 914        }
 915
 916#ifdef __BIG_ENDIAN__
 917        {
 918                ihandle elfloader;
 919
 920                /* no ibm,client-architecture-support call, try the old way */
 921                elfloader = call_prom("open", 1, 1,
 922                                      ADDR("/packages/elf-loader"));
 923                if (elfloader == 0) {
 924                        prom_printf("couldn't open /packages/elf-loader\n");
 925                        return;
 926                }
 927                call_prom("call-method", 3, 1, ADDR("process-elf-header"),
 928                          elfloader, ADDR(&fake_elf));
 929                call_prom("close", 1, 0, elfloader);
 930        }
 931#endif /* __BIG_ENDIAN__ */
 932}
 933#endif /* #if defined(CONFIG_PPC_PSERIES) || defined(CONFIG_PPC_POWERNV) */
 934
 935/*
 936 * Memory allocation strategy... our layout is normally:
 937 *
 938 *  at 14Mb or more we have vmlinux, then a gap and initrd.  In some
 939 *  rare cases, initrd might end up being before the kernel though.
 940 *  We assume this won't override the final kernel at 0, we have no
 941 *  provision to handle that in this version, but it should hopefully
 942 *  never happen.
 943 *
 944 *  alloc_top is set to the top of RMO, eventually shrink down if the
 945 *  TCEs overlap
 946 *
 947 *  alloc_bottom is set to the top of kernel/initrd
 948 *
 949 *  from there, allocations are done this way : rtas is allocated
 950 *  topmost, and the device-tree is allocated from the bottom. We try
 951 *  to grow the device-tree allocation as we progress. If we can't,
 952 *  then we fail, we don't currently have a facility to restart
 953 *  elsewhere, but that shouldn't be necessary.
 954 *
 955 *  Note that calls to reserve_mem have to be done explicitly, memory
 956 *  allocated with either alloc_up or alloc_down isn't automatically
 957 *  reserved.
 958 */
 959
 960
 961/*
 962 * Allocates memory in the RMO upward from the kernel/initrd
 963 *
 964 * When align is 0, this is a special case, it means to allocate in place
 965 * at the current location of alloc_bottom or fail (that is basically
 966 * extending the previous allocation). Used for the device-tree flattening
 967 */
 968static unsigned long __init alloc_up(unsigned long size, unsigned long align)
 969{
 970        unsigned long base = alloc_bottom;
 971        unsigned long addr = 0;
 972
 973        if (align)
 974                base = _ALIGN_UP(base, align);
 975        prom_debug("alloc_up(%x, %x)\n", size, align);
 976        if (ram_top == 0)
 977                prom_panic("alloc_up() called with mem not initialized\n");
 978
 979        if (align)
 980                base = _ALIGN_UP(alloc_bottom, align);
 981        else
 982                base = alloc_bottom;
 983
 984        for(; (base + size) <= alloc_top; 
 985            base = _ALIGN_UP(base + 0x100000, align)) {
 986                prom_debug("    trying: 0x%x\n\r", base);
 987                addr = (unsigned long)prom_claim(base, size, 0);
 988                if (addr != PROM_ERROR && addr != 0)
 989                        break;
 990                addr = 0;
 991                if (align == 0)
 992                        break;
 993        }
 994        if (addr == 0)
 995                return 0;
 996        alloc_bottom = addr + size;
 997
 998        prom_debug(" -> %x\n", addr);
 999        prom_debug("  alloc_bottom : %x\n", alloc_bottom);
1000        prom_debug("  alloc_top    : %x\n", alloc_top);
1001        prom_debug("  alloc_top_hi : %x\n", alloc_top_high);
1002        prom_debug("  rmo_top      : %x\n", rmo_top);
1003        prom_debug("  ram_top      : %x\n", ram_top);
1004
1005        return addr;
1006}
1007
1008/*
1009 * Allocates memory downward, either from top of RMO, or if highmem
1010 * is set, from the top of RAM.  Note that this one doesn't handle
1011 * failures.  It does claim memory if highmem is not set.
1012 */
1013static unsigned long __init alloc_down(unsigned long size, unsigned long align,
1014                                       int highmem)
1015{
1016        unsigned long base, addr = 0;
1017
1018        prom_debug("alloc_down(%x, %x, %s)\n", size, align,
1019                   highmem ? "(high)" : "(low)");
1020        if (ram_top == 0)
1021                prom_panic("alloc_down() called with mem not initialized\n");
1022
1023        if (highmem) {
1024                /* Carve out storage for the TCE table. */
1025                addr = _ALIGN_DOWN(alloc_top_high - size, align);
1026                if (addr <= alloc_bottom)
1027                        return 0;
1028                /* Will we bump into the RMO ? If yes, check out that we
1029                 * didn't overlap existing allocations there, if we did,
1030                 * we are dead, we must be the first in town !
1031                 */
1032                if (addr < rmo_top) {
1033                        /* Good, we are first */
1034                        if (alloc_top == rmo_top)
1035                                alloc_top = rmo_top = addr;
1036                        else
1037                                return 0;
1038                }
1039                alloc_top_high = addr;
1040                goto bail;
1041        }
1042
1043        base = _ALIGN_DOWN(alloc_top - size, align);
1044        for (; base > alloc_bottom;
1045             base = _ALIGN_DOWN(base - 0x100000, align))  {
1046                prom_debug("    trying: 0x%x\n\r", base);
1047                addr = (unsigned long)prom_claim(base, size, 0);
1048                if (addr != PROM_ERROR && addr != 0)
1049                        break;
1050                addr = 0;
1051        }
1052        if (addr == 0)
1053                return 0;
1054        alloc_top = addr;
1055
1056 bail:
1057        prom_debug(" -> %x\n", addr);
1058        prom_debug("  alloc_bottom : %x\n", alloc_bottom);
1059        prom_debug("  alloc_top    : %x\n", alloc_top);
1060        prom_debug("  alloc_top_hi : %x\n", alloc_top_high);
1061        prom_debug("  rmo_top      : %x\n", rmo_top);
1062        prom_debug("  ram_top      : %x\n", ram_top);
1063
1064        return addr;
1065}
1066
1067/*
1068 * Parse a "reg" cell
1069 */
1070static unsigned long __init prom_next_cell(int s, cell_t **cellp)
1071{
1072        cell_t *p = *cellp;
1073        unsigned long r = 0;
1074
1075        /* Ignore more than 2 cells */
1076        while (s > sizeof(unsigned long) / 4) {
1077                p++;
1078                s--;
1079        }
1080        r = be32_to_cpu(*p++);
1081#ifdef CONFIG_PPC64
1082        if (s > 1) {
1083                r <<= 32;
1084                r |= be32_to_cpu(*(p++));
1085        }
1086#endif
1087        *cellp = p;
1088        return r;
1089}
1090
1091/*
1092 * Very dumb function for adding to the memory reserve list, but
1093 * we don't need anything smarter at this point
1094 *
1095 * XXX Eventually check for collisions.  They should NEVER happen.
1096 * If problems seem to show up, it would be a good start to track
1097 * them down.
1098 */
1099static void __init reserve_mem(u64 base, u64 size)
1100{
1101        u64 top = base + size;
1102        unsigned long cnt = mem_reserve_cnt;
1103
1104        if (size == 0)
1105                return;
1106
1107        /* We need to always keep one empty entry so that we
1108         * have our terminator with "size" set to 0 since we are
1109         * dumb and just copy this entire array to the boot params
1110         */
1111        base = _ALIGN_DOWN(base, PAGE_SIZE);
1112        top = _ALIGN_UP(top, PAGE_SIZE);
1113        size = top - base;
1114
1115        if (cnt >= (MEM_RESERVE_MAP_SIZE - 1))
1116                prom_panic("Memory reserve map exhausted !\n");
1117        mem_reserve_map[cnt].base = cpu_to_be64(base);
1118        mem_reserve_map[cnt].size = cpu_to_be64(size);
1119        mem_reserve_cnt = cnt + 1;
1120}
1121
1122/*
1123 * Initialize memory allocation mechanism, parse "memory" nodes and
1124 * obtain that way the top of memory and RMO to setup out local allocator
1125 */
1126static void __init prom_init_mem(void)
1127{
1128        phandle node;
1129        char *path, type[64];
1130        unsigned int plen;
1131        cell_t *p, *endp;
1132        __be32 val;
1133        u32 rac, rsc;
1134
1135        /*
1136         * We iterate the memory nodes to find
1137         * 1) top of RMO (first node)
1138         * 2) top of memory
1139         */
1140        val = cpu_to_be32(2);
1141        prom_getprop(prom.root, "#address-cells", &val, sizeof(val));
1142        rac = be32_to_cpu(val);
1143        val = cpu_to_be32(1);
1144        prom_getprop(prom.root, "#size-cells", &val, sizeof(rsc));
1145        rsc = be32_to_cpu(val);
1146        prom_debug("root_addr_cells: %x\n", rac);
1147        prom_debug("root_size_cells: %x\n", rsc);
1148
1149        prom_debug("scanning memory:\n");
1150        path = prom_scratch;
1151
1152        for (node = 0; prom_next_node(&node); ) {
1153                type[0] = 0;
1154                prom_getprop(node, "device_type", type, sizeof(type));
1155
1156                if (type[0] == 0) {
1157                        /*
1158                         * CHRP Longtrail machines have no device_type
1159                         * on the memory node, so check the name instead...
1160                         */
1161                        prom_getprop(node, "name", type, sizeof(type));
1162                }
1163                if (strcmp(type, "memory"))
1164                        continue;
1165
1166                plen = prom_getprop(node, "reg", regbuf, sizeof(regbuf));
1167                if (plen > sizeof(regbuf)) {
1168                        prom_printf("memory node too large for buffer !\n");
1169                        plen = sizeof(regbuf);
1170                }
1171                p = regbuf;
1172                endp = p + (plen / sizeof(cell_t));
1173
1174#ifdef DEBUG_PROM
1175                memset(path, 0, PROM_SCRATCH_SIZE);
1176                call_prom("package-to-path", 3, 1, node, path, PROM_SCRATCH_SIZE-1);
1177                prom_debug("  node %s :\n", path);
1178#endif /* DEBUG_PROM */
1179
1180                while ((endp - p) >= (rac + rsc)) {
1181                        unsigned long base, size;
1182
1183                        base = prom_next_cell(rac, &p);
1184                        size = prom_next_cell(rsc, &p);
1185
1186                        if (size == 0)
1187                                continue;
1188                        prom_debug("    %x %x\n", base, size);
1189                        if (base == 0 && (of_platform & PLATFORM_LPAR))
1190                                rmo_top = size;
1191                        if ((base + size) > ram_top)
1192                                ram_top = base + size;
1193                }
1194        }
1195
1196        alloc_bottom = PAGE_ALIGN((unsigned long)&_end + 0x4000);
1197
1198        /*
1199         * If prom_memory_limit is set we reduce the upper limits *except* for
1200         * alloc_top_high. This must be the real top of RAM so we can put
1201         * TCE's up there.
1202         */
1203
1204        alloc_top_high = ram_top;
1205
1206        if (prom_memory_limit) {
1207                if (prom_memory_limit <= alloc_bottom) {
1208                        prom_printf("Ignoring mem=%x <= alloc_bottom.\n",
1209                                prom_memory_limit);
1210                        prom_memory_limit = 0;
1211                } else if (prom_memory_limit >= ram_top) {
1212                        prom_printf("Ignoring mem=%x >= ram_top.\n",
1213                                prom_memory_limit);
1214                        prom_memory_limit = 0;
1215                } else {
1216                        ram_top = prom_memory_limit;
1217                        rmo_top = min(rmo_top, prom_memory_limit);
1218                }
1219        }
1220
1221        /*
1222         * Setup our top alloc point, that is top of RMO or top of
1223         * segment 0 when running non-LPAR.
1224         * Some RS64 machines have buggy firmware where claims up at
1225         * 1GB fail.  Cap at 768MB as a workaround.
1226         * Since 768MB is plenty of room, and we need to cap to something
1227         * reasonable on 32-bit, cap at 768MB on all machines.
1228         */
1229        if (!rmo_top)
1230                rmo_top = ram_top;
1231        rmo_top = min(0x30000000ul, rmo_top);
1232        alloc_top = rmo_top;
1233        alloc_top_high = ram_top;
1234
1235        /*
1236         * Check if we have an initrd after the kernel but still inside
1237         * the RMO.  If we do move our bottom point to after it.
1238         */
1239        if (prom_initrd_start &&
1240            prom_initrd_start < rmo_top &&
1241            prom_initrd_end > alloc_bottom)
1242                alloc_bottom = PAGE_ALIGN(prom_initrd_end);
1243
1244        prom_printf("memory layout at init:\n");
1245        prom_printf("  memory_limit : %x (16 MB aligned)\n", prom_memory_limit);
1246        prom_printf("  alloc_bottom : %x\n", alloc_bottom);
1247        prom_printf("  alloc_top    : %x\n", alloc_top);
1248        prom_printf("  alloc_top_hi : %x\n", alloc_top_high);
1249        prom_printf("  rmo_top      : %x\n", rmo_top);
1250        prom_printf("  ram_top      : %x\n", ram_top);
1251}
1252
1253static void __init prom_close_stdin(void)
1254{
1255        __be32 val;
1256        ihandle stdin;
1257
1258        if (prom_getprop(prom.chosen, "stdin", &val, sizeof(val)) > 0) {
1259                stdin = be32_to_cpu(val);
1260                call_prom("close", 1, 0, stdin);
1261        }
1262}
1263
1264#ifdef CONFIG_PPC_POWERNV
1265
1266#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL
1267static u64 __initdata prom_opal_base;
1268static u64 __initdata prom_opal_entry;
1269#endif
1270
1271/*
1272 * Allocate room for and instantiate OPAL
1273 */
1274static void __init prom_instantiate_opal(void)
1275{
1276        phandle opal_node;
1277        ihandle opal_inst;
1278        u64 base, entry;
1279        u64 size = 0, align = 0x10000;
1280        __be64 val64;
1281        u32 rets[2];
1282
1283        prom_debug("prom_instantiate_opal: start...\n");
1284
1285        opal_node = call_prom("finddevice", 1, 1, ADDR("/ibm,opal"));
1286        prom_debug("opal_node: %x\n", opal_node);
1287        if (!PHANDLE_VALID(opal_node))
1288                return;
1289
1290        val64 = 0;
1291        prom_getprop(opal_node, "opal-runtime-size", &val64, sizeof(val64));
1292        size = be64_to_cpu(val64);
1293        if (size == 0)
1294                return;
1295        val64 = 0;
1296        prom_getprop(opal_node, "opal-runtime-alignment", &val64,sizeof(val64));
1297        align = be64_to_cpu(val64);
1298
1299        base = alloc_down(size, align, 0);
1300        if (base == 0) {
1301                prom_printf("OPAL allocation failed !\n");
1302                return;
1303        }
1304
1305        opal_inst = call_prom("open", 1, 1, ADDR("/ibm,opal"));
1306        if (!IHANDLE_VALID(opal_inst)) {
1307                prom_printf("opening opal package failed (%x)\n", opal_inst);
1308                return;
1309        }
1310
1311        prom_printf("instantiating opal at 0x%x...", base);
1312
1313        if (call_prom_ret("call-method", 4, 3, rets,
1314                          ADDR("load-opal-runtime"),
1315                          opal_inst,
1316                          base >> 32, base & 0xffffffff) != 0
1317            || (rets[0] == 0 && rets[1] == 0)) {
1318                prom_printf(" failed\n");
1319                return;
1320        }
1321        entry = (((u64)rets[0]) << 32) | rets[1];
1322
1323        prom_printf(" done\n");
1324
1325        reserve_mem(base, size);
1326
1327        prom_debug("opal base     = 0x%x\n", base);
1328        prom_debug("opal align    = 0x%x\n", align);
1329        prom_debug("opal entry    = 0x%x\n", entry);
1330        prom_debug("opal size     = 0x%x\n", (long)size);
1331
1332        prom_setprop(opal_node, "/ibm,opal", "opal-base-address",
1333                     &base, sizeof(base));
1334        prom_setprop(opal_node, "/ibm,opal", "opal-entry-address",
1335                     &entry, sizeof(entry));
1336
1337#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL
1338        prom_opal_base = base;
1339        prom_opal_entry = entry;
1340#endif
1341        prom_debug("prom_instantiate_opal: end...\n");
1342}
1343
1344#endif /* CONFIG_PPC_POWERNV */
1345
1346/*
1347 * Allocate room for and instantiate RTAS
1348 */
1349static void __init prom_instantiate_rtas(void)
1350{
1351        phandle rtas_node;
1352        ihandle rtas_inst;
1353        u32 base, entry = 0;
1354        __be32 val;
1355        u32 size = 0;
1356
1357        prom_debug("prom_instantiate_rtas: start...\n");
1358
1359        rtas_node = call_prom("finddevice", 1, 1, ADDR("/rtas"));
1360        prom_debug("rtas_node: %x\n", rtas_node);
1361        if (!PHANDLE_VALID(rtas_node))
1362                return;
1363
1364        val = 0;
1365        prom_getprop(rtas_node, "rtas-size", &val, sizeof(size));
1366        size = be32_to_cpu(val);
1367        if (size == 0)
1368                return;
1369
1370        base = alloc_down(size, PAGE_SIZE, 0);
1371        if (base == 0)
1372                prom_panic("Could not allocate memory for RTAS\n");
1373
1374        rtas_inst = call_prom("open", 1, 1, ADDR("/rtas"));
1375        if (!IHANDLE_VALID(rtas_inst)) {
1376                prom_printf("opening rtas package failed (%x)\n", rtas_inst);
1377                return;
1378        }
1379
1380        prom_printf("instantiating rtas at 0x%x...", base);
1381
1382        if (call_prom_ret("call-method", 3, 2, &entry,
1383                          ADDR("instantiate-rtas"),
1384                          rtas_inst, base) != 0
1385            || entry == 0) {
1386                prom_printf(" failed\n");
1387                return;
1388        }
1389        prom_printf(" done\n");
1390
1391        reserve_mem(base, size);
1392
1393        val = cpu_to_be32(base);
1394        prom_setprop(rtas_node, "/rtas", "linux,rtas-base",
1395                     &val, sizeof(val));
1396        val = cpu_to_be32(entry);
1397        prom_setprop(rtas_node, "/rtas", "linux,rtas-entry",
1398                     &val, sizeof(val));
1399
1400        /* Check if it supports "query-cpu-stopped-state" */
1401        if (prom_getprop(rtas_node, "query-cpu-stopped-state",
1402                         &val, sizeof(val)) != PROM_ERROR)
1403                rtas_has_query_cpu_stopped = true;
1404
1405        prom_debug("rtas base     = 0x%x\n", base);
1406        prom_debug("rtas entry    = 0x%x\n", entry);
1407        prom_debug("rtas size     = 0x%x\n", (long)size);
1408
1409        prom_debug("prom_instantiate_rtas: end...\n");
1410}
1411
1412#ifdef CONFIG_PPC64
1413/*
1414 * Allocate room for and instantiate Stored Measurement Log (SML)
1415 */
1416static void __init prom_instantiate_sml(void)
1417{
1418        phandle ibmvtpm_node;
1419        ihandle ibmvtpm_inst;
1420        u32 entry = 0, size = 0;
1421        u64 base;
1422
1423        prom_debug("prom_instantiate_sml: start...\n");
1424
1425        ibmvtpm_node = call_prom("finddevice", 1, 1, ADDR("/ibm,vtpm"));
1426        prom_debug("ibmvtpm_node: %x\n", ibmvtpm_node);
1427        if (!PHANDLE_VALID(ibmvtpm_node))
1428                return;
1429
1430        ibmvtpm_inst = call_prom("open", 1, 1, ADDR("/ibm,vtpm"));
1431        if (!IHANDLE_VALID(ibmvtpm_inst)) {
1432                prom_printf("opening vtpm package failed (%x)\n", ibmvtpm_inst);
1433                return;
1434        }
1435
1436        if (call_prom_ret("call-method", 2, 2, &size,
1437                          ADDR("sml-get-handover-size"),
1438                          ibmvtpm_inst) != 0 || size == 0) {
1439                prom_printf("SML get handover size failed\n");
1440                return;
1441        }
1442
1443        base = alloc_down(size, PAGE_SIZE, 0);
1444        if (base == 0)
1445                prom_panic("Could not allocate memory for sml\n");
1446
1447        prom_printf("instantiating sml at 0x%x...", base);
1448
1449        if (call_prom_ret("call-method", 4, 2, &entry,
1450                          ADDR("sml-handover"),
1451                          ibmvtpm_inst, size, base) != 0 || entry == 0) {
1452                prom_printf("SML handover failed\n");
1453                return;
1454        }
1455        prom_printf(" done\n");
1456
1457        reserve_mem(base, size);
1458
1459        prom_setprop(ibmvtpm_node, "/ibm,vtpm", "linux,sml-base",
1460                     &base, sizeof(base));
1461        prom_setprop(ibmvtpm_node, "/ibm,vtpm", "linux,sml-size",
1462                     &size, sizeof(size));
1463
1464        prom_debug("sml base     = 0x%x\n", base);
1465        prom_debug("sml size     = 0x%x\n", (long)size);
1466
1467        prom_debug("prom_instantiate_sml: end...\n");
1468}
1469
1470/*
1471 * Allocate room for and initialize TCE tables
1472 */
1473#ifdef __BIG_ENDIAN__
1474static void __init prom_initialize_tce_table(void)
1475{
1476        phandle node;
1477        ihandle phb_node;
1478        char compatible[64], type[64], model[64];
1479        char *path = prom_scratch;
1480        u64 base, align;
1481        u32 minalign, minsize;
1482        u64 tce_entry, *tce_entryp;
1483        u64 local_alloc_top, local_alloc_bottom;
1484        u64 i;
1485
1486        if (prom_iommu_off)
1487                return;
1488
1489        prom_debug("starting prom_initialize_tce_table\n");
1490
1491        /* Cache current top of allocs so we reserve a single block */
1492        local_alloc_top = alloc_top_high;
1493        local_alloc_bottom = local_alloc_top;
1494
1495        /* Search all nodes looking for PHBs. */
1496        for (node = 0; prom_next_node(&node); ) {
1497                compatible[0] = 0;
1498                type[0] = 0;
1499                model[0] = 0;
1500                prom_getprop(node, "compatible",
1501                             compatible, sizeof(compatible));
1502                prom_getprop(node, "device_type", type, sizeof(type));
1503                prom_getprop(node, "model", model, sizeof(model));
1504
1505                if ((type[0] == 0) || (strstr(type, "pci") == NULL))
1506                        continue;
1507
1508                /* Keep the old logic intact to avoid regression. */
1509                if (compatible[0] != 0) {
1510                        if ((strstr(compatible, "python") == NULL) &&
1511                            (strstr(compatible, "Speedwagon") == NULL) &&
1512                            (strstr(compatible, "Winnipeg") == NULL))
1513                                continue;
1514                } else if (model[0] != 0) {
1515                        if ((strstr(model, "ython") == NULL) &&
1516                            (strstr(model, "peedwagon") == NULL) &&
1517                            (strstr(model, "innipeg") == NULL))
1518                                continue;
1519                }
1520
1521                if (prom_getprop(node, "tce-table-minalign", &minalign,
1522                                 sizeof(minalign)) == PROM_ERROR)
1523                        minalign = 0;
1524                if (prom_getprop(node, "tce-table-minsize", &minsize,
1525                                 sizeof(minsize)) == PROM_ERROR)
1526                        minsize = 4UL << 20;
1527
1528                /*
1529                 * Even though we read what OF wants, we just set the table
1530                 * size to 4 MB.  This is enough to map 2GB of PCI DMA space.
1531                 * By doing this, we avoid the pitfalls of trying to DMA to
1532                 * MMIO space and the DMA alias hole.
1533                 *
1534                 * On POWER4, firmware sets the TCE region by assuming
1535                 * each TCE table is 8MB. Using this memory for anything
1536                 * else will impact performance, so we always allocate 8MB.
1537                 * Anton
1538                 */
1539                if (pvr_version_is(PVR_POWER4) || pvr_version_is(PVR_POWER4p))
1540                        minsize = 8UL << 20;
1541                else
1542                        minsize = 4UL << 20;
1543
1544                /* Align to the greater of the align or size */
1545                align = max(minalign, minsize);
1546                base = alloc_down(minsize, align, 1);
1547                if (base == 0)
1548                        prom_panic("ERROR, cannot find space for TCE table.\n");
1549                if (base < local_alloc_bottom)
1550                        local_alloc_bottom = base;
1551
1552                /* It seems OF doesn't null-terminate the path :-( */
1553                memset(path, 0, PROM_SCRATCH_SIZE);
1554                /* Call OF to setup the TCE hardware */
1555                if (call_prom("package-to-path", 3, 1, node,
1556                              path, PROM_SCRATCH_SIZE-1) == PROM_ERROR) {
1557                        prom_printf("package-to-path failed\n");
1558                }
1559
1560                /* Save away the TCE table attributes for later use. */
1561                prom_setprop(node, path, "linux,tce-base", &base, sizeof(base));
1562                prom_setprop(node, path, "linux,tce-size", &minsize, sizeof(minsize));
1563
1564                prom_debug("TCE table: %s\n", path);
1565                prom_debug("\tnode = 0x%x\n", node);
1566                prom_debug("\tbase = 0x%x\n", base);
1567                prom_debug("\tsize = 0x%x\n", minsize);
1568
1569                /* Initialize the table to have a one-to-one mapping
1570                 * over the allocated size.
1571                 */
1572                tce_entryp = (u64 *)base;
1573                for (i = 0; i < (minsize >> 3) ;tce_entryp++, i++) {
1574                        tce_entry = (i << PAGE_SHIFT);
1575                        tce_entry |= 0x3;
1576                        *tce_entryp = tce_entry;
1577                }
1578
1579                prom_printf("opening PHB %s", path);
1580                phb_node = call_prom("open", 1, 1, path);
1581                if (phb_node == 0)
1582                        prom_printf("... failed\n");
1583                else
1584                        prom_printf("... done\n");
1585
1586                call_prom("call-method", 6, 0, ADDR("set-64-bit-addressing"),
1587                          phb_node, -1, minsize,
1588                          (u32) base, (u32) (base >> 32));
1589                call_prom("close", 1, 0, phb_node);
1590        }
1591
1592        reserve_mem(local_alloc_bottom, local_alloc_top - local_alloc_bottom);
1593
1594        /* These are only really needed if there is a memory limit in
1595         * effect, but we don't know so export them always. */
1596        prom_tce_alloc_start = local_alloc_bottom;
1597        prom_tce_alloc_end = local_alloc_top;
1598
1599        /* Flag the first invalid entry */
1600        prom_debug("ending prom_initialize_tce_table\n");
1601}
1602#endif /* __BIG_ENDIAN__ */
1603#endif /* CONFIG_PPC64 */
1604
1605/*
1606 * With CHRP SMP we need to use the OF to start the other processors.
1607 * We can't wait until smp_boot_cpus (the OF is trashed by then)
1608 * so we have to put the processors into a holding pattern controlled
1609 * by the kernel (not OF) before we destroy the OF.
1610 *
1611 * This uses a chunk of low memory, puts some holding pattern
1612 * code there and sends the other processors off to there until
1613 * smp_boot_cpus tells them to do something.  The holding pattern
1614 * checks that address until its cpu # is there, when it is that
1615 * cpu jumps to __secondary_start().  smp_boot_cpus() takes care
1616 * of setting those values.
1617 *
1618 * We also use physical address 0x4 here to tell when a cpu
1619 * is in its holding pattern code.
1620 *
1621 * -- Cort
1622 */
1623/*
1624 * We want to reference the copy of __secondary_hold_* in the
1625 * 0 - 0x100 address range
1626 */
1627#define LOW_ADDR(x)     (((unsigned long) &(x)) & 0xff)
1628
1629static void __init prom_hold_cpus(void)
1630{
1631        unsigned long i;
1632        phandle node;
1633        char type[64];
1634        unsigned long *spinloop
1635                = (void *) LOW_ADDR(__secondary_hold_spinloop);
1636        unsigned long *acknowledge
1637                = (void *) LOW_ADDR(__secondary_hold_acknowledge);
1638        unsigned long secondary_hold = LOW_ADDR(__secondary_hold);
1639
1640        /*
1641         * On pseries, if RTAS supports "query-cpu-stopped-state",
1642         * we skip this stage, the CPUs will be started by the
1643         * kernel using RTAS.
1644         */
1645        if ((of_platform == PLATFORM_PSERIES ||
1646             of_platform == PLATFORM_PSERIES_LPAR) &&
1647            rtas_has_query_cpu_stopped) {
1648                prom_printf("prom_hold_cpus: skipped\n");
1649                return;
1650        }
1651
1652        prom_debug("prom_hold_cpus: start...\n");
1653        prom_debug("    1) spinloop       = 0x%x\n", (unsigned long)spinloop);
1654        prom_debug("    1) *spinloop      = 0x%x\n", *spinloop);
1655        prom_debug("    1) acknowledge    = 0x%x\n",
1656                   (unsigned long)acknowledge);
1657        prom_debug("    1) *acknowledge   = 0x%x\n", *acknowledge);
1658        prom_debug("    1) secondary_hold = 0x%x\n", secondary_hold);
1659
1660        /* Set the common spinloop variable, so all of the secondary cpus
1661         * will block when they are awakened from their OF spinloop.
1662         * This must occur for both SMP and non SMP kernels, since OF will
1663         * be trashed when we move the kernel.
1664         */
1665        *spinloop = 0;
1666
1667        /* look for cpus */
1668        for (node = 0; prom_next_node(&node); ) {
1669                unsigned int cpu_no;
1670                __be32 reg;
1671
1672                type[0] = 0;
1673                prom_getprop(node, "device_type", type, sizeof(type));
1674                if (strcmp(type, "cpu") != 0)
1675                        continue;
1676
1677                /* Skip non-configured cpus. */
1678                if (prom_getprop(node, "status", type, sizeof(type)) > 0)
1679                        if (strcmp(type, "okay") != 0)
1680                                continue;
1681
1682                reg = cpu_to_be32(-1); /* make sparse happy */
1683                prom_getprop(node, "reg", &reg, sizeof(reg));
1684                cpu_no = be32_to_cpu(reg);
1685
1686                prom_debug("cpu hw idx   = %lu\n", cpu_no);
1687
1688                /* Init the acknowledge var which will be reset by
1689                 * the secondary cpu when it awakens from its OF
1690                 * spinloop.
1691                 */
1692                *acknowledge = (unsigned long)-1;
1693
1694                if (cpu_no != prom.cpu) {
1695                        /* Primary Thread of non-boot cpu or any thread */
1696                        prom_printf("starting cpu hw idx %lu... ", cpu_no);
1697                        call_prom("start-cpu", 3, 0, node,
1698                                  secondary_hold, cpu_no);
1699
1700                        for (i = 0; (i < 100000000) && 
1701                             (*acknowledge == ((unsigned long)-1)); i++ )
1702                                mb();
1703
1704                        if (*acknowledge == cpu_no)
1705                                prom_printf("done\n");
1706                        else
1707                                prom_printf("failed: %x\n", *acknowledge);
1708                }
1709#ifdef CONFIG_SMP
1710                else
1711                        prom_printf("boot cpu hw idx %lu\n", cpu_no);
1712#endif /* CONFIG_SMP */
1713        }
1714
1715        prom_debug("prom_hold_cpus: end...\n");
1716}
1717
1718
1719static void __init prom_init_client_services(unsigned long pp)
1720{
1721        /* Get a handle to the prom entry point before anything else */
1722        prom_entry = pp;
1723
1724        /* get a handle for the stdout device */
1725        prom.chosen = call_prom("finddevice", 1, 1, ADDR("/chosen"));
1726        if (!PHANDLE_VALID(prom.chosen))
1727                prom_panic("cannot find chosen"); /* msg won't be printed :( */
1728
1729        /* get device tree root */
1730        prom.root = call_prom("finddevice", 1, 1, ADDR("/"));
1731        if (!PHANDLE_VALID(prom.root))
1732                prom_panic("cannot find device tree root"); /* msg won't be printed :( */
1733
1734        prom.mmumap = 0;
1735}
1736
1737#ifdef CONFIG_PPC32
1738/*
1739 * For really old powermacs, we need to map things we claim.
1740 * For that, we need the ihandle of the mmu.
1741 * Also, on the longtrail, we need to work around other bugs.
1742 */
1743static void __init prom_find_mmu(void)
1744{
1745        phandle oprom;
1746        char version[64];
1747
1748        oprom = call_prom("finddevice", 1, 1, ADDR("/openprom"));
1749        if (!PHANDLE_VALID(oprom))
1750                return;
1751        if (prom_getprop(oprom, "model", version, sizeof(version)) <= 0)
1752                return;
1753        version[sizeof(version) - 1] = 0;
1754        /* XXX might need to add other versions here */
1755        if (strcmp(version, "Open Firmware, 1.0.5") == 0)
1756                of_workarounds = OF_WA_CLAIM;
1757        else if (strncmp(version, "FirmWorks,3.", 12) == 0) {
1758                of_workarounds = OF_WA_CLAIM | OF_WA_LONGTRAIL;
1759                call_prom("interpret", 1, 1, "dev /memory 0 to allow-reclaim");
1760        } else
1761                return;
1762        prom.memory = call_prom("open", 1, 1, ADDR("/memory"));
1763        prom_getprop(prom.chosen, "mmu", &prom.mmumap,
1764                     sizeof(prom.mmumap));
1765        prom.mmumap = be32_to_cpu(prom.mmumap);
1766        if (!IHANDLE_VALID(prom.memory) || !IHANDLE_VALID(prom.mmumap))
1767                of_workarounds &= ~OF_WA_CLAIM;         /* hmmm */
1768}
1769#else
1770#define prom_find_mmu()
1771#endif
1772
1773static void __init prom_init_stdout(void)
1774{
1775        char *path = of_stdout_device;
1776        char type[16];
1777        phandle stdout_node;
1778        __be32 val;
1779
1780        if (prom_getprop(prom.chosen, "stdout", &val, sizeof(val)) <= 0)
1781                prom_panic("cannot find stdout");
1782
1783        prom.stdout = be32_to_cpu(val);
1784
1785        /* Get the full OF pathname of the stdout device */
1786        memset(path, 0, 256);
1787        call_prom("instance-to-path", 3, 1, prom.stdout, path, 255);
1788        prom_printf("OF stdout device is: %s\n", of_stdout_device);
1789        prom_setprop(prom.chosen, "/chosen", "linux,stdout-path",
1790                     path, strlen(path) + 1);
1791
1792        /* instance-to-package fails on PA-Semi */
1793        stdout_node = call_prom("instance-to-package", 1, 1, prom.stdout);
1794        if (stdout_node != PROM_ERROR) {
1795                val = cpu_to_be32(stdout_node);
1796                prom_setprop(prom.chosen, "/chosen", "linux,stdout-package",
1797                             &val, sizeof(val));
1798
1799                /* If it's a display, note it */
1800                memset(type, 0, sizeof(type));
1801                prom_getprop(stdout_node, "device_type", type, sizeof(type));
1802                if (strcmp(type, "display") == 0)
1803                        prom_setprop(stdout_node, path, "linux,boot-display", NULL, 0);
1804        }
1805}
1806
1807static int __init prom_find_machine_type(void)
1808{
1809        char compat[256];
1810        int len, i = 0;
1811#ifdef CONFIG_PPC64
1812        phandle rtas;
1813        int x;
1814#endif
1815
1816        /* Look for a PowerMac or a Cell */
1817        len = prom_getprop(prom.root, "compatible",
1818                           compat, sizeof(compat)-1);
1819        if (len > 0) {
1820                compat[len] = 0;
1821                while (i < len) {
1822                        char *p = &compat[i];
1823                        int sl = strlen(p);
1824                        if (sl == 0)
1825                                break;
1826                        if (strstr(p, "Power Macintosh") ||
1827                            strstr(p, "MacRISC"))
1828                                return PLATFORM_POWERMAC;
1829#ifdef CONFIG_PPC64
1830                        /* We must make sure we don't detect the IBM Cell
1831                         * blades as pSeries due to some firmware issues,
1832                         * so we do it here.
1833                         */
1834                        if (strstr(p, "IBM,CBEA") ||
1835                            strstr(p, "IBM,CPBW-1.0"))
1836                                return PLATFORM_GENERIC;
1837#endif /* CONFIG_PPC64 */
1838                        i += sl + 1;
1839                }
1840        }
1841#ifdef CONFIG_PPC64
1842        /* Try to detect OPAL */
1843        if (PHANDLE_VALID(call_prom("finddevice", 1, 1, ADDR("/ibm,opal"))))
1844                return PLATFORM_OPAL;
1845
1846        /* Try to figure out if it's an IBM pSeries or any other
1847         * PAPR compliant platform. We assume it is if :
1848         *  - /device_type is "chrp" (please, do NOT use that for future
1849         *    non-IBM designs !
1850         *  - it has /rtas
1851         */
1852        len = prom_getprop(prom.root, "device_type",
1853                           compat, sizeof(compat)-1);
1854        if (len <= 0)
1855                return PLATFORM_GENERIC;
1856        if (strcmp(compat, "chrp"))
1857                return PLATFORM_GENERIC;
1858
1859        /* Default to pSeries. We need to know if we are running LPAR */
1860        rtas = call_prom("finddevice", 1, 1, ADDR("/rtas"));
1861        if (!PHANDLE_VALID(rtas))
1862                return PLATFORM_GENERIC;
1863        x = prom_getproplen(rtas, "ibm,hypertas-functions");
1864        if (x != PROM_ERROR) {
1865                prom_debug("Hypertas detected, assuming LPAR !\n");
1866                return PLATFORM_PSERIES_LPAR;
1867        }
1868        return PLATFORM_PSERIES;
1869#else
1870        return PLATFORM_GENERIC;
1871#endif
1872}
1873
1874static int __init prom_set_color(ihandle ih, int i, int r, int g, int b)
1875{
1876        return call_prom("call-method", 6, 1, ADDR("color!"), ih, i, b, g, r);
1877}
1878
1879/*
1880 * If we have a display that we don't know how to drive,
1881 * we will want to try to execute OF's open method for it
1882 * later.  However, OF will probably fall over if we do that
1883 * we've taken over the MMU.
1884 * So we check whether we will need to open the display,
1885 * and if so, open it now.
1886 */
1887static void __init prom_check_displays(void)
1888{
1889        char type[16], *path;
1890        phandle node;
1891        ihandle ih;
1892        int i;
1893
1894        static unsigned char default_colors[] = {
1895                0x00, 0x00, 0x00,
1896                0x00, 0x00, 0xaa,
1897                0x00, 0xaa, 0x00,
1898                0x00, 0xaa, 0xaa,
1899                0xaa, 0x00, 0x00,
1900                0xaa, 0x00, 0xaa,
1901                0xaa, 0xaa, 0x00,
1902                0xaa, 0xaa, 0xaa,
1903                0x55, 0x55, 0x55,
1904                0x55, 0x55, 0xff,
1905                0x55, 0xff, 0x55,
1906                0x55, 0xff, 0xff,
1907                0xff, 0x55, 0x55,
1908                0xff, 0x55, 0xff,
1909                0xff, 0xff, 0x55,
1910                0xff, 0xff, 0xff
1911        };
1912        const unsigned char *clut;
1913
1914        prom_debug("Looking for displays\n");
1915        for (node = 0; prom_next_node(&node); ) {
1916                memset(type, 0, sizeof(type));
1917                prom_getprop(node, "device_type", type, sizeof(type));
1918                if (strcmp(type, "display") != 0)
1919                        continue;
1920
1921                /* It seems OF doesn't null-terminate the path :-( */
1922                path = prom_scratch;
1923                memset(path, 0, PROM_SCRATCH_SIZE);
1924
1925                /*
1926                 * leave some room at the end of the path for appending extra
1927                 * arguments
1928                 */
1929                if (call_prom("package-to-path", 3, 1, node, path,
1930                              PROM_SCRATCH_SIZE-10) == PROM_ERROR)
1931                        continue;
1932                prom_printf("found display   : %s, opening... ", path);
1933                
1934                ih = call_prom("open", 1, 1, path);
1935                if (ih == 0) {
1936                        prom_printf("failed\n");
1937                        continue;
1938                }
1939
1940                /* Success */
1941                prom_printf("done\n");
1942                prom_setprop(node, path, "linux,opened", NULL, 0);
1943
1944                /* Setup a usable color table when the appropriate
1945                 * method is available. Should update this to set-colors */
1946                clut = default_colors;
1947                for (i = 0; i < 16; i++, clut += 3)
1948                        if (prom_set_color(ih, i, clut[0], clut[1],
1949                                           clut[2]) != 0)
1950                                break;
1951
1952#ifdef CONFIG_LOGO_LINUX_CLUT224
1953                clut = PTRRELOC(logo_linux_clut224.clut);
1954                for (i = 0; i < logo_linux_clut224.clutsize; i++, clut += 3)
1955                        if (prom_set_color(ih, i + 32, clut[0], clut[1],
1956                                           clut[2]) != 0)
1957                                break;
1958#endif /* CONFIG_LOGO_LINUX_CLUT224 */
1959
1960#ifdef CONFIG_PPC_EARLY_DEBUG_BOOTX
1961                if (prom_getprop(node, "linux,boot-display", NULL, 0) !=
1962                    PROM_ERROR) {
1963                        u32 width, height, pitch, addr;
1964
1965                        prom_printf("Setting btext !\n");
1966                        prom_getprop(node, "width", &width, 4);
1967                        prom_getprop(node, "height", &height, 4);
1968                        prom_getprop(node, "linebytes", &pitch, 4);
1969                        prom_getprop(node, "address", &addr, 4);
1970                        prom_printf("W=%d H=%d LB=%d addr=0x%x\n",
1971                                    width, height, pitch, addr);
1972                        btext_setup_display(width, height, 8, pitch, addr);
1973                }
1974#endif /* CONFIG_PPC_EARLY_DEBUG_BOOTX */
1975        }
1976}
1977
1978
1979/* Return (relocated) pointer to this much memory: moves initrd if reqd. */
1980static void __init *make_room(unsigned long *mem_start, unsigned long *mem_end,
1981                              unsigned long needed, unsigned long align)
1982{
1983        void *ret;
1984
1985        *mem_start = _ALIGN(*mem_start, align);
1986        while ((*mem_start + needed) > *mem_end) {
1987                unsigned long room, chunk;
1988
1989                prom_debug("Chunk exhausted, claiming more at %x...\n",
1990                           alloc_bottom);
1991                room = alloc_top - alloc_bottom;
1992                if (room > DEVTREE_CHUNK_SIZE)
1993                        room = DEVTREE_CHUNK_SIZE;
1994                if (room < PAGE_SIZE)
1995                        prom_panic("No memory for flatten_device_tree "
1996                                   "(no room)\n");
1997                chunk = alloc_up(room, 0);
1998                if (chunk == 0)
1999                        prom_panic("No memory for flatten_device_tree "
2000                                   "(claim failed)\n");
2001                *mem_end = chunk + room;
2002        }
2003
2004        ret = (void *)*mem_start;
2005        *mem_start += needed;
2006
2007        return ret;
2008}
2009
2010#define dt_push_token(token, mem_start, mem_end) do {                   \
2011                void *room = make_room(mem_start, mem_end, 4, 4);       \
2012                *(__be32 *)room = cpu_to_be32(token);                   \
2013        } while(0)
2014
2015static unsigned long __init dt_find_string(char *str)
2016{
2017        char *s, *os;
2018
2019        s = os = (char *)dt_string_start;
2020        s += 4;
2021        while (s <  (char *)dt_string_end) {
2022                if (strcmp(s, str) == 0)
2023                        return s - os;
2024                s += strlen(s) + 1;
2025        }
2026        return 0;
2027}
2028
2029/*
2030 * The Open Firmware 1275 specification states properties must be 31 bytes or
2031 * less, however not all firmwares obey this. Make it 64 bytes to be safe.
2032 */
2033#define MAX_PROPERTY_NAME 64
2034
2035static void __init scan_dt_build_strings(phandle node,
2036                                         unsigned long *mem_start,
2037                                         unsigned long *mem_end)
2038{
2039        char *prev_name, *namep, *sstart;
2040        unsigned long soff;
2041        phandle child;
2042
2043        sstart =  (char *)dt_string_start;
2044
2045        /* get and store all property names */
2046        prev_name = "";
2047        for (;;) {
2048                /* 64 is max len of name including nul. */
2049                namep = make_room(mem_start, mem_end, MAX_PROPERTY_NAME, 1);
2050                if (call_prom("nextprop", 3, 1, node, prev_name, namep) != 1) {
2051                        /* No more nodes: unwind alloc */
2052                        *mem_start = (unsigned long)namep;
2053                        break;
2054                }
2055
2056                /* skip "name" */
2057                if (strcmp(namep, "name") == 0) {
2058                        *mem_start = (unsigned long)namep;
2059                        prev_name = "name";
2060                        continue;
2061                }
2062                /* get/create string entry */
2063                soff = dt_find_string(namep);
2064                if (soff != 0) {
2065                        *mem_start = (unsigned long)namep;
2066                        namep = sstart + soff;
2067                } else {
2068                        /* Trim off some if we can */
2069                        *mem_start = (unsigned long)namep + strlen(namep) + 1;
2070                        dt_string_end = *mem_start;
2071                }
2072                prev_name = namep;
2073        }
2074
2075        /* do all our children */
2076        child = call_prom("child", 1, 1, node);
2077        while (child != 0) {
2078                scan_dt_build_strings(child, mem_start, mem_end);
2079                child = call_prom("peer", 1, 1, child);
2080        }
2081}
2082
2083static void __init scan_dt_build_struct(phandle node, unsigned long *mem_start,
2084                                        unsigned long *mem_end)
2085{
2086        phandle child;
2087        char *namep, *prev_name, *sstart, *p, *ep, *lp, *path;
2088        unsigned long soff;
2089        unsigned char *valp;
2090        static char pname[MAX_PROPERTY_NAME];
2091        int l, room, has_phandle = 0;
2092
2093        dt_push_token(OF_DT_BEGIN_NODE, mem_start, mem_end);
2094
2095        /* get the node's full name */
2096        namep = (char *)*mem_start;
2097        room = *mem_end - *mem_start;
2098        if (room > 255)
2099                room = 255;
2100        l = call_prom("package-to-path", 3, 1, node, namep, room);
2101        if (l >= 0) {
2102                /* Didn't fit?  Get more room. */
2103                if (l >= room) {
2104                        if (l >= *mem_end - *mem_start)
2105                                namep = make_room(mem_start, mem_end, l+1, 1);
2106                        call_prom("package-to-path", 3, 1, node, namep, l);
2107                }
2108                namep[l] = '\0';
2109
2110                /* Fixup an Apple bug where they have bogus \0 chars in the
2111                 * middle of the path in some properties, and extract
2112                 * the unit name (everything after the last '/').
2113                 */
2114                for (lp = p = namep, ep = namep + l; p < ep; p++) {
2115                        if (*p == '/')
2116                                lp = namep;
2117                        else if (*p != 0)
2118                                *lp++ = *p;
2119                }
2120                *lp = 0;
2121                *mem_start = _ALIGN((unsigned long)lp + 1, 4);
2122        }
2123
2124        /* get it again for debugging */
2125        path = prom_scratch;
2126        memset(path, 0, PROM_SCRATCH_SIZE);
2127        call_prom("package-to-path", 3, 1, node, path, PROM_SCRATCH_SIZE-1);
2128
2129        /* get and store all properties */
2130        prev_name = "";
2131        sstart = (char *)dt_string_start;
2132        for (;;) {
2133                if (call_prom("nextprop", 3, 1, node, prev_name,
2134                              pname) != 1)
2135                        break;
2136
2137                /* skip "name" */
2138                if (strcmp(pname, "name") == 0) {
2139                        prev_name = "name";
2140                        continue;
2141                }
2142
2143                /* find string offset */
2144                soff = dt_find_string(pname);
2145                if (soff == 0) {
2146                        prom_printf("WARNING: Can't find string index for"
2147                                    " <%s>, node %s\n", pname, path);
2148                        break;
2149                }
2150                prev_name = sstart + soff;
2151
2152                /* get length */
2153                l = call_prom("getproplen", 2, 1, node, pname);
2154
2155                /* sanity checks */
2156                if (l == PROM_ERROR)
2157                        continue;
2158
2159                /* push property head */
2160                dt_push_token(OF_DT_PROP, mem_start, mem_end);
2161                dt_push_token(l, mem_start, mem_end);
2162                dt_push_token(soff, mem_start, mem_end);
2163
2164                /* push property content */
2165                valp = make_room(mem_start, mem_end, l, 4);
2166                call_prom("getprop", 4, 1, node, pname, valp, l);
2167                *mem_start = _ALIGN(*mem_start, 4);
2168
2169                if (!strcmp(pname, "phandle"))
2170                        has_phandle = 1;
2171        }
2172
2173        /* Add a "linux,phandle" property if no "phandle" property already
2174         * existed (can happen with OPAL)
2175         */
2176        if (!has_phandle) {
2177                soff = dt_find_string("linux,phandle");
2178                if (soff == 0)
2179                        prom_printf("WARNING: Can't find string index for"
2180                                    " <linux-phandle> node %s\n", path);
2181                else {
2182                        dt_push_token(OF_DT_PROP, mem_start, mem_end);
2183                        dt_push_token(4, mem_start, mem_end);
2184                        dt_push_token(soff, mem_start, mem_end);
2185                        valp = make_room(mem_start, mem_end, 4, 4);
2186                        *(__be32 *)valp = cpu_to_be32(node);
2187                }
2188        }
2189
2190        /* do all our children */
2191        child = call_prom("child", 1, 1, node);
2192        while (child != 0) {
2193                scan_dt_build_struct(child, mem_start, mem_end);
2194                child = call_prom("peer", 1, 1, child);
2195        }
2196
2197        dt_push_token(OF_DT_END_NODE, mem_start, mem_end);
2198}
2199
2200static void __init flatten_device_tree(void)
2201{
2202        phandle root;
2203        unsigned long mem_start, mem_end, room;
2204        struct boot_param_header *hdr;
2205        char *namep;
2206        u64 *rsvmap;
2207
2208        /*
2209         * Check how much room we have between alloc top & bottom (+/- a
2210         * few pages), crop to 1MB, as this is our "chunk" size
2211         */
2212        room = alloc_top - alloc_bottom - 0x4000;
2213        if (room > DEVTREE_CHUNK_SIZE)
2214                room = DEVTREE_CHUNK_SIZE;
2215        prom_debug("starting device tree allocs at %x\n", alloc_bottom);
2216
2217        /* Now try to claim that */
2218        mem_start = (unsigned long)alloc_up(room, PAGE_SIZE);
2219        if (mem_start == 0)
2220                prom_panic("Can't allocate initial device-tree chunk\n");
2221        mem_end = mem_start + room;
2222
2223        /* Get root of tree */
2224        root = call_prom("peer", 1, 1, (phandle)0);
2225        if (root == (phandle)0)
2226                prom_panic ("couldn't get device tree root\n");
2227
2228        /* Build header and make room for mem rsv map */ 
2229        mem_start = _ALIGN(mem_start, 4);
2230        hdr = make_room(&mem_start, &mem_end,
2231                        sizeof(struct boot_param_header), 4);
2232        dt_header_start = (unsigned long)hdr;
2233        rsvmap = make_room(&mem_start, &mem_end, sizeof(mem_reserve_map), 8);
2234
2235        /* Start of strings */
2236        mem_start = PAGE_ALIGN(mem_start);
2237        dt_string_start = mem_start;
2238        mem_start += 4; /* hole */
2239
2240        /* Add "linux,phandle" in there, we'll need it */
2241        namep = make_room(&mem_start, &mem_end, 16, 1);
2242        strcpy(namep, "linux,phandle");
2243        mem_start = (unsigned long)namep + strlen(namep) + 1;
2244
2245        /* Build string array */
2246        prom_printf("Building dt strings...\n"); 
2247        scan_dt_build_strings(root, &mem_start, &mem_end);
2248        dt_string_end = mem_start;
2249
2250        /* Build structure */
2251        mem_start = PAGE_ALIGN(mem_start);
2252        dt_struct_start = mem_start;
2253        prom_printf("Building dt structure...\n"); 
2254        scan_dt_build_struct(root, &mem_start, &mem_end);
2255        dt_push_token(OF_DT_END, &mem_start, &mem_end);
2256        dt_struct_end = PAGE_ALIGN(mem_start);
2257
2258        /* Finish header */
2259        hdr->boot_cpuid_phys = cpu_to_be32(prom.cpu);
2260        hdr->magic = cpu_to_be32(OF_DT_HEADER);
2261        hdr->totalsize = cpu_to_be32(dt_struct_end - dt_header_start);
2262        hdr->off_dt_struct = cpu_to_be32(dt_struct_start - dt_header_start);
2263        hdr->off_dt_strings = cpu_to_be32(dt_string_start - dt_header_start);
2264        hdr->dt_strings_size = cpu_to_be32(dt_string_end - dt_string_start);
2265        hdr->off_mem_rsvmap = cpu_to_be32(((unsigned long)rsvmap) - dt_header_start);
2266        hdr->version = cpu_to_be32(OF_DT_VERSION);
2267        /* Version 16 is not backward compatible */
2268        hdr->last_comp_version = cpu_to_be32(0x10);
2269
2270        /* Copy the reserve map in */
2271        memcpy(rsvmap, mem_reserve_map, sizeof(mem_reserve_map));
2272
2273#ifdef DEBUG_PROM
2274        {
2275                int i;
2276                prom_printf("reserved memory map:\n");
2277                for (i = 0; i < mem_reserve_cnt; i++)
2278                        prom_printf("  %x - %x\n",
2279                                    be64_to_cpu(mem_reserve_map[i].base),
2280                                    be64_to_cpu(mem_reserve_map[i].size));
2281        }
2282#endif
2283        /* Bump mem_reserve_cnt to cause further reservations to fail
2284         * since it's too late.
2285         */
2286        mem_reserve_cnt = MEM_RESERVE_MAP_SIZE;
2287
2288        prom_printf("Device tree strings 0x%x -> 0x%x\n",
2289                    dt_string_start, dt_string_end);
2290        prom_printf("Device tree struct  0x%x -> 0x%x\n",
2291                    dt_struct_start, dt_struct_end);
2292}
2293
2294#ifdef CONFIG_PPC_MAPLE
2295/* PIBS Version 1.05.0000 04/26/2005 has an incorrect /ht/isa/ranges property.
2296 * The values are bad, and it doesn't even have the right number of cells. */
2297static void __init fixup_device_tree_maple(void)
2298{
2299        phandle isa;
2300        u32 rloc = 0x01002000; /* IO space; PCI device = 4 */
2301        u32 isa_ranges[6];
2302        char *name;
2303
2304        name = "/ht@0/isa@4";
2305        isa = call_prom("finddevice", 1, 1, ADDR(name));
2306        if (!PHANDLE_VALID(isa)) {
2307                name = "/ht@0/isa@6";
2308                isa = call_prom("finddevice", 1, 1, ADDR(name));
2309                rloc = 0x01003000; /* IO space; PCI device = 6 */
2310        }
2311        if (!PHANDLE_VALID(isa))
2312                return;
2313
2314        if (prom_getproplen(isa, "ranges") != 12)
2315                return;
2316        if (prom_getprop(isa, "ranges", isa_ranges, sizeof(isa_ranges))
2317                == PROM_ERROR)
2318                return;
2319
2320        if (isa_ranges[0] != 0x1 ||
2321                isa_ranges[1] != 0xf4000000 ||
2322                isa_ranges[2] != 0x00010000)
2323                return;
2324
2325        prom_printf("Fixing up bogus ISA range on Maple/Apache...\n");
2326
2327        isa_ranges[0] = 0x1;
2328        isa_ranges[1] = 0x0;
2329        isa_ranges[2] = rloc;
2330        isa_ranges[3] = 0x0;
2331        isa_ranges[4] = 0x0;
2332        isa_ranges[5] = 0x00010000;
2333        prom_setprop(isa, name, "ranges",
2334                        isa_ranges, sizeof(isa_ranges));
2335}
2336
2337#define CPC925_MC_START         0xf8000000
2338#define CPC925_MC_LENGTH        0x1000000
2339/* The values for memory-controller don't have right number of cells */
2340static void __init fixup_device_tree_maple_memory_controller(void)
2341{
2342        phandle mc;
2343        u32 mc_reg[4];
2344        char *name = "/hostbridge@f8000000";
2345        u32 ac, sc;
2346
2347        mc = call_prom("finddevice", 1, 1, ADDR(name));
2348        if (!PHANDLE_VALID(mc))
2349                return;
2350
2351        if (prom_getproplen(mc, "reg") != 8)
2352                return;
2353
2354        prom_getprop(prom.root, "#address-cells", &ac, sizeof(ac));
2355        prom_getprop(prom.root, "#size-cells", &sc, sizeof(sc));
2356        if ((ac != 2) || (sc != 2))
2357                return;
2358
2359        if (prom_getprop(mc, "reg", mc_reg, sizeof(mc_reg)) == PROM_ERROR)
2360                return;
2361
2362        if (mc_reg[0] != CPC925_MC_START || mc_reg[1] != CPC925_MC_LENGTH)
2363                return;
2364
2365        prom_printf("Fixing up bogus hostbridge on Maple...\n");
2366
2367        mc_reg[0] = 0x0;
2368        mc_reg[1] = CPC925_MC_START;
2369        mc_reg[2] = 0x0;
2370        mc_reg[3] = CPC925_MC_LENGTH;
2371        prom_setprop(mc, name, "reg", mc_reg, sizeof(mc_reg));
2372}
2373#else
2374#define fixup_device_tree_maple()
2375#define fixup_device_tree_maple_memory_controller()
2376#endif
2377
2378#ifdef CONFIG_PPC_CHRP
2379/*
2380 * Pegasos and BriQ lacks the "ranges" property in the isa node
2381 * Pegasos needs decimal IRQ 14/15, not hexadecimal
2382 * Pegasos has the IDE configured in legacy mode, but advertised as native
2383 */
2384static void __init fixup_device_tree_chrp(void)
2385{
2386        phandle ph;
2387        u32 prop[6];
2388        u32 rloc = 0x01006000; /* IO space; PCI device = 12 */
2389        char *name;
2390        int rc;
2391
2392        name = "/pci@80000000/isa@c";
2393        ph = call_prom("finddevice", 1, 1, ADDR(name));
2394        if (!PHANDLE_VALID(ph)) {
2395                name = "/pci@ff500000/isa@6";
2396                ph = call_prom("finddevice", 1, 1, ADDR(name));
2397                rloc = 0x01003000; /* IO space; PCI device = 6 */
2398        }
2399        if (PHANDLE_VALID(ph)) {
2400                rc = prom_getproplen(ph, "ranges");
2401                if (rc == 0 || rc == PROM_ERROR) {
2402                        prom_printf("Fixing up missing ISA range on Pegasos...\n");
2403
2404                        prop[0] = 0x1;
2405                        prop[1] = 0x0;
2406                        prop[2] = rloc;
2407                        prop[3] = 0x0;
2408                        prop[4] = 0x0;
2409                        prop[5] = 0x00010000;
2410                        prom_setprop(ph, name, "ranges", prop, sizeof(prop));
2411                }
2412        }
2413
2414        name = "/pci@80000000/ide@C,1";
2415        ph = call_prom("finddevice", 1, 1, ADDR(name));
2416        if (PHANDLE_VALID(ph)) {
2417                prom_printf("Fixing up IDE interrupt on Pegasos...\n");
2418                prop[0] = 14;
2419                prop[1] = 0x0;
2420                prom_setprop(ph, name, "interrupts", prop, 2*sizeof(u32));
2421                prom_printf("Fixing up IDE class-code on Pegasos...\n");
2422                rc = prom_getprop(ph, "class-code", prop, sizeof(u32));
2423                if (rc == sizeof(u32)) {
2424                        prop[0] &= ~0x5;
2425                        prom_setprop(ph, name, "class-code", prop, sizeof(u32));
2426                }
2427        }
2428}
2429#else
2430#define fixup_device_tree_chrp()
2431#endif
2432
2433#if defined(CONFIG_PPC64) && defined(CONFIG_PPC_PMAC)
2434static void __init fixup_device_tree_pmac(void)
2435{
2436        phandle u3, i2c, mpic;
2437        u32 u3_rev;
2438        u32 interrupts[2];
2439        u32 parent;
2440
2441        /* Some G5s have a missing interrupt definition, fix it up here */
2442        u3 = call_prom("finddevice", 1, 1, ADDR("/u3@0,f8000000"));
2443        if (!PHANDLE_VALID(u3))
2444                return;
2445        i2c = call_prom("finddevice", 1, 1, ADDR("/u3@0,f8000000/i2c@f8001000"));
2446        if (!PHANDLE_VALID(i2c))
2447                return;
2448        mpic = call_prom("finddevice", 1, 1, ADDR("/u3@0,f8000000/mpic@f8040000"));
2449        if (!PHANDLE_VALID(mpic))
2450                return;
2451
2452        /* check if proper rev of u3 */
2453        if (prom_getprop(u3, "device-rev", &u3_rev, sizeof(u3_rev))
2454            == PROM_ERROR)
2455                return;
2456        if (u3_rev < 0x35 || u3_rev > 0x39)
2457                return;
2458        /* does it need fixup ? */
2459        if (prom_getproplen(i2c, "interrupts") > 0)
2460                return;
2461
2462        prom_printf("fixing up bogus interrupts for u3 i2c...\n");
2463
2464        /* interrupt on this revision of u3 is number 0 and level */
2465        interrupts[0] = 0;
2466        interrupts[1] = 1;
2467        prom_setprop(i2c, "/u3@0,f8000000/i2c@f8001000", "interrupts",
2468                     &interrupts, sizeof(interrupts));
2469        parent = (u32)mpic;
2470        prom_setprop(i2c, "/u3@0,f8000000/i2c@f8001000", "interrupt-parent",
2471                     &parent, sizeof(parent));
2472}
2473#else
2474#define fixup_device_tree_pmac()
2475#endif
2476
2477#ifdef CONFIG_PPC_EFIKA
2478/*
2479 * The MPC5200 FEC driver requires an phy-handle property to tell it how
2480 * to talk to the phy.  If the phy-handle property is missing, then this
2481 * function is called to add the appropriate nodes and link it to the
2482 * ethernet node.
2483 */
2484static void __init fixup_device_tree_efika_add_phy(void)
2485{
2486        u32 node;
2487        char prop[64];
2488        int rv;
2489
2490        /* Check if /builtin/ethernet exists - bail if it doesn't */
2491        node = call_prom("finddevice", 1, 1, ADDR("/builtin/ethernet"));
2492        if (!PHANDLE_VALID(node))
2493                return;
2494
2495        /* Check if the phy-handle property exists - bail if it does */
2496        rv = prom_getprop(node, "phy-handle", prop, sizeof(prop));
2497        if (!rv)
2498                return;
2499
2500        /*
2501         * At this point the ethernet device doesn't have a phy described.
2502         * Now we need to add the missing phy node and linkage
2503         */
2504
2505        /* Check for an MDIO bus node - if missing then create one */
2506        node = call_prom("finddevice", 1, 1, ADDR("/builtin/mdio"));
2507        if (!PHANDLE_VALID(node)) {
2508                prom_printf("Adding Ethernet MDIO node\n");
2509                call_prom("interpret", 1, 1,
2510                        " s\" /builtin\" find-device"
2511                        " new-device"
2512                                " 1 encode-int s\" #address-cells\" property"
2513                                " 0 encode-int s\" #size-cells\" property"
2514                                " s\" mdio\" device-name"
2515                                " s\" fsl,mpc5200b-mdio\" encode-string"
2516                                " s\" compatible\" property"
2517                                " 0xf0003000 0x400 reg"
2518                                " 0x2 encode-int"
2519                                " 0x5 encode-int encode+"
2520                                " 0x3 encode-int encode+"
2521                                " s\" interrupts\" property"
2522                        " finish-device");
2523        };
2524
2525        /* Check for a PHY device node - if missing then create one and
2526         * give it's phandle to the ethernet node */
2527        node = call_prom("finddevice", 1, 1,
2528                         ADDR("/builtin/mdio/ethernet-phy"));
2529        if (!PHANDLE_VALID(node)) {
2530                prom_printf("Adding Ethernet PHY node\n");
2531                call_prom("interpret", 1, 1,
2532                        " s\" /builtin/mdio\" find-device"
2533                        " new-device"
2534                                " s\" ethernet-phy\" device-name"
2535                                " 0x10 encode-int s\" reg\" property"
2536                                " my-self"
2537                                " ihandle>phandle"
2538                        " finish-device"
2539                        " s\" /builtin/ethernet\" find-device"
2540                                " encode-int"
2541                                " s\" phy-handle\" property"
2542                        " device-end");
2543        }
2544}
2545
2546static void __init fixup_device_tree_efika(void)
2547{
2548        int sound_irq[3] = { 2, 2, 0 };
2549        int bcomm_irq[3*16] = { 3,0,0, 3,1,0, 3,2,0, 3,3,0,
2550                                3,4,0, 3,5,0, 3,6,0, 3,7,0,
2551                                3,8,0, 3,9,0, 3,10,0, 3,11,0,
2552                                3,12,0, 3,13,0, 3,14,0, 3,15,0 };
2553        u32 node;
2554        char prop[64];
2555        int rv, len;
2556
2557        /* Check if we're really running on a EFIKA */
2558        node = call_prom("finddevice", 1, 1, ADDR("/"));
2559        if (!PHANDLE_VALID(node))
2560                return;
2561
2562        rv = prom_getprop(node, "model", prop, sizeof(prop));
2563        if (rv == PROM_ERROR)
2564                return;
2565        if (strcmp(prop, "EFIKA5K2"))
2566                return;
2567
2568        prom_printf("Applying EFIKA device tree fixups\n");
2569
2570        /* Claiming to be 'chrp' is death */
2571        node = call_prom("finddevice", 1, 1, ADDR("/"));
2572        rv = prom_getprop(node, "device_type", prop, sizeof(prop));
2573        if (rv != PROM_ERROR && (strcmp(prop, "chrp") == 0))
2574                prom_setprop(node, "/", "device_type", "efika", sizeof("efika"));
2575
2576        /* CODEGEN,description is exposed in /proc/cpuinfo so
2577           fix that too */
2578        rv = prom_getprop(node, "CODEGEN,description", prop, sizeof(prop));
2579        if (rv != PROM_ERROR && (strstr(prop, "CHRP")))
2580                prom_setprop(node, "/", "CODEGEN,description",
2581                             "Efika 5200B PowerPC System",
2582                             sizeof("Efika 5200B PowerPC System"));
2583
2584        /* Fixup bestcomm interrupts property */
2585        node = call_prom("finddevice", 1, 1, ADDR("/builtin/bestcomm"));
2586        if (PHANDLE_VALID(node)) {
2587                len = prom_getproplen(node, "interrupts");
2588                if (len == 12) {
2589                        prom_printf("Fixing bestcomm interrupts property\n");
2590                        prom_setprop(node, "/builtin/bestcom", "interrupts",
2591                                     bcomm_irq, sizeof(bcomm_irq));
2592                }
2593        }
2594
2595        /* Fixup sound interrupts property */
2596        node = call_prom("finddevice", 1, 1, ADDR("/builtin/sound"));
2597        if (PHANDLE_VALID(node)) {
2598                rv = prom_getprop(node, "interrupts", prop, sizeof(prop));
2599                if (rv == PROM_ERROR) {
2600                        prom_printf("Adding sound interrupts property\n");
2601                        prom_setprop(node, "/builtin/sound", "interrupts",
2602                                     sound_irq, sizeof(sound_irq));
2603                }
2604        }
2605
2606        /* Make sure ethernet phy-handle property exists */
2607        fixup_device_tree_efika_add_phy();
2608}
2609#else
2610#define fixup_device_tree_efika()
2611#endif
2612
2613static void __init fixup_device_tree(void)
2614{
2615        fixup_device_tree_maple();
2616        fixup_device_tree_maple_memory_controller();
2617        fixup_device_tree_chrp();
2618        fixup_device_tree_pmac();
2619        fixup_device_tree_efika();
2620}
2621
2622static void __init prom_find_boot_cpu(void)
2623{
2624        __be32 rval;
2625        ihandle prom_cpu;
2626        phandle cpu_pkg;
2627
2628        rval = 0;
2629        if (prom_getprop(prom.chosen, "cpu", &rval, sizeof(rval)) <= 0)
2630                return;
2631        prom_cpu = be32_to_cpu(rval);
2632
2633        cpu_pkg = call_prom("instance-to-package", 1, 1, prom_cpu);
2634
2635        prom_getprop(cpu_pkg, "reg", &rval, sizeof(rval));
2636        prom.cpu = be32_to_cpu(rval);
2637
2638        prom_debug("Booting CPU hw index = %lu\n", prom.cpu);
2639}
2640
2641static void __init prom_check_initrd(unsigned long r3, unsigned long r4)
2642{
2643#ifdef CONFIG_BLK_DEV_INITRD
2644        if (r3 && r4 && r4 != 0xdeadbeef) {
2645                __be64 val;
2646
2647                prom_initrd_start = is_kernel_addr(r3) ? __pa(r3) : r3;
2648                prom_initrd_end = prom_initrd_start + r4;
2649
2650                val = cpu_to_be64(prom_initrd_start);
2651                prom_setprop(prom.chosen, "/chosen", "linux,initrd-start",
2652                             &val, sizeof(val));
2653                val = cpu_to_be64(prom_initrd_end);
2654                prom_setprop(prom.chosen, "/chosen", "linux,initrd-end",
2655                             &val, sizeof(val));
2656
2657                reserve_mem(prom_initrd_start,
2658                            prom_initrd_end - prom_initrd_start);
2659
2660                prom_debug("initrd_start=0x%x\n", prom_initrd_start);
2661                prom_debug("initrd_end=0x%x\n", prom_initrd_end);
2662        }
2663#endif /* CONFIG_BLK_DEV_INITRD */
2664}
2665
2666#ifdef CONFIG_PPC64
2667#ifdef CONFIG_RELOCATABLE
2668static void reloc_toc(void)
2669{
2670}
2671
2672static void unreloc_toc(void)
2673{
2674}
2675#else
2676static void __reloc_toc(unsigned long offset, unsigned long nr_entries)
2677{
2678        unsigned long i;
2679        unsigned long *toc_entry;
2680
2681        /* Get the start of the TOC by using r2 directly. */
2682        asm volatile("addi %0,2,-0x8000" : "=b" (toc_entry));
2683
2684        for (i = 0; i < nr_entries; i++) {
2685                *toc_entry = *toc_entry + offset;
2686                toc_entry++;
2687        }
2688}
2689
2690static void reloc_toc(void)
2691{
2692        unsigned long offset = reloc_offset();
2693        unsigned long nr_entries =
2694                (__prom_init_toc_end - __prom_init_toc_start) / sizeof(long);
2695
2696        __reloc_toc(offset, nr_entries);
2697
2698        mb();
2699}
2700
2701static void unreloc_toc(void)
2702{
2703        unsigned long offset = reloc_offset();
2704        unsigned long nr_entries =
2705                (__prom_init_toc_end - __prom_init_toc_start) / sizeof(long);
2706
2707        mb();
2708
2709        __reloc_toc(-offset, nr_entries);
2710}
2711#endif
2712#endif
2713
2714/*
2715 * We enter here early on, when the Open Firmware prom is still
2716 * handling exceptions and the MMU hash table for us.
2717 */
2718
2719unsigned long __init prom_init(unsigned long r3, unsigned long r4,
2720                               unsigned long pp,
2721                               unsigned long r6, unsigned long r7,
2722                               unsigned long kbase)
2723{       
2724        unsigned long hdr;
2725
2726#ifdef CONFIG_PPC32
2727        unsigned long offset = reloc_offset();
2728        reloc_got2(offset);
2729#else
2730        reloc_toc();
2731#endif
2732
2733        /*
2734         * First zero the BSS
2735         */
2736        memset(&__bss_start, 0, __bss_stop - __bss_start);
2737
2738        /*
2739         * Init interface to Open Firmware, get some node references,
2740         * like /chosen
2741         */
2742        prom_init_client_services(pp);
2743
2744        /*
2745         * See if this OF is old enough that we need to do explicit maps
2746         * and other workarounds
2747         */
2748        prom_find_mmu();
2749
2750        /*
2751         * Init prom stdout device
2752         */
2753        prom_init_stdout();
2754
2755        prom_printf("Preparing to boot %s", linux_banner);
2756
2757        /*
2758         * Get default machine type. At this point, we do not differentiate
2759         * between pSeries SMP and pSeries LPAR
2760         */
2761        of_platform = prom_find_machine_type();
2762        prom_printf("Detected machine type: %x\n", of_platform);
2763
2764#ifndef CONFIG_NONSTATIC_KERNEL
2765        /* Bail if this is a kdump kernel. */
2766        if (PHYSICAL_START > 0)
2767                prom_panic("Error: You can't boot a kdump kernel from OF!\n");
2768#endif
2769
2770        /*
2771         * Check for an initrd
2772         */
2773        prom_check_initrd(r3, r4);
2774
2775#if defined(CONFIG_PPC_PSERIES) || defined(CONFIG_PPC_POWERNV)
2776        /*
2777         * On pSeries, inform the firmware about our capabilities
2778         */
2779        if (of_platform == PLATFORM_PSERIES ||
2780            of_platform == PLATFORM_PSERIES_LPAR)
2781                prom_send_capabilities();
2782#endif
2783
2784        /*
2785         * Copy the CPU hold code
2786         */
2787        if (of_platform != PLATFORM_POWERMAC)
2788                copy_and_flush(0, kbase, 0x100, 0);
2789
2790        /*
2791         * Do early parsing of command line
2792         */
2793        early_cmdline_parse();
2794
2795        /*
2796         * Initialize memory management within prom_init
2797         */
2798        prom_init_mem();
2799
2800        /*
2801         * Determine which cpu is actually running right _now_
2802         */
2803        prom_find_boot_cpu();
2804
2805        /* 
2806         * Initialize display devices
2807         */
2808        prom_check_displays();
2809
2810#if defined(CONFIG_PPC64) && defined(__BIG_ENDIAN__)
2811        /*
2812         * Initialize IOMMU (TCE tables) on pSeries. Do that before anything else
2813         * that uses the allocator, we need to make sure we get the top of memory
2814         * available for us here...
2815         */
2816        if (of_platform == PLATFORM_PSERIES)
2817                prom_initialize_tce_table();
2818#endif
2819
2820        /*
2821         * On non-powermacs, try to instantiate RTAS. PowerMacs don't
2822         * have a usable RTAS implementation.
2823         */
2824        if (of_platform != PLATFORM_POWERMAC &&
2825            of_platform != PLATFORM_OPAL)
2826                prom_instantiate_rtas();
2827
2828#ifdef CONFIG_PPC_POWERNV
2829        if (of_platform == PLATFORM_OPAL)
2830                prom_instantiate_opal();
2831#endif /* CONFIG_PPC_POWERNV */
2832
2833#ifdef CONFIG_PPC64
2834        /* instantiate sml */
2835        prom_instantiate_sml();
2836#endif
2837
2838        /*
2839         * On non-powermacs, put all CPUs in spin-loops.
2840         *
2841         * PowerMacs use a different mechanism to spin CPUs
2842         *
2843         * (This must be done after instanciating RTAS)
2844         */
2845        if (of_platform != PLATFORM_POWERMAC &&
2846            of_platform != PLATFORM_OPAL)
2847                prom_hold_cpus();
2848
2849        /*
2850         * Fill in some infos for use by the kernel later on
2851         */
2852        if (prom_memory_limit) {
2853                __be64 val = cpu_to_be64(prom_memory_limit);
2854                prom_setprop(prom.chosen, "/chosen", "linux,memory-limit",
2855                             &val, sizeof(val));
2856        }
2857#ifdef CONFIG_PPC64
2858        if (prom_iommu_off)
2859                prom_setprop(prom.chosen, "/chosen", "linux,iommu-off",
2860                             NULL, 0);
2861
2862        if (prom_iommu_force_on)
2863                prom_setprop(prom.chosen, "/chosen", "linux,iommu-force-on",
2864                             NULL, 0);
2865
2866        if (prom_tce_alloc_start) {
2867                prom_setprop(prom.chosen, "/chosen", "linux,tce-alloc-start",
2868                             &prom_tce_alloc_start,
2869                             sizeof(prom_tce_alloc_start));
2870                prom_setprop(prom.chosen, "/chosen", "linux,tce-alloc-end",
2871                             &prom_tce_alloc_end,
2872                             sizeof(prom_tce_alloc_end));
2873        }
2874#endif
2875
2876        /*
2877         * Fixup any known bugs in the device-tree
2878         */
2879        fixup_device_tree();
2880
2881        /*
2882         * Now finally create the flattened device-tree
2883         */
2884        prom_printf("copying OF device tree...\n");
2885        flatten_device_tree();
2886
2887        /*
2888         * in case stdin is USB and still active on IBM machines...
2889         * Unfortunately quiesce crashes on some powermacs if we have
2890         * closed stdin already (in particular the powerbook 101). It
2891         * appears that the OPAL version of OFW doesn't like it either.
2892         */
2893        if (of_platform != PLATFORM_POWERMAC &&
2894            of_platform != PLATFORM_OPAL)
2895                prom_close_stdin();
2896
2897        /*
2898         * Call OF "quiesce" method to shut down pending DMA's from
2899         * devices etc...
2900         */
2901        prom_printf("Calling quiesce...\n");
2902        call_prom("quiesce", 0, 0);
2903
2904        /*
2905         * And finally, call the kernel passing it the flattened device
2906         * tree and NULL as r5, thus triggering the new entry point which
2907         * is common to us and kexec
2908         */
2909        hdr = dt_header_start;
2910
2911        /* Don't print anything after quiesce under OPAL, it crashes OFW */
2912        if (of_platform != PLATFORM_OPAL) {
2913                prom_printf("returning from prom_init\n");
2914                prom_debug("->dt_header_start=0x%x\n", hdr);
2915        }
2916
2917#ifdef CONFIG_PPC32
2918        reloc_got2(-offset);
2919#else
2920        unreloc_toc();
2921#endif
2922
2923#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL
2924        /* OPAL early debug gets the OPAL base & entry in r8 and r9 */
2925        __start(hdr, kbase, 0, 0, 0,
2926                prom_opal_base, prom_opal_entry);
2927#else
2928        __start(hdr, kbase, 0, 0, 0, 0, 0);
2929#endif
2930
2931        return 0;
2932}
2933