From 39fbffd3d2aac33fdb74b84c2e2596012949cf46 Mon Sep 17 00:00:00 2001 From: Uwe Bonnes Date: Sat, 9 Oct 2021 13:10:23 +0200 Subject: [PATCH] stlinkv2: Fix low access to AP registers. --- src/platforms/hosted/stlinkv2.c | 5 +++-- 1 file changed, 3 insertions(+), 2 deletions(-) diff --git a/src/platforms/hosted/stlinkv2.c b/src/platforms/hosted/stlinkv2.c index 4f80559..42e81dd 100644 --- a/src/platforms/hosted/stlinkv2.c +++ b/src/platforms/hosted/stlinkv2.c @@ -764,9 +764,10 @@ uint32_t stlink_dp_low_access(ADIv5_DP_t *dp, uint8_t RnW, int res; if (RnW) { res = stlink_read_dp_register( - STLINK_DEBUG_PORT_ACCESS, addr, &response); + (addr < 0x100) ? STLINK_DEBUG_PORT_ACCESS : 0, addr, &response); } else { - res = stlink_write_dp_register(STLINK_DEBUG_PORT_ACCESS, addr, value); + res = stlink_write_dp_register( + (addr < 0x100) ? STLINK_DEBUG_PORT_ACCESS : 0, addr, value); } if (res == STLINK_ERROR_WAIT) raise_exception(EXCEPTION_TIMEOUT, "DP ACK timeout");