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

Handle SW-DP fault on WDATAERR.

This commit is contained in:
Gareth McMullin 2013-06-19 21:06:59 +12:00
parent d8f737fc53
commit a30ef31018
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
src/adiv5_swdp.c
View File

@ -73,6 +73,7 @@ int adiv5_swdp_scan(void)
dp->error = adiv5_swdp_error; dp->error = adiv5_swdp_error;
dp->low_access = adiv5_swdp_low_access; dp->low_access = adiv5_swdp_low_access;
adiv5_swdp_error(dp);
adiv5_dp_init(dp); adiv5_dp_init(dp);
if(!target_list) morse("NO TARGETS.", 1); if(!target_list) morse("NO TARGETS.", 1);
@ -97,7 +98,7 @@ static uint32_t adiv5_swdp_error(ADIv5_DP_t *dp)
err = adiv5_swdp_read(dp, ADIV5_DP_CTRLSTAT) & err = adiv5_swdp_read(dp, ADIV5_DP_CTRLSTAT) &
(ADIV5_DP_CTRLSTAT_STICKYORUN | ADIV5_DP_CTRLSTAT_STICKYCMP | (ADIV5_DP_CTRLSTAT_STICKYORUN | ADIV5_DP_CTRLSTAT_STICKYCMP |
ADIV5_DP_CTRLSTAT_STICKYERR); ADIV5_DP_CTRLSTAT_STICKYERR | ADIV5_DP_CTRLSTAT_WDATAERR);
if(err & ADIV5_DP_CTRLSTAT_STICKYORUN) if(err & ADIV5_DP_CTRLSTAT_STICKYORUN)
clr |= ADIV5_DP_ABORT_ORUNERRCLR; clr |= ADIV5_DP_ABORT_ORUNERRCLR;
@ -105,6 +106,8 @@ static uint32_t adiv5_swdp_error(ADIv5_DP_t *dp)
clr |= ADIV5_DP_ABORT_STKCMPCLR; clr |= ADIV5_DP_ABORT_STKCMPCLR;
if(err & ADIV5_DP_CTRLSTAT_STICKYERR) if(err & ADIV5_DP_CTRLSTAT_STICKYERR)
clr |= ADIV5_DP_ABORT_STKERRCLR; clr |= ADIV5_DP_ABORT_STKERRCLR;
if(err & ADIV5_DP_CTRLSTAT_WDATAERR)
clr |= ADIV5_DP_ABORT_WDERRCLR;
adiv5_swdp_write(dp, ADIV5_DP_ABORT, clr); adiv5_swdp_write(dp, ADIV5_DP_ABORT, clr);
dp->fault = 0; dp->fault = 0;