+//! Write data to address
+void jtag430x2_writemem(unsigned long adr,
+ unsigned int data){
+ jtag_ir_shift_8(IR_CNTRL_SIG_CAPTURE);
+ if(jtag_dr_shift_16(0) & 0x0301){
+ CLRTCLK;
+ jtag_ir_shift_8(IR_CNTRL_SIG_16BIT);
+ if(adr>=0x100)
+ jtag_dr_shift_16(0x0500);//word mode
+ else
+ jtag_dr_shift_16(0x0510);//byte mode
+ jtag_ir_shift_8(IR_ADDR_16BIT);
+ jtag430_dr_shift_20(adr);
+
+ SETTCLK;
+
+ jtag_ir_shift_8(IR_DATA_TO_ADDR);
+ jtag_dr_shift_16(data);//16 word
+
+ CLRTCLK;
+ jtag_ir_shift_8(IR_CNTRL_SIG_16BIT);
+ jtag_dr_shift_16(0x0501);
+ SETTCLK;
+
+ CLRTCLK;
+ SETTCLK;
+ //init state
+ }else{
+ while(1) PLEDOUT^=PLEDPIN; //loop if locked up
+ }
+}