static int stlink_usb_init_mode(void *handle)
{
int res;
uint8_t mode;
enum stlink_mode emode;
struct stlink_usb_handle_s *h;
assert(handle != NULL);
h = (struct stlink_usb_handle_s *)handle;
res = stlink_usb_current_mode(handle, &mode);
if (res != ERROR_OK)
return res;
LOG_DEBUG("MODE: 0x%02X", mode);
/* try to exit current mode */
switch (mode) {
case STLINK_DEV_DFU_MODE:
emode = STLINK_MODE_DFU;
break;
case STLINK_DEV_DEBUG_MODE:
emode = STLINK_MODE_DEBUG_SWD;
break;
case STLINK_DEV_SWIM_MODE:
emode = STLINK_MODE_DEBUG_SWIM;
break;
case STLINK_DEV_BOOTLOADER_MODE:
case STLINK_DEV_MASS_MODE:
default:
emode = STLINK_MODE_UNKNOWN;
break;
}
if (emode != STLINK_MODE_UNKNOWN) {
res = stlink_usb_mode_leave(handle, emode);
if (res != ERROR_OK)
return res;
}
res = stlink_usb_current_mode(handle, &mode);
if (res != ERROR_OK)
return res;
LOG_DEBUG("MODE: 0x%02X", mode);
/* set selected mode */
switch (h->transport) {
case STLINK_TRANSPORT_SWD:
emode = STLINK_MODE_DEBUG_SWD;
break;
case STLINK_TRANSPORT_JTAG:
emode = STLINK_MODE_DEBUG_JTAG;
break;
case STLINK_TRANSPORT_SWIM:
emode = STLINK_MODE_DEBUG_SWIM;
break;
default:
emode = STLINK_MODE_UNKNOWN;
break;
}
if (emode == STLINK_MODE_UNKNOWN) {
LOG_ERROR("selected mode (transport) not supported");
return ERROR_FAIL;
}
res = stlink_usb_mode_enter(handle, emode);
if (res != ERROR_OK)
return res;
res = stlink_usb_current_mode(handle, &mode);
if (res != ERROR_OK)
return res;
LOG_DEBUG("MODE: 0x%02X", mode);
return ERROR_OK;
}
static int stlink_usb_init_mode(void *handle, bool connect_under_reset)
{
int res;
uint8_t mode;
enum stlink_mode emode;
struct stlink_usb_handle_s *h = handle;
assert(handle != NULL);
res = stlink_usb_current_mode(handle, &mode);
if (res != ERROR_OK)
return res;
LOG_DEBUG("MODE: 0x%02X", mode);
/* try to exit current mode */
switch (mode) {
case STLINK_DEV_DFU_MODE:
emode = STLINK_MODE_DFU;
break;
case STLINK_DEV_DEBUG_MODE:
emode = STLINK_MODE_DEBUG_SWD;
break;
case STLINK_DEV_SWIM_MODE:
emode = STLINK_MODE_DEBUG_SWIM;
break;
case STLINK_DEV_BOOTLOADER_MODE:
case STLINK_DEV_MASS_MODE:
default:
emode = STLINK_MODE_UNKNOWN;
break;
}
if (emode != STLINK_MODE_UNKNOWN) {
res = stlink_usb_mode_leave(handle, emode);
if (res != ERROR_OK)
return res;
}
res = stlink_usb_current_mode(handle, &mode);
if (res != ERROR_OK)
return res;
/* we check the target voltage here as an aid to debugging connection problems.
* the stlink requires the target Vdd to be connected for reliable debugging.
* this cmd is supported in all modes except DFU
*/
if (mode != STLINK_DEV_DFU_MODE) {
float target_voltage;
/* check target voltage (if supported) */
res = stlink_usb_check_voltage(h, &target_voltage);
if (res != ERROR_OK) {
if (res != ERROR_COMMAND_NOTFOUND)
LOG_ERROR("voltage check failed");
/* attempt to continue as it is not a catastrophic failure */
} else {
/* check for a sensible target voltage, operating range is 1.65-5.5v
* according to datasheet */
if (target_voltage < 1.5)
LOG_ERROR("target voltage may be too low for reliable debugging");
}
}
LOG_DEBUG("MODE: 0x%02X", mode);
/* set selected mode */
emode = stlink_get_mode(h->transport);
if (emode == STLINK_MODE_UNKNOWN) {
LOG_ERROR("selected mode (transport) not supported");
return ERROR_FAIL;
}
if (connect_under_reset) {
res = stlink_usb_assert_srst(handle, 0);
if (res != ERROR_OK)
return res;
}
res = stlink_usb_mode_enter(handle, emode);
if (res != ERROR_OK)
return res;
res = stlink_usb_current_mode(handle, &mode);
if (res != ERROR_OK)
return res;
LOG_DEBUG("MODE: 0x%02X", mode);
return ERROR_OK;
}
