bootmii-autoloader/exception.c

// Copyright 2008-2009  Segher Boessenkool  <segher@kernel.crashing.org>
// This code is licensed to you under the terms of the GNU GPL, version 2;
// see file COPYING or http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt

#include "loader.h"

extern char exception_2200_start, exception_2200_end;

void exception_handler(int exception)
{
	u32 *x;
	u32 i;

	printf("\nException %04x occurred!\n", exception);

	x = (u32 *)0x80002000;

	printf("\n R0..R7    R8..R15  R16..R23  R24..R31\n");
	for (i = 0; i < 8; i++) {
		printf("%08x  %08x  %08x  %08x\n", x[0], x[8], x[16], x[24]);
		x++;
	}
	x += 24;

	printf("\n CR/XER    LR/CTR  SRR0/SRR1 DAR/DSISR\n");
	for (i = 0; i < 2; i++) {
		printf("%08x  %08x  %08x  %08x\n", x[0], x[2], x[4], x[6]);
		x++;
	}

	// Hang.
	for (;;)
		;
}

void exception_init(void)
{
	u32 vector;
	u32 len_2200;

	for (vector = 0x100; vector < 0x2000; vector += 0x10) {
		u32 *insn = (u32 *)(0x80000000 + vector);

		insn[0] = 0xbc002000;			// stmw 0,0x2000(0)
		insn[1] = 0x38600000 | (u32)vector;	// li 3,vector
		insn[2] = 0x48002202;			// ba 0x2200
		insn[3] = 0;
	}
	sync_before_exec((void *)0x80000100, 0x1f00);

	len_2200 = &exception_2200_end - &exception_2200_start;
	memcpy((void *)0x80002200, &exception_2200_start, len_2200);
	sync_before_exec((void *)0x80002200, len_2200);
}