Merge pull request #9977 from JosJuice/jitarm64-mtfsfx

JitArm64: Implement mtfsfx

Source/Core/Common/Arm64Emitter.cpp

@@ -3008,6 +3008,14 @@ void ARM64FloatEmitter::BIC(ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm)
 {
   EmitThreeSame(0, 1, 3, Rd, Rn, Rm);
 }
+void ARM64FloatEmitter::BIF(ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm)
+{
+  EmitThreeSame(1, 3, 3, Rd, Rn, Rm);
+}
+void ARM64FloatEmitter::BIT(ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm)
+{
+  EmitThreeSame(1, 2, 3, Rd, Rn, Rm);
+}
 void ARM64FloatEmitter::BSL(ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm)
 {
   EmitThreeSame(1, 1, 3, Rd, Rn, Rm);

Source/Core/Common/Arm64Emitter.h

@@ -1248,6 +1248,8 @@ public:
   void ADD(u8 size, ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm);
   void AND(ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm);
   void BIC(ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm);
+  void BIF(ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm);
+  void BIT(ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm);
   void BSL(ARM64Reg Rd, ARM64Reg Rn, ARM64Reg Rm);
   void DUP(u8 size, ARM64Reg Rd, ARM64Reg Rn, u8 index);
   void FABS(u8 size, ARM64Reg Rd, ARM64Reg Rn);

Source/Core/Core/PowerPC/JitArm64/Jit.h

@@ -122,6 +122,7 @@ public:
   void mtfsb0x(UGeckoInstruction inst);
   void mtfsb1x(UGeckoInstruction inst);
   void mtfsfix(UGeckoInstruction inst);
+  void mtfsfx(UGeckoInstruction inst);
 
   // LoadStore
   void lXX(UGeckoInstruction inst);

Source/Core/Core/PowerPC/JitArm64/JitArm64_SystemRegisters.cpp

@@ -852,3 +852,44 @@ void JitArm64::mtfsfix(UGeckoInstruction inst)
   if (inst.CRFD == 7)
     UpdateRoundingMode();
 }
+
+void JitArm64::mtfsfx(UGeckoInstruction inst)
+{
+  INSTRUCTION_START
+  JITDISABLE(bJITSystemRegistersOff);
+  FALLBACK_IF(inst.Rc);
+
+  u32 mask = 0;
+  for (int i = 0; i < 8; i++)
+  {
+    if (inst.FM & (1 << i))
+      mask |= 0xFU << (4 * i);
+  }
+
+  if (mask == 0xFFFFFFFF)
+  {
+    ARM64Reg VB = fpr.R(inst.FB, RegType::LowerPair);
+
+    m_float_emit.STR(32, IndexType::Unsigned, VB, PPC_REG, PPCSTATE_OFF(fpscr));
+  }
+  else if (mask != 0)
+  {
+    ARM64Reg VB = fpr.R(inst.FB, RegType::LowerPair);
+
+    ARM64Reg V0 = fpr.GetReg();
+    ARM64Reg V1 = fpr.GetReg();
+    ARM64Reg WA = gpr.GetReg();
+
+    m_float_emit.LDR(32, IndexType::Unsigned, V0, PPC_REG, PPCSTATE_OFF(fpscr));
+    MOVI2R(WA, mask);
+    m_float_emit.FMOV(EncodeRegToSingle(V1), WA);
+    m_float_emit.BIT(EncodeRegToDouble(V0), EncodeRegToDouble(VB), EncodeRegToDouble(V1));
+    m_float_emit.STR(32, IndexType::Unsigned, V0, PPC_REG, PPCSTATE_OFF(fpscr));
+
+    fpr.Unlock(V0, V1);
+    gpr.Unlock(WA);
+  }
+
+  if (inst.FM & 1)
+    UpdateRoundingMode();
+}

Source/Core/Core/PowerPC/JitArm64/JitArm64_Tables.cpp

@@ -319,7 +319,7 @@ constexpr std::array<GekkoOPTemplate, 15> table63{{
     {70, &JitArm64::mtfsb0x},   // mtfsb0x
     {38, &JitArm64::mtfsb1x},   // mtfsb1x
     {134, &JitArm64::mtfsfix},  // mtfsfix
-    {711, &JitArm64::FallBackToInterpreter},  // mtfsfx
+    {711, &JitArm64::mtfsfx},   // mtfsfx
 }};
 
 constexpr std::array<GekkoOPTemplate, 10> table63_2{{