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
) != (u32
)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
, u32
*idcode
)
63 jtag_add_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
, u32
*impcode
)
90 jtag_add_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
, u32
*data
)
116 tap
= ejtag_info
->tap
;
127 buf_set_u32(field
.out_value
, 0, field
.num_bits
, *data
);
129 field
.in_value
= (u8
*)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");
147 int mips_ejtag_step_enable(mips_ejtag_t
*ejtag_info
)
150 MIPS32_MTC0(1,31,0), /* move $1 to COP0 DeSave */
151 MIPS32_MFC0(1,23,0), /* move COP0 Debug to $1 */
152 MIPS32_ORI(1,1,0x0100), /* set SSt bit in debug reg */
153 MIPS32_MTC0(1,23,0), /* move $1 to COP0 Debug */
154 MIPS32_MFC0(1,31,0), /* move COP0 DeSave to $1 */
160 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
161 0, NULL
, 0, NULL
, 1);
165 int mips_ejtag_step_disable(mips_ejtag_t
*ejtag_info
)
168 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
169 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
170 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
171 MIPS32_SW(1,0,15), /* sw $1,($15) */
172 MIPS32_SW(2,0,15), /* sw $2,($15) */
173 MIPS32_MFC0(1,23,0), /* move COP0 Debug to $1 */
174 MIPS32_LUI(2,0xFFFF), /* $2 = 0xfffffeff */
175 MIPS32_ORI(2,2,0xFEFF),
177 MIPS32_MTC0(1,23,0), /* move $1 to COP0 Debug */
180 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
186 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
187 0, NULL
, 0, NULL
, 1);
192 int mips_ejtag_config_step(mips_ejtag_t
*ejtag_info
, int enable_step
)
195 return mips_ejtag_step_enable(ejtag_info
);
196 return mips_ejtag_step_disable(ejtag_info
);
199 int mips_ejtag_enter_debug(mips_ejtag_t
*ejtag_info
)
202 jtag_add_end_state(TAP_IDLE
);
203 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
205 /* set debug break bit */
206 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
| EJTAG_CTRL_JTAGBRK
;
207 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
209 /* break bit will be cleared by hardware */
210 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
;
211 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
212 LOG_DEBUG("ejtag_ctrl: 0x%8.8x", ejtag_ctrl
);
213 if((ejtag_ctrl
& EJTAG_CTRL_BRKST
) == 0)
214 LOG_DEBUG("Failed to enter Debug Mode!");
219 int mips_ejtag_exit_debug(mips_ejtag_t
*ejtag_info
)
224 /* execute our dret instruction */
225 mips32_pracc_exec(ejtag_info
, 1, &inst
, 0, NULL
, 0, NULL
, 0);
230 int mips_ejtag_read_debug(mips_ejtag_t
*ejtag_info
, u32
* debug_reg
)
234 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
235 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
236 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
237 MIPS32_SW(1,0,15), /* sw $1,($15) */
238 MIPS32_SW(2,0,15), /* sw $2,($15) */
239 MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $1 = MIPS32_PRACC_PARAM_OUT */
240 MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
241 MIPS32_MFC0(2,23,0), /* move COP0 Debug to $2 */
245 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
251 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
252 0, NULL
, 1, debug_reg
, 1);
257 int mips_ejtag_init(mips_ejtag_t
*ejtag_info
)
261 mips_ejtag_get_impcode(ejtag_info
, &ejtag_info
->impcode
);
262 LOG_DEBUG("impcode: 0x%8.8x", ejtag_info
->impcode
);
264 /* get ejtag version */
265 ejtag_version
= ((ejtag_info
->impcode
>> 29) & 0x07);
267 switch (ejtag_version
)
270 LOG_DEBUG("EJTAG: Version 1 or 2.0 Detected");
273 LOG_DEBUG("EJTAG: Version 2.5 Detected");
276 LOG_DEBUG("EJTAG: Version 2.6 Detected");
279 LOG_DEBUG("EJTAG: Version 3.1 Detected");
282 LOG_DEBUG("EJTAG: Unknown Version Detected");
285 LOG_DEBUG("EJTAG: features:%s%s%s%s%s%s%s",
286 ejtag_info
->impcode
& (1<<28) ? " R3k": " R4k",
287 ejtag_info
->impcode
& (1<<24) ? " DINT": "",
288 ejtag_info
->impcode
& (1<<22) ? " ASID_8": "",
289 ejtag_info
->impcode
& (1<<21) ? " ASID_6": "",
290 ejtag_info
->impcode
& (1<<16) ? " MIPS16": "",
291 ejtag_info
->impcode
& (1<<14) ? " noDMA": " DMA",
292 ejtag_info
->impcode
& (1<<0) ? " MIPS64": " MIPS32"
295 if((ejtag_info
->impcode
& (1<<14)) == 0)
296 LOG_DEBUG("EJTAG: DMA Access Mode Support Enabled");
298 /* set initial state for ejtag control reg */
299 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)