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).
40 The LW $1, ($2 +100) instruction is also executed. If this is
41 not wanted a NOP can be inserted:
48 or the code can be changed to:
54 The original code contained NOPs. I have removed these and moved
57 I also moved the PRACC_STACK to 0xFF204000. This allows
58 the use of 16 bits offsets to get pointers to the input
59 and output area relative to the stack. Note that the stack
60 isn't really a stack (the stack pointer is not 'moving')
61 but a FIFO simulated in software.
63 These changes result in a 35% speed increase when programming an
66 More improvement could be gained if the registers do no need
67 to be preserved but in that case the routines should be aware
68 OpenOCD is used as a flash programmer or as a debug tool.
78 #include "mips32_pracc.h"
80 struct mips32_pracc_context
82 uint32_t *local_iparam
;
84 uint32_t *local_oparam
;
90 struct mips_ejtag
*ejtag_info
;
93 static int wait_for_pracc_rw(struct mips_ejtag
*ejtag_info
, uint32_t *ctrl
)
99 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
100 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
;
101 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
102 if (ejtag_ctrl
& EJTAG_CTRL_PRACC
)
104 LOG_DEBUG("DEBUGMODULE: No memory access in progress!\n");
105 return ERROR_JTAG_DEVICE_ERROR
;
112 static int mips32_pracc_exec_read(struct mips32_pracc_context
*ctx
, uint32_t address
)
114 struct mips_ejtag
*ejtag_info
= ctx
->ejtag_info
;
116 uint32_t ejtag_ctrl
, data
;
118 if ((address
>= MIPS32_PRACC_PARAM_IN
)
119 && (address
<= MIPS32_PRACC_PARAM_IN
+ ctx
->num_iparam
* 4))
121 offset
= (address
- MIPS32_PRACC_PARAM_IN
) / 4;
122 data
= ctx
->local_iparam
[offset
];
124 else if ((address
>= MIPS32_PRACC_PARAM_OUT
)
125 && (address
<= MIPS32_PRACC_PARAM_OUT
+ ctx
->num_oparam
* 4))
127 offset
= (address
- MIPS32_PRACC_PARAM_OUT
) / 4;
128 data
= ctx
->local_oparam
[offset
];
130 else if ((address
>= MIPS32_PRACC_TEXT
)
131 && (address
<= MIPS32_PRACC_TEXT
+ ctx
->code_len
* 4))
133 offset
= (address
- MIPS32_PRACC_TEXT
) / 4;
134 data
= ctx
->code
[offset
];
136 else if (address
== MIPS32_PRACC_STACK
)
138 /* save to our debug stack */
139 data
= ctx
->stack
[--ctx
->stack_offset
];
143 /* TODO: send JMP 0xFF200000 instruction. Hopefully processor jump back
144 * to start of debug vector */
147 LOG_ERROR("Error reading unexpected address 0x%8.8" PRIx32
"", address
);
148 return ERROR_JTAG_DEVICE_ERROR
;
151 /* Send the data out */
152 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_DATA
, NULL
);
153 mips_ejtag_drscan_32(ctx
->ejtag_info
, &data
);
155 /* Clear the access pending bit (let the processor eat!) */
156 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
& ~EJTAG_CTRL_PRACC
;
157 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
158 mips_ejtag_drscan_32(ctx
->ejtag_info
, &ejtag_ctrl
);
161 jtag_execute_queue();
166 static int mips32_pracc_exec_write(struct mips32_pracc_context
*ctx
, uint32_t address
)
168 uint32_t ejtag_ctrl
,data
;
170 struct mips_ejtag
*ejtag_info
= ctx
->ejtag_info
;
172 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_DATA
, NULL
);
173 mips_ejtag_drscan_32(ctx
->ejtag_info
, &data
);
175 /* Clear access pending bit */
176 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
& ~EJTAG_CTRL_PRACC
;
177 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
178 mips_ejtag_drscan_32(ctx
->ejtag_info
, &ejtag_ctrl
);
181 jtag_execute_queue();
183 if ((address
>= MIPS32_PRACC_PARAM_IN
)
184 && (address
<= MIPS32_PRACC_PARAM_IN
+ ctx
->num_iparam
* 4))
186 offset
= (address
- MIPS32_PRACC_PARAM_IN
) / 4;
187 ctx
->local_iparam
[offset
] = data
;
189 else if ((address
>= MIPS32_PRACC_PARAM_OUT
)
190 && (address
<= MIPS32_PRACC_PARAM_OUT
+ ctx
->num_oparam
* 4))
192 offset
= (address
- MIPS32_PRACC_PARAM_OUT
) / 4;
193 ctx
->local_oparam
[offset
] = data
;
195 else if (address
== MIPS32_PRACC_STACK
)
197 /* save data onto our stack */
198 ctx
->stack
[ctx
->stack_offset
++] = data
;
202 LOG_ERROR("Error writing unexpected address 0x%8.8" PRIx32
"", address
);
203 return ERROR_JTAG_DEVICE_ERROR
;
209 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
)
212 uint32_t address
, data
;
213 struct mips32_pracc_context ctx
;
217 ctx
.local_iparam
= param_in
;
218 ctx
.local_oparam
= param_out
;
219 ctx
.num_iparam
= num_param_in
;
220 ctx
.num_oparam
= num_param_out
;
222 ctx
.code_len
= code_len
;
223 ctx
.ejtag_info
= ejtag_info
;
224 ctx
.stack_offset
= 0;
228 if ((retval
= wait_for_pracc_rw(ejtag_info
, &ejtag_ctrl
)) != ERROR_OK
)
232 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_ADDRESS
, NULL
);
233 mips_ejtag_drscan_32(ejtag_info
, &address
);
235 /* Check for read or write */
236 if (ejtag_ctrl
& EJTAG_CTRL_PRNW
)
238 if ((retval
= mips32_pracc_exec_write(&ctx
, address
)) != ERROR_OK
)
243 /* Check to see if its reading at the debug vector. The first pass through
244 * the module is always read at the vector, so the first one we allow. When
245 * the second read from the vector occurs we are done and just exit. */
246 if ((address
== MIPS32_PRACC_TEXT
) && (pass
++))
251 if ((retval
= mips32_pracc_exec_read(&ctx
, address
)) != ERROR_OK
)
259 /* stack sanity check */
260 if (ctx
.stack_offset
!= 0)
262 LOG_DEBUG("Pracc Stack not zero");
268 int mips32_pracc_read_mem(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int size
, int count
, void *buf
)
273 return mips32_pracc_read_mem8(ejtag_info
, addr
, count
, (uint8_t*)buf
);
275 return mips32_pracc_read_mem16(ejtag_info
, addr
, count
, (uint16_t*)buf
);
278 return mips32_pracc_read_u32(ejtag_info
, addr
, (uint32_t*)buf
);
280 return mips32_pracc_read_mem32(ejtag_info
, addr
, count
, (uint32_t*)buf
);
286 int mips32_pracc_read_mem32(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint32_t *buf
)
288 static const uint32_t code
[] = {
290 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
291 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
292 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
293 MIPS32_SW(8,0,15), /* sw $8,($15) */
294 MIPS32_SW(9,0,15), /* sw $9,($15) */
295 MIPS32_SW(10,0,15), /* sw $10,($15) */
296 MIPS32_SW(11,0,15), /* sw $11,($15) */
298 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
299 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
300 MIPS32_LW(9,0,8), /* $9 = mem[$8]; read addr */
301 MIPS32_LW(10,4,8), /* $10 = mem[$8 + 4]; read count */
302 MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $11 = MIPS32_PRACC_PARAM_OUT */
303 MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
305 MIPS32_BEQ(0,10,8), /* beq 0, $10, end */
308 MIPS32_LW(8,0,9), /* lw $8,0($9), Load $8 with the word @mem[$9] */
309 MIPS32_SW(8,0,11), /* sw $8,0($11) */
311 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
312 MIPS32_ADDI(9,9,4), /* $1 += 4 */
313 MIPS32_ADDI(11,11,4), /* $11 += 4 */
315 MIPS32_B(NEG16(8)), /* b loop */
318 MIPS32_LW(11,0,15), /* lw $11,($15) */
319 MIPS32_LW(10,0,15), /* lw $10,($15) */
320 MIPS32_LW(9,0,15), /* lw $9,($15) */
321 MIPS32_LW(8,0,15), /* lw $8,($15) */
322 MIPS32_B(NEG16(27)), /* b start */
323 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
326 int retval
= ERROR_OK
;
329 uint32_t param_in
[2];
340 param_in
[1] = blocksize
;
342 if ((retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
,
343 ARRAY_SIZE(param_in
), param_in
, blocksize
, &buf
[bytesread
], 1)) != ERROR_OK
)
350 bytesread
+= blocksize
;
356 int mips32_pracc_read_u32(struct mips_ejtag
*ejtag_info
, uint32_t addr
, uint32_t *buf
)
358 static const uint32_t code
[] = {
360 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
361 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
362 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
363 MIPS32_SW(8,0,15), /* sw $8,($15) */
365 MIPS32_LW(8,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
),15), /* load R8 @ param_in[0] = address */
367 MIPS32_LW(8,0,8), /* lw $8,0($8), Load $8 with the word @mem[$8] */
368 MIPS32_SW(8,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_OUT
),15), /* store R8 @ param_out[0] */
370 MIPS32_LW(8,0,15), /* lw $8,($15) */
371 MIPS32_B(NEG16(9)), /* b start */
372 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
375 int retval
= ERROR_OK
;
376 uint32_t param_in
[1];
380 if ((retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
,
381 ARRAY_SIZE(param_in
), param_in
, 1, buf
, 1)) != ERROR_OK
)
389 int mips32_pracc_read_mem16(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint16_t *buf
)
391 static const uint32_t code
[] = {
393 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
394 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
395 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
396 MIPS32_SW(8,0,15), /* sw $8,($15) */
397 MIPS32_SW(9,0,15), /* sw $9,($15) */
398 MIPS32_SW(10,0,15), /* sw $10,($15) */
399 MIPS32_SW(11,0,15), /* sw $11,($15) */
401 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
402 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
403 MIPS32_LW(9,0,8), /* $9 = mem[$8]; read addr */
404 MIPS32_LW(10,4,8), /* $10 = mem[$8 + 4]; read count */
405 MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $11 = MIPS32_PRACC_PARAM_OUT */
406 MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
408 MIPS32_BEQ(0,10,8), /* beq 0, $10, end */
411 MIPS32_LHU(8,0,9), /* lw $8,0($9), Load $8 with the halfword @mem[$9] */
412 MIPS32_SW(8,0,11), /* sw $8,0($11) */
414 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
415 MIPS32_ADDI(9,9,2), /* $9 += 2 */
416 MIPS32_ADDI(11,11,4), /* $11 += 4 */
417 MIPS32_B(NEG16(8)), /* b loop */
420 MIPS32_LW(11,0,15), /* lw $11,($15) */
421 MIPS32_LW(10,0,15), /* lw $10,($15) */
422 MIPS32_LW(9,0,15), /* lw $9,($15) */
423 MIPS32_LW(8,0,15), /* lw $8,($15) */
424 MIPS32_B(NEG16(27)), /* b start */
425 MIPS32_MFC0(15,30,0), /* move COP0 DeSave to $15 */
428 /* TODO remove array */
429 uint32_t *param_out
= malloc(count
* sizeof(uint32_t));
435 uint32_t param_in
[2];
446 param_in
[1] = blocksize
;
448 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
449 ARRAY_SIZE(param_in
), param_in
, count
, param_out
, 1);
451 // count -= blocksize;
452 // addr += blocksize;
453 // bytesread += blocksize;
456 for (i
= 0; i
< count
; i
++)
458 buf
[i
] = param_out
[i
];
466 int mips32_pracc_read_mem8(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint8_t *buf
)
468 static const uint32_t code
[] = {
470 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
471 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
472 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
473 MIPS32_SW(8,0,15), /* sw $8,($15) */
474 MIPS32_SW(9,0,15), /* sw $9,($15) */
475 MIPS32_SW(10,0,15), /* sw $10,($15) */
476 MIPS32_SW(11,0,15), /* sw $11,($15) */
478 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
479 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
480 MIPS32_LW(9,0,8), /* $9 = mem[$8]; read addr */
481 MIPS32_LW(10,4,8), /* $10 = mem[$8 + 4]; read count */
482 MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $11 = MIPS32_PRACC_PARAM_OUT */
483 MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
485 MIPS32_BEQ(0,10,8), /* beq 0, $10, end */
488 MIPS32_LBU(8,0,9), /* lw $8,0($9), Load t4 with the byte @mem[t1] */
489 MIPS32_SW(8,0,11), /* sw $8,0($11) */
491 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
492 MIPS32_ADDI(9,9,1), /* $9 += 1 */
493 MIPS32_ADDI(11,11,4), /* $11 += 4 */
494 MIPS32_B(NEG16(8)), /* b loop */
497 MIPS32_LW(11,0,15), /* lw $11,($15) */
498 MIPS32_LW(10,0,15), /* lw $10,($15) */
499 MIPS32_LW(9,0,15), /* lw $9,($15) */
500 MIPS32_LW(8,0,15), /* lw $8,($15) */
501 MIPS32_B(NEG16(27)), /* b start */
502 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
505 /* TODO remove array */
506 uint32_t *param_out
= malloc(count
* sizeof(uint32_t));
512 uint32_t param_in
[2];
523 param_in
[1] = blocksize
;
525 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
526 ARRAY_SIZE(param_in
), param_in
, count
, param_out
, 1);
528 // count -= blocksize;
529 // addr += blocksize;
530 // bytesread += blocksize;
533 for (i
= 0; i
< count
; i
++)
535 buf
[i
] = param_out
[i
];
543 int mips32_pracc_write_mem(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int size
, int count
, void *buf
)
548 return mips32_pracc_write_mem8(ejtag_info
, addr
, count
, (uint8_t*)buf
);
550 return mips32_pracc_write_mem16(ejtag_info
, addr
, count
,(uint16_t*)buf
);
553 return mips32_pracc_write_u32(ejtag_info
, addr
, (uint32_t*)buf
);
555 return mips32_pracc_write_mem32(ejtag_info
, addr
, count
, (uint32_t*)buf
);
561 int mips32_pracc_write_mem32(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint32_t *buf
)
563 static const uint32_t code
[] = {
565 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
566 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
567 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
568 MIPS32_SW(8,0,15), /* sw $8,($15) */
569 MIPS32_SW(9,0,15), /* sw $9,($15) */
570 MIPS32_SW(10,0,15), /* sw $10,($15) */
571 MIPS32_SW(11,0,15), /* sw $11,($15) */
573 MIPS32_ADDI(8,15,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
)), /* $8= MIPS32_PRACC_PARAM_IN */
574 MIPS32_LW(9,0,8), /* Load write addr to $9 */
575 MIPS32_LW(10,4,8), /* Load write count to $10 */
576 MIPS32_ADDI(8,8,8), /* $8 += 8 beginning of data */
579 MIPS32_LW(11,0,8), /* lw $11,0($8), Load $11 with the word @mem[$8] */
580 MIPS32_SW(11,0,9), /* sw $11,0($9) */
582 MIPS32_ADDI(9,9,4), /* $9 += 4 */
583 MIPS32_BNE(10,9,NEG16(4)), /* bne $10, $9, loop */
584 MIPS32_ADDI(8,8,4), /* $8 += 4 */
587 MIPS32_LW(11,0,15), /* lw $11,($15) */
588 MIPS32_LW(10,0,15), /* lw $10,($15) */
589 MIPS32_LW(9,0,15), /* lw $9,($15) */
590 MIPS32_LW(8,0,15), /* lw $8,($15) */
591 MIPS32_B(NEG16(21)), /* b start */
592 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
595 /* TODO remove array */
596 uint32_t *param_in
= malloc((count
+ 2) * sizeof(uint32_t));
598 param_in
[1] = addr
+ (count
* sizeof(uint32_t)); /* last address */
600 memcpy(¶m_in
[2], buf
, count
* sizeof(uint32_t));
602 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
603 count
+ 2, param_in
, 0, NULL
, 1);
610 int mips32_pracc_write_u32(struct mips_ejtag
*ejtag_info
, uint32_t addr
, uint32_t *buf
)
612 static const uint32_t code
[] = {
614 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
615 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
616 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
617 MIPS32_SW(8,0,15), /* sw $8,($15) */
618 MIPS32_SW(9,0,15), /* sw $9,($15) */
620 MIPS32_LW(8,NEG16((MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
)-4), 15), /* load R8 @ param_in[1] = data */
621 MIPS32_LW(9,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
), 15), /* load R9 @ param_in[0] = address */
623 MIPS32_SW(8,0,9), /* sw $8,0($9) */
625 MIPS32_LW(9,0,15), /* lw $9,($15) */
626 MIPS32_LW(8,0,15), /* lw $8,($15) */
627 MIPS32_B(NEG16(11)), /* b start */
628 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
631 /* TODO remove array */
632 uint32_t param_in
[1 + 1];
636 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
637 ARRAY_SIZE(param_in
), param_in
, 0, NULL
, 1);
642 int mips32_pracc_write_mem16(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint16_t *buf
)
644 static const uint32_t code
[] = {
646 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
647 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
648 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
649 MIPS32_SW(8,0,15), /* sw $8,($15) */
650 MIPS32_SW(9,0,15), /* sw $9,($15) */
651 MIPS32_SW(10,0,15), /* sw $10,($15) */
652 MIPS32_SW(11,0,15), /* sw $11,($15) */
654 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
655 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
656 MIPS32_LW(9,0,8), /* Load write addr to $9 */
657 MIPS32_LW(10,4,8), /* Load write count to $10 */
658 MIPS32_ADDI(8,8,8), /* $8 += 8 */
660 MIPS32_BEQ(0,10,8), /* beq $0, $10, end */
663 MIPS32_LW(11,0,8), /* lw $11,0($8), Load $11 with the word @mem[$8] */
664 MIPS32_SH(11,0,9), /* sh $11,0($9) */
666 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
667 MIPS32_ADDI(9,9,2), /* $9 += 2 */
668 MIPS32_ADDI(8,8,4), /* $8 += 4 */
670 MIPS32_B(NEG16(8)), /* b loop */
673 MIPS32_LW(11,0,15), /* lw $11,($15) */
674 MIPS32_LW(10,0,15), /* lw $10,($15) */
675 MIPS32_LW(9,0,15), /* lw $9,($15) */
676 MIPS32_LW(8,0,15), /* lw $8,($15) */
677 MIPS32_B(NEG16(26)), /* b start */
678 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
681 /* TODO remove array */
682 uint32_t *param_in
= malloc((count
+ 2) * sizeof(uint32_t));
687 for (i
= 0; i
< count
; i
++)
689 param_in
[i
+ 2] = buf
[i
];
692 mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
693 count
+ 2, param_in
, 0, NULL
, 1);
700 int mips32_pracc_write_mem8(struct mips_ejtag
*ejtag_info
, uint32_t addr
, int count
, uint8_t *buf
)
702 static const uint32_t code
[] = {
704 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
705 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
706 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
707 MIPS32_SW(8,0,15), /* sw $8,($15) */
708 MIPS32_SW(9,0,15), /* sw $9,($15) */
709 MIPS32_SW(10,0,15), /* sw $10,($15) */
710 MIPS32_SW(11,0,15), /* sw $11,($15) */
712 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
713 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
714 MIPS32_LW(9,0,8), /* Load write addr to $9 */
715 MIPS32_LW(10,4,8), /* Load write count to $10 */
716 MIPS32_ADDI(8,8,8), /* $8 += 8 */
718 MIPS32_BEQ(0,10,8), /* beq $0, $10, end */
721 MIPS32_LW(11,0,8), /* lw $11,0($8), Load $11 with the word @mem[$8] */
722 MIPS32_SB(11,0,9), /* sb $11,0($9) */
724 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
725 MIPS32_ADDI(9,9,1), /* $9 += 1 */
726 MIPS32_ADDI(8,8,4), /* $8 += 4 */
728 MIPS32_B(NEG16(8)), /* b loop */
731 MIPS32_LW(11,0,15), /* lw $11,($15) */
732 MIPS32_LW(10,0,15), /* lw $10,($15) */
733 MIPS32_LW(9,0,15), /* lw $9,($15) */
734 MIPS32_LW(8,0,15), /* lw $8,($15) */
735 MIPS32_B(NEG16(26)), /* b start */
736 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
739 /* TODO remove array */
740 uint32_t *param_in
= malloc((count
+ 2) * sizeof(uint32_t));
746 for (i
= 0; i
< count
; i
++)
748 param_in
[i
+ 2] = buf
[i
];
751 retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
752 count
+ 2, param_in
, 0, NULL
, 1);
759 int mips32_pracc_write_regs(struct mips_ejtag
*ejtag_info
, uint32_t *regs
)
761 static const uint32_t code
[] = {
763 MIPS32_LUI(2,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $2 = MIPS32_PRACC_PARAM_IN */
764 MIPS32_ORI(2,2,LOWER16(MIPS32_PRACC_PARAM_IN
)),
765 MIPS32_LW(1,1*4,2), /* lw $1,1*4($2) */
766 MIPS32_LW(15,15*4,2), /* lw $15,15*4($2) */
767 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
768 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
769 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
770 MIPS32_SW(1,0,15), /* sw $1,($15) */
771 MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $1 = MIPS32_PRACC_PARAM_IN */
772 MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_IN
)),
773 MIPS32_LW(3,3*4,1), /* lw $3,3*4($1) */
774 MIPS32_LW(4,4*4,1), /* lw $4,4*4($1) */
775 MIPS32_LW(5,5*4,1), /* lw $5,5*4($1) */
776 MIPS32_LW(6,6*4,1), /* lw $6,6*4($1) */
777 MIPS32_LW(7,7*4,1), /* lw $7,7*4($1) */
778 MIPS32_LW(8,8*4,1), /* lw $8,8*4($1) */
779 MIPS32_LW(9,9*4,1), /* lw $9,9*4($1) */
780 MIPS32_LW(10,10*4,1), /* lw $10,10*4($1) */
781 MIPS32_LW(11,11*4,1), /* lw $11,11*4($1) */
782 MIPS32_LW(12,12*4,1), /* lw $12,12*4($1) */
783 MIPS32_LW(13,13*4,1), /* lw $13,13*4($1) */
784 MIPS32_LW(14,14*4,1), /* lw $14,14*4($1) */
785 MIPS32_LW(16,16*4,1), /* lw $16,16*4($1) */
786 MIPS32_LW(17,17*4,1), /* lw $17,17*4($1) */
787 MIPS32_LW(18,18*4,1), /* lw $18,18*4($1) */
788 MIPS32_LW(19,19*4,1), /* lw $19,19*4($1) */
789 MIPS32_LW(20,20*4,1), /* lw $20,20*4($1) */
790 MIPS32_LW(21,21*4,1), /* lw $21,21*4($1) */
791 MIPS32_LW(22,22*4,1), /* lw $22,22*4($1) */
792 MIPS32_LW(23,23*4,1), /* lw $23,23*4($1) */
793 MIPS32_LW(24,24*4,1), /* lw $24,24*4($1) */
794 MIPS32_LW(25,25*4,1), /* lw $25,25*4($1) */
795 MIPS32_LW(26,26*4,1), /* lw $26,26*4($1) */
796 MIPS32_LW(27,27*4,1), /* lw $27,27*4($1) */
797 MIPS32_LW(28,28*4,1), /* lw $28,28*4($1) */
798 MIPS32_LW(29,29*4,1), /* lw $29,29*4($1) */
799 MIPS32_LW(30,30*4,1), /* lw $30,30*4($1) */
800 MIPS32_LW(31,31*4,1), /* lw $31,31*4($1) */
802 MIPS32_LW(2,32*4,1), /* lw $2,32*4($1) */
803 MIPS32_MTC0(2,12,0), /* move $2 to status */
804 MIPS32_LW(2,33*4,1), /* lw $2,33*4($1) */
805 MIPS32_MTLO(2), /* move $2 to lo */
806 MIPS32_LW(2,34*4,1), /* lw $2,34*4($1) */
807 MIPS32_MTHI(2), /* move $2 to hi */
808 MIPS32_LW(2,35*4,1), /* lw $2,35*4($1) */
809 MIPS32_MTC0(2,8,0), /* move $2 to badvaddr */
810 MIPS32_LW(2,36*4,1), /* lw $2,36*4($1) */
811 MIPS32_MTC0(2,13,0), /* move $2 to cause*/
812 MIPS32_LW(2,37*4,1), /* lw $2,37*4($1) */
813 MIPS32_MTC0(2,24,0), /* move $2 to depc (pc) */
815 MIPS32_LW(2,2*4,1), /* lw $2,2*4($1) */
816 MIPS32_LW(1,0,15), /* lw $1,($15) */
817 MIPS32_B(NEG16(53)), /* b start */
818 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
823 retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
824 MIPS32NUMCOREREGS
, regs
, 0, NULL
, 1);
829 int mips32_pracc_read_regs(struct mips_ejtag
*ejtag_info
, uint32_t *regs
)
831 static const uint32_t code
[] = {
833 MIPS32_MTC0(2,31,0), /* move $2 to COP0 DeSave */
834 MIPS32_LUI(2,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $2 = MIPS32_PRACC_PARAM_OUT */
835 MIPS32_ORI(2,2,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
836 MIPS32_SW(0,0*4,2), /* sw $0,0*4($2) */
837 MIPS32_SW(1,1*4,2), /* sw $1,1*4($2) */
838 MIPS32_SW(15,15*4,2), /* sw $15,15*4($2) */
839 MIPS32_MFC0(2,31,0), /* move COP0 DeSave to $2 */
840 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
841 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
842 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
843 MIPS32_SW(1,0,15), /* sw $1,($15) */
844 MIPS32_SW(2,0,15), /* sw $2,($15) */
845 MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $1 = MIPS32_PRACC_PARAM_OUT */
846 MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
847 MIPS32_SW(2,2*4,1), /* sw $2,2*4($1) */
848 MIPS32_SW(3,3*4,1), /* sw $3,3*4($1) */
849 MIPS32_SW(4,4*4,1), /* sw $4,4*4($1) */
850 MIPS32_SW(5,5*4,1), /* sw $5,5*4($1) */
851 MIPS32_SW(6,6*4,1), /* sw $6,6*4($1) */
852 MIPS32_SW(7,7*4,1), /* sw $7,7*4($1) */
853 MIPS32_SW(8,8*4,1), /* sw $8,8*4($1) */
854 MIPS32_SW(9,9*4,1), /* sw $9,9*4($1) */
855 MIPS32_SW(10,10*4,1), /* sw $10,10*4($1) */
856 MIPS32_SW(11,11*4,1), /* sw $11,11*4($1) */
857 MIPS32_SW(12,12*4,1), /* sw $12,12*4($1) */
858 MIPS32_SW(13,13*4,1), /* sw $13,13*4($1) */
859 MIPS32_SW(14,14*4,1), /* sw $14,14*4($1) */
860 MIPS32_SW(16,16*4,1), /* sw $16,16*4($1) */
861 MIPS32_SW(17,17*4,1), /* sw $17,17*4($1) */
862 MIPS32_SW(18,18*4,1), /* sw $18,18*4($1) */
863 MIPS32_SW(19,19*4,1), /* sw $19,19*4($1) */
864 MIPS32_SW(20,20*4,1), /* sw $20,20*4($1) */
865 MIPS32_SW(21,21*4,1), /* sw $21,21*4($1) */
866 MIPS32_SW(22,22*4,1), /* sw $22,22*4($1) */
867 MIPS32_SW(23,23*4,1), /* sw $23,23*4($1) */
868 MIPS32_SW(24,24*4,1), /* sw $24,24*4($1) */
869 MIPS32_SW(25,25*4,1), /* sw $25,25*4($1) */
870 MIPS32_SW(26,26*4,1), /* sw $26,26*4($1) */
871 MIPS32_SW(27,27*4,1), /* sw $27,27*4($1) */
872 MIPS32_SW(28,28*4,1), /* sw $28,28*4($1) */
873 MIPS32_SW(29,29*4,1), /* sw $29,29*4($1) */
874 MIPS32_SW(30,30*4,1), /* sw $30,30*4($1) */
875 MIPS32_SW(31,31*4,1), /* sw $31,31*4($1) */
877 MIPS32_MFC0(2,12,0), /* move status to $2 */
878 MIPS32_SW(2,32*4,1), /* sw $2,32*4($1) */
879 MIPS32_MFLO(2), /* move lo to $2 */
880 MIPS32_SW(2,33*4,1), /* sw $2,33*4($1) */
881 MIPS32_MFHI(2), /* move hi to $2 */
882 MIPS32_SW(2,34*4,1), /* sw $2,34*4($1) */
883 MIPS32_MFC0(2,8,0), /* move badvaddr to $2 */
884 MIPS32_SW(2,35*4,1), /* sw $2,35*4($1) */
885 MIPS32_MFC0(2,13,0), /* move cause to $2 */
886 MIPS32_SW(2,36*4,1), /* sw $2,36*4($1) */
887 MIPS32_MFC0(2,24,0), /* move depc (pc) to $2 */
888 MIPS32_SW(2,37*4,1), /* sw $2,37*4($1) */
890 MIPS32_LW(2,0,15), /* lw $2,($15) */
891 MIPS32_LW(1,0,15), /* lw $1,($15) */
892 MIPS32_B(NEG16(58)), /* b start */
893 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
898 retval
= mips32_pracc_exec(ejtag_info
, ARRAY_SIZE(code
), code
, \
899 0, NULL
, MIPS32NUMCOREREGS
, regs
, 1);
904 /* fastdata upload/download requires an initialized working area
905 * to load the download code; it should not be called otherwise
906 * fetch order from the fastdata area
911 int mips32_pracc_fastdata_xfer(struct mips_ejtag
*ejtag_info
, struct working_area
*source
,
912 int write
, uint32_t addr
, int count
, uint32_t *buf
)
914 uint32_t handler_code
[] = {
915 /* caution when editing, table is modified below */
916 /* r15 points to the start of this code */
917 MIPS32_SW(8,MIPS32_FASTDATA_HANDLER_SIZE
- 4,15),
918 MIPS32_SW(9,MIPS32_FASTDATA_HANDLER_SIZE
- 8,15),
919 MIPS32_SW(10,MIPS32_FASTDATA_HANDLER_SIZE
- 12,15),
920 MIPS32_SW(11,MIPS32_FASTDATA_HANDLER_SIZE
- 16,15),
921 /* start of fastdata area in t0 */
922 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_FASTDATA_AREA
)),
923 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_FASTDATA_AREA
)),
924 MIPS32_LW(9,0,8), /* start addr in t1 */
925 MIPS32_LW(10,0,8), /* end addr to t2 */
927 /* 8 */ MIPS32_LW(11,0,0), /* lw t3,[t8 | r9] */
928 /* 9 */ MIPS32_SW(11,0,0), /* sw t3,[r9 | r8] */
929 MIPS32_BNE(10,9,NEG16(3)), /* bne $t2,t1,loop */
930 MIPS32_ADDI(9,9,4), /* addi t1,t1,4 */
932 MIPS32_LW(8,MIPS32_FASTDATA_HANDLER_SIZE
- 4,15),
933 MIPS32_LW(9,MIPS32_FASTDATA_HANDLER_SIZE
- 8,15),
934 MIPS32_LW(10,MIPS32_FASTDATA_HANDLER_SIZE
- 12,15),
935 MIPS32_LW(11,MIPS32_FASTDATA_HANDLER_SIZE
- 16,15),
937 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_TEXT
)),
938 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_TEXT
)),
939 MIPS32_JR(15), /* jr start */
940 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
943 uint32_t jmp_code
[] = {
944 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
945 /* 1 */ MIPS32_LUI(15,0), /* addr of working area added below */
946 /* 2 */ MIPS32_ORI(15,15,0), /* addr of working area added below */
947 MIPS32_JR(15), /* jump to ram program */
952 uint32_t val
, ejtag_ctrl
, address
;
954 if (source
->size
< MIPS32_FASTDATA_HANDLER_SIZE
)
955 return ERROR_TARGET_RESOURCE_NOT_AVAILABLE
;
959 handler_code
[8] = MIPS32_LW(11,0,8); /* load data from probe at fastdata area */
960 handler_code
[9] = MIPS32_SW(11,0,9); /* store data to RAM @ r9 */
964 handler_code
[8] = MIPS32_LW(11,0,9); /* load data from RAM @ r9 */
965 handler_code
[9] = MIPS32_SW(11,0,8); /* store data to probe at fastdata area */
968 /* write program into RAM */
969 mips32_pracc_write_mem32(ejtag_info
, source
->address
, ARRAY_SIZE(handler_code
), handler_code
);
971 LOG_DEBUG("%s using 0x%.8" PRIx32
" for write handler\n", __func__
, source
->address
);
973 jmp_code
[1] |= UPPER16(source
->address
);
974 jmp_code
[2] |= LOWER16(source
->address
);
976 for (i
= 0; i
< (int) ARRAY_SIZE(jmp_code
); i
++)
978 if ((retval
= wait_for_pracc_rw(ejtag_info
, &ejtag_ctrl
)) != ERROR_OK
)
981 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_DATA
, NULL
);
982 mips_ejtag_drscan_32(ejtag_info
, &jmp_code
[i
]);
984 /* Clear the access pending bit (let the processor eat!) */
985 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
& ~EJTAG_CTRL_PRACC
;
986 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
987 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
990 if ((retval
= wait_for_pracc_rw(ejtag_info
, &ejtag_ctrl
)) != ERROR_OK
)
993 /* next fetch to dmseg should be in FASTDATA_AREA, check */
995 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_ADDRESS
, NULL
);
996 mips_ejtag_drscan_32(ejtag_info
, &address
);
998 if (address
!= MIPS32_PRACC_FASTDATA_AREA
)
1001 /* Send the load start address */
1003 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_FASTDATA
, NULL
);
1004 mips_ejtag_fastdata_scan(ejtag_info
, 1, &val
);
1006 /* Send the load end address */
1007 val
= addr
+ (count
- 1) * 4;
1008 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_FASTDATA
, NULL
);
1009 mips_ejtag_fastdata_scan(ejtag_info
, 1, &val
);
1011 for (i
= 0; i
< count
; i
++)
1013 /* Send the data out using fastdata (clears the access pending bit) */
1014 if ((retval
= mips_ejtag_fastdata_scan(ejtag_info
, write
, buf
++)) != ERROR_OK
)
1018 if ((retval
= jtag_execute_queue()) != ERROR_OK
)
1020 LOG_ERROR("fastdata load failed");
1024 if ((retval
= wait_for_pracc_rw(ejtag_info
, &ejtag_ctrl
)) != ERROR_OK
)
1028 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_ADDRESS
, NULL
);
1029 mips_ejtag_drscan_32(ejtag_info
, &address
);
1031 if (address
!= MIPS32_PRACC_TEXT
)
1032 LOG_ERROR("mini program did not return to start\n");