| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878 |
- using ChocolArm64.Decoder;
- using ChocolArm64.State;
- using ChocolArm64.Translation;
- using System;
- using System.Reflection;
- using System.Runtime.Intrinsics;
- using System.Runtime.Intrinsics.X86;
- namespace ChocolArm64.Instruction
- {
- static class AInstEmitSimdHelper
- {
- [Flags]
- public enum OperFlags
- {
- Rd = 1 << 0,
- Rn = 1 << 1,
- Rm = 1 << 2,
- Ra = 1 << 3,
- RnRm = Rn | Rm,
- RdRn = Rd | Rn,
- RaRnRm = Ra | Rn | Rm,
- RdRnRm = Rd | Rn | Rm
- }
- public static int GetImmShl(AOpCodeSimdShImm Op)
- {
- return Op.Imm - (8 << Op.Size);
- }
- public static int GetImmShr(AOpCodeSimdShImm Op)
- {
- return (8 << (Op.Size + 1)) - Op.Imm;
- }
- public static void EmitSse2Call(AILEmitterCtx Context, string Name)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- void Ldvec(int Reg)
- {
- Context.EmitLdvec(Reg);
- switch (Op.Size)
- {
- case 0: AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorSingleToSByte)); break;
- case 1: AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorSingleToInt16)); break;
- case 2: AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorSingleToInt32)); break;
- case 3: AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorSingleToInt64)); break;
- }
- }
- Ldvec(Op.Rn);
- Type BaseType = null;
- Type[] Types;
- switch (Op.Size)
- {
- case 0: BaseType = typeof(Vector128<sbyte>); break;
- case 1: BaseType = typeof(Vector128<short>); break;
- case 2: BaseType = typeof(Vector128<int>); break;
- case 3: BaseType = typeof(Vector128<long>); break;
- }
- if (Op is AOpCodeSimdReg BinOp)
- {
- Ldvec(BinOp.Rm);
- Types = new Type[] { BaseType, BaseType };
- }
- else
- {
- Types = new Type[] { BaseType };
- }
- Context.EmitCall(typeof(Sse2).GetMethod(Name, Types));
- switch (Op.Size)
- {
- case 0: AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorSByteToSingle)); break;
- case 1: AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInt16ToSingle)); break;
- case 2: AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInt32ToSingle)); break;
- case 3: AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInt64ToSingle)); break;
- }
- Context.EmitStvec(Op.Rd);
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void EmitSse2CallF(AILEmitterCtx Context, string Name)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- void Ldvec(int Reg)
- {
- Context.EmitLdvec(Reg);
- if (SizeF == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorSingleToDouble));
- }
- }
- Ldvec(Op.Rn);
- Type BaseType = SizeF == 0
- ? typeof(Vector128<float>)
- : typeof(Vector128<double>);
- Type[] Types;
- if (Op is AOpCodeSimdReg BinOp)
- {
- Ldvec(BinOp.Rm);
- Types = new Type[] { BaseType, BaseType };
- }
- else
- {
- Types = new Type[] { BaseType };
- }
- MethodInfo MthdInfo;
- if (SizeF == 0)
- {
- MthdInfo = typeof(Sse).GetMethod(Name, Types);
- }
- else /* if (SizeF == 1) */
- {
- MthdInfo = typeof(Sse2).GetMethod(Name, Types);
- }
- Context.EmitCall(MthdInfo);
- if (SizeF == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorDoubleToSingle));
- }
- Context.EmitStvec(Op.Rd);
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void EmitUnaryMathCall(AILEmitterCtx Context, string Name)
- {
- IAOpCodeSimd Op = (IAOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- MethodInfo MthdInfo;
- if (SizeF == 0)
- {
- MthdInfo = typeof(MathF).GetMethod(Name, new Type[] { typeof(float) });
- }
- else /* if (SizeF == 1) */
- {
- MthdInfo = typeof(Math).GetMethod(Name, new Type[] { typeof(double) });
- }
- Context.EmitCall(MthdInfo);
- }
- public static void EmitBinaryMathCall(AILEmitterCtx Context, string Name)
- {
- IAOpCodeSimd Op = (IAOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- MethodInfo MthdInfo;
- if (SizeF == 0)
- {
- MthdInfo = typeof(MathF).GetMethod(Name, new Type[] { typeof(float), typeof(float) });
- }
- else /* if (SizeF == 1) */
- {
- MthdInfo = typeof(Math).GetMethod(Name, new Type[] { typeof(double), typeof(double) });
- }
- Context.EmitCall(MthdInfo);
- }
- public static void EmitRoundMathCall(AILEmitterCtx Context, MidpointRounding RoundMode)
- {
- IAOpCodeSimd Op = (IAOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- Context.EmitLdc_I4((int)RoundMode);
- MethodInfo MthdInfo;
- Type[] Types = new Type[] { null, typeof(MidpointRounding) };
- Types[0] = SizeF == 0
- ? typeof(float)
- : typeof(double);
- if (SizeF == 0)
- {
- MthdInfo = typeof(MathF).GetMethod(nameof(MathF.Round), Types);
- }
- else /* if (SizeF == 1) */
- {
- MthdInfo = typeof(Math).GetMethod(nameof(Math.Round), Types);
- }
- Context.EmitCall(MthdInfo);
- }
- public static void EmitUnarySoftFloatCall(AILEmitterCtx Context, string Name)
- {
- IAOpCodeSimd Op = (IAOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- MethodInfo MthdInfo;
- if (SizeF == 0)
- {
- MthdInfo = typeof(ASoftFloat).GetMethod(Name, new Type[] { typeof(float) });
- }
- else /* if (SizeF == 1) */
- {
- MthdInfo = typeof(ASoftFloat).GetMethod(Name, new Type[] { typeof(double) });
- }
- Context.EmitCall(MthdInfo);
- }
- public static void EmitScalarBinaryOpByElemF(AILEmitterCtx Context, Action Emit)
- {
- AOpCodeSimdRegElemF Op = (AOpCodeSimdRegElemF)Context.CurrOp;
- EmitScalarOpByElemF(Context, Emit, Op.Index, Ternary: false);
- }
- public static void EmitScalarOpByElemF(AILEmitterCtx Context, Action Emit, int Elem, bool Ternary)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int SizeF = Op.Size & 1;
- if (Ternary)
- {
- EmitVectorExtractF(Context, Op.Rd, 0, SizeF);
- }
- EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
- EmitVectorExtractF(Context, Op.Rm, Elem, SizeF);
- Emit();
- EmitScalarSetF(Context, Op.Rd, SizeF);
- }
- public static void EmitScalarUnaryOpSx(AILEmitterCtx Context, Action Emit)
- {
- EmitScalarOp(Context, Emit, OperFlags.Rn, true);
- }
- public static void EmitScalarBinaryOpSx(AILEmitterCtx Context, Action Emit)
- {
- EmitScalarOp(Context, Emit, OperFlags.RnRm, true);
- }
- public static void EmitScalarUnaryOpZx(AILEmitterCtx Context, Action Emit)
- {
- EmitScalarOp(Context, Emit, OperFlags.Rn, false);
- }
- public static void EmitScalarBinaryOpZx(AILEmitterCtx Context, Action Emit)
- {
- EmitScalarOp(Context, Emit, OperFlags.RnRm, false);
- }
- public static void EmitScalarTernaryOpZx(AILEmitterCtx Context, Action Emit)
- {
- EmitScalarOp(Context, Emit, OperFlags.RdRnRm, false);
- }
- public static void EmitScalarOp(AILEmitterCtx Context, Action Emit, OperFlags Opers, bool Signed)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- if (Opers.HasFlag(OperFlags.Rd))
- {
- EmitVectorExtract(Context, Op.Rd, 0, Op.Size, Signed);
- }
- if (Opers.HasFlag(OperFlags.Rn))
- {
- EmitVectorExtract(Context, Op.Rn, 0, Op.Size, Signed);
- }
- if (Opers.HasFlag(OperFlags.Rm))
- {
- EmitVectorExtract(Context, ((AOpCodeSimdReg)Op).Rm, 0, Op.Size, Signed);
- }
- Emit();
- EmitScalarSet(Context, Op.Rd, Op.Size);
- }
- public static void EmitScalarUnaryOpF(AILEmitterCtx Context, Action Emit)
- {
- EmitScalarOpF(Context, Emit, OperFlags.Rn);
- }
- public static void EmitScalarBinaryOpF(AILEmitterCtx Context, Action Emit)
- {
- EmitScalarOpF(Context, Emit, OperFlags.RnRm);
- }
- public static void EmitScalarTernaryRaOpF(AILEmitterCtx Context, Action Emit)
- {
- EmitScalarOpF(Context, Emit, OperFlags.RaRnRm);
- }
- public static void EmitScalarOpF(AILEmitterCtx Context, Action Emit, OperFlags Opers)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- if (Opers.HasFlag(OperFlags.Ra))
- {
- EmitVectorExtractF(Context, ((AOpCodeSimdReg)Op).Ra, 0, SizeF);
- }
- if (Opers.HasFlag(OperFlags.Rn))
- {
- EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
- }
- if (Opers.HasFlag(OperFlags.Rm))
- {
- EmitVectorExtractF(Context, ((AOpCodeSimdReg)Op).Rm, 0, SizeF);
- }
- Emit();
- EmitScalarSetF(Context, Op.Rd, SizeF);
- }
- public static void EmitVectorUnaryOpF(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorOpF(Context, Emit, OperFlags.Rn);
- }
- public static void EmitVectorBinaryOpF(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorOpF(Context, Emit, OperFlags.RnRm);
- }
- public static void EmitVectorTernaryOpF(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorOpF(Context, Emit, OperFlags.RdRnRm);
- }
- public static void EmitVectorOpF(AILEmitterCtx Context, Action Emit, OperFlags Opers)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- for (int Index = 0; Index < (Bytes >> SizeF + 2); Index++)
- {
- if (Opers.HasFlag(OperFlags.Rd))
- {
- EmitVectorExtractF(Context, Op.Rd, Index, SizeF);
- }
- if (Opers.HasFlag(OperFlags.Rn))
- {
- EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
- }
- if (Opers.HasFlag(OperFlags.Rm))
- {
- EmitVectorExtractF(Context, ((AOpCodeSimdReg)Op).Rm, Index, SizeF);
- }
- Emit();
- EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
- }
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void EmitVectorBinaryOpByElemF(AILEmitterCtx Context, Action Emit)
- {
- AOpCodeSimdRegElemF Op = (AOpCodeSimdRegElemF)Context.CurrOp;
- EmitVectorOpByElemF(Context, Emit, Op.Index, Ternary: false);
- }
- public static void EmitVectorTernaryOpByElemF(AILEmitterCtx Context, Action Emit)
- {
- AOpCodeSimdRegElemF Op = (AOpCodeSimdRegElemF)Context.CurrOp;
- EmitVectorOpByElemF(Context, Emit, Op.Index, Ternary: true);
- }
- public static void EmitVectorOpByElemF(AILEmitterCtx Context, Action Emit, int Elem, bool Ternary)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int SizeF = Op.Size & 1;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- for (int Index = 0; Index < (Bytes >> SizeF + 2); Index++)
- {
- if (Ternary)
- {
- EmitVectorExtractF(Context, Op.Rd, Index, SizeF);
- }
- EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
- EmitVectorExtractF(Context, Op.Rm, Elem, SizeF);
- Emit();
- EmitVectorInsertTmpF(Context, Index, SizeF);
- }
- Context.EmitLdvectmp();
- Context.EmitStvec(Op.Rd);
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void EmitVectorUnaryOpSx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorOp(Context, Emit, OperFlags.Rn, true);
- }
- public static void EmitVectorBinaryOpSx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorOp(Context, Emit, OperFlags.RnRm, true);
- }
- public static void EmitVectorUnaryOpZx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorOp(Context, Emit, OperFlags.Rn, false);
- }
- public static void EmitVectorBinaryOpZx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorOp(Context, Emit, OperFlags.RnRm, false);
- }
- public static void EmitVectorTernaryOpZx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorOp(Context, Emit, OperFlags.RdRnRm, false);
- }
- public static void EmitVectorOp(AILEmitterCtx Context, Action Emit, OperFlags Opers, bool Signed)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- for (int Index = 0; Index < (Bytes >> Op.Size); Index++)
- {
- if (Opers.HasFlag(OperFlags.Rd))
- {
- EmitVectorExtract(Context, Op.Rd, Index, Op.Size, Signed);
- }
- if (Opers.HasFlag(OperFlags.Rn))
- {
- EmitVectorExtract(Context, Op.Rn, Index, Op.Size, Signed);
- }
- if (Opers.HasFlag(OperFlags.Rm))
- {
- EmitVectorExtract(Context, ((AOpCodeSimdReg)Op).Rm, Index, Op.Size, Signed);
- }
- Emit();
- EmitVectorInsert(Context, Op.Rd, Index, Op.Size);
- }
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void EmitVectorBinaryOpByElemSx(AILEmitterCtx Context, Action Emit)
- {
- AOpCodeSimdRegElem Op = (AOpCodeSimdRegElem)Context.CurrOp;
- EmitVectorOpByElem(Context, Emit, Op.Index, false, true);
- }
- public static void EmitVectorBinaryOpByElemZx(AILEmitterCtx Context, Action Emit)
- {
- AOpCodeSimdRegElem Op = (AOpCodeSimdRegElem)Context.CurrOp;
- EmitVectorOpByElem(Context, Emit, Op.Index, false, false);
- }
- public static void EmitVectorTernaryOpByElemZx(AILEmitterCtx Context, Action Emit)
- {
- AOpCodeSimdRegElem Op = (AOpCodeSimdRegElem)Context.CurrOp;
- EmitVectorOpByElem(Context, Emit, Op.Index, true, false);
- }
- public static void EmitVectorOpByElem(AILEmitterCtx Context, Action Emit, int Elem, bool Ternary, bool Signed)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- for (int Index = 0; Index < (Bytes >> Op.Size); Index++)
- {
- if (Ternary)
- {
- EmitVectorExtract(Context, Op.Rd, Index, Op.Size, Signed);
- }
- EmitVectorExtract(Context, Op.Rn, Index, Op.Size, Signed);
- EmitVectorExtract(Context, Op.Rm, Elem, Op.Size, Signed);
- Emit();
- EmitVectorInsertTmp(Context, Index, Op.Size);
- }
- Context.EmitLdvectmp();
- Context.EmitStvec(Op.Rd);
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void EmitVectorImmUnaryOp(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorImmOp(Context, Emit, false);
- }
- public static void EmitVectorImmBinaryOp(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorImmOp(Context, Emit, true);
- }
- public static void EmitVectorImmOp(AILEmitterCtx Context, Action Emit, bool Binary)
- {
- AOpCodeSimdImm Op = (AOpCodeSimdImm)Context.CurrOp;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- for (int Index = 0; Index < (Bytes >> Op.Size); Index++)
- {
- if (Binary)
- {
- EmitVectorExtractZx(Context, Op.Rd, Index, Op.Size);
- }
- Context.EmitLdc_I8(Op.Imm);
- Emit();
- EmitVectorInsert(Context, Op.Rd, Index, Op.Size);
- }
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void EmitVectorWidenRmBinaryOpSx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorWidenRmBinaryOp(Context, Emit, true);
- }
- public static void EmitVectorWidenRmBinaryOpZx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorWidenRmBinaryOp(Context, Emit, false);
- }
- public static void EmitVectorWidenRmBinaryOp(AILEmitterCtx Context, Action Emit, bool Signed)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- Context.EmitLdvec(Op.Rd);
- Context.EmitStvectmp();
- int Elems = 8 >> Op.Size;
- int Part = Op.RegisterSize == ARegisterSize.SIMD128 ? Elems : 0;
- for (int Index = 0; Index < Elems; Index++)
- {
- EmitVectorExtract(Context, Op.Rn, Index, Op.Size + 1, Signed);
- EmitVectorExtract(Context, Op.Rm, Part + Index, Op.Size, Signed);
- Emit();
- EmitVectorInsertTmp(Context, Index, Op.Size + 1);
- }
- Context.EmitLdvectmp();
- Context.EmitStvec(Op.Rd);
- }
- public static void EmitVectorWidenRnRmBinaryOpSx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorWidenRnRmOp(Context, Emit, false, true);
- }
- public static void EmitVectorWidenRnRmBinaryOpZx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorWidenRnRmOp(Context, Emit, false, false);
- }
- public static void EmitVectorWidenRnRmTernaryOpSx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorWidenRnRmOp(Context, Emit, true, true);
- }
- public static void EmitVectorWidenRnRmTernaryOpZx(AILEmitterCtx Context, Action Emit)
- {
- EmitVectorWidenRnRmOp(Context, Emit, true, false);
- }
- public static void EmitVectorWidenRnRmOp(AILEmitterCtx Context, Action Emit, bool Ternary, bool Signed)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- Context.EmitLdvec(Op.Rd);
- Context.EmitStvectmp();
- int Elems = 8 >> Op.Size;
- int Part = Op.RegisterSize == ARegisterSize.SIMD128 ? Elems : 0;
- for (int Index = 0; Index < Elems; Index++)
- {
- if (Ternary)
- {
- EmitVectorExtract(Context, Op.Rd, Index, Op.Size + 1, Signed);
- }
- EmitVectorExtract(Context, Op.Rn, Part + Index, Op.Size, Signed);
- EmitVectorExtract(Context, Op.Rm, Part + Index, Op.Size, Signed);
- Emit();
- EmitVectorInsertTmp(Context, Index, Op.Size + 1);
- }
- Context.EmitLdvectmp();
- Context.EmitStvec(Op.Rd);
- }
- public static void EmitScalarSet(AILEmitterCtx Context, int Reg, int Size)
- {
- EmitVectorZeroAll(Context, Reg);
- EmitVectorInsert(Context, Reg, 0, Size);
- }
- public static void EmitScalarSetF(AILEmitterCtx Context, int Reg, int Size)
- {
- EmitVectorZeroAll(Context, Reg);
- EmitVectorInsertF(Context, Reg, 0, Size);
- }
- public static void EmitVectorExtractSx(AILEmitterCtx Context, int Reg, int Index, int Size)
- {
- EmitVectorExtract(Context, Reg, Index, Size, true);
- }
- public static void EmitVectorExtractZx(AILEmitterCtx Context, int Reg, int Index, int Size)
- {
- EmitVectorExtract(Context, Reg, Index, Size, false);
- }
- public static void EmitVectorExtract(AILEmitterCtx Context, int Reg, int Index, int Size, bool Signed)
- {
- ThrowIfInvalid(Index, Size);
- IAOpCodeSimd Op = (IAOpCodeSimd)Context.CurrOp;
- Context.EmitLdvec(Reg);
- Context.EmitLdc_I4(Index);
- Context.EmitLdc_I4(Size);
- AVectorHelper.EmitCall(Context, Signed
- ? nameof(AVectorHelper.VectorExtractIntSx)
- : nameof(AVectorHelper.VectorExtractIntZx));
- }
- public static void EmitVectorExtractF(AILEmitterCtx Context, int Reg, int Index, int Size)
- {
- ThrowIfInvalidF(Index, Size);
- Context.EmitLdvec(Reg);
- Context.EmitLdc_I4(Index);
- if (Size == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorExtractSingle));
- }
- else if (Size == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorExtractDouble));
- }
- else
- {
- throw new ArgumentOutOfRangeException(nameof(Size));
- }
- }
- public static void EmitVectorZeroAll(AILEmitterCtx Context, int Rd)
- {
- EmitVectorZeroLower(Context, Rd);
- EmitVectorZeroUpper(Context, Rd);
- }
- public static void EmitVectorZeroLower(AILEmitterCtx Context, int Rd)
- {
- EmitVectorInsert(Context, Rd, 0, 3, 0);
- }
- public static void EmitVectorZeroUpper(AILEmitterCtx Context, int Rd)
- {
- EmitVectorInsert(Context, Rd, 1, 3, 0);
- }
- public static void EmitVectorInsert(AILEmitterCtx Context, int Reg, int Index, int Size)
- {
- ThrowIfInvalid(Index, Size);
- Context.EmitLdvec(Reg);
- Context.EmitLdc_I4(Index);
- Context.EmitLdc_I4(Size);
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInsertInt));
- Context.EmitStvec(Reg);
- }
- public static void EmitVectorInsertTmp(AILEmitterCtx Context, int Index, int Size)
- {
- ThrowIfInvalid(Index, Size);
- Context.EmitLdvectmp();
- Context.EmitLdc_I4(Index);
- Context.EmitLdc_I4(Size);
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInsertInt));
- Context.EmitStvectmp();
- }
- public static void EmitVectorInsert(AILEmitterCtx Context, int Reg, int Index, int Size, long Value)
- {
- ThrowIfInvalid(Index, Size);
- Context.EmitLdc_I8(Value);
- Context.EmitLdvec(Reg);
- Context.EmitLdc_I4(Index);
- Context.EmitLdc_I4(Size);
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInsertInt));
- Context.EmitStvec(Reg);
- }
- public static void EmitVectorInsertF(AILEmitterCtx Context, int Reg, int Index, int Size)
- {
- ThrowIfInvalidF(Index, Size);
- Context.EmitLdvec(Reg);
- Context.EmitLdc_I4(Index);
- if (Size == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInsertSingle));
- }
- else if (Size == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInsertDouble));
- }
- else
- {
- throw new ArgumentOutOfRangeException(nameof(Size));
- }
- Context.EmitStvec(Reg);
- }
- public static void EmitVectorInsertTmpF(AILEmitterCtx Context, int Index, int Size)
- {
- ThrowIfInvalidF(Index, Size);
- Context.EmitLdvectmp();
- Context.EmitLdc_I4(Index);
- if (Size == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInsertSingle));
- }
- else if (Size == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.VectorInsertDouble));
- }
- else
- {
- throw new ArgumentOutOfRangeException(nameof(Size));
- }
- Context.EmitStvectmp();
- }
- private static void ThrowIfInvalid(int Index, int Size)
- {
- if ((uint)Size > 3)
- {
- throw new ArgumentOutOfRangeException(nameof(Size));
- }
- if ((uint)Index >= 16 >> Size)
- {
- throw new ArgumentOutOfRangeException(nameof(Index));
- }
- }
- private static void ThrowIfInvalidF(int Index, int Size)
- {
- if ((uint)Size > 1)
- {
- throw new ArgumentOutOfRangeException(nameof(Size));
- }
- if ((uint)Index >= 4 >> Size)
- {
- throw new ArgumentOutOfRangeException(nameof(Index));
- }
- }
- }
- }
|