1 /***************************************************************************
2 * Copyright (C) 2008 by Spencer Oliver *
3 * spen@spen-soft.co.uk *
5 * Copyright (C) 2008 by David T.L. Wong *
7 * Copyright (C) 2009 by David N. Claffey <dnclaffey@gmail.com> *
9 * This program is free software; you can redistribute it and/or modify *
10 * it under the terms of the GNU General Public License as published by *
11 * the Free Software Foundation; either version 2 of the License, or *
12 * (at your option) any later version. *
14 * This program is distributed in the hope that it will be useful, *
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
17 * GNU General Public License for more details. *
19 * You should have received a copy of the GNU General Public License *
20 * along with this program; if not, write to the *
21 * Free Software Foundation, Inc., *
22 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
23 ***************************************************************************/
26 This version has optimized assembly routines for 32 bit operations:
29 - write array of words
31 One thing to be aware of is that the MIPS32 cpu will execute the
32 instruction after a branch instruction (one delay slot).
41 The LW $1, ($2 +100) instruction is also executed. If this is
42 not wanted a NOP can be inserted:
49 or the code can be changed to:
55 The original code contained NOPs. I have removed these and moved
58 I also moved the PRACC_STACK to 0xFF204000. This allows
59 the use of 16 bits offsets to get pointers to the input
60 and output area relative to the stack. Note that the stack
61 isn't really a stack (the stack pointer is not 'moving')
62 but a FIFO simulated in software.
64 These changes result in a 35% speed increase when programming an
67 More improvement could be gained if the registers do no need
68 to be preserved but in that case the routines should be aware
69 OpenOCD is used as a flash programmer or as a debug tool.
79 #include "mips32_pracc.h"
81 struct mips32_pracc_context
83 uint32_t *local_iparam
;
85 uint32_t *local_oparam
;
91 struct mips_ejtag
*ejtag_info
;
94 static int wait_for_pracc_rw(struct mips_ejtag
*ejtag_info
, uint32_t *ctrl
)
100 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
101 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
;
102 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
103 if (ejtag_ctrl
& EJTAG_CTRL_PRACC
)
105 LOG_DEBUG("DEBUGMODULE: No memory access in progress!\n");
106 return ERROR_JTAG_DEVICE_ERROR
;
113 static int mips32_pracc_exec_read(struct mips32_pracc_context
*ctx
, uint32_t address
)
115 struct mips_ejtag
*ejtag_info
= ctx
->ejtag_info
;
117 uint32_t ejtag_ctrl
, data
;
119 if ((address
>= MIPS32_PRACC_PARAM_IN
)
120 && (address
<= MIPS32_PRACC_PARAM_IN
+ ctx
->num_iparam
* 4))
122 offset
= (address
- MIPS32_PRACC_PARAM_IN
) / 4;
123 data
= ctx
->local_iparam
[offset
];
125 else if ((address
>= MIPS32_PRACC_PARAM_OUT
)
126 && (address
<= MIPS32_PRACC_PARAM_OUT
+ ctx
->num_oparam
* 4))
128 offset
= (address
- MIPS32_PRACC_PARAM_OUT
) / 4;
129 data
= ctx
->local_oparam
[offset
];
131 else if ((address
>= MIPS32_PRACC_TEXT
)
132 && (address
<= MIPS32_PRACC_TEXT
+ ctx
->code_len
*4))
134 offset
= (address
- MIPS32_PRACC_TEXT
) / 4;
135 data
= ctx
->code
[offset
];
137 else if (address
== MIPS32_PRACC_STACK
)
139 /* save to our debug stack */
140 data
= ctx
->stack
[--ctx
->stack_offset
];
144 /* TODO: send JMP 0xFF200000 instruction. Hopefully processor jump back
145 * to start of debug vector */
148 LOG_ERROR("Error reading unexpected address %8.8" PRIx32
"", address
);
149 return ERROR_JTAG_DEVICE_ERROR
;
152 /* Send the data out */
153 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_DATA
, NULL
);
154 mips_ejtag_drscan_32(ctx
->ejtag_info
, &data
);
156 /* Clear the access pending bit (let the processor eat!) */
158 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
& ~EJTAG_CTRL_PRACC
;
159 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
160 mips_ejtag_drscan_32(ctx
->ejtag_info
, &ejtag_ctrl
);
163 jtag_execute_queue();
168 static int mips32_pracc_exec_write(struct mips32_pracc_context
*ctx
, uint32_t address
)
170 uint32_t ejtag_ctrl
,data
;
172 struct mips_ejtag
*ejtag_info
= ctx
->ejtag_info
;
174 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_DATA
, NULL
);
175 mips_ejtag_drscan_32(ctx
->ejtag_info
, &data
);
177 /* Clear access pending bit */
178 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
& ~EJTAG_CTRL_PRACC
;
179 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
180 mips_ejtag_drscan_32(ctx
->ejtag_info
, &ejtag_ctrl
);
183 jtag_execute_queue();
185 if ((address
>= MIPS32_PRACC_PARAM_IN
)
186 && (address
<= MIPS32_PRACC_PARAM_IN
+ ctx
->num_iparam
* 4))
188 offset
= (address
- MIPS32_PRACC_PARAM_IN
) / 4;
189 ctx
->local_iparam
[offset
] = data
;
191 else if ((address
>= MIPS32_PRACC_PARAM_OUT
)
192 && (address
<= MIPS32_PRACC_PARAM_OUT
+ ctx
->num_oparam
* 4))
194 offset
= (address
- MIPS32_PRACC_PARAM_OUT
) / 4;
195 ctx
->local_oparam
[offset
] = data
;
197 else if (address
== MIPS32_PRACC_STACK
)
199 /* save data onto our stack */
200 ctx
->stack
[ctx
->stack_offset
++] = data
;
204 LOG_ERROR("Error writing unexpected address %8.8" PRIx32
"", address
);
205 return ERROR_JTAG_DEVICE_ERROR
;
211 int mips32_pracc_exec(struct mips_ejtag
*ejtag_info
, int code_len
, const uint32_t *code
, int num_param_in
, uint32_t *param_in
, int num_param_out
, uint32_t *param_out
, int cycle
)
214 uint32_t address
, data
;
215 struct mips32_pracc_context ctx
;
219 ctx
.local_iparam
= param_in
;
220 ctx
.local_oparam
= param_out
;
221 ctx
.num_iparam
= num_param_in
;
222 ctx
.num_oparam
= num_param_out
;
224 ctx
.code_len
= code_len
;
225 ctx
.ejtag_info
= ejtag_info
;
226 ctx
.stack_offset
= 0;
230 if ((retval
= wait_for_pracc_rw(ejtag_info
, &ejtag_ctrl
)) != ERROR_OK
)
234 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_ADDRESS
, NULL
);
235 mips_ejtag_drscan_32(ejtag_info
, &address
);
237 // printf("Adres: %.8x\n", address);
239 /* Check for read or write */
240 if (ejtag_ctrl
& EJTAG_CTRL_PRNW
)
242 if ((retval
= mips32_pracc_exec_write(&ctx
, address
)) != ERROR_OK
)
247 /* Check to see if its reading at the debug vector. The first pass through
248 * the module is always read at the vector, so the first one we allow. When
249 * the second read from the vector occurs we are done and just exit. */
250 if ((address
== MIPS32_PRACC_TEXT
) && (pass
++))
255 if ((retval
= mips32_pracc_exec_read(&ctx
, address
)) != ERROR_OK
)
263 /* stack sanity check */
264 if (ctx
.stack_offset
!= 0)
266 LOG_DEBUG("Pracc Stack not zero");
272 int mips32_pracc_read_mem(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int size
, int count
, void *buf
)
277 return mips32_pracc_read_mem8(ejtag_info
, addr
, count
, (uint8_t*)buf
);
279 return mips32_pracc_read_mem16(ejtag_info
, addr
, count
, (uint16_t*)buf
);
282 return mips32_pracc_read_u32(ejtag_info
, addr
, (uint32_t*)buf
);
284 return mips32_pracc_read_mem32(ejtag_info
, addr
, count
, (uint32_t*)buf
);
290 int mips32_pracc_read_mem32(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint32_t *buf
)
292 static const uint32_t code
[] = {
294 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
295 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
296 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
297 MIPS32_SW(8,0,15), /* sw $8,($15) */
298 MIPS32_SW(9,0,15), /* sw $9,($15) */
299 MIPS32_SW(10,0,15), /* sw $10,($15) */
300 MIPS32_SW(11,0,15), /* sw $11,($15) */
302 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
303 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
304 MIPS32_LW(9,0,8), /* $9 = mem[$8]; read addr */
305 MIPS32_LW(10,4,8), /* $10 = mem[$8 + 4]; read count */
306 MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $11 = MIPS32_PRACC_PARAM_OUT */
307 MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
310 MIPS32_BEQ(0,10,9), /* beq 0, $10, end */
313 MIPS32_LW(8,0,9), /* lw $8,0($9), Load $8 with the word @mem[$9] */
314 MIPS32_SW(8,0,11), /* sw $8,0($11) */
316 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
317 MIPS32_ADDI(9,9,4), /* $1 += 4 */
318 MIPS32_ADDI(11,11,4), /* $11 += 4 */
321 MIPS32_B(NEG16(9)), /* b loop */
324 MIPS32_LW(11,0,15), /* lw $11,($15) */
325 MIPS32_LW(10,0,15), /* lw $10,($15) */
326 MIPS32_LW(9,0,15), /* lw $9,($15) */
327 MIPS32_LW(8,0,15), /* lw $8,($15) */
328 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
330 MIPS32_B(NEG16(31)), /* b start */
334 int retval
= ERROR_OK
;
337 uint32_t param_in
[2];
348 param_in
[1] = blocksize
;
350 if ((retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
,
351 ARRAY_SIZE(param_in
), param_in
, blocksize
, &buf
[bytesread
], 1)) != ERROR_OK
)
358 bytesread
+= blocksize
;
364 int mips32_pracc_read_u32(struct mips_ejtag
*ejtag_info
, uint32_t addr
, uint32_t *buf
)
366 static const uint32_t code
[] = {
368 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
369 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
370 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
371 MIPS32_SW(8,0,15), /* sw $8,($15) */
373 MIPS32_LW(8,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
), 15), //load R8 @ param_in[0] = address
375 MIPS32_LW(8,0,8), /* lw $8,0($8), Load $8 with the word @mem[$8] */
376 MIPS32_SW(8,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_OUT
),15), /* sw $8,0($9) */
378 MIPS32_LW(8,0,15), /* lw $8,($15) */
379 MIPS32_B(NEG16(9)), //was 17 /* b start */
380 MIPS32_MFC0(15,31,0), //this instruction will be executed (MIPS executes instruction after jump) /* move COP0 DeSave to $15 */
384 int retval
= ERROR_OK
;
385 uint32_t param_in
[1];
389 if ((retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
,
390 ARRAY_SIZE(param_in
), param_in
, sizeof(uint32_t), buf
, 1)) != ERROR_OK
)
398 int mips32_pracc_read_mem16(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint16_t *buf
)
400 static const uint32_t code
[] = {
402 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
403 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
404 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
405 MIPS32_SW(8,0,15), /* sw $8,($15) */
406 MIPS32_SW(9,0,15), /* sw $9,($15) */
407 MIPS32_SW(10,0,15), /* sw $10,($15) */
408 MIPS32_SW(11,0,15), /* sw $11,($15) */
410 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
411 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
412 MIPS32_LW(9,0,8), /* $9 = mem[$8]; read addr */
413 MIPS32_LW(10,4,8), /* $10 = mem[$8 + 4]; read count */
414 MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $11 = MIPS32_PRACC_PARAM_OUT */
415 MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
418 MIPS32_BEQ(0,10,9), /* beq 0, $10, end */
421 MIPS32_LHU(8,0,9), /* lw $8,0($9), Load $8 with the halfword @mem[$9] */
422 MIPS32_SW(8,0,11), /* sw $8,0($11) */
424 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
425 MIPS32_ADDI(9,9,2), /* $9 += 2 */
426 MIPS32_ADDI(11,11,4), /* $11 += 4 */
428 MIPS32_B(NEG16(9)), /* b loop */
431 MIPS32_LW(11,0,15), /* lw $11,($15) */
432 MIPS32_LW(10,0,15), /* lw $10,($15) */
433 MIPS32_LW(9,0,15), /* lw $9,($15) */
434 MIPS32_LW(8,0,15), /* lw $8,($15) */
435 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
437 MIPS32_B(NEG16(31)), /* b start */
441 // /* TODO remove array */
442 uint32_t *param_out
= malloc(count
* sizeof(uint32_t));
448 uint32_t param_in
[2];
459 param_in
[1] = blocksize
;
461 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
462 ARRAY_SIZE(param_in
), param_in
, count
, param_out
, 1);
464 // count -= blocksize;
465 // addr += blocksize;
466 // bytesread += blocksize;
469 for (i
= 0; i
< count
; i
++)
471 buf
[i
] = param_out
[i
];
479 int mips32_pracc_read_mem8(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint8_t *buf
)
481 static const uint32_t code
[] = {
483 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
484 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
485 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
486 MIPS32_SW(8,0,15), /* sw $8,($15) */
487 MIPS32_SW(9,0,15), /* sw $9,($15) */
488 MIPS32_SW(10,0,15), /* sw $10,($15) */
489 MIPS32_SW(11,0,15), /* sw $11,($15) */
491 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
492 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
493 MIPS32_LW(9,0,8), /* $9 = mem[$8]; read addr */
494 MIPS32_LW(10,4,8), /* $10 = mem[$8 + 4]; read count */
495 MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $11 = MIPS32_PRACC_PARAM_OUT */
496 MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
499 MIPS32_BEQ(0,10,9), /* beq 0, $10, end */
502 MIPS32_LBU(8,0,9), /* lw $8,0($9), Load t4 with the byte @mem[t1] */
503 MIPS32_SW(8,0,11), /* sw $8,0($11) */
505 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
506 MIPS32_ADDI(9,9,1), /* $9 += 1 */
507 MIPS32_ADDI(11,11,4), /* $11 += 4 */
509 MIPS32_B(NEG16(9)), /* b loop */
512 MIPS32_LW(11,0,15), /* lw $11,($15) */
513 MIPS32_LW(10,0,15), /* lw $10,($15) */
514 MIPS32_LW(9,0,15), /* lw $9,($15) */
515 MIPS32_LW(8,0,15), /* lw $8,($15) */
516 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
518 MIPS32_B(NEG16(31)), /* b start */
522 // /* TODO remove array */
523 uint32_t *param_out
= malloc(count
* sizeof(uint32_t));
529 uint32_t param_in
[2];
540 param_in
[1] = blocksize
;
542 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
543 ARRAY_SIZE(param_in
), param_in
, count
, param_out
, 1);
545 // count -= blocksize;
546 // addr += blocksize;
547 // bytesread += blocksize;
550 for (i
= 0; i
< count
; i
++)
552 buf
[i
] = param_out
[i
];
560 int mips32_pracc_write_mem(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int size
, int count
, void *buf
)
565 return mips32_pracc_write_mem8(ejtag_info
, addr
, count
, (uint8_t*)buf
);
567 return mips32_pracc_write_mem16(ejtag_info
, addr
, count
,(uint16_t*)buf
);
570 return mips32_pracc_write_u32(ejtag_info
, addr
, (uint32_t*)buf
);
572 return mips32_pracc_write_mem32(ejtag_info
, addr
, count
, (uint32_t*)buf
);
578 int mips32_pracc_write_mem32(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint32_t *buf
)
581 //NC: use destination pointer as loop counter (last address is in $10)
582 static const uint32_t code
[] = {
584 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
585 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
586 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
587 MIPS32_SW(8,0,15), /* sw $8,($15) */
588 MIPS32_SW(9,0,15), /* sw $9,($15) */
589 MIPS32_SW(10,0,15), /* sw $10,($15) */
590 MIPS32_SW(11,0,15), /* sw $11,($15) */
592 MIPS32_ADDI(8,15,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
)), //$8= MIPS32_PRACC_PARAM_IN
593 MIPS32_LW(9,0,8), /* Load write addr to $9 */
594 MIPS32_LW(10,4,8), //last address /* Load write count to $10 */
595 MIPS32_ADDI(8,8,8), // $8 += 8 beginning of data
598 MIPS32_LW(11,0,8), /* lw $11,0($8), Load $11 with the word @mem[$8] */
599 MIPS32_SW(11,0,9), /* sw $11,0($9) */
601 MIPS32_ADDI(9,9,4), /* $9 += 4 */
602 MIPS32_BNE(10,9,NEG16(4)), //was 9 BNE $10, 9, loop /* b loop */
603 MIPS32_ADDI(8,8,4), //this instruction is part of the loop (one delay slot)! /* $8 += 4 */
605 MIPS32_LW(11,0,15), /* lw $11,($15) */
606 MIPS32_LW(10,0,15), /* lw $10,($15) */
607 MIPS32_LW(9,0,15), /* lw $9,($15) */
608 MIPS32_LW(8,0,15), /* lw $8,($15) */
609 MIPS32_B(NEG16(21)), //was 30 /* b start */
610 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
611 MIPS32_NOP
, //this one will not be executed
614 /* TODO remove array */
615 uint32_t *param_in
= malloc((count
+ 2) * sizeof(uint32_t));
617 param_in
[1] = addr
+ count
* sizeof(uint32_t); //last address
619 memcpy(¶m_in
[2], buf
, count
* sizeof(uint32_t));
621 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
622 count
+ 2, param_in
, 0, NULL
, 1);
629 int mips32_pracc_write_u32(struct mips_ejtag
*ejtag_info
, uint32_t addr
, uint32_t *buf
)
631 static const uint32_t code
[] = {
633 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
634 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
635 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
636 MIPS32_SW(8,0,15), /* sw $8,($15) */
637 MIPS32_SW(9,0,15), /* sw $9,($15) */
639 MIPS32_LW(8,NEG16((MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
)-4), 15), //load R8 @ param_in[1] = data
640 MIPS32_LW(9,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
), 15), //load R9 @ param_in[0] = address
642 MIPS32_SW(8,0,9), /* sw $8,0($9) */
644 MIPS32_LW(9,0,15), /* lw $9,($15) */
645 MIPS32_LW(8,0,15), /* lw $8,($15) */
646 MIPS32_B(NEG16(11)), /* b start */
647 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
651 /* TODO remove array */
652 uint32_t param_in
[1 + 1];
656 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
657 ARRAY_SIZE(param_in
),param_in
, 0, NULL
, 1);
662 int mips32_pracc_write_mem16(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint16_t *buf
)
664 static const uint32_t code
[] = {
666 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
667 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
668 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
669 MIPS32_SW(8,0,15), /* sw $8,($15) */
670 MIPS32_SW(9,0,15), /* sw $9,($15) */
671 MIPS32_SW(10,0,15), /* sw $10,($15) */
672 MIPS32_SW(11,0,15), /* sw $11,($15) */
674 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
675 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
676 MIPS32_LW(9,0,8), /* Load write addr to $9 */
677 MIPS32_LW(10,4,8), /* Load write count to $10 */
678 MIPS32_ADDI(8,8,8), /* $8 += 8 */
681 MIPS32_BEQ(0,10,9), /* beq $0, $10, end */
684 MIPS32_LW(11,0,8), /* lw $11,0($8), Load $11 with the word @mem[$8] */
685 MIPS32_SH(11,0,9), /* sh $11,0($9) */
687 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
688 MIPS32_ADDI(9,9,2), /* $9 += 2 */
689 MIPS32_ADDI(8,8,4), /* $8 += 4 */
692 MIPS32_B(NEG16(9)), /* b loop */
695 MIPS32_LW(11,0,15), /* lw $11,($15) */
696 MIPS32_LW(10,0,15), /* lw $10,($15) */
697 MIPS32_LW(9,0,15), /* lw $9,($15) */
698 MIPS32_LW(8,0,15), /* lw $8,($15) */
699 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
701 MIPS32_B(NEG16(30)), /* b start */
705 /* TODO remove array */
706 uint32_t *param_in
= malloc((count
+ 2) * sizeof(uint32_t));
711 for (i
= 0; i
< count
; i
++)
713 param_in
[i
+ 2] = buf
[i
];
716 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
717 count
+ 2, param_in
, 0, NULL
, 1);
724 int mips32_pracc_write_mem8(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint8_t *buf
)
726 static const uint32_t code
[] = {
728 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
729 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
730 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
731 MIPS32_SW(8,0,15), /* sw $8,($15) */
732 MIPS32_SW(9,0,15), /* sw $9,($15) */
733 MIPS32_SW(10,0,15), /* sw $10,($15) */
734 MIPS32_SW(11,0,15), /* sw $11,($15) */
736 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
737 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
738 MIPS32_LW(9,0,8), /* Load write addr to $9 */
739 MIPS32_LW(10,4,8), /* Load write count to $10 */
740 MIPS32_ADDI(8,8,8), /* $8 += 8 */
743 MIPS32_BEQ(0,10,9), /* beq $0, $10, end */
746 MIPS32_LW(11,0,8), /* lw $11,0($8), Load $11 with the word @mem[$8] */
747 MIPS32_SB(11,0,9), /* sb $11,0($9) */
749 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
750 MIPS32_ADDI(9,9,1), /* $9 += 1 */
751 MIPS32_ADDI(8,8,4), /* $8 += 4 */
754 MIPS32_B(NEG16(9)), /* b loop */
757 MIPS32_LW(11,0,15), /* lw $11,($15) */
758 MIPS32_LW(10,0,15), /* lw $10,($15) */
759 MIPS32_LW(9,0,15), /* lw $9,($15) */
760 MIPS32_LW(8,0,15), /* lw $8,($15) */
761 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
763 MIPS32_B(NEG16(30)), /* b start */
767 /* TODO remove array */
768 uint32_t *param_in
= malloc((count
+ 2) * sizeof(uint32_t));
774 for (i
= 0; i
< count
; i
++)
776 param_in
[i
+ 2] = buf
[i
];
779 retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
780 count
+2, param_in
, 0, NULL
, 1);
787 int mips32_pracc_write_regs(struct mips_ejtag
*ejtag_info
, uint32_t *regs
)
789 static const uint32_t code
[] = {
791 MIPS32_LUI(2,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $2 = MIPS32_PRACC_PARAM_IN */
792 MIPS32_ORI(2,2,LOWER16(MIPS32_PRACC_PARAM_IN
)),
793 MIPS32_LW(1,1*4,2), /* lw $1,1*4($2) */
794 MIPS32_LW(15,15*4,2), /* lw $15,15*4($2) */
795 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
796 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
797 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
798 MIPS32_SW(1,0,15), /* sw $1,($15) */
799 MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $1 = MIPS32_PRACC_PARAM_IN */
800 MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_IN
)),
801 MIPS32_LW(3,3*4,1), /* lw $3,3*4($1) */
802 MIPS32_LW(4,4*4,1), /* lw $4,4*4($1) */
803 MIPS32_LW(5,5*4,1), /* lw $5,5*4($1) */
804 MIPS32_LW(6,6*4,1), /* lw $6,6*4($1) */
805 MIPS32_LW(7,7*4,1), /* lw $7,7*4($1) */
806 MIPS32_LW(8,8*4,1), /* lw $8,8*4($1) */
807 MIPS32_LW(9,9*4,1), /* lw $9,9*4($1) */
808 MIPS32_LW(10,10*4,1), /* lw $10,10*4($1) */
809 MIPS32_LW(11,11*4,1), /* lw $11,11*4($1) */
810 MIPS32_LW(12,12*4,1), /* lw $12,12*4($1) */
811 MIPS32_LW(13,13*4,1), /* lw $13,13*4($1) */
812 MIPS32_LW(14,14*4,1), /* lw $14,14*4($1) */
813 MIPS32_LW(16,16*4,1), /* lw $16,16*4($1) */
814 MIPS32_LW(17,17*4,1), /* lw $17,17*4($1) */
815 MIPS32_LW(18,18*4,1), /* lw $18,18*4($1) */
816 MIPS32_LW(19,19*4,1), /* lw $19,19*4($1) */
817 MIPS32_LW(20,20*4,1), /* lw $20,20*4($1) */
818 MIPS32_LW(21,21*4,1), /* lw $21,21*4($1) */
819 MIPS32_LW(22,22*4,1), /* lw $22,22*4($1) */
820 MIPS32_LW(23,23*4,1), /* lw $23,23*4($1) */
821 MIPS32_LW(24,24*4,1), /* lw $24,24*4($1) */
822 MIPS32_LW(25,25*4,1), /* lw $25,25*4($1) */
823 MIPS32_LW(26,26*4,1), /* lw $26,26*4($1) */
824 MIPS32_LW(27,27*4,1), /* lw $27,27*4($1) */
825 MIPS32_LW(28,28*4,1), /* lw $28,28*4($1) */
826 MIPS32_LW(29,29*4,1), /* lw $29,29*4($1) */
827 MIPS32_LW(30,30*4,1), /* lw $30,30*4($1) */
828 MIPS32_LW(31,31*4,1), /* lw $31,31*4($1) */
830 MIPS32_LW(2,32*4,1), /* lw $2,32*4($1) */
831 MIPS32_MTC0(2,12,0), /* move $2 to status */
832 MIPS32_LW(2,33*4,1), /* lw $2,33*4($1) */
833 MIPS32_MTLO(2), /* move $2 to lo */
834 MIPS32_LW(2,34*4,1), /* lw $2,34*4($1) */
835 MIPS32_MTHI(2), /* move $2 to hi */
836 MIPS32_LW(2,35*4,1), /* lw $2,35*4($1) */
837 MIPS32_MTC0(2,8,0), /* move $2 to badvaddr */
838 MIPS32_LW(2,36*4,1), /* lw $2,36*4($1) */
839 MIPS32_MTC0(2,13,0), /* move $2 to cause*/
840 MIPS32_LW(2,37*4,1), /* lw $2,37*4($1) */
841 MIPS32_MTC0(2,24,0), /* move $2 to pc */
843 MIPS32_LW(2,2*4,1), /* lw $2,2*4($1) */
844 MIPS32_LW(1,0,15), /* lw $1,($15) */
845 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
847 MIPS32_B(NEG16(55)), /* b start */
853 retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
854 38, regs
, 0, NULL
, 1);
859 int mips32_pracc_read_regs(struct mips_ejtag
*ejtag_info
, uint32_t *regs
)
861 static const uint32_t code
[] = {
863 MIPS32_MTC0(2,31,0), /* move $2 to COP0 DeSave */
864 MIPS32_LUI(2,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $2 = MIPS32_PRACC_PARAM_OUT */
865 MIPS32_ORI(2,2,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
866 MIPS32_SW(0,0*4,2), /* sw $0,0*4($2) */
867 MIPS32_SW(1,1*4,2), /* sw $1,1*4($2) */
868 MIPS32_SW(15,15*4,2), /* sw $15,15*4($2) */
869 MIPS32_MFC0(2,31,0), /* move COP0 DeSave to $2 */
870 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
871 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
872 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
873 MIPS32_SW(1,0,15), /* sw $1,($15) */
874 MIPS32_SW(2,0,15), /* sw $2,($15) */
875 MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $1 = MIPS32_PRACC_PARAM_OUT */
876 MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
877 MIPS32_SW(2,2*4,1), /* sw $2,2*4($1) */
878 MIPS32_SW(3,3*4,1), /* sw $3,3*4($1) */
879 MIPS32_SW(4,4*4,1), /* sw $4,4*4($1) */
880 MIPS32_SW(5,5*4,1), /* sw $5,5*4($1) */
881 MIPS32_SW(6,6*4,1), /* sw $6,6*4($1) */
882 MIPS32_SW(7,7*4,1), /* sw $7,7*4($1) */
883 MIPS32_SW(8,8*4,1), /* sw $8,8*4($1) */
884 MIPS32_SW(9,9*4,1), /* sw $9,9*4($1) */
885 MIPS32_SW(10,10*4,1), /* sw $10,10*4($1) */
886 MIPS32_SW(11,11*4,1), /* sw $11,11*4($1) */
887 MIPS32_SW(12,12*4,1), /* sw $12,12*4($1) */
888 MIPS32_SW(13,13*4,1), /* sw $13,13*4($1) */
889 MIPS32_SW(14,14*4,1), /* sw $14,14*4($1) */
890 MIPS32_SW(16,16*4,1), /* sw $16,16*4($1) */
891 MIPS32_SW(17,17*4,1), /* sw $17,17*4($1) */
892 MIPS32_SW(18,18*4,1), /* sw $18,18*4($1) */
893 MIPS32_SW(19,19*4,1), /* sw $19,19*4($1) */
894 MIPS32_SW(20,20*4,1), /* sw $20,20*4($1) */
895 MIPS32_SW(21,21*4,1), /* sw $21,21*4($1) */
896 MIPS32_SW(22,22*4,1), /* sw $22,22*4($1) */
897 MIPS32_SW(23,23*4,1), /* sw $23,23*4($1) */
898 MIPS32_SW(24,24*4,1), /* sw $24,24*4($1) */
899 MIPS32_SW(25,25*4,1), /* sw $25,25*4($1) */
900 MIPS32_SW(26,26*4,1), /* sw $26,26*4($1) */
901 MIPS32_SW(27,27*4,1), /* sw $27,27*4($1) */
902 MIPS32_SW(28,28*4,1), /* sw $28,28*4($1) */
903 MIPS32_SW(29,29*4,1), /* sw $29,29*4($1) */
904 MIPS32_SW(30,30*4,1), /* sw $30,30*4($1) */
905 MIPS32_SW(31,31*4,1), /* sw $31,31*4($1) */
907 MIPS32_MFC0(2,12,0), /* move status to $2 */
908 MIPS32_SW(2,32*4,1), /* sw $2,32*4($1) */
909 MIPS32_MFLO(2), /* move lo to $2 */
910 MIPS32_SW(2,33*4,1), /* sw $2,33*4($1) */
911 MIPS32_MFHI(2), /* move hi to $2 */
912 MIPS32_SW(2,34*4,1), /* sw $2,34*4($1) */
913 MIPS32_MFC0(2,8,0), /* move badvaddr to $2 */
914 MIPS32_SW(2,35*4,1), /* sw $2,35*4($1) */
915 MIPS32_MFC0(2,13,0), /* move cause to $2 */
916 MIPS32_SW(2,36*4,1), /* sw $2,36*4($1) */
917 MIPS32_MFC0(2,24,0), /* move pc to $2 */
918 MIPS32_SW(2,37*4,1), /* sw $2,37*4($1) */
920 MIPS32_LW(2,0,15), /* lw $2,($15) */
921 MIPS32_LW(1,0,15), /* lw $1,($15) */
922 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
924 MIPS32_B(NEG16(60)), /* b start */
930 retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
931 0, NULL
, 38, regs
, 1);
936 /* fastdata upload/download requires an initialized working area
937 * to load the download code; it should not be called otherwise
938 * fetch order from the fastdata area
943 int mips32_pracc_fastdata_xfer(struct mips_ejtag
*ejtag_info
, struct working_area
*source
,
944 int write
, uint32_t addr
, int count
, uint32_t *buf
)
946 uint32_t handler_code
[] = {
947 /* caution when editing, table is modified below */
948 /* r15 points to the start of this code */
949 MIPS32_SW(8,MIPS32_FASTDATA_HANDLER_SIZE
- 4,15),
950 MIPS32_SW(9,MIPS32_FASTDATA_HANDLER_SIZE
- 8,15),
951 MIPS32_SW(10,MIPS32_FASTDATA_HANDLER_SIZE
- 12,15),
952 MIPS32_SW(11,MIPS32_FASTDATA_HANDLER_SIZE
- 16,15),
953 /* start of fastdata area in t0 */
954 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_FASTDATA_AREA
)),
955 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_FASTDATA_AREA
)),
956 MIPS32_LW(9,0,8), /* start addr in t1 */
957 MIPS32_LW(10,0,8), /* end addr to t2 */
959 /* 8 */ MIPS32_LW(11,0,0), /* lw t3,[t8 | r9] */
960 /* 9 */ MIPS32_SW(11,0,0), /* sw t3,[r9 | r8] */
961 MIPS32_BNE(10,9,NEG16(3)), /* bne $t2,t1,loop */
962 MIPS32_ADDI(9,9,4), /* addi t1,t1,4 */
964 MIPS32_LW(8,MIPS32_FASTDATA_HANDLER_SIZE
- 4,15),
965 MIPS32_LW(9,MIPS32_FASTDATA_HANDLER_SIZE
- 8,15),
966 MIPS32_LW(10,MIPS32_FASTDATA_HANDLER_SIZE
- 12,15),
967 MIPS32_LW(11,MIPS32_FASTDATA_HANDLER_SIZE
- 16,15),
969 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_TEXT
)),
970 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_TEXT
)),
971 MIPS32_JR(15), /* jr start */
972 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
976 uint32_t jmp_code
[] = {
977 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
978 /* 1 */ MIPS32_LUI(15,0), /* addr of working area added below */
979 /* 2 */ MIPS32_ORI(15,15,0), /* addr of working area added below */
980 MIPS32_JR(15), /* jump to ram program */
984 #define JMP_CODE_SIZE (sizeof(jmp_code)/sizeof(jmp_code[0]))
985 #define HANDLER_CODE_SIZE sizeof(handler_code)/sizeof(handler_code[0])
988 uint32_t val
, ejtag_ctrl
, address
;
990 if (source
->size
< MIPS32_FASTDATA_HANDLER_SIZE
)
991 return ERROR_TARGET_RESOURCE_NOT_AVAILABLE
;
995 handler_code
[8] = MIPS32_LW(11,0,8); /* load data from probe at fastdata area */
996 handler_code
[9] = MIPS32_SW(11,0,9); /* store data to RAM @ r9 */
1000 handler_code
[8] = MIPS32_LW(11,0,9); /* load data from RAM @ r9 */
1001 handler_code
[9] = MIPS32_SW(11,0,8); /* store data to probe at fastdata area */
1004 /* write program into RAM */
1005 mips32_pracc_write_mem32(ejtag_info
, source
->address
, HANDLER_CODE_SIZE
, handler_code
);
1007 /* quick verify RAM is working */
1008 mips32_pracc_read_u32(ejtag_info
, source
->address
, &val
);
1009 if (val
!= handler_code
[0])
1011 LOG_ERROR("fastdata handler verify failed\n");
1012 return ERROR_TARGET_RESOURCE_NOT_AVAILABLE
;
1015 LOG_INFO("%s using 0x%.8x for write handler\n", __func__
, source
->address
);
1017 jmp_code
[1] |= UPPER16(source
->address
);
1018 jmp_code
[2] |= LOWER16(source
->address
);
1020 for (i
= 0; i
< (int) JMP_CODE_SIZE
; i
++)
1022 if ((retval
= wait_for_pracc_rw(ejtag_info
, &ejtag_ctrl
)) != ERROR_OK
)
1025 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_DATA
, NULL
);
1026 mips_ejtag_drscan_32(ejtag_info
, &jmp_code
[i
]);
1028 /* Clear the access pending bit (let the processor eat!) */
1030 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
& ~EJTAG_CTRL_PRACC
;
1031 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
1032 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
1035 if ((retval
= wait_for_pracc_rw(ejtag_info
, &ejtag_ctrl
)) != ERROR_OK
)
1038 /* next fetch to dmseg should be in FASTDATA_AREA, check */
1040 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_ADDRESS
, NULL
);
1041 mips_ejtag_drscan_32(ejtag_info
, &address
);
1043 if (address
!= MIPS32_PRACC_FASTDATA_AREA
)
1046 /* Send the load start address */
1048 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_FASTDATA
, NULL
);
1049 mips_ejtag_fastdata_scan(ejtag_info
, 1, &val
);
1051 /* Send the load end address */
1052 val
= addr
+ (count
- 1) * 4;
1053 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_FASTDATA
, NULL
);
1054 mips_ejtag_fastdata_scan(ejtag_info
, 1, &val
);
1056 for (i
= 0; i
< count
; i
++)
1058 /* Send the data out using fastdata (clears the access pending bit) */
1059 if ((retval
= mips_ejtag_fastdata_scan(ejtag_info
, write
, buf
++)) != ERROR_OK
)
1063 if ((retval
= jtag_execute_queue()) != ERROR_OK
)
1065 LOG_ERROR("fastdata load failed");
1069 if ((retval
= wait_for_pracc_rw(ejtag_info
, &ejtag_ctrl
)) != ERROR_OK
)
1073 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_ADDRESS
, NULL
);
1074 mips_ejtag_drscan_32(ejtag_info
, &address
);
1076 if (address
!= MIPS32_PRACC_TEXT
)
1077 LOG_ERROR("mini program did not return to start\n");
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)