adafruit-mirror/zephyr
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions 9

dap: implement wait for SWJ pins command

Browse source 
Implement wait for SWJ pins command.

Signed-off-by: Maximilian Deubel <maximilian.deubel@nordicsemi.no>
This commit is contained in:
Maximilian Deubel 2023-07-07 15:23:55 +02:00 committed by Alberto Escolar
parent 3e8f9fb7df
commit 6522dd7f53
1 changed files with 12 additions and 4 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

16
subsys/dap/cmsis_dap.c
View file

@ -229,6 +229,7 @@ static uint16_t dap_swj_pins(struct dap_context *const ctx,
uint8_t value = request[0];
uint8_t select = request[1];
uint32_t wait = sys_get_le32(&request[2]);
int64_t timeout_ticks;
uint8_t state;
if (!atomic_test_bit(&ctx->state, DAP_STATE_CONNECTED)) {
@ -242,10 +243,17 @@ static uint16_t dap_swj_pins(struct dap_context *const ctx,
api->swdp_set_pins(ctx->swdp_dev, select, value);
}
/* TODO: implement wait */
api->swdp_get_pins(ctx->swdp_dev, &state);
LOG_ERR("select 0x%02x, value 0x%02x, wait %u, state 0x%02x",
select, value, wait, state);
timeout_ticks = k_uptime_ticks() + (CONFIG_SYS_CLOCK_TICKS_PER_SEC / 1000000 * wait);
do {
api->swdp_get_pins(ctx->swdp_dev, &state);
LOG_INF("select 0x%02x, value 0x%02x, wait %u, state 0x%02x",
select, value, wait, state);
if ((value & select) == (state & select)) {
LOG_DBG("swdp_get_pins succeeded before timeout");
break;
}
} while (k_uptime_ticks() - timeout_ticks > 0);
response[0] = state;