drivers: cmsis-dap: fix connection in JTAG mode