]> git.gag.com Git - fw/openocd/blob - src/target/dsp563xx_once.c
d19323ee7371bdb5ef7f137c538e9c1026a55b5a
[fw/openocd] / src / target / dsp563xx_once.c
1 /***************************************************************************
2  *   Copyright (C) 2009 by Mathias Kuester                                 *
3  *   mkdorg@users.sourceforge.net                                          *
4  *                                                                         *
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.                                   *
9  *                                                                         *
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.                          *
14  *                                                                         *
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  ***************************************************************************/
20 #ifdef HAVE_CONFIG_H
21 #include "config.h"
22 #endif
23
24 #include <jim.h>
25
26 #include "target.h"
27 #include "target_type.h"
28 #include "register.h"
29 #include "dsp563xx.h"
30 #include "dsp563xx_once.h"
31
32 #define JTAG_STATUS_NORMAL              0x01
33 #define JTAG_STATUS_STOPWAIT            0x05
34 #define JTAG_STATUS_BUSY                0x09
35 #define JTAG_STATUS_DEBUG               0x0d
36
37 #define JTAG_INSTR_EXTEST               0x00
38 #define JTAG_INSTR_SAMPLE_PRELOAD       0x01
39 #define JTAG_INSTR_IDCODE               0x02
40 #define JTAG_INSTR_HIZ                  0x04
41 #define JTAG_INSTR_CLAMP                0x05
42 #define JTAG_INSTR_ENABLE_ONCE          0x06
43 #define JTAG_INSTR_DEBUG_REQUEST        0x07
44 #define JTAG_INSTR_BYPASS               0x0F
45
46 /** */
47 static inline int dsp563xx_write_dr(struct jtag_tap *tap, uint8_t * dr_in, uint8_t * dr_out, int dr_len, int rti)
48 {
49         jtag_add_plain_dr_scan(dr_len, dr_out, dr_in, TAP_IDLE);
50
51         return ERROR_OK;
52 }
53
54 /** */
55 static inline int dsp563xx_write_dr_u8(struct jtag_tap *tap, uint8_t * dr_in, uint8_t dr_out, int dr_len, int rti)
56 {
57         return dsp563xx_write_dr(tap, dr_in, &dr_out, dr_len, rti);
58 }
59
60 /** */
61 static inline int dsp563xx_write_dr_u32(struct jtag_tap *tap, uint32_t * dr_in, uint32_t dr_out, int dr_len, int rti)
62 {
63         return dsp563xx_write_dr(tap, (uint8_t *) dr_in, (uint8_t *) & dr_out, dr_len, rti);
64 }
65
66 /** single word instruction */
67 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)
68 {
69         int err;
70
71         if ((err = dsp563xx_write_dr_u8(tap, 0, instr | (ex << 5) | (go << 6) | (rw << 7), 8, 0)) != ERROR_OK)
72                 return err;
73         if ( flush )
74                 err = jtag_execute_queue();
75         return err;
76 }
77
78 /* IR and DR functions */
79 static inline int dsp563xx_write_ir(struct jtag_tap *tap, uint8_t * ir_in, uint8_t * ir_out, int ir_len, int rti)
80 {
81         jtag_add_plain_ir_scan(tap->ir_length, ir_out, ir_in, TAP_IDLE);
82
83         return ERROR_OK;
84 }
85
86 static inline int dsp563xx_write_ir_u8(struct jtag_tap *tap, uint8_t * ir_in, uint8_t ir_out, int ir_len, int rti)
87 {
88         return dsp563xx_write_ir(tap, ir_in, &ir_out, ir_len, rti);
89 }
90
91 static inline int dsp563xx_jtag_sendinstr(struct jtag_tap *tap, uint8_t * ir_in, uint8_t ir_out)
92 {
93         return dsp563xx_write_ir_u8(tap, ir_in, ir_out, tap->ir_length, 1);
94 }
95
96 /** */
97 int dsp563xx_once_target_status(struct jtag_tap *tap)
98 {
99         int err;
100         uint8_t jtag_status;
101
102         if ((err = dsp563xx_jtag_sendinstr(tap, &jtag_status, JTAG_INSTR_ENABLE_ONCE)) != ERROR_OK)
103                 return err;
104         if ((err = jtag_execute_queue()) != ERROR_OK)
105                 return err;
106
107         if ((jtag_status & 1) != 1)
108         {
109                 return TARGET_UNKNOWN;
110         }
111
112         if (jtag_status != JTAG_STATUS_DEBUG)
113         {
114                 return TARGET_RUNNING;
115         }
116
117         return TARGET_HALTED;
118 }
119
120 /** */
121 int dsp563xx_once_request_debug(struct jtag_tap *tap, int reset_state)
122 {
123         int err;
124         uint8_t ir_in = 0, pattern = 0;
125         uint32_t retry = 0;
126
127         /* in reset state we only get a ACK
128          * from the interface */
129         if (reset_state)
130         {
131                 pattern = 1;
132         }
133         else
134         {
135                 pattern = JTAG_STATUS_DEBUG;
136         }
137
138         /* wait until we get the ack */
139         while (ir_in != pattern)
140         {
141                 if ((err = dsp563xx_jtag_sendinstr(tap, &ir_in, JTAG_INSTR_DEBUG_REQUEST)) != ERROR_OK)
142                         return err;
143                 if ((err = jtag_execute_queue()) != ERROR_OK)
144                         return err;
145
146                 LOG_DEBUG("debug request: %02X", ir_in);
147
148                 if (retry++ == 100)
149                 {
150                         return ERROR_TARGET_FAILURE;
151                 }
152         }
153
154         /* we cant enable the once in reset state */
155         if (pattern == 1)
156         {
157                 return ERROR_OK;
158         }
159
160         /* try to enable once */
161         retry = 0;
162         ir_in = 0;
163         while (ir_in != pattern)
164         {
165                 if ((err = dsp563xx_jtag_sendinstr(tap, &ir_in, JTAG_INSTR_ENABLE_ONCE)) != ERROR_OK)
166                         return err;
167                 if ((err = jtag_execute_queue()) != ERROR_OK)
168                         return err;
169
170                 LOG_DEBUG("enable once: %02X", ir_in);
171
172                 if (retry++ == 100)
173                 {
174                         LOG_DEBUG("error");
175                         return ERROR_TARGET_FAILURE;
176                 }
177         }
178
179         if (ir_in != JTAG_STATUS_DEBUG)
180         {
181                 return ERROR_TARGET_FAILURE;
182         }
183
184         return ERROR_OK;
185 }
186
187 /** once read registers */
188 int dsp563xx_once_read_register(struct jtag_tap *tap, int flush, struct once_reg *regs, int len)
189 {
190         int i;
191         int err;
192
193         for (i = 0; i < len; i++)
194         {
195                 if ((err = dsp563xx_once_reg_read_ex(tap, flush, regs[i].addr, regs[i].len, &regs[i].reg)) != ERROR_OK)
196                         return err;
197         }
198
199         if ( flush )
200                 err = jtag_execute_queue();
201         return err;
202 }
203
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)
206 {
207         int err;
208
209         if ((err = dsp563xx_once_ir_exec(tap, 1, reg, 1, 0, 0)) != ERROR_OK)
210                 return err;
211         if ((err = dsp563xx_write_dr_u32(tap, data, 0x00, len, 0)) != ERROR_OK)
212                 return err;
213         if ( flush )
214                 err = jtag_execute_queue();
215         return err;
216 }
217
218 /** once read register */
219 int dsp563xx_once_reg_read(struct jtag_tap *tap, int flush, uint8_t reg, uint32_t * data)
220 {
221         int err;
222
223         if ((err = dsp563xx_once_ir_exec(tap, flush, reg, 1, 0, 0)) != ERROR_OK)
224                 return err;
225         if ((err = dsp563xx_write_dr_u32(tap, data, 0x00, 24, 0)) != ERROR_OK)
226                 return err;
227         if ( flush )
228                 err = jtag_execute_queue();
229         return err;
230 }
231
232 /** once write register */
233 int dsp563xx_once_reg_write(struct jtag_tap *tap, int flush, uint8_t reg, uint32_t data)
234 {
235         int err;
236
237         if ((err = dsp563xx_once_ir_exec(tap, flush, reg, 0, 0, 0)) != ERROR_OK)
238                 return err;
239         if ((err = dsp563xx_write_dr_u32(tap, 0x00, data, 24, 0)) != ERROR_OK)
240                 return err;
241         if ( flush )
242                 err = jtag_execute_queue();
243         return err;
244 }
245
246 /** single word instruction */
247 int dsp563xx_once_execute_sw_ir(struct jtag_tap *tap, int flush, uint32_t opcode)
248 {
249         int err;
250
251         if ((err = dsp563xx_once_ir_exec(tap, flush, DSP563XX_ONCE_OPDBR, 0, 1, 0)) != ERROR_OK)
252                 return err;
253         if ((err = dsp563xx_write_dr_u32(tap, 0, opcode, 24, 0)) != ERROR_OK)
254                 return err;
255         if ( flush )
256                 err = jtag_execute_queue();
257         return err;
258 }
259
260 /** double word instruction */
261 int dsp563xx_once_execute_dw_ir(struct jtag_tap *tap, int flush, uint32_t opcode, uint32_t operand)
262 {
263         int err;
264
265         if ((err = dsp563xx_once_ir_exec(tap, flush, DSP563XX_ONCE_OPDBR, 0, 0, 0)) != ERROR_OK)
266                 return err;
267         if ((err = dsp563xx_write_dr_u32(tap, 0, opcode, 24, 0)) != ERROR_OK)
268                 return err;
269         if ( flush )
270                 if ((err = jtag_execute_queue()) != ERROR_OK)
271                         return err;
272
273         if ((err = dsp563xx_once_ir_exec(tap, flush, DSP563XX_ONCE_OPDBR, 0, 1, 0)) != ERROR_OK)
274                 return err;
275         if ((err = dsp563xx_write_dr_u32(tap, 0, operand, 24, 0)) != ERROR_OK)
276                 return err;
277         if ( flush )
278                 if ((err = jtag_execute_queue()) != ERROR_OK)
279                         return err;
280
281         return ERROR_OK;
282 }