Request debugger power down after target is set to RUN state.

mathias-arm · Oct 6, 2020 · f1bb93e · f1bb93e
1 parent 6ac64b9
commit f1bb93e
Showing 1 changed file with 13 additions and 0 deletions.
diff --git a/source/daplink/interface/swd_host.c b/source/daplink/interface/swd_host.c
@@ -1051,6 +1051,19 @@ uint8_t swd_set_target_state_sw(target_state_t state)
             osDelay(2);
             swd_set_target_reset(0);
             osDelay(2);
+
+            // Power down
+            if (!swd_write_dp(DP_CTRL_STAT, 0x0)) {
+                return 0;
+            }
+
+            // Wait until ACK is deasserted
+            do {
+                if (!swd_read_dp(DP_CTRL_STAT, &val)) {
+                    return 0;
+                }
+            } while ((val & (CSYSPWRUPACK | CDBGPWRUPACK)) == 1);
+
             swd_off();
             break;