Initial version

Committed on the Free edition of March Hare Software CVSNT Server. Upgrade to CVS Suite for more features and support: http://march-hare.com/cvsnt/ git-svn-id: http://moon:8086/svn/vhdl/trunk@372 cc03376c-175c-47c8-b038-4cd826a8556b
2009-03-01 17:51:24 +00:00
parent c3b72ca3a9
commit 6b4a578ccc
1 changed files with 232 additions and 0 deletions
@@ -0,0 +1,232 @@
+#include <stdlib.h>
+#include <stdio.h>
+#include "libsys.h"
+
+void _exc_break(void)
+{
+	__asm
+	(
+		".set	noreorder\n"
+		"break 0x123\n"
+		".set	reorder\n"
+
+	);
+}
+
+void _exc_syscall(void)
+{
+	__asm
+	(
+		".set	noreorder\n"
+		"syscall\n"
+		".set	reorder\n"
+
+	);
+}
+
+void _exc_arith(void)
+{
+	__asm
+	(
+		".set	noreorder\n"
+		" li	$t0, 0x7FFFFFFF\n"
+		" addi  $t1, $t0, 2\n"
+		".set	reorder\n"
+
+	);
+}
+
+void _exc_store_err(void)
+{
+	volatile int *pSrc = (int*)sys_timer_sec;
+	volatile int *pDst = (int*)0x40000001;
+
+	*pDst = *pSrc;
+
+}
+
+void _exc_load_err(void)
+{
+	volatile int *pSrc = (int*)0x40000002;
+	volatile int *pDst = (int*)sys_led_port;
+
+	*pDst = *pSrc;
+
+}
+
+void _exc_kaddr_err(void)
+{
+	__asm
+	(
+		".set	noreorder\n"
+		" li	$t0, 0x80000000\n"
+		" jr    $t0\n"
+		"nop\n"
+		".set	reorder\n"
+
+	);
+
+}
+
+void _exc_iaddr_err(void)
+{
+	__asm
+	(
+		".set	noreorder\n"
+		" li	$t0, 0x80000003\n"
+		" jr    $t0\n"
+		"nop\n"
+		".set	reorder\n"
+
+	);
+
+}
+
+void _exc_ri(void)
+{
+	__asm
+	(
+		".set	noreorder\n"
+		" li	$t0, 0x40010000\n"
+		" li	$t1, 0x9c563442\n"
+		" sw	$t1, 0($t0)\n"
+		" jr    $t0\n"
+		"nop\n"
+		".set	reorder\n"
+
+	);
+
+}
+
+void _exc_ibe(void)
+{
+	__asm
+	(
+		".set	noreorder\n"
+		" li	$t1, 0xAc563440\n"
+		" jr    $t1\n"
+		"nop\n"
+		".set	reorder\n"
+
+	);
+
+}
+
+void _exc_dbe(void)
+{
+	__asm
+	(
+		".set	noreorder\n"
+		" li	$t1, 0xAc563440\n"
+		" lw	$t0, 0($t1)\n"
+		"nop\n"
+		" jr    $t0\n"
+		"nop\n"
+		".set	reorder\n"
+
+	);
+
+}
+
+void handler0(void)
+{
+	printf("Interrupt 0\n");
+	interrupt_clr(0);
+}
+
+void handler1(void)
+{
+	printf("Interrupt 1\n");
+	interrupt_clr(1);
+}
+
+int main(void)
+{
+	int buf[256];
+	volatile int *pLED = (int*)sys_led_port;
+	volatile int *pFlash = (int*)sys_flash_io;
+	int i, sel;
+
+	interrupt_register(0, handler0);
+	interrupt_enable(0);
+	interrupt_register(1, handler1);
+	interrupt_enable(1);
+
+	for (i=0; i < 8192; i++)
+		*pLED = *pFlash;
+
+	while(1)
+	{
+		printf("Welche exception möchten Sie testen?\n");
+		printf(" 1 : Reserved instruction\n");
+		printf(" 2 : Privileged address\n");
+		printf(" 3 : Arithmetic overflow\n");
+		printf(" 4 : Syscall\n");
+		printf(" 5 : Breakpoint\n");
+		printf(" 6 : Load error on instruction\n");
+		printf(" 7 : Load error on data\n");
+		printf(" 8 : Store error on data\n");
+		printf(" 9 : Bus error on instruction\n");
+		printf("10 : Bus error on data\n");
+		printf("11 : SW-interrupt 0\n");
+		printf("12 : SW-interrupt 1\n");
+
+		scanf("%d", &sel);
+		printf("Jetzt kommt die exception (%d)!\n", sel);
+
+		switch(sel)
+		{
+			case 1:
+			_exc_ri();
+			break;
+
+			case 2:
+			_exc_kaddr_err();
+			break;
+
+			case 3:
+			_exc_arith();
+			break;
+
+			case 4:
+			_exc_syscall();
+			break;
+
+			case 5:
+			_exc_break();
+			break;
+
+			case 6:
+			_exc_iaddr_err();
+			break;
+
+			case 7:
+			_exc_load_err();
+			break;
+
+			case 8:
+			_exc_store_err();
+			break;
+
+			case 9:
+			printf("IBE: Exception not implemented in current CPU!\nPush reset to restart!\n");
+			_exc_ibe();
+			break;
+
+			case 10:
+			printf("DBE: Exception not implemented in current CPU!\nPush reset to restart!\n");
+			_exc_dbe();
+			break;
+
+			case 11:
+			case 12:
+			interrupt_set(sel-11);
+			break;
+
+			default:
+			break;
+		}
+		sel = 0;
+	}
+	return 0;
+}