[rtems commit] bsp/tms570: Fix bsp_reset()

[Sebastian Huber]

Module:    rtems
Branch:    master
Commit:    849210fff615e78d0f88d6b1359ebf464c5bbd53
Changeset: http://git.rtems.org/rtems/commit/?id=849210fff615e78d0f88d6b1359ebf464c5bbd53

Author:    Sebastian Huber <sebastian.huber at embedded-brains.de>
Date:      Thu Dec 21 15:16:47 2023 +0100

bsp/tms570: Fix bsp_reset()

Update #4982.

---

 bsps/arm/tms570/start/bspreset.c | 10 +++++++++-
 1 file changed, 9 insertions(+), 1 deletion(-)

diff --git a/bsps/arm/tms570/start/bspreset.c b/bsps/arm/tms570/start/bspreset.c
index 624eeed8ff..67cf96c67c 100644
--- a/bsps/arm/tms570/start/bspreset.c
+++ b/bsps/arm/tms570/start/bspreset.c
@@ -41,6 +41,7 @@
 
 #include <bsp/bootcard.h>
 #include <bsp/tms570.h>
+#include <bsp/tms570-pom.h>
 
 static void handle_esm_errors(uint32_t esm_irq_channel)
 {
@@ -56,7 +57,14 @@ static void handle_esm_errors(uint32_t esm_irq_channel)
 
 void bsp_reset(void)
 {
-   uint32_t esm_irq_channel = TMS570_ESM.IOFFHR - 1;
+   rtems_interrupt_level level;
+   uint32_t esm_irq_channel;
+
+   rtems_interrupt_disable(level);
+   (void) level;
+
+   tms570_pom_initialize_and_clear();
+   esm_irq_channel = TMS570_ESM.IOFFHR - 1;
 
    if (esm_irq_channel) {
      handle_esm_errors(esm_irq_channel);