private void Inst_Dmtc1(MipsInstruction inst) { if (!CheckCop1Usable()) { CauseException = ExceptionCode.CopUnstable; return; } if (!CheckEvenOddAllowed(inst.Fs)) { CauseFPUException(FPUExceptionType.Unimplemented); return; } UInt64 value = MipsState.ReadGPRUnsigned(inst.Rt); if (MipsState.CP0Regs.StatusReg.AdditionalFPR) { MipsState.Fpr.WriteFPRUnsigned(inst.Fs, value); } else { MipsState.Fpr.WriteFPR32Unsigned(inst.Fs + 1, (UInt32)(value >> 32)); MipsState.Fpr.WriteFPR32Unsigned(inst.Fs, (UInt32)(value & 0xFFFFFFFF)); } }
private void Inst_Sltu(MipsInstruction inst) { if (!MipsState.Operating64BitMode) { if (MipsState.ReadGPR32Unsigned(inst.Rs) < MipsState.ReadGPR32Unsigned(inst.Rt)) { MipsState.GPRRegs[inst.Rd] = 1; } else { MipsState.GPRRegs[inst.Rd] = 0; } } else { if (MipsState.ReadGPRUnsigned(inst.Rs) < MipsState.ReadGPRUnsigned(inst.Rt)) { MipsState.GPRRegs[inst.Rd] = 1; } else { MipsState.GPRRegs[inst.Rd] = 0; } } }
private void Inst_Add(MipsInstruction inst) { if (!MipsState.Operating64BitMode) { try { MipsState.WriteGPR32Signed(inst.Rd, MipsState.ReadGPR32Signed(inst.Rs) + MipsState.ReadGPR32Signed(inst.Rt)); } catch (OverflowException) { CauseException = ExceptionCode.OverFlow; } } else { if (MipsState.ReadGPRUnsigned(inst.Rs).IsSigned32() && MipsState.ReadGPRUnsigned(inst.Rt).IsSigned32()) { try { MipsState.WriteGPRSigned(inst.Rd, MipsState.ReadGPRSigned(inst.Rs) + MipsState.ReadGPRSigned(inst.Rt)); } catch (OverflowException) { CauseException = ExceptionCode.OverFlow; } } } }
private void Inst_Mtc0(MipsInstruction inst) { if (MipsState.CP0Regs.StatusReg.CopUsable0) { var regType = (CP0RegName)inst.Rd; switch (regType) { default: MipsState.CP0Regs[inst.Rd] = MipsState.ReadGPRUnsigned(inst.Rt); break; case CP0RegName.Count: { UInt32 count = (UInt32)MipsState.CP0Regs[inst.Rd]; UInt32 newCount = (UInt32)MipsState.ReadGPRUnsigned(inst.Rt); MipsState.CP0Regs.Count = newCount; MupenHelper.UpdateCount(); if (MupenHelper.NextInterrupt <= count) { MupenHelper.GenInterrupt(); } MupenHelper.TranslateEventQueue(newCount); break; } case CP0RegName.Compare: { UInt32 newCompare = (UInt32)MipsState.ReadGPRUnsigned(inst.Rt); MipsState.CP0Regs.Compare = newCompare; MupenHelper.UpdateCount(); MupenHelper.RemoveEvent(MupenHelper.COMPARE_INT); MupenHelper.AddInterruptEventCount(MupenHelper.COMPARE_INT, newCompare); MipsState.CP0Regs.Cause &= 0xFFFF7FFFU; break; } case CP0RegName.SR: { UInt32 newStatus = (UInt32)MipsState.ReadGPRUnsigned(inst.Rt); MipsState.CP0Regs.Status = newStatus; MupenHelper.UpdateCount(); MupenHelper.CheckInterrupt(); if (MupenHelper.NextInterrupt <= MipsState.CP0Regs.Count) { MupenHelper.GenInterrupt(); } break; } } } else { CauseException = ExceptionCode.CopUnstable; } }
private void Inst_Dmtc0(MipsInstruction inst) { if (MipsState.Operating64BitMode) { MipsState.CP0Regs[inst.Rd] = MipsState.ReadGPRUnsigned(inst.Rt); } else { CauseException = ExceptionCode.ReservedInstruction; } }
private void Inst_Bnel(MipsInstruction inst) { if (!MipsState.Operating64BitMode) { DoBranchLikely(MipsState.ReadGPR32Unsigned(inst.Rs) != MipsState.ReadGPR32Unsigned(inst.Rt), inst); } else { DoBranchLikely(MipsState.ReadGPRUnsigned(inst.Rs) != MipsState.ReadGPRUnsigned(inst.Rt), inst); } }
private void Inst_Dsrl32(MipsInstruction inst) { if (MipsState.Operating64BitMode) { MipsState.WriteGPRUnsigned(inst.Rd, MipsState.ReadGPRUnsigned(inst.Rt) >> (32 + inst.ShiftAmount)); } else { CauseException = ExceptionCode.ReservedInstruction; } }
private void Inst_Dsrlv(MipsInstruction inst) { if (MipsState.Operating64BitMode) { MipsState.WriteGPRUnsigned(inst.Rd, MipsState.ReadGPRUnsigned(inst.Rt) >> (Int32)(MipsState.ReadGPR32Unsigned(inst.Rs) & 0x3FUL)); } else { CauseException = ExceptionCode.ReservedInstruction; } }
private void Inst_Xor(MipsInstruction inst) { if (!MipsState.Operating64BitMode) { MipsState.WriteGPR32Unsigned(inst.Rd, MipsState.ReadGPR32Unsigned(inst.Rs) ^ MipsState.ReadGPR32Unsigned(inst.Rt)); } else { MipsState.WriteGPRUnsigned(inst.Rd, MipsState.ReadGPRUnsigned(inst.Rs) ^ MipsState.ReadGPRUnsigned(inst.Rt)); } }
private void Inst_Andi(MipsInstruction inst) { if (!MipsState.Operating64BitMode) { MipsState.WriteGPR32Unsigned(inst.Rt, MipsState.ReadGPR32Unsigned(inst.Rs) & (UInt32)inst.Immediate); } else { MipsState.WriteGPRUnsigned(inst.Rt, MipsState.ReadGPRUnsigned(inst.Rs) & (UInt64)inst.Immediate); } }
private void Inst_Sh(MipsInstruction inst) { Int64 address = ComputeAddress(inst); if ((address & 1) != 0) { CauseException = ExceptionCode.AddressErrorStore; return; } DataManipulator.Store(address, (UInt16)MipsState.ReadGPRUnsigned(inst.Rt)); }
private void Inst_Sltiu(MipsInstruction inst) { if (!MipsState.Operating64BitMode) { Boolean condition = MipsState.ReadGPR32Unsigned(inst.Rs) < ((UInt32)(Int32)(Int16)inst.Immediate); MipsState.WriteGPR32Unsigned(inst.Rt, condition ? 1U : 0U); } else { Boolean condition = MipsState.ReadGPRUnsigned(inst.Rs) < ((UInt64)(Int64)(Int16)inst.Immediate); MipsState.WriteGPRUnsigned(inst.Rt, condition ? 1UL : 0UL); } }
private void Inst_Dsubu(MipsInstruction inst) { if (MipsState.Operating64BitMode) { unchecked { MipsState.WriteGPRUnsigned(inst.Rd, MipsState.ReadGPRUnsigned(inst.Rs) - MipsState.ReadGPRUnsigned(inst.Rt)); } } else { CauseException = ExceptionCode.ReservedInstruction; } }
private void Inst_Daddiu(MipsInstruction inst) { if (!MipsState.Operating64BitMode) { CauseException = ExceptionCode.ReservedInstruction; } else { unchecked { MipsState.WriteGPRUnsigned(inst.Rd, MipsState.ReadGPRUnsigned(inst.Rs) + (UInt64)(Int64)(Int16)inst.Immediate); } } }
private void Inst_Dmultu(MipsInstruction inst) { if (MipsState.Operating64BitMode) { BigInteger product = BigInteger.Multiply( new BigInteger(MipsState.ReadGPRUnsigned(inst.Rs)), new BigInteger(MipsState.ReadGPRUnsigned(inst.Rt))); MipsState.Lo = (UInt64)(product & 0xFFFFFFFFFFFFFFFFUL); MipsState.Hi = (UInt64)((product >> 64) & 0xFFFFFFFFFFFFFFFFUL); } else { CauseException = ExceptionCode.ReservedInstruction; } }
private void Inst_Ldr(MipsInstruction inst) { if (MipsState.Operating64BitMode) { /* Thanks to PJ64 Implementation */ Int64 address = ComputeAddress(inst); Int32 offset = (Int32)(address & 7); UInt64 value = DataManipulator.LoadDoublewordUnsigned(address & ~7); MipsState.WriteGPRUnsigned(inst.Rt, MipsState.ReadGPRUnsigned(inst.Rt) & LDRMask[offset]); MipsState.WriteGPRUnsigned(inst.Rt, MipsState.ReadGPRUnsigned(inst.Rt) + (value >> LDRShift[offset])); } else { CauseException = ExceptionCode.ReservedInstruction; } }
private void Inst_Addiu(MipsInstruction inst) { unchecked { if (!MipsState.Operating64BitMode) { MipsState.WriteGPR32Unsigned(inst.Rt, MipsState.ReadGPR32Unsigned(inst.Rs) + (UInt32)(Int32)(Int16)inst.Immediate); } else { if (MipsState.ReadGPRUnsigned(inst.Rs).IsSigned32()) { MipsState.WriteGPRUnsigned(inst.Rt, MipsState.ReadGPRUnsigned(inst.Rs) + (UInt64)(Int64)(Int16)inst.Immediate); } } } }
private void Inst_Sdr(MipsInstruction inst) { if (MipsState.Operating64BitMode) { /* Thanks to PJ64 implementation */ Int64 address = ComputeAddress(inst); Int32 offset = (Int32)(address & 7); UInt64 value = DataManipulator.LoadDoublewordUnsigned(address & ~7); value &= SDRMask[offset]; value += MipsState.ReadGPRUnsigned(inst.Rt) << SDLShift[offset]; DataManipulator.Store(address & ~7, value); } else { CauseException = ExceptionCode.ReservedInstruction; } }
private void Inst_Addu(MipsInstruction inst) { unchecked { if (!MipsState.Operating64BitMode) { MipsState.WriteGPR32Unsigned(inst.Rd, MipsState.ReadGPR32Unsigned(inst.Rs) + MipsState.ReadGPR32Unsigned(inst.Rt)); } else { if (MipsState.ReadGPRUnsigned(inst.Rs).IsSigned32() && MipsState.ReadGPRUnsigned(inst.Rt).IsSigned32()) { MipsState.WriteGPRUnsigned(inst.Rd, MipsState.ReadGPRUnsigned(inst.Rs) + MipsState.ReadGPRUnsigned(inst.Rt)); } } } }
private void Inst_Tltiu(MipsInstruction inst) { Boolean condition; if (!MipsState.Operating64BitMode) { condition = MipsState.ReadGPR32Unsigned(inst.Rs) < (UInt32)(Int32)(Int16)inst.Immediate; } else { condition = MipsState.ReadGPRUnsigned(inst.Rs) < (UInt64)(Int64)(Int16)inst.Immediate; } if (condition) { CauseException = ExceptionCode.Trap; } }
private void Inst_Sd(MipsInstruction inst) { if (!MipsState.Operating64BitMode) { throw new InvalidOperationException("Instruction reserved"); } Int64 address = (MipsState.ReadGPRSigned(inst.Rs) + (Int64)inst.Immediate); if ((address & 7) != 0) { CauseException = ExceptionCode.AddressErrorStore; } else { DataManipulator.Store(address, MipsState.ReadGPRUnsigned(inst.Rt)); } }
private void Inst_Teq(MipsInstruction inst) { Boolean condition; if (!MipsState.Operating64BitMode) { condition = MipsState.ReadGPR32Unsigned(inst.Rs) == MipsState.ReadGPR32Unsigned(inst.Rt); } else { condition = MipsState.ReadGPRUnsigned(inst.Rs) == MipsState.ReadGPRUnsigned(inst.Rt); } if (condition) { CauseException = ExceptionCode.Trap; } }
private void Inst_Divu(MipsInstruction inst) { try { unchecked { if (!MipsState.Operating64BitMode || (MipsState.ReadGPRUnsigned(inst.Rs).IsSigned32() && MipsState.ReadGPRUnsigned(inst.Rt).IsSigned32())) { /* Data input is always the size of a MIPS word */ MipsState.Hi = (UInt64)(MipsState.ReadGPR32Unsigned(inst.Rs) / MipsState.ReadGPR32Unsigned(inst.Rt)); MipsState.Lo = (UInt64)(MipsState.ReadGPR32Unsigned(inst.Rs) % MipsState.ReadGPR32Unsigned(inst.Rt)); } } } catch (DivideByZeroException) { MipsState.Hi = 0; MipsState.Lo = 0; return; } }
private void Inst_Sllv(MipsInstruction inst) { Int32 shiftAmount = MipsState.ReadGPR32Signed(inst.Rs) & 0x1F; if (!MipsState.Operating64BitMode) { MipsState.WriteGPR32Unsigned(inst.Rd, MipsState.ReadGPR32Unsigned(inst.Rt) << shiftAmount); } else { UInt64 result = MipsState.ReadGPRUnsigned(inst.Rt) << shiftAmount; /* Truncate */ if (shiftAmount == 0) { MipsState.WriteGPRSigned(inst.Rd, (Int32)(UInt32)result); } else { MipsState.WriteGPRUnsigned(inst.Rd, result); } } }
private void Inst_Sb(MipsInstruction inst) { Int64 address = ComputeAddress(inst); DataManipulator.Store(address, MipsState.ReadGPRUnsigned(inst.Rt) & 0xFF); }
private void Inst_Nor(MipsInstruction inst) { MipsState.WriteGPRUnsigned(inst.Rd, ~(MipsState.ReadGPRUnsigned(inst.Rs) | MipsState.ReadGPRUnsigned(inst.Rt))); }
private void Inst_Mtlo(MipsInstruction inst) { MipsState.Lo = MipsState.ReadGPRUnsigned(inst.Rs); }