Trigger a watchdog reset to start SFU

Author: pennam

src/utility/ota/OTA-nano-rp2040.cpp

@@ -237,7 +237,8 @@ int rp2040_connect_onOTARequest(char const * ota_url)
   /* Perform the reset to reboot to SFU. */
   DEBUG_INFO("%s: %d bytes received", __FUNCTION__, ftell(file));
   fclose(file);
-  NVIC_SystemReset();
+  //NVIC_SystemReset();
+  mbed_watchdog_trigger_reset();
 
   return static_cast<int>(OTAError::None);
 }

src/utility/watchdog/Watchdog.cpp

@@ -110,4 +110,25 @@ void mbed_watchdog_reset()
     hal_watchdog_kick();
   }
 }
+
+void mbed_watchdog_trigger_reset()
+{
+  watchdog_config_t cfg;
+#if defined(ARDUINO_PORTENTA_H7_M7) || defined(ARDUINO_PORTENTA_H7_M4)
+  cfg.timeout_ms = 1;
+#elif defined(ARDUINO_NANO_RP2040_CONNECT)
+  cfg.timeout_ms = 1;
+#else
+# error "You need to define the maximum possible timeout for this architecture."
+#endif
+
+  if (hal_watchdog_init(&cfg) == WATCHDOG_STATUS_OK) {
+    is_watchdog_enabled = true;
+  }
+  else {
+    DEBUG_WARNING("%s: watchdog could not be reconfigured", __FUNCTION__);
+  }
+
+  while(1){}
+}
 #endif /* ARDUINO_ARCH_MBED */

src/utility/watchdog/Watchdog.h

@@ -30,6 +30,7 @@ void samd_watchdog_reset();
 #ifdef ARDUINO_ARCH_MBED
 void mbed_watchdog_enable();
 void mbed_watchdog_reset();
+void mbed_watchdog_trigger_reset();
 #endif /* ARDUINO_ARCH_MBED */
 
 #endif /* ARDUINO_AIOTC_UTILITY_WATCHDOG_H_ */