+//! Read data from address
+unsigned int jtag430x2_readmem(unsigned long adr){
+ unsigned int toret=0;
+ //unsigned int tries=5;
+
+ while(1){
+ do{
+ jtag_ir_shift_8(IR_CNTRL_SIG_CAPTURE);
+ }while(!(jtag_dr_shift_16(0) & 0x0301));
+
+ if(jtag_dr_shift_16(0) & 0x0301){
+ // Read Memory
+ CLRTCLK;
+ jtag_ir_shift_8(IR_CNTRL_SIG_16BIT);
+
+ jtag_dr_shift_16(0x0501);//word read
+
+ jtag_ir_shift_8(IR_ADDR_16BIT);
+ jtag430_dr_shift_20(adr); //20
+
+ jtag_ir_shift_8(IR_DATA_TO_ADDR);
+ SETTCLK;
+ CLRTCLK;
+ toret = jtag_dr_shift_16(0x0000);
+
+ SETTCLK;
+
+ //Cycle a bit.
+ CLRTCLK;
+ SETTCLK;
+ return toret;
+ }
+
+ return 0xdead;
+ }
+ //return toret;
+}
+
+//! Syncs a POR.
+unsigned int jtag430x2_syncpor(){
+ jtag_ir_shift_8(IR_CNTRL_SIG_16BIT);
+ jtag_dr_shift_16(0x1501); //JTAG mode
+ while(!(jtag_dr_shift_16(0) & 0x200)); //0x100 or 0x200?
+ return jtag430x2_por();
+}