i_addx.c

来自「SkyEye是一个可以运行嵌入式操作系统的硬件仿真工具」· C语言 代码 · 共 75 行

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

#include "coldfire.h"

/* AddX instruction */

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

*/

int ADDXTime=1;  /* All the rest of the modes are not valid */



INSTRUCTION_4ARGS(ADDX,
	unsigned Code2,4,
	unsigned RegisterDx,3,
	unsigned Code1,6,
	unsigned RegisterDy,3);


static void execute(void)
{
	struct _Address Source,Destination;
	unsigned int Result, SValue, DValue;
	int Extend = SRBits->X;
	ADDX_Instr Instr;

	Memory_RetrWordFromPC(&Instr.Code);

	if(!EA_GetFromPC(&Source, 32, 0, Instr.Bits.RegisterDy)) return;
	if(!EA_GetFromPC(&Destination, 32, 0, Instr.Bits.RegisterDx)) return;
	EA_GetValue(&SValue, &Source);
	EA_GetValue(&DValue, &Destination);

	Result = SValue + DValue + Extend;


	SR_Set(I_ADDX, SValue, DValue, Result);

	EA_PutValue(&Destination, Result);

	cycle(ADDXTime);

	return;
}

static int disassemble(char *Instruction, char *Arg1, char *Arg2) 
{
	ADDX_Instr Instr;
	Memory_RetrWordFromPC(&Instr.Code);

	sprintf(Instruction, "ADDX.L");
	Addressing_Print(32, 0, Instr.Bits.RegisterDy, Arg1);
	Addressing_Print(32, 0, Instr.Bits.RegisterDx, Arg2);
	return 0;
}

int addx_5206_register(void)
{
	instruction_register(0xD180, 0xF1F8, &execute, &disassemble);
	return 1;
}