1 files changed, 336 insertions, 0 deletions
diff --git a/ARMeilleure/Instructions/InstEmitSimdMove32.cs b/ARMeilleure/Instructions/InstEmitSimdMove32.cs
new file mode 100644
index 00000000..3fd42cbf
--- /dev/null
+++ b/ARMeilleure/Instructions/InstEmitSimdMove32.cs
@@ -0,0 +1,336 @@
+using ARMeilleure.Decoders;
+using ARMeilleure.IntermediateRepresentation;
+using ARMeilleure.Translation;
+
+using static ARMeilleure.Instructions.InstEmitHelper;
+using static ARMeilleure.Instructions.InstEmitSimdHelper;
+using static ARMeilleure.Instructions.InstEmitSimdHelper32;
+using static ARMeilleure.IntermediateRepresentation.OperandHelper;
+
+namespace ARMeilleure.Instructions
+{
+    static partial class InstEmit32
+    {
+        public static void Vmov_I(ArmEmitterContext context)
+        {
+            EmitVectorImmUnaryOp32(context, (op1) => op1);
+        }
+
+        public static void Vmvn_I(ArmEmitterContext context)
+        {
+            EmitVectorImmUnaryOp32(context, (op1) => context.BitwiseExclusiveOr(op1, op1));
+        }
+
+        public static void Vmov_GS(ArmEmitterContext context)
+        {
+            OpCode32SimdMovGp op = (OpCode32SimdMovGp)context.CurrOp;
+
+            Operand vec = GetVecA32(op.Vn >> 2);
+            if (op.Op == 1)
+            {
+                // To general purpose.
+                Operand value = context.VectorExtract(OperandType.I32, vec, op.Vn & 0x3);
+                SetIntA32(context, op.Rt, value);
+            } 
+            else
+            {
+                // From general purpose.
+                Operand value = GetIntA32(context, op.Rt);
+                context.Copy(vec, context.VectorInsert(vec, value, op.Vn & 0x3));
+            }
+        }
+
+        public static void Vmov_G1(ArmEmitterContext context)
+        {
+            OpCode32SimdMovGpElem op = (OpCode32SimdMovGpElem)context.CurrOp;
+
+            int index = op.Index + ((op.Vd & 1) << (3 - op.Size));
+            if (op.Op == 1)
+            {
+                // To general purpose.
+                Operand value = EmitVectorExtract32(context, op.Vd >> 1, index, op.Size, !op.U);
+                SetIntA32(context, op.Rt, value);
+            }
+            else
+            {
+                // From general purpose.
+                Operand vec = GetVecA32(op.Vd >> 1);
+                Operand value = GetIntA32(context, op.Rt);
+                context.Copy(vec, EmitVectorInsert(context, vec, value, index, op.Size));
+            }
+        }
+
+        public static void Vmov_G2(ArmEmitterContext context)
+        {
+            OpCode32SimdMovGpDouble op = (OpCode32SimdMovGpDouble)context.CurrOp;
+
+            Operand vec = GetVecA32(op.Vm >> 2);
+            int vm1 = op.Vm + 1;
+            bool sameOwnerVec = (op.Vm >> 2) == (vm1 >> 2);
+            Operand vec2 = sameOwnerVec ? vec : GetVecA32(vm1 >> 2);
+            if (op.Op == 1)
+            {
+                // To general purpose.
+                Operand lowValue = context.VectorExtract(OperandType.I32, vec, op.Vm & 3);
+                SetIntA32(context, op.Rt, lowValue);
+
+                Operand highValue = context.VectorExtract(OperandType.I32, vec2, vm1 & 3);
+                SetIntA32(context, op.Rt2, highValue);
+            }
+            else
+            {
+                // From general purpose.
+                Operand lowValue = GetIntA32(context, op.Rt);
+                Operand resultVec = context.VectorInsert(vec, lowValue, op.Vm & 3);
+
+                Operand highValue = GetIntA32(context, op.Rt2);
+
+                if (sameOwnerVec)
+                {
+                    context.Copy(vec, context.VectorInsert(resultVec, highValue, vm1 & 3));
+                } 
+                else
+                {
+                    context.Copy(vec, resultVec);
+                    context.Copy(vec2, context.VectorInsert(vec2, highValue, vm1 & 3));
+                }
+            }
+        }
+
+        public static void Vmov_GD(ArmEmitterContext context)
+        {
+            OpCode32SimdMovGpDouble op = (OpCode32SimdMovGpDouble)context.CurrOp;
+
+            Operand vec = GetVecA32(op.Vm >> 1);
+            if (op.Op == 1)
+            {
+                // To general purpose.
+                Operand value = context.VectorExtract(OperandType.I64, vec, op.Vm & 1);
+                SetIntA32(context, op.Rt, context.ConvertI64ToI32(value));
+                SetIntA32(context, op.Rt2, context.ConvertI64ToI32(context.ShiftRightUI(value, Const(32))));
+            }
+            else
+            {
+                // From general purpose.
+                Operand lowValue = GetIntA32(context, op.Rt);
+                Operand highValue = GetIntA32(context, op.Rt2);
+
+                Operand value = context.BitwiseOr(
+                    context.ZeroExtend32(OperandType.I64, lowValue),
+                    context.ShiftLeft(context.ZeroExtend32(OperandType.I64, highValue), Const(32)));
+
+                context.Copy(vec, context.VectorInsert(vec, value, op.Vm & 1));
+            }
+        }
+
+        public static void Vtbl(ArmEmitterContext context)
+        {
+            OpCode32SimdTbl op = (OpCode32SimdTbl)context.CurrOp;
+
+            bool extension = op.Opc == 1;
+
+            int elems = op.GetBytesCount() >> op.Size;
+
+            int length = op.Length + 1;
+
+            (int Qx, int Ix)[] tableTuples = new (int, int)[length];
+            for (int i = 0; i < length; i++)
+            {
+                (int vn, int en) = GetQuadwordAndSubindex(op.Vn + i, op.RegisterSize);
+                tableTuples[i] = (vn, en);
+            }
+
+            int byteLength = length * 8;
+
+            Operand res = GetVecA32(op.Qd);
+            Operand m = GetVecA32(op.Qm);
+
+            for (int index = 0; index < elems; index++)
+            {
+                Operand selectedIndex = context.ZeroExtend8(OperandType.I32, context.VectorExtract8(m, index + op.Im));
+
+                Operand inRange = context.ICompareLess(selectedIndex, Const(byteLength));
+                Operand elemRes = null; // Note: This is I64 for ease of calculation.
+
+                // TODO: Branching rather than conditional select.
+
+                // Get indexed byte.
+                // To simplify (ha) the il, we get bytes from every vector and use a nested conditional select to choose the right result.
+                // This does have to extract `length` times for every element but certainly not as bad as it could be.
+
+                // Which vector number is the index on.
+                Operand vecIndex = context.ShiftRightUI(selectedIndex, Const(3));
+                // What should we shift by to extract it.
+                Operand subVecIndexShift = context.ShiftLeft(context.BitwiseAnd(selectedIndex, Const(7)), Const(3));
+
+                for (int i = 0; i < length; i++)
+                {
+                    (int qx, int ix) = tableTuples[i];
+                    // Get the whole vector, we'll get a byte out of it.
+                    Operand lookupResult;
+                    if (qx == op.Qd)
+                    {
+                        // Result contains the current state of the vector.
+                        lookupResult = context.VectorExtract(OperandType.I64, res, ix);
+                    } 
+                    else
+                    {
+                        lookupResult = EmitVectorExtract32(context, qx, ix, 3, false); // I64
+                    }
+                    
+                    lookupResult = context.ShiftRightUI(lookupResult, subVecIndexShift); // Get the relevant byte from this vector.
+
+                    if (i == 0)
+                    {
+                        elemRes = lookupResult; // First result is always default.
+                    } 
+                    else
+                    {
+                        Operand isThisElem = context.ICompareEqual(vecIndex, Const(i));
+                        elemRes = context.ConditionalSelect(isThisElem, lookupResult, elemRes);
+                    }
+                }
+
+                Operand fallback = (extension) ? context.ZeroExtend32(OperandType.I64, EmitVectorExtract32(context, op.Qd, index + op.Id, 0, false)) : Const(0L); 
+
+                res = EmitVectorInsert(context, res, context.ConditionalSelect(inRange, elemRes, fallback), index + op.Id, 0);
+            }
+
+            context.Copy(GetVecA32(op.Qd), res);
+        }
+
+        public static void Vtrn(ArmEmitterContext context)
+        {
+            OpCode32SimdCmpZ op = (OpCode32SimdCmpZ)context.CurrOp;
+
+            int elems = op.GetBytesCount() >> op.Size;
+            int pairs = elems >> 1;
+
+            bool overlap = op.Qm == op.Qd;
+
+            Operand resD = GetVecA32(op.Qd);
+            Operand resM = GetVecA32(op.Qm);
+
+            for (int index = 0; index < pairs; index++)
+            {
+                int pairIndex = index << 1;
+                Operand d2 = EmitVectorExtract32(context, op.Qd, pairIndex + 1 + op.Id, op.Size, false);
+                Operand m1 = EmitVectorExtract32(context, op.Qm, pairIndex + op.Im, op.Size, false);
+
+                resD = EmitVectorInsert(context, resD, m1, pairIndex + 1 + op.Id, op.Size);
+
+                if (overlap)
+                {
+                    resM = resD;
+                }
+
+                resM = EmitVectorInsert(context, resM, d2, pairIndex + op.Im, op.Size);
+
+                if (overlap)
+                {
+                    resD = resM;
+                }
+            }
+
+            context.Copy(GetVecA32(op.Qd), resD);
+            if (!overlap)
+            {
+                context.Copy(GetVecA32(op.Qm), resM);
+            }
+        }
+
+        public static void Vzip(ArmEmitterContext context)
+        {
+            OpCode32SimdCmpZ op = (OpCode32SimdCmpZ)context.CurrOp;
+
+            int elems = op.GetBytesCount() >> op.Size;
+            int pairs = elems >> 1;
+
+            bool overlap = op.Qm == op.Qd;
+
+            Operand resD = GetVecA32(op.Qd);
+            Operand resM = GetVecA32(op.Qm);
+
+            for (int index = 0; index < pairs; index++)
+            {
+                int pairIndex = index << 1;
+                Operand dRowD = EmitVectorExtract32(context, op.Qd, index + op.Id, op.Size, false);
+                Operand mRowD = EmitVectorExtract32(context, op.Qm, index + op.Im, op.Size, false);
+
+                Operand dRowM = EmitVectorExtract32(context, op.Qd, index + op.Id + pairs, op.Size, false);
+                Operand mRowM = EmitVectorExtract32(context, op.Qm, index + op.Im + pairs, op.Size, false);
+
+                resD = EmitVectorInsert(context, resD, dRowD, pairIndex + op.Id, op.Size);
+                resD = EmitVectorInsert(context, resD, mRowD, pairIndex + 1 + op.Id, op.Size);
+
+                if (overlap)
+                {
+                    resM = resD;
+                }
+
+                resM = EmitVectorInsert(context, resM, dRowM, pairIndex + op.Im, op.Size);
+                resM = EmitVectorInsert(context, resM, mRowM, pairIndex + 1 + op.Im, op.Size);
+
+                if (overlap)
+                {
+                    resD = resM;
+                }
+            }
+
+            context.Copy(GetVecA32(op.Qd), resD);
+            if (!overlap)
+            {
+                context.Copy(GetVecA32(op.Qm), resM);
+            }
+        }
+
+        public static void Vuzp(ArmEmitterContext context)
+        {
+            OpCode32SimdCmpZ op = (OpCode32SimdCmpZ)context.CurrOp;
+
+            int elems = op.GetBytesCount() >> op.Size;
+            int pairs = elems >> 1;
+
+            bool overlap = op.Qm == op.Qd;
+
+            Operand resD = GetVecA32(op.Qd);
+            Operand resM = GetVecA32(op.Qm);
+
+            for (int index = 0; index < elems; index++)
+            {
+                Operand dIns, mIns;
+                if (index >= pairs)
+                {
+                    int pind = index - pairs;
+                    dIns = EmitVectorExtract32(context, op.Qm, (pind << 1) + op.Im, op.Size, false);
+                    mIns = EmitVectorExtract32(context, op.Qm, ((pind << 1) | 1) + op.Im, op.Size, false);
+                } 
+                else
+                {
+                    dIns = EmitVectorExtract32(context, op.Qd, (index << 1) + op.Id, op.Size, false);
+                    mIns = EmitVectorExtract32(context, op.Qd, ((index << 1) | 1) + op.Id, op.Size, false);
+                }
+
+                resD = EmitVectorInsert(context, resD, dIns, index + op.Id, op.Size);
+
+                if (overlap)
+                {
+                    resM = resD;
+                }
+
+                resM = EmitVectorInsert(context, resM, mIns, index + op.Im, op.Size);
+
+                if (overlap)
+                {
+                    resD = resM;
+                }
+            }
+
+            context.Copy(GetVecA32(op.Qd), resD);
+            if (!overlap)
+            {
+                context.Copy(GetVecA32(op.Qm), resM);
+            }
+        }
+    }
+}