1 /***************************************************************************
2 * Copyright (C) 2009 by Mathias Kuester *
3 * mkdorg@users.sourceforge.net *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
27 #include "target_type.h"
30 #include "dsp563xx_once.h"
32 #define JTAG_STATUS_STATIC_MASK 0x03
33 #define JTAG_STATUS_STATIC_VALUE 0x01
35 #define JTAG_STATUS_NORMAL 0x01
36 #define JTAG_STATUS_STOPWAIT 0x05
37 #define JTAG_STATUS_BUSY 0x09
38 #define JTAG_STATUS_DEBUG 0x0d
40 #define JTAG_INSTR_EXTEST 0x00
41 #define JTAG_INSTR_SAMPLE_PRELOAD 0x01
42 #define JTAG_INSTR_IDCODE 0x02
43 #define JTAG_INSTR_HIZ 0x04
44 #define JTAG_INSTR_CLAMP 0x05
45 #define JTAG_INSTR_ENABLE_ONCE 0x06
46 #define JTAG_INSTR_DEBUG_REQUEST 0x07
47 #define JTAG_INSTR_BYPASS 0x0F
50 static inline int dsp563xx_write_dr(struct jtag_tap
*tap
, uint8_t * dr_in
, uint8_t * dr_out
, int dr_len
, int rti
)
52 jtag_add_plain_dr_scan(dr_len
, dr_out
, dr_in
, TAP_IDLE
);
58 static inline int dsp563xx_write_dr_u8(struct jtag_tap
*tap
, uint8_t * dr_in
, uint8_t dr_out
, int dr_len
, int rti
)
60 return dsp563xx_write_dr(tap
, dr_in
, &dr_out
, dr_len
, rti
);
64 static inline int dsp563xx_write_dr_u32(struct jtag_tap
*tap
, uint32_t * dr_in
, uint32_t dr_out
, int dr_len
, int rti
)
66 return dsp563xx_write_dr(tap
, (uint8_t *) dr_in
, (uint8_t *) & dr_out
, dr_len
, rti
);
69 /** single word instruction */
70 static inline int dsp563xx_once_ir_exec(struct jtag_tap
*tap
, int flush
, uint8_t instr
, uint8_t rw
, uint8_t go
, uint8_t ex
)
74 if ((err
= dsp563xx_write_dr_u8(tap
, 0, instr
| (ex
<< 5) | (go
<< 6) | (rw
<< 7), 8, 0)) != ERROR_OK
)
77 err
= jtag_execute_queue();
81 /* IR and DR functions */
82 static inline int dsp563xx_write_ir(struct jtag_tap
*tap
, uint8_t * ir_in
, uint8_t * ir_out
, int ir_len
, int rti
)
84 jtag_add_plain_ir_scan(tap
->ir_length
, ir_out
, ir_in
, TAP_IDLE
);
89 static inline int dsp563xx_write_ir_u8(struct jtag_tap
*tap
, uint8_t * ir_in
, uint8_t ir_out
, int ir_len
, int rti
)
91 return dsp563xx_write_ir(tap
, ir_in
, &ir_out
, ir_len
, rti
);
94 static inline int dsp563xx_jtag_sendinstr(struct jtag_tap
*tap
, uint8_t * ir_in
, uint8_t ir_out
)
96 return dsp563xx_write_ir_u8(tap
, ir_in
, ir_out
, tap
->ir_length
, 1);
100 int dsp563xx_once_target_status(struct jtag_tap
*tap
)
105 if ((err
= dsp563xx_jtag_sendinstr(tap
, &jtag_status
, JTAG_INSTR_ENABLE_ONCE
)) != ERROR_OK
)
106 return TARGET_UNKNOWN
;
107 if ((err
= jtag_execute_queue()) != ERROR_OK
)
108 return TARGET_UNKNOWN
;
110 /* verify correct static status pattern */
111 if ( (jtag_status
& JTAG_STATUS_STATIC_MASK
) != JTAG_STATUS_STATIC_VALUE
)
112 return TARGET_UNKNOWN
;
114 if (jtag_status
!= JTAG_STATUS_DEBUG
)
115 return TARGET_RUNNING
;
117 return TARGET_HALTED
;
121 int dsp563xx_once_request_debug(struct jtag_tap
*tap
, int reset_state
)
124 uint8_t ir_in
= 0, pattern
= 0;
127 /* in reset state we only get a ACK
128 * from the interface */
135 pattern
= JTAG_STATUS_DEBUG
;
138 /* wait until we get the ack */
139 while (ir_in
!= pattern
)
141 if ((err
= dsp563xx_jtag_sendinstr(tap
, &ir_in
, JTAG_INSTR_DEBUG_REQUEST
)) != ERROR_OK
)
143 if ((err
= jtag_execute_queue()) != ERROR_OK
)
146 LOG_DEBUG("debug request: %02X", ir_in
);
150 return ERROR_TARGET_FAILURE
;
154 /* we cant enable the once in reset state */
160 /* try to enable once */
163 while (ir_in
!= pattern
)
165 if ((err
= dsp563xx_jtag_sendinstr(tap
, &ir_in
, JTAG_INSTR_ENABLE_ONCE
)) != ERROR_OK
)
167 if ((err
= jtag_execute_queue()) != ERROR_OK
)
170 LOG_DEBUG("enable once: %02X", ir_in
);
175 return ERROR_TARGET_FAILURE
;
179 if (ir_in
!= JTAG_STATUS_DEBUG
)
181 return ERROR_TARGET_FAILURE
;
187 /** once read registers */
188 int dsp563xx_once_read_register(struct jtag_tap
*tap
, int flush
, struct once_reg
*regs
, int len
)
193 for (i
= 0; i
< len
; i
++)
195 if ((err
= dsp563xx_once_reg_read_ex(tap
, flush
, regs
[i
].addr
, regs
[i
].len
, ®s
[i
].reg
)) != ERROR_OK
)
200 err
= jtag_execute_queue();
204 /** once read register with register len */
205 int dsp563xx_once_reg_read_ex(struct jtag_tap
*tap
, int flush
, uint8_t reg
, uint8_t len
, uint32_t * data
)
209 if ((err
= dsp563xx_once_ir_exec(tap
, 1, reg
, 1, 0, 0)) != ERROR_OK
)
211 if ((err
= dsp563xx_write_dr_u32(tap
, data
, 0x00, len
, 0)) != ERROR_OK
)
214 err
= jtag_execute_queue();
218 /** once read register */
219 int dsp563xx_once_reg_read(struct jtag_tap
*tap
, int flush
, uint8_t reg
, uint32_t * data
)
223 if ((err
= dsp563xx_once_ir_exec(tap
, flush
, reg
, 1, 0, 0)) != ERROR_OK
)
225 if ((err
= dsp563xx_write_dr_u32(tap
, data
, 0x00, 24, 0)) != ERROR_OK
)
228 err
= jtag_execute_queue();
232 /** once write register */
233 int dsp563xx_once_reg_write(struct jtag_tap
*tap
, int flush
, uint8_t reg
, uint32_t data
)
237 if ((err
= dsp563xx_once_ir_exec(tap
, flush
, reg
, 0, 0, 0)) != ERROR_OK
)
239 if ((err
= dsp563xx_write_dr_u32(tap
, 0x00, data
, 24, 0)) != ERROR_OK
)
242 err
= jtag_execute_queue();
246 /** single word instruction */
247 int dsp563xx_once_execute_sw_ir(struct jtag_tap
*tap
, int flush
, uint32_t opcode
)
251 if ((err
= dsp563xx_once_ir_exec(tap
, flush
, DSP563XX_ONCE_OPDBR
, 0, 1, 0)) != ERROR_OK
)
253 if ((err
= dsp563xx_write_dr_u32(tap
, 0, opcode
, 24, 0)) != ERROR_OK
)
256 err
= jtag_execute_queue();
260 /** double word instruction */
261 int dsp563xx_once_execute_dw_ir(struct jtag_tap
*tap
, int flush
, uint32_t opcode
, uint32_t operand
)
265 if ((err
= dsp563xx_once_ir_exec(tap
, flush
, DSP563XX_ONCE_OPDBR
, 0, 0, 0)) != ERROR_OK
)
267 if ((err
= dsp563xx_write_dr_u32(tap
, 0, opcode
, 24, 0)) != ERROR_OK
)
270 if ((err
= jtag_execute_queue()) != ERROR_OK
)
273 if ((err
= dsp563xx_once_ir_exec(tap
, flush
, DSP563XX_ONCE_OPDBR
, 0, 1, 0)) != ERROR_OK
)
275 if ((err
= dsp563xx_write_dr_u32(tap
, 0, operand
, 24, 0)) != ERROR_OK
)
278 if ((err
= jtag_execute_queue()) != ERROR_OK
)