AInstEmitSimdArithmetic.cs 36 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263
  1. using ChocolArm64.Decoder;
  2. using ChocolArm64.State;
  3. using ChocolArm64.Translation;
  4. using System;
  5. using System.Reflection;
  6. using System.Reflection.Emit;
  7. using System.Runtime.Intrinsics.X86;
  8. using static ChocolArm64.Instruction.AInstEmitSimdHelper;
  9. namespace ChocolArm64.Instruction
  10. {
  11. static partial class AInstEmit
  12. {
  13. public static void Abs_S(AILEmitterCtx Context)
  14. {
  15. EmitScalarUnaryOpSx(Context, () => EmitAbs(Context));
  16. }
  17. public static void Abs_V(AILEmitterCtx Context)
  18. {
  19. EmitVectorUnaryOpSx(Context, () => EmitAbs(Context));
  20. }
  21. private static void EmitAbs(AILEmitterCtx Context)
  22. {
  23. AILLabel LblTrue = new AILLabel();
  24. Context.Emit(OpCodes.Dup);
  25. Context.Emit(OpCodes.Ldc_I4_0);
  26. Context.Emit(OpCodes.Bge_S, LblTrue);
  27. Context.Emit(OpCodes.Neg);
  28. Context.MarkLabel(LblTrue);
  29. }
  30. public static void Add_S(AILEmitterCtx Context)
  31. {
  32. EmitScalarBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
  33. }
  34. public static void Add_V(AILEmitterCtx Context)
  35. {
  36. if (AOptimizations.UseSse2)
  37. {
  38. EmitSse2Call(Context, nameof(Sse2.Add));
  39. }
  40. else
  41. {
  42. EmitVectorBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
  43. }
  44. }
  45. public static void Addhn_V(AILEmitterCtx Context)
  46. {
  47. EmitHighNarrow(Context, () => Context.Emit(OpCodes.Add), Round: false);
  48. }
  49. public static void Addp_S(AILEmitterCtx Context)
  50. {
  51. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  52. EmitVectorExtractZx(Context, Op.Rn, 0, Op.Size);
  53. EmitVectorExtractZx(Context, Op.Rn, 1, Op.Size);
  54. Context.Emit(OpCodes.Add);
  55. EmitScalarSet(Context, Op.Rd, Op.Size);
  56. }
  57. public static void Addp_V(AILEmitterCtx Context)
  58. {
  59. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  60. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  61. int Elems = Bytes >> Op.Size;
  62. int Half = Elems >> 1;
  63. for (int Index = 0; Index < Elems; Index++)
  64. {
  65. int Elem = (Index & (Half - 1)) << 1;
  66. EmitVectorExtractZx(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 0, Op.Size);
  67. EmitVectorExtractZx(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 1, Op.Size);
  68. Context.Emit(OpCodes.Add);
  69. EmitVectorInsertTmp(Context, Index, Op.Size);
  70. }
  71. Context.EmitLdvectmp();
  72. Context.EmitStvec(Op.Rd);
  73. if (Op.RegisterSize == ARegisterSize.SIMD64)
  74. {
  75. EmitVectorZeroUpper(Context, Op.Rd);
  76. }
  77. }
  78. public static void Addv_V(AILEmitterCtx Context)
  79. {
  80. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  81. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  82. EmitVectorExtractZx(Context, Op.Rn, 0, Op.Size);
  83. for (int Index = 1; Index < (Bytes >> Op.Size); Index++)
  84. {
  85. EmitVectorExtractZx(Context, Op.Rn, Index, Op.Size);
  86. Context.Emit(OpCodes.Add);
  87. }
  88. EmitScalarSet(Context, Op.Rd, Op.Size);
  89. }
  90. public static void Cls_V(AILEmitterCtx Context)
  91. {
  92. MethodInfo MthdInfo = typeof(ASoftFallback).GetMethod(nameof(ASoftFallback.CountLeadingSigns));
  93. EmitCountLeadingBits(Context, () => Context.EmitCall(MthdInfo));
  94. }
  95. public static void Clz_V(AILEmitterCtx Context)
  96. {
  97. MethodInfo MthdInfo = typeof(ASoftFallback).GetMethod(nameof(ASoftFallback.CountLeadingZeros));
  98. EmitCountLeadingBits(Context, () => Context.EmitCall(MthdInfo));
  99. }
  100. private static void EmitCountLeadingBits(AILEmitterCtx Context, Action Emit)
  101. {
  102. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  103. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  104. for (int Index = 0; Index < (Bytes >> Op.Size); Index++)
  105. {
  106. EmitVectorExtractZx(Context, Op.Rn, Index, Op.Size);
  107. Context.EmitLdc_I4(8 << Op.Size);
  108. Emit();
  109. EmitVectorInsert(Context, Op.Rd, Index, Op.Size);
  110. }
  111. if (Op.RegisterSize == ARegisterSize.SIMD64)
  112. {
  113. EmitVectorZeroUpper(Context, Op.Rd);
  114. }
  115. }
  116. public static void Cnt_V(AILEmitterCtx Context)
  117. {
  118. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  119. int Elems = Op.RegisterSize == ARegisterSize.SIMD128 ? 16 : 8;
  120. for (int Index = 0; Index < Elems; Index++)
  121. {
  122. EmitVectorExtractZx(Context, Op.Rn, Index, 0);
  123. Context.Emit(OpCodes.Conv_U1);
  124. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.CountSetBits8));
  125. Context.Emit(OpCodes.Conv_U8);
  126. EmitVectorInsert(Context, Op.Rd, Index, 0);
  127. }
  128. if (Op.RegisterSize == ARegisterSize.SIMD64)
  129. {
  130. EmitVectorZeroUpper(Context, Op.Rd);
  131. }
  132. }
  133. private static void EmitHighNarrow(AILEmitterCtx Context, Action Emit, bool Round)
  134. {
  135. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  136. int Elems = 8 >> Op.Size;
  137. int ESize = 8 << Op.Size;
  138. int Part = Op.RegisterSize == ARegisterSize.SIMD128 ? Elems : 0;
  139. for (int Index = 0; Index < Elems; Index++)
  140. {
  141. EmitVectorExtractZx(Context, Op.Rn, Index, Op.Size + 1);
  142. EmitVectorExtractZx(Context, Op.Rm, Index, Op.Size + 1);
  143. Emit();
  144. if (Round)
  145. {
  146. Context.EmitLdc_I8(1L << (ESize - 1));
  147. Context.Emit(OpCodes.Add);
  148. }
  149. Context.EmitLsr(ESize);
  150. EmitVectorInsert(Context, Op.Rd, Part + Index, Op.Size);
  151. }
  152. if (Part == 0)
  153. {
  154. EmitVectorZeroUpper(Context, Op.Rd);
  155. }
  156. }
  157. private static void EmitSaturatingExtNarrow(AILEmitterCtx Context, bool SignedSrc, bool SignedDst, bool Scalar)
  158. {
  159. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  160. int Elems = (!Scalar ? 8 >> Op.Size : 1);
  161. int ESize = 8 << Op.Size;
  162. int TMaxValue = (SignedDst ? (1 << (ESize - 1)) - 1 : (int)((1L << ESize) - 1L));
  163. int TMinValue = (SignedDst ? -((1 << (ESize - 1))) : 0);
  164. int Part = (!Scalar & (Op.RegisterSize == ARegisterSize.SIMD128) ? Elems : 0);
  165. Context.EmitLdc_I8(0L);
  166. Context.EmitSttmp();
  167. for (int Index = 0; Index < Elems; Index++)
  168. {
  169. AILLabel LblLe = new AILLabel();
  170. AILLabel LblGeEnd = new AILLabel();
  171. EmitVectorExtract(Context, Op.Rn, Index, Op.Size + 1, SignedSrc);
  172. Context.Emit(OpCodes.Dup);
  173. Context.EmitLdc_I4(TMaxValue);
  174. Context.Emit(OpCodes.Conv_U8);
  175. Context.Emit(SignedSrc ? OpCodes.Ble_S : OpCodes.Ble_Un_S, LblLe);
  176. Context.Emit(OpCodes.Pop);
  177. Context.EmitLdc_I4(TMaxValue);
  178. Context.EmitLdc_I8(0x8000000L);
  179. Context.EmitSttmp();
  180. Context.Emit(OpCodes.Br_S, LblGeEnd);
  181. Context.MarkLabel(LblLe);
  182. Context.Emit(OpCodes.Dup);
  183. Context.EmitLdc_I4(TMinValue);
  184. Context.Emit(OpCodes.Conv_I8);
  185. Context.Emit(SignedSrc ? OpCodes.Bge_S : OpCodes.Bge_Un_S, LblGeEnd);
  186. Context.Emit(OpCodes.Pop);
  187. Context.EmitLdc_I4(TMinValue);
  188. Context.EmitLdc_I8(0x8000000L);
  189. Context.EmitSttmp();
  190. Context.MarkLabel(LblGeEnd);
  191. if (Scalar)
  192. {
  193. EmitVectorZeroLower(Context, Op.Rd);
  194. }
  195. EmitVectorInsert(Context, Op.Rd, Part + Index, Op.Size);
  196. }
  197. if (Part == 0)
  198. {
  199. EmitVectorZeroUpper(Context, Op.Rd);
  200. }
  201. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  202. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  203. Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpsr));
  204. Context.EmitLdtmp();
  205. Context.Emit(OpCodes.Conv_I4);
  206. Context.Emit(OpCodes.Or);
  207. Context.EmitCallPropSet(typeof(AThreadState), nameof(AThreadState.Fpsr));
  208. }
  209. public static void Fabd_S(AILEmitterCtx Context)
  210. {
  211. EmitScalarBinaryOpF(Context, () =>
  212. {
  213. Context.Emit(OpCodes.Sub);
  214. EmitUnaryMathCall(Context, nameof(Math.Abs));
  215. });
  216. }
  217. public static void Fabs_S(AILEmitterCtx Context)
  218. {
  219. EmitScalarUnaryOpF(Context, () =>
  220. {
  221. EmitUnaryMathCall(Context, nameof(Math.Abs));
  222. });
  223. }
  224. public static void Fabs_V(AILEmitterCtx Context)
  225. {
  226. EmitVectorUnaryOpF(Context, () =>
  227. {
  228. EmitUnaryMathCall(Context, nameof(Math.Abs));
  229. });
  230. }
  231. public static void Fadd_S(AILEmitterCtx Context)
  232. {
  233. if (AOptimizations.UseSse && AOptimizations.UseSse2)
  234. {
  235. EmitSseOrSse2CallF(Context, nameof(Sse.AddScalar));
  236. }
  237. else
  238. {
  239. EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Add));
  240. }
  241. }
  242. public static void Fadd_V(AILEmitterCtx Context)
  243. {
  244. if (AOptimizations.UseSse && AOptimizations.UseSse2)
  245. {
  246. EmitSseOrSse2CallF(Context, nameof(Sse.Add));
  247. }
  248. else
  249. {
  250. EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Add));
  251. }
  252. }
  253. public static void Faddp_S(AILEmitterCtx Context)
  254. {
  255. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  256. int SizeF = Op.Size & 1;
  257. EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
  258. EmitVectorExtractF(Context, Op.Rn, 1, SizeF);
  259. Context.Emit(OpCodes.Add);
  260. EmitScalarSetF(Context, Op.Rd, SizeF);
  261. }
  262. public static void Faddp_V(AILEmitterCtx Context)
  263. {
  264. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  265. int SizeF = Op.Size & 1;
  266. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  267. int Elems = Bytes >> SizeF + 2;
  268. int Half = Elems >> 1;
  269. for (int Index = 0; Index < Elems; Index++)
  270. {
  271. int Elem = (Index & (Half - 1)) << 1;
  272. EmitVectorExtractF(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 0, SizeF);
  273. EmitVectorExtractF(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 1, SizeF);
  274. Context.Emit(OpCodes.Add);
  275. EmitVectorInsertTmpF(Context, Index, SizeF);
  276. }
  277. Context.EmitLdvectmp();
  278. Context.EmitStvec(Op.Rd);
  279. if (Op.RegisterSize == ARegisterSize.SIMD64)
  280. {
  281. EmitVectorZeroUpper(Context, Op.Rd);
  282. }
  283. }
  284. public static void Fdiv_S(AILEmitterCtx Context)
  285. {
  286. if (AOptimizations.UseSse && AOptimizations.UseSse2)
  287. {
  288. EmitSseOrSse2CallF(Context, nameof(Sse.DivideScalar));
  289. }
  290. else
  291. {
  292. EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Div));
  293. }
  294. }
  295. public static void Fdiv_V(AILEmitterCtx Context)
  296. {
  297. if (AOptimizations.UseSse && AOptimizations.UseSse2)
  298. {
  299. EmitSseOrSse2CallF(Context, nameof(Sse.Divide));
  300. }
  301. else
  302. {
  303. EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Div));
  304. }
  305. }
  306. public static void Fmadd_S(AILEmitterCtx Context)
  307. {
  308. EmitScalarTernaryRaOpF(Context, () =>
  309. {
  310. Context.Emit(OpCodes.Mul);
  311. Context.Emit(OpCodes.Add);
  312. });
  313. }
  314. public static void Fmax_S(AILEmitterCtx Context)
  315. {
  316. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  317. EmitScalarBinaryOpF(Context, () =>
  318. {
  319. if (Op.Size == 0)
  320. {
  321. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MaxF));
  322. }
  323. else if (Op.Size == 1)
  324. {
  325. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Max));
  326. }
  327. else
  328. {
  329. throw new InvalidOperationException();
  330. }
  331. });
  332. }
  333. public static void Fmax_V(AILEmitterCtx Context)
  334. {
  335. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  336. EmitVectorBinaryOpF(Context, () =>
  337. {
  338. if (Op.Size == 0)
  339. {
  340. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MaxF));
  341. }
  342. else if (Op.Size == 1)
  343. {
  344. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Max));
  345. }
  346. else
  347. {
  348. throw new InvalidOperationException();
  349. }
  350. });
  351. }
  352. public static void Fmin_S(AILEmitterCtx Context)
  353. {
  354. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  355. EmitScalarBinaryOpF(Context, () =>
  356. {
  357. if (Op.Size == 0)
  358. {
  359. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MinF));
  360. }
  361. else if (Op.Size == 1)
  362. {
  363. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Min));
  364. }
  365. else
  366. {
  367. throw new InvalidOperationException();
  368. }
  369. });
  370. }
  371. public static void Fmin_V(AILEmitterCtx Context)
  372. {
  373. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  374. int SizeF = Op.Size & 1;
  375. EmitVectorBinaryOpF(Context, () =>
  376. {
  377. if (SizeF == 0)
  378. {
  379. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MinF));
  380. }
  381. else if (SizeF == 1)
  382. {
  383. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Min));
  384. }
  385. else
  386. {
  387. throw new InvalidOperationException();
  388. }
  389. });
  390. }
  391. public static void Fmaxnm_S(AILEmitterCtx Context)
  392. {
  393. Fmax_S(Context);
  394. }
  395. public static void Fminnm_S(AILEmitterCtx Context)
  396. {
  397. Fmin_S(Context);
  398. }
  399. public static void Fmla_Se(AILEmitterCtx Context)
  400. {
  401. EmitScalarTernaryOpByElemF(Context, () =>
  402. {
  403. Context.Emit(OpCodes.Mul);
  404. Context.Emit(OpCodes.Add);
  405. });
  406. }
  407. public static void Fmla_V(AILEmitterCtx Context)
  408. {
  409. EmitVectorTernaryOpF(Context, () =>
  410. {
  411. Context.Emit(OpCodes.Mul);
  412. Context.Emit(OpCodes.Add);
  413. });
  414. }
  415. public static void Fmla_Ve(AILEmitterCtx Context)
  416. {
  417. EmitVectorTernaryOpByElemF(Context, () =>
  418. {
  419. Context.Emit(OpCodes.Mul);
  420. Context.Emit(OpCodes.Add);
  421. });
  422. }
  423. public static void Fmls_V(AILEmitterCtx Context)
  424. {
  425. EmitVectorTernaryOpF(Context, () =>
  426. {
  427. Context.Emit(OpCodes.Mul);
  428. Context.Emit(OpCodes.Sub);
  429. });
  430. }
  431. public static void Fmls_Ve(AILEmitterCtx Context)
  432. {
  433. EmitVectorTernaryOpByElemF(Context, () =>
  434. {
  435. Context.Emit(OpCodes.Mul);
  436. Context.Emit(OpCodes.Sub);
  437. });
  438. }
  439. public static void Fmsub_S(AILEmitterCtx Context)
  440. {
  441. EmitScalarTernaryRaOpF(Context, () =>
  442. {
  443. Context.Emit(OpCodes.Mul);
  444. Context.Emit(OpCodes.Sub);
  445. });
  446. }
  447. public static void Fmul_S(AILEmitterCtx Context)
  448. {
  449. if (AOptimizations.UseSse && AOptimizations.UseSse2)
  450. {
  451. EmitSseOrSse2CallF(Context, nameof(Sse.MultiplyScalar));
  452. }
  453. else
  454. {
  455. EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Mul));
  456. }
  457. }
  458. public static void Fmul_Se(AILEmitterCtx Context)
  459. {
  460. EmitScalarBinaryOpByElemF(Context, () => Context.Emit(OpCodes.Mul));
  461. }
  462. public static void Fmul_V(AILEmitterCtx Context)
  463. {
  464. if (AOptimizations.UseSse && AOptimizations.UseSse2)
  465. {
  466. EmitSseOrSse2CallF(Context, nameof(Sse.Multiply));
  467. }
  468. else
  469. {
  470. EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Mul));
  471. }
  472. }
  473. public static void Fmul_Ve(AILEmitterCtx Context)
  474. {
  475. EmitVectorBinaryOpByElemF(Context, () => Context.Emit(OpCodes.Mul));
  476. }
  477. public static void Fneg_S(AILEmitterCtx Context)
  478. {
  479. EmitScalarUnaryOpF(Context, () => Context.Emit(OpCodes.Neg));
  480. }
  481. public static void Fneg_V(AILEmitterCtx Context)
  482. {
  483. EmitVectorUnaryOpF(Context, () => Context.Emit(OpCodes.Neg));
  484. }
  485. public static void Fnmadd_S(AILEmitterCtx Context)
  486. {
  487. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  488. int SizeF = Op.Size & 1;
  489. EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
  490. Context.Emit(OpCodes.Neg);
  491. EmitVectorExtractF(Context, Op.Rm, 0, SizeF);
  492. Context.Emit(OpCodes.Mul);
  493. EmitVectorExtractF(Context, Op.Ra, 0, SizeF);
  494. Context.Emit(OpCodes.Sub);
  495. EmitScalarSetF(Context, Op.Rd, SizeF);
  496. }
  497. public static void Fnmsub_S(AILEmitterCtx Context)
  498. {
  499. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  500. int SizeF = Op.Size & 1;
  501. EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
  502. EmitVectorExtractF(Context, Op.Rm, 0, SizeF);
  503. Context.Emit(OpCodes.Mul);
  504. EmitVectorExtractF(Context, Op.Ra, 0, SizeF);
  505. Context.Emit(OpCodes.Sub);
  506. EmitScalarSetF(Context, Op.Rd, SizeF);
  507. }
  508. public static void Fnmul_S(AILEmitterCtx Context)
  509. {
  510. EmitScalarBinaryOpF(Context, () =>
  511. {
  512. Context.Emit(OpCodes.Mul);
  513. Context.Emit(OpCodes.Neg);
  514. });
  515. }
  516. public static void Frecpe_S(AILEmitterCtx Context)
  517. {
  518. EmitFrecpe(Context, 0, Scalar: true);
  519. }
  520. public static void Frecpe_V(AILEmitterCtx Context)
  521. {
  522. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  523. int SizeF = Op.Size & 1;
  524. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  525. for (int Index = 0; Index < Bytes >> SizeF + 2; Index++)
  526. {
  527. EmitFrecpe(Context, Index, Scalar: false);
  528. }
  529. if (Op.RegisterSize == ARegisterSize.SIMD64)
  530. {
  531. EmitVectorZeroUpper(Context, Op.Rd);
  532. }
  533. }
  534. private static void EmitFrecpe(AILEmitterCtx Context, int Index, bool Scalar)
  535. {
  536. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  537. int SizeF = Op.Size & 1;
  538. if (SizeF == 0)
  539. {
  540. Context.EmitLdc_R4(1);
  541. }
  542. else /* if (SizeF == 1) */
  543. {
  544. Context.EmitLdc_R8(1);
  545. }
  546. EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
  547. Context.Emit(OpCodes.Div);
  548. if (Scalar)
  549. {
  550. EmitVectorZeroAll(Context, Op.Rd);
  551. }
  552. EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
  553. }
  554. public static void Frecps_S(AILEmitterCtx Context)
  555. {
  556. EmitFrecps(Context, 0, Scalar: true);
  557. }
  558. public static void Frecps_V(AILEmitterCtx Context)
  559. {
  560. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  561. int SizeF = Op.Size & 1;
  562. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  563. for (int Index = 0; Index < Bytes >> SizeF + 2; Index++)
  564. {
  565. EmitFrecps(Context, Index, Scalar: false);
  566. }
  567. if (Op.RegisterSize == ARegisterSize.SIMD64)
  568. {
  569. EmitVectorZeroUpper(Context, Op.Rd);
  570. }
  571. }
  572. private static void EmitFrecps(AILEmitterCtx Context, int Index, bool Scalar)
  573. {
  574. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  575. int SizeF = Op.Size & 1;
  576. if (SizeF == 0)
  577. {
  578. Context.EmitLdc_R4(2);
  579. }
  580. else /* if (SizeF == 1) */
  581. {
  582. Context.EmitLdc_R8(2);
  583. }
  584. EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
  585. EmitVectorExtractF(Context, Op.Rm, Index, SizeF);
  586. Context.Emit(OpCodes.Mul);
  587. Context.Emit(OpCodes.Sub);
  588. if (Scalar)
  589. {
  590. EmitVectorZeroAll(Context, Op.Rd);
  591. }
  592. EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
  593. }
  594. public static void Frinta_S(AILEmitterCtx Context)
  595. {
  596. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  597. EmitVectorExtractF(Context, Op.Rn, 0, Op.Size);
  598. EmitRoundMathCall(Context, MidpointRounding.AwayFromZero);
  599. EmitScalarSetF(Context, Op.Rd, Op.Size);
  600. }
  601. public static void Frinta_V(AILEmitterCtx Context)
  602. {
  603. EmitVectorUnaryOpF(Context, () =>
  604. {
  605. EmitRoundMathCall(Context, MidpointRounding.AwayFromZero);
  606. });
  607. }
  608. public static void Frinti_S(AILEmitterCtx Context)
  609. {
  610. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  611. EmitScalarUnaryOpF(Context, () =>
  612. {
  613. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  614. Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
  615. if (Op.Size == 0)
  616. {
  617. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
  618. }
  619. else if (Op.Size == 1)
  620. {
  621. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
  622. }
  623. else
  624. {
  625. throw new InvalidOperationException();
  626. }
  627. });
  628. }
  629. public static void Frinti_V(AILEmitterCtx Context)
  630. {
  631. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  632. int SizeF = Op.Size & 1;
  633. EmitVectorUnaryOpF(Context, () =>
  634. {
  635. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  636. Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
  637. if (SizeF == 0)
  638. {
  639. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
  640. }
  641. else if (SizeF == 1)
  642. {
  643. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
  644. }
  645. else
  646. {
  647. throw new InvalidOperationException();
  648. }
  649. });
  650. }
  651. public static void Frintm_S(AILEmitterCtx Context)
  652. {
  653. EmitScalarUnaryOpF(Context, () =>
  654. {
  655. EmitUnaryMathCall(Context, nameof(Math.Floor));
  656. });
  657. }
  658. public static void Frintm_V(AILEmitterCtx Context)
  659. {
  660. EmitVectorUnaryOpF(Context, () =>
  661. {
  662. EmitUnaryMathCall(Context, nameof(Math.Floor));
  663. });
  664. }
  665. public static void Frintn_S(AILEmitterCtx Context)
  666. {
  667. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  668. EmitVectorExtractF(Context, Op.Rn, 0, Op.Size);
  669. EmitRoundMathCall(Context, MidpointRounding.ToEven);
  670. EmitScalarSetF(Context, Op.Rd, Op.Size);
  671. }
  672. public static void Frintn_V(AILEmitterCtx Context)
  673. {
  674. EmitVectorUnaryOpF(Context, () =>
  675. {
  676. EmitRoundMathCall(Context, MidpointRounding.ToEven);
  677. });
  678. }
  679. public static void Frintp_S(AILEmitterCtx Context)
  680. {
  681. EmitScalarUnaryOpF(Context, () =>
  682. {
  683. EmitUnaryMathCall(Context, nameof(Math.Ceiling));
  684. });
  685. }
  686. public static void Frintp_V(AILEmitterCtx Context)
  687. {
  688. EmitVectorUnaryOpF(Context, () =>
  689. {
  690. EmitUnaryMathCall(Context, nameof(Math.Ceiling));
  691. });
  692. }
  693. public static void Frintx_S(AILEmitterCtx Context)
  694. {
  695. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  696. EmitScalarUnaryOpF(Context, () =>
  697. {
  698. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  699. Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
  700. if (Op.Size == 0)
  701. {
  702. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
  703. }
  704. else if (Op.Size == 1)
  705. {
  706. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
  707. }
  708. else
  709. {
  710. throw new InvalidOperationException();
  711. }
  712. });
  713. }
  714. public static void Frintx_V(AILEmitterCtx Context)
  715. {
  716. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  717. EmitVectorUnaryOpF(Context, () =>
  718. {
  719. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  720. Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
  721. if (Op.Size == 0)
  722. {
  723. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
  724. }
  725. else if (Op.Size == 1)
  726. {
  727. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
  728. }
  729. else
  730. {
  731. throw new InvalidOperationException();
  732. }
  733. });
  734. }
  735. public static void Frsqrte_S(AILEmitterCtx Context)
  736. {
  737. EmitScalarUnaryOpF(Context, () =>
  738. {
  739. EmitUnarySoftFloatCall(Context, nameof(ASoftFloat.InvSqrtEstimate));
  740. });
  741. }
  742. public static void Frsqrte_V(AILEmitterCtx Context)
  743. {
  744. EmitVectorUnaryOpF(Context, () =>
  745. {
  746. EmitUnarySoftFloatCall(Context, nameof(ASoftFloat.InvSqrtEstimate));
  747. });
  748. }
  749. public static void Frsqrts_S(AILEmitterCtx Context)
  750. {
  751. EmitFrsqrts(Context, 0, Scalar: true);
  752. }
  753. public static void Frsqrts_V(AILEmitterCtx Context)
  754. {
  755. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  756. int SizeF = Op.Size & 1;
  757. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  758. for (int Index = 0; Index < Bytes >> SizeF + 2; Index++)
  759. {
  760. EmitFrsqrts(Context, Index, Scalar: false);
  761. }
  762. if (Op.RegisterSize == ARegisterSize.SIMD64)
  763. {
  764. EmitVectorZeroUpper(Context, Op.Rd);
  765. }
  766. }
  767. private static void EmitFrsqrts(AILEmitterCtx Context, int Index, bool Scalar)
  768. {
  769. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  770. int SizeF = Op.Size & 1;
  771. if (SizeF == 0)
  772. {
  773. Context.EmitLdc_R4(3);
  774. }
  775. else /* if (SizeF == 1) */
  776. {
  777. Context.EmitLdc_R8(3);
  778. }
  779. EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
  780. EmitVectorExtractF(Context, Op.Rm, Index, SizeF);
  781. Context.Emit(OpCodes.Mul);
  782. Context.Emit(OpCodes.Sub);
  783. if (SizeF == 0)
  784. {
  785. Context.EmitLdc_R4(0.5f);
  786. }
  787. else /* if (SizeF == 1) */
  788. {
  789. Context.EmitLdc_R8(0.5);
  790. }
  791. Context.Emit(OpCodes.Mul);
  792. if (Scalar)
  793. {
  794. EmitVectorZeroAll(Context, Op.Rd);
  795. }
  796. EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
  797. }
  798. public static void Fsqrt_S(AILEmitterCtx Context)
  799. {
  800. EmitScalarUnaryOpF(Context, () =>
  801. {
  802. EmitUnaryMathCall(Context, nameof(Math.Sqrt));
  803. });
  804. }
  805. public static void Fsub_S(AILEmitterCtx Context)
  806. {
  807. if (AOptimizations.UseSse && AOptimizations.UseSse2)
  808. {
  809. EmitSseOrSse2CallF(Context, nameof(Sse.SubtractScalar));
  810. }
  811. else
  812. {
  813. EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Sub));
  814. }
  815. }
  816. public static void Fsub_V(AILEmitterCtx Context)
  817. {
  818. if (AOptimizations.UseSse && AOptimizations.UseSse2)
  819. {
  820. EmitSseOrSse2CallF(Context, nameof(Sse.Subtract));
  821. }
  822. else
  823. {
  824. EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Sub));
  825. }
  826. }
  827. public static void Mla_V(AILEmitterCtx Context)
  828. {
  829. EmitVectorTernaryOpZx(Context, () =>
  830. {
  831. Context.Emit(OpCodes.Mul);
  832. Context.Emit(OpCodes.Add);
  833. });
  834. }
  835. public static void Mla_Ve(AILEmitterCtx Context)
  836. {
  837. EmitVectorTernaryOpByElemZx(Context, () =>
  838. {
  839. Context.Emit(OpCodes.Mul);
  840. Context.Emit(OpCodes.Add);
  841. });
  842. }
  843. public static void Mls_V(AILEmitterCtx Context)
  844. {
  845. EmitVectorTernaryOpZx(Context, () =>
  846. {
  847. Context.Emit(OpCodes.Mul);
  848. Context.Emit(OpCodes.Sub);
  849. });
  850. }
  851. public static void Mul_V(AILEmitterCtx Context)
  852. {
  853. EmitVectorBinaryOpZx(Context, () => Context.Emit(OpCodes.Mul));
  854. }
  855. public static void Mul_Ve(AILEmitterCtx Context)
  856. {
  857. EmitVectorBinaryOpByElemZx(Context, () => Context.Emit(OpCodes.Mul));
  858. }
  859. public static void Neg_S(AILEmitterCtx Context)
  860. {
  861. EmitScalarUnaryOpSx(Context, () => Context.Emit(OpCodes.Neg));
  862. }
  863. public static void Neg_V(AILEmitterCtx Context)
  864. {
  865. EmitVectorUnaryOpSx(Context, () => Context.Emit(OpCodes.Neg));
  866. }
  867. public static void Raddhn_V(AILEmitterCtx Context)
  868. {
  869. EmitHighNarrow(Context, () => Context.Emit(OpCodes.Add), Round: true);
  870. }
  871. public static void Rsubhn_V(AILEmitterCtx Context)
  872. {
  873. EmitHighNarrow(Context, () => Context.Emit(OpCodes.Sub), Round: true);
  874. }
  875. public static void Saddw_V(AILEmitterCtx Context)
  876. {
  877. EmitVectorWidenRmBinaryOpSx(Context, () => Context.Emit(OpCodes.Add));
  878. }
  879. public static void Smax_V(AILEmitterCtx Context)
  880. {
  881. Type[] Types = new Type[] { typeof(long), typeof(long) };
  882. MethodInfo MthdInfo = typeof(Math).GetMethod(nameof(Math.Max), Types);
  883. EmitVectorBinaryOpSx(Context, () => Context.EmitCall(MthdInfo));
  884. }
  885. public static void Smin_V(AILEmitterCtx Context)
  886. {
  887. Type[] Types = new Type[] { typeof(long), typeof(long) };
  888. MethodInfo MthdInfo = typeof(Math).GetMethod(nameof(Math.Min), Types);
  889. EmitVectorBinaryOpSx(Context, () => Context.EmitCall(MthdInfo));
  890. }
  891. public static void Smlal_V(AILEmitterCtx Context)
  892. {
  893. EmitVectorWidenRnRmTernaryOpSx(Context, () =>
  894. {
  895. Context.Emit(OpCodes.Mul);
  896. Context.Emit(OpCodes.Add);
  897. });
  898. }
  899. public static void Smull_V(AILEmitterCtx Context)
  900. {
  901. EmitVectorWidenRnRmBinaryOpSx(Context, () => Context.Emit(OpCodes.Mul));
  902. }
  903. public static void Sqxtn_S(AILEmitterCtx Context)
  904. {
  905. EmitSaturatingExtNarrow(Context, SignedSrc: true, SignedDst: true, Scalar: true);
  906. }
  907. public static void Sqxtn_V(AILEmitterCtx Context)
  908. {
  909. EmitSaturatingExtNarrow(Context, SignedSrc: true, SignedDst: true, Scalar: false);
  910. }
  911. public static void Sqxtun_S(AILEmitterCtx Context)
  912. {
  913. EmitSaturatingExtNarrow(Context, SignedSrc: true, SignedDst: false, Scalar: true);
  914. }
  915. public static void Sqxtun_V(AILEmitterCtx Context)
  916. {
  917. EmitSaturatingExtNarrow(Context, SignedSrc: true, SignedDst: false, Scalar: false);
  918. }
  919. public static void Sub_S(AILEmitterCtx Context)
  920. {
  921. EmitScalarBinaryOpZx(Context, () => Context.Emit(OpCodes.Sub));
  922. }
  923. public static void Sub_V(AILEmitterCtx Context)
  924. {
  925. if (AOptimizations.UseSse2)
  926. {
  927. EmitSse2Call(Context, nameof(Sse2.Subtract));
  928. }
  929. else
  930. {
  931. EmitVectorBinaryOpZx(Context, () => Context.Emit(OpCodes.Sub));
  932. }
  933. }
  934. public static void Subhn_V(AILEmitterCtx Context)
  935. {
  936. EmitHighNarrow(Context, () => Context.Emit(OpCodes.Sub), Round: false);
  937. }
  938. public static void Uabd_V(AILEmitterCtx Context)
  939. {
  940. EmitVectorBinaryOpZx(Context, () => EmitAbd(Context));
  941. }
  942. public static void Uabdl_V(AILEmitterCtx Context)
  943. {
  944. EmitVectorWidenRnRmBinaryOpZx(Context, () => EmitAbd(Context));
  945. }
  946. private static void EmitAbd(AILEmitterCtx Context)
  947. {
  948. Context.Emit(OpCodes.Sub);
  949. Type[] Types = new Type[] { typeof(long) };
  950. Context.EmitCall(typeof(Math).GetMethod(nameof(Math.Abs), Types));
  951. }
  952. public static void Uaddl_V(AILEmitterCtx Context)
  953. {
  954. EmitVectorWidenRnRmBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
  955. }
  956. public static void Uaddlv_V(AILEmitterCtx Context)
  957. {
  958. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  959. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  960. EmitVectorExtractZx(Context, Op.Rn, 0, Op.Size);
  961. for (int Index = 1; Index < (Bytes >> Op.Size); Index++)
  962. {
  963. EmitVectorExtractZx(Context, Op.Rn, Index, Op.Size);
  964. Context.Emit(OpCodes.Add);
  965. }
  966. EmitScalarSet(Context, Op.Rd, Op.Size + 1);
  967. }
  968. public static void Uaddw_V(AILEmitterCtx Context)
  969. {
  970. EmitVectorWidenRmBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
  971. }
  972. public static void Uhadd_V(AILEmitterCtx Context)
  973. {
  974. EmitVectorBinaryOpZx(Context, () =>
  975. {
  976. Context.Emit(OpCodes.Add);
  977. Context.EmitLdc_I4(1);
  978. Context.Emit(OpCodes.Shr_Un);
  979. });
  980. }
  981. public static void Umull_V(AILEmitterCtx Context)
  982. {
  983. EmitVectorWidenRnRmBinaryOpZx(Context, () => Context.Emit(OpCodes.Mul));
  984. }
  985. public static void Uqxtn_S(AILEmitterCtx Context)
  986. {
  987. EmitSaturatingExtNarrow(Context, SignedSrc: false, SignedDst: false, Scalar: true);
  988. }
  989. public static void Uqxtn_V(AILEmitterCtx Context)
  990. {
  991. EmitSaturatingExtNarrow(Context, SignedSrc: false, SignedDst: false, Scalar: false);
  992. }
  993. }
  994. }