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_shift20(0);
  57 }
  58
  59 //! Set the program counter.
  60 void jtag430x2_setpc(unsigned long pc){
  61   //From SLAU265.
  62
  63   unsigned short Mova;
  64   unsigned short Pc_l;
  65
  66   Mova  = 0x0080;
  67   Mova += (unsigned short)((pc>>8) & 0x00000F00);
  68   Pc_l  = (unsigned short)((pc & 0xFFFF));
  69
  70   // Check Full-Emulation-State at the beginning
  71   jtag_ir_shift8(IR_CNTRL_SIG_CAPTURE);
  72   if(jtag_dr_shift16(0) & 0x0301){
  73       // MOVA #imm20, PC
  74       CLRTCLK;
  75       // take over bus control during clock LOW phase
  76       jtag_ir_shift8(IR_DATA_16BIT);
  77       SETTCLK;
  78       jtag_dr_shift16(Mova);
  79       jtag_ir_shift8(IR_CNTRL_SIG_16BIT);
  80       jtag_dr_shift16(0x1400);
  81       jtag_ir_shift8(IR_DATA_16BIT);
  82       CLRTCLK;
  83       SETTCLK;
  84       jtag_dr_shift16(Pc_l);
  85       CLRTCLK;
  86       SETTCLK;
  87       jtag_dr_shift16(0x4303);
  88       CLRTCLK;
  89       jtag_ir_shift8(IR_ADDR_CAPTURE);
  90       jtag_dr_shift20(0x00000);
  91   }else{
  92     while(1) P1OUT^=1; //Lock LED if locked up.
  93   }
  94 }
  95
  96
  97 //! Read data from address
  98 unsigned int jtag430x2_readmem(unsigned int adr){
  99   unsigned int toret;
 100
 101   jtag430x2_setpc(adr);
 102   SETTCLK;
 103   jtag_ir_shift8(IR_CNTRL_SIG_16BIT);
 104   jtag_dr_shift16(0x0501);
 105   jtag_ir_shift8(IR_ADDR_CAPTURE);
 106
 107   jtag_ir_shift8(IR_DATA_QUICK);
 108
 109   SETTCLK;
 110   CLRTCLK;
 111   toret = jtag_dr_shift16(0);//read
 112
 113   jtag_ir_shift8(IR_CNTRL_SIG_CAPTURE);
 114
 115   return toret;
 116 }
 117
 118
 119 //! Handles classic MSP430 JTAG commands.  Forwards others to JTAG.
 120 void jtag430x2handle(unsigned char app,
 121                    unsigned char verb,
 122                    unsigned char len){
 123
 124   switch(verb){
 125   case START:
 126     //Enter JTAG mode.
 127     do cmddata[0]=jtag430x2_start();
 128     while(cmddata[0]==00 || cmddata[0]==0xFF);
 129
 130     //MSP430 or MSP430X
 131     if(jtagid==MSP430JTAGID){
 132       jtag430mode=MSP430MODE;
 133       drwidth=16;
 134     }else if(jtagid==MSP430X2JTAGID){
 135       jtag430mode=MSP430X2MODE;
 136       drwidth=20;
 137     }else{
 138       txdata(app,NOK,1);
 139       return;
 140     }
 141
 142     //TAP setup, fuse check
 143     //jtag430_resettap();
 144     txdata(app,verb,1);
 145     break;
 146   case JTAG430_READMEM:
 147   case PEEK:
 148     cmddataword[0]=jtag430x2_readmem(cmddataword[0]);
 149     //cmddataword[0]=jtag430_readmem(cmddataword[0]);
 150     txdata(app,verb,2);
 151     break;
 152   case JTAG430_COREIP_ID:
 153     cmddataword[0]=jtag430_coreid();
 154     txdata(app,verb,2);
 155     break;
 156   case JTAG430_DEVICE_ID:
 157     cmddatalong[0]=jtag430_deviceid();
 158     txdata(app,verb,4);
 159     break;
 160   case JTAG430_HALTCPU:
 161   case JTAG430_RELEASECPU:
 162   case JTAG430_SETINSTRFETCH:
 163   case JTAG430_WRITEMEM:
 164   case POKE:
 165   case JTAG430_WRITEFLASH:
 166   case JTAG430_ERASEFLASH:
 167   case JTAG430_SETPC:
 168   default:
 169     jtaghandle(app,verb,len);
 170   }
 171   jtag430_resettap();
 172 }