1 files changed, 175 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/powerpc/mpc55xxevb/startup/start-early.c b/c/src/lib/libbsp/powerpc/mpc55xxevb/startup/start-early.c
new file mode 100644
index 0000000000..4d0c35da58
--- /dev/null
+++ b/c/src/lib/libbsp/powerpc/mpc55xxevb/startup/start-early.c
@@ -0,0 +1,175 @@
+/**
+ * @file
+ *
+ * @ingroup mpc55xx
+ *
+ * @brief Early initialization code.
+ */
+
+/*
+ * Copyright (c) 2008-2011 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.com/license/LICENSE.
+ */
+
+#include <bsp.h>
+#include <bsp/start.h>
+#include <bsp/mpc55xx-config.h>
+
+static BSP_START_TEXT_SECTION void mpc55xx_start_mmu(void)
+{
+  #ifdef MPC55XX_BOOTFLAGS
+    /* If the low bit of bootflag 0 is clear don't change the MMU.  */
+    bool do_mmu_config = (mpc55xx_bootflag_0 [0] & 1) != 0;
+  #else
+    bool do_mmu_config = true;
+  #endif
+
+  if (do_mmu_config) {
+    mpc55xx_start_mmu_apply_config(
+      &mpc55xx_start_config_mmu [0],
+      mpc55xx_start_config_mmu_count [0]
+    );
+  }
+}
+
+static BSP_START_TEXT_SECTION void mpc55xx_start_internal_ram(void)
+{
+  /* Initialize internal SRAM to zero (ECC) */
+  bsp_start_zero(
+    (char *) bsp_ram_start + MPC55XX_EARLY_STACK_SIZE,
+    (size_t) bsp_ram_size - MPC55XX_EARLY_STACK_SIZE
+  );
+  #ifdef MPC55XX_HAS_SECOND_INTERNAL_RAM_AREA
+    bsp_start_zero(&bsp_ram_1_start [0], (size_t) bsp_ram_1_size);
+  #endif
+}
+
+static BSP_START_TEXT_SECTION void mpc55xx_start_mode_change(void)
+{
+  #ifdef MPC55XX_HAS_MODE_CONTROL
+    uint32_t mctl_key1 = 0x5af0;
+    uint32_t mctl_key2 = 0xa50f;
+    int i = 0;
+
+    /* Clear any pending RGM status */
+    RGM.FES.R = 0xffff;
+    RGM.DES.R = 0xffff;
+
+    /* Make sure XOSC and PLLs are on in RUN0 state */
+    ME.DRUN_MC.R = 0x001f0074;
+    ME.RUN_MC [0].R = 0x001f0074;
+
+    /*
+     * Make sure all peripherals are active in DRUN and RUN0 state.
+     *
+     * FIXME: This might be optimized to reduce power consumtion.
+     */
+    for (i = 0; i < 8; ++i) {
+      ME_RUN_PC_32B_tag run_pc = { .R = ME.RUN_PC [i].R };
+
+      run_pc.B.DRUN = 1;
+      run_pc.B.RUN0 = 1;
+
+      ME.RUN_PC [i].R = run_pc.R;
+    }
+
+    /* Switch to RUN0 state */
+    ME.MCTL.R = 0x40000000 | mctl_key1;
+    ME.MCTL.R = 0x40000000 | mctl_key2;
+
+    while (ME.GS.B.S_MTRANS) {
+      /* Wait for mode switch to be completed */
+    }
+  #endif
+}
+
+static BSP_START_TEXT_SECTION void mpc55xx_start_siu(void)
+{
+  size_t i = 0;
+
+  #ifdef MPC55XX_BOARD_GWLCFM
+    SIU.GPDO[122].B.PDO=1; /* make sure USB reset is kept high */
+    SIU.GPDO[121].B.PDO=1; /* make sure Ethernet reset is kept high */
+    SIU.GPDO[113].B.PDO=1; /* make sure MOST Companion reset is kept high */
+  #endif
+
+  for (i = 0; i < mpc55xx_start_config_siu_pcr_count [0]; ++i) {
+     const mpc55xx_siu_pcr_config *e = &mpc55xx_start_config_siu_pcr [i];
+     int j = e->index;
+     int n = j + e->count;
+     uint16_t pcr = e->pcr.R;
+
+     while (j < n) {
+       SIU.PCR [j].R = pcr;
+       ++j;
+     }
+  }
+}
+
+static BSP_START_TEXT_SECTION void mpc55xx_start_ebi_chip_select(void)
+{
+  #ifdef MPC55XX_HAS_EBI
+    size_t i = 0;
+
+    for (i = 0; i < mpc55xx_start_config_ebi_cs_count [0]; ++i) {
+       EBI.CS [i] = mpc55xx_start_config_ebi_cs [i];
+    }
+
+    for (i = 0; i < mpc55xx_start_config_ebi_cal_cs_count [0]; ++i) {
+       EBI.CAL_CS [i] = mpc55xx_start_config_ebi_cal_cs [i];
+    }
+  #endif
+}
+
+static BSP_START_TEXT_SECTION void mpc55xx_start_ebi(void)
+{
+  #if defined(MPC55XX_BOARD_GWLCFM)
+    /*
+     * init EBI for Muxed AD bus
+     */
+    EBI.MCR.B.DBM = 1;
+    EBI.MCR.B.AD_MUX = 1; /* use multiplexed bus */
+    EBI.MCR.B.D16_31 = 1; /* use lower AD bus    */
+
+    SIU.ECCR.B.EBDF = 3;  /* use CLK/4 as bus clock */
+  #elif defined(MPC55XX_BOARD_MPC5674FEVB)
+    struct EBI_tag ebi = {
+      .MCR = {
+        .B = {
+          .ACGE = 0,
+          .MDIS = 0,
+          .D16_31 = 0,
+          .AD_MUX = 0,
+          .DBM = 0
+        }
+      }
+    };
+
+    EBI.MCR.R = ebi.MCR.R;
+  #endif
+}
+
+BSP_START_TEXT_SECTION void mpc55xx_start_early(void)
+{
+  mpc55xx_start_watchdog();
+  mpc55xx_start_clock();
+  mpc55xx_start_flash();
+  #if defined(BSP_DATA_CACHE_ENABLED) || defined(BSP_INSTRUCTION_CACHE_ENABLED)
+    mpc55xx_start_cache();
+  #endif
+  mpc55xx_start_mmu();
+  mpc55xx_start_internal_ram();
+  mpc55xx_start_mode_change();
+  mpc55xx_start_siu();
+  mpc55xx_start_ebi_chip_select();
+  mpc55xx_start_ebi();
+}