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  * SPDX-License-Identifier:     GPL-2.0+
   7  */
   8
   9 /*
  10  * cpu_init.c - low level cpu init
  11  */
  12
  13 #include <config.h>
  14 #include <common.h>
  15 #include <mpc86xx.h>
  16 #include <asm/mmu.h>
  17 #include <asm/fsl_law.h>
  18 #include <asm/fsl_serdes.h>
  19 #include <asm/mp.h>
  20
  21 extern void srio_init(void);
  22
  23 DECLARE_GLOBAL_DATA_PTR;
  24
  25 /*
  26  * Breathe some life into the CPU...
  27  *
  28  * Set up the memory map
  29  * initialize a bunch of registers
  30  */
  31
  32 void cpu_init_f(void)
  33 {
  34         /* Pointer is writable since we allocated a register for it */
  35         gd = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
  36
  37         /* Clear initial global data */
  38         memset ((void *) gd, 0, sizeof (gd_t));
  39
  40 #ifdef CONFIG_FSL_LAW
  41         init_laws();
  42 #endif
  43
  44         setup_bats();
  45
  46         init_early_memctl_regs();
  47
  48 #if defined(CONFIG_FSL_DMA)
  49         dma_init();
  50 #endif
  51
  52         /* enable the timebase bit in HID0 */
  53         set_hid0(get_hid0() | 0x4000000);
  54
  55         /* enable EMCP, SYNCBE | ABE bits in HID1 */
  56         set_hid1(get_hid1() | 0x80000C00);
  57 }
  58
  59 /*
  60  * initialize higher level parts of CPU like timers
  61  */
  62 int cpu_init_r(void)
  63 {
  64         /* needs to be in ram since code uses global static vars */
  65         fsl_serdes_init();
  66
  67 #ifdef CONFIG_SYS_SRIO
  68         srio_init();
  69 #endif
  70
  71 #if defined(CONFIG_MP)
  72         setup_mp();
  73 #endif
  74         return 0;
  75 }
  76
  77 #ifdef CONFIG_ADDR_MAP
  78 /* Initialize address mapping array */
  79 void init_addr_map(void)
  80 {
  81         int i;
  82         ppc_bat_t bat = DBAT0;
  83         phys_size_t size;
  84         unsigned long upper, lower;
  85
  86         for (i = 0; i < CONFIG_SYS_NUM_ADDR_MAP; i++, bat++) {
  87                 if (read_bat(bat, &upper, &lower) != -1) {
  88                         if (!BATU_VALID(upper))
  89                                 size = 0;
  90                         else
  91                                 size = BATU_SIZE(upper);
  92                         addrmap_set_entry(BATU_VADDR(upper), BATL_PADDR(lower),
  93                                           size, i);
  94                 }
  95 #ifdef CONFIG_HIGH_BATS
  96                 /* High bats are not contiguous with low BAT numbers */
  97                 if (bat == DBAT3)
  98                         bat = DBAT4 - 1;
  99 #endif
 100         }
 101 }
 102 #endif