stlink_usb: Changes to make connect_under_reset work