arch/powerpc/cpu/mpc86xx/cpu_init.c

   1 /*
   2  * Copyright 2004,2009-2011 Freescale Semiconductor, Inc.
   3  * Jeff Brown
   4  * Srikanth Srinivasan (srikanth.srinivasan@freescale.com)
   5  *
   6  * See file CREDITS for list of people who contributed to this
   7  * project.
   8  *
   9  * This program is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU General Public License as
  11  * published by the Free Software Foundation; either version 2 of
  12  * the License, or (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  22  * MA 02111-1307 USA
  23  */
  24
  25 /*
  26  * cpu_init.c - low level cpu init
  27  */
  28
  29 #include <config.h>
  30 #include <common.h>
  31 #include <mpc86xx.h>
  32 #include <asm/mmu.h>
  33 #include <asm/fsl_law.h>
  34 #include <asm/fsl_serdes.h>
  35 #include <asm/mp.h>
  36
  37 extern void srio_init(void);
  38
  39 DECLARE_GLOBAL_DATA_PTR;
  40
  41 /*
  42  * Breathe some life into the CPU...
  43  *
  44  * Set up the memory map
  45  * initialize a bunch of registers
  46  */
  47
  48 void cpu_init_f(void)
  49 {
  50         /* Pointer is writable since we allocated a register for it */
  51         gd = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
  52
  53         /* Clear initial global data */
  54         memset ((void *) gd, 0, sizeof (gd_t));
  55
  56 #ifdef CONFIG_FSL_LAW
  57         init_laws();
  58 #endif
  59
  60         setup_bats();
  61
  62         init_early_memctl_regs();
  63
  64 #if defined(CONFIG_FSL_DMA)
  65         dma_init();
  66 #endif
  67
  68         /* enable the timebase bit in HID0 */
  69         set_hid0(get_hid0() | 0x4000000);
  70
  71         /* enable EMCP, SYNCBE | ABE bits in HID1 */
  72         set_hid1(get_hid1() | 0x80000C00);
  73 }
  74
  75 /*
  76  * initialize higher level parts of CPU like timers
  77  */
  78 int cpu_init_r(void)
  79 {
  80         /* needs to be in ram since code uses global static vars */
  81         fsl_serdes_init();
  82
  83 #ifdef CONFIG_SYS_SRIO
  84         srio_init();
  85 #endif
  86
  87 #if defined(CONFIG_MP)
  88         setup_mp();
  89 #endif
  90         return 0;
  91 }
  92
  93 #ifdef CONFIG_ADDR_MAP
  94 /* Initialize address mapping array */
  95 void init_addr_map(void)
  96 {
  97         int i;
  98         ppc_bat_t bat = DBAT0;
  99         phys_size_t size;
 100         unsigned long upper, lower;
 101
 102         for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++, bat++) {
 103                 if (read_bat(bat, &upper, &lower) != -1) {
 104                         if (!BATU_VALID(upper))
 105                                 size = 0;
 106                         else
 107                                 size = BATU_SIZE(upper);
 108                         addrmap_set_entry(BATU_VADDR(upper), BATL_PADDR(lower),
 109                                           size, i);
 110                 }
 111 #ifdef CONFIG_HIGH_BATS
 112                 /* High bats are not contiguous with low BAT numbers */
 113                 if (bat == DBAT3)
 114                         bat = DBAT4 - 1;
 115 #endif
 116         }
 117 }
 118 #endif