adi_v5_cmisis_dap: Separate ABORT from clearing sticky errors

We don't need to do full blown AP ABORT in case of CMSIS-DAP errors,
and the code that was in place was not doing that(issuing AP ABORT)
anyway.

Change-Id: Ide83b1f8875d725da6cb0d53aae8229f8c6316b3
Signed-off-by: Andrey Smirnov <andrew.smirnov@gmail.com>
Signed-off-by: Andreas Fritiofson <andreas.fritiofson@gmail.com>
Reviewed-on: http://openocd.zylin.com/2112
Tested-by: jenkins
Reviewed-by: Andrey Yurovsky <yurovsky@gmail.com>
__archive__
Andrey Smirnov 2014-06-18 23:33:51 +02:00 committed by Andreas Fritiofson
parent 6db70bc89b
commit d6fd5d0f9b
1 changed files with 27 additions and 29 deletions

View File

@ -54,14 +54,26 @@
/* YUK! - but this is currently a global.... */ /* YUK! - but this is currently a global.... */
extern struct jtag_interface *jtag_interface; extern struct jtag_interface *jtag_interface;
static int (cmsis_dap_queue_ap_abort)(struct adiv5_dap *dap, uint8_t *ack) static int cmsis_dap_clear_sticky_errors(struct adiv5_dap *dap)
{ {
LOG_DEBUG("CMSIS-ADI: cmsis_dap_queue_ap_abort"); LOG_DEBUG("CMSIS-ADI: %s", __func__);
/* FIXME: implement this properly cmsis-dap has DAP_WriteABORT() const struct swd_driver *swd = jtag_interface->swd;
* for now just hack @ everything */ assert(swd);
return jtag_interface->swd->write_reg(
(CMSIS_CMD_DP | CMSIS_CMD_WRITE | CMSIS_CMD_A32(DP_ABORT)), 0x1e); return swd->write_reg(swd_cmd(false, false, DP_ABORT),
STKCMPCLR | STKERRCLR | WDERRCLR | ORUNERRCLR);
}
static int cmsis_dap_queue_ap_abort(struct adiv5_dap *dap, uint8_t *ack)
{
LOG_DEBUG("CMSIS-ADI: %s", __func__);
const struct swd_driver *swd = jtag_interface->swd;
assert(swd);
return swd->write_reg(swd_cmd(false, false, DP_ABORT),
DAPABORT | STKCMPCLR | STKERRCLR | WDERRCLR | ORUNERRCLR);
} }
static int cmsis_dap_queue_dp_read(struct adiv5_dap *dap, unsigned reg, uint32_t *data) static int cmsis_dap_queue_dp_read(struct adiv5_dap *dap, unsigned reg, uint32_t *data)
@ -71,11 +83,8 @@ static int cmsis_dap_queue_dp_read(struct adiv5_dap *dap, unsigned reg, uint32_t
int retval = jtag_interface->swd->read_reg( int retval = jtag_interface->swd->read_reg(
(CMSIS_CMD_DP | CMSIS_CMD_READ | CMSIS_CMD_A32(reg)), data); (CMSIS_CMD_DP | CMSIS_CMD_READ | CMSIS_CMD_A32(reg)), data);
if (retval != ERROR_OK) { if (retval != ERROR_OK)
/* fault response */ cmsis_dap_clear_sticky_errors(dap);
uint8_t ack = retval & 0xff;
cmsis_dap_queue_ap_abort(dap, &ack);
}
return retval; return retval;
} }
@ -94,11 +103,8 @@ static int (cmsis_dap_queue_dp_write)(struct adiv5_dap *dap, unsigned reg, uint3
int retval = jtag_interface->swd->write_reg( int retval = jtag_interface->swd->write_reg(
(CMSIS_CMD_DP | CMSIS_CMD_WRITE | CMSIS_CMD_A32(reg)), data); (CMSIS_CMD_DP | CMSIS_CMD_WRITE | CMSIS_CMD_A32(reg)), data);
if (retval != ERROR_OK) { if (retval != ERROR_OK)
/* fault response */ cmsis_dap_clear_sticky_errors(dap);
uint8_t ack = retval & 0xff;
cmsis_dap_queue_ap_abort(dap, &ack);
}
return retval; return retval;
} }
@ -128,11 +134,8 @@ static int (cmsis_dap_queue_ap_read)(struct adiv5_dap *dap, unsigned reg, uint32
retval = jtag_interface->swd->read_reg( retval = jtag_interface->swd->read_reg(
(CMSIS_CMD_AP | CMSIS_CMD_READ | CMSIS_CMD_A32(reg)), data); (CMSIS_CMD_AP | CMSIS_CMD_READ | CMSIS_CMD_A32(reg)), data);
if (retval != ERROR_OK) { if (retval != ERROR_OK)
/* fault response */ cmsis_dap_clear_sticky_errors(dap);
uint8_t ack = retval & 0xff;
cmsis_dap_queue_ap_abort(dap, &ack);
}
return retval; return retval;
} }
@ -155,11 +158,8 @@ static int (cmsis_dap_queue_ap_write)(struct adiv5_dap *dap, unsigned reg, uint3
retval = jtag_interface->swd->write_reg( retval = jtag_interface->swd->write_reg(
(CMSIS_CMD_AP | CMSIS_CMD_WRITE | CMSIS_CMD_A32(reg)), data); (CMSIS_CMD_AP | CMSIS_CMD_WRITE | CMSIS_CMD_A32(reg)), data);
if (retval != ERROR_OK) { if (retval != ERROR_OK)
/* fault response */ cmsis_dap_clear_sticky_errors(dap);
uint8_t ack = retval & 0xff;
cmsis_dap_queue_ap_abort(dap, &ack);
}
return retval; return retval;
} }
@ -276,15 +276,13 @@ static int cmsis_dap_init(struct command_context *ctx)
} }
#endif #endif
uint8_t ack = 0;
status = cmsis_dap_queue_dp_read(dap, DP_IDCODE, &idcode); status = cmsis_dap_queue_dp_read(dap, DP_IDCODE, &idcode);
if (status == ERROR_OK) if (status == ERROR_OK)
LOG_INFO("IDCODE 0x%08" PRIx32, idcode); LOG_INFO("IDCODE 0x%08" PRIx32, idcode);
/* force clear all sticky faults */ /* force clear all sticky faults */
cmsis_dap_queue_ap_abort(dap, &ack); cmsis_dap_clear_sticky_errors(dap);
/* this is a workaround to get polling working */ /* this is a workaround to get polling working */
jtag_add_reset(0, 0); jtag_add_reset(0, 0);