[nrf noup] boot: zephyr: cleanup of SQSPI for nRF54L

This commit ensures nrf_cleanup cleans up SQSPI if
it is used, so that it can be used by the application
as well.
The main usage is external flash communication using
SQSPI.

Signed-off-by: Artur Hadasz <artur.hadasz@nordicsemi.no>

Author: ahasztag

boot/zephyr/CMakeLists.txt

@@ -808,9 +808,15 @@ if(SYSBUILD)
 endif()
 
 if(CONFIG_MCUBOOT_NRF_CLEANUP_PERIPHERAL)
-zephyr_library_sources(
-  ${BOOT_DIR}/zephyr/nrf_cleanup.c
-)
+  zephyr_library_sources(
+    ${BOOT_DIR}/zephyr/nrf_cleanup.c
+  )
+
+  if(CONFIG_MSPI_NRF_SQSPI)
+    zephyr_library_include_directories(
+      ${ZEPHYR_NRFXLIB_MODULE_DIR}/softperipheral/include
+    )
+  endif()
 endif()
 
 if(SYSBUILD AND CONFIG_PCD_APP)

boot/zephyr/nrf_cleanup.c

@@ -22,6 +22,11 @@
 #if defined(NRF_DPPIC)
     #include <hal/nrf_dppi.h>
 #endif
+#if defined(CONFIG_MSPI_NRF_SQSPI)
+    #include <hal/nrf_vpr.h>
+    #include <softperipheral_regif.h>
+#endif
+
 
 #include <string.h>
 
@@ -110,6 +115,24 @@ static void nrf_cleanup_clock(void)
     nrf_clock_int_disable(NRF_CLOCK, 0xFFFFFFFF);
 }
 #endif
+#if defined(CONFIG_MSPI_NRF_SQSPI)
+static void nrf_cleanup_sqspi(void)
+{
+    nrf_vpr_cpurun_set(NRF_VPR, false);
+
+    // Reset VPR.
+    nrf_vpr_debugif_dmcontrol_mask_set(NRF_VPR,
+                                       (VPR_DEBUGIF_DMCONTROL_NDMRESET_Active
+                                        << VPR_DEBUGIF_DMCONTROL_NDMRESET_Pos |
+                                        VPR_DEBUGIF_DMCONTROL_DMACTIVE_Enabled
+                                        << VPR_DEBUGIF_DMCONTROL_DMACTIVE_Pos));
+    nrf_vpr_debugif_dmcontrol_mask_set(NRF_VPR,
+                                       (VPR_DEBUGIF_DMCONTROL_NDMRESET_Inactive
+                                        << VPR_DEBUGIF_DMCONTROL_NDMRESET_Pos |
+                                        VPR_DEBUGIF_DMCONTROL_DMACTIVE_Disabled
+                                        << VPR_DEBUGIF_DMCONTROL_DMACTIVE_Pos));
+}
+#endif
 
 void nrf_cleanup_peripheral(void)
 {
@@ -123,6 +146,10 @@ void nrf_cleanup_peripheral(void)
     nrf_cleanup_rtc(NRF_RTC2);
 #endif
 
+#if defined(CONFIG_MSPI_NRF_SQSPI)
+    nrf_cleanup_sqspi();
+#endif
+
 #if defined(CONFIG_NRF_GRTC_TIMER)
     nrf_cleanup_grtc();
 #endif