Unbreak jtag

Author: bugadani

src/jtag.rs

@@ -333,17 +333,18 @@ fn transfer<DEPS>(
 fn shift_register_data<DEPS>(
     jtag: &mut impl Jtag<DEPS>,
     mut data: u32,
-    mut clocks: u8,
+    clock_cycles: u8,
     exit_shift: bool,
 ) -> u32 {
     // All bits except last with TMS = 0
     let mut captured_dr = 0;
+    let mut clocks = clock_cycles;
     while clocks > 1 {
         let bits = (clocks - 1).min(8);
 
         let captured_byte = shift_tdi(jtag, data as u8, bits, false);
         captured_dr >>= bits;
-        captured_dr |= (captured_byte as u32) << (32 - bits);
+        captured_dr |= (captured_byte as u32) << (clock_cycles - bits);
 
         data >>= bits;
         clocks -= bits;
@@ -352,7 +353,7 @@ fn shift_register_data<DEPS>(
     // Last bit (with TMS = 1 if exit_shift)
     let captured_byte = shift_tdi(jtag, data as u8, 1, exit_shift);
     captured_dr >>= 1;
-    captured_dr |= (captured_byte as u32) << 31;
+    captured_dr |= (captured_byte as u32) << (clock_cycles - 1);
 
     captured_dr
 }