MSP430X2 client connects but reads garbage from ram.

[goodfet] / firmware / apps / jtag / jtag.c

diff --git a/firmware/apps/jtag/jtag.c b/firmware/apps/jtag/jtag.c
index 4dc7021..5abba15 100644 (file)
--- a/firmware/apps/jtag/jtag.c
+++ b/firmware/apps/jtag/jtag.c
@@ -55,8 +55,11 @@ unsigned char jtagtrans8(unsigned char byte){
 unsigned long jtagtransn(unsigned long word,
                         unsigned int bitcount){
   unsigned int bit;
+  unsigned int high=(word>>16);
   SAVETCLK;
   
+  
+  
   for (bit = 0; bit < bitcount; bit++) {
     /* write MOSI on trailing edge of previous clock */
     if (word & 0x8000)
@@ -73,6 +76,11 @@ unsigned long jtagtransn(unsigned long word,
     /* read MISO on trailing edge */
     word |= READMISO;
   }
+  
+  if(bitcount==20){
+    word = ((word << 16) | (word >> 4)) & 0x000FFFFF;
+  }
+  
   RESTORETCLK;
   
   // exit state