1 files changed, 100 insertions, 0 deletions
diff --git a/ARMeilleure/Instructions/InstEmitMul.cs b/ARMeilleure/Instructions/InstEmitMul.cs
new file mode 100644
index 00000000..65d11b30
--- /dev/null
+++ b/ARMeilleure/Instructions/InstEmitMul.cs
@@ -0,0 +1,100 @@
+using ARMeilleure.Decoders;
+using ARMeilleure.IntermediateRepresentation;
+using ARMeilleure.Translation;
+using System;
+
+using static ARMeilleure.Instructions.InstEmitHelper;
+
+namespace ARMeilleure.Instructions
+{
+    static partial class InstEmit
+    {
+        public static void Madd(ArmEmitterContext context) => EmitMul(context, isAdd: true);
+        public static void Msub(ArmEmitterContext context) => EmitMul(context, isAdd: false);
+
+        private static void EmitMul(ArmEmitterContext context, bool isAdd)
+        {
+            OpCodeMul op = (OpCodeMul)context.CurrOp;
+
+            Operand a = GetIntOrZR(context, op.Ra);
+            Operand n = GetIntOrZR(context, op.Rn);
+            Operand m = GetIntOrZR(context, op.Rm);
+
+            Operand res = context.Multiply(n, m);
+
+            res = isAdd ? context.Add(a, res) : context.Subtract(a, res);
+
+            SetIntOrZR(context, op.Rd, res);
+        }
+
+        public static void Smaddl(ArmEmitterContext context) => EmitMull(context, MullFlags.SignedAdd);
+        public static void Smsubl(ArmEmitterContext context) => EmitMull(context, MullFlags.SignedSubtract);
+        public static void Umaddl(ArmEmitterContext context) => EmitMull(context, MullFlags.Add);
+        public static void Umsubl(ArmEmitterContext context) => EmitMull(context, MullFlags.Subtract);
+
+        [Flags]
+        private enum MullFlags
+        {
+            Subtract = 0,
+            Add      = 1 << 0,
+            Signed   = 1 << 1,
+
+            SignedAdd      = Signed | Add,
+            SignedSubtract = Signed | Subtract
+        }
+
+        private static void EmitMull(ArmEmitterContext context, MullFlags flags)
+        {
+            OpCodeMul op = (OpCodeMul)context.CurrOp;
+
+            Operand GetExtendedRegister32(int index)
+            {
+                Operand value = GetIntOrZR(context, index);
+
+                if ((flags & MullFlags.Signed) != 0)
+                {
+                    return context.SignExtend32(value.Type, value);
+                }
+                else
+                {
+                    return context.ZeroExtend32(value.Type, value);
+                }
+            }
+
+            Operand a = GetIntOrZR(context, op.Ra);
+
+            Operand n = GetExtendedRegister32(op.Rn);
+            Operand m = GetExtendedRegister32(op.Rm);
+
+            Operand res = context.Multiply(n, m);
+
+            res = (flags & MullFlags.Add) != 0 ? context.Add(a, res) : context.Subtract(a, res);
+
+            SetIntOrZR(context, op.Rd, res);
+        }
+
+        public static void Smulh(ArmEmitterContext context)
+        {
+            OpCodeMul op = (OpCodeMul)context.CurrOp;
+
+            Operand n = GetIntOrZR(context, op.Rn);
+            Operand m = GetIntOrZR(context, op.Rm);
+
+            Operand d = context.Multiply64HighSI(n, m);
+
+            SetIntOrZR(context, op.Rd, d);
+        }
+
+        public static void Umulh(ArmEmitterContext context)
+        {
+            OpCodeMul op = (OpCodeMul)context.CurrOp;
+
+            Operand n = GetIntOrZR(context, op.Rn);
+            Operand m = GetIntOrZR(context, op.Rm);
+
+            Operand d = context.Multiply64HighUI(n, m);
+
+            SetIntOrZR(context, op.Rd, d);
+        }
+    }
+}
+\ No newline at end of file