1 files changed, 37 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/arm/altera-cyclone-v/startup/bspreset.c b/c/src/lib/libbsp/arm/altera-cyclone-v/startup/bspreset.c
new file mode 100644
index 0000000000..65e8624847
--- /dev/null
+++ b/c/src/lib/libbsp/arm/altera-cyclone-v/startup/bspreset.c
@@ -0,0 +1,37 @@
+/*
+ * Copyright (c) 2013 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Dornierstr. 4
+ *  82178 Puchheim
+ *  Germany
+ *  <info@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/bootcard.h>
+#include <bsp/alt_reset_manager.h>
+#include "socal/alt_rstmgr.h"
+#include "socal/hps.h"
+
+void bsp_reset(void)
+{
+  uint32_t           self_cpu  = rtems_smp_get_current_processor();
+  volatile uint32_t *mpumodrst = ALT_RSTMGR_MPUMODRST_ADDR;
+  
+  if( self_cpu == 0 ) {
+    /* Reset CPU1 */
+    (*mpumodrst) |= ALT_RSTMGR_MPUMODRST_CPU1_SET_MSK;
+    
+    /* Simply call the reset method from alteras HWLIB */
+    (void) alt_reset_cold_reset();
+  } else {
+    /* Keep CPU1 waiting until it gets reset by CPU0 */
+    while ( true ) {
+      __asm__ volatile ("wfi");
+    }
+  }
+}