jtag: cmsis-dap: Issue disconnect before reconnecting