public static void RRF(Data.Command com)
{
byte d = (byte)(com.GetLowByte() & 128);
byte f = (byte)(com.GetLowByte() & 127);
byte result = (byte)(Data.GetRegister(Data.AddressResolution(f)) >> 1);
//Add carry bit if flag is set
if (Data.GetRegisterBit(Data.Registers.STATUS, Data.Flags.Status.C))
{
result += 128;
}
//Set carry flag for current calculation
if ((Data.GetRegister(Data.AddressResolution(f)) & 1) == 1)
{
Data.SetRegisterBit(Data.Registers.STATUS, Data.Flags.Status.C, true);
}
else
{
Data.SetRegisterBit(Data.Registers.STATUS, Data.Flags.Status.C, false);
}
DirectionalWrite(d, f, result);
}
public static void BSF(Data.Command com)
{
int b1 = (com.GetHighByte() & 3) << 1;
int b = b1 + (((com.GetLowByte() & 128) == 128) ? 1 : 0);
byte f = (byte)(com.GetLowByte() & 127);
Data.SetRegisterBit(Data.AddressResolution(f), b, true);
}
public static void SWAPF(Data.Command com)
{
byte d = (byte)(com.GetLowByte() & 128);
byte f = (byte)(com.GetLowByte() & 127);
byte result = (byte)((Data.GetRegister(Data.AddressResolution(f)) & 0x0F) << 4 | (Data.GetRegister(Data.AddressResolution(f)) & 0xF0) >> 4);;
DirectionalWrite(d, f, result);
}
public static void SUBWF(Data.Command com)
{
byte d = (byte)(com.GetLowByte() & 128);
byte f = (byte)(com.GetLowByte() & 127);
byte result = BitwiseSubstract(Data.GetRegister(Data.AddressResolution(f)), Data.GetRegisterW());
DirectionalWrite(d, f, result);
}
public static void ANDWF(Data.Command com)
{
byte d = (byte)(com.GetLowByte() & 128);
byte f = (byte)(com.GetLowByte() & 127);
byte result = (byte)(Data.GetRegisterW() & Data.GetRegister(Data.AddressResolution(f)));
DirectionalWrite(d, f, result);
}
public static void INCF(Data.Command com)
{
byte d = (byte)(com.GetLowByte() & 128);
byte f = (byte)(com.GetLowByte() & 127);
byte result = (byte)(Data.GetRegister(Data.AddressResolution(f)) + 1);
CheckZFlag(result);
DirectionalWrite(d, f, result);
}
public static void MOVF(Data.Command com)
{
byte d = (byte)(com.GetLowByte() & 128);
byte f = (byte)(com.GetLowByte() & 127);
CheckZFlag(Data.GetRegister(Data.AddressResolution(f)));
if (d != 128)
{
Data.SetRegisterW(Data.GetRegister(Data.AddressResolution(f)));
}
}
public static void BTFSS(Data.Command com)
{
int b1 = (com.GetHighByte() & 3) << 1;
int b = b1 + (((com.GetLowByte() & 128) == 128) ? 1 : 0);
byte f = (byte)(com.GetLowByte() & 127);
if (Data.GetRegisterBit(Data.AddressResolution(f), b) == true)
{
Data.IncPC();
SkipCycle();
}
}
public static void INCFSZ(Data.Command com)
{
byte d = (byte)(com.GetLowByte() & 128);
byte f = (byte)(com.GetLowByte() & 127);
byte result = (byte)(Data.GetRegister(Data.AddressResolution(f)) + 1);
if (result == 0)
{
Data.IncPC();
SkipCycle();
}
DirectionalWrite(d, f, result);
}
public static void CLRF(Data.Command com)
{
byte f = (byte)(com.GetLowByte() & 127);
Data.SetRegister(Data.AddressResolution(f), 0);
Data.SetRegisterBit(Data.Registers.STATUS, Data.Flags.Status.Z, true);
}
public static void ADDLW(Data.Command com)
{
byte k = com.GetLowByte();
byte result = BitwiseAdd(Data.GetRegisterW(), k);
Data.SetRegisterW(result);
}
public static void SUBLW(Data.Command com)
{
byte k = com.GetLowByte();
byte result = BitwiseSubstract(k, Data.GetRegisterW());
Data.SetRegisterW(result);
}
public static void XORLW(Data.Command com)
{
byte k = com.GetLowByte();
byte result = (byte)(Data.GetRegisterW() ^ k);
CheckZFlag(result);
Data.SetRegisterW(result);
}
public static void RETLW(Data.Command com)
{
byte k = com.GetLowByte();
Data.SetRegisterW(k);
Data.SetPC(Data.PopStack());
Data.SetPCLfromPC();
SkipCycle();
}
public static void GOTO(Data.Command com)
{
byte k1 = com.GetLowByte();
byte k2 = (byte)(com.GetHighByte() & 7);
byte merge = (byte)((Data.GetRegister(Data.Registers.PCLATH) & 24) + k2);
Data.SetPCFromBytes(merge, k1);
Data.SetPCLfromPC();
SkipCycle();
}
public static void MOVWF(Data.Command com)
{
byte f = (byte)(com.GetLowByte() & 127);
Data.SetRegister(Data.AddressResolution(f), Data.GetRegisterW());
}
public static void MOVLW(Data.Command com)
{
byte k = com.GetLowByte();
Data.SetRegisterW(k);
}
