AInstEmitSimdArithmetic.cs 35 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230
  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 EmitQxtn(AILEmitterCtx Context, bool Signed, 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 = (Signed ? (1 << (ESize - 1)) - 1 : (int)((1L << ESize) - 1L));
  163. int TMinValue = (Signed ? -((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, Signed);
  172. Context.Emit(OpCodes.Dup);
  173. Context.EmitLdc_I4(TMaxValue);
  174. Context.Emit(OpCodes.Conv_U8);
  175. Context.Emit(Signed ? 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(Signed ? 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.UseSse2)
  234. {
  235. EmitSse2CallF(Context, nameof(Sse2.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.UseSse2)
  245. {
  246. EmitSse2CallF(Context, nameof(Sse2.Add));
  247. }
  248. else
  249. {
  250. EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Add));
  251. }
  252. }
  253. public static void Faddp_V(AILEmitterCtx Context)
  254. {
  255. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  256. int SizeF = Op.Size & 1;
  257. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  258. int Elems = Bytes >> SizeF + 2;
  259. int Half = Elems >> 1;
  260. for (int Index = 0; Index < Elems; Index++)
  261. {
  262. int Elem = (Index & (Half - 1)) << 1;
  263. EmitVectorExtractF(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 0, SizeF);
  264. EmitVectorExtractF(Context, Index < Half ? Op.Rn : Op.Rm, Elem + 1, SizeF);
  265. Context.Emit(OpCodes.Add);
  266. EmitVectorInsertTmpF(Context, Index, SizeF);
  267. }
  268. Context.EmitLdvectmp();
  269. Context.EmitStvec(Op.Rd);
  270. if (Op.RegisterSize == ARegisterSize.SIMD64)
  271. {
  272. EmitVectorZeroUpper(Context, Op.Rd);
  273. }
  274. }
  275. public static void Fdiv_S(AILEmitterCtx Context)
  276. {
  277. if (AOptimizations.UseSse2)
  278. {
  279. EmitSse2CallF(Context, nameof(Sse2.DivideScalar));
  280. }
  281. else
  282. {
  283. EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Div));
  284. }
  285. }
  286. public static void Fdiv_V(AILEmitterCtx Context)
  287. {
  288. if (AOptimizations.UseSse2)
  289. {
  290. EmitSse2CallF(Context, nameof(Sse2.Divide));
  291. }
  292. else
  293. {
  294. EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Div));
  295. }
  296. }
  297. public static void Fmadd_S(AILEmitterCtx Context)
  298. {
  299. EmitScalarTernaryRaOpF(Context, () =>
  300. {
  301. Context.Emit(OpCodes.Mul);
  302. Context.Emit(OpCodes.Add);
  303. });
  304. }
  305. public static void Fmax_S(AILEmitterCtx Context)
  306. {
  307. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  308. EmitScalarBinaryOpF(Context, () =>
  309. {
  310. if (Op.Size == 0)
  311. {
  312. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MaxF));
  313. }
  314. else if (Op.Size == 1)
  315. {
  316. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Max));
  317. }
  318. else
  319. {
  320. throw new InvalidOperationException();
  321. }
  322. });
  323. }
  324. public static void Fmax_V(AILEmitterCtx Context)
  325. {
  326. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  327. EmitVectorBinaryOpF(Context, () =>
  328. {
  329. if (Op.Size == 0)
  330. {
  331. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MaxF));
  332. }
  333. else if (Op.Size == 1)
  334. {
  335. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Max));
  336. }
  337. else
  338. {
  339. throw new InvalidOperationException();
  340. }
  341. });
  342. }
  343. public static void Fmin_S(AILEmitterCtx Context)
  344. {
  345. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  346. EmitScalarBinaryOpF(Context, () =>
  347. {
  348. if (Op.Size == 0)
  349. {
  350. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MinF));
  351. }
  352. else if (Op.Size == 1)
  353. {
  354. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Min));
  355. }
  356. else
  357. {
  358. throw new InvalidOperationException();
  359. }
  360. });
  361. }
  362. public static void Fmin_V(AILEmitterCtx Context)
  363. {
  364. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  365. int SizeF = Op.Size & 1;
  366. EmitVectorBinaryOpF(Context, () =>
  367. {
  368. if (SizeF == 0)
  369. {
  370. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.MinF));
  371. }
  372. else if (SizeF == 1)
  373. {
  374. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Min));
  375. }
  376. else
  377. {
  378. throw new InvalidOperationException();
  379. }
  380. });
  381. }
  382. public static void Fmaxnm_S(AILEmitterCtx Context)
  383. {
  384. Fmax_S(Context);
  385. }
  386. public static void Fminnm_S(AILEmitterCtx Context)
  387. {
  388. Fmin_S(Context);
  389. }
  390. public static void Fmla_V(AILEmitterCtx Context)
  391. {
  392. EmitVectorTernaryOpF(Context, () =>
  393. {
  394. Context.Emit(OpCodes.Mul);
  395. Context.Emit(OpCodes.Add);
  396. });
  397. }
  398. public static void Fmla_Ve(AILEmitterCtx Context)
  399. {
  400. EmitVectorTernaryOpByElemF(Context, () =>
  401. {
  402. Context.Emit(OpCodes.Mul);
  403. Context.Emit(OpCodes.Add);
  404. });
  405. }
  406. public static void Fmls_V(AILEmitterCtx Context)
  407. {
  408. EmitVectorTernaryOpF(Context, () =>
  409. {
  410. Context.Emit(OpCodes.Mul);
  411. Context.Emit(OpCodes.Sub);
  412. });
  413. }
  414. public static void Fmls_Ve(AILEmitterCtx Context)
  415. {
  416. EmitVectorTernaryOpByElemF(Context, () =>
  417. {
  418. Context.Emit(OpCodes.Mul);
  419. Context.Emit(OpCodes.Sub);
  420. });
  421. }
  422. public static void Fmsub_S(AILEmitterCtx Context)
  423. {
  424. EmitScalarTernaryRaOpF(Context, () =>
  425. {
  426. Context.Emit(OpCodes.Mul);
  427. Context.Emit(OpCodes.Sub);
  428. });
  429. }
  430. public static void Fmul_S(AILEmitterCtx Context)
  431. {
  432. if (AOptimizations.UseSse2)
  433. {
  434. EmitSse2CallF(Context, nameof(Sse2.MultiplyScalar));
  435. }
  436. else
  437. {
  438. EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Mul));
  439. }
  440. }
  441. public static void Fmul_Se(AILEmitterCtx Context)
  442. {
  443. EmitScalarBinaryOpByElemF(Context, () => Context.Emit(OpCodes.Mul));
  444. }
  445. public static void Fmul_V(AILEmitterCtx Context)
  446. {
  447. if (AOptimizations.UseSse2)
  448. {
  449. EmitSse2CallF(Context, nameof(Sse2.Multiply));
  450. }
  451. else
  452. {
  453. EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Mul));
  454. }
  455. }
  456. public static void Fmul_Ve(AILEmitterCtx Context)
  457. {
  458. EmitVectorBinaryOpByElemF(Context, () => Context.Emit(OpCodes.Mul));
  459. }
  460. public static void Fneg_S(AILEmitterCtx Context)
  461. {
  462. EmitScalarUnaryOpF(Context, () => Context.Emit(OpCodes.Neg));
  463. }
  464. public static void Fneg_V(AILEmitterCtx Context)
  465. {
  466. EmitVectorUnaryOpF(Context, () => Context.Emit(OpCodes.Neg));
  467. }
  468. public static void Fnmadd_S(AILEmitterCtx Context)
  469. {
  470. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  471. int SizeF = Op.Size & 1;
  472. EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
  473. Context.Emit(OpCodes.Neg);
  474. EmitVectorExtractF(Context, Op.Rm, 0, SizeF);
  475. Context.Emit(OpCodes.Mul);
  476. EmitVectorExtractF(Context, Op.Ra, 0, SizeF);
  477. Context.Emit(OpCodes.Sub);
  478. EmitScalarSetF(Context, Op.Rd, SizeF);
  479. }
  480. public static void Fnmsub_S(AILEmitterCtx Context)
  481. {
  482. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  483. int SizeF = Op.Size & 1;
  484. EmitVectorExtractF(Context, Op.Rn, 0, SizeF);
  485. EmitVectorExtractF(Context, Op.Rm, 0, SizeF);
  486. Context.Emit(OpCodes.Mul);
  487. EmitVectorExtractF(Context, Op.Ra, 0, SizeF);
  488. Context.Emit(OpCodes.Sub);
  489. EmitScalarSetF(Context, Op.Rd, SizeF);
  490. }
  491. public static void Fnmul_S(AILEmitterCtx Context)
  492. {
  493. EmitScalarBinaryOpF(Context, () =>
  494. {
  495. Context.Emit(OpCodes.Mul);
  496. Context.Emit(OpCodes.Neg);
  497. });
  498. }
  499. public static void Frecpe_S(AILEmitterCtx Context)
  500. {
  501. EmitFrecpe(Context, 0, Scalar: true);
  502. }
  503. public static void Frecpe_V(AILEmitterCtx Context)
  504. {
  505. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  506. int SizeF = Op.Size & 1;
  507. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  508. for (int Index = 0; Index < Bytes >> SizeF + 2; Index++)
  509. {
  510. EmitFrecpe(Context, Index, Scalar: false);
  511. }
  512. if (Op.RegisterSize == ARegisterSize.SIMD64)
  513. {
  514. EmitVectorZeroUpper(Context, Op.Rd);
  515. }
  516. }
  517. private static void EmitFrecpe(AILEmitterCtx Context, int Index, bool Scalar)
  518. {
  519. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  520. int SizeF = Op.Size & 1;
  521. if (SizeF == 0)
  522. {
  523. Context.EmitLdc_R4(1);
  524. }
  525. else /* if (SizeF == 1) */
  526. {
  527. Context.EmitLdc_R8(1);
  528. }
  529. EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
  530. Context.Emit(OpCodes.Div);
  531. if (Scalar)
  532. {
  533. EmitVectorZeroAll(Context, Op.Rd);
  534. }
  535. EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
  536. }
  537. public static void Frecps_S(AILEmitterCtx Context)
  538. {
  539. EmitFrecps(Context, 0, Scalar: true);
  540. }
  541. public static void Frecps_V(AILEmitterCtx Context)
  542. {
  543. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  544. int SizeF = Op.Size & 1;
  545. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  546. for (int Index = 0; Index < Bytes >> SizeF + 2; Index++)
  547. {
  548. EmitFrecps(Context, Index, Scalar: false);
  549. }
  550. if (Op.RegisterSize == ARegisterSize.SIMD64)
  551. {
  552. EmitVectorZeroUpper(Context, Op.Rd);
  553. }
  554. }
  555. private static void EmitFrecps(AILEmitterCtx Context, int Index, bool Scalar)
  556. {
  557. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  558. int SizeF = Op.Size & 1;
  559. if (SizeF == 0)
  560. {
  561. Context.EmitLdc_R4(2);
  562. }
  563. else /* if (SizeF == 1) */
  564. {
  565. Context.EmitLdc_R8(2);
  566. }
  567. EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
  568. EmitVectorExtractF(Context, Op.Rm, Index, SizeF);
  569. Context.Emit(OpCodes.Mul);
  570. Context.Emit(OpCodes.Sub);
  571. if (Scalar)
  572. {
  573. EmitVectorZeroAll(Context, Op.Rd);
  574. }
  575. EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
  576. }
  577. public static void Frinta_S(AILEmitterCtx Context)
  578. {
  579. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  580. EmitVectorExtractF(Context, Op.Rn, 0, Op.Size);
  581. EmitRoundMathCall(Context, MidpointRounding.AwayFromZero);
  582. EmitScalarSetF(Context, Op.Rd, Op.Size);
  583. }
  584. public static void Frinta_V(AILEmitterCtx Context)
  585. {
  586. EmitVectorUnaryOpF(Context, () =>
  587. {
  588. EmitRoundMathCall(Context, MidpointRounding.AwayFromZero);
  589. });
  590. }
  591. public static void Frinti_S(AILEmitterCtx Context)
  592. {
  593. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  594. EmitScalarUnaryOpF(Context, () =>
  595. {
  596. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  597. Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
  598. if (Op.Size == 0)
  599. {
  600. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
  601. }
  602. else if (Op.Size == 1)
  603. {
  604. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
  605. }
  606. else
  607. {
  608. throw new InvalidOperationException();
  609. }
  610. });
  611. }
  612. public static void Frinti_V(AILEmitterCtx Context)
  613. {
  614. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  615. int SizeF = Op.Size & 1;
  616. EmitVectorUnaryOpF(Context, () =>
  617. {
  618. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  619. Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
  620. if (SizeF == 0)
  621. {
  622. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
  623. }
  624. else if (SizeF == 1)
  625. {
  626. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
  627. }
  628. else
  629. {
  630. throw new InvalidOperationException();
  631. }
  632. });
  633. }
  634. public static void Frintm_S(AILEmitterCtx Context)
  635. {
  636. EmitScalarUnaryOpF(Context, () =>
  637. {
  638. EmitUnaryMathCall(Context, nameof(Math.Floor));
  639. });
  640. }
  641. public static void Frintm_V(AILEmitterCtx Context)
  642. {
  643. EmitVectorUnaryOpF(Context, () =>
  644. {
  645. EmitUnaryMathCall(Context, nameof(Math.Floor));
  646. });
  647. }
  648. public static void Frintn_S(AILEmitterCtx Context)
  649. {
  650. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  651. EmitVectorExtractF(Context, Op.Rn, 0, Op.Size);
  652. EmitRoundMathCall(Context, MidpointRounding.ToEven);
  653. EmitScalarSetF(Context, Op.Rd, Op.Size);
  654. }
  655. public static void Frintn_V(AILEmitterCtx Context)
  656. {
  657. EmitVectorUnaryOpF(Context, () =>
  658. {
  659. EmitRoundMathCall(Context, MidpointRounding.ToEven);
  660. });
  661. }
  662. public static void Frintp_S(AILEmitterCtx Context)
  663. {
  664. EmitScalarUnaryOpF(Context, () =>
  665. {
  666. EmitUnaryMathCall(Context, nameof(Math.Ceiling));
  667. });
  668. }
  669. public static void Frintp_V(AILEmitterCtx Context)
  670. {
  671. EmitVectorUnaryOpF(Context, () =>
  672. {
  673. EmitUnaryMathCall(Context, nameof(Math.Ceiling));
  674. });
  675. }
  676. public static void Frintx_S(AILEmitterCtx Context)
  677. {
  678. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  679. EmitScalarUnaryOpF(Context, () =>
  680. {
  681. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  682. Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
  683. if (Op.Size == 0)
  684. {
  685. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
  686. }
  687. else if (Op.Size == 1)
  688. {
  689. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
  690. }
  691. else
  692. {
  693. throw new InvalidOperationException();
  694. }
  695. });
  696. }
  697. public static void Frintx_V(AILEmitterCtx Context)
  698. {
  699. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  700. EmitVectorUnaryOpF(Context, () =>
  701. {
  702. Context.EmitLdarg(ATranslatedSub.StateArgIdx);
  703. Context.EmitCallPropGet(typeof(AThreadState), nameof(AThreadState.Fpcr));
  704. if (Op.Size == 0)
  705. {
  706. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.RoundF));
  707. }
  708. else if (Op.Size == 1)
  709. {
  710. AVectorHelper.EmitCall(Context, nameof(AVectorHelper.Round));
  711. }
  712. else
  713. {
  714. throw new InvalidOperationException();
  715. }
  716. });
  717. }
  718. public static void Frsqrte_S(AILEmitterCtx Context)
  719. {
  720. EmitScalarUnaryOpF(Context, () =>
  721. {
  722. EmitUnarySoftFloatCall(Context, nameof(ASoftFloat.InvSqrtEstimate));
  723. });
  724. }
  725. public static void Frsqrte_V(AILEmitterCtx Context)
  726. {
  727. EmitVectorUnaryOpF(Context, () =>
  728. {
  729. EmitUnarySoftFloatCall(Context, nameof(ASoftFloat.InvSqrtEstimate));
  730. });
  731. }
  732. public static void Frsqrts_S(AILEmitterCtx Context)
  733. {
  734. EmitFrsqrts(Context, 0, Scalar: true);
  735. }
  736. public static void Frsqrts_V(AILEmitterCtx Context)
  737. {
  738. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  739. int SizeF = Op.Size & 1;
  740. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  741. for (int Index = 0; Index < Bytes >> SizeF + 2; Index++)
  742. {
  743. EmitFrsqrts(Context, Index, Scalar: false);
  744. }
  745. if (Op.RegisterSize == ARegisterSize.SIMD64)
  746. {
  747. EmitVectorZeroUpper(Context, Op.Rd);
  748. }
  749. }
  750. private static void EmitFrsqrts(AILEmitterCtx Context, int Index, bool Scalar)
  751. {
  752. AOpCodeSimdReg Op = (AOpCodeSimdReg)Context.CurrOp;
  753. int SizeF = Op.Size & 1;
  754. if (SizeF == 0)
  755. {
  756. Context.EmitLdc_R4(3);
  757. }
  758. else /* if (SizeF == 1) */
  759. {
  760. Context.EmitLdc_R8(3);
  761. }
  762. EmitVectorExtractF(Context, Op.Rn, Index, SizeF);
  763. EmitVectorExtractF(Context, Op.Rm, Index, SizeF);
  764. Context.Emit(OpCodes.Mul);
  765. Context.Emit(OpCodes.Sub);
  766. if (SizeF == 0)
  767. {
  768. Context.EmitLdc_R4(0.5f);
  769. }
  770. else /* if (SizeF == 1) */
  771. {
  772. Context.EmitLdc_R8(0.5);
  773. }
  774. Context.Emit(OpCodes.Mul);
  775. if (Scalar)
  776. {
  777. EmitVectorZeroAll(Context, Op.Rd);
  778. }
  779. EmitVectorInsertF(Context, Op.Rd, Index, SizeF);
  780. }
  781. public static void Fsqrt_S(AILEmitterCtx Context)
  782. {
  783. EmitScalarUnaryOpF(Context, () =>
  784. {
  785. EmitUnaryMathCall(Context, nameof(Math.Sqrt));
  786. });
  787. }
  788. public static void Fsub_S(AILEmitterCtx Context)
  789. {
  790. if (AOptimizations.UseSse2)
  791. {
  792. EmitSse2CallF(Context, nameof(Sse2.SubtractScalar));
  793. }
  794. else
  795. {
  796. EmitScalarBinaryOpF(Context, () => Context.Emit(OpCodes.Sub));
  797. }
  798. }
  799. public static void Fsub_V(AILEmitterCtx Context)
  800. {
  801. if (AOptimizations.UseSse2)
  802. {
  803. EmitSse2CallF(Context, nameof(Sse2.Subtract));
  804. }
  805. else
  806. {
  807. EmitVectorBinaryOpF(Context, () => Context.Emit(OpCodes.Sub));
  808. }
  809. }
  810. public static void Mla_V(AILEmitterCtx Context)
  811. {
  812. EmitVectorTernaryOpZx(Context, () =>
  813. {
  814. Context.Emit(OpCodes.Mul);
  815. Context.Emit(OpCodes.Add);
  816. });
  817. }
  818. public static void Mla_Ve(AILEmitterCtx Context)
  819. {
  820. EmitVectorTernaryOpByElemZx(Context, () =>
  821. {
  822. Context.Emit(OpCodes.Mul);
  823. Context.Emit(OpCodes.Add);
  824. });
  825. }
  826. public static void Mls_V(AILEmitterCtx Context)
  827. {
  828. EmitVectorTernaryOpZx(Context, () =>
  829. {
  830. Context.Emit(OpCodes.Mul);
  831. Context.Emit(OpCodes.Sub);
  832. });
  833. }
  834. public static void Mul_V(AILEmitterCtx Context)
  835. {
  836. EmitVectorBinaryOpZx(Context, () => Context.Emit(OpCodes.Mul));
  837. }
  838. public static void Mul_Ve(AILEmitterCtx Context)
  839. {
  840. EmitVectorBinaryOpByElemZx(Context, () => Context.Emit(OpCodes.Mul));
  841. }
  842. public static void Neg_S(AILEmitterCtx Context)
  843. {
  844. EmitScalarUnaryOpSx(Context, () => Context.Emit(OpCodes.Neg));
  845. }
  846. public static void Neg_V(AILEmitterCtx Context)
  847. {
  848. EmitVectorUnaryOpSx(Context, () => Context.Emit(OpCodes.Neg));
  849. }
  850. public static void Raddhn_V(AILEmitterCtx Context)
  851. {
  852. EmitHighNarrow(Context, () => Context.Emit(OpCodes.Add), Round: true);
  853. }
  854. public static void Rsubhn_V(AILEmitterCtx Context)
  855. {
  856. EmitHighNarrow(Context, () => Context.Emit(OpCodes.Sub), Round: true);
  857. }
  858. public static void Saddw_V(AILEmitterCtx Context)
  859. {
  860. EmitVectorWidenRmBinaryOpSx(Context, () => Context.Emit(OpCodes.Add));
  861. }
  862. public static void Smax_V(AILEmitterCtx Context)
  863. {
  864. Type[] Types = new Type[] { typeof(long), typeof(long) };
  865. MethodInfo MthdInfo = typeof(Math).GetMethod(nameof(Math.Max), Types);
  866. EmitVectorBinaryOpSx(Context, () => Context.EmitCall(MthdInfo));
  867. }
  868. public static void Smin_V(AILEmitterCtx Context)
  869. {
  870. Type[] Types = new Type[] { typeof(long), typeof(long) };
  871. MethodInfo MthdInfo = typeof(Math).GetMethod(nameof(Math.Min), Types);
  872. EmitVectorBinaryOpSx(Context, () => Context.EmitCall(MthdInfo));
  873. }
  874. public static void Smlal_V(AILEmitterCtx Context)
  875. {
  876. EmitVectorWidenRnRmTernaryOpSx(Context, () =>
  877. {
  878. Context.Emit(OpCodes.Mul);
  879. Context.Emit(OpCodes.Add);
  880. });
  881. }
  882. public static void Smull_V(AILEmitterCtx Context)
  883. {
  884. EmitVectorWidenRnRmBinaryOpSx(Context, () => Context.Emit(OpCodes.Mul));
  885. }
  886. public static void Sqxtn_S(AILEmitterCtx Context)
  887. {
  888. EmitQxtn(Context, Signed: true, Scalar: true);
  889. }
  890. public static void Sqxtn_V(AILEmitterCtx Context)
  891. {
  892. EmitQxtn(Context, Signed: true, Scalar: false);
  893. }
  894. public static void Sub_S(AILEmitterCtx Context)
  895. {
  896. EmitScalarBinaryOpZx(Context, () => Context.Emit(OpCodes.Sub));
  897. }
  898. public static void Sub_V(AILEmitterCtx Context)
  899. {
  900. if (AOptimizations.UseSse2)
  901. {
  902. EmitSse2Call(Context, nameof(Sse2.Subtract));
  903. }
  904. else
  905. {
  906. EmitVectorBinaryOpZx(Context, () => Context.Emit(OpCodes.Sub));
  907. }
  908. }
  909. public static void Subhn_V(AILEmitterCtx Context)
  910. {
  911. EmitHighNarrow(Context, () => Context.Emit(OpCodes.Sub), Round: false);
  912. }
  913. public static void Uabd_V(AILEmitterCtx Context)
  914. {
  915. EmitVectorBinaryOpZx(Context, () => EmitAbd(Context));
  916. }
  917. public static void Uabdl_V(AILEmitterCtx Context)
  918. {
  919. EmitVectorWidenRnRmBinaryOpZx(Context, () => EmitAbd(Context));
  920. }
  921. private static void EmitAbd(AILEmitterCtx Context)
  922. {
  923. Context.Emit(OpCodes.Sub);
  924. Type[] Types = new Type[] { typeof(long) };
  925. Context.EmitCall(typeof(Math).GetMethod(nameof(Math.Abs), Types));
  926. }
  927. public static void Uaddl_V(AILEmitterCtx Context)
  928. {
  929. EmitVectorWidenRnRmBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
  930. }
  931. public static void Uaddlv_V(AILEmitterCtx Context)
  932. {
  933. AOpCodeSimd Op = (AOpCodeSimd)Context.CurrOp;
  934. int Bytes = Context.CurrOp.GetBitsCount() >> 3;
  935. EmitVectorExtractZx(Context, Op.Rn, 0, Op.Size);
  936. for (int Index = 1; Index < (Bytes >> Op.Size); Index++)
  937. {
  938. EmitVectorExtractZx(Context, Op.Rn, Index, Op.Size);
  939. Context.Emit(OpCodes.Add);
  940. }
  941. EmitScalarSet(Context, Op.Rd, Op.Size + 1);
  942. }
  943. public static void Uaddw_V(AILEmitterCtx Context)
  944. {
  945. EmitVectorWidenRmBinaryOpZx(Context, () => Context.Emit(OpCodes.Add));
  946. }
  947. public static void Uhadd_V(AILEmitterCtx Context)
  948. {
  949. EmitVectorBinaryOpZx(Context, () =>
  950. {
  951. Context.Emit(OpCodes.Add);
  952. Context.EmitLdc_I4(1);
  953. Context.Emit(OpCodes.Shr_Un);
  954. });
  955. }
  956. public static void Umull_V(AILEmitterCtx Context)
  957. {
  958. EmitVectorWidenRnRmBinaryOpZx(Context, () => Context.Emit(OpCodes.Mul));
  959. }
  960. public static void Uqxtn_S(AILEmitterCtx Context)
  961. {
  962. EmitQxtn(Context, Signed: false, Scalar: true);
  963. }
  964. public static void Uqxtn_V(AILEmitterCtx Context)
  965. {
  966. EmitQxtn(Context, Signed: false, Scalar: false);
  967. }
  968. }
  969. }