1 files changed, 47 insertions, 0 deletions
diff --git a/bsps/arm/tms570/start/bspreset.c b/bsps/arm/tms570/start/bspreset.c
new file mode 100644
index 0000000000..f6bdee27e1
--- /dev/null
+++ b/bsps/arm/tms570/start/bspreset.c
@@ -0,0 +1,47 @@
+/**
+ * @file bspreset.c
+ *
+ * @ingroup tms570
+ *
+ * @brief Reset code.
+ */
+
+/*
+ * Copyright (c) 2015 Taller Technologies.
+ *
+ * @author Martin Galvan <martin.galvan@tallertechnologies.com>
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.org/license/LICENSE.
+ */
+
+#include <bsp.h>
+#include <bsp/bootcard.h>
+#include <bsp/tms570.h>
+#include <bsp/start.h>
+
+static void handle_esm_errors(uint32_t esm_irq_channel)
+{
+   /* ESMR3 errors don't generate interrupts. */
+   if (esm_irq_channel < 0x20u) {
+     TMS570_ESM.SR[0] = 1 << esm_irq_channel;
+   } else if (esm_irq_channel < 0x40u) {
+     TMS570_ESM.SR[1] = 1 << (esm_irq_channel - 32u);
+   } else if (esm_irq_channel < 0x60u) {
+     TMS570_ESM.SR4 = 1 << (esm_irq_channel - 64u);
+   }
+}
+
+void bsp_reset(void)
+{
+   uint32_t esm_irq_channel = TMS570_ESM.IOFFHR - 1;
+
+   if (esm_irq_channel) {
+     handle_esm_errors(esm_irq_channel);
+   }
+
+   /* Reset the board */
+   /* write of value other than 1 cause system reset */
+   TMS570_SYS1.SYSECR = TMS570_SYS1_SYSECR_RESET(2);
+}