+
+// define the jtag430x2 app's app_t
+app_t const jtag430x2_app = {
+ /* app number */
+ JTAG430X2,
+
+ /* handle fn */
+ jtag430x2_handle_fn,
+
+ /* name */
+ "JTAG430X2",
+
+ /* desc */
+ "\tThe JTAG430X2 app extends the basic JTAG app with support\n"
+ "\tfor 20-bit MSP430X2 devices, such as the MSP430F5xx Family.\n"
+};
+
+//! Shift 20 bits of the DR.
+uint32_t jtag430_dr_shift_20(uint32_t in)
+{
+ if (!in_run_test_idle())
+ {
+ debugstr("Not in run-test-idle state");
+ return 0;
+ }
+
+ // get intot the right state
+ jtag_capture_dr();
+ jtag_shift_register();
+
+ // shift DR, then idle
+ return jtag_trans_n(in, 20, MSB);
+}
+
+//! Grab the core ID.
+unsigned int jtag430_coreid(){
+ jtag_ir_shift_8(IR_COREIP_ID);
+ return jtag_dr_shift_16(0);
+}
+
+//! Grab the device ID.
+unsigned long jtag430_deviceid(){
+ jtag_ir_shift_8(IR_DEVICE_ID);
+ return jtag430_dr_shift_20(0);
+}
+
+
+//! 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) led_toggle(); //loop if locked up
+ }