InstEmitSimdArithmetic32.cs 58 KB

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