InstEmitSimdArithmetic32.cs 52 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392
  1. using ARMeilleure.Decoders;
  2. using ARMeilleure.IntermediateRepresentation;
  3. using ARMeilleure.Translation;
  4. using System;
  5. using System.Diagnostics;
  6. using static ARMeilleure.Instructions.InstEmitFlowHelper;
  7. using static ARMeilleure.Instructions.InstEmitHelper;
  8. using static ARMeilleure.Instructions.InstEmitSimdHelper;
  9. using static ARMeilleure.Instructions.InstEmitSimdHelper32;
  10. using static ARMeilleure.IntermediateRepresentation.OperandHelper;
  11. namespace ARMeilleure.Instructions
  12. {
  13. static partial class InstEmit32
  14. {
  15. public static void Vabd_I(ArmEmitterContext context)
  16. {
  17. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  18. EmitVectorBinaryOpI32(context, (op1, op2) => EmitAbs(context, context.Subtract(op1, op2)), !op.U);
  19. }
  20. public static void Vabdl_I(ArmEmitterContext context)
  21. {
  22. OpCode32SimdRegLong op = (OpCode32SimdRegLong)context.CurrOp;
  23. EmitVectorBinaryLongOpI32(context, (op1, op2) => EmitAbs(context, context.Subtract(op1, op2)), !op.U);
  24. }
  25. public static void Vabs_S(ArmEmitterContext context)
  26. {
  27. OpCode32SimdS op = (OpCode32SimdS)context.CurrOp;
  28. if (Optimizations.FastFP && Optimizations.UseSse2)
  29. {
  30. EmitScalarUnaryOpSimd32(context, (m) =>
  31. {
  32. return EmitFloatAbs(context, m, (op.Size & 1) == 0, false);
  33. });
  34. }
  35. else
  36. {
  37. EmitScalarUnaryOpF32(context, (op1) => EmitUnaryMathCall(context, nameof(Math.Abs), op1));
  38. }
  39. }
  40. public static void Vabs_V(ArmEmitterContext context)
  41. {
  42. OpCode32SimdCmpZ op = (OpCode32SimdCmpZ)context.CurrOp;
  43. if (op.F)
  44. {
  45. if (Optimizations.FastFP && Optimizations.UseSse2)
  46. {
  47. EmitVectorUnaryOpSimd32(context, (m) =>
  48. {
  49. return EmitFloatAbs(context, m, (op.Size & 1) == 0, true);
  50. });
  51. }
  52. else
  53. {
  54. EmitVectorUnaryOpF32(context, (op1) => EmitUnaryMathCall(context, nameof(Math.Abs), op1));
  55. }
  56. }
  57. else
  58. {
  59. EmitVectorUnaryOpSx32(context, (op1) => EmitAbs(context, op1));
  60. }
  61. }
  62. private static Operand EmitAbs(ArmEmitterContext context, Operand value)
  63. {
  64. Operand isPositive = context.ICompareGreaterOrEqual(value, Const(value.Type, 0));
  65. return context.ConditionalSelect(isPositive, value, context.Negate(value));
  66. }
  67. public static void Vadd_S(ArmEmitterContext context)
  68. {
  69. if (Optimizations.FastFP && Optimizations.UseSse2)
  70. {
  71. EmitScalarBinaryOpF32(context, Intrinsic.X86Addss, Intrinsic.X86Addsd);
  72. }
  73. else if (Optimizations.FastFP)
  74. {
  75. EmitScalarBinaryOpF32(context, (op1, op2) => context.Add(op1, op2));
  76. }
  77. else
  78. {
  79. EmitScalarBinaryOpF32(context, (op1, op2) => EmitSoftFloatCall(context, nameof(SoftFloat32.FPAdd), op1, op2));
  80. }
  81. }
  82. public static void Vadd_V(ArmEmitterContext context)
  83. {
  84. if (Optimizations.FastFP && Optimizations.UseSse2)
  85. {
  86. EmitVectorBinaryOpF32(context, Intrinsic.X86Addps, Intrinsic.X86Addpd);
  87. }
  88. else if (Optimizations.FastFP)
  89. {
  90. EmitVectorBinaryOpF32(context, (op1, op2) => context.Add(op1, op2));
  91. }
  92. else
  93. {
  94. EmitVectorBinaryOpF32(context, (op1, op2) => EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPAddFpscr), op1, op2));
  95. }
  96. }
  97. public static void Vadd_I(ArmEmitterContext context)
  98. {
  99. if (Optimizations.UseSse2)
  100. {
  101. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  102. EmitVectorBinaryOpSimd32(context, (op1, op2) => context.AddIntrinsic(X86PaddInstruction[op.Size], op1, op2));
  103. }
  104. else
  105. {
  106. EmitVectorBinaryOpZx32(context, (op1, op2) => context.Add(op1, op2));
  107. }
  108. }
  109. public static void Vaddl_I(ArmEmitterContext context)
  110. {
  111. OpCode32SimdRegLong op = (OpCode32SimdRegLong)context.CurrOp;
  112. EmitVectorBinaryLongOpI32(context, (op1, op2) => context.Add(op1, op2), !op.U);
  113. }
  114. public static void Vaddw_I(ArmEmitterContext context)
  115. {
  116. OpCode32SimdRegWide op = (OpCode32SimdRegWide)context.CurrOp;
  117. EmitVectorBinaryWideOpI32(context, (op1, op2) => context.Add(op1, op2), !op.U);
  118. }
  119. public static void Vdup(ArmEmitterContext context)
  120. {
  121. OpCode32SimdDupGP op = (OpCode32SimdDupGP)context.CurrOp;
  122. Operand insert = GetIntA32(context, op.Rt);
  123. // Zero extend into an I64, then replicate. Saves the most time over elementwise inserts.
  124. insert = op.Size switch
  125. {
  126. 2 => context.Multiply(context.ZeroExtend32(OperandType.I64, insert), Const(0x0000000100000001u)),
  127. 1 => context.Multiply(context.ZeroExtend16(OperandType.I64, insert), Const(0x0001000100010001u)),
  128. 0 => context.Multiply(context.ZeroExtend8(OperandType.I64, insert), Const(0x0101010101010101u)),
  129. _ => throw new InvalidOperationException($"Invalid Vdup size \"{op.Size}\".")
  130. };
  131. InsertScalar(context, op.Vd, insert);
  132. if (op.Q)
  133. {
  134. InsertScalar(context, op.Vd + 1, insert);
  135. }
  136. }
  137. public static void Vdup_1(ArmEmitterContext context)
  138. {
  139. OpCode32SimdDupElem op = (OpCode32SimdDupElem)context.CurrOp;
  140. Operand insert = EmitVectorExtractZx32(context, op.Vm >> 1, ((op.Vm & 1) << (3 - op.Size)) + op.Index, op.Size);
  141. // Zero extend into an I64, then replicate. Saves the most time over elementwise inserts.
  142. insert = op.Size switch
  143. {
  144. 2 => context.Multiply(context.ZeroExtend32(OperandType.I64, insert), Const(0x0000000100000001u)),
  145. 1 => context.Multiply(context.ZeroExtend16(OperandType.I64, insert), Const(0x0001000100010001u)),
  146. 0 => context.Multiply(context.ZeroExtend8(OperandType.I64, insert), Const(0x0101010101010101u)),
  147. _ => throw new InvalidOperationException($"Invalid Vdup size \"{op.Size}\".")
  148. };
  149. InsertScalar(context, op.Vd, insert);
  150. if (op.Q)
  151. {
  152. InsertScalar(context, op.Vd | 1, insert);
  153. }
  154. }
  155. private static (long, long) MaskHelperByteSequence(int start, int length, int startByte)
  156. {
  157. int end = start + length;
  158. int b = startByte;
  159. long result = 0;
  160. long result2 = 0;
  161. for (int i = 0; i < 8; i++)
  162. {
  163. result |= (long)((i >= end || i < start) ? 0x80 : b++) << (i * 8);
  164. }
  165. for (int i = 8; i < 16; i++)
  166. {
  167. result2 |= (long)((i >= end || i < start) ? 0x80 : b++) << ((i - 8) * 8);
  168. }
  169. return (result2, result);
  170. }
  171. public static void Vext(ArmEmitterContext context)
  172. {
  173. OpCode32SimdExt op = (OpCode32SimdExt)context.CurrOp;
  174. int elems = op.GetBytesCount();
  175. int byteOff = op.Immediate;
  176. if (Optimizations.UseSsse3)
  177. {
  178. EmitVectorBinaryOpSimd32(context, (n, m) =>
  179. {
  180. // Writing low to high of d: start <imm> into n, overlap into m.
  181. // Then rotate n down by <imm>, m up by (elems)-imm.
  182. // Then OR them together for the result.
  183. (long nMaskHigh, long nMaskLow) = MaskHelperByteSequence(0, elems - byteOff, byteOff);
  184. (long mMaskHigh, long mMaskLow) = MaskHelperByteSequence(elems - byteOff, byteOff, 0);
  185. Operand nMask, mMask;
  186. if (!op.Q)
  187. {
  188. // Do the same operation to the bytes in the top doubleword too, as our target could be in either.
  189. nMaskHigh = nMaskLow + 0x0808080808080808L;
  190. mMaskHigh = mMaskLow + 0x0808080808080808L;
  191. }
  192. nMask = X86GetElements(context, nMaskHigh, nMaskLow);
  193. mMask = X86GetElements(context, mMaskHigh, mMaskLow);
  194. Operand nPart = context.AddIntrinsic(Intrinsic.X86Pshufb, n, nMask);
  195. Operand mPart = context.AddIntrinsic(Intrinsic.X86Pshufb, m, mMask);
  196. return context.AddIntrinsic(Intrinsic.X86Por, nPart, mPart);
  197. });
  198. }
  199. else
  200. {
  201. Operand res = GetVecA32(op.Qd);
  202. for (int index = 0; index < elems; index++)
  203. {
  204. Operand extract;
  205. if (byteOff >= elems)
  206. {
  207. extract = EmitVectorExtractZx32(context, op.Qm, op.Im + (byteOff - elems), op.Size);
  208. }
  209. else
  210. {
  211. extract = EmitVectorExtractZx32(context, op.Qn, op.In + byteOff, op.Size);
  212. }
  213. byteOff++;
  214. res = EmitVectorInsert(context, res, extract, op.Id + index, op.Size);
  215. }
  216. context.Copy(GetVecA32(op.Qd), res);
  217. }
  218. }
  219. public static void Vfma_S(ArmEmitterContext context) // Fused.
  220. {
  221. if (Optimizations.FastFP && Optimizations.UseFma)
  222. {
  223. EmitScalarTernaryOpF32(context, Intrinsic.X86Vfmadd231ss, Intrinsic.X86Vfmadd231sd);
  224. }
  225. else if (Optimizations.FastFP && Optimizations.UseSse2)
  226. {
  227. EmitScalarTernaryOpF32(context, Intrinsic.X86Mulss, Intrinsic.X86Mulsd, Intrinsic.X86Addss, Intrinsic.X86Addsd);
  228. }
  229. else
  230. {
  231. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  232. {
  233. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPMulAdd), op1, op2, op3);
  234. });
  235. }
  236. }
  237. public static void Vfma_V(ArmEmitterContext context) // Fused.
  238. {
  239. if (Optimizations.FastFP && Optimizations.UseFma)
  240. {
  241. EmitVectorTernaryOpF32(context, Intrinsic.X86Vfmadd231ps);
  242. }
  243. else
  244. {
  245. EmitVectorTernaryOpF32(context, (op1, op2, op3) =>
  246. {
  247. return EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMulAddFpscr), op1, op2, op3);
  248. });
  249. }
  250. }
  251. public static void Vfms_S(ArmEmitterContext context) // Fused.
  252. {
  253. if (Optimizations.FastFP && Optimizations.UseFma)
  254. {
  255. EmitScalarTernaryOpF32(context, Intrinsic.X86Vfnmadd231ss, Intrinsic.X86Vfnmadd231sd);
  256. }
  257. else if (Optimizations.FastFP && Optimizations.UseSse2)
  258. {
  259. EmitScalarTernaryOpF32(context, Intrinsic.X86Mulss, Intrinsic.X86Mulsd, Intrinsic.X86Subss, Intrinsic.X86Subsd);
  260. }
  261. else
  262. {
  263. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  264. {
  265. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPMulSub), op1, op2, op3);
  266. });
  267. }
  268. }
  269. public static void Vfms_V(ArmEmitterContext context) // Fused.
  270. {
  271. if (Optimizations.FastFP && Optimizations.UseFma)
  272. {
  273. EmitVectorTernaryOpF32(context, Intrinsic.X86Vfnmadd231ps);
  274. }
  275. else
  276. {
  277. EmitVectorTernaryOpF32(context, (op1, op2, op3) =>
  278. {
  279. return EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMulSubFpscr), op1, op2, op3);
  280. });
  281. }
  282. }
  283. public static void Vfnma_S(ArmEmitterContext context) // Fused.
  284. {
  285. if (Optimizations.FastFP && Optimizations.UseFma)
  286. {
  287. EmitScalarTernaryOpF32(context, Intrinsic.X86Vfnmsub231ss, Intrinsic.X86Vfnmsub231sd);
  288. }
  289. else if (Optimizations.FastFP && Optimizations.UseSse2)
  290. {
  291. EmitScalarTernaryOpF32(context, Intrinsic.X86Mulss, Intrinsic.X86Mulsd, Intrinsic.X86Subss, Intrinsic.X86Subsd, isNegD: true);
  292. }
  293. else
  294. {
  295. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  296. {
  297. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPNegMulAdd), op1, op2, op3);
  298. });
  299. }
  300. }
  301. public static void Vfnms_S(ArmEmitterContext context) // Fused.
  302. {
  303. if (Optimizations.FastFP && Optimizations.UseFma)
  304. {
  305. EmitScalarTernaryOpF32(context, Intrinsic.X86Vfmsub231ss, Intrinsic.X86Vfmsub231sd);
  306. }
  307. else if (Optimizations.FastFP && Optimizations.UseSse2)
  308. {
  309. EmitScalarTernaryOpF32(context, Intrinsic.X86Mulss, Intrinsic.X86Mulsd, Intrinsic.X86Addss, Intrinsic.X86Addsd, isNegD: true);
  310. }
  311. else
  312. {
  313. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  314. {
  315. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPNegMulSub), op1, op2, op3);
  316. });
  317. }
  318. }
  319. public static void Vhadd(ArmEmitterContext context)
  320. {
  321. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  322. if (op.U)
  323. {
  324. EmitVectorBinaryOpZx32(context, (op1, op2) => context.ShiftRightUI(context.Add(op1, op2), Const(1)));
  325. }
  326. else
  327. {
  328. EmitVectorBinaryOpSx32(context, (op1, op2) => context.ShiftRightSI(context.Add(op1, op2), Const(1)));
  329. }
  330. }
  331. public static void Vmov_S(ArmEmitterContext context)
  332. {
  333. if (Optimizations.FastFP && Optimizations.UseSse2)
  334. {
  335. EmitScalarUnaryOpF32(context, 0, 0);
  336. }
  337. else
  338. {
  339. EmitScalarUnaryOpF32(context, (op1) => op1);
  340. }
  341. }
  342. public static void Vmovn(ArmEmitterContext context)
  343. {
  344. EmitVectorUnaryNarrowOp32(context, (op1) => op1);
  345. }
  346. public static void Vneg_S(ArmEmitterContext context)
  347. {
  348. OpCode32SimdS op = (OpCode32SimdS)context.CurrOp;
  349. if (Optimizations.UseSse2)
  350. {
  351. EmitScalarUnaryOpSimd32(context, (m) =>
  352. {
  353. if ((op.Size & 1) == 0)
  354. {
  355. Operand mask = X86GetScalar(context, -0f);
  356. return context.AddIntrinsic(Intrinsic.X86Xorps, mask, m);
  357. }
  358. else
  359. {
  360. Operand mask = X86GetScalar(context, -0d);
  361. return context.AddIntrinsic(Intrinsic.X86Xorpd, mask, m);
  362. }
  363. });
  364. }
  365. else
  366. {
  367. EmitScalarUnaryOpF32(context, (op1) => context.Negate(op1));
  368. }
  369. }
  370. public static void Vnmul_S(ArmEmitterContext context)
  371. {
  372. OpCode32SimdRegS op = (OpCode32SimdRegS)context.CurrOp;
  373. if (Optimizations.UseSse2)
  374. {
  375. EmitScalarBinaryOpSimd32(context, (n, m) =>
  376. {
  377. if ((op.Size & 1) == 0)
  378. {
  379. Operand res = context.AddIntrinsic(Intrinsic.X86Mulss, n, m);
  380. Operand mask = X86GetScalar(context, -0f);
  381. return context.AddIntrinsic(Intrinsic.X86Xorps, mask, res);
  382. }
  383. else
  384. {
  385. Operand res = context.AddIntrinsic(Intrinsic.X86Mulsd, n, m);
  386. Operand mask = X86GetScalar(context, -0d);
  387. return context.AddIntrinsic(Intrinsic.X86Xorpd, mask, res);
  388. }
  389. });
  390. }
  391. else
  392. {
  393. EmitScalarBinaryOpF32(context, (op1, op2) => context.Negate(context.Multiply(op1, op2)));
  394. }
  395. }
  396. public static void Vnmla_S(ArmEmitterContext context)
  397. {
  398. OpCode32SimdRegS op = (OpCode32SimdRegS)context.CurrOp;
  399. if (Optimizations.FastFP && Optimizations.UseSse2)
  400. {
  401. EmitScalarTernaryOpF32(context, Intrinsic.X86Mulss, Intrinsic.X86Mulsd, Intrinsic.X86Subss, Intrinsic.X86Subsd, isNegD: true);
  402. }
  403. else if (Optimizations.FastFP)
  404. {
  405. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  406. {
  407. return context.Subtract(context.Negate(op1), context.Multiply(op2, op3));
  408. });
  409. }
  410. else
  411. {
  412. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  413. {
  414. Operand res = EmitSoftFloatCall(context, nameof(SoftFloat32.FPMul), op2, op3);
  415. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPSub), context.Negate(op1), res);
  416. });
  417. }
  418. }
  419. public static void Vnmls_S(ArmEmitterContext context)
  420. {
  421. OpCode32SimdRegS op = (OpCode32SimdRegS)context.CurrOp;
  422. if (Optimizations.FastFP && Optimizations.UseSse2)
  423. {
  424. EmitScalarTernaryOpF32(context, Intrinsic.X86Mulss, Intrinsic.X86Mulsd, Intrinsic.X86Addss, Intrinsic.X86Addsd, isNegD: true);
  425. }
  426. else if (Optimizations.FastFP)
  427. {
  428. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  429. {
  430. return context.Add(context.Negate(op1), context.Multiply(op2, op3));
  431. });
  432. }
  433. else
  434. {
  435. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  436. {
  437. Operand res = EmitSoftFloatCall(context, nameof(SoftFloat32.FPMul), op2, op3);
  438. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPAdd), context.Negate(op1), res);
  439. });
  440. }
  441. }
  442. public static void Vneg_V(ArmEmitterContext context)
  443. {
  444. OpCode32SimdCmpZ op = (OpCode32SimdCmpZ)context.CurrOp;
  445. if (op.F)
  446. {
  447. if (Optimizations.FastFP && Optimizations.UseSse2)
  448. {
  449. EmitVectorUnaryOpSimd32(context, (m) =>
  450. {
  451. if ((op.Size & 1) == 0)
  452. {
  453. Operand mask = X86GetAllElements(context, -0f);
  454. return context.AddIntrinsic(Intrinsic.X86Xorps, mask, m);
  455. }
  456. else
  457. {
  458. Operand mask = X86GetAllElements(context, -0d);
  459. return context.AddIntrinsic(Intrinsic.X86Xorpd, mask, m);
  460. }
  461. });
  462. }
  463. else
  464. {
  465. EmitVectorUnaryOpF32(context, (op1) => context.Negate(op1));
  466. }
  467. }
  468. else
  469. {
  470. EmitVectorUnaryOpSx32(context, (op1) => context.Negate(op1));
  471. }
  472. }
  473. public static void Vdiv_S(ArmEmitterContext context)
  474. {
  475. if (Optimizations.FastFP && Optimizations.UseSse2)
  476. {
  477. EmitScalarBinaryOpF32(context, Intrinsic.X86Divss, Intrinsic.X86Divsd);
  478. }
  479. else if (Optimizations.FastFP)
  480. {
  481. EmitScalarBinaryOpF32(context, (op1, op2) => context.Divide(op1, op2));
  482. }
  483. else
  484. {
  485. EmitScalarBinaryOpF32(context, (op1, op2) =>
  486. {
  487. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPDiv), op1, op2);
  488. });
  489. }
  490. }
  491. public static void Vmaxnm_S(ArmEmitterContext context)
  492. {
  493. if (Optimizations.FastFP && Optimizations.UseSse41)
  494. {
  495. EmitSse41MaxMinNumOpF32(context, true, true);
  496. }
  497. else
  498. {
  499. EmitScalarBinaryOpF32(context, (op1, op2) => EmitSoftFloatCall(context, nameof(SoftFloat32.FPMaxNum), op1, op2));
  500. }
  501. }
  502. public static void Vmaxnm_V(ArmEmitterContext context)
  503. {
  504. if (Optimizations.FastFP && Optimizations.UseSse41)
  505. {
  506. EmitSse41MaxMinNumOpF32(context, true, false);
  507. }
  508. else
  509. {
  510. EmitVectorBinaryOpSx32(context, (op1, op2) => EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMaxNumFpscr), op1, op2));
  511. }
  512. }
  513. public static void Vminnm_S(ArmEmitterContext context)
  514. {
  515. if (Optimizations.FastFP && Optimizations.UseSse41)
  516. {
  517. EmitSse41MaxMinNumOpF32(context, false, true);
  518. }
  519. else
  520. {
  521. EmitScalarBinaryOpF32(context, (op1, op2) => EmitSoftFloatCall(context, nameof(SoftFloat32.FPMinNum), op1, op2));
  522. }
  523. }
  524. public static void Vminnm_V(ArmEmitterContext context)
  525. {
  526. if (Optimizations.FastFP && Optimizations.UseSse41)
  527. {
  528. EmitSse41MaxMinNumOpF32(context, false, false);
  529. }
  530. else
  531. {
  532. EmitVectorBinaryOpSx32(context, (op1, op2) => EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMinNumFpscr), op1, op2));
  533. }
  534. }
  535. public static void Vmax_V(ArmEmitterContext context)
  536. {
  537. if (Optimizations.FastFP && Optimizations.UseSse2)
  538. {
  539. EmitVectorBinaryOpF32(context, Intrinsic.X86Maxps, Intrinsic.X86Maxpd);
  540. }
  541. else
  542. {
  543. EmitVectorBinaryOpF32(context, (op1, op2) =>
  544. {
  545. return EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMaxFpscr), op1, op2);
  546. });
  547. }
  548. }
  549. public static void Vmax_I(ArmEmitterContext context)
  550. {
  551. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  552. if (op.U)
  553. {
  554. if (Optimizations.UseSse2)
  555. {
  556. EmitVectorBinaryOpSimd32(context, (op1, op2) => context.AddIntrinsic(X86PmaxuInstruction[op.Size], op1, op2));
  557. }
  558. else
  559. {
  560. EmitVectorBinaryOpZx32(context, (op1, op2) => context.ConditionalSelect(context.ICompareGreaterUI(op1, op2), op1, op2));
  561. }
  562. }
  563. else
  564. {
  565. if (Optimizations.UseSse2)
  566. {
  567. EmitVectorBinaryOpSimd32(context, (op1, op2) => context.AddIntrinsic(X86PmaxsInstruction[op.Size], op1, op2));
  568. }
  569. else
  570. {
  571. EmitVectorBinaryOpSx32(context, (op1, op2) => context.ConditionalSelect(context.ICompareGreater(op1, op2), op1, op2));
  572. }
  573. }
  574. }
  575. public static void Vmin_V(ArmEmitterContext context)
  576. {
  577. if (Optimizations.FastFP && Optimizations.UseSse2)
  578. {
  579. EmitVectorBinaryOpF32(context, Intrinsic.X86Minps, Intrinsic.X86Minpd);
  580. }
  581. else
  582. {
  583. EmitVectorBinaryOpF32(context, (op1, op2) =>
  584. {
  585. return EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMinFpscr), op1, op2);
  586. });
  587. }
  588. }
  589. public static void Vmin_I(ArmEmitterContext context)
  590. {
  591. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  592. if (op.U)
  593. {
  594. if (Optimizations.UseSse2)
  595. {
  596. EmitVectorBinaryOpSimd32(context, (op1, op2) => context.AddIntrinsic(X86PminuInstruction[op.Size], op1, op2));
  597. }
  598. else
  599. {
  600. EmitVectorBinaryOpZx32(context, (op1, op2) => context.ConditionalSelect(context.ICompareLessUI(op1, op2), op1, op2));
  601. }
  602. }
  603. else
  604. {
  605. if (Optimizations.UseSse2)
  606. {
  607. EmitVectorBinaryOpSimd32(context, (op1, op2) => context.AddIntrinsic(X86PminsInstruction[op.Size], op1, op2));
  608. }
  609. else
  610. {
  611. EmitVectorBinaryOpSx32(context, (op1, op2) => context.ConditionalSelect(context.ICompareLess(op1, op2), op1, op2));
  612. }
  613. }
  614. }
  615. public static void Vmla_S(ArmEmitterContext context)
  616. {
  617. if (Optimizations.FastFP && Optimizations.UseSse2)
  618. {
  619. EmitScalarTernaryOpF32(context, Intrinsic.X86Mulss, Intrinsic.X86Mulsd, Intrinsic.X86Addss, Intrinsic.X86Addsd);
  620. }
  621. else if (Optimizations.FastFP)
  622. {
  623. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  624. {
  625. return context.Add(op1, context.Multiply(op2, op3));
  626. });
  627. }
  628. else
  629. {
  630. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  631. {
  632. Operand res = EmitSoftFloatCall(context, nameof(SoftFloat32.FPMul), op2, op3);
  633. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPAdd), op1, res);
  634. });
  635. }
  636. }
  637. public static void Vmla_V(ArmEmitterContext context)
  638. {
  639. if (Optimizations.FastFP && Optimizations.UseSse2)
  640. {
  641. EmitVectorTernaryOpF32(context, Intrinsic.X86Mulps, Intrinsic.X86Mulpd, Intrinsic.X86Addps, Intrinsic.X86Addpd);
  642. }
  643. else if (Optimizations.FastFP)
  644. {
  645. EmitVectorTernaryOpF32(context, (op1, op2, op3) => context.Add(op1, context.Multiply(op2, op3)));
  646. }
  647. else
  648. {
  649. EmitVectorTernaryOpF32(context, (op1, op2, op3) =>
  650. {
  651. return EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMulAddFpscr), op1, op2, op3);
  652. });
  653. }
  654. }
  655. public static void Vmla_I(ArmEmitterContext context)
  656. {
  657. EmitVectorTernaryOpZx32(context, (op1, op2, op3) => context.Add(op1, context.Multiply(op2, op3)));
  658. }
  659. public static void Vmla_1(ArmEmitterContext context)
  660. {
  661. OpCode32SimdRegElem op = (OpCode32SimdRegElem)context.CurrOp;
  662. if (op.F)
  663. {
  664. if (Optimizations.FastFP && Optimizations.UseSse2)
  665. {
  666. EmitVectorsByScalarOpF32(context, Intrinsic.X86Mulps, Intrinsic.X86Mulpd, Intrinsic.X86Addps, Intrinsic.X86Addpd);
  667. }
  668. else if (Optimizations.FastFP)
  669. {
  670. EmitVectorsByScalarOpF32(context, (op1, op2, op3) => context.Add(op1, context.Multiply(op2, op3)));
  671. }
  672. else
  673. {
  674. EmitVectorsByScalarOpF32(context, (op1, op2, op3) => EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMulAddFpscr), op1, op2, op3));
  675. }
  676. }
  677. else
  678. {
  679. EmitVectorsByScalarOpI32(context, (op1, op2, op3) => context.Add(op1, context.Multiply(op2, op3)), false);
  680. }
  681. }
  682. public static void Vmls_S(ArmEmitterContext context)
  683. {
  684. if (Optimizations.FastFP && Optimizations.UseSse2)
  685. {
  686. EmitScalarTernaryOpF32(context, Intrinsic.X86Mulss, Intrinsic.X86Mulsd, Intrinsic.X86Subss, Intrinsic.X86Subsd);
  687. }
  688. else if (Optimizations.FastFP)
  689. {
  690. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  691. {
  692. return context.Subtract(op1, context.Multiply(op2, op3));
  693. });
  694. }
  695. else
  696. {
  697. EmitScalarTernaryOpF32(context, (op1, op2, op3) =>
  698. {
  699. Operand res = EmitSoftFloatCall(context, nameof(SoftFloat32.FPMul), op2, op3);
  700. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPSub), op1, res);
  701. });
  702. }
  703. }
  704. public static void Vmls_V(ArmEmitterContext context)
  705. {
  706. if (Optimizations.FastFP && Optimizations.UseSse2)
  707. {
  708. EmitVectorTernaryOpF32(context, Intrinsic.X86Mulps, Intrinsic.X86Mulpd, Intrinsic.X86Subps, Intrinsic.X86Subpd);
  709. }
  710. else if (Optimizations.FastFP)
  711. {
  712. EmitVectorTernaryOpF32(context, (op1, op2, op3) => context.Subtract(op1, context.Multiply(op2, op3)));
  713. }
  714. else
  715. {
  716. EmitVectorTernaryOpF32(context, (op1, op2, op3) =>
  717. {
  718. return EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMulSubFpscr), op1, op2, op3);
  719. });
  720. }
  721. }
  722. public static void Vmls_I(ArmEmitterContext context)
  723. {
  724. EmitVectorTernaryOpZx32(context, (op1, op2, op3) => context.Subtract(op1, context.Multiply(op2, op3)));
  725. }
  726. public static void Vmls_1(ArmEmitterContext context)
  727. {
  728. OpCode32SimdRegElem op = (OpCode32SimdRegElem)context.CurrOp;
  729. if (op.F)
  730. {
  731. if (Optimizations.FastFP && Optimizations.UseSse2)
  732. {
  733. EmitVectorsByScalarOpF32(context, Intrinsic.X86Mulps, Intrinsic.X86Mulpd, Intrinsic.X86Subps, Intrinsic.X86Subpd);
  734. }
  735. else if (Optimizations.FastFP)
  736. {
  737. EmitVectorsByScalarOpF32(context, (op1, op2, op3) => context.Subtract(op1, context.Multiply(op2, op3)));
  738. }
  739. else
  740. {
  741. EmitVectorsByScalarOpF32(context, (op1, op2, op3) => EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMulSubFpscr), op1, op2, op3));
  742. }
  743. }
  744. else
  745. {
  746. EmitVectorsByScalarOpI32(context, (op1, op2, op3) => context.Subtract(op1, context.Multiply(op2, op3)), false);
  747. }
  748. }
  749. public static void Vmlsl_I(ArmEmitterContext context)
  750. {
  751. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  752. EmitVectorTernaryLongOpI32(context, (opD, op1, op2) => context.Subtract(opD, context.Multiply(op1, op2)), !op.U);
  753. }
  754. public static void Vmul_S(ArmEmitterContext context)
  755. {
  756. if (Optimizations.FastFP && Optimizations.UseSse2)
  757. {
  758. EmitScalarBinaryOpF32(context, Intrinsic.X86Mulss, Intrinsic.X86Mulsd);
  759. }
  760. else if (Optimizations.FastFP)
  761. {
  762. EmitScalarBinaryOpF32(context, (op1, op2) => context.Multiply(op1, op2));
  763. }
  764. else
  765. {
  766. EmitScalarBinaryOpF32(context, (op1, op2) =>
  767. {
  768. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPMul), op1, op2);
  769. });
  770. }
  771. }
  772. public static void Vmul_V(ArmEmitterContext context)
  773. {
  774. if (Optimizations.FastFP && Optimizations.UseSse2)
  775. {
  776. EmitVectorBinaryOpF32(context, Intrinsic.X86Mulps, Intrinsic.X86Mulpd);
  777. }
  778. else if (Optimizations.FastFP)
  779. {
  780. EmitVectorBinaryOpF32(context, (op1, op2) => context.Multiply(op1, op2));
  781. }
  782. else
  783. {
  784. EmitVectorBinaryOpF32(context, (op1, op2) =>
  785. {
  786. return EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMulFpscr), op1, op2);
  787. });
  788. }
  789. }
  790. public static void Vmul_I(ArmEmitterContext context)
  791. {
  792. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  793. if (op.U) // This instruction is always signed, U indicates polynomial mode.
  794. {
  795. EmitVectorBinaryOpZx32(context, (op1, op2) => EmitPolynomialMultiply(context, op1, op2, 8 << op.Size));
  796. }
  797. else
  798. {
  799. EmitVectorBinaryOpSx32(context, (op1, op2) => context.Multiply(op1, op2));
  800. }
  801. }
  802. public static void Vmul_1(ArmEmitterContext context)
  803. {
  804. OpCode32SimdRegElem op = (OpCode32SimdRegElem)context.CurrOp;
  805. if (op.F)
  806. {
  807. if (Optimizations.FastFP && Optimizations.UseSse2)
  808. {
  809. EmitVectorByScalarOpF32(context, Intrinsic.X86Mulps, Intrinsic.X86Mulpd);
  810. }
  811. else if (Optimizations.FastFP)
  812. {
  813. EmitVectorByScalarOpF32(context, (op1, op2) => context.Multiply(op1, op2));
  814. }
  815. else
  816. {
  817. EmitVectorByScalarOpF32(context, (op1, op2) => EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMulFpscr), op1, op2));
  818. }
  819. }
  820. else
  821. {
  822. EmitVectorByScalarOpI32(context, (op1, op2) => context.Multiply(op1, op2), false);
  823. }
  824. }
  825. public static void Vmull_1(ArmEmitterContext context)
  826. {
  827. OpCode32SimdRegElem op = (OpCode32SimdRegElem)context.CurrOp;
  828. EmitVectorByScalarLongOpI32(context, (op1, op2) => context.Multiply(op1, op2), !op.U);
  829. }
  830. public static void Vmull_I(ArmEmitterContext context)
  831. {
  832. OpCode32SimdRegLong op = (OpCode32SimdRegLong)context.CurrOp;
  833. if (op.Polynomial)
  834. {
  835. EmitVectorBinaryLongOpI32(context, (op1, op2) => EmitPolynomialMultiply(context, op1, op2, 8 << op.Size), false);
  836. }
  837. else
  838. {
  839. EmitVectorBinaryLongOpI32(context, (op1, op2) => context.Multiply(op1, op2), !op.U);
  840. }
  841. }
  842. public static void Vpadd_V(ArmEmitterContext context)
  843. {
  844. if (Optimizations.FastFP && Optimizations.UseSse2)
  845. {
  846. EmitSse2VectorPairwiseOpF32(context, Intrinsic.X86Addps);
  847. }
  848. else
  849. {
  850. EmitVectorPairwiseOpF32(context, (op1, op2) => EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPAddFpscr), op1, op2));
  851. }
  852. }
  853. public static void Vpadd_I(ArmEmitterContext context)
  854. {
  855. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  856. if (Optimizations.UseSsse3)
  857. {
  858. EmitSsse3VectorPairwiseOp32(context, X86PaddInstruction);
  859. }
  860. else
  861. {
  862. EmitVectorPairwiseOpI32(context, (op1, op2) => context.Add(op1, op2), !op.U);
  863. }
  864. }
  865. public static void Vpmax_V(ArmEmitterContext context)
  866. {
  867. if (Optimizations.FastFP && Optimizations.UseSse2)
  868. {
  869. EmitSse2VectorPairwiseOpF32(context, Intrinsic.X86Maxps);
  870. }
  871. else
  872. {
  873. EmitVectorPairwiseOpF32(context, (op1, op2) => EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat64.FPMaxFpscr), op1, op2));
  874. }
  875. }
  876. public static void Vpmax_I(ArmEmitterContext context)
  877. {
  878. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  879. if (Optimizations.UseSsse3)
  880. {
  881. EmitSsse3VectorPairwiseOp32(context, op.U ? X86PmaxuInstruction : X86PmaxsInstruction);
  882. }
  883. else
  884. {
  885. EmitVectorPairwiseOpI32(context, (op1, op2) =>
  886. {
  887. Operand greater = op.U ? context.ICompareGreaterUI(op1, op2) : context.ICompareGreater(op1, op2);
  888. return context.ConditionalSelect(greater, op1, op2);
  889. }, !op.U);
  890. }
  891. }
  892. public static void Vpmin_V(ArmEmitterContext context)
  893. {
  894. if (Optimizations.FastFP && Optimizations.UseSse2)
  895. {
  896. EmitSse2VectorPairwiseOpF32(context, Intrinsic.X86Minps);
  897. }
  898. else
  899. {
  900. EmitVectorPairwiseOpF32(context, (op1, op2) => EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPMinFpscr), op1, op2));
  901. }
  902. }
  903. public static void Vpmin_I(ArmEmitterContext context)
  904. {
  905. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  906. if (Optimizations.UseSsse3)
  907. {
  908. EmitSsse3VectorPairwiseOp32(context, op.U ? X86PminuInstruction : X86PminsInstruction);
  909. }
  910. else
  911. {
  912. EmitVectorPairwiseOpI32(context, (op1, op2) =>
  913. {
  914. Operand greater = op.U ? context.ICompareLessUI(op1, op2) : context.ICompareLess(op1, op2);
  915. return context.ConditionalSelect(greater, op1, op2);
  916. }, !op.U);
  917. }
  918. }
  919. public static void Vrev(ArmEmitterContext context)
  920. {
  921. OpCode32SimdRev op = (OpCode32SimdRev)context.CurrOp;
  922. if (Optimizations.UseSsse3)
  923. {
  924. EmitVectorUnaryOpSimd32(context, (op1) =>
  925. {
  926. Operand mask;
  927. switch (op.Size)
  928. {
  929. case 3:
  930. // Rev64
  931. switch (op.Opc)
  932. {
  933. case 0:
  934. mask = X86GetElements(context, 0x08090a0b0c0d0e0fL, 0x0001020304050607L);
  935. return context.AddIntrinsic(Intrinsic.X86Pshufb, op1, mask);
  936. case 1:
  937. mask = X86GetElements(context, 0x09080b0a0d0c0f0eL, 0x0100030205040706L);
  938. return context.AddIntrinsic(Intrinsic.X86Pshufb, op1, mask);
  939. case 2:
  940. return context.AddIntrinsic(Intrinsic.X86Shufps, op1, op1, Const(1 | (0 << 2) | (3 << 4) | (2 << 6)));
  941. }
  942. break;
  943. case 2:
  944. // Rev32
  945. switch (op.Opc)
  946. {
  947. case 0:
  948. mask = X86GetElements(context, 0x0c0d0e0f_08090a0bL, 0x04050607_00010203L);
  949. return context.AddIntrinsic(Intrinsic.X86Pshufb, op1, mask);
  950. case 1:
  951. mask = X86GetElements(context, 0x0d0c0f0e_09080b0aL, 0x05040706_01000302L);
  952. return context.AddIntrinsic(Intrinsic.X86Pshufb, op1, mask);
  953. }
  954. break;
  955. case 1:
  956. // Rev16
  957. mask = X86GetElements(context, 0x0e0f_0c0d_0a0b_0809L, 0x_0607_0405_0203_0001L);
  958. return context.AddIntrinsic(Intrinsic.X86Pshufb, op1, mask);
  959. }
  960. throw new InvalidOperationException("Invalid VREV Opcode + Size combo."); // Should be unreachable.
  961. });
  962. }
  963. else
  964. {
  965. EmitVectorUnaryOpZx32(context, (op1) =>
  966. {
  967. switch (op.Opc)
  968. {
  969. case 0:
  970. switch (op.Size) // Swap bytes.
  971. {
  972. case 1:
  973. return InstEmitAluHelper.EmitReverseBytes16_32Op(context, op1);
  974. case 2:
  975. case 3:
  976. return context.ByteSwap(op1);
  977. }
  978. break;
  979. case 1:
  980. switch (op.Size)
  981. {
  982. case 2:
  983. return context.BitwiseOr(context.ShiftRightUI(context.BitwiseAnd(op1, Const(0xffff0000)), Const(16)),
  984. context.ShiftLeft(context.BitwiseAnd(op1, Const(0x0000ffff)), Const(16)));
  985. case 3:
  986. return context.BitwiseOr(
  987. context.BitwiseOr(context.ShiftRightUI(context.BitwiseAnd(op1, Const(0xffff000000000000ul)), Const(48)),
  988. context.ShiftLeft(context.BitwiseAnd(op1, Const(0x000000000000fffful)), Const(48))),
  989. context.BitwiseOr(context.ShiftRightUI(context.BitwiseAnd(op1, Const(0x0000ffff00000000ul)), Const(16)),
  990. context.ShiftLeft(context.BitwiseAnd(op1, Const(0x00000000ffff0000ul)), Const(16))));
  991. }
  992. break;
  993. case 2:
  994. // Swap upper and lower halves.
  995. return context.BitwiseOr(context.ShiftRightUI(context.BitwiseAnd(op1, Const(0xffffffff00000000ul)), Const(32)),
  996. context.ShiftLeft(context.BitwiseAnd(op1, Const(0x00000000fffffffful)), Const(32)));
  997. }
  998. throw new InvalidOperationException("Invalid VREV Opcode + Size combo."); // Should be unreachable.
  999. });
  1000. }
  1001. }
  1002. public static void Vrecpe(ArmEmitterContext context)
  1003. {
  1004. OpCode32SimdSqrte op = (OpCode32SimdSqrte)context.CurrOp;
  1005. if (op.F)
  1006. {
  1007. int sizeF = op.Size & 1;
  1008. if (Optimizations.FastFP && Optimizations.UseSse2 && sizeF == 0)
  1009. {
  1010. EmitVectorUnaryOpF32(context, Intrinsic.X86Rcpps, 0);
  1011. }
  1012. else
  1013. {
  1014. EmitVectorUnaryOpF32(context, (op1) =>
  1015. {
  1016. return EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPRecipEstimateFpscr), op1);
  1017. });
  1018. }
  1019. }
  1020. else
  1021. {
  1022. throw new NotImplementedException("Integer Vrecpe not currently implemented.");
  1023. }
  1024. }
  1025. public static void Vrecps(ArmEmitterContext context)
  1026. {
  1027. if (Optimizations.FastFP && Optimizations.UseSse2)
  1028. {
  1029. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  1030. bool single = (op.Size & 1) == 0;
  1031. // (2 - (n*m))
  1032. EmitVectorBinaryOpSimd32(context, (n, m) =>
  1033. {
  1034. if (single)
  1035. {
  1036. Operand maskTwo = X86GetAllElements(context, 2f);
  1037. Operand res = context.AddIntrinsic(Intrinsic.X86Mulps, n, m);
  1038. return context.AddIntrinsic(Intrinsic.X86Subps, maskTwo, res);
  1039. }
  1040. else
  1041. {
  1042. Operand maskTwo = X86GetAllElements(context, 2d);
  1043. Operand res = context.AddIntrinsic(Intrinsic.X86Mulpd, n, m);
  1044. return context.AddIntrinsic(Intrinsic.X86Subpd, maskTwo, res);
  1045. }
  1046. });
  1047. }
  1048. else
  1049. {
  1050. EmitVectorBinaryOpF32(context, (op1, op2) =>
  1051. {
  1052. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPRecipStep), op1, op2);
  1053. });
  1054. }
  1055. }
  1056. public static void Vrsqrte(ArmEmitterContext context)
  1057. {
  1058. OpCode32SimdSqrte op = (OpCode32SimdSqrte)context.CurrOp;
  1059. if (op.F)
  1060. {
  1061. int sizeF = op.Size & 1;
  1062. if (Optimizations.FastFP && Optimizations.UseSse2 && sizeF == 0)
  1063. {
  1064. EmitVectorUnaryOpF32(context, Intrinsic.X86Rsqrtps, 0);
  1065. }
  1066. else
  1067. {
  1068. EmitVectorUnaryOpF32(context, (op1) =>
  1069. {
  1070. return EmitSoftFloatCallDefaultFpscr(context, nameof(SoftFloat32.FPRSqrtEstimateFpscr), op1);
  1071. });
  1072. }
  1073. }
  1074. else
  1075. {
  1076. throw new NotImplementedException("Integer Vrsqrte not currently implemented.");
  1077. }
  1078. }
  1079. public static void Vrsqrts(ArmEmitterContext context)
  1080. {
  1081. if (Optimizations.FastFP && Optimizations.UseSse2)
  1082. {
  1083. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  1084. bool single = (op.Size & 1) == 0;
  1085. // (3 - (n*m)) / 2
  1086. EmitVectorBinaryOpSimd32(context, (n, m) =>
  1087. {
  1088. if (single)
  1089. {
  1090. Operand maskHalf = X86GetAllElements(context, 0.5f);
  1091. Operand maskThree = X86GetAllElements(context, 3f);
  1092. Operand res = context.AddIntrinsic(Intrinsic.X86Mulps, n, m);
  1093. res = context.AddIntrinsic(Intrinsic.X86Subps, maskThree, res);
  1094. return context.AddIntrinsic(Intrinsic.X86Mulps, maskHalf, res);
  1095. }
  1096. else
  1097. {
  1098. Operand maskHalf = X86GetAllElements(context, 0.5d);
  1099. Operand maskThree = X86GetAllElements(context, 3d);
  1100. Operand res = context.AddIntrinsic(Intrinsic.X86Mulpd, n, m);
  1101. res = context.AddIntrinsic(Intrinsic.X86Subpd, maskThree, res);
  1102. return context.AddIntrinsic(Intrinsic.X86Mulpd, maskHalf, res);
  1103. }
  1104. });
  1105. }
  1106. else
  1107. {
  1108. EmitVectorBinaryOpF32(context, (op1, op2) =>
  1109. {
  1110. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPRSqrtStep), op1, op2);
  1111. });
  1112. }
  1113. }
  1114. public static void Vsel(ArmEmitterContext context)
  1115. {
  1116. OpCode32SimdSel op = (OpCode32SimdSel)context.CurrOp;
  1117. Operand condition = null;
  1118. switch (op.Cc)
  1119. {
  1120. case OpCode32SimdSelMode.Eq:
  1121. condition = GetCondTrue(context, Condition.Eq);
  1122. break;
  1123. case OpCode32SimdSelMode.Ge:
  1124. condition = GetCondTrue(context, Condition.Ge);
  1125. break;
  1126. case OpCode32SimdSelMode.Gt:
  1127. condition = GetCondTrue(context, Condition.Gt);
  1128. break;
  1129. case OpCode32SimdSelMode.Vs:
  1130. condition = GetCondTrue(context, Condition.Vs);
  1131. break;
  1132. }
  1133. EmitScalarBinaryOpI32(context, (op1, op2) =>
  1134. {
  1135. return context.ConditionalSelect(condition, op1, op2);
  1136. });
  1137. }
  1138. public static void Vsqrt_S(ArmEmitterContext context)
  1139. {
  1140. if (Optimizations.FastFP && Optimizations.UseSse2)
  1141. {
  1142. EmitScalarUnaryOpF32(context, Intrinsic.X86Sqrtss, Intrinsic.X86Sqrtsd);
  1143. }
  1144. else
  1145. {
  1146. EmitScalarUnaryOpF32(context, (op1) =>
  1147. {
  1148. return EmitSoftFloatCall(context, nameof(SoftFloat32.FPSqrt), op1);
  1149. });
  1150. }
  1151. }
  1152. public static void Vsub_S(ArmEmitterContext context)
  1153. {
  1154. if (Optimizations.FastFP && Optimizations.UseSse2)
  1155. {
  1156. EmitScalarBinaryOpF32(context, Intrinsic.X86Subss, Intrinsic.X86Subsd);
  1157. }
  1158. else
  1159. {
  1160. EmitScalarBinaryOpF32(context, (op1, op2) => context.Subtract(op1, op2));
  1161. }
  1162. }
  1163. public static void Vsub_V(ArmEmitterContext context)
  1164. {
  1165. if (Optimizations.FastFP && Optimizations.UseSse2)
  1166. {
  1167. EmitVectorBinaryOpF32(context, Intrinsic.X86Subps, Intrinsic.X86Subpd);
  1168. }
  1169. else
  1170. {
  1171. EmitVectorBinaryOpF32(context, (op1, op2) => context.Subtract(op1, op2));
  1172. }
  1173. }
  1174. public static void Vsub_I(ArmEmitterContext context)
  1175. {
  1176. if (Optimizations.UseSse2)
  1177. {
  1178. OpCode32SimdReg op = (OpCode32SimdReg)context.CurrOp;
  1179. EmitVectorBinaryOpSimd32(context, (op1, op2) => context.AddIntrinsic(X86PsubInstruction[op.Size], op1, op2));
  1180. }
  1181. else
  1182. {
  1183. EmitVectorBinaryOpZx32(context, (op1, op2) => context.Subtract(op1, op2));
  1184. }
  1185. }
  1186. public static void Vsubw_I(ArmEmitterContext context)
  1187. {
  1188. OpCode32SimdRegWide op = (OpCode32SimdRegWide)context.CurrOp;
  1189. EmitVectorBinaryWideOpI32(context, (op1, op2) => context.Subtract(op1, op2), !op.U);
  1190. }
  1191. private static void EmitSse41MaxMinNumOpF32(ArmEmitterContext context, bool isMaxNum, bool scalar)
  1192. {
  1193. IOpCode32Simd op = (IOpCode32Simd)context.CurrOp;
  1194. Func<Operand, Operand, Operand> genericEmit = (n, m) =>
  1195. {
  1196. Operand nNum = context.Copy(n);
  1197. Operand mNum = context.Copy(m);
  1198. InstEmit.EmitSse2VectorIsNaNOpF(context, nNum, out Operand nQNaNMask, out _, isQNaN: true);
  1199. InstEmit.EmitSse2VectorIsNaNOpF(context, mNum, out Operand mQNaNMask, out _, isQNaN: true);
  1200. int sizeF = op.Size & 1;
  1201. if (sizeF == 0)
  1202. {
  1203. Operand negInfMask = X86GetAllElements(context, isMaxNum ? float.NegativeInfinity : float.PositiveInfinity);
  1204. Operand nMask = context.AddIntrinsic(Intrinsic.X86Andnps, mQNaNMask, nQNaNMask);
  1205. Operand mMask = context.AddIntrinsic(Intrinsic.X86Andnps, nQNaNMask, mQNaNMask);
  1206. nNum = context.AddIntrinsic(Intrinsic.X86Blendvps, nNum, negInfMask, nMask);
  1207. mNum = context.AddIntrinsic(Intrinsic.X86Blendvps, mNum, negInfMask, mMask);
  1208. return context.AddIntrinsic(isMaxNum ? Intrinsic.X86Maxps : Intrinsic.X86Minps, nNum, mNum);
  1209. }
  1210. else /* if (sizeF == 1) */
  1211. {
  1212. Operand negInfMask = X86GetAllElements(context, isMaxNum ? double.NegativeInfinity : double.PositiveInfinity);
  1213. Operand nMask = context.AddIntrinsic(Intrinsic.X86Andnpd, mQNaNMask, nQNaNMask);
  1214. Operand mMask = context.AddIntrinsic(Intrinsic.X86Andnpd, nQNaNMask, mQNaNMask);
  1215. nNum = context.AddIntrinsic(Intrinsic.X86Blendvpd, nNum, negInfMask, nMask);
  1216. mNum = context.AddIntrinsic(Intrinsic.X86Blendvpd, mNum, negInfMask, mMask);
  1217. return context.AddIntrinsic(isMaxNum ? Intrinsic.X86Maxpd : Intrinsic.X86Minpd, nNum, mNum);
  1218. }
  1219. };
  1220. if (scalar)
  1221. {
  1222. EmitScalarBinaryOpSimd32(context, genericEmit);
  1223. }
  1224. else
  1225. {
  1226. EmitVectorBinaryOpSimd32(context, genericEmit);
  1227. }
  1228. }
  1229. private static Operand EmitPolynomialMultiply(ArmEmitterContext context, Operand op1, Operand op2, int eSize)
  1230. {
  1231. Debug.Assert(eSize <= 32);
  1232. Operand result = eSize == 32 ? Const(0L) : Const(0);
  1233. if (eSize == 32)
  1234. {
  1235. op1 = context.ZeroExtend32(OperandType.I64, op1);
  1236. op2 = context.ZeroExtend32(OperandType.I64, op2);
  1237. }
  1238. for (int i = 0; i < eSize; i++)
  1239. {
  1240. Operand mask = context.BitwiseAnd(op1, Const(op1.Type, 1L << i));
  1241. result = context.BitwiseExclusiveOr(result, context.Multiply(op2, mask));
  1242. }
  1243. return result;
  1244. }
  1245. }
  1246. }