release/src-rt-6.x.4708/linux/linux-2.6.36/arch/powerpc/boot/redboot-83xx.c

   1 /*
   2  * RedBoot firmware support
   3  *
   4  * Author: Scott Wood <scottwood@freescale.com>
   5  *
   6  * Copyright (c) 2007 Freescale Semiconductor, Inc.
   7  * Copyright (c) 2008 Codehermit
   8  *
   9  * This program is free software; you can redistribute it and/or modify it
  10  * under the terms of the GNU General Public License version 2 as published
  11  * by the Free Software Foundation.
  12  */
  13
  14 #include "ops.h"
  15 #include "stdio.h"
  16 #include "redboot.h"
  17 #include "fsl-soc.h"
  18 #include "io.h"
  19
  20 static bd_t bd;
  21 BSS_STACK(4096);
  22
  23 #define MHZ(x)  ((x + 500000) / 1000000)
  24
  25 static void platform_fixups(void)
  26 {
  27         void *node;
  28
  29         dt_fixup_memory(bd.bi_memstart, bd.bi_memsize);
  30         dt_fixup_mac_addresses(bd.bi_enetaddr);
  31         dt_fixup_cpu_clocks(bd.bi_intfreq, bd.bi_busfreq / 16, bd.bi_busfreq);
  32
  33         node = finddevice("/soc/cpm/brg");
  34         if (node) {
  35                 printf("BRG clock-frequency <- 0x%x (%dMHz)\r\n",
  36                        bd.bi_busfreq, MHZ(bd.bi_busfreq));
  37                 setprop(node, "clock-frequency",  &bd.bi_busfreq, 4);
  38         }
  39
  40 }
  41
  42 void platform_init(unsigned long r3, unsigned long r4, unsigned long r5,
  43                    unsigned long r6, unsigned long r7)
  44 {
  45         memcpy(&bd, (char *)r3, sizeof(bd));
  46
  47         if (bd.bi_tag != 0x42444944)
  48                 return;
  49
  50         simple_alloc_init(_end,
  51                           bd.bi_memstart + bd.bi_memsize - (unsigned long)_end,
  52                           32, 64);
  53
  54         fdt_init(_dtb_start);
  55         serial_console_init();
  56         platform_ops.fixups = platform_fixups;
  57
  58         loader_info.cmdline = (char *)bd.bi_cmdline;
  59         loader_info.cmdline_len = strlen((char *)bd.bi_cmdline);
  60 }