i_trap.c

来自「skyeye的开源代码」· C语言 代码 · 共 61 行

/**********************************/
/*                                */
/*  Copyright 2000, David Grant   */
/*                                */
/*  see LICENSE for more details  */
/*                                */
/**********************************/

#include "coldfire.h"

/* Trap instruction */

/* Format 
   
 15  14  13  12  11  10   9   8   7   6   5   4   3   2   1   0
+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+
| 0 | 1 | 0 | 0 | 1 | 1 | 1 | 0 | 0 | 1 | 0 | 0 |    Vector     |
+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+

*/

int TRAPTime=15;


INSTRUCTION_2ARGS(TRAP, 
		unsigned Code1,12, 
		unsigned Vector,4);


static void execute(void)
{
	TRAP_Instr Instr;
	Memory_RetrWordFromPC(&Instr.Code);


	/* this is done in the exception 
		SRBits->T=0;
		SRBits->S=1; */
	exception_do_exception(32+Instr.Bits.Vector);
	
	cycle(TRAPTime);
	
	return;
}

static int disassemble(char *Instruction, char *Arg1, char *Arg2)
{
	TRAP_Instr Instr;
	Memory_RetrWordFromPC(&Instr.Code);
	sprintf(Instruction, "TRAP");
	sprintf(Arg1, "#0x%02X", Instr.Bits.Vector);
	Arg2[0]=0;
	return 0;
}

int trap_5206_register(void)
{
	instruction_register(0x4E40, 0xFFF0, &execute, &disassemble);
	return 1;
}