stlink: code factorization by introducing stlink_usb_exit_mode