Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 | /*
* Note that prom_init() and anything called from prom_init()
* may be running at an address that is different from the address
* that it was linked at. References to static data items are
* handled by compiling this file with -mrelocatable-lib.
*/
#include <linux/config.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/init.h>
#include <linux/version.h>
#include <linux/threads.h>
#include <linux/spinlock.h>
#include <linux/ioport.h>
#include <linux/pci.h>
#include <linux/slab.h>
#include <asm/sections.h>
#include <asm/prom.h>
#include <asm/page.h>
#include <asm/processor.h>
#include <asm/irq.h>
#include <asm/io.h>
#include <asm/smp.h>
#include <asm/bootx.h>
#include <asm/system.h>
#include <asm/mmu.h>
#include <asm/pgtable.h>
#include <asm/bitops.h>
#include <asm/bootinfo.h>
#include <asm/btext.h>
#include <asm/pci-bridge.h>
#include <asm/open_pic.h>
#include <asm/cacheflush.h>
#ifdef CONFIG_FB
#include <asm/linux_logo.h>
#endif
/*
* Properties whose value is longer than this get excluded from our
* copy of the device tree. This way we don't waste space storing
* things like "driver,AAPL,MacOS,PowerPC" properties. But this value
* does need to be big enough to ensure that we don't lose things
* like the interrupt-map property on a PCI-PCI bridge.
*/
#define MAX_PROPERTY_LENGTH 4096
#ifndef FB_MAX /* avoid pulling in all of the fb stuff */
#define FB_MAX 8
#endif
#define ALIGNUL(x) (((x) + sizeof(unsigned long)-1) & -sizeof(unsigned long))
struct prom_args {
const char *service;
int nargs;
int nret;
void *args[10];
};
struct pci_address {
unsigned a_hi;
unsigned a_mid;
unsigned a_lo;
};
struct pci_reg_property {
struct pci_address addr;
unsigned size_hi;
unsigned size_lo;
};
struct pci_range {
struct pci_address addr;
unsigned phys;
unsigned size_hi;
unsigned size_lo;
};
struct isa_reg_property {
unsigned space;
unsigned address;
unsigned size;
};
struct pci_intr_map {
struct pci_address addr;
unsigned dunno;
phandle int_ctrler;
unsigned intr;
};
static void prom_exit(void);
static void *call_prom(const char *service, int nargs, int nret, ...);
static void *call_prom_ret(const char *service, int nargs, int nret,
void **rets, ...);
static void prom_print_hex(unsigned int v);
static int prom_set_color(ihandle ih, int i, int r, int g, int b);
static int prom_next_node(phandle *nodep);
static unsigned long check_display(unsigned long mem);
static void setup_disp_fake_bi(ihandle dp);
static unsigned long copy_device_tree(unsigned long mem_start,
unsigned long mem_end);
static unsigned long inspect_node(phandle node, struct device_node *dad,
unsigned long mem_start, unsigned long mem_end,
struct device_node ***allnextpp);
static void prom_hold_cpus(unsigned long mem);
static void prom_instantiate_rtas(void);
static void * early_get_property(unsigned long base, unsigned long node,
char *prop);
prom_entry prom __initdata = 0;
ihandle prom_chosen __initdata = 0;
ihandle prom_stdout __initdata = 0;
char *prom_display_paths[FB_MAX] __initdata = { 0, };
phandle prom_display_nodes[FB_MAX] __initdata;
unsigned int prom_num_displays __initdata = 0;
static char *of_stdout_device __initdata = 0;
static ihandle prom_disp_node __initdata = 0;
unsigned int rtas_data; /* physical pointer */
unsigned int rtas_entry; /* physical pointer */
unsigned int rtas_size;
unsigned int old_rtas;
boot_infos_t *boot_infos;
char *bootpath;
char *bootdevice;
struct device_node *allnodes;
extern char *klimit;
extern char _stext;
static void __init
prom_exit(void)
{
struct prom_args args;
args.service = "exit";
args.nargs = 0;
args.nret = 0;
prom(&args);
for (;;) /* should never get here */
;
}
static void * __init
call_prom(const char *service, int nargs, int nret, ...)
{
va_list list;
int i;
struct prom_args prom_args;
prom_args.service = service;
prom_args.nargs = nargs;
prom_args.nret = nret;
va_start(list, nret);
for (i = 0; i < nargs; ++i)
prom_args.args[i] = va_arg(list, void *);
va_end(list);
for (i = 0; i < nret; ++i)
prom_args.args[i + nargs] = 0;
prom(&prom_args);
return prom_args.args[nargs];
}
static void * __init
call_prom_ret(const char *service, int nargs, int nret, void **rets, ...)
{
va_list list;
int i;
struct prom_args prom_args;
prom_args.service = service;
prom_args.nargs = nargs;
prom_args.nret = nret;
va_start(list, rets);
for (i = 0; i < nargs; ++i)
prom_args.args[i] = va_arg(list, void *);
va_end(list);
for (i = 0; i < nret; ++i)
prom_args.args[i + nargs] = 0;
prom(&prom_args);
for (i = 1; i < nret; ++i)
rets[i-1] = prom_args.args[nargs + i];
return prom_args.args[nargs];
}
void __init
prom_print(const char *msg)
{
const char *p, *q;
if (prom_stdout == 0)
return;
for (p = msg; *p != 0; p = q) {
for (q = p; *q != 0 && *q != '\n'; ++q)
;
if (q > p)
call_prom("write", 3, 1, prom_stdout, p, q - p);
if (*q != 0) {
++q;
call_prom("write", 3, 1, prom_stdout, "\r\n", 2);
}
}
}
static void __init
prom_print_hex(unsigned int v)
{
char buf[16];
int i, c;
for (i = 0; i < 8; ++i) {
c = (v >> ((7-i)*4)) & 0xf;
c += (c >= 10)? ('a' - 10): '0';
buf[i] = c;
}
buf[i] = ' ';
buf[i+1] = 0;
prom_print(buf);
}
static int __init
prom_set_color(ihandle ih, int i, int r, int g, int b)
{
struct prom_args prom_args;
prom_args.service = "call-method";
prom_args.nargs = 6;
prom_args.nret = 1;
prom_args.args[0] = "color!";
prom_args.args[1] = ih;
prom_args.args[2] = (void *) i;
prom_args.args[3] = (void *) b;
prom_args.args[4] = (void *) g;
prom_args.args[5] = (void *) r;
prom(&prom_args);
return (int) prom_args.args[6];
}
static int __init
prom_next_node(phandle *nodep)
{
phandle node;
if ((node = *nodep) != 0
&& (*nodep = call_prom("child", 1, 1, node)) != 0)
return 1;
if ((*nodep = call_prom("peer", 1, 1, node)) != 0)
return 1;
for (;;) {
if ((node = call_prom("parent", 1, 1, node)) == 0)
return 0;
if ((*nodep = call_prom("peer", 1, 1, node)) != 0)
return 1;
}
}
/*
* If we have a display that we don't know how to drive,
* we will want to try to execute OF's open method for it
* later. However, OF will probably fall over if we do that
* we've taken over the MMU.
* So we check whether we will need to open the display,
* and if so, open it now.
*/
static unsigned long __init
check_display(unsigned long mem)
{
phandle node;
ihandle ih;
int i;
char type[16], *path;
static unsigned char default_colors[] = {
0x00, 0x00, 0x00,
0x00, 0x00, 0xaa,
0x00, 0xaa, 0x00,
0x00, 0xaa, 0xaa,
0xaa, 0x00, 0x00,
0xaa, 0x00, 0xaa,
0xaa, 0xaa, 0x00,
0xaa, 0xaa, 0xaa,
0x55, 0x55, 0x55,
0x55, 0x55, 0xff,
0x55, 0xff, 0x55,
0x55, 0xff, 0xff,
0xff, 0x55, 0x55,
0xff, 0x55, 0xff,
0xff, 0xff, 0x55,
0xff, 0xff, 0xff
};
prom_disp_node = 0;
for (node = 0; prom_next_node(&node); ) {
type[0] = 0;
call_prom("getprop", 4, 1, node, "device_type",
type, sizeof(type));
if (strcmp(type, "display") != 0)
continue;
/* It seems OF doesn't null-terminate the path :-( */
path = (char *) mem;
memset(path, 0, 256);
if ((int) call_prom("package-to-path", 3, 1,
node, path, 255) < 0)
continue;
/*
* If this display is the device that OF is using for stdout,
* move it to the front of the list.
*/
mem += strlen(path) + 1;
i = prom_num_displays++;
if (of_stdout_device != 0 && i > 0
&& strcmp(of_stdout_device, path) == 0) {
for (; i > 0; --i) {
prom_display_paths[i]
= prom_display_paths[i-1];
prom_display_nodes[i]
= prom_display_nodes[i-1];
}
}
prom_display_paths[i] = path;
prom_display_nodes[i] = node;
if (i == 0)
prom_disp_node = node;
if (prom_num_displays >= FB_MAX)
break;
}
try_again:
/*
* Open the first display and set its colormap.
*/
if (prom_num_displays > 0) {
path = prom_display_paths[0];
prom_print("opening display ");
prom_print(path);
ih = call_prom("open", 1, 1, path);
if (ih == 0 || ih == (ihandle) -1) {
prom_print("... failed\n");
for (i=1; i<prom_num_displays; i++) {
prom_display_paths[i-1] = prom_display_paths[i];
prom_display_nodes[i-1] = prom_display_nodes[i];
}
if (--prom_num_displays > 0)
prom_disp_node = prom_display_nodes[0];
else
prom_disp_node = NULL;
goto try_again;
} else {
prom_print("... ok\n");
/*
* Setup a usable color table when the appropriate
* method is available.
* Should update this to use set-colors.
*/
for (i = 0; i < 32; i++)
if (prom_set_color(ih, i, default_colors[i*3],
default_colors[i*3+1],
default_colors[i*3+2]) != 0)
break;
#ifdef CONFIG_FB
for (i = 0; i < LINUX_LOGO_COLORS; i++)
if (prom_set_color(ih, i + 32,
linux_logo_red[i],
linux_logo_green[i],
linux_logo_blue[i]) != 0)
break;
#endif /* CONFIG_FB */
}
}
return ALIGNUL(mem);
}
/* This function will enable the early boot text when doing OF booting. This
* way, xmon output should work too
*/
static void __init
setup_disp_fake_bi(ihandle dp)
{
#ifdef CONFIG_BOOTX_TEXT
int width = 640, height = 480, depth = 8, pitch;
unsigned address;
struct pci_reg_property addrs[8];
int i, naddrs;
char name[32];
char *getprop = "getprop";
prom_print("Initializing fake screen: ");
memset(name, 0, sizeof(name));
call_prom(getprop, 4, 1, dp, "name", name, sizeof(name));
name[sizeof(name)-1] = 0;
prom_print(name);
prom_print("\n");
call_prom(getprop, 4, 1, dp, "width", &width, sizeof(width));
call_prom(getprop, 4, 1, dp, "height", &height, sizeof(height));
call_prom(getprop, 4, 1, dp, "depth", &depth, sizeof(depth));
pitch = width * ((depth + 7) / 8);
call_prom(getprop, 4, 1, dp, "linebytes",
&pitch, sizeof(pitch));
if (pitch == 1)
pitch = 0x1000; /* for strange IBM display */
address = 0;
call_prom(getprop, 4, 1, dp, "address",
&address, sizeof(address));
if (address == 0) {
/* look for an assigned address with a size of >= 1MB */
naddrs = (int) call_prom(getprop, 4, 1, dp,
"assigned-addresses",
addrs, sizeof(addrs));
naddrs /= sizeof(struct pci_reg_property);
for (i = 0; i < naddrs; ++i) {
if (addrs[i].size_lo >= (1 << 20)) {
address = addrs[i].addr.a_lo;
/* use the BE aperture if possible */
if (addrs[i].size_lo >= (16 << 20))
address += (8 << 20);
break;
}
}
if (address == 0) {
prom_print("Failed to get address\n");
return;
}
}
/* kludge for valkyrie */
if (strcmp(name, "valkyrie") == 0)
address += 0x1000;
btext_setup_display(width, height, depth, pitch, address);
btext_prepare_BAT();
#endif /* CONFIG_BOOTX_TEXT */
}
/*
* Make a copy of the device tree from the PROM.
*/
static unsigned long __init
copy_device_tree(unsigned long mem_start, unsigned long mem_end)
{
phandle root;
unsigned long new_start;
struct device_node **allnextp;
root = call_prom("peer", 1, 1, (phandle)0);
if (root == (phandle)0) {
prom_print("couldn't get device tree root\n");
prom_exit();
}
allnextp = &allnodes;
mem_start = ALIGNUL(mem_start);
new_start = inspect_node(root, 0, mem_start, mem_end, &allnextp);
*allnextp = 0;
return new_start;
}
static unsigned long __init
inspect_node(phandle node, struct device_node *dad,
unsigned long mem_start, unsigned long mem_end,
struct device_node ***allnextpp)
{
int l;
phandle child;
struct device_node *np;
struct property *pp, **prev_propp;
char *prev_name, *namep;
unsigned char *valp;
np = (struct device_node *) mem_start;
mem_start += sizeof(struct device_node);
memset(np, 0, sizeof(*np));
np->node = node;
**allnextpp = PTRUNRELOC(np);
*allnextpp = &np->allnext;
if (dad != 0) {
np->parent = PTRUNRELOC(dad);
/* we temporarily use the `next' field as `last_child'. */
if (dad->next == 0)
dad->child = PTRUNRELOC(np);
else
dad->next->sibling = PTRUNRELOC(np);
dad->next = np;
}
/* get and store all properties */
prev_propp = &np->properties;
prev_name = "";
for (;;) {
pp = (struct property *) mem_start;
namep = (char *) (pp + 1);
pp->name = PTRUNRELOC(namep);
if ((int) call_prom("nextprop", 3, 1, node, prev_name,
namep) <= 0)
break;
mem_start = ALIGNUL((unsigned long)namep + strlen(namep) + 1);
prev_name = namep;
valp = (unsigned char *) mem_start;
pp->value = PTRUNRELOC(valp);
pp->length = (int)
call_prom("getprop", 4, 1, node, namep,
valp, mem_end - mem_start);
if (pp->length < 0)
continue;
#ifdef MAX_PROPERTY_LENGTH
if (pp->length > MAX_PROPERTY_LENGTH)
continue; /* ignore this property */
#endif
mem_start = ALIGNUL(mem_start + pp->length);
*prev_propp = PTRUNRELOC(pp);
prev_propp = &pp->next;
}
if (np->node != NULL) {
/* Add a "linux,phandle" property" */
pp = (struct property *) mem_start;
*prev_propp = PTRUNRELOC(pp);
prev_propp = &pp->next;
namep = (char *) (pp + 1);
pp->name = PTRUNRELOC(namep);
strcpy(namep, "linux,phandle");
mem_start = ALIGNUL((unsigned long)namep + strlen(namep) + 1);
pp->value = (unsigned char *) PTRUNRELOC(&np->node);
pp->length = sizeof(np->node);
}
*prev_propp = NULL;
/* get the node's full name */
l = (int) call_prom("package-to-path", 3, 1, node,
(char *) mem_start, mem_end - mem_start);
if (l >= 0) {
np->full_name = PTRUNRELOC((char *) mem_start);
*(char *)(mem_start + l) = 0;
mem_start = ALIGNUL(mem_start + l + 1);
}
/* do all our children */
child = call_prom("child", 1, 1, node);
while (child != (void *)0) {
mem_start = inspect_node(child, np, mem_start, mem_end,
allnextpp);
child = call_prom("peer", 1, 1, child);
}
return mem_start;
}
unsigned long smp_chrp_cpu_nr __initdata = 0;
/*
* With CHRP SMP we need to use the OF to start the other
* processors so we can't wait until smp_boot_cpus (the OF is
* trashed by then) so we have to put the processors into
* a holding pattern controlled by the kernel (not OF) before
* we destroy the OF.
*
* This uses a chunk of high memory, puts some holding pattern
* code there and sends the other processors off to there until
* smp_boot_cpus tells them to do something. We do that by using
* physical address 0x0. The holding pattern checks that address
* until its cpu # is there, when it is that cpu jumps to
* __secondary_start(). smp_boot_cpus() takes care of setting those
* values.
*
* We also use physical address 0x4 here to tell when a cpu
* is in its holding pattern code.
*
* -- Cort
*
* Note that we have to do this if we have more than one CPU,
* even if this is a UP kernel. Otherwise when we trash OF
* the other CPUs will start executing some random instructions
* and crash the system. -- paulus
*/
static void __init
prom_hold_cpus(unsigned long mem)
{
extern void __secondary_hold(void);
unsigned long i;
int cpu;
phandle node;
char type[16], *path;
unsigned int reg;
/*
* XXX: hack to make sure we're chrp, assume that if we're
* chrp we have a device_type property -- Cort
*/
node = call_prom("finddevice", 1, 1, "/");
if ((int)call_prom("getprop", 4, 1, node,
"device_type",type, sizeof(type)) <= 0)
return;
/* copy the holding pattern code to someplace safe (0) */
/* the holding pattern is now within the first 0x100
bytes of the kernel image -- paulus */
memcpy((void *)0, &_stext, 0x100);
flush_icache_range(0, 0x100);
/* look for cpus */
*(unsigned long *)(0x0) = 0;
asm volatile("dcbf 0,%0": : "r" (0) : "memory");
for (node = 0; prom_next_node(&node); ) {
type[0] = 0;
call_prom("getprop", 4, 1, node, "device_type",
type, sizeof(type));
if (strcmp(type, "cpu") != 0)
continue;
path = (char *) mem;
memset(path, 0, 256);
if ((int) call_prom("package-to-path", 3, 1,
node, path, 255) < 0)
continue;
reg = -1;
call_prom("getprop", 4, 1, node, "reg", ®, sizeof(reg));
cpu = smp_chrp_cpu_nr++;
#ifdef CONFIG_SMP
smp_hw_index[cpu] = reg;
#endif /* CONFIG_SMP */
/* XXX: hack - don't start cpu 0, this cpu -- Cort */
if (cpu == 0)
continue;
prom_print("starting cpu ");
prom_print(path);
*(ulong *)(0x4) = 0;
call_prom("start-cpu", 3, 0, node,
(char *)__secondary_hold - &_stext, cpu);
prom_print("...");
for ( i = 0 ; (i < 10000) && (*(ulong *)(0x4) == 0); i++ )
;
if (*(ulong *)(0x4) == cpu)
prom_print("ok\n");
else {
prom_print("failed: ");
prom_print_hex(*(ulong *)0x4);
prom_print("\n");
}
}
}
static void __init
prom_instantiate_rtas(void)
{
ihandle prom_rtas;
unsigned int i;
struct prom_args prom_args;
prom_rtas = call_prom("finddevice", 1, 1, "/rtas");
if (prom_rtas == (void *) -1)
return;
rtas_size = 0;
call_prom("getprop", 4, 1, prom_rtas,
"rtas-size", &rtas_size, sizeof(rtas_size));
prom_print("instantiating rtas");
if (rtas_size == 0) {
rtas_data = 0;
} else {
/*
* Ask OF for some space for RTAS.
* Actually OF has bugs so we just arbitrarily
* use memory at the 6MB point.
*/
rtas_data = 6 << 20;
prom_print(" at ");
prom_print_hex(rtas_data);
}
prom_rtas = call_prom("open", 1, 1, "/rtas");
prom_print("...");
prom_args.service = "call-method";
prom_args.nargs = 3;
prom_args.nret = 2;
prom_args.args[0] = "instantiate-rtas";
prom_args.args[1] = prom_rtas;
prom_args.args[2] = (void *) rtas_data;
prom(&prom_args);
i = 0;
if (prom_args.args[3] == 0)
i = (unsigned int)prom_args.args[4];
rtas_entry = i;
if ((rtas_entry == -1) || (rtas_entry == 0))
prom_print(" failed\n");
else
prom_print(" done\n");
}
/*
* We enter here early on, when the Open Firmware prom is still
* handling exceptions and the MMU hash table for us.
*/
unsigned long __init
prom_init(int r3, int r4, prom_entry pp)
{
unsigned long mem;
ihandle prom_mmu;
unsigned long offset = reloc_offset();
int i, l;
char *p, *d;
unsigned long phys;
void *result[3];
/* Default */
phys = (unsigned long) &_stext;
/* First get a handle for the stdout device */
prom = pp;
prom_chosen = call_prom("finddevice", 1, 1,
"/chosen");
if (prom_chosen == (void *)-1)
prom_exit();
if ((int) call_prom("getprop", 4, 1, prom_chosen,
"stdout", &prom_stdout,
sizeof(prom_stdout)) <= 0)
prom_exit();
/* Get the full OF pathname of the stdout device */
mem = (unsigned long) klimit + offset;
p = (char *) mem;
memset(p, 0, 256);
call_prom("instance-to-path", 3, 1, prom_stdout, p, 255);
of_stdout_device = p;
mem += strlen(p) + 1;
/* Get the boot device and translate it to a full OF pathname. */
p = (char *) mem;
l = (int) call_prom("getprop", 4, 1, prom_chosen,
"bootpath", p, 1<<20);
if (l > 0) {
p[l] = 0; /* should already be null-terminated */
bootpath = PTRUNRELOC(p);
mem += l + 1;
d = (char *) mem;
*d = 0;
call_prom("canon", 3, 1, p, d, 1<<20);
bootdevice = PTRUNRELOC(d);
mem = ALIGNUL(mem + strlen(d) + 1);
}
prom_instantiate_rtas();
mem = check_display(mem);
prom_print("copying OF device tree...");
mem = copy_device_tree(mem, mem + (1<<20));
prom_print("done\n");
prom_hold_cpus(mem);
klimit = (char *) (mem - offset);
/* If we are already running at 0xc0000000, we assume we were
* loaded by an OF bootloader which did set a BAT for us.
* This breaks OF translate so we force phys to be 0.
*/
if (offset == 0)
phys = 0;
else if ((int) call_prom("getprop", 4, 1, prom_chosen, "mmu",
&prom_mmu, sizeof(prom_mmu)) <= 0) {
prom_print(" no MMU found\n");
} else if ((int)call_prom_ret("call-method", 4, 4, result, "translate",
prom_mmu, &_stext, 1) != 0) {
prom_print(" (translate failed)\n");
} else {
/* We assume the phys. address size is 3 cells */
phys = (unsigned long)result[2];
}
if (prom_disp_node != 0)
setup_disp_fake_bi(prom_disp_node);
/* Use quiesce call to get OF to shut down any devices it's using */
prom_print("Calling quiesce ...\n");
call_prom("quiesce", 0, 0);
/* Relocate various pointers which will be used once the
kernel is running at the address it was linked at. */
for (i = 0; i < prom_num_displays; ++i)
prom_display_paths[i] = PTRUNRELOC(prom_display_paths[i]);
prom_print("returning 0x");
prom_print_hex(phys);
prom_print("from prom_init\n");
prom_stdout = 0;
return phys;
}
/*
* early_get_property is used to access the device tree image prepared
* by BootX very early on, before the pointers in it have been relocated.
*/
static void * __init
early_get_property(unsigned long base, unsigned long node, char *prop)
{
struct device_node *np = (struct device_node *)(base + node);
struct property *pp;
for (pp = np->properties; pp != 0; pp = pp->next) {
pp = (struct property *) (base + (unsigned long)pp);
if (strcmp((char *)((unsigned long)pp->name + base),
prop) == 0) {
return (void *)((unsigned long)pp->value + base);
}
}
return 0;
}
/* Is boot-info compatible ? */
#define BOOT_INFO_IS_COMPATIBLE(bi) ((bi)->compatible_version <= BOOT_INFO_VERSION)
#define BOOT_INFO_IS_V2_COMPATIBLE(bi) ((bi)->version >= 2)
#define BOOT_INFO_IS_V4_COMPATIBLE(bi) ((bi)->version >= 4)
void __init
bootx_init(unsigned long r4, unsigned long phys)
{
boot_infos_t *bi = (boot_infos_t *) r4;
unsigned long space;
unsigned long ptr, x;
char *model;
boot_infos = PTRUNRELOC(bi);
if (!BOOT_INFO_IS_V2_COMPATIBLE(bi))
bi->logicalDisplayBase = 0;
#ifdef CONFIG_BOOTX_TEXT
btext_init(bi);
/*
* Test if boot-info is compatible. Done only in config
* CONFIG_BOOTX_TEXT since there is nothing much we can do
* with an incompatible version, except display a message
* and eventually hang the processor...
*
* I'll try to keep enough of boot-info compatible in the
* future to always allow display of this message;
*/
if (!BOOT_INFO_IS_COMPATIBLE(bi)) {
btext_drawstring(" !!! WARNING - Incompatible version of BootX !!!\n\n\n");
btext_flushscreen();
}
#endif /* CONFIG_BOOTX_TEXT */
/* New BootX enters kernel with MMU off, i/os are not allowed
here. This hack will have been done by the boostrap anyway.
*/
if (bi->version < 4) {
/*
* XXX If this is an iMac, turn off the USB controller.
*/
model = (char *) early_get_property
(r4 + bi->deviceTreeOffset, 4, "model");
if (model
&& (strcmp(model, "iMac,1") == 0
|| strcmp(model, "PowerMac1,1") == 0)) {
out_le32((unsigned *)0x80880008, 1); /* XXX */
}
}
/* Move klimit to enclose device tree, args, ramdisk, etc... */
if (bi->version < 5) {
space = bi->deviceTreeOffset + bi->deviceTreeSize;
if (bi->ramDisk)
space = bi->ramDisk + bi->ramDiskSize;
} else
space = bi->totalParamsSize;
klimit = PTRUNRELOC((char *) bi + space);
/* New BootX will have flushed all TLBs and enters kernel with
MMU switched OFF, so this should not be useful anymore.
*/
if (bi->version < 4) {
/*
* Touch each page to make sure the PTEs for them
* are in the hash table - the aim is to try to avoid
* getting DSI exceptions while copying the kernel image.
*/
for (ptr = ((unsigned long) &_stext) & PAGE_MASK;
ptr < (unsigned long)bi + space; ptr += PAGE_SIZE)
x = *(volatile unsigned long *)ptr;
}
#ifdef CONFIG_BOOTX_TEXT
/*
* Note that after we call btext_prepare_BAT, we can't do
* prom_draw*, flushscreen or clearscreen until we turn the MMU
* on, since btext_prepare_BAT sets disp_bi.logicalDisplayBase
* to a virtual address.
*/
btext_prepare_BAT();
#endif
}
|