readMem is my ass a kickin. why won't the arm micro restart and execute the pretty...
[goodfet] / firmware / include / jtagarm7tdmi.h
1 /*! \file jtagarm7tdmi.h
2   \brief JTAG handler functions for the ARM7TDMI family of processors
3 */
4
5 #include "jtag.h"
6
7
8 #define JTAGSTATE_ARM 0         // bit 4 on dbg status reg is low
9 #define JTAGSTATE_THUMB 1
10
11 #define ARMTCKTOCK  CLRTCK; PLEDOUT^=PLEDPIN; SETTCK; PLEDOUT^=PLEDPIN;
12 // ASSUME RUN-TEST/IDLE STATE
13 #define SHIFT_IR    SETTMS;TCKTOCK;TCKTOCK;CLRTMS;TCKTOCK;TCKTOCK;
14 #define SHIFT_DR    SETTMS;TCKTOCK;CLRTMS;TCKTOCK;TCKTOCK;
15
16
17
18 unsigned char current_chain;
19 unsigned char current_dbgstate = -1;
20 unsigned char last_halt_debug_state = -1;
21 unsigned long last_halt_pc = -1;
22 unsigned long count_dbgspd_instr_since_debug = 0;
23 unsigned long count_sysspd_instr_since_debug = 0;
24
25
26 void jtag_goto_shift_ir();
27 void jtag_goto_shift_dr();
28 void jtag_reset_to_runtest_idle();
29 void jtag_arm_tcktock();
30
31
32 // JTAGARM7TDMI Commands
33
34 //! Write data to address.
35 unsigned long jtagarm7tdmi_writemem(unsigned long adr, unsigned long data);
36 //! Read data from address
37 unsigned long jtagarm7tdmi_readmem(unsigned long adr);
38
39 //! Halt the CPU
40 unsigned long jtagarm7tdmi_haltcpu();
41 //! Release the CPU
42 unsigned long jtagarm7tdmi_releasecpu();
43
44 //! Set the program counter.
45 void jtagarm7tdmi_setpc(unsigned long adr);
46
47 //! Write data to address.
48 unsigned long jtagarm7tdmi_writeflash(unsigned long adr, unsigned long data);
49
50
51 //! Start JTAG
52 unsigned long jtagarm7tdmi_start(void);
53 //! Reset TAP State Machine
54 void jtagarm7tdmi_resettap();
55
56 //! ARM-specific JTAG bit-transfer
57 unsigned long jtagarmtransn(unsigned long word, unsigned char bitcount, unsigned char lsb, unsigned char end, unsigned char retidle);
58
59 //! Grab debug register - Expect chain 2 to be selected
60 unsigned long jtagarm7tdmi_get_dbgstate() ;
61 //! Grab the core ID.
62 unsigned long jtagarm7tdmi_idcode();
63 //!  Connect Bypass Register to TDO/TDI
64 unsigned char jtagarm7tdmi_bypass();
65 //!  Connect the appropriate scan chain to TDO/TDI
66 unsigned long jtagarm7tdmi_scan_intest(int n);
67 //!  Set a 32-bit ARM register
68 void jtagarm7tdmi_set_register(unsigned long reg, unsigned long val);
69 //!  Get a 32-bit ARM register
70 unsigned long jtagarm7tdmi_get_register(unsigned long reg);
71
72 // ARM7TDMI-specific pins
73 // DBGRQ - GoodFET Pin 8
74 #define DBGRQ   TST
75
76 /*      ARM7TDMI data
77 The instruction register is 4 bits in length.
78 There is no parity bit.
79 The fixed value 0001 is loaded into the instruction register during the CAPTURE-IR
80 controller state.
81 The least significant bit of the instruction register is scanned in and scanned out first.
82 */
83
84 //4-bit ARM7TDMI JTAG commands, bit-swapped
85 #define ARM7TDMI_IR_EXTEST              0x0
86 #define ARM7TDMI_IR_SCAN_N              0x2
87 #define ARM7TDMI_IR_SAMPLE              0x3
88 #define ARM7TDMI_IR_RESTART             0x4
89 #define ARM7TDMI_IR_CLAMP               0x5
90 #define ARM7TDMI_IR_HIGHZ               0x7
91 #define ARM7TDMI_IR_CLAMPZ              0x9
92 #define ARM7TDMI_IR_INTEST              0xC
93 #define ARM7TDMI_IR_IDCODE              0xE
94 #define ARM7TDMI_IR_BYPASS              0xF
95
96 // read 3 bit - Debug Control
97 #define EICE_DBGCTRL                    0       
98 #define EICE_DBGCTRL_BITLEN             3
99 // read 5 bit - Debug Status
100 #define EICE_DBGSTATUS                  1
101 #define EICE_DBGSTATUS_BITLEN           5
102 // read 6 bit - Debug Comms Control Register
103 #define EICE_DBGCCR                     4
104 #define EICE_DBGCCR_BITLEN              6
105 // r/w 32 bit - Debug Comms Data Register
106 #define EICE_DBGCDR                     5
107 // r/w 32 bit - Watchpoint 0 Address
108 #define EICE_WP0ADDR                    8
109 // r/w 32 bit - Watchpoint 0 Addres Mask
110 #define EICE_WP0ADDRMASK                9
111 // r/w 32 bit - Watchpoint 0 Data
112 #define EICE_WP0DATA                    10
113 // r/w 32 bit - Watchpoint 0 Data Masl
114 #define EICE_WP0DATAMASK                11
115 // r/w 9 bit - Watchpoint 0 Control Value
116 #define EICE_WP0CTRL                    12
117 // r/w 8 bit - Watchpoint 0 Control Mask
118 #define EICE_WP0CTRLMASK                13
119 // r/w 32 bit - Watchpoint 0 Address
120 #define EICE_WP1ADDR                    16
121 // r/w 32 bit - Watchpoint 0 Addres Mask
122 #define EICE_WP1ADDRMASK                17
123 // r/w 32 bit - Watchpoint 0 Data
124 #define EICE_WP1DATA                    18
125 // r/w 32 bit - Watchpoint 0 Data Masl
126 #define EICE_WP1DATAMASK                19
127 // r/w 9 bit - Watchpoint 0 Control Value
128 #define EICE_WP1CTRL                    20
129 // r/w 8 bit - Watchpoint 0 Control Mask
130 #define EICE_WP1CTRLMASK                21
131
132
133 #define NOEND 0
134 #define END 1
135 #define MSB 0
136 #define LSB 1
137 #define NORETIDLE 0
138 #define RETIDLE 1
139
140
141 //JTAGARM7TDMI commands
142 #define JTAGARM7TDMI_GET_DEBUG_CTRL       0x80
143 #define JTAGARM7TDMI_SET_DEBUG_CTRL       0x81
144 #define JTAGARM7TDMI_GET_PC               0x82
145 #define JTAGARM7TDMI_SET_PC               0x83
146 #define JTAGARM7TDMI_GET_CHIP_ID          0x84
147 #define JTAGARM7TDMI_GET_DEBUG_STATE      0x85
148 #define JTAGARM7TDMI_GET_WATCHPOINT       0x86
149 #define JTAGARM7TDMI_SET_WATCHPOINT       0x87
150 #define JTAGARM7TDMI_GET_REGISTER         0x88
151 #define JTAGARM7TDMI_SET_REGISTER         0x89
152 #define JTAGARM7TDMI_GET_REGISTERS        0x8a
153 #define JTAGARM7TDMI_SET_REGISTERS        0x8b
154 #define JTAGARM7TDMI_HALTCPU              0x8c
155 #define JTAGARM7TDMI_RELEASECPU           0x8d
156 #define JTAGARM7TDMI_DEBUG_INSTR          0x8e
157 #define JTAGARM7TDMI_STEP_INSTR           0x8f
158 #define JTAGARM7TDMI_WRITEMEM             0x90
159 #define JTAGARM7TDMI_READMEM              0x91
160 #define JTAGARM7TDMI_WRITE_FLASH_PAGE     0x92
161 #define JTAGARM7TDMI_READ_FLASH_PAGE      0x93
162 #define JTAGARM7TDMI_MASS_ERASE_FLASH     0x94
163 #define JTAGARM7TDMI_PROGRAM_FLASH        0x95
164 #define JTAGARM7TDMI_LOCKCHIP             0x96
165 #define JTAGARM7TDMI_CHIP_ERASE           0x97
166 // Really ARM specific stuff
167 #define JTAGARM7TDMI_GET_CPSR             0x98
168 #define JTAGARM7TDMI_SET_CPSR             0x99
169 #define JTAGARM7TDMI_GET_SPSR             0x9a
170 #define JTAGARM7TDMI_SET_SPSR             0x9b
171 #define JTAGARM7TDMI_SET_MODE_THUMB       0x9c
172 #define JTAGARM7TDMI_SET_MODE_ARM         0x9d
173 #define JTAGARM7TDMI_SET_IR               0x9e
174 #define JTAGARM7TDMI_WAIT_DBG             0x9f
175 #define JTAGARM7TDMI_SHIFT_DR             0xa0
176 #define JTAGARM7TDMI_SETWATCH0            0xa1
177 #define JTAGARM7TDMI_SETWATCH1            0xa2
178
179
180 // for deeper understanding, read the instruction cycle timing section of: 
181 //      http://www.atmel.com/dyn/resources/prod_documents/DDI0029G_7TDMI_R3_trm.pdf
182 #define EXECNOPARM                  0xe1a00000L
183 #define ARM_INSTR_NOP               0xe1a00000L
184 #define ARM_INSTR_BX_R0             0xe12fff10L
185 #define ARM_INSTR_STR_Rx_r14        0xe58f0000L // from atmel docs
186 #define ARM_READ_REG                ARM_INSTR_STR_Rx_r14
187 #define ARM_INSTR_LDR_Rx_r14        0xe59f0000L // from atmel docs
188 #define ARM_WRITE_REG               ARM_INSTR_LDR_Rx_r14
189 #define ARM_INSTR_LDR_R1_r0_4       0xe4901004L
190 #define ARM_READ_MEM                ARM_INSTR_LDR_R1_r0_4
191 #define ARM_INSTR_STR_R1_r0_4       0xe4801004L
192 #define ARM_WRITE_MEM               ARM_INSTR_STR_R1_r0_4
193 #define ARM_INSTR_MRS_R0_CPSR       0xe10f0000L
194 #define ARM_INSTR_MSR_cpsr_cxsf_R0  0xe12ff000L
195 #define ARM_INSTR_STMIA_R14_r0_rx   0xE88E0000L      // add up to 65k to indicate which registers...
196 #define ARM_STORE_MULTIPLE          ARM_INSTR_STMIA_R14_r0_rx
197 #define ARM_INSTR_SKANKREGS         0xE88F7fffL
198 #define ARM_INSTR_CLOBBEREGS        0xE89F7fffL
199
200 #define ARM_INSTR_B_IMM             0xea000000L
201 #define ARM_INSTR_BX_PC             0xe12fff10L      // need to set r0 to the desired address
202 #define THUMB_INSTR_STR_R0_r0       0x60006000L
203 #define THUMB_INSTR_MOV_R0_PC       0x46b846b8L
204 #define THUMB_INSTR_BX_PC           0x47784778L
205 #define THUMB_INSTR_NOP             0x1c001c00L
206 #define ARM_REG_PC                  15
207
208 #define JTAG_ARM7TDMI_DBG_DBGACK    1
209 #define JTAG_ARM7TDMI_DBG_DBGRQ     2
210 #define JTAG_ARM7TDMI_DBG_IFEN      4
211 #define JTAG_ARM7TDMI_DBG_cgenL     8
212 #define JTAG_ARM7TDMI_DBG_TBIT      16
213