mips32_pracc.c 30 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
	const 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, const 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
	static const 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

Zachary T Welch's avatar
Zachary T Welch committed
351
352
		if ((retval = mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code,
			ARRAY_SIZE(param_in), 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
	static const 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;

Zachary T Welch's avatar
Zachary T Welch committed
390
391
	if ((retval = mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code,
		ARRAY_SIZE(param_in), 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
	static const 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 = malloc(count * sizeof(uint32_t));
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

Zachary T Welch's avatar
Zachary T Welch committed
462
463
		mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code, \
			ARRAY_SIZE(param_in), 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

475
476
	free(param_out);

ntfreak's avatar
ntfreak committed
477
478
479
	return ERROR_OK;
}

480
int mips32_pracc_read_mem8(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint8_t *buf)
ntfreak's avatar
ntfreak committed
481
{
482
	static const uint32_t code[] = {
ntfreak's avatar
ntfreak committed
483
484
485
486
487
488
489
															/* 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
490
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
491

ntfreak's avatar
ntfreak committed
492
493
		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
494
		MIPS32_LW(9,0,8), 									/* $9 = mem[$8]; read addr */
zwelch's avatar
zwelch committed
495
		MIPS32_LW(10,4,8), 									/* $10 = mem[$8 + 4]; read count */
zwelch's avatar
zwelch committed
496
		MIPS32_LUI(11,UPPER16(MIPS32_PRACC_PARAM_OUT)), 	/* $11 = MIPS32_PRACC_PARAM_OUT */
ntfreak's avatar
ntfreak committed
497
498
499
500
501
		MIPS32_ORI(11,11,LOWER16(MIPS32_PRACC_PARAM_OUT)),
		MIPS32_NOP,
															/* loop: */
		MIPS32_BEQ(0,10,9), 								/* beq 0, $10, end */
		MIPS32_NOP,
502

503
504
		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) */
505

ntfreak's avatar
ntfreak committed
506
		MIPS32_ADDI(10,10,NEG16(1)), 						/* $10-- */
zwelch's avatar
zwelch committed
507
508
		MIPS32_ADDI(9,9,1), 								/* $9 += 1 */
		MIPS32_ADDI(11,11,4), 								/* $11 += 4 */
ntfreak's avatar
ntfreak committed
509
510
511
512
		MIPS32_NOP,
		MIPS32_B(NEG16(9)),									/* b loop */
		MIPS32_NOP,
															/* end: */
513
514
515
516
		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
517
518
519
520
521
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(31)),								/* b start */
		MIPS32_NOP,
	};
522

ntfreak's avatar
ntfreak committed
523
//	/* TODO remove array */
524
	uint32_t *param_out = malloc(count * sizeof(uint32_t));
ntfreak's avatar
ntfreak committed
525
	int i;
526

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

ntfreak's avatar
ntfreak committed
532
	bytesread = 0;
533

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

ntfreak's avatar
ntfreak committed
540
541
		param_in[0] = addr;
		param_in[1] = blocksize;
542

Zachary T Welch's avatar
Zachary T Welch committed
543
544
		mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code, \
			ARRAY_SIZE(param_in), param_in, count, param_out, 1);
545

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

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

556
557
	free(param_out);

ntfreak's avatar
ntfreak committed
558
559
560
	return ERROR_OK;
}

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

ntfreak's avatar
ntfreak committed
576
577
578
	return ERROR_OK;
}

579
int mips32_pracc_write_mem32(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint32_t *buf)
ntfreak's avatar
ntfreak committed
580
{
581
582

//NC: use destination pointer as loop counter (last address is in $10)
583
	static const uint32_t code[] = {
ntfreak's avatar
ntfreak committed
584
585
586
587
588
589
590
															/* 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
591
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
592

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

//loop:
ntfreak's avatar
ntfreak committed
599
600
		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) */
601

zwelch's avatar
zwelch committed
602
		MIPS32_ADDI(9,9,4), 								/* $9 += 4 */
603
		MIPS32_BNE(10,9,NEG16(4)),  //was 9 BNE $10, 9, loop									/* b loop */
zwelch's avatar
zwelch committed
604
		MIPS32_ADDI(8,8,4),  //this instruction is part of the loop (one delay slot)!	/* $8 += 4 */
ntfreak's avatar
ntfreak committed
605
															/* end: */
606
607
608
609
		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) */
610
		MIPS32_B(NEG16(21)),	 //was 30							/* b start */
ntfreak's avatar
ntfreak committed
611
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
612
		MIPS32_NOP, //this one will not be executed
ntfreak's avatar
ntfreak committed
613
	};
614

ntfreak's avatar
ntfreak committed
615
	/* TODO remove array */
616
	uint32_t *param_in = malloc((count + 2) * sizeof(uint32_t));
ntfreak's avatar
ntfreak committed
617
	param_in[0] = addr;
618
	param_in[1] = addr + count * sizeof(uint32_t);	//last address
619

620
	memcpy(&param_in[2], buf, count * sizeof(uint32_t));
621

Zachary T Welch's avatar
Zachary T Welch committed
622
	mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code, \
623
		count + 2, param_in, 0, NULL, 1);
ntfreak's avatar
ntfreak committed
624

625
626
	free(param_in);

ntfreak's avatar
ntfreak committed
627
628
629
	return ERROR_OK;
}

630
int mips32_pracc_write_u32(struct mips_ejtag *ejtag_info, uint32_t addr, uint32_t *buf)
631
{
632
	static const uint32_t code[] = {
633
634
635
636
637
638
															/* 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) */
639

640
641
		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
642
643
644
645
646

		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) */
647
648
		MIPS32_B(NEG16(11)),								/* b start */
		MIPS32_MFC0(15,31,0),							/* move COP0 DeSave to $15 */
649
650
651
652
		MIPS32_NOP,
	};

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

Zachary T Welch's avatar
Zachary T Welch committed
657
658
	mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code, \
		ARRAY_SIZE(param_in),param_in, 0, NULL, 1);
659
660
661
662

	return ERROR_OK;
}

663
int mips32_pracc_write_mem16(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint16_t *buf)
ntfreak's avatar
ntfreak committed
664
{
665
	static const uint32_t code[] = {
ntfreak's avatar
ntfreak committed
666
667
668
669
670
671
672
															/* 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
673
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
674

ntfreak's avatar
ntfreak committed
675
676
677
678
		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
679
		MIPS32_ADDI(8,8,8), 								/* $8 += 8 */
ntfreak's avatar
ntfreak committed
680
681
682
683
		MIPS32_NOP,
															/* loop: */
		MIPS32_BEQ(0,10,9),									/* beq $0, $10, end */
		MIPS32_NOP,
684

ntfreak's avatar
ntfreak committed
685
686
		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) */
687

ntfreak's avatar
ntfreak committed
688
		MIPS32_ADDI(10,10,NEG16(1)), 						/* $10-- */
zwelch's avatar
zwelch committed
689
690
		MIPS32_ADDI(9,9,2), 								/* $9 += 2 */
		MIPS32_ADDI(8,8,4), 								/* $8 += 4 */
691

ntfreak's avatar
ntfreak committed
692
693
694
695
		MIPS32_NOP,
		MIPS32_B(NEG16(9)),									/* b loop */
		MIPS32_NOP,
															/* end: */
696
697
698
699
		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
700
701
702
703
704
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(30)),								/* b start */
		MIPS32_NOP,
	};
705

ntfreak's avatar
ntfreak committed
706
	/* TODO remove array */
707
	uint32_t *param_in = malloc((count + 2) * sizeof(uint32_t));
ntfreak's avatar
ntfreak committed
708
709
710
	int i;
	param_in[0] = addr;
	param_in[1] = count;
711

ntfreak's avatar
ntfreak committed
712
713
	for (i = 0; i < count; i++)
	{
zwelch's avatar
zwelch committed
714
		param_in[i + 2] = buf[i];
ntfreak's avatar
ntfreak committed
715
	}
716

Zachary T Welch's avatar
Zachary T Welch committed
717
	mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code, \
718
		count + 2, param_in, 0, NULL, 1);
ntfreak's avatar
ntfreak committed
719

720
721
	free(param_in);

ntfreak's avatar
ntfreak committed
722
723
724
	return ERROR_OK;
}

725
int mips32_pracc_write_mem8(struct mips_ejtag *ejtag_info, uint32_t addr, int count, uint8_t *buf)
ntfreak's avatar
ntfreak committed
726
{
727
	static const uint32_t code[] = {
ntfreak's avatar
ntfreak committed
728
729
730
731
732
733
734
															/* 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
735
		MIPS32_SW(11,0,15), 								/* sw $11,($15) */
736

ntfreak's avatar
ntfreak committed
737
738
739
740
		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
741
		MIPS32_ADDI(8,8,8), 								/* $8 += 8 */
ntfreak's avatar
ntfreak committed
742
743
744
745
		MIPS32_NOP,
															/* loop: */
		MIPS32_BEQ(0,10,9),									/* beq $0, $10, end */
		MIPS32_NOP,
746

ntfreak's avatar
ntfreak committed
747
748
		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) */
749

ntfreak's avatar
ntfreak committed
750
		MIPS32_ADDI(10,10,NEG16(1)), 						/* $10-- */
zwelch's avatar
zwelch committed
751
752
		MIPS32_ADDI(9,9,1), 								/* $9 += 1 */
		MIPS32_ADDI(8,8,4), 								/* $8 += 4 */
753

ntfreak's avatar
ntfreak committed
754
755
756
757
		MIPS32_NOP,
		MIPS32_B(NEG16(9)),									/* b loop */
		MIPS32_NOP,
															/* end: */
758
759
760
761
		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
762
763
764
765
766
		MIPS32_MFC0(15,31,0),								/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(30)),								/* b start */
		MIPS32_NOP,
	};
767

ntfreak's avatar
ntfreak committed
768
	/* TODO remove array */
769
	uint32_t *param_in = malloc((count + 2) * sizeof(uint32_t));
ntfreak's avatar
ntfreak committed
770
771
772
773
	int retval;
	int i;
	param_in[0] = addr;
	param_in[1] = count;
774

ntfreak's avatar
ntfreak committed
775
776
	for (i = 0; i < count; i++)
	{
zwelch's avatar
zwelch committed
777
		param_in[i + 2] = buf[i];
ntfreak's avatar
ntfreak committed
778
	}
779

Zachary T Welch's avatar
Zachary T Welch committed
780
	retval = mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code, \
781
		count +2, param_in, 0, NULL, 1);
ntfreak's avatar
ntfreak committed
782

783
784
	free(param_in);

ntfreak's avatar
ntfreak committed
785
786
787
	return retval;
}

788
int mips32_pracc_write_regs(struct mips_ejtag *ejtag_info, uint32_t *regs)
ntfreak's avatar
ntfreak committed
789
{
790
	static const uint32_t code[] = {
ntfreak's avatar
ntfreak committed
791
792
793
794
														/* 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) */
795
796
797
798
799
		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
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
824
825
826
827
828
829
		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) */
830

831
832
833
834
835
836
837
838
839
840
841
842
		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 */
843

844
845
846
		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
847
		MIPS32_NOP,
848
		MIPS32_B(NEG16(55)),							/* b start */
ntfreak's avatar
ntfreak committed
849
850
		MIPS32_NOP,
	};
851

ntfreak's avatar
ntfreak committed
852
	int retval;
853

Zachary T Welch's avatar
Zachary T Welch committed
854
	retval = mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code, \
855
		38, regs, 0, NULL, 1);
856

ntfreak's avatar
ntfreak committed
857
858
859
	return retval;
}

860
int mips32_pracc_read_regs(struct mips_ejtag *ejtag_info, uint32_t *regs)
ntfreak's avatar
ntfreak committed
861
{
862
	static const uint32_t code[] = {
ntfreak's avatar
ntfreak committed
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
897
898
899
900
901
902
903
904
905
906
														/* 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) */
907

ntfreak's avatar
ntfreak committed
908
909
		MIPS32_MFC0(2,12,0),							/* move status to $2 */
		MIPS32_SW(2,32*4,1), 							/* sw $2,32*4($1) */
910
		MIPS32_MFLO(2),									/* move lo to $2 */
ntfreak's avatar
ntfreak committed
911
		MIPS32_SW(2,33*4,1), 							/* sw $2,33*4($1) */
912
		MIPS32_MFHI(2),									/* move hi to $2 */
ntfreak's avatar
ntfreak committed
913
914
915
916
917
918
919
		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) */
920

921
922
		MIPS32_LW(2,0,15), 								/* lw $2,($15) */
		MIPS32_LW(1,0,15), 								/* lw $1,($15) */
ntfreak's avatar
ntfreak committed
923
924
925
926
927
		MIPS32_MFC0(15,31,0),							/* move COP0 DeSave to $15 */
		MIPS32_NOP,
		MIPS32_B(NEG16(60)),							/* b start */
		MIPS32_NOP,
	};
928

ntfreak's avatar
ntfreak committed
929
	int retval;
930

Zachary T Welch's avatar
Zachary T Welch committed
931
	retval = mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code, \
ntfreak's avatar
ntfreak committed
932
		0, NULL, 38, regs, 1);
933

ntfreak's avatar
ntfreak committed
934
935
	return retval;
}