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 ***************************************************************************/
24 This version has optimized assembly routines for 32 bit operations:
27 - write array of words
29 One thing to be aware of is that the MIPS32 cpu will execute the
30 instruction after a branch instruction (one delay slot).
39 The LW $1, ($2 +100) instruction is also executed. If this is
40 not wanted a NOP can be inserted:
47 or the code can be changed to:
53 The original code contained NOPs. I have removed these and moved
56 I also moved the PRACC_STACK to 0xFF204000. This allows
57 the use of 16 bits offsets to get pointers to the input
58 and output area relative to the stack. Note that the stack
59 isn't really a stack (the stack pointer is not 'moving')
60 but a FIFO simulated in software.
62 These changes result in a 35% speed increase when programming an
65 More improvement could be gained if the registers do no need
66 to be preserved but in that case the routines should be aware
67 OpenOCD is used as a flash programmer or as a debug tool.
78 #include "mips32_pracc.h"
81 uint32_t *local_iparam
;
83 uint32_t *local_oparam
;
89 mips_ejtag_t
*ejtag_info
;
90 } mips32_pracc_context
;
92 static int wait_for_pracc_rw(mips_ejtag_t
*ejtag_info
, uint32_t *ctrl
)
98 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
99 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
;
100 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
101 if (ejtag_ctrl
& EJTAG_CTRL_PRACC
)
103 LOG_DEBUG("DEBUGMODULE: No memory access in progress!\n");
104 return ERROR_JTAG_DEVICE_ERROR
;
111 static int mips32_pracc_exec_read(mips32_pracc_context
*ctx
, uint32_t address
)
113 mips_ejtag_t
*ejtag_info
= ctx
->ejtag_info
;
115 uint32_t ejtag_ctrl
, data
;
117 if ((address
>= MIPS32_PRACC_PARAM_IN
)
118 && (address
<= MIPS32_PRACC_PARAM_IN
+ ctx
->num_iparam
* 4))
120 offset
= (address
- MIPS32_PRACC_PARAM_IN
) / 4;
121 data
= ctx
->local_iparam
[offset
];
123 else if ((address
>= MIPS32_PRACC_PARAM_OUT
)
124 && (address
<= MIPS32_PRACC_PARAM_OUT
+ ctx
->num_oparam
* 4))
126 offset
= (address
- MIPS32_PRACC_PARAM_OUT
) / 4;
127 data
= ctx
->local_oparam
[offset
];
129 else if ((address
>= MIPS32_PRACC_TEXT
)
130 && (address
<= MIPS32_PRACC_TEXT
+ ctx
->code_len
*4))
132 offset
= (address
- MIPS32_PRACC_TEXT
) / 4;
133 data
= ctx
->code
[offset
];
135 else if (address
== MIPS32_PRACC_STACK
)
137 /* save to our debug stack */
138 data
= ctx
->stack
[--ctx
->stack_offset
];
142 /* TODO: send JMP 0xFF200000 instruction. Hopefully processor jump back
143 * to start of debug vector */
146 LOG_ERROR("Error reading unexpected address %8.8" PRIx32
"", address
);
147 return ERROR_JTAG_DEVICE_ERROR
;
150 /* Send the data out */
151 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_DATA
, NULL
);
152 mips_ejtag_drscan_32(ctx
->ejtag_info
, &data
);
154 /* 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();
167 static int mips32_pracc_exec_write(mips32_pracc_context
*ctx
, uint32_t address
)
169 uint32_t ejtag_ctrl
,data
;
171 mips_ejtag_t
*ejtag_info
= ctx
->ejtag_info
;
173 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_DATA
, NULL
);
174 mips_ejtag_drscan_32(ctx
->ejtag_info
, &data
);
176 /* Clear access pending bit */
177 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
& ~EJTAG_CTRL_PRACC
;
178 mips_ejtag_set_instr(ctx
->ejtag_info
, EJTAG_INST_CONTROL
, NULL
);
179 mips_ejtag_drscan_32(ctx
->ejtag_info
, &ejtag_ctrl
);
182 jtag_execute_queue();
184 if ((address
>= MIPS32_PRACC_PARAM_IN
)
185 && (address
<= MIPS32_PRACC_PARAM_IN
+ ctx
->num_iparam
* 4))
187 offset
= (address
- MIPS32_PRACC_PARAM_IN
) / 4;
188 ctx
->local_iparam
[offset
] = data
;
190 else if ((address
>= MIPS32_PRACC_PARAM_OUT
)
191 && (address
<= MIPS32_PRACC_PARAM_OUT
+ ctx
->num_oparam
* 4))
193 offset
= (address
- MIPS32_PRACC_PARAM_OUT
) / 4;
194 ctx
->local_oparam
[offset
] = data
;
196 else if (address
== MIPS32_PRACC_STACK
)
198 /* save data onto our stack */
199 ctx
->stack
[ctx
->stack_offset
++] = data
;
203 LOG_ERROR("Error writing unexpected address %8.8" PRIx32
"", address
);
204 return ERROR_JTAG_DEVICE_ERROR
;
210 int mips32_pracc_exec( mips_ejtag_t
*ejtag_info
, int code_len
, uint32_t *code
, int num_param_in
, uint32_t *param_in
, int num_param_out
, uint32_t *param_out
, int cycle
)
213 uint32_t address
, data
;
214 mips32_pracc_context ctx
;
218 ctx
.local_iparam
= param_in
;
219 ctx
.local_oparam
= param_out
;
220 ctx
.num_iparam
= num_param_in
;
221 ctx
.num_oparam
= num_param_out
;
223 ctx
.code_len
= code_len
;
224 ctx
.ejtag_info
= ejtag_info
;
225 ctx
.stack_offset
= 0;
229 if ((retval
= wait_for_pracc_rw(ejtag_info
, &ejtag_ctrl
)) != ERROR_OK
)
233 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_ADDRESS
, NULL
);
234 mips_ejtag_drscan_32(ejtag_info
, &address
);
236 // printf("Adres: %.8x\n", address);
238 /* Check for read or write */
239 if (ejtag_ctrl
& EJTAG_CTRL_PRNW
)
241 if ((retval
= mips32_pracc_exec_write(&ctx
, address
)) != ERROR_OK
)
246 /* Check to see if its reading at the debug vector. The first pass through
247 * the module is always read at the vector, so the first one we allow. When
248 * the second read from the vector occurs we are done and just exit. */
249 if ((address
== MIPS32_PRACC_TEXT
) && (pass
++))
254 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(mips_ejtag_t
*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(mips_ejtag_t
*ejtag_info
, uint32_t addr
, int count
, uint32_t *buf
)
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
, sizeof(code
)/sizeof(code
[0]), code
,
351 sizeof(param_in
)/sizeof(param_in
[0]), param_in
, blocksize
, &buf
[bytesread
], 1)) != ERROR_OK
)
358 bytesread
+= blocksize
;
364 int mips32_pracc_read_u32(mips_ejtag_t
*ejtag_info
, uint32_t addr
, uint32_t *buf
)
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
, sizeof(code
)/sizeof(code
[0]), code
,
390 sizeof(param_in
)/sizeof(param_in
[0]), param_in
, sizeof(uint32_t), buf
, 1)) != ERROR_OK
)
398 int mips32_pracc_read_mem16(mips_ejtag_t
*ejtag_info
, uint32_t addr
, int count
, uint16_t *buf
)
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
[count
];
448 uint32_t param_in
[2];
459 param_in
[1] = blocksize
;
461 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
462 sizeof(param_in
)/sizeof(param_in
[0]), 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
];
477 int mips32_pracc_read_mem8(mips_ejtag_t
*ejtag_info
, uint32_t addr
, int count
, uint8_t *buf
)
481 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
482 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
483 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
484 MIPS32_SW(8,0,15), /* sw $8,($15) */
485 MIPS32_SW(9,0,15), /* sw $9,($15) */
486 MIPS32_SW(10,0,15), /* sw $10,($15) */
487 MIPS32_SW(11,0,15), /* sw $11,($15) */
489 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
490 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
491 MIPS32_LW(9,0,8), /* $9=mem[$8]; read addr */
492 MIPS32_LW(10,4,8), /* $10=mem[$8+4]; read count */
493 MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $11=MIPS32_PRACC_PARAM_OUT */
494 MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
497 MIPS32_BEQ(0,10,9), /* beq 0, $10, end */
500 MIPS32_LBU(8,0,9), /* lw $8,0($9), Load t4 with the byte @mem[t1] */
501 MIPS32_SW(8,0,11), /* sw $8,0($11) */
503 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
504 MIPS32_ADDI(9,9,1), /* $9+=1 */
505 MIPS32_ADDI(11,11,4), /* $11+=4 */
507 MIPS32_B(NEG16(9)), /* b loop */
510 MIPS32_LW(11,0,15), /* lw $11,($15) */
511 MIPS32_LW(10,0,15), /* lw $10,($15) */
512 MIPS32_LW(9,0,15), /* lw $9,($15) */
513 MIPS32_LW(8,0,15), /* lw $8,($15) */
514 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
516 MIPS32_B(NEG16(31)), /* b start */
520 // /* TODO remove array */
521 uint32_t param_out
[count
];
527 uint32_t param_in
[2];
538 param_in
[1] = blocksize
;
540 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
541 sizeof(param_in
)/sizeof(param_in
[0]), param_in
, count
, param_out
, 1);
543 // count -= blocksize;
544 // addr += blocksize;
545 // bytesread += blocksize;
548 for (i
= 0; i
< count
; i
++)
550 buf
[i
] = param_out
[i
];
556 int mips32_pracc_write_mem(mips_ejtag_t
*ejtag_info
, uint32_t addr
, int size
, int count
, void *buf
)
561 return mips32_pracc_write_mem8(ejtag_info
, addr
, count
, (uint8_t*)buf
);
563 return mips32_pracc_write_mem16(ejtag_info
, addr
, count
,(uint16_t*)buf
);
566 return mips32_pracc_write_u32(ejtag_info
, addr
, (uint32_t*)buf
);
568 return mips32_pracc_write_mem32(ejtag_info
, addr
, count
, (uint32_t*)buf
);
574 int mips32_pracc_write_mem32(mips_ejtag_t
*ejtag_info
, uint32_t addr
, int count
, uint32_t *buf
)
577 //NC: use destination pointer as loop counter (last address is in $10)
580 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
581 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
582 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
583 MIPS32_SW(8,0,15), /* sw $8,($15) */
584 MIPS32_SW(9,0,15), /* sw $9,($15) */
585 MIPS32_SW(10,0,15), /* sw $10,($15) */
586 MIPS32_SW(11,0,15), /* sw $11,($15) */
588 MIPS32_ADDI(8,15,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
)), //$8= MIPS32_PRACC_PARAM_IN
589 MIPS32_LW(9,0,8), /* Load write addr to $9 */
590 MIPS32_LW(10,4,8), //last address /* Load write count to $10 */
591 MIPS32_ADDI(8,8,8), // $8+=8 beginning of data
594 MIPS32_LW(11,0,8), /* lw $11,0($8), Load $11 with the word @mem[$8] */
595 MIPS32_SW(11,0,9), /* sw $11,0($9) */
597 MIPS32_ADDI(9,9,4), /* $9+=4 */
598 MIPS32_BNE(10,9,NEG16(4)), //was 9 BNE $10, 9, loop /* b loop */
599 MIPS32_ADDI(8,8,4), //this instruction is part of the loop (one delay slot)! /* $8+=4 */
601 MIPS32_LW(11,0,15), /* lw $11,($15) */
602 MIPS32_LW(10,0,15), /* lw $10,($15) */
603 MIPS32_LW(9,0,15), /* lw $9,($15) */
604 MIPS32_LW(8,0,15), /* lw $8,($15) */
605 MIPS32_B(NEG16(21)), //was 30 /* b start */
606 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
607 MIPS32_NOP
, //this one will not be executed
610 /* TODO remove array */
611 uint32_t param_in
[count
+2];
613 param_in
[1] = addr
+ count
* sizeof(uint32_t); //last address
615 memcpy(¶m_in
[2], buf
, count
* sizeof(uint32_t));
617 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
618 sizeof(param_in
)/sizeof(param_in
[0]),param_in
, 0, NULL
, 1);
623 int mips32_pracc_write_u32(mips_ejtag_t
*ejtag_info
, uint32_t addr
, uint32_t *buf
)
627 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
628 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
629 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
630 MIPS32_SW(8,0,15), /* sw $8,($15) */
631 MIPS32_SW(9,0,15), /* sw $9,($15) */
633 MIPS32_LW(8,NEG16((MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
)-4), 15), //load R8 @ param_in[1] = data
634 MIPS32_LW(9,NEG16(MIPS32_PRACC_STACK
-MIPS32_PRACC_PARAM_IN
), 15), //load R9 @ param_in[0] = address
636 MIPS32_SW(8,0,9), /* sw $8,0($9) */
638 MIPS32_LW(9,0,15), /* lw $9,($15) */
639 MIPS32_LW(8,0,15), /* lw $8,($15) */
640 MIPS32_B(NEG16(11)), /* b start */
641 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
645 /* TODO remove array */
646 uint32_t param_in
[1+1];
650 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
651 sizeof(param_in
)/sizeof(param_in
[0]),param_in
, 0, NULL
, 1);
656 int mips32_pracc_write_mem16(mips_ejtag_t
*ejtag_info
, uint32_t addr
, int count
, uint16_t *buf
)
660 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
661 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
662 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
663 MIPS32_SW(8,0,15), /* sw $8,($15) */
664 MIPS32_SW(9,0,15), /* sw $9,($15) */
665 MIPS32_SW(10,0,15), /* sw $10,($15) */
666 MIPS32_SW(11,0,15), /* sw $11,($15) */
668 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
669 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
670 MIPS32_LW(9,0,8), /* Load write addr to $9 */
671 MIPS32_LW(10,4,8), /* Load write count to $10 */
672 MIPS32_ADDI(8,8,8), /* $8+=8 */
675 MIPS32_BEQ(0,10,9), /* beq $0, $10, end */
678 MIPS32_LW(11,0,8), /* lw $11,0($8), Load $11 with the word @mem[$8] */
679 MIPS32_SH(11,0,9), /* sh $11,0($9) */
681 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
682 MIPS32_ADDI(9,9,2), /* $9+=2 */
683 MIPS32_ADDI(8,8,4), /* $8+=4 */
686 MIPS32_B(NEG16(9)), /* b loop */
689 MIPS32_LW(11,0,15), /* lw $11,($15) */
690 MIPS32_LW(10,0,15), /* lw $10,($15) */
691 MIPS32_LW(9,0,15), /* lw $9,($15) */
692 MIPS32_LW(8,0,15), /* lw $8,($15) */
693 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
695 MIPS32_B(NEG16(30)), /* b start */
699 /* TODO remove array */
700 uint32_t param_in
[count
+2];
705 for (i
= 0; i
< count
; i
++)
707 param_in
[i
+2] = buf
[i
];
710 mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
711 sizeof(param_in
)/sizeof(param_in
[0]), param_in
, 0, NULL
, 1);
716 int mips32_pracc_write_mem8(mips_ejtag_t
*ejtag_info
, uint32_t addr
, int count
, uint8_t *buf
)
720 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
721 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
722 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
723 MIPS32_SW(8,0,15), /* sw $8,($15) */
724 MIPS32_SW(9,0,15), /* sw $9,($15) */
725 MIPS32_SW(10,0,15), /* sw $10,($15) */
726 MIPS32_SW(11,0,15), /* sw $11,($15) */
728 MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $8 = MIPS32_PRACC_PARAM_IN */
729 MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN
)),
730 MIPS32_LW(9,0,8), /* Load write addr to $9 */
731 MIPS32_LW(10,4,8), /* Load write count to $10 */
732 MIPS32_ADDI(8,8,8), /* $8+=8 */
735 MIPS32_BEQ(0,10,9), /* beq $0, $10, end */
738 MIPS32_LW(11,0,8), /* lw $11,0($8), Load $11 with the word @mem[$8] */
739 MIPS32_SB(11,0,9), /* sb $11,0($9) */
741 MIPS32_ADDI(10,10,NEG16(1)), /* $10-- */
742 MIPS32_ADDI(9,9,1), /* $9+=1 */
743 MIPS32_ADDI(8,8,4), /* $8+=4 */
746 MIPS32_B(NEG16(9)), /* b loop */
749 MIPS32_LW(11,0,15), /* lw $11,($15) */
750 MIPS32_LW(10,0,15), /* lw $10,($15) */
751 MIPS32_LW(9,0,15), /* lw $9,($15) */
752 MIPS32_LW(8,0,15), /* lw $8,($15) */
753 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
755 MIPS32_B(NEG16(30)), /* b start */
759 /* TODO remove array */
760 uint32_t param_in
[count
+2];
766 for (i
= 0; i
< count
; i
++)
768 param_in
[i
+2] = buf
[i
];
771 retval
= mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
772 sizeof(param_in
)/sizeof(param_in
[0]), param_in
, 0, NULL
, 1);
777 int mips32_pracc_write_regs(mips_ejtag_t
*ejtag_info
, uint32_t *regs
)
781 MIPS32_LUI(2,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $2 = MIPS32_PRACC_PARAM_IN */
782 MIPS32_ORI(2,2,LOWER16(MIPS32_PRACC_PARAM_IN
)),
783 MIPS32_LW(1,1*4,2), /* lw $1,1*4($2) */
784 MIPS32_LW(15,15*4,2), /* lw $15,15*4($2) */
785 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
786 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
787 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
788 MIPS32_SW(1,0,15), /* sw $1,($15) */
789 MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_IN
)), /* $1 = MIPS32_PRACC_PARAM_IN */
790 MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_IN
)),
791 MIPS32_LW(3,3*4,1), /* lw $3,3*4($1) */
792 MIPS32_LW(4,4*4,1), /* lw $4,4*4($1) */
793 MIPS32_LW(5,5*4,1), /* lw $5,5*4($1) */
794 MIPS32_LW(6,6*4,1), /* lw $6,6*4($1) */
795 MIPS32_LW(7,7*4,1), /* lw $7,7*4($1) */
796 MIPS32_LW(8,8*4,1), /* lw $8,8*4($1) */
797 MIPS32_LW(9,9*4,1), /* lw $9,9*4($1) */
798 MIPS32_LW(10,10*4,1), /* lw $10,10*4($1) */
799 MIPS32_LW(11,11*4,1), /* lw $11,11*4($1) */
800 MIPS32_LW(12,12*4,1), /* lw $12,12*4($1) */
801 MIPS32_LW(13,13*4,1), /* lw $13,13*4($1) */
802 MIPS32_LW(14,14*4,1), /* lw $14,14*4($1) */
803 MIPS32_LW(16,16*4,1), /* lw $16,16*4($1) */
804 MIPS32_LW(17,17*4,1), /* lw $17,17*4($1) */
805 MIPS32_LW(18,18*4,1), /* lw $18,18*4($1) */
806 MIPS32_LW(19,19*4,1), /* lw $19,19*4($1) */
807 MIPS32_LW(20,20*4,1), /* lw $20,20*4($1) */
808 MIPS32_LW(21,21*4,1), /* lw $21,21*4($1) */
809 MIPS32_LW(22,22*4,1), /* lw $22,22*4($1) */
810 MIPS32_LW(23,23*4,1), /* lw $23,23*4($1) */
811 MIPS32_LW(24,24*4,1), /* lw $24,24*4($1) */
812 MIPS32_LW(25,25*4,1), /* lw $25,25*4($1) */
813 MIPS32_LW(26,26*4,1), /* lw $26,26*4($1) */
814 MIPS32_LW(27,27*4,1), /* lw $27,27*4($1) */
815 MIPS32_LW(28,28*4,1), /* lw $28,28*4($1) */
816 MIPS32_LW(29,29*4,1), /* lw $29,29*4($1) */
817 MIPS32_LW(30,30*4,1), /* lw $30,30*4($1) */
818 MIPS32_LW(31,31*4,1), /* lw $31,31*4($1) */
820 MIPS32_LW(2,32*4,1), /* lw $2,32*4($1) */
821 MIPS32_MTC0(2,12,0), /* move $2 to status */
822 MIPS32_LW(2,33*4,1), /* lw $2,33*4($1) */
823 MIPS32_MTLO(2), /* move $2 to lo */
824 MIPS32_LW(2,34*4,1), /* lw $2,34*4($1) */
825 MIPS32_MTHI(2), /* move $2 to hi */
826 MIPS32_LW(2,35*4,1), /* lw $2,35*4($1) */
827 MIPS32_MTC0(2,8,0), /* move $2 to badvaddr */
828 MIPS32_LW(2,36*4,1), /* lw $2,36*4($1) */
829 MIPS32_MTC0(2,13,0), /* move $2 to cause*/
830 MIPS32_LW(2,37*4,1), /* lw $2,37*4($1) */
831 MIPS32_MTC0(2,24,0), /* move $2 to pc */
833 MIPS32_LW(2,2*4,1), /* lw $2,2*4($1) */
834 MIPS32_LW(1,0,15), /* lw $1,($15) */
835 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
837 MIPS32_B(NEG16(55)), /* b start */
843 retval
= mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
844 38, regs
, 0, NULL
, 1);
849 int mips32_pracc_read_regs(mips_ejtag_t
*ejtag_info
, uint32_t *regs
)
853 MIPS32_MTC0(2,31,0), /* move $2 to COP0 DeSave */
854 MIPS32_LUI(2,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $2 = MIPS32_PRACC_PARAM_OUT */
855 MIPS32_ORI(2,2,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
856 MIPS32_SW(0,0*4,2), /* sw $0,0*4($2) */
857 MIPS32_SW(1,1*4,2), /* sw $1,1*4($2) */
858 MIPS32_SW(15,15*4,2), /* sw $15,15*4($2) */
859 MIPS32_MFC0(2,31,0), /* move COP0 DeSave to $2 */
860 MIPS32_MTC0(15,31,0), /* move $15 to COP0 DeSave */
861 MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK
)), /* $15 = MIPS32_PRACC_STACK */
862 MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK
)),
863 MIPS32_SW(1,0,15), /* sw $1,($15) */
864 MIPS32_SW(2,0,15), /* sw $2,($15) */
865 MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_OUT
)), /* $1 = MIPS32_PRACC_PARAM_OUT */
866 MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_OUT
)),
867 MIPS32_SW(2,2*4,1), /* sw $2,2*4($1) */
868 MIPS32_SW(3,3*4,1), /* sw $3,3*4($1) */
869 MIPS32_SW(4,4*4,1), /* sw $4,4*4($1) */
870 MIPS32_SW(5,5*4,1), /* sw $5,5*4($1) */
871 MIPS32_SW(6,6*4,1), /* sw $6,6*4($1) */
872 MIPS32_SW(7,7*4,1), /* sw $7,7*4($1) */
873 MIPS32_SW(8,8*4,1), /* sw $8,8*4($1) */
874 MIPS32_SW(9,9*4,1), /* sw $9,9*4($1) */
875 MIPS32_SW(10,10*4,1), /* sw $10,10*4($1) */
876 MIPS32_SW(11,11*4,1), /* sw $11,11*4($1) */
877 MIPS32_SW(12,12*4,1), /* sw $12,12*4($1) */
878 MIPS32_SW(13,13*4,1), /* sw $13,13*4($1) */
879 MIPS32_SW(14,14*4,1), /* sw $14,14*4($1) */
880 MIPS32_SW(16,16*4,1), /* sw $16,16*4($1) */
881 MIPS32_SW(17,17*4,1), /* sw $17,17*4($1) */
882 MIPS32_SW(18,18*4,1), /* sw $18,18*4($1) */
883 MIPS32_SW(19,19*4,1), /* sw $19,19*4($1) */
884 MIPS32_SW(20,20*4,1), /* sw $20,20*4($1) */
885 MIPS32_SW(21,21*4,1), /* sw $21,21*4($1) */
886 MIPS32_SW(22,22*4,1), /* sw $22,22*4($1) */
887 MIPS32_SW(23,23*4,1), /* sw $23,23*4($1) */
888 MIPS32_SW(24,24*4,1), /* sw $24,24*4($1) */
889 MIPS32_SW(25,25*4,1), /* sw $25,25*4($1) */
890 MIPS32_SW(26,26*4,1), /* sw $26,26*4($1) */
891 MIPS32_SW(27,27*4,1), /* sw $27,27*4($1) */
892 MIPS32_SW(28,28*4,1), /* sw $28,28*4($1) */
893 MIPS32_SW(29,29*4,1), /* sw $29,29*4($1) */
894 MIPS32_SW(30,30*4,1), /* sw $30,30*4($1) */
895 MIPS32_SW(31,31*4,1), /* sw $31,31*4($1) */
897 MIPS32_MFC0(2,12,0), /* move status to $2 */
898 MIPS32_SW(2,32*4,1), /* sw $2,32*4($1) */
899 MIPS32_MFLO(2), /* move lo to $2 */
900 MIPS32_SW(2,33*4,1), /* sw $2,33*4($1) */
901 MIPS32_MFHI(2), /* move hi to $2 */
902 MIPS32_SW(2,34*4,1), /* sw $2,34*4($1) */
903 MIPS32_MFC0(2,8,0), /* move badvaddr to $2 */
904 MIPS32_SW(2,35*4,1), /* sw $2,35*4($1) */
905 MIPS32_MFC0(2,13,0), /* move cause to $2 */
906 MIPS32_SW(2,36*4,1), /* sw $2,36*4($1) */
907 MIPS32_MFC0(2,24,0), /* move pc to $2 */
908 MIPS32_SW(2,37*4,1), /* sw $2,37*4($1) */
910 MIPS32_LW(2,0,15), /* lw $2,($15) */
911 MIPS32_LW(1,0,15), /* lw $1,($15) */
912 MIPS32_MFC0(15,31,0), /* move COP0 DeSave to $15 */
914 MIPS32_B(NEG16(60)), /* b start */
920 retval
= mips32_pracc_exec(ejtag_info
, sizeof(code
)/sizeof(code
[0]), code
, \
921 0, NULL
, 38, regs
, 1);