summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--src/transport/swd_core.c13
1 files changed, 9 insertions, 4 deletions
diff --git a/src/transport/swd_core.c b/src/transport/swd_core.c
index c18c111a..7617d3db 100644
--- a/src/transport/swd_core.c
+++ b/src/transport/swd_core.c
@@ -103,10 +103,15 @@ int oocd_swd_queue_ap_write(struct adiv5_dap *dap, unsigned reg, uint32_t data){
}
int oocd_swd_queue_ap_abort(struct adiv5_dap *dap, uint8_t *ack){
- //int retval;
- //char reg=SWD_DP_ABORT_ADDR;
- LOG_ERROR("oocd_swd_queue_ap_abort() not yet implemented");
- return ERROR_FAIL;
+ int retval;
+ int abort_flags = SWD_DP_ABORT_ORUNERRCLR | SWD_DP_ABORT_WDERRCLR | SWD_DP_ABORT_STKERRCLR \
+ | SWD_DP_ABORT_STKCMPCLR | SWD_DP_ABORT_DAPABORT;
+ retval=swd_dp_write((swd_ctx_t *)dap->ctx, SWD_OPERATION_EXECUTE, SWD_DP_ABORT_ADDR, &abort_flags);
+ if (retval<0){
+ LOG_ERROR("swd_dp_write(ABORT) error: %s ", swd_error_string(retval));
+ return ERROR_FAIL;
+ }
+ return ERROR_OK;
}
int oocd_swd_run(struct adiv5_dap *dap){