X-Git-Url: https://hackdaworld.org/gitweb/?p=my-code%2Ffpga.git;a=blobdiff_plain;f=fx2%2Ffx2.c;fp=fx2%2Ffx2.c;h=49f0da53740d7d6899178542fa410fef60d16bc7;hp=a8f0467e88f90c5000c52696de78af4889fffd48;hb=428f6220f2ed679f658e077d8c30cc29958e1f26;hpb=dc754367536310b01e2ea0fc7225ac899a8e8539

diff --git a/fx2/fx2.c b/fx2/fx2.c
index a8f0467..49f0da5 100644
--- a/fx2/fx2.c
+++ b/fx2/fx2.c
@@ -252,21 +252,17 @@ void main() {
 	fx2_init();
 
 	/* jtag by polling ep1 */
+
 	while(1) {
 		if(!(EP1OUTCS&BUSY)) {
+			set=IOD;
 			buf=EP1OUTBUF[0];
-			if(buf!=GET_TDO) {
-				set=(IOD&(~0x1c))|(buf&0x1c);
-				IOD=set;
-				EP1OUTBC=1;
-			}
-			else {
-				while(EP1INCS&BUSY)
-					continue;
-				buf=IOD&0x01?1:0;
-				EP1INBUF[0]=buf;
-				EP1INBC=1;
-			}
+			IOD=(IOD&(~0x1c))|(buf&0x1c);
+			EP1OUTBC=1;
+		}
+		if(!(EP1INCS&BUSY)) {
+			EP1INBUF[0]=IOD&0x01;
+			EP1INBC=1;
 		}
 	}