sys64738
/
blackmagic
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

cmsis_dap.c: Fix dap_dp_read_reg.

This commit is contained in:
Uwe Bonnes 2020-08-15 19:09:05 +02:00 committed by UweBonnes
parent f65afb1588
commit badff20099
1 changed files with 11 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
src/platforms/hosted/cmsis_dap.c
View File

@ -111,7 +111,7 @@ static uint32_t dap_dp_error(ADIv5_DP_t *dp)
return err; return err;
} }
static uint32_t dap_dp_low_access(struct ADIv5_DP_s *dp, uint8_t RnW, static uint32_t dap_dp_low_access(struct ADIv5_DP_s *dp, uint8_t RnW,
uint16_t addr, uint32_t value) uint16_t addr, uint32_t value)
{ {
bool APnDP = addr & ADIV5_APnDP; bool APnDP = addr & ADIV5_APnDP;
@ -128,7 +128,16 @@ static uint32_t dap_dp_low_access(struct ADIv5_DP_s *dp, uint8_t RnW,
static uint32_t dap_dp_read_reg(ADIv5_DP_t *dp, uint16_t addr) static uint32_t dap_dp_read_reg(ADIv5_DP_t *dp, uint16_t addr)
{ {
return dap_read_reg(dp, addr); uint32_t res;
if (addr & ADIV5_APnDP) {
dap_dp_low_access(dp, ADIV5_LOW_READ, addr, 0);
res = dap_dp_low_access(dp, ADIV5_LOW_READ,
ADIV5_DP_RDBUFF, 0);
} else {
res = dap_dp_low_access(dp, ADIV5_LOW_READ, addr, 0);
}
DEBUG_PROBE("dp_read %04x %08" PRIx32 "\n", addr, res);
return res;
} }
void dap_exit_function(void) void dap_exit_function(void)