1 /***************************************************************************
2 * Copyright (C) 2008 by Spencer Oliver *
3 * spen@spen-soft.co.uk *
5 * Copyright (C) 2008 by David T.L. Wong *
7 * This program is free software; you can redistribute it and/or modify *
8 * it under the terms of the GNU General Public License as published by *
9 * the Free Software Foundation; either version 2 of the License, or *
10 * (at your option) any later version. *
12 * This program is distributed in the hope that it will be useful, *
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
15 * GNU General Public License for more details. *
17 * You should have received a copy of the GNU General Public License *
18 * along with this program; if not, write to the *
19 * Free Software Foundation, Inc., *
20 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
21 ***************************************************************************/
27 #include "mips_ejtag.h"
30 int mips_ejtag_set_instr(mips_ejtag_t
*ejtag_info
, int new_instr
, void *delete_me_and_submit_patch
)
34 tap
= ejtag_info
->tap
;
38 if (buf_get_u32(tap
->cur_instr
, 0, tap
->ir_length
) != (uint32_t)new_instr
)
44 field
.num_bits
= tap
->ir_length
;
46 buf_set_u32(field
.out_value
, 0, field
.num_bits
, new_instr
);
48 field
.in_value
= NULL
;
53 jtag_add_ir_scan(1, &field
, jtag_get_end_state());
59 int mips_ejtag_get_idcode(mips_ejtag_t
*ejtag_info
, uint32_t *idcode
)
63 jtag_set_end_state(TAP_IDLE
);
65 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_IDCODE
, NULL
);
67 field
.tap
= ejtag_info
->tap
;
69 field
.out_value
= NULL
;
71 field
.in_value
= (void*)idcode
;
76 jtag_add_dr_scan(1, &field
, jtag_get_end_state());
78 if (jtag_execute_queue() != ERROR_OK
)
80 LOG_ERROR("register read failed");
86 int mips_ejtag_get_impcode(mips_ejtag_t
*ejtag_info
, uint32_t *impcode
)
90 jtag_set_end_state(TAP_IDLE
);
92 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_IMPCODE
, NULL
);
94 field
.tap
= ejtag_info
->tap
;
96 field
.out_value
= NULL
;
98 field
.in_value
= (void*)impcode
;
103 jtag_add_dr_scan(1, &field
, jtag_get_end_state());
105 if (jtag_execute_queue() != ERROR_OK
)
107 LOG_ERROR("register read failed");
113 int mips_ejtag_drscan_32(mips_ejtag_t
*ejtag_info
, uint32_t *data
)
116 tap
= ejtag_info
->tap
;
127 buf_set_u32(field
.out_value
, 0, field
.num_bits
, *data
);
134 jtag_add_dr_scan(1, &field
, jtag_get_end_state());
136 if ((retval
= jtag_execute_queue()) != ERROR_OK
)
138 LOG_ERROR("register read failed");
142 *data
= buf_get_u32(field
.in_value
, 0, 32);
149 int mips_ejtag_step_enable(mips_ejtag_t
*ejtag_info
)
152 MIPS32_MTC0(1,31,0), /* move $1 to COP0 DeSave */
153 MIPS32_MFC0(1,23,0), /* move COP0 Debug to $1 */
154 MIPS32_ORI(1,1,0x0100), /* set SSt bit in debug reg */
155 MIPS32_MTC0(1,23,0), /* move $1 to COP0 Debug */
156 MIPS32_MFC0(1,31,0), /* move COP0 DeSave to $1 */
162 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
163 0, NULL
, 0, NULL
, 1);
167 int mips_ejtag_step_disable(mips_ejtag_t
*ejtag_info
)
170 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
171 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
172 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
173 MIPS32_SW(1,0,15), /* sw $1,($15) */
174 MIPS32_SW(2,0,15), /* sw $2,($15) */
175 MIPS32_MFC0(1,23,0), /* move COP0 Debug to $1 */
176 MIPS32_LUI(2,0xFFFF), /* $2 = 0xfffffeff */
177 MIPS32_ORI(2,2,0xFEFF),
179 MIPS32_MTC0(1,23,0), /* move $1 to COP0 Debug */
182 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
188 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
189 0, NULL
, 0, NULL
, 1);
194 int mips_ejtag_config_step(mips_ejtag_t
*ejtag_info
, int enable_step
)
197 return mips_ejtag_step_enable(ejtag_info
);
198 return mips_ejtag_step_disable(ejtag_info
);
201 int mips_ejtag_enter_debug(mips_ejtag_t
*ejtag_info
)
204 jtag_set_end_state(TAP_IDLE
);
205 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
207 /* set debug break bit */
208 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
| EJTAG_CTRL_JTAGBRK
;
209 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
211 /* break bit will be cleared by hardware */
212 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
;
213 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
214 LOG_DEBUG("ejtag_ctrl: 0x%8.8" PRIx32
"", ejtag_ctrl
);
215 if ((ejtag_ctrl
& EJTAG_CTRL_BRKST
) == 0)
216 LOG_DEBUG("Failed to enter Debug Mode!");
221 int mips_ejtag_exit_debug(mips_ejtag_t
*ejtag_info
)
226 /* execute our dret instruction */
227 mips32_pracc_exec(ejtag_info
, 1, &inst
, 0, NULL
, 0, NULL
, 0);
232 int mips_ejtag_read_debug(mips_ejtag_t
*ejtag_info
, uint32_t* debug_reg
)
236 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
237 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
238 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
239 MIPS32_SW(1,0,15), /* sw $1,($15) */
240 MIPS32_SW(2,0,15), /* sw $2,($15) */
241 MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $1 = MIPS32_PRACC_PARAM_OUT */
242 MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
243 MIPS32_MFC0(2,23,0), /* move COP0 Debug to $2 */
247 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
253 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
254 0, NULL
, 1, debug_reg
, 1);
259 int mips_ejtag_init(mips_ejtag_t
*ejtag_info
)
261 uint32_t ejtag_version
;
263 mips_ejtag_get_impcode(ejtag_info
, &ejtag_info
->impcode
);
264 LOG_DEBUG("impcode: 0x%8.8" PRIx32
"", ejtag_info
->impcode
);
266 /* get ejtag version */
267 ejtag_version
= ((ejtag_info
->impcode
>> 29) & 0x07);
269 switch (ejtag_version
)
272 LOG_DEBUG("EJTAG: Version 1 or 2.0 Detected");
275 LOG_DEBUG("EJTAG: Version 2.5 Detected");
278 LOG_DEBUG("EJTAG: Version 2.6 Detected");
281 LOG_DEBUG("EJTAG: Version 3.1 Detected");
284 LOG_DEBUG("EJTAG: Unknown Version Detected");
287 LOG_DEBUG("EJTAG: features:%s%s%s%s%s%s%s",
288 ejtag_info
->impcode
& (1<<28) ? " R3k": " R4k",
289 ejtag_info
->impcode
& (1<<24) ? " DINT": "",
290 ejtag_info
->impcode
& (1<<22) ? " ASID_8": "",
291 ejtag_info
->impcode
& (1<<21) ? " ASID_6": "",
292 ejtag_info
->impcode
& (1<<16) ? " MIPS16": "",
293 ejtag_info
->impcode
& (1<<14) ? " noDMA": " DMA",
294 ejtag_info
->impcode
& (1<<0) ? " MIPS64": " MIPS32"
297 if ((ejtag_info
->impcode
& (1<<14)) == 0)
298 LOG_DEBUG("EJTAG: DMA Access Mode Support Enabled");
300 /* set initial state for ejtag control reg */
301 ejtag_info
->ejtag_ctrl
= EJTAG_CTRL_ROCC
| EJTAG_CTRL_PRACC
| EJTAG_CTRL_PROBEN
| EJTAG_CTRL_SETDEV
;
Linking to existing account procedure
If you already have an account and want to add another login method
you
MUST first sign in with your existing account and
then change URL to read
https://review.openocd.org/login/?link
to get to this page again but this time it'll work for linking. Thank you.
SSH host keys fingerprints
1024 SHA256:YKx8b7u5ZWdcbp7/4AeXNaqElP49m6QrwfXaqQGJAOk gerrit-code-review@openocd.zylin.com (DSA)
384 SHA256:jHIbSQa4REvwCFG4cq5LBlBLxmxSqelQPem/EXIrxjk gerrit-code-review@openocd.org (ECDSA)
521 SHA256:UAOPYkU9Fjtcao0Ul/Rrlnj/OsQvt+pgdYSZ4jOYdgs gerrit-code-review@openocd.org (ECDSA)
256 SHA256:A13M5QlnozFOvTllybRZH6vm7iSt0XLxbA48yfc2yfY gerrit-code-review@openocd.org (ECDSA)
256 SHA256:spYMBqEYoAOtK7yZBrcwE8ZpYt6b68Cfh9yEVetvbXg gerrit-code-review@openocd.org (ED25519)
+--[ED25519 256]--+
|=.. |
|+o.. . |
|*.o . . |
|+B . . . |
|Bo. = o S |
|Oo.+ + = |
|oB=.* = . o |
| =+=.+ + E |
|. .=o . o |
+----[SHA256]-----+
2048 SHA256:0Onrb7/PHjpo6iVZ7xQX2riKN83FJ3KGU0TvI0TaFG4 gerrit-code-review@openocd.zylin.com (RSA)