git.rot13.org Git - goodfet/blob - firmware/apps/jtag/jtag430x2.c

   1 /*! \file jtag430x2.c
   2   \author Travis Goodspeed <travis at radiantmachines.com>
   3
   4   This is an implementation of the MSP430X2 JTAG protocol
   5   for the GoodFET project at http://goodfet.sf.net/
   6
   7   See the license file for details of proper use.
   8 */
   9
  10 #include "platform.h"
  11 #include "command.h"
  12 #include "jtag.h"
  13
  14 unsigned char jtagid;
  15
  16 //! Get the JTAG ID
  17 unsigned char jtag430x2_jtagid(){
  18   jtag430_resettap();
  19   return jtagid=jtag_ir_shift8(IR_BYPASS);
  20 }
  21 //! Start JTAG, take pins
  22 unsigned char jtag430x2_start(){
  23   jtagsetup();
  24
  25   //Known-good starting position.
  26   //Might be unnecessary.
  27   SETTST;
  28   SETRST;
  29
  30   delay(0xFFFF);
  31
  32   //Entry sequence from Page 67 of SLAU265A for 4-wire MSP430 JTAG
  33   CLRRST;
  34   delay(10);
  35   CLRTST;
  36
  37   delay(5);
  38   SETTST;
  39   msdelay(5);
  40   SETRST;
  41   P5DIR&=~RST;
  42
  43   delay(0xFFFF);
  44
  45   //Perform a reset and disable watchdog.
  46   return jtag430x2_jtagid();
  47 }
  48
  49 unsigned int jtag430_coreid(){
  50   jtag_ir_shift8(IR_COREIP_ID);
  51   return jtag_dr_shift16(0);
  52 }
  53
  54 unsigned long jtag430_deviceid(){
  55   jtag_ir_shift8(IR_DEVICE_ID);
  56   return jtag_dr_shift(0);
  57 }
  58
  59 //! Set the program counter.
  60 void jtag430x2_setpc(unsigned long pc){
  61   unsigned short Mova;
  62   unsigned short Pc_l;
  63
  64   Mova  = 0x0080;
  65   Mova += (unsigned short)((pc>>8) & 0x00000F00);
  66   Pc_l  = (unsigned short)((pc & 0xFFFF));
  67
  68   // Check Full-Emulation-State at the beginning
  69   jtag_ir_shift8(IR_CNTRL_SIG_CAPTURE);
  70   if(jtag_dr_shift16(0) & 0x0301){
  71       // MOVA #imm20, PC
  72       CLRTCLK;
  73       // take over bus control during clock LOW phase
  74       jtag_ir_shift8(IR_DATA_16BIT);
  75       SETTCLK;
  76       jtag_dr_shift16(Mova);
  77       jtag_ir_shift8(IR_CNTRL_SIG_16BIT);
  78       jtag_dr_shift16(0x1400);
  79       jtag_ir_shift8(IR_DATA_16BIT);
  80       CLRTCLK;
  81       SETTCLK;
  82       jtag_dr_shift16(Pc_l);
  83       CLRTCLK;
  84       SETTCLK;
  85       jtag_dr_shift16(0x4303);
  86       CLRTCLK;
  87       jtag_ir_shift8(IR_ADDR_CAPTURE);
  88       jtag_dr_shift(0x00000);
  89   }
  90 }
  91
  92 //! Read data from address
  93 unsigned int jtag430x2_readmem(unsigned int adr){
  94   unsigned int toret;
  95
  96   //SETPC_430Xv2(StartAddr);
  97   SETTCLK;
  98   jtag_ir_shift8(IR_CNTRL_SIG_16BIT);
  99   jtag_dr_shift16(0x0501);
 100   jtag_ir_shift8(IR_ADDR_CAPTURE);
 101
 102   jtag_ir_shift8(IR_DATA_QUICK);
 103
 104   SETTCLK;
 105   CLRTCLK;
 106   toret = jtag_dr_shift16(0);//read
 107
 108   jtag_ir_shift8(IR_CNTRL_SIG_CAPTURE);
 109
 110   return toret;
 111 }
 112
 113
 114 //! Handles classic MSP430 JTAG commands.  Forwards others to JTAG.
 115 void jtag430x2handle(unsigned char app,
 116                    unsigned char verb,
 117                    unsigned char len){
 118
 119   switch(verb){
 120   case START:
 121     //Enter JTAG mode.
 122     do cmddata[0]=jtag430x2_start();
 123     while(cmddata[0]==00 || cmddata[0]==0xFF);
 124
 125     //MSP430 or MSP430X
 126     if(jtagid==MSP430JTAGID){
 127       jtag430mode=MSP430MODE;
 128       drwidth=16;
 129     }else if(jtagid==MSP430X2JTAGID){
 130       jtag430mode=MSP430X2MODE;
 131     }else{
 132       txdata(app,NOK,1);
 133       return;
 134     }
 135
 136     //TAP setup, fuse check
 137     //jtag430_resettap();
 138     txdata(app,verb,1);
 139     break;
 140   case JTAG430_READMEM:
 141   case PEEK:
 142     cmddataword[0]=jtag430x2_readmem(cmddataword[0]);
 143     txdata(app,verb,2);
 144     break;
 145   case JTAG430_COREIP_ID:
 146     cmddataword[0]=jtag430_coreid();
 147     txdata(app,verb,2);
 148     break;
 149   case JTAG430_DEVICE_ID:
 150     cmddatalong[0]=jtag430_deviceid();
 151     txdata(app,verb,4);
 152     break;
 153   case JTAG430_HALTCPU:
 154   case JTAG430_RELEASECPU:
 155   case JTAG430_SETINSTRFETCH:
 156   case JTAG430_WRITEMEM:
 157   case POKE:
 158   case JTAG430_WRITEFLASH:
 159   case JTAG430_ERASEFLASH:
 160   case JTAG430_SETPC:
 161   default:
 162     jtaghandle(app,verb,len);
 163   }
 164   jtag430_resettap();
 165 }