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
  60 //! Read data from address
  61 unsigned int jtag430x2_readmem(unsigned long adr){
  62   unsigned int toret=0;
  63
  64   jtag_ir_shift8(IR_CNTRL_SIG_CAPTURE);
  65   if(jtag_dr_shift16(0) & 0x0301){
  66     // Read Memory
  67     CLRTCLK;
  68     jtag_ir_shift8(IR_CNTRL_SIG_16BIT);
  69     if(adr>=0x100){
  70       jtag_dr_shift16(0x0501);//word read
  71     }else{
  72       jtag_dr_shift16(0x0511);//byte read
  73     }
  74     jtag_ir_shift8(IR_ADDR_16BIT);
  75     jtag_dr_shift20(adr);
  76
  77     jtag_ir_shift8(IR_DATA_TO_ADDR);
  78     SETTCLK;
  79     CLRTCLK;
  80     toret = jtag_dr_shift16(0x0000);
  81
  82     SETTCLK;
  83     // one or more cycle, so CPU is driving correct MAB
  84
  85     CLRTCLK;
  86     SETTCLK;
  87     // Processor is now again in Init State
  88   }
  89
  90
  91
  92   return toret;
  93 }
  94
  95
  96 //! Handles classic MSP430 JTAG commands.  Forwards others to JTAG.
  97 void jtag430x2handle(unsigned char app,
  98                    unsigned char verb,
  99                    unsigned char len){
 100
 101   switch(verb){
 102   case START:
 103     //Enter JTAG mode.
 104     do cmddata[0]=jtag430x2_start();
 105     while(cmddata[0]==00 || cmddata[0]==0xFF);
 106
 107     //MSP430 or MSP430X
 108     if(jtagid==MSP430JTAGID){
 109       jtag430mode=MSP430MODE;
 110       drwidth=16;
 111     }else if(jtagid==MSP430X2JTAGID){
 112       jtag430mode=MSP430X2MODE;
 113       drwidth=20;
 114     }else{
 115       txdata(app,NOK,1);
 116       return;
 117     }
 118
 119     //TAP setup, fuse check
 120     //jtag430_resettap();
 121     txdata(app,verb,1);
 122     break;
 123   case JTAG430_READMEM:
 124   case PEEK:
 125     cmddataword[0]=jtag430x2_readmem(cmddataword[0]);
 126     //cmddataword[0]=jtag430_readmem(cmddataword[0]);
 127     txdata(app,verb,2);
 128     break;
 129   case JTAG430_COREIP_ID:
 130     cmddataword[0]=jtag430_coreid();
 131     txdata(app,verb,2);
 132     break;
 133   case JTAG430_DEVICE_ID:
 134     cmddatalong[0]=jtag430_deviceid();
 135     txdata(app,verb,4);
 136     break;
 137   case JTAG430_HALTCPU:
 138   case JTAG430_RELEASECPU:
 139   case JTAG430_SETINSTRFETCH:
 140   case JTAG430_WRITEMEM:
 141   case POKE:
 142   case JTAG430_WRITEFLASH:
 143   case JTAG430_ERASEFLASH:
 144   case JTAG430_SETPC:
 145   default:
 146     jtaghandle(app,verb,len);
 147   }
 148   jtag430_resettap();
 149 }