| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254 |
- using ChocolArm64.Decoder;
- using ChocolArm64.State;
- using ChocolArm64.Translation;
- using System;
- using System.Reflection;
- using System.Reflection.Emit;
- using System.Runtime.Intrinsics.X86;
- using static ChocolArm64.Instruction.AInstEmitSimdHelper;
- namespace ChocolArm64.Instruction
- {
- static partial class AInstEmit
- {
- public static void Abs_S(AILEmitterCtx Context)
- {
- EmitScalarUnaryOpSx(Context, () => EmitAbs(Context));
- }
- public static void Abs_V(AILEmitterCtx Context)
- {
- EmitVectorUnaryOpSx(Context, () => EmitAbs(Context));
- }
- private static void EmitAbs(AILEmitterCtx Context)
- {
- AILLabel LblTrue = new AILLabel();
- Context.Emit(OpCodes.Dup);
- Context.Emit(OpCodes.Ldc_I4_0);
- Context.Emit(OpCodes.Bge_S, LblTrue);
- Context.Emit(OpCodes.Neg);
- Context.MarkLabel(LblTrue);
- }
- public static void Add_S(AILEmitterCtx Context)
- {
- EmitScalarBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
- }
- public static void Add_V(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse2)
- {
- EmitSse2Call(Context, nameof(Sse2.Add));
- }
- else
- {
- EmitVectorBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
- }
- }
- public static void Addhn_V(AILEmitterCtx Context)
- {
- EmitHighNarrow(Context, () => Context.Emit(OpCodes.Add), Round: false);
- }
- public static void Addp_S(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- EmitVectorExtractZx(Context, Op.Rn, 0, Op.Size);
- EmitVectorExtractZx(Context, Op.Rn, 1, Op.Size);
- Context.Emit(OpCodes.Add);
- EmitScalarSet(Context, Op.Rd, Op.Size);
- }
- public static void Addp_V(AILEmitterCtx Context)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- int Elems = Bytes >> Op.Size;
- int Half = Elems >> 1;
- for (int Index = 0; Index < Elems; Index++)
- {
- int Elem = (Index & (Half - 1)) << 1;
- EmitVectorExtractZx(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 0, Op.Size);
- EmitVectorExtractZx(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 1, Op.Size);
- Context.Emit(OpCodes.Add);
- EmitVectorInsertTmp(Context, Index, Op.Size);
- }
- Context.EmitLdvectmp();
- Context.EmitStvec(Op.Rd);
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void Addv_V(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- EmitVectorExtractZx(Context, Op.Rn, 0, Op.Size);
- for (int Index = 1; Index < (Bytes >> Op.Size); Index++)
- {
- EmitVectorExtractZx(Context, Op.Rn, Index, Op.Size);
- Context.Emit(OpCodes.Add);
- }
- EmitScalarSet(Context, Op.Rd, Op.Size);
- }
- public static void Cls_V(AILEmitterCtx Context)
- {
- MethodInfo MthdInfo = typeof(ASoftFallback).GetMethod(nameof(ASoftFallback.CountLeadingSigns));
- EmitCountLeadingBits(Context, () => Context.EmitCall(MthdInfo));
- }
- public static void Clz_V(AILEmitterCtx Context)
- {
- MethodInfo MthdInfo = typeof(ASoftFallback).GetMethod(nameof(ASoftFallback.CountLeadingZeros));
- EmitCountLeadingBits(Context, () => Context.EmitCall(MthdInfo));
- }
- private static void EmitCountLeadingBits(AILEmitterCtx Context, Action Emit)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- for (int Index = 0; Index < (Bytes >> Op.Size); Index++)
- {
- EmitVectorExtractZx(Context, Op.Rn, Index, Op.Size);
- Context.EmitLdc_I4(8 << Op.Size);
- Emit();
- EmitVectorInsert(Context, Op.Rd, Index, Op.Size);
- }
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void Cnt_V(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int Elems = Op.RegisterSize == ARegisterSize.SIMD128 ? 16 : 8;
- for (int Index = 0; Index < Elems; Index++)
- {
- EmitVectorExtractZx(Context, Op.Rn, Index, 0);
- Context.Emit(OpCodes.Conv_U1);
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.CountSetBits8));
- Context.Emit(OpCodes.Conv_U8);
- EmitVectorInsert(Context, Op.Rd, Index, 0);
- }
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- private static void EmitHighNarrow(AILEmitterCtx Context, Action Emit, bool Round)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int Elems = 8 >> Op.Size;
- int ESize = 8 << Op.Size;
- int Part = Op.RegisterSize == ARegisterSize.SIMD128 ? Elems : 0;
- for (int Index = 0; Index < Elems; Index++)
- {
- EmitVectorExtractZx(Context, Op.Rn, Index, Op.Size + 1);
- EmitVectorExtractZx(Context, Op.Rm, Index, Op.Size + 1);
- Emit();
- if (Round)
- {
- Context.EmitLdc_I8(1L << (ESize - 1));
- Context.Emit(OpCodes.Add);
- }
- Context.EmitLsr(ESize);
- EmitVectorInsert(Context, Op.Rd, Part + Index, Op.Size);
- }
- if (Part == 0)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- private static void EmitSaturatingExtNarrow(AILEmitterCtx Context, bool SignedSrc, bool SignedDst, bool Scalar)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int Elems = (!Scalar ? 8 >> Op.Size : 1);
- int ESize = 8 << Op.Size;
- int TMaxValue = (SignedDst ? (1 << (ESize - 1)) - 1 : (int)((1L << ESize) - 1L));
- int TMinValue = (SignedDst ? -((1 << (ESize - 1))) : 0);
- int Part = (!Scalar & (Op.RegisterSize == ARegisterSize.SIMD128) ? Elems : 0);
- Context.EmitLdc_I8(0L);
- Context.EmitSttmp();
- for (int Index = 0; Index < Elems; Index++)
- {
- AILLabel LblLe = new AILLabel();
- AILLabel LblGeEnd = new AILLabel();
- EmitVectorExtract(Context, Op.Rn, Index, Op.Size + 1, SignedSrc);
- Context.Emit(OpCodes.Dup);
- Context.EmitLdc_I4(TMaxValue);
- Context.Emit(OpCodes.Conv_U8);
- Context.Emit(SignedSrc ? OpCodes.Ble_S : OpCodes.Ble_Un_S, LblLe);
- Context.Emit(OpCodes.Pop);
- Context.EmitLdc_I4(TMaxValue);
- Context.EmitLdc_I8(0x8000000L);
- Context.EmitSttmp();
- Context.Emit(OpCodes.Br_S, LblGeEnd);
- Context.MarkLabel(LblLe);
- Context.Emit(OpCodes.Dup);
- Context.EmitLdc_I4(TMinValue);
- Context.Emit(OpCodes.Conv_I8);
- Context.Emit(SignedSrc ? OpCodes.Bge_S : OpCodes.Bge_Un_S, LblGeEnd);
- Context.Emit(OpCodes.Pop);
- Context.EmitLdc_I4(TMinValue);
- Context.EmitLdc_I8(0x8000000L);
- Context.EmitSttmp();
- Context.MarkLabel(LblGeEnd);
- if (Scalar)
- {
- EmitVectorZeroLower(Context, Op.Rd);
- }
- EmitVectorInsert(Context, Op.Rd, Part + Index, Op.Size);
- }
- if (Part == 0)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- Context.EmitLdarg(ATranslatedSub.StateArgIdx);
- Context.EmitLdarg(ATranslatedSub.StateArgIdx);
- Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpsr));
- Context.EmitLdtmp();
- Context.Emit(OpCodes.Conv_I4);
- Context.Emit(OpCodes.Or);
- Context.EmitCallPropSet(typeof(AThreadState), nameof(AThreadState.Fpsr));
- }
- public static void Fabd_S(AILEmitterCtx Context)
- {
- EmitScalarBinaryOpF(Context, () =>
- {
- Context.Emit(OpCodes.Sub);
- EmitUnaryMathCall(Context, nameof(Math.Abs));
- });
- }
- public static void Fabs_S(AILEmitterCtx Context)
- {
- EmitScalarUnaryOpF(Context, () =>
- {
- EmitUnaryMathCall(Context, nameof(Math.Abs));
- });
- }
- public static void Fabs_V(AILEmitterCtx Context)
- {
- EmitVectorUnaryOpF(Context, () =>
- {
- EmitUnaryMathCall(Context, nameof(Math.Abs));
- });
- }
- public static void Fadd_S(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse && AOptimizations.UseSse2)
- {
- EmitSseOrSse2CallF(Context, nameof(Sse.AddScalar));
- }
- else
- {
- EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Add));
- }
- }
- public static void Fadd_V(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse && AOptimizations.UseSse2)
- {
- EmitSseOrSse2CallF(Context, nameof(Sse.Add));
- }
- else
- {
- EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Add));
- }
- }
- public static void Faddp_S(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
- EmitVectorExtractF(Context, Op.Rn, 1, SizeF);
- Context.Emit(OpCodes.Add);
- EmitScalarSetF(Context, Op.Rd, SizeF);
- }
- public static void Faddp_V(AILEmitterCtx Context)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int SizeF = Op.Size & 1;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- int Elems = Bytes >> SizeF + 2;
- int Half = Elems >> 1;
- for (int Index = 0; Index < Elems; Index++)
- {
- int Elem = (Index & (Half - 1)) << 1;
- EmitVectorExtractF(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 0, SizeF);
- EmitVectorExtractF(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 1, SizeF);
- Context.Emit(OpCodes.Add);
- EmitVectorInsertTmpF(Context, Index, SizeF);
- }
- Context.EmitLdvectmp();
- Context.EmitStvec(Op.Rd);
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- public static void Fdiv_S(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse && AOptimizations.UseSse2)
- {
- EmitSseOrSse2CallF(Context, nameof(Sse.DivideScalar));
- }
- else
- {
- EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Div));
- }
- }
- public static void Fdiv_V(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse && AOptimizations.UseSse2)
- {
- EmitSseOrSse2CallF(Context, nameof(Sse.Divide));
- }
- else
- {
- EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Div));
- }
- }
- public static void Fmadd_S(AILEmitterCtx Context)
- {
- EmitScalarTernaryRaOpF(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Add);
- });
- }
- public static void Fmax_S(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- EmitScalarBinaryOpF(Context, () =>
- {
- if (Op.Size == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MaxF));
- }
- else if (Op.Size == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Max));
- }
- else
- {
- throw new InvalidOperationException();
- }
- });
- }
- public static void Fmax_V(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- EmitVectorBinaryOpF(Context, () =>
- {
- if (Op.Size == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MaxF));
- }
- else if (Op.Size == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Max));
- }
- else
- {
- throw new InvalidOperationException();
- }
- });
- }
- public static void Fmin_S(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- EmitScalarBinaryOpF(Context, () =>
- {
- if (Op.Size == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MinF));
- }
- else if (Op.Size == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Min));
- }
- else
- {
- throw new InvalidOperationException();
- }
- });
- }
- public static void Fmin_V(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- EmitVectorBinaryOpF(Context, () =>
- {
- if (SizeF == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MinF));
- }
- else if (SizeF == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Min));
- }
- else
- {
- throw new InvalidOperationException();
- }
- });
- }
- public static void Fmaxnm_S(AILEmitterCtx Context)
- {
- Fmax_S(Context);
- }
- public static void Fminnm_S(AILEmitterCtx Context)
- {
- Fmin_S(Context);
- }
- public static void Fmla_V(AILEmitterCtx Context)
- {
- EmitVectorTernaryOpF(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Add);
- });
- }
- public static void Fmla_Ve(AILEmitterCtx Context)
- {
- EmitVectorTernaryOpByElemF(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Add);
- });
- }
- public static void Fmls_V(AILEmitterCtx Context)
- {
- EmitVectorTernaryOpF(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Sub);
- });
- }
- public static void Fmls_Ve(AILEmitterCtx Context)
- {
- EmitVectorTernaryOpByElemF(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Sub);
- });
- }
- public static void Fmsub_S(AILEmitterCtx Context)
- {
- EmitScalarTernaryRaOpF(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Sub);
- });
- }
- public static void Fmul_S(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse && AOptimizations.UseSse2)
- {
- EmitSseOrSse2CallF(Context, nameof(Sse.MultiplyScalar));
- }
- else
- {
- EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Mul));
- }
- }
- public static void Fmul_Se(AILEmitterCtx Context)
- {
- EmitScalarBinaryOpByElemF(Context, () => Context.Emit(OpCodes.Mul));
- }
- public static void Fmul_V(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse && AOptimizations.UseSse2)
- {
- EmitSseOrSse2CallF(Context, nameof(Sse.Multiply));
- }
- else
- {
- EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Mul));
- }
- }
- public static void Fmul_Ve(AILEmitterCtx Context)
- {
- EmitVectorBinaryOpByElemF(Context, () => Context.Emit(OpCodes.Mul));
- }
- public static void Fneg_S(AILEmitterCtx Context)
- {
- EmitScalarUnaryOpF(Context, () => Context.Emit(OpCodes.Neg));
- }
- public static void Fneg_V(AILEmitterCtx Context)
- {
- EmitVectorUnaryOpF(Context, () => Context.Emit(OpCodes.Neg));
- }
- public static void Fnmadd_S(AILEmitterCtx Context)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int SizeF = Op.Size & 1;
- EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
- Context.Emit(OpCodes.Neg);
- EmitVectorExtractF(Context, Op.Rm, 0, SizeF);
- Context.Emit(OpCodes.Mul);
- EmitVectorExtractF(Context, Op.Ra, 0, SizeF);
- Context.Emit(OpCodes.Sub);
- EmitScalarSetF(Context, Op.Rd, SizeF);
- }
- public static void Fnmsub_S(AILEmitterCtx Context)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int SizeF = Op.Size & 1;
- EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
- EmitVectorExtractF(Context, Op.Rm, 0, SizeF);
- Context.Emit(OpCodes.Mul);
- EmitVectorExtractF(Context, Op.Ra, 0, SizeF);
- Context.Emit(OpCodes.Sub);
- EmitScalarSetF(Context, Op.Rd, SizeF);
- }
- public static void Fnmul_S(AILEmitterCtx Context)
- {
- EmitScalarBinaryOpF(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Neg);
- });
- }
- public static void Frecpe_S(AILEmitterCtx Context)
- {
- EmitFrecpe(Context, 0, Scalar: true);
- }
- public static void Frecpe_V(AILEmitterCtx Context)
- {
- 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++)
- {
- EmitFrecpe(Context, Index, Scalar: false);
- }
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- private static void EmitFrecpe(AILEmitterCtx Context, int Index, bool Scalar)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- if (SizeF == 0)
- {
- Context.EmitLdc_R4(1);
- }
- else /* if (SizeF == 1) */
- {
- Context.EmitLdc_R8(1);
- }
- EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
- Context.Emit(OpCodes.Div);
- if (Scalar)
- {
- EmitVectorZeroAll(Context, Op.Rd);
- }
- EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
- }
- public static void Frecps_S(AILEmitterCtx Context)
- {
- EmitFrecps(Context, 0, Scalar: true);
- }
- public static void Frecps_V(AILEmitterCtx Context)
- {
- 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++)
- {
- EmitFrecps(Context, Index, Scalar: false);
- }
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- private static void EmitFrecps(AILEmitterCtx Context, int Index, bool Scalar)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int SizeF = Op.Size & 1;
- if (SizeF == 0)
- {
- Context.EmitLdc_R4(2);
- }
- else /* if (SizeF == 1) */
- {
- Context.EmitLdc_R8(2);
- }
- EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
- EmitVectorExtractF(Context, Op.Rm, Index, SizeF);
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Sub);
- if (Scalar)
- {
- EmitVectorZeroAll(Context, Op.Rd);
- }
- EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
- }
- public static void Frinta_S(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- EmitVectorExtractF(Context, Op.Rn, 0, Op.Size);
- EmitRoundMathCall(Context, MidpointRounding.AwayFromZero);
- EmitScalarSetF(Context, Op.Rd, Op.Size);
- }
- public static void Frinta_V(AILEmitterCtx Context)
- {
- EmitVectorUnaryOpF(Context, () =>
- {
- EmitRoundMathCall(Context, MidpointRounding.AwayFromZero);
- });
- }
- public static void Frinti_S(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- EmitScalarUnaryOpF(Context, () =>
- {
- Context.EmitLdarg(ATranslatedSub.StateArgIdx);
- Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
- if (Op.Size == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
- }
- else if (Op.Size == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
- }
- else
- {
- throw new InvalidOperationException();
- }
- });
- }
- public static void Frinti_V(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int SizeF = Op.Size & 1;
- EmitVectorUnaryOpF(Context, () =>
- {
- Context.EmitLdarg(ATranslatedSub.StateArgIdx);
- Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
- if (SizeF == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
- }
- else if (SizeF == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
- }
- else
- {
- throw new InvalidOperationException();
- }
- });
- }
- public static void Frintm_S(AILEmitterCtx Context)
- {
- EmitScalarUnaryOpF(Context, () =>
- {
- EmitUnaryMathCall(Context, nameof(Math.Floor));
- });
- }
- public static void Frintm_V(AILEmitterCtx Context)
- {
- EmitVectorUnaryOpF(Context, () =>
- {
- EmitUnaryMathCall(Context, nameof(Math.Floor));
- });
- }
- public static void Frintn_S(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- EmitVectorExtractF(Context, Op.Rn, 0, Op.Size);
- EmitRoundMathCall(Context, MidpointRounding.ToEven);
- EmitScalarSetF(Context, Op.Rd, Op.Size);
- }
- public static void Frintn_V(AILEmitterCtx Context)
- {
- EmitVectorUnaryOpF(Context, () =>
- {
- EmitRoundMathCall(Context, MidpointRounding.ToEven);
- });
- }
- public static void Frintp_S(AILEmitterCtx Context)
- {
- EmitScalarUnaryOpF(Context, () =>
- {
- EmitUnaryMathCall(Context, nameof(Math.Ceiling));
- });
- }
- public static void Frintp_V(AILEmitterCtx Context)
- {
- EmitVectorUnaryOpF(Context, () =>
- {
- EmitUnaryMathCall(Context, nameof(Math.Ceiling));
- });
- }
- public static void Frintx_S(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- EmitScalarUnaryOpF(Context, () =>
- {
- Context.EmitLdarg(ATranslatedSub.StateArgIdx);
- Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
- if (Op.Size == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
- }
- else if (Op.Size == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
- }
- else
- {
- throw new InvalidOperationException();
- }
- });
- }
- public static void Frintx_V(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- EmitVectorUnaryOpF(Context, () =>
- {
- Context.EmitLdarg(ATranslatedSub.StateArgIdx);
- Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
- if (Op.Size == 0)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
- }
- else if (Op.Size == 1)
- {
- AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
- }
- else
- {
- throw new InvalidOperationException();
- }
- });
- }
- public static void Frsqrte_S(AILEmitterCtx Context)
- {
- EmitScalarUnaryOpF(Context, () =>
- {
- EmitUnarySoftFloatCall(Context, nameof(ASoftFloat.InvSqrtEstimate));
- });
- }
- public static void Frsqrte_V(AILEmitterCtx Context)
- {
- EmitVectorUnaryOpF(Context, () =>
- {
- EmitUnarySoftFloatCall(Context, nameof(ASoftFloat.InvSqrtEstimate));
- });
- }
- public static void Frsqrts_S(AILEmitterCtx Context)
- {
- EmitFrsqrts(Context, 0, Scalar: true);
- }
- public static void Frsqrts_V(AILEmitterCtx Context)
- {
- 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++)
- {
- EmitFrsqrts(Context, Index, Scalar: false);
- }
- if (Op.RegisterSize == ARegisterSize.SIMD64)
- {
- EmitVectorZeroUpper(Context, Op.Rd);
- }
- }
- private static void EmitFrsqrts(AILEmitterCtx Context, int Index, bool Scalar)
- {
- AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
- int SizeF = Op.Size & 1;
- if (SizeF == 0)
- {
- Context.EmitLdc_R4(3);
- }
- else /* if (SizeF == 1) */
- {
- Context.EmitLdc_R8(3);
- }
- EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
- EmitVectorExtractF(Context, Op.Rm, Index, SizeF);
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Sub);
- if (SizeF == 0)
- {
- Context.EmitLdc_R4(0.5f);
- }
- else /* if (SizeF == 1) */
- {
- Context.EmitLdc_R8(0.5);
- }
- Context.Emit(OpCodes.Mul);
- if (Scalar)
- {
- EmitVectorZeroAll(Context, Op.Rd);
- }
- EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
- }
- public static void Fsqrt_S(AILEmitterCtx Context)
- {
- EmitScalarUnaryOpF(Context, () =>
- {
- EmitUnaryMathCall(Context, nameof(Math.Sqrt));
- });
- }
- public static void Fsub_S(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse && AOptimizations.UseSse2)
- {
- EmitSseOrSse2CallF(Context, nameof(Sse.SubtractScalar));
- }
- else
- {
- EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Sub));
- }
- }
- public static void Fsub_V(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse && AOptimizations.UseSse2)
- {
- EmitSseOrSse2CallF(Context, nameof(Sse.Subtract));
- }
- else
- {
- EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Sub));
- }
- }
- public static void Mla_V(AILEmitterCtx Context)
- {
- EmitVectorTernaryOpZx(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Add);
- });
- }
- public static void Mla_Ve(AILEmitterCtx Context)
- {
- EmitVectorTernaryOpByElemZx(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Add);
- });
- }
- public static void Mls_V(AILEmitterCtx Context)
- {
- EmitVectorTernaryOpZx(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Sub);
- });
- }
- public static void Mul_V(AILEmitterCtx Context)
- {
- EmitVectorBinaryOpZx(Context, () => Context.Emit(OpCodes.Mul));
- }
- public static void Mul_Ve(AILEmitterCtx Context)
- {
- EmitVectorBinaryOpByElemZx(Context, () => Context.Emit(OpCodes.Mul));
- }
- public static void Neg_S(AILEmitterCtx Context)
- {
- EmitScalarUnaryOpSx(Context, () => Context.Emit(OpCodes.Neg));
- }
- public static void Neg_V(AILEmitterCtx Context)
- {
- EmitVectorUnaryOpSx(Context, () => Context.Emit(OpCodes.Neg));
- }
- public static void Raddhn_V(AILEmitterCtx Context)
- {
- EmitHighNarrow(Context, () => Context.Emit(OpCodes.Add), Round: true);
- }
- public static void Rsubhn_V(AILEmitterCtx Context)
- {
- EmitHighNarrow(Context, () => Context.Emit(OpCodes.Sub), Round: true);
- }
- public static void Saddw_V(AILEmitterCtx Context)
- {
- EmitVectorWidenRmBinaryOpSx(Context, () => Context.Emit(OpCodes.Add));
- }
- public static void Smax_V(AILEmitterCtx Context)
- {
- Type[] Types = new Type[] { typeof(long), typeof(long) };
- MethodInfo MthdInfo = typeof(Math).GetMethod(nameof(Math.Max), Types);
- EmitVectorBinaryOpSx(Context, () => Context.EmitCall(MthdInfo));
- }
- public static void Smin_V(AILEmitterCtx Context)
- {
- Type[] Types = new Type[] { typeof(long), typeof(long) };
- MethodInfo MthdInfo = typeof(Math).GetMethod(nameof(Math.Min), Types);
- EmitVectorBinaryOpSx(Context, () => Context.EmitCall(MthdInfo));
- }
- public static void Smlal_V(AILEmitterCtx Context)
- {
- EmitVectorWidenRnRmTernaryOpSx(Context, () =>
- {
- Context.Emit(OpCodes.Mul);
- Context.Emit(OpCodes.Add);
- });
- }
- public static void Smull_V(AILEmitterCtx Context)
- {
- EmitVectorWidenRnRmBinaryOpSx(Context, () => Context.Emit(OpCodes.Mul));
- }
- public static void Sqxtn_S(AILEmitterCtx Context)
- {
- EmitSaturatingExtNarrow(Context, SignedSrc: true, SignedDst: true, Scalar: true);
- }
- public static void Sqxtn_V(AILEmitterCtx Context)
- {
- EmitSaturatingExtNarrow(Context, SignedSrc: true, SignedDst: true, Scalar: false);
- }
- public static void Sqxtun_S(AILEmitterCtx Context)
- {
- EmitSaturatingExtNarrow(Context, SignedSrc: true, SignedDst: false, Scalar: true);
- }
- public static void Sqxtun_V(AILEmitterCtx Context)
- {
- EmitSaturatingExtNarrow(Context, SignedSrc: true, SignedDst: false, Scalar: false);
- }
- public static void Sub_S(AILEmitterCtx Context)
- {
- EmitScalarBinaryOpZx(Context, () => Context.Emit(OpCodes.Sub));
- }
- public static void Sub_V(AILEmitterCtx Context)
- {
- if (AOptimizations.UseSse2)
- {
- EmitSse2Call(Context, nameof(Sse2.Subtract));
- }
- else
- {
- EmitVectorBinaryOpZx(Context, () => Context.Emit(OpCodes.Sub));
- }
- }
- public static void Subhn_V(AILEmitterCtx Context)
- {
- EmitHighNarrow(Context, () => Context.Emit(OpCodes.Sub), Round: false);
- }
- public static void Uabd_V(AILEmitterCtx Context)
- {
- EmitVectorBinaryOpZx(Context, () => EmitAbd(Context));
- }
- public static void Uabdl_V(AILEmitterCtx Context)
- {
- EmitVectorWidenRnRmBinaryOpZx(Context, () => EmitAbd(Context));
- }
- private static void EmitAbd(AILEmitterCtx Context)
- {
- Context.Emit(OpCodes.Sub);
- Type[] Types = new Type[] { typeof(long) };
- Context.EmitCall(typeof(Math).GetMethod(nameof(Math.Abs), Types));
- }
- public static void Uaddl_V(AILEmitterCtx Context)
- {
- EmitVectorWidenRnRmBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
- }
- public static void Uaddlv_V(AILEmitterCtx Context)
- {
- AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
- int Bytes = Context.CurrOp.GetBitsCount() >> 3;
- EmitVectorExtractZx(Context, Op.Rn, 0, Op.Size);
- for (int Index = 1; Index < (Bytes >> Op.Size); Index++)
- {
- EmitVectorExtractZx(Context, Op.Rn, Index, Op.Size);
- Context.Emit(OpCodes.Add);
- }
- EmitScalarSet(Context, Op.Rd, Op.Size + 1);
- }
- public static void Uaddw_V(AILEmitterCtx Context)
- {
- EmitVectorWidenRmBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
- }
- public static void Uhadd_V(AILEmitterCtx Context)
- {
- EmitVectorBinaryOpZx(Context, () =>
- {
- Context.Emit(OpCodes.Add);
- Context.EmitLdc_I4(1);
- Context.Emit(OpCodes.Shr_Un);
- });
- }
- public static void Umull_V(AILEmitterCtx Context)
- {
- EmitVectorWidenRnRmBinaryOpZx(Context, () => Context.Emit(OpCodes.Mul));
- }
- public static void Uqxtn_S(AILEmitterCtx Context)
- {
- EmitSaturatingExtNarrow(Context, SignedSrc: false, SignedDst: false, Scalar: true);
- }
- public static void Uqxtn_V(AILEmitterCtx Context)
- {
- EmitSaturatingExtNarrow(Context, SignedSrc: false, SignedDst: false, Scalar: false);
- }
- }
- }
|