stlink: fix SWIM mode on stlink-v3