- jtag_ir_shift8(IR_ADDR_16BIT);
- jtag_dr_shift20(adr); //20
-
- jtag_ir_shift8(IR_DATA_TO_ADDR);
- SETTCLK;
- CLRTCLK;
- toret = jtag_dr_shift16(0x0000);
-
- SETTCLK;
-
- //Cycle a bit.
- CLRTCLK;
- SETTCLK;
- }else{
- return 0xBABE;
+ if(jtag_dr_shift16(0) & 0x0301){
+ // Read Memory
+ CLRTCLK;
+ jtag_ir_shift8(IR_CNTRL_SIG_16BIT);
+ if(adr>=0x100){
+ jtag_dr_shift16(0x0501);//word read
+ }else{
+ jtag_dr_shift16(0x0511);//byte read
+ }
+
+ jtag_ir_shift8(IR_ADDR_16BIT);
+ jtag_dr_shift20(adr); //20
+
+ jtag_ir_shift8(IR_DATA_TO_ADDR);
+ SETTCLK;
+ CLRTCLK;
+ toret = jtag_dr_shift16(0x0000);
+
+ SETTCLK;
+
+ //Cycle a bit.
+ CLRTCLK;
+ SETTCLK;
+ return toret;
+ }