mips32_pracc.c 29.9 KB
Newer Older
ntfreak's avatar
ntfreak committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
/***************************************************************************
 *   Copyright (C) 2008 by Spencer Oliver                                  *
 *   spen@spen-soft.co.uk                                                  *
 *                                                                         *
 *   Copyright (C) 2008 by David T.L. Wong                                 *
 *                                                                         *
 *   This program is free software; you can redistribute it and/or modify  *
 *   it under the terms of the GNU General Public License as published by  *
 *   the Free Software Foundation; either version 2 of the License, or     *
 *   (at your option) any later version.                                   *
 *                                                                         *
 *   This program is distributed in the hope that it will be useful,       *
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
 *   GNU General Public License for more details.                          *
 *                                                                         *
 *   You should have received a copy of the GNU General Public License     *
 *   along with this program; if not, write to the                         *
 *   Free Software Foundation, Inc.,                                       *
 *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
 ***************************************************************************/
22
23
24
25
26
27
28

/*
This version has optimized assembly routines for 32 bit operations:
- read word
- write word
- write array of words

29
One thing to be aware of is that the MIPS32 cpu will execute the
30
31
32
33
34
35
36
37
38
instruction after a branch instruction (one delay slot).

For example:


    LW $2, ($5 +10)
    B foo
    LW $1, ($2 +100)

39
The LW $1, ($2 +100) instruction is also executed. If this is
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
not wanted a NOP can be inserted:

    LW $2, ($5 +10)
    B foo
    NOP
    LW $1, ($2 +100)

or the code can be changed to:

    B foo
    LW $2, ($5 +10)
    LW $1, ($2 +100)

The original code contained NOPs. I have removed these and moved
the branches.

I also moved the PRACC_STACK to 0xFF204000. This allows
the use of 16 bits offsets to get pointers to the input
and output area relative to the stack. Note that the stack
isn't really a stack (the stack pointer is not 'moving')
but a FIFO simulated in software.

These changes result in a 35% speed increase when programming an
external flash.

More improvement could be gained if the registers do no need
to be preserved but in that case the routines should be aware
OpenOCD is used as a flash programmer or as a debug tool.

Nico Coesel
*/


ntfreak's avatar
ntfreak committed
73
74
75
76
77
78
79
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include "mips32.h"
#include "mips32_pracc.h"

Zachary T Welch's avatar
Zachary T Welch committed
80
81
struct mips32_pracc_context
{
82
	uint32_t *local_iparam;
ntfreak's avatar
ntfreak committed
83
	int num_iparam;
84
	uint32_t *local_oparam;
ntfreak's avatar
ntfreak committed
85
	int num_oparam;
86
	uint32_t *code;
ntfreak's avatar
ntfreak committed
87
	int code_len;
88
	uint32_t stack[32];
ntfreak's avatar
ntfreak committed
89
	int stack_offset;
90
	struct mips_ejtag *ejtag_info;
Zachary T Welch's avatar
Zachary T Welch committed
91
};
ntfreak's avatar
ntfreak committed
92

93
static int wait_for_pracc_rw(struct mips_ejtag *ejtag_info, uint32_t *ctrl)
ntfreak's avatar
ntfreak committed
94
{
95
	uint32_t ejtag_ctrl;
96
97

	while (1)
ntfreak's avatar
ntfreak committed
98
99
	{
		mips_ejtag_set_instr(ejtag_info, EJTAG_INST_CONTROL, NULL);
100
		ejtag_ctrl = ejtag_info->ejtag_ctrl;
ntfreak's avatar
ntfreak committed
101
102
103
104
105
106
		mips_ejtag_drscan_32(ejtag_info, &ejtag_ctrl);
		if (ejtag_ctrl & EJTAG_CTRL_PRACC)
			break;
		LOG_DEBUG("DEBUGMODULE: No memory access in progress!\n");
		return ERROR_JTAG_DEVICE_ERROR;
	}
107

ntfreak's avatar
ntfreak committed
108
109
110
111
	*ctrl = ejtag_ctrl;
	return ERROR_OK;
}

Zachary T Welch's avatar
Zachary T Welch committed
112
static int mips32_pracc_exec_read(struct mips32_pracc_context *ctx, uint32_t address)
ntfreak's avatar
ntfreak committed
113
{
114
	struct mips_ejtag *ejtag_info = ctx->ejtag_info;
ntfreak's avatar
ntfreak committed
115
	int offset;
116
	uint32_t ejtag_ctrl, data;
ntfreak's avatar
ntfreak committed
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144

	if ((address >= MIPS32_PRACC_PARAM_IN)
		&& (address <= MIPS32_PRACC_PARAM_IN + ctx->num_iparam * 4))
	{
		offset = (address - MIPS32_PRACC_PARAM_IN) / 4;
		data = ctx->local_iparam[offset];
	}
	else if ((address >= MIPS32_PRACC_PARAM_OUT)
		&& (address <= MIPS32_PRACC_PARAM_OUT + ctx->num_oparam * 4))
	{
		offset = (address - MIPS32_PRACC_PARAM_OUT) / 4;
		data = ctx->local_oparam[offset];
	}
	else if ((address >= MIPS32_PRACC_TEXT)
		&& (address <= MIPS32_PRACC_TEXT + ctx->code_len*4))
	{
		offset = (address - MIPS32_PRACC_TEXT) / 4;
		data = ctx->code[offset];
	}
	else if (address == MIPS32_PRACC_STACK)
	{
		/* save to our debug stack */
		data = ctx->stack[--ctx->stack_offset];
	}
	else
	{
		/* TODO: send JMP 0xFF200000 instruction. Hopefully processor jump back
		 * to start of debug vector */
145

ntfreak's avatar
ntfreak committed
146
		data = 0;
duane's avatar
duane committed
147
		LOG_ERROR("Error reading unexpected address %8.8" PRIx32 "", address);
ntfreak's avatar
ntfreak committed
148
149
		return ERROR_JTAG_DEVICE_ERROR;
	}
150

ntfreak's avatar
ntfreak committed
151
152
153
154
155
	/* Send the data out */
	mips_ejtag_set_instr(ctx->ejtag_info, EJTAG_INST_DATA, NULL);
	mips_ejtag_drscan_32(ctx->ejtag_info, &data);

	/* Clear the access pending bit (let the processor eat!) */
156

157
	ejtag_ctrl = ejtag_info->ejtag_ctrl & ~EJTAG_CTRL_PRACC;
ntfreak's avatar
ntfreak committed
158
	mips_ejtag_set_instr(ctx->ejtag_info, EJTAG_INST_CONTROL, NULL);
159
	mips_ejtag_drscan_32(ctx->ejtag_info, &ejtag_ctrl);
160
161
162

	jtag_add_clocks(5);
	jtag_execute_queue();
163

164

ntfreak's avatar
ntfreak committed
165
166
167
	return ERROR_OK;
}

Zachary T Welch's avatar
Zachary T Welch committed
168
static int mips32_pracc_exec_write(struct mips32_pracc_context *ctx, uint32_t address)
ntfreak's avatar
ntfreak committed
169
{
170
	uint32_t ejtag_ctrl,data;
ntfreak's avatar
ntfreak committed
171
	int offset;
172
	struct mips_ejtag *ejtag_info = ctx->ejtag_info;
173

ntfreak's avatar
ntfreak committed
174
175
	mips_ejtag_set_instr(ctx->ejtag_info, EJTAG_INST_DATA, NULL);
	mips_ejtag_drscan_32(ctx->ejtag_info, &data);
176

ntfreak's avatar
ntfreak committed
177
	/* Clear access pending bit */
178
	ejtag_ctrl = ejtag_info->ejtag_ctrl & ~EJTAG_CTRL_PRACC;
ntfreak's avatar
ntfreak committed
179
	mips_ejtag_set_instr(ctx->ejtag_info, EJTAG_INST_CONTROL, NULL);
180
	mips_ejtag_drscan_32(ctx->ejtag_info, &ejtag_ctrl);
181
182
183

	jtag_add_clocks(5);
	jtag_execute_queue();
184

ntfreak's avatar
ntfreak committed
185
186
187
188
189
190
	if ((address >= MIPS32_PRACC_PARAM_IN)
		&& (address <= MIPS32_PRACC_PARAM_IN + ctx->num_iparam * 4))
	{
		offset = (address - MIPS32_PRACC_PARAM_IN) / 4;
		ctx->local_iparam[offset] = data;
	}
191
	else if ((address >= MIPS32_PRACC_PARAM_OUT)
ntfreak's avatar
ntfreak committed
192
193
194
195
196
197
198
199
200
201
202
203
		&& (address <= MIPS32_PRACC_PARAM_OUT + ctx->num_oparam * 4))
	{
		offset = (address - MIPS32_PRACC_PARAM_OUT) / 4;
		ctx->local_oparam[offset] = data;
	}
	else if (address == MIPS32_PRACC_STACK)
	{
		/* save data onto our stack */
		ctx->stack[ctx->stack_offset++] = data;
	}
	else
	{
duane's avatar
duane committed
204
		LOG_ERROR("Error writing unexpected address %8.8" PRIx32 "", address);
ntfreak's avatar
ntfreak committed
205
206
		return ERROR_JTAG_DEVICE_ERROR;
	}
207

ntfreak's avatar
ntfreak committed
208
209
210
	return ERROR_OK;
}

211
int mips32_pracc_exec(struct mips_ejtag *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)
ntfreak's avatar
ntfreak committed
212
{
213
214
	uint32_t ejtag_ctrl;
	uint32_t address, data;
Zachary T Welch's avatar
Zachary T Welch committed
215
	struct mips32_pracc_context ctx;
ntfreak's avatar
ntfreak committed
216
217
	int retval;
	int pass = 0;
218

ntfreak's avatar
ntfreak committed
219
220
221
222
223
224
225
226
	ctx.local_iparam = param_in;
	ctx.local_oparam = param_out;
	ctx.num_iparam = num_param_in;
	ctx.num_oparam = num_param_out;
	ctx.code = code;
	ctx.code_len = code_len;
	ctx.ejtag_info = ejtag_info;
	ctx.stack_offset = 0;
227

ntfreak's avatar
ntfreak committed
228
229
	while (1)
	{
230
		if ((retval = wait_for_pracc_rw(ejtag_info, &ejtag_ctrl)) != ERROR_OK)
ntfreak's avatar
ntfreak committed
231
			return retval;
232

ntfreak's avatar
ntfreak committed
233
234
235
		address = data = 0;
		mips_ejtag_set_instr(ejtag_info, EJTAG_INST_ADDRESS, NULL);
		mips_ejtag_drscan_32(ejtag_info, &address);
236
237

//		printf("Adres: %.8x\n", address);
238

ntfreak's avatar
ntfreak committed
239
		/* Check for read or write */
240
		if (ejtag_ctrl & EJTAG_CTRL_PRNW)
ntfreak's avatar
ntfreak committed
241
242
243
244
245
246
247
248
249
250
251
252
253
		{
			if ((retval = mips32_pracc_exec_write(&ctx, address)) != ERROR_OK)
				return retval;
		}
		else
		{
			/* Check to see if its reading at the debug vector. The first pass through
			 * the module is always read at the vector, so the first one we allow.  When
			 * the second read from the vector occurs we are done and just exit. */
			if ((address == MIPS32_PRACC_TEXT) && (pass++))
			{
				break;
			}
254

ntfreak's avatar
ntfreak committed
255
256
			if ((retval = mips32_pracc_exec_read(&ctx, address)) != ERROR_OK)
				return retval;
257

ntfreak's avatar
ntfreak committed
258
		}
259

ntfreak's avatar
ntfreak committed
260
261
262
		if (cycle == 0)
			break;
	}
263

ntfreak's avatar
ntfreak committed
264
265
266
267
268
	/* stack sanity check */
	if (ctx.stack_offset != 0)
	{
		LOG_DEBUG("Pracc Stack not zero");
	}
269

ntfreak's avatar
ntfreak committed
270
271
272
	return ERROR_OK;
}

273
int mips32_pracc_read_mem(struct mips_ejtag *ejtag_info, uint32_t addr, int size, int count, void *buf)
ntfreak's avatar
ntfreak committed
274
275
276
277
{
	switch (size)
	{
		case 1:
278
			return mips32_pracc_read_mem8(ejtag_info, addr, count, (uint8_t*)buf);
ntfreak's avatar
ntfreak committed
279
		case 2:
zwelch's avatar
zwelch committed
280
			return mips32_pracc_read_mem16(ejtag_info, addr, count, (uint16_t*)buf);
ntfreak's avatar
ntfreak committed
281
		case 4:
zwelch's avatar
zwelch committed
282
			if (count == 1)
283
				return mips32_pracc_read_u32(ejtag_info, addr, (uint32_t*)buf);
284
			else
285
				return mips32_pracc_read_mem32(ejtag_info, addr, count, (uint32_t*)buf);
ntfreak's avatar
ntfreak committed
286
	}
287

ntfreak's avatar
ntfreak committed
288
289
290
	return ERROR_OK;
}

291
int mips32_pracc_read_mem32(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint32_t *buf)
292
{
293
	uint32_t code[] = {
ntfreak's avatar
ntfreak committed
294
295
296
297
298
299
300
															/* start: */
		MIPS32_MTC0(15,31,0),								/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 		/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(8,0,15), 									/* sw $8,($15) */
		MIPS32_SW(9,0,15), 									/* sw $9,($15) */
		MIPS32_SW(10,0,15), 								/* sw $10,($15) */
ntfreak's avatar
ntfreak committed
301
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
302

ntfreak's avatar
ntfreak committed
303
304
		MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN)),		/* $8 = MIPS32_PRACC_PARAM_IN */
		MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN)),
zwelch's avatar
zwelch committed
305
		MIPS32_LW(9,0,8),									/* $9 = mem[$8]; read addr */
zwelch's avatar
zwelch committed
306
		MIPS32_LW(10,4,8),									/* $10 = mem[$8 + 4]; read count */
zwelch's avatar
zwelch committed
307
		MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT)), 	/* $11 = MIPS32_PRACC_PARAM_OUT */
ntfreak's avatar
ntfreak committed
308
309
310
311
312
		MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT)),
		MIPS32_NOP,
															/* loop: */
		MIPS32_BEQ(0,10,9),									/* beq 0, $10, end */
		MIPS32_NOP,
313

314
315
		MIPS32_LW(8,0,9), 									/* lw $8,0($9), Load $8 with the word @mem[$9] */
		MIPS32_SW(8,0,11), 									/* sw $8,0($11) */
316

ntfreak's avatar
ntfreak committed
317
		MIPS32_ADDI(10,10,NEG16(1)), 						/* $10-- */
zwelch's avatar
zwelch committed
318
319
		MIPS32_ADDI(9,9,4), 								/* $1 += 4 */
		MIPS32_ADDI(11,11,4), 								/* $11 += 4 */
320

ntfreak's avatar
ntfreak committed
321
322
323
324
		MIPS32_NOP,
		MIPS32_B(NEG16(9)),									/* b loop */
		MIPS32_NOP,
															/* end: */
325
326
327
328
		MIPS32_LW(11,0,15), 								/* lw $11,($15) */
		MIPS32_LW(10,0,15), 								/* lw $10,($15) */
		MIPS32_LW(9,0,15), 									/* lw $9,($15) */
		MIPS32_LW(8,0,15), 									/* lw $8,($15) */
ntfreak's avatar
ntfreak committed
329
330
331
332
333
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(31)),								/* b start */
		MIPS32_NOP,
	};
334

335
	int retval = ERROR_OK;
ntfreak's avatar
ntfreak committed
336
337
	int blocksize;
	int bytesread;
338
	uint32_t param_in[2];
339

ntfreak's avatar
ntfreak committed
340
	bytesread = 0;
341

ntfreak's avatar
ntfreak committed
342
	while (count > 0)
343
	{
ntfreak's avatar
ntfreak committed
344
345
346
		blocksize = count;
		if (count > 0x400)
			blocksize = 0x400;
347

ntfreak's avatar
ntfreak committed
348
349
		param_in[0] = addr;
		param_in[1] = blocksize;
350
351

		if ((retval = mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code,
ntfreak's avatar
ntfreak committed
352
			sizeof(param_in)/sizeof(param_in[0]), param_in, blocksize, &buf[bytesread], 1)) != ERROR_OK)
oharboe's avatar
oharboe committed
353
		{
ntfreak's avatar
ntfreak committed
354
			return retval;
oharboe's avatar
oharboe committed
355
		}
356

ntfreak's avatar
ntfreak committed
357
358
359
360
361
362
363
364
		count -= blocksize;
		addr += blocksize;
		bytesread += blocksize;
	}

	return retval;
}

365
int mips32_pracc_read_u32(struct mips_ejtag *ejtag_info, uint32_t addr, uint32_t *buf)
366
{
367
	uint32_t code[] = {
368
369
370
371
372
373
															/* start: */
		MIPS32_MTC0(15,31,0),								/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 		/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(8,0,15), 									/* sw $8,($15) */

374
		MIPS32_LW(8,NEG16(MIPS32_PRACC_STACK-MIPS32_PRACC_PARAM_IN), 15),  //load R8 @ param_in[0] = address
375
376

		MIPS32_LW(8,0,8), 									/* lw $8,0($8), Load $8 with the word @mem[$8] */
377
		MIPS32_SW(8,NEG16(MIPS32_PRACC_STACK-MIPS32_PRACC_PARAM_OUT),15), 									/* sw $8,0($9) */
378
379

		MIPS32_LW(8,0,15), 									/* lw $8,($15) */
380
381
		MIPS32_B(NEG16(9)),	//was 17							/* b start */
		MIPS32_MFC0(15,31,0),   //this instruction will be executed (MIPS executes instruction after jump)							/* move COP0 DeSave to $15 */
382
383
384
385
		MIPS32_NOP,
	};

	int retval = ERROR_OK;
386
	uint32_t param_in[1];
387
388
389

	param_in[0] = addr;

390
	if ((retval = mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code,
391
		sizeof(param_in)/sizeof(param_in[0]), param_in, sizeof(uint32_t), buf, 1)) != ERROR_OK)
392
393
394
395
396
397
398
	{
		return retval;
	}

	return retval;
}

399
int mips32_pracc_read_mem16(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint16_t *buf)
ntfreak's avatar
ntfreak committed
400
{
401
	uint32_t code[] = {
ntfreak's avatar
ntfreak committed
402
403
404
405
406
407
408
															/* start: */
		MIPS32_MTC0(15,31,0),								/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 		/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(8,0,15), 									/* sw $8,($15) */
		MIPS32_SW(9,0,15), 									/* sw $9,($15) */
		MIPS32_SW(10,0,15), 								/* sw $10,($15) */
ntfreak's avatar
ntfreak committed
409
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
410

ntfreak's avatar
ntfreak committed
411
412
		MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN)),		/* $8 = MIPS32_PRACC_PARAM_IN */
		MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN)),
zwelch's avatar
zwelch committed
413
		MIPS32_LW(9,0,8),									/* $9 = mem[$8]; read addr */
zwelch's avatar
zwelch committed
414
		MIPS32_LW(10,4,8),									/* $10 = mem[$8 + 4]; read count */
zwelch's avatar
zwelch committed
415
		MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT)),		/* $11 = MIPS32_PRACC_PARAM_OUT */
ntfreak's avatar
ntfreak committed
416
417
418
419
420
		MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT)),
		MIPS32_NOP,
															/* loop: */
		MIPS32_BEQ(0,10,9), 								/* beq 0, $10, end */
		MIPS32_NOP,
421

422
423
		MIPS32_LHU(8,0,9), 									/* lw $8,0($9), Load $8 with the halfword @mem[$9] */
		MIPS32_SW(8,0,11), 									/* sw $8,0($11) */
424

ntfreak's avatar
ntfreak committed
425
		MIPS32_ADDI(10,10,NEG16(1)), 						/* $10-- */
zwelch's avatar
zwelch committed
426
427
		MIPS32_ADDI(9,9,2), 								/* $9 += 2 */
		MIPS32_ADDI(11,11,4), 								/* $11 += 4 */
ntfreak's avatar
ntfreak committed
428
429
430
431
		MIPS32_NOP,
		MIPS32_B(NEG16(9)),									/* b loop */
		MIPS32_NOP,

432
433
434
435
		MIPS32_LW(11,0,15), 								/* lw $11,($15) */
		MIPS32_LW(10,0,15), 								/* lw $10,($15) */
		MIPS32_LW(9,0,15), 									/* lw $9,($15) */
		MIPS32_LW(8,0,15), 									/* lw $8,($15) */
ntfreak's avatar
ntfreak committed
436
437
438
439
440
441
442
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(31)),								/* b start */
		MIPS32_NOP,
	};

//	/* TODO remove array */
443
	uint32_t param_out[count];
ntfreak's avatar
ntfreak committed
444
	int i;
445

ntfreak's avatar
ntfreak committed
446
447
448
//	int retval;
	int blocksize;
	int bytesread;
449
	uint32_t param_in[2];
450

ntfreak's avatar
ntfreak committed
451
	bytesread = 0;
452

ntfreak's avatar
ntfreak committed
453
	//while (count > 0)
454
	{
ntfreak's avatar
ntfreak committed
455
456
457
		blocksize = count;
		if (count > 0x400)
			blocksize = 0x400;
458

ntfreak's avatar
ntfreak committed
459
460
		param_in[0] = addr;
		param_in[1] = blocksize;
461

ntfreak's avatar
ntfreak committed
462
463
		mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code, \
			sizeof(param_in)/sizeof(param_in[0]), param_in, count, param_out, 1);
464

ntfreak's avatar
ntfreak committed
465
466
467
468
//		count -= blocksize;
//		addr += blocksize;
//		bytesread += blocksize;
	}
469

ntfreak's avatar
ntfreak committed
470
471
472
473
	for (i = 0; i < count; i++)
	{
		buf[i] = param_out[i];
	}
474

ntfreak's avatar
ntfreak committed
475
476
477
	return ERROR_OK;
}

478
int mips32_pracc_read_mem8(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint8_t *buf)
ntfreak's avatar
ntfreak committed
479
{
480
	uint32_t code[] = {
ntfreak's avatar
ntfreak committed
481
482
483
484
485
486
487
															/* start: */
		MIPS32_MTC0(15,31,0),								/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 		/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(8,0,15), 									/* sw $8,($15) */
		MIPS32_SW(9,0,15), 									/* sw $9,($15) */
		MIPS32_SW(10,0,15), 								/* sw $10,($15) */
ntfreak's avatar
ntfreak committed
488
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
489

ntfreak's avatar
ntfreak committed
490
491
		MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN)), 		/* $8 = MIPS32_PRACC_PARAM_IN */
		MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN)),
zwelch's avatar
zwelch committed
492
		MIPS32_LW(9,0,8), 									/* $9 = mem[$8]; read addr */
zwelch's avatar
zwelch committed
493
		MIPS32_LW(10,4,8), 									/* $10 = mem[$8 + 4]; read count */
zwelch's avatar
zwelch committed
494
		MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT)), 	/* $11 = MIPS32_PRACC_PARAM_OUT */
ntfreak's avatar
ntfreak committed
495
496
497
498
499
		MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT)),
		MIPS32_NOP,
															/* loop: */
		MIPS32_BEQ(0,10,9), 								/* beq 0, $10, end */
		MIPS32_NOP,
500

501
502
		MIPS32_LBU(8,0,9), 									/* lw $8,0($9), Load t4 with the byte @mem[t1] */
		MIPS32_SW(8,0,11), 									/* sw $8,0($11) */
503

ntfreak's avatar
ntfreak committed
504
		MIPS32_ADDI(10,10,NEG16(1)), 						/* $10-- */
zwelch's avatar
zwelch committed
505
506
		MIPS32_ADDI(9,9,1), 								/* $9 += 1 */
		MIPS32_ADDI(11,11,4), 								/* $11 += 4 */
ntfreak's avatar
ntfreak committed
507
508
509
510
		MIPS32_NOP,
		MIPS32_B(NEG16(9)),									/* b loop */
		MIPS32_NOP,
															/* end: */
511
512
513
514
		MIPS32_LW(11,0,15), 								/* lw $11,($15) */
		MIPS32_LW(10,0,15), 								/* lw $10,($15) */
		MIPS32_LW(9,0,15), 									/* lw $9,($15) */
		MIPS32_LW(8,0,15), 									/* lw $8,($15) */
ntfreak's avatar
ntfreak committed
515
516
517
518
519
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(31)),								/* b start */
		MIPS32_NOP,
	};
520

ntfreak's avatar
ntfreak committed
521
//	/* TODO remove array */
522
	uint32_t param_out[count];
ntfreak's avatar
ntfreak committed
523
	int i;
524

ntfreak's avatar
ntfreak committed
525
526
527
//	int retval;
	int blocksize;
	int bytesread;
528
	uint32_t param_in[2];
529

ntfreak's avatar
ntfreak committed
530
	bytesread = 0;
531

ntfreak's avatar
ntfreak committed
532
//	while (count > 0)
533
	{
ntfreak's avatar
ntfreak committed
534
535
536
		blocksize = count;
		if (count > 0x400)
			blocksize = 0x400;
537

ntfreak's avatar
ntfreak committed
538
539
		param_in[0] = addr;
		param_in[1] = blocksize;
540

ntfreak's avatar
ntfreak committed
541
542
		mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code, \
			sizeof(param_in)/sizeof(param_in[0]), param_in, count, param_out, 1);
543

ntfreak's avatar
ntfreak committed
544
545
546
547
//		count -= blocksize;
//		addr += blocksize;
//		bytesread += blocksize;
	}
548

ntfreak's avatar
ntfreak committed
549
550
551
552
553
554
555
556
	for (i = 0; i < count; i++)
	{
		buf[i] = param_out[i];
	}

	return ERROR_OK;
}

557
int mips32_pracc_write_mem(struct mips_ejtag *ejtag_info, uint32_t addr, int size, int count, void *buf)
ntfreak's avatar
ntfreak committed
558
559
560
561
{
	switch (size)
	{
		case 1:
562
			return mips32_pracc_write_mem8(ejtag_info, addr, count, (uint8_t*)buf);
ntfreak's avatar
ntfreak committed
563
		case 2:
zwelch's avatar
zwelch committed
564
			return mips32_pracc_write_mem16(ejtag_info, addr, count,(uint16_t*)buf);
ntfreak's avatar
ntfreak committed
565
		case 4:
zwelch's avatar
zwelch committed
566
			if (count == 1)
567
				return mips32_pracc_write_u32(ejtag_info, addr, (uint32_t*)buf);
568
			else
569
				return mips32_pracc_write_mem32(ejtag_info, addr, count, (uint32_t*)buf);
ntfreak's avatar
ntfreak committed
570
	}
571

ntfreak's avatar
ntfreak committed
572
573
574
	return ERROR_OK;
}

575
int mips32_pracc_write_mem32(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint32_t *buf)
ntfreak's avatar
ntfreak committed
576
{
577
578

//NC: use destination pointer as loop counter (last address is in $10)
579
	uint32_t code[] = {
ntfreak's avatar
ntfreak committed
580
581
582
583
584
585
586
															/* start: */
		MIPS32_MTC0(15,31,0),								/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 		/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(8,0,15), 									/* sw $8,($15) */
		MIPS32_SW(9,0,15), 									/* sw $9,($15) */
		MIPS32_SW(10,0,15), 								/* sw $10,($15) */
ntfreak's avatar
ntfreak committed
587
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
588

589
		MIPS32_ADDI(8,15,NEG16(MIPS32_PRACC_STACK-MIPS32_PRACC_PARAM_IN)),  //$8= MIPS32_PRACC_PARAM_IN
ntfreak's avatar
ntfreak committed
590
		MIPS32_LW(9,0,8), 									/* Load write addr to $9 */
591
		MIPS32_LW(10,4,8),	//last address 									/* Load write count to $10 */
zwelch's avatar
zwelch committed
592
		MIPS32_ADDI(8,8,8), 	// $8 += 8 beginning of data
593
594

//loop:
ntfreak's avatar
ntfreak committed
595
596
		MIPS32_LW(11,0,8), 									/* lw $11,0($8), Load $11 with the word @mem[$8] */
		MIPS32_SW(11,0,9), 									/* sw $11,0($9) */
597

zwelch's avatar
zwelch committed
598
		MIPS32_ADDI(9,9,4), 								/* $9 += 4 */
599
		MIPS32_BNE(10,9,NEG16(4)),  //was 9 BNE $10, 9, loop									/* b loop */
zwelch's avatar
zwelch committed
600
		MIPS32_ADDI(8,8,4),  //this instruction is part of the loop (one delay slot)!	/* $8 += 4 */
ntfreak's avatar
ntfreak committed
601
															/* end: */
602
603
604
605
		MIPS32_LW(11,0,15), 								/* lw $11,($15) */
		MIPS32_LW(10,0,15), 								/* lw $10,($15) */
		MIPS32_LW(9,0,15), 									/* lw $9,($15) */
		MIPS32_LW(8,0,15), 									/* lw $8,($15) */
606
		MIPS32_B(NEG16(21)),	 //was 30							/* b start */
ntfreak's avatar
ntfreak committed
607
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
608
		MIPS32_NOP, //this one will not be executed
ntfreak's avatar
ntfreak committed
609
	};
610

ntfreak's avatar
ntfreak committed
611
	/* TODO remove array */
zwelch's avatar
zwelch committed
612
	uint32_t param_in[count + 2];
ntfreak's avatar
ntfreak committed
613
	param_in[0] = addr;
614
	param_in[1] = addr + count * sizeof(uint32_t);	//last address
615

616
	memcpy(&param_in[2], buf, count * sizeof(uint32_t));
617

ntfreak's avatar
ntfreak committed
618
619
620
621
622
623
	mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code, \
		sizeof(param_in)/sizeof(param_in[0]),param_in, 0, NULL, 1);

	return ERROR_OK;
}

624
int mips32_pracc_write_u32(struct mips_ejtag *ejtag_info, uint32_t addr, uint32_t *buf)
625
{
626
	uint32_t code[] = {
627
628
629
630
631
632
															/* start: */
		MIPS32_MTC0(15,31,0),								/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 		/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(8,0,15), 									/* sw $8,($15) */
		MIPS32_SW(9,0,15), 									/* sw $9,($15) */
633

634
635
		MIPS32_LW(8,NEG16((MIPS32_PRACC_STACK-MIPS32_PRACC_PARAM_IN)-4), 15),  //load R8 @ param_in[1] = data
		MIPS32_LW(9,NEG16(MIPS32_PRACC_STACK-MIPS32_PRACC_PARAM_IN), 15),  //load R9 @ param_in[0] = address
636
637
638
639
640

		MIPS32_SW(8,0,9), 									/* sw $8,0($9) */

		MIPS32_LW(9,0,15), 									/* lw $9,($15) */
		MIPS32_LW(8,0,15), 									/* lw $8,($15) */
641
642
		MIPS32_B(NEG16(11)),								/* b start */
		MIPS32_MFC0(15,31,0),							/* move COP0 DeSave to $15 */
643
644
645
646
		MIPS32_NOP,
	};

	/* TODO remove array */
zwelch's avatar
zwelch committed
647
	uint32_t param_in[1 + 1];
648
649
650
651
652
653
654
655
656
	param_in[0] = addr;
	param_in[1] = *buf;

	mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code, \
		sizeof(param_in)/sizeof(param_in[0]),param_in, 0, NULL, 1);

	return ERROR_OK;
}

657
int mips32_pracc_write_mem16(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint16_t *buf)
ntfreak's avatar
ntfreak committed
658
{
659
	uint32_t code[] = {
ntfreak's avatar
ntfreak committed
660
661
662
663
664
665
666
															/* start: */
		MIPS32_MTC0(15,31,0),								/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 		/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(8,0,15), 									/* sw $8,($15) */
		MIPS32_SW(9,0,15), 									/* sw $9,($15) */
		MIPS32_SW(10,0,15), 								/* sw $10,($15) */
ntfreak's avatar
ntfreak committed
667
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
668

ntfreak's avatar
ntfreak committed
669
670
671
672
		MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN)), 		/* $8 = MIPS32_PRACC_PARAM_IN */
		MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN)),
		MIPS32_LW(9,0,8), 									/* Load write addr to $9 */
		MIPS32_LW(10,4,8), 									/* Load write count to $10 */
zwelch's avatar
zwelch committed
673
		MIPS32_ADDI(8,8,8), 								/* $8 += 8 */
ntfreak's avatar
ntfreak committed
674
675
676
677
		MIPS32_NOP,
															/* loop: */
		MIPS32_BEQ(0,10,9),									/* beq $0, $10, end */
		MIPS32_NOP,
678

ntfreak's avatar
ntfreak committed
679
680
		MIPS32_LW(11,0,8), 									/* lw $11,0($8), Load $11 with the word @mem[$8] */
		MIPS32_SH(11,0,9), 									/* sh $11,0($9) */
681

ntfreak's avatar
ntfreak committed
682
		MIPS32_ADDI(10,10,NEG16(1)), 						/* $10-- */
zwelch's avatar
zwelch committed
683
684
		MIPS32_ADDI(9,9,2), 								/* $9 += 2 */
		MIPS32_ADDI(8,8,4), 								/* $8 += 4 */
685

ntfreak's avatar
ntfreak committed
686
687
688
689
		MIPS32_NOP,
		MIPS32_B(NEG16(9)),									/* b loop */
		MIPS32_NOP,
															/* end: */
690
691
692
693
		MIPS32_LW(11,0,15), 								/* lw $11,($15) */
		MIPS32_LW(10,0,15), 								/* lw $10,($15) */
		MIPS32_LW(9,0,15), 									/* lw $9,($15) */
		MIPS32_LW(8,0,15), 									/* lw $8,($15) */
ntfreak's avatar
ntfreak committed
694
695
696
697
698
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(30)),								/* b start */
		MIPS32_NOP,
	};
699

ntfreak's avatar
ntfreak committed
700
	/* TODO remove array */
zwelch's avatar
zwelch committed
701
	uint32_t param_in[count + 2];
ntfreak's avatar
ntfreak committed
702
703
704
	int i;
	param_in[0] = addr;
	param_in[1] = count;
705

ntfreak's avatar
ntfreak committed
706
707
	for (i = 0; i < count; i++)
	{
zwelch's avatar
zwelch committed
708
		param_in[i + 2] = buf[i];
ntfreak's avatar
ntfreak committed
709
	}
710

ntfreak's avatar
ntfreak committed
711
712
713
714
715
716
	mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code, \
		sizeof(param_in)/sizeof(param_in[0]), param_in, 0, NULL, 1);

	return ERROR_OK;
}

717
int mips32_pracc_write_mem8(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint8_t *buf)
ntfreak's avatar
ntfreak committed
718
{
719
	uint32_t code[] = {
ntfreak's avatar
ntfreak committed
720
721
722
723
724
725
726
															/* start: */
		MIPS32_MTC0(15,31,0),								/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 		/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(8,0,15), 									/* sw $8,($15) */
		MIPS32_SW(9,0,15), 									/* sw $9,($15) */
		MIPS32_SW(10,0,15), 								/* sw $10,($15) */
ntfreak's avatar
ntfreak committed
727
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
728

ntfreak's avatar
ntfreak committed
729
730
731
732
		MIPS32_LUI(8,UPPER16(MIPS32_PRACC_PARAM_IN)), 		/* $8 = MIPS32_PRACC_PARAM_IN */
		MIPS32_ORI(8,8,LOWER16(MIPS32_PRACC_PARAM_IN)),
		MIPS32_LW(9,0,8), 									/* Load write addr to $9 */
		MIPS32_LW(10,4,8), 									/* Load write count to $10 */
zwelch's avatar
zwelch committed
733
		MIPS32_ADDI(8,8,8), 								/* $8 += 8 */
ntfreak's avatar
ntfreak committed
734
735
736
737
		MIPS32_NOP,
															/* loop: */
		MIPS32_BEQ(0,10,9),									/* beq $0, $10, end */
		MIPS32_NOP,
738

ntfreak's avatar
ntfreak committed
739
740
		MIPS32_LW(11,0,8), 									/* lw $11,0($8), Load $11 with the word @mem[$8] */
		MIPS32_SB(11,0,9), 									/* sb $11,0($9) */
741

ntfreak's avatar
ntfreak committed
742
		MIPS32_ADDI(10,10,NEG16(1)), 						/* $10-- */
zwelch's avatar
zwelch committed
743
744
		MIPS32_ADDI(9,9,1), 								/* $9 += 1 */
		MIPS32_ADDI(8,8,4), 								/* $8 += 4 */
745

ntfreak's avatar
ntfreak committed
746
747
748
749
		MIPS32_NOP,
		MIPS32_B(NEG16(9)),									/* b loop */
		MIPS32_NOP,
															/* end: */
750
751
752
753
		MIPS32_LW(11,0,15), 								/* lw $11,($15) */
		MIPS32_LW(10,0,15), 								/* lw $10,($15) */
		MIPS32_LW(9,0,15), 									/* lw $9,($15) */
		MIPS32_LW(8,0,15), 									/* lw $8,($15) */
ntfreak's avatar
ntfreak committed
754
755
756
757
758
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(30)),								/* b start */
		MIPS32_NOP,
	};
759

ntfreak's avatar
ntfreak committed
760
	/* TODO remove array */
zwelch's avatar
zwelch committed
761
	uint32_t param_in[count + 2];
ntfreak's avatar
ntfreak committed
762
763
764
765
	int retval;
	int i;
	param_in[0] = addr;
	param_in[1] = count;
766

ntfreak's avatar
ntfreak committed
767
768
	for (i = 0; i < count; i++)
	{
zwelch's avatar
zwelch committed
769
		param_in[i + 2] = buf[i];
ntfreak's avatar
ntfreak committed
770
	}
771

ntfreak's avatar
ntfreak committed
772
773
774
775
776
777
	retval = mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code, \
		sizeof(param_in)/sizeof(param_in[0]), param_in, 0, NULL, 1);

	return retval;
}

778
int mips32_pracc_write_regs(struct mips_ejtag *ejtag_info, uint32_t *regs)
ntfreak's avatar
ntfreak committed
779
{
780
	uint32_t code[] = {
ntfreak's avatar
ntfreak committed
781
782
783
784
														/* start: */
		MIPS32_LUI(2,UPPER16(MIPS32_PRACC_PARAM_IN)), 	/* $2 = MIPS32_PRACC_PARAM_IN */
		MIPS32_ORI(2,2,LOWER16(MIPS32_PRACC_PARAM_IN)),
		MIPS32_LW(1,1*4,2), 							/* lw $1,1*4($2) */
785
786
787
788
789
		MIPS32_LW(15,15*4,2), 							/* lw $15,15*4($2) */
		MIPS32_MTC0(15,31,0),							/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 	/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(1,0,15), 								/* sw $1,($15) */
ntfreak's avatar
ntfreak committed
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
		MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_IN)), 	/* $1 = MIPS32_PRACC_PARAM_IN */
		MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_IN)),
		MIPS32_LW(3,3*4,1), 							/* lw $3,3*4($1) */
		MIPS32_LW(4,4*4,1), 							/* lw $4,4*4($1) */
		MIPS32_LW(5,5*4,1), 							/* lw $5,5*4($1) */
		MIPS32_LW(6,6*4,1), 							/* lw $6,6*4($1) */
		MIPS32_LW(7,7*4,1), 							/* lw $7,7*4($1) */
		MIPS32_LW(8,8*4,1), 							/* lw $8,8*4($1) */
		MIPS32_LW(9,9*4,1), 							/* lw $9,9*4($1) */
		MIPS32_LW(10,10*4,1), 							/* lw $10,10*4($1) */
		MIPS32_LW(11,11*4,1), 							/* lw $11,11*4($1) */
		MIPS32_LW(12,12*4,1), 							/* lw $12,12*4($1) */
		MIPS32_LW(13,13*4,1), 							/* lw $13,13*4($1) */
		MIPS32_LW(14,14*4,1), 							/* lw $14,14*4($1) */
		MIPS32_LW(16,16*4,1), 							/* lw $16,16*4($1) */
		MIPS32_LW(17,17*4,1), 							/* lw $17,17*4($1) */
		MIPS32_LW(18,18*4,1), 							/* lw $18,18*4($1) */
		MIPS32_LW(19,19*4,1), 							/* lw $19,19*4($1) */
		MIPS32_LW(20,20*4,1), 							/* lw $20,20*4($1) */
		MIPS32_LW(21,21*4,1), 							/* lw $21,21*4($1) */
		MIPS32_LW(22,22*4,1), 							/* lw $22,22*4($1) */
		MIPS32_LW(23,23*4,1), 							/* lw $23,23*4($1) */
		MIPS32_LW(24,24*4,1), 							/* lw $24,24*4($1) */
		MIPS32_LW(25,25*4,1), 							/* lw $25,25*4($1) */
		MIPS32_LW(26,26*4,1), 							/* lw $26,26*4($1) */
		MIPS32_LW(27,27*4,1), 							/* lw $27,27*4($1) */
		MIPS32_LW(28,28*4,1), 							/* lw $28,28*4($1) */
		MIPS32_LW(29,29*4,1), 							/* lw $29,29*4($1) */
		MIPS32_LW(30,30*4,1), 							/* lw $30,30*4($1) */
		MIPS32_LW(31,31*4,1), 							/* lw $31,31*4($1) */
820

821
822
823
824
825
826
827
828
829
830
831
832
		MIPS32_LW(2,32*4,1), 							/* lw $2,32*4($1) */
		MIPS32_MTC0(2,12,0),							/* move $2 to status */
		MIPS32_LW(2,33*4,1), 							/* lw $2,33*4($1) */
		MIPS32_MTLO(2),									/* move $2 to lo */
		MIPS32_LW(2,34*4,1), 							/* lw $2,34*4($1) */
		MIPS32_MTHI(2),									/* move $2 to hi */
		MIPS32_LW(2,35*4,1), 							/* lw $2,35*4($1) */
		MIPS32_MTC0(2,8,0),								/* move $2 to badvaddr */
		MIPS32_LW(2,36*4,1), 							/* lw $2,36*4($1) */
		MIPS32_MTC0(2,13,0),							/* move $2 to cause*/
		MIPS32_LW(2,37*4,1), 							/* lw $2,37*4($1) */
		MIPS32_MTC0(2,24,0),							/* move $2 to pc */
833

834
835
836
		MIPS32_LW(2,2*4,1), 							/* lw $2,2*4($1) */
		MIPS32_LW(1,0,15), 								/* lw $1,($15) */
		MIPS32_MFC0(15,31,0),							/* move COP0 DeSave to $15 */
ntfreak's avatar
ntfreak committed
837
		MIPS32_NOP,
838
		MIPS32_B(NEG16(55)),							/* b start */
ntfreak's avatar
ntfreak committed
839
840
		MIPS32_NOP,
	};
841

ntfreak's avatar
ntfreak committed
842
	int retval;
843

ntfreak's avatar
ntfreak committed
844
	retval = mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code, \
845
		38, regs, 0, NULL, 1);
846

ntfreak's avatar
ntfreak committed
847
848
849
	return retval;
}

850
int mips32_pracc_read_regs(struct mips_ejtag *ejtag_info, uint32_t *regs)
ntfreak's avatar
ntfreak committed
851
{
852
	uint32_t code[] = {
ntfreak's avatar
ntfreak committed
853
854
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
879
880
881
882
883
884
885
886
887
888
889
890
891
892
893
894
895
896
														/* start: */
		MIPS32_MTC0(2,31,0),							/* move $2 to COP0 DeSave */
		MIPS32_LUI(2,UPPER16(MIPS32_PRACC_PARAM_OUT)), 	/* $2 = MIPS32_PRACC_PARAM_OUT */
		MIPS32_ORI(2,2,LOWER16(MIPS32_PRACC_PARAM_OUT)),
		MIPS32_SW(0,0*4,2),								/* sw $0,0*4($2) */
		MIPS32_SW(1,1*4,2), 							/* sw $1,1*4($2) */
		MIPS32_SW(15,15*4,2), 							/* sw $15,15*4($2) */
		MIPS32_MFC0(2,31,0),							/* move COP0 DeSave to $2 */
		MIPS32_MTC0(15,31,0),							/* move $15 to COP0 DeSave */
		MIPS32_LUI(15,UPPER16(MIPS32_PRACC_STACK)), 	/* $15 = MIPS32_PRACC_STACK */
		MIPS32_ORI(15,15,LOWER16(MIPS32_PRACC_STACK)),
		MIPS32_SW(1,0,15), 								/* sw $1,($15) */
		MIPS32_SW(2,0,15), 								/* sw $2,($15) */
		MIPS32_LUI(1,UPPER16(MIPS32_PRACC_PARAM_OUT)), 	/* $1 = MIPS32_PRACC_PARAM_OUT */
		MIPS32_ORI(1,1,LOWER16(MIPS32_PRACC_PARAM_OUT)),
		MIPS32_SW(2,2*4,1), 							/* sw $2,2*4($1) */
		MIPS32_SW(3,3*4,1), 							/* sw $3,3*4($1) */
		MIPS32_SW(4,4*4,1), 							/* sw $4,4*4($1) */
		MIPS32_SW(5,5*4,1), 							/* sw $5,5*4($1) */
		MIPS32_SW(6,6*4,1), 							/* sw $6,6*4($1) */
		MIPS32_SW(7,7*4,1), 							/* sw $7,7*4($1) */
		MIPS32_SW(8,8*4,1), 							/* sw $8,8*4($1) */
		MIPS32_SW(9,9*4,1), 							/* sw $9,9*4($1) */
		MIPS32_SW(10,10*4,1), 							/* sw $10,10*4($1) */
		MIPS32_SW(11,11*4,1), 							/* sw $11,11*4($1) */
		MIPS32_SW(12,12*4,1), 							/* sw $12,12*4($1) */
		MIPS32_SW(13,13*4,1), 							/* sw $13,13*4($1) */
		MIPS32_SW(14,14*4,1), 							/* sw $14,14*4($1) */
		MIPS32_SW(16,16*4,1), 							/* sw $16,16*4($1) */
		MIPS32_SW(17,17*4,1), 							/* sw $17,17*4($1) */
		MIPS32_SW(18,18*4,1), 							/* sw $18,18*4($1) */
		MIPS32_SW(19,19*4,1), 							/* sw $19,19*4($1) */
		MIPS32_SW(20,20*4,1), 							/* sw $20,20*4($1) */
		MIPS32_SW(21,21*4,1), 							/* sw $21,21*4($1) */
		MIPS32_SW(22,22*4,1), 							/* sw $22,22*4($1) */
		MIPS32_SW(23,23*4,1), 							/* sw $23,23*4($1) */
		MIPS32_SW(24,24*4,1), 							/* sw $24,24*4($1) */
		MIPS32_SW(25,25*4,1), 							/* sw $25,25*4($1) */
		MIPS32_SW(26,26*4,1), 							/* sw $26,26*4($1) */
		MIPS32_SW(27,27*4,1), 							/* sw $27,27*4($1) */
		MIPS32_SW(28,28*4,1), 							/* sw $28,28*4($1) */
		MIPS32_SW(29,29*4,1), 							/* sw $29,29*4($1) */
		MIPS32_SW(30,30*4,1), 							/* sw $30,30*4($1) */
		MIPS32_SW(31,31*4,1), 							/* sw $31,31*4($1) */
897

ntfreak's avatar
ntfreak committed
898
899
		MIPS32_MFC0(2,12,0),							/* move status to $2 */
		MIPS32_SW(2,32*4,1), 							/* sw $2,32*4($1) */
900
		MIPS32_MFLO(2),									/* move lo to $2 */
ntfreak's avatar
ntfreak committed
901
		MIPS32_SW(2,33*4,1), 							/* sw $2,33*4($1) */
902
		MIPS32_MFHI(2),									/* move hi to $2 */
ntfreak's avatar
ntfreak committed
903
904
905
906
907
908
909
		MIPS32_SW(2,34*4,1), 							/* sw $2,34*4($1) */
		MIPS32_MFC0(2,8,0),								/* move badvaddr to $2 */
		MIPS32_SW(2,35*4,1), 							/* sw $2,35*4($1) */
		MIPS32_MFC0(2,13,0),							/* move cause to $2 */
		MIPS32_SW(2,36*4,1), 							/* sw $2,36*4($1) */
		MIPS32_MFC0(2,24,0),							/* move pc to $2 */
		MIPS32_SW(2,37*4,1), 							/* sw $2,37*4($1) */
910

911
912
		MIPS32_LW(2,0,15), 								/* lw $2,($15) */
		MIPS32_LW(1,0,15), 								/* lw $1,($15) */
ntfreak's avatar
ntfreak committed
913
914
915
916
917
		MIPS32_MFC0(15,31,0),							/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(60)),							/* b start */
		MIPS32_NOP,
	};
918

ntfreak's avatar
ntfreak committed
919
	int retval;
920

ntfreak's avatar
ntfreak committed
921
922
	retval = mips32_pracc_exec(ejtag_info, sizeof(code)/sizeof(code[0]), code, \
		0, NULL, 38, regs, 1);
923

ntfreak's avatar
ntfreak committed
924
925
	return retval;
}