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, see <http://www.gnu.org/licenses/>. *
17 ***************************************************************************/
26 #include "target_type.h"
29 #include "dsp563xx_once.h"
31 #define JTAG_STATUS_STATIC_MASK 0x03
32 #define JTAG_STATUS_STATIC_VALUE 0x01
34 #define JTAG_STATUS_NORMAL 0x01
35 #define JTAG_STATUS_STOPWAIT 0x05
36 #define JTAG_STATUS_BUSY 0x09
37 #define JTAG_STATUS_DEBUG 0x0d
39 #define JTAG_INSTR_EXTEST 0x00
40 #define JTAG_INSTR_SAMPLE_PRELOAD 0x01
41 #define JTAG_INSTR_IDCODE 0x02
42 #define JTAG_INSTR_HIZ 0x04
43 #define JTAG_INSTR_CLAMP 0x05
44 #define JTAG_INSTR_ENABLE_ONCE 0x06
45 #define JTAG_INSTR_DEBUG_REQUEST 0x07
46 #define JTAG_INSTR_BYPASS 0x0F
49 static inline int dsp563xx_write_dr(struct jtag_tap
*tap
, uint8_t * dr_in
, uint8_t * dr_out
, int dr_len
, int rti
)
51 jtag_add_plain_dr_scan(dr_len
, dr_out
, dr_in
, TAP_IDLE
);
57 static inline int dsp563xx_write_dr_u8(struct jtag_tap
*tap
, uint8_t * dr_in
, uint8_t dr_out
, int dr_len
, int rti
)
59 return dsp563xx_write_dr(tap
, dr_in
, &dr_out
, dr_len
, rti
);
63 static inline int dsp563xx_write_dr_u32(struct jtag_tap
*tap
, uint32_t * dr_in
, uint32_t dr_out
, int dr_len
, int rti
)
65 return dsp563xx_write_dr(tap
, (uint8_t *) dr_in
, (uint8_t *) &dr_out
, dr_len
, rti
);
68 /** single word instruction */
69 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
)
73 err
= dsp563xx_write_dr_u8(tap
, 0, instr
| (ex
<< 5) | (go
<< 6) | (rw
<< 7), 8, 0);
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 err
= dsp563xx_jtag_sendinstr(tap
, &jtag_status
, JTAG_INSTR_ENABLE_ONCE
);
107 return TARGET_UNKNOWN
;
108 err
= jtag_execute_queue();
110 return TARGET_UNKNOWN
;
112 /* verify correct static status pattern */
113 if ((jtag_status
& JTAG_STATUS_STATIC_MASK
) != JTAG_STATUS_STATIC_VALUE
)
114 return TARGET_UNKNOWN
;
116 if (jtag_status
!= JTAG_STATUS_DEBUG
)
117 return TARGET_RUNNING
;
119 return TARGET_HALTED
;
123 int dsp563xx_once_request_debug(struct jtag_tap
*tap
, int reset_state
)
126 uint8_t ir_in
= 0, pattern
= 0;
129 /* in reset state we only get a ACK
130 * from the interface */
134 pattern
= JTAG_STATUS_DEBUG
;
136 /* wait until we get the ack */
137 while (ir_in
!= pattern
) {
138 err
= dsp563xx_jtag_sendinstr(tap
, &ir_in
, JTAG_INSTR_DEBUG_REQUEST
);
141 err
= jtag_execute_queue();
145 LOG_DEBUG("debug request: %02X", ir_in
);
148 return ERROR_TARGET_FAILURE
;
151 /* we cant enable the once in reset state */
155 /* try to enable once */
158 while (ir_in
!= pattern
) {
159 err
= dsp563xx_jtag_sendinstr(tap
, &ir_in
, JTAG_INSTR_ENABLE_ONCE
);
162 err
= jtag_execute_queue();
166 LOG_DEBUG("enable once: %02X", ir_in
);
168 if (retry
++ == 100) {
170 return ERROR_TARGET_FAILURE
;
174 if (ir_in
!= JTAG_STATUS_DEBUG
)
175 return ERROR_TARGET_FAILURE
;
180 /** once read registers */
181 int dsp563xx_once_read_register(struct jtag_tap
*tap
, int flush
, struct once_reg
*regs
, int len
)
186 for (i
= 0; i
< len
; i
++) {
187 err
= dsp563xx_once_reg_read_ex(tap
, flush
, regs
[i
].addr
, regs
[i
].len
, ®s
[i
].reg
);
193 err
= jtag_execute_queue();
197 /** once read register with register len */
198 int dsp563xx_once_reg_read_ex(struct jtag_tap
*tap
, int flush
, uint8_t reg
, uint8_t len
, uint32_t * data
)
202 err
= dsp563xx_once_ir_exec(tap
, 1, reg
, 1, 0, 0);
205 err
= dsp563xx_write_dr_u32(tap
, data
, 0x00, len
, 0);
209 err
= jtag_execute_queue();
214 /** once read register */
215 int dsp563xx_once_reg_read(struct jtag_tap
*tap
, int flush
, uint8_t reg
, uint32_t * data
)
219 err
= dsp563xx_once_ir_exec(tap
, flush
, reg
, 1, 0, 0);
222 err
= dsp563xx_write_dr_u32(tap
, data
, 0x00, 24, 0);
226 err
= jtag_execute_queue();
231 /** once write register */
232 int dsp563xx_once_reg_write(struct jtag_tap
*tap
, int flush
, uint8_t reg
, uint32_t data
)
236 err
= dsp563xx_once_ir_exec(tap
, flush
, reg
, 0, 0, 0);
239 err
= dsp563xx_write_dr_u32(tap
, 0x00, data
, 24, 0);
243 err
= jtag_execute_queue();
247 /** single word instruction */
248 int dsp563xx_once_execute_sw_ir(struct jtag_tap
*tap
, int flush
, uint32_t opcode
)
252 err
= dsp563xx_once_ir_exec(tap
, flush
, DSP563XX_ONCE_OPDBR
, 0, 1, 0);
255 err
= dsp563xx_write_dr_u32(tap
, 0, opcode
, 24, 0);
259 err
= jtag_execute_queue();
263 /** double word instruction */
264 int dsp563xx_once_execute_dw_ir(struct jtag_tap
*tap
, int flush
, uint32_t opcode
, uint32_t operand
)
268 err
= dsp563xx_once_ir_exec(tap
, flush
, DSP563XX_ONCE_OPDBR
, 0, 0, 0);
271 err
= dsp563xx_write_dr_u32(tap
, 0, opcode
, 24, 0);
275 err
= jtag_execute_queue();
280 err
= dsp563xx_once_ir_exec(tap
, flush
, DSP563XX_ONCE_OPDBR
, 0, 1, 0);
283 err
= dsp563xx_write_dr_u32(tap
, 0, operand
, 24, 0);
287 err
= jtag_execute_queue();