diff --git a/src/target/adiv5_swdp.c b/src/target/adiv5_swdp.c index d4ba9ebc..9e107c1d 100644 --- a/src/target/adiv5_swdp.c +++ b/src/target/adiv5_swdp.c @@ -64,12 +64,12 @@ int adiv5_swdp_scan(void) return -1; /* Switch from JTAG to SWD mode */ - swdptap_seq_out(0xFFFF, 16); - for(int i = 0; i < 50; i++) - swdptap_bit_out(1); + swdptap_seq_out(0xFFFFFFFF, 16); + swdptap_seq_out(0xFFFFFFFF, 32); + swdptap_seq_out(0xFFFFFFFF, 18); swdptap_seq_out(0xE79E, 16); /* 0b0111100111100111 */ - for(int i = 0; i < 50; i++) - swdptap_bit_out(1); + swdptap_seq_out(0xFFFFFFFF, 32); + swdptap_seq_out(0xFFFFFFFF, 18); swdptap_seq_out(0, 16); /* Read the SW-DP IDCODE register to syncronise */