i_andi.c

SkyEye是一个可以运行嵌入式操作系统的硬件仿真工具

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

#include "coldfire.h"

/* AND instruction */

/* Format 
   
 15  14  13  12  11  10   9   8   7   6   5   4   3   2   1   0
+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+
| 0 | 0 | 0 | 0 | 0 | 0 | 1 | 0 | 1 | 0 | 0 | 0 | 0 |EA Register|
+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+
|                  Upper Word of Immediate Data                 |
+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+
|                  Lower Word of Immediate Data                 |
+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+---+

*/

int ANDITime=1;


INSTRUCTION_2ARGS(ANDI,
	unsigned Code1,13,
	unsigned Register,3);

static void execute(void)
{
	struct _Address Source,Destination;
	unsigned int Result, SValue, DValue;
	ANDI_Instr Instr;
	Memory_RetrWordFromPC(&Instr.Code);

	if(!EA_GetFromPC(&Source, 32, 7, 4)) return;
	if(!EA_GetFromPC(&Destination, 32, 0, Instr.Bits.Register)) return;

	EA_GetValue(&SValue, &Source);
	EA_GetValue(&DValue, &Destination);

	Result = SValue & DValue;

	EA_PutValue(&Destination, Result);
	
        /* Set the status register
	 *  X - Not affected
	 *  N - Set if source is -ve, cleared otherwise
	 *  Z - Set if source is zero, cleared otherwise
	 *  V - always cleared
	 *  C - always cleared
	 */
	memory_core.sr &= 0xFFF0;
	SRBits->N = ((int)Result < 0);
	SRBits->Z = (Result == 0);
				
	
	cycle(ANDITime);
	
	return;
}

static int disassemble(char *Instruction, char *Arg1, char *Arg2)
{
	ANDI_Instr Instr;
	Memory_RetrWordFromPC(&Instr.Code);
	sprintf(Instruction, "ANDI.L");
	Addressing_Print(32, 7, 4, Arg1);	
	Addressing_Print(32, 0, Instr.Bits.Register, Arg2);
	return 0;
}

int andi_5206_register(void)
{
	instruction_register(0x0280, 0xFFF8, &execute, &disassemble);
	return 1;
}