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;
}
}