target/ti-cjtag: make switching to JTAG more reliable