| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790 |
- using ChocolArm64.State;
- using System;
- using System.Diagnostics;
- using System.Runtime.CompilerServices;
- namespace ChocolArm64.Instructions
- {
- static class SoftFloat
- {
- static SoftFloat()
- {
- RecipEstimateTable = BuildRecipEstimateTable();
- RecipSqrtEstimateTable = BuildRecipSqrtEstimateTable();
- }
- internal static readonly byte[] RecipEstimateTable;
- internal static readonly byte[] RecipSqrtEstimateTable;
- private static byte[] BuildRecipEstimateTable()
- {
- byte[] tbl = new byte[256];
- for (int idx = 0; idx < 256; idx++)
- {
- uint src = (uint)idx + 256u;
- Debug.Assert(256u <= src && src < 512u);
- src = (src << 1) + 1u;
- uint aux = (1u << 19) / src;
- uint dst = (aux + 1u) >> 1;
- Debug.Assert(256u <= dst && dst < 512u);
- tbl[idx] = (byte)(dst - 256u);
- }
- return tbl;
- }
- private static byte[] BuildRecipSqrtEstimateTable()
- {
- byte[] tbl = new byte[384];
- for (int idx = 0; idx < 384; idx++)
- {
- uint src = (uint)idx + 128u;
- Debug.Assert(128u <= src && src < 512u);
- if (src < 256u)
- {
- src = (src << 1) + 1u;
- }
- else
- {
- src = (src >> 1) << 1;
- src = (src + 1u) << 1;
- }
- uint aux = 512u;
- while (src * (aux + 1u) * (aux + 1u) < (1u << 28))
- {
- aux = aux + 1u;
- }
- uint dst = (aux + 1u) >> 1;
- Debug.Assert(256u <= dst && dst < 512u);
- tbl[idx] = (byte)(dst - 256u);
- }
- return tbl;
- }
- }
- static class SoftFloat16_32
- {
- public static float FPConvert(ushort valueBits, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat16_32.FPConvert: state.Fpcr = 0x{state.CFpcr:X8}");
- double real = valueBits.FPUnpackCv(out FpType type, out bool sign, state);
- float result;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- if (state.GetFpcrFlag(Fpcr.Dn))
- {
- result = FPDefaultNaN();
- }
- else
- {
- result = FPConvertNaN(valueBits);
- }
- if (type == FpType.SNaN)
- {
- FPProcessException(FpExc.InvalidOp, state);
- }
- }
- else if (type == FpType.Infinity)
- {
- result = FPInfinity(sign);
- }
- else if (type == FpType.Zero)
- {
- result = FPZero(sign);
- }
- else
- {
- result = FPRoundCv(real, state);
- }
- return result;
- }
- private static float FPDefaultNaN()
- {
- return -float.NaN;
- }
- private static float FPInfinity(bool sign)
- {
- return sign ? float.NegativeInfinity : float.PositiveInfinity;
- }
- private static float FPZero(bool sign)
- {
- return sign ? -0f : +0f;
- }
- private static float FPMaxNormal(bool sign)
- {
- return sign ? float.MinValue : float.MaxValue;
- }
- private static double FPUnpackCv(
- this ushort valueBits,
- out FpType type,
- out bool sign,
- CpuThreadState state)
- {
- sign = (~(uint)valueBits & 0x8000u) == 0u;
- uint exp16 = ((uint)valueBits & 0x7C00u) >> 10;
- uint frac16 = (uint)valueBits & 0x03FFu;
- double real;
- if (exp16 == 0u)
- {
- if (frac16 == 0u)
- {
- type = FpType.Zero;
- real = 0d;
- }
- else
- {
- type = FpType.Nonzero; // Subnormal.
- real = Math.Pow(2d, -14) * ((double)frac16 * Math.Pow(2d, -10));
- }
- }
- else if (exp16 == 0x1Fu && !state.GetFpcrFlag(Fpcr.Ahp))
- {
- if (frac16 == 0u)
- {
- type = FpType.Infinity;
- real = Math.Pow(2d, 1000);
- }
- else
- {
- type = (~frac16 & 0x0200u) == 0u ? FpType.QNaN : FpType.SNaN;
- real = 0d;
- }
- }
- else
- {
- type = FpType.Nonzero; // Normal.
- real = Math.Pow(2d, (int)exp16 - 15) * (1d + (double)frac16 * Math.Pow(2d, -10));
- }
- return sign ? -real : real;
- }
- private static float FPRoundCv(double real, CpuThreadState state)
- {
- const int minimumExp = -126;
- const int e = 8;
- const int f = 23;
- bool sign;
- double mantissa;
- if (real < 0d)
- {
- sign = true;
- mantissa = -real;
- }
- else
- {
- sign = false;
- mantissa = real;
- }
- int exponent = 0;
- while (mantissa < 1d)
- {
- mantissa *= 2d;
- exponent--;
- }
- while (mantissa >= 2d)
- {
- mantissa /= 2d;
- exponent++;
- }
- if (state.GetFpcrFlag(Fpcr.Fz) && exponent < minimumExp)
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- return FPZero(sign);
- }
- uint biasedExp = (uint)Math.Max(exponent - minimumExp + 1, 0);
- if (biasedExp == 0u)
- {
- mantissa /= Math.Pow(2d, minimumExp - exponent);
- }
- uint intMant = (uint)Math.Floor(mantissa * Math.Pow(2d, f));
- double error = mantissa * Math.Pow(2d, f) - (double)intMant;
- if (biasedExp == 0u && (error != 0d || state.GetFpcrFlag(Fpcr.Ufe)))
- {
- FPProcessException(FpExc.Underflow, state);
- }
- bool overflowToInf;
- bool roundUp;
- switch (state.FPRoundingMode())
- {
- default:
- case RoundMode.ToNearest:
- roundUp = (error > 0.5d || (error == 0.5d && (intMant & 1u) == 1u));
- overflowToInf = true;
- break;
- case RoundMode.TowardsPlusInfinity:
- roundUp = (error != 0d && !sign);
- overflowToInf = !sign;
- break;
- case RoundMode.TowardsMinusInfinity:
- roundUp = (error != 0d && sign);
- overflowToInf = sign;
- break;
- case RoundMode.TowardsZero:
- roundUp = false;
- overflowToInf = false;
- break;
- }
- if (roundUp)
- {
- intMant++;
- if (intMant == 1u << f)
- {
- biasedExp = 1u;
- }
- if (intMant == 1u << (f + 1))
- {
- biasedExp++;
- intMant >>= 1;
- }
- }
- float result;
- if (biasedExp >= (1u << e) - 1u)
- {
- result = overflowToInf ? FPInfinity(sign) : FPMaxNormal(sign);
- FPProcessException(FpExc.Overflow, state);
- error = 1d;
- }
- else
- {
- result = BitConverter.Int32BitsToSingle(
- (int)((sign ? 1u : 0u) << 31 | (biasedExp & 0xFFu) << 23 | (intMant & 0x007FFFFFu)));
- }
- if (error != 0d)
- {
- FPProcessException(FpExc.Inexact, state);
- }
- return result;
- }
- private static float FPConvertNaN(ushort valueBits)
- {
- return BitConverter.Int32BitsToSingle(
- (int)(((uint)valueBits & 0x8000u) << 16 | 0x7FC00000u | ((uint)valueBits & 0x01FFu) << 13));
- }
- private static void FPProcessException(FpExc exc, CpuThreadState state)
- {
- int enable = (int)exc + 8;
- if ((state.CFpcr & (1 << enable)) != 0)
- {
- throw new NotImplementedException("Floating-point trap handling.");
- }
- else
- {
- state.CFpsr |= 1 << (int)exc;
- }
- }
- }
- static class SoftFloat32_16
- {
- public static ushort FPConvert(float value, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32_16.FPConvert: state.Fpcr = 0x{state.CFpcr:X8}");
- double real = value.FPUnpackCv(out FpType type, out bool sign, out uint valueBits, state);
- bool altHp = state.GetFpcrFlag(Fpcr.Ahp);
- ushort resultBits;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- if (altHp)
- {
- resultBits = FPZero(sign);
- }
- else if (state.GetFpcrFlag(Fpcr.Dn))
- {
- resultBits = FPDefaultNaN();
- }
- else
- {
- resultBits = FPConvertNaN(valueBits);
- }
- if (type == FpType.SNaN || altHp)
- {
- FPProcessException(FpExc.InvalidOp, state);
- }
- }
- else if (type == FpType.Infinity)
- {
- if (altHp)
- {
- resultBits = (ushort)((sign ? 1u : 0u) << 15 | 0x7FFFu);
- FPProcessException(FpExc.InvalidOp, state);
- }
- else
- {
- resultBits = FPInfinity(sign);
- }
- }
- else if (type == FpType.Zero)
- {
- resultBits = FPZero(sign);
- }
- else
- {
- resultBits = FPRoundCv(real, state);
- }
- return resultBits;
- }
- private static ushort FPDefaultNaN()
- {
- return (ushort)0x7E00u;
- }
- private static ushort FPInfinity(bool sign)
- {
- return sign ? (ushort)0xFC00u : (ushort)0x7C00u;
- }
- private static ushort FPZero(bool sign)
- {
- return sign ? (ushort)0x8000u : (ushort)0x0000u;
- }
- private static ushort FPMaxNormal(bool sign)
- {
- return sign ? (ushort)0xFBFFu : (ushort)0x7BFFu;
- }
- private static double FPUnpackCv(
- this float value,
- out FpType type,
- out bool sign,
- out uint valueBits,
- CpuThreadState state)
- {
- valueBits = (uint)BitConverter.SingleToInt32Bits(value);
- sign = (~valueBits & 0x80000000u) == 0u;
- uint exp32 = (valueBits & 0x7F800000u) >> 23;
- uint frac32 = valueBits & 0x007FFFFFu;
- double real;
- if (exp32 == 0u)
- {
- if (frac32 == 0u || state.GetFpcrFlag(Fpcr.Fz))
- {
- type = FpType.Zero;
- real = 0d;
- if (frac32 != 0u)
- {
- FPProcessException(FpExc.InputDenorm, state);
- }
- }
- else
- {
- type = FpType.Nonzero; // Subnormal.
- real = Math.Pow(2d, -126) * ((double)frac32 * Math.Pow(2d, -23));
- }
- }
- else if (exp32 == 0xFFu)
- {
- if (frac32 == 0u)
- {
- type = FpType.Infinity;
- real = Math.Pow(2d, 1000);
- }
- else
- {
- type = (~frac32 & 0x00400000u) == 0u ? FpType.QNaN : FpType.SNaN;
- real = 0d;
- }
- }
- else
- {
- type = FpType.Nonzero; // Normal.
- real = Math.Pow(2d, (int)exp32 - 127) * (1d + (double)frac32 * Math.Pow(2d, -23));
- }
- return sign ? -real : real;
- }
- private static ushort FPRoundCv(double real, CpuThreadState state)
- {
- const int minimumExp = -14;
- const int e = 5;
- const int f = 10;
- bool sign;
- double mantissa;
- if (real < 0d)
- {
- sign = true;
- mantissa = -real;
- }
- else
- {
- sign = false;
- mantissa = real;
- }
- int exponent = 0;
- while (mantissa < 1d)
- {
- mantissa *= 2d;
- exponent--;
- }
- while (mantissa >= 2d)
- {
- mantissa /= 2d;
- exponent++;
- }
- uint biasedExp = (uint)Math.Max(exponent - minimumExp + 1, 0);
- if (biasedExp == 0u)
- {
- mantissa /= Math.Pow(2d, minimumExp - exponent);
- }
- uint intMant = (uint)Math.Floor(mantissa * Math.Pow(2d, f));
- double error = mantissa * Math.Pow(2d, f) - (double)intMant;
- if (biasedExp == 0u && (error != 0d || state.GetFpcrFlag(Fpcr.Ufe)))
- {
- FPProcessException(FpExc.Underflow, state);
- }
- bool overflowToInf;
- bool roundUp;
- switch (state.FPRoundingMode())
- {
- default:
- case RoundMode.ToNearest:
- roundUp = (error > 0.5d || (error == 0.5d && (intMant & 1u) == 1u));
- overflowToInf = true;
- break;
- case RoundMode.TowardsPlusInfinity:
- roundUp = (error != 0d && !sign);
- overflowToInf = !sign;
- break;
- case RoundMode.TowardsMinusInfinity:
- roundUp = (error != 0d && sign);
- overflowToInf = sign;
- break;
- case RoundMode.TowardsZero:
- roundUp = false;
- overflowToInf = false;
- break;
- }
- if (roundUp)
- {
- intMant++;
- if (intMant == 1u << f)
- {
- biasedExp = 1u;
- }
- if (intMant == 1u << (f + 1))
- {
- biasedExp++;
- intMant >>= 1;
- }
- }
- ushort resultBits;
- if (!state.GetFpcrFlag(Fpcr.Ahp))
- {
- if (biasedExp >= (1u << e) - 1u)
- {
- resultBits = overflowToInf ? FPInfinity(sign) : FPMaxNormal(sign);
- FPProcessException(FpExc.Overflow, state);
- error = 1d;
- }
- else
- {
- resultBits = (ushort)((sign ? 1u : 0u) << 15 | (biasedExp & 0x1Fu) << 10 | (intMant & 0x03FFu));
- }
- }
- else
- {
- if (biasedExp >= 1u << e)
- {
- resultBits = (ushort)((sign ? 1u : 0u) << 15 | 0x7FFFu);
- FPProcessException(FpExc.InvalidOp, state);
- error = 0d;
- }
- else
- {
- resultBits = (ushort)((sign ? 1u : 0u) << 15 | (biasedExp & 0x1Fu) << 10 | (intMant & 0x03FFu));
- }
- }
- if (error != 0d)
- {
- FPProcessException(FpExc.Inexact, state);
- }
- return resultBits;
- }
- private static ushort FPConvertNaN(uint valueBits)
- {
- return (ushort)((valueBits & 0x80000000u) >> 16 | 0x7E00u | (valueBits & 0x003FE000u) >> 13);
- }
- private static void FPProcessException(FpExc exc, CpuThreadState state)
- {
- int enable = (int)exc + 8;
- if ((state.CFpcr & (1 << enable)) != 0)
- {
- throw new NotImplementedException("Floating-point trap handling.");
- }
- else
- {
- state.CFpsr |= 1 << (int)exc;
- }
- }
- }
- static class SoftFloat32
- {
- public static float FPAdd(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPAdd: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- float result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if (inf1 && inf2 && sign1 == !sign2)
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if ((inf1 && !sign1) || (inf2 && !sign2))
- {
- result = FPInfinity(false);
- }
- else if ((inf1 && sign1) || (inf2 && sign2))
- {
- result = FPInfinity(true);
- }
- else if (zero1 && zero2 && sign1 == sign2)
- {
- result = FPZero(sign1);
- }
- else
- {
- result = value1 + value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- return result;
- }
- public static int FPCompare(float value1, float value2, bool signalNaNs, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPCompare: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out _, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out _, state);
- int result;
- if (type1 == FpType.SNaN || type1 == FpType.QNaN || type2 == FpType.SNaN || type2 == FpType.QNaN)
- {
- result = 0b0011;
- if (type1 == FpType.SNaN || type2 == FpType.SNaN || signalNaNs)
- {
- FPProcessException(FpExc.InvalidOp, state);
- }
- }
- else
- {
- if (value1 == value2)
- {
- result = 0b0110;
- }
- else if (value1 < value2)
- {
- result = 0b1000;
- }
- else
- {
- result = 0b0010;
- }
- }
- return result;
- }
- public static float FPCompareEQ(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPCompareEQ: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out _, out _, state);
- value2 = value2.FPUnpack(out FpType type2, out _, out _, state);
- float result;
- if (type1 == FpType.SNaN || type1 == FpType.QNaN || type2 == FpType.SNaN || type2 == FpType.QNaN)
- {
- result = ZerosOrOnes(false);
- if (type1 == FpType.SNaN || type2 == FpType.SNaN)
- {
- FPProcessException(FpExc.InvalidOp, state);
- }
- }
- else
- {
- result = ZerosOrOnes(value1 == value2);
- }
- return result;
- }
- public static float FPCompareGE(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPCompareGE: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out _, out _, state);
- value2 = value2.FPUnpack(out FpType type2, out _, out _, state);
- float result;
- if (type1 == FpType.SNaN || type1 == FpType.QNaN || type2 == FpType.SNaN || type2 == FpType.QNaN)
- {
- result = ZerosOrOnes(false);
- FPProcessException(FpExc.InvalidOp, state);
- }
- else
- {
- result = ZerosOrOnes(value1 >= value2);
- }
- return result;
- }
- public static float FPCompareGT(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPCompareGT: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out _, out _, state);
- value2 = value2.FPUnpack(out FpType type2, out _, out _, state);
- float result;
- if (type1 == FpType.SNaN || type1 == FpType.QNaN || type2 == FpType.SNaN || type2 == FpType.QNaN)
- {
- result = ZerosOrOnes(false);
- FPProcessException(FpExc.InvalidOp, state);
- }
- else
- {
- result = ZerosOrOnes(value1 > value2);
- }
- return result;
- }
- [MethodImpl(MethodImplOptions.AggressiveInlining)]
- public static float FPCompareLE(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPCompareLE: state.Fpcr = 0x{state.CFpcr:X8}");
- return FPCompareGE(value2, value1, state);
- }
- [MethodImpl(MethodImplOptions.AggressiveInlining)]
- public static float FPCompareLT(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPCompareLT: state.Fpcr = 0x{state.CFpcr:X8}");
- return FPCompareGT(value2, value1, state);
- }
- public static float FPDiv(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPDiv: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- float result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && inf2) || (zero1 && zero2))
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if (inf1 || zero2)
- {
- result = FPInfinity(sign1 ^ sign2);
- if (!inf1)
- {
- FPProcessException(FpExc.DivideByZero, state);
- }
- }
- else if (zero1 || inf2)
- {
- result = FPZero(sign1 ^ sign2);
- }
- else
- {
- result = value1 / value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- return result;
- }
- public static float FPMax(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPMax: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- float result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- if (value1 > value2)
- {
- if (type1 == FpType.Infinity)
- {
- result = FPInfinity(sign1);
- }
- else if (type1 == FpType.Zero)
- {
- result = FPZero(sign1 && sign2);
- }
- else
- {
- result = value1;
- }
- }
- else
- {
- if (type2 == FpType.Infinity)
- {
- result = FPInfinity(sign2);
- }
- else if (type2 == FpType.Zero)
- {
- result = FPZero(sign1 && sign2);
- }
- else
- {
- result = value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- }
- return result;
- }
- public static float FPMaxNum(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPMaxNum: state.Fpcr = 0x{state.CFpcr:X8}");
- value1.FPUnpack(out FpType type1, out _, out _, state);
- value2.FPUnpack(out FpType type2, out _, out _, state);
- if (type1 == FpType.QNaN && type2 != FpType.QNaN)
- {
- value1 = FPInfinity(true);
- }
- else if (type1 != FpType.QNaN && type2 == FpType.QNaN)
- {
- value2 = FPInfinity(true);
- }
- return FPMax(value1, value2, state);
- }
- public static float FPMin(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPMin: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- float result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- if (value1 < value2)
- {
- if (type1 == FpType.Infinity)
- {
- result = FPInfinity(sign1);
- }
- else if (type1 == FpType.Zero)
- {
- result = FPZero(sign1 || sign2);
- }
- else
- {
- result = value1;
- }
- }
- else
- {
- if (type2 == FpType.Infinity)
- {
- result = FPInfinity(sign2);
- }
- else if (type2 == FpType.Zero)
- {
- result = FPZero(sign1 || sign2);
- }
- else
- {
- result = value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- }
- return result;
- }
- public static float FPMinNum(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPMinNum: state.Fpcr = 0x{state.CFpcr:X8}");
- value1.FPUnpack(out FpType type1, out _, out _, state);
- value2.FPUnpack(out FpType type2, out _, out _, state);
- if (type1 == FpType.QNaN && type2 != FpType.QNaN)
- {
- value1 = FPInfinity(false);
- }
- else if (type1 != FpType.QNaN && type2 == FpType.QNaN)
- {
- value2 = FPInfinity(false);
- }
- return FPMin(value1, value2, state);
- }
- public static float FPMul(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPMul: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- float result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && zero2) || (zero1 && inf2))
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if (inf1 || inf2)
- {
- result = FPInfinity(sign1 ^ sign2);
- }
- else if (zero1 || zero2)
- {
- result = FPZero(sign1 ^ sign2);
- }
- else
- {
- result = value1 * value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- return result;
- }
- public static float FPMulAdd(
- float valueA,
- float value1,
- float value2,
- CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPMulAdd: state.Fpcr = 0x{state.CFpcr:X8}");
- valueA = valueA.FPUnpack(out FpType typeA, out bool signA, out uint addend, state);
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- float result = FPProcessNaNs3(typeA, type1, type2, addend, op1, op2, out bool done, state);
- if (typeA == FpType.QNaN && ((inf1 && zero2) || (zero1 && inf2)))
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- if (!done)
- {
- bool infA = typeA == FpType.Infinity; bool zeroA = typeA == FpType.Zero;
- bool signP = sign1 ^ sign2;
- bool infP = inf1 || inf2;
- bool zeroP = zero1 || zero2;
- if ((inf1 && zero2) || (zero1 && inf2) || (infA && infP && signA != signP))
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if ((infA && !signA) || (infP && !signP))
- {
- result = FPInfinity(false);
- }
- else if ((infA && signA) || (infP && signP))
- {
- result = FPInfinity(true);
- }
- else if (zeroA && zeroP && signA == signP)
- {
- result = FPZero(signA);
- }
- else
- {
- // TODO: When available, use: T MathF.FusedMultiplyAdd(T, T, T);
- // https://github.com/dotnet/corefx/issues/31903
- result = valueA + (value1 * value2);
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- return result;
- }
- [MethodImpl(MethodImplOptions.AggressiveInlining)]
- public static float FPMulSub(
- float valueA,
- float value1,
- float value2,
- CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPMulSub: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPNeg();
- return FPMulAdd(valueA, value1, value2, state);
- }
- public static float FPMulX(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPMulX: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- float result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && zero2) || (zero1 && inf2))
- {
- result = FPTwo(sign1 ^ sign2);
- }
- else if (inf1 || inf2)
- {
- result = FPInfinity(sign1 ^ sign2);
- }
- else if (zero1 || zero2)
- {
- result = FPZero(sign1 ^ sign2);
- }
- else
- {
- result = value1 * value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- return result;
- }
- public static float FPRecipEstimate(float value, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPRecipEstimate: state.Fpcr = 0x{state.CFpcr:X8}");
- value.FPUnpack(out FpType type, out bool sign, out uint op, state);
- float result;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- result = FPProcessNaN(type, op, state);
- }
- else if (type == FpType.Infinity)
- {
- result = FPZero(sign);
- }
- else if (type == FpType.Zero)
- {
- result = FPInfinity(sign);
- FPProcessException(FpExc.DivideByZero, state);
- }
- else if (MathF.Abs(value) < MathF.Pow(2f, -128))
- {
- bool overflowToInf;
- switch (state.FPRoundingMode())
- {
- default:
- case RoundMode.ToNearest: overflowToInf = true; break;
- case RoundMode.TowardsPlusInfinity: overflowToInf = !sign; break;
- case RoundMode.TowardsMinusInfinity: overflowToInf = sign; break;
- case RoundMode.TowardsZero: overflowToInf = false; break;
- }
- result = overflowToInf ? FPInfinity(sign) : FPMaxNormal(sign);
- FPProcessException(FpExc.Overflow, state);
- FPProcessException(FpExc.Inexact, state);
- }
- else if (state.GetFpcrFlag(Fpcr.Fz) && (MathF.Abs(value) >= MathF.Pow(2f, 126)))
- {
- result = FPZero(sign);
- state.SetFpsrFlag(Fpsr.Ufc);
- }
- else
- {
- ulong fraction = (ulong)(op & 0x007FFFFFu) << 29;
- uint exp = (op & 0x7F800000u) >> 23;
- if (exp == 0u)
- {
- if ((fraction & 0x0008000000000000ul) == 0ul)
- {
- fraction = (fraction & 0x0003FFFFFFFFFFFFul) << 2;
- exp -= 1u;
- }
- else
- {
- fraction = (fraction & 0x0007FFFFFFFFFFFFul) << 1;
- }
- }
- uint scaled = (uint)(((fraction & 0x000FF00000000000ul) | 0x0010000000000000ul) >> 44);
- uint resultExp = 253u - exp;
- uint estimate = (uint)SoftFloat.RecipEstimateTable[scaled - 256u] + 256u;
- fraction = (ulong)(estimate & 0xFFu) << 44;
- if (resultExp == 0u)
- {
- fraction = ((fraction & 0x000FFFFFFFFFFFFEul) | 0x0010000000000000ul) >> 1;
- }
- else if (resultExp + 1u == 0u)
- {
- fraction = ((fraction & 0x000FFFFFFFFFFFFCul) | 0x0010000000000000ul) >> 2;
- resultExp = 0u;
- }
- result = BitConverter.Int32BitsToSingle(
- (int)((sign ? 1u : 0u) << 31 | (resultExp & 0xFFu) << 23 | (uint)(fraction >> 29) & 0x007FFFFFu));
- }
- return result;
- }
- public static float FPRecipStepFused(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPRecipStepFused: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPNeg();
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- float result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && zero2) || (zero1 && inf2))
- {
- result = FPTwo(false);
- }
- else if (inf1 || inf2)
- {
- result = FPInfinity(sign1 ^ sign2);
- }
- else
- {
- // TODO: When available, use: T MathF.FusedMultiplyAdd(T, T, T);
- // https://github.com/dotnet/corefx/issues/31903
- result = 2f + (value1 * value2);
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- return result;
- }
- public static float FPRecpX(float value, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPRecpX: state.Fpcr = 0x{state.CFpcr:X8}");
- value.FPUnpack(out FpType type, out bool sign, out uint op, state);
- float result;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- result = FPProcessNaN(type, op, state);
- }
- else
- {
- uint notExp = (~op >> 23) & 0xFFu;
- uint maxExp = 0xFEu;
- result = BitConverter.Int32BitsToSingle(
- (int)((sign ? 1u : 0u) << 31 | (notExp == 0xFFu ? maxExp : notExp) << 23));
- }
- return result;
- }
- public static float FPRSqrtEstimate(float value, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPRSqrtEstimate: state.Fpcr = 0x{state.CFpcr:X8}");
- value.FPUnpack(out FpType type, out bool sign, out uint op, state);
- float result;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- result = FPProcessNaN(type, op, state);
- }
- else if (type == FpType.Zero)
- {
- result = FPInfinity(sign);
- FPProcessException(FpExc.DivideByZero, state);
- }
- else if (sign)
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if (type == FpType.Infinity)
- {
- result = FPZero(false);
- }
- else
- {
- ulong fraction = (ulong)(op & 0x007FFFFFu) << 29;
- uint exp = (op & 0x7F800000u) >> 23;
- if (exp == 0u)
- {
- while ((fraction & 0x0008000000000000ul) == 0ul)
- {
- fraction = (fraction & 0x0007FFFFFFFFFFFFul) << 1;
- exp -= 1u;
- }
- fraction = (fraction & 0x0007FFFFFFFFFFFFul) << 1;
- }
- uint scaled;
- if ((exp & 1u) == 0u)
- {
- scaled = (uint)(((fraction & 0x000FF00000000000ul) | 0x0010000000000000ul) >> 44);
- }
- else
- {
- scaled = (uint)(((fraction & 0x000FE00000000000ul) | 0x0010000000000000ul) >> 45);
- }
- uint resultExp = (380u - exp) >> 1;
- uint estimate = (uint)SoftFloat.RecipSqrtEstimateTable[scaled - 128u] + 256u;
- result = BitConverter.Int32BitsToSingle((int)((resultExp & 0xFFu) << 23 | (estimate & 0xFFu) << 15));
- }
- return result;
- }
- public static float FPRSqrtStepFused(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPRSqrtStepFused: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPNeg();
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- float result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && zero2) || (zero1 && inf2))
- {
- result = FPOnePointFive(false);
- }
- else if (inf1 || inf2)
- {
- result = FPInfinity(sign1 ^ sign2);
- }
- else
- {
- // TODO: When available, use: T MathF.FusedMultiplyAdd(T, T, T);
- // https://github.com/dotnet/corefx/issues/31903
- result = (3f + (value1 * value2)) / 2f;
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- return result;
- }
- public static float FPSqrt(float value, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPSqrt: state.Fpcr = 0x{state.CFpcr:X8}");
- value = value.FPUnpack(out FpType type, out bool sign, out uint op, state);
- float result;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- result = FPProcessNaN(type, op, state);
- }
- else if (type == FpType.Zero)
- {
- result = FPZero(sign);
- }
- else if (type == FpType.Infinity && !sign)
- {
- result = FPInfinity(sign);
- }
- else if (sign)
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else
- {
- result = MathF.Sqrt(value);
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- return result;
- }
- public static float FPSub(float value1, float value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat32.FPSub: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out uint op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out uint op2, state);
- float result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if (inf1 && inf2 && sign1 == sign2)
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if ((inf1 && !sign1) || (inf2 && sign2))
- {
- result = FPInfinity(false);
- }
- else if ((inf1 && sign1) || (inf2 && !sign2))
- {
- result = FPInfinity(true);
- }
- else if (zero1 && zero2 && sign1 == !sign2)
- {
- result = FPZero(sign1);
- }
- else
- {
- result = value1 - value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && float.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0f);
- }
- }
- }
- return result;
- }
- private static float FPDefaultNaN()
- {
- return -float.NaN;
- }
- private static float FPInfinity(bool sign)
- {
- return sign ? float.NegativeInfinity : float.PositiveInfinity;
- }
- private static float FPZero(bool sign)
- {
- return sign ? -0f : +0f;
- }
- private static float FPMaxNormal(bool sign)
- {
- return sign ? float.MinValue : float.MaxValue;
- }
- private static float FPTwo(bool sign)
- {
- return sign ? -2f : +2f;
- }
- private static float FPOnePointFive(bool sign)
- {
- return sign ? -1.5f : +1.5f;
- }
- private static float FPNeg(this float value)
- {
- return -value;
- }
- private static float ZerosOrOnes(bool ones)
- {
- return BitConverter.Int32BitsToSingle(ones ? -1 : 0);
- }
- private static float FPUnpack(
- this float value,
- out FpType type,
- out bool sign,
- out uint valueBits,
- CpuThreadState state)
- {
- valueBits = (uint)BitConverter.SingleToInt32Bits(value);
- sign = (~valueBits & 0x80000000u) == 0u;
- if ((valueBits & 0x7F800000u) == 0u)
- {
- if ((valueBits & 0x007FFFFFu) == 0u || state.GetFpcrFlag(Fpcr.Fz))
- {
- type = FpType.Zero;
- value = FPZero(sign);
- if ((valueBits & 0x007FFFFFu) != 0u)
- {
- FPProcessException(FpExc.InputDenorm, state);
- }
- }
- else
- {
- type = FpType.Nonzero;
- }
- }
- else if ((~valueBits & 0x7F800000u) == 0u)
- {
- if ((valueBits & 0x007FFFFFu) == 0u)
- {
- type = FpType.Infinity;
- }
- else
- {
- type = (~valueBits & 0x00400000u) == 0u ? FpType.QNaN : FpType.SNaN;
- value = FPZero(sign);
- }
- }
- else
- {
- type = FpType.Nonzero;
- }
- return value;
- }
- private static float FPProcessNaNs(
- FpType type1,
- FpType type2,
- uint op1,
- uint op2,
- out bool done,
- CpuThreadState state)
- {
- done = true;
- if (type1 == FpType.SNaN)
- {
- return FPProcessNaN(type1, op1, state);
- }
- else if (type2 == FpType.SNaN)
- {
- return FPProcessNaN(type2, op2, state);
- }
- else if (type1 == FpType.QNaN)
- {
- return FPProcessNaN(type1, op1, state);
- }
- else if (type2 == FpType.QNaN)
- {
- return FPProcessNaN(type2, op2, state);
- }
- done = false;
- return FPZero(false);
- }
- private static float FPProcessNaNs3(
- FpType type1,
- FpType type2,
- FpType type3,
- uint op1,
- uint op2,
- uint op3,
- out bool done,
- CpuThreadState state)
- {
- done = true;
- if (type1 == FpType.SNaN)
- {
- return FPProcessNaN(type1, op1, state);
- }
- else if (type2 == FpType.SNaN)
- {
- return FPProcessNaN(type2, op2, state);
- }
- else if (type3 == FpType.SNaN)
- {
- return FPProcessNaN(type3, op3, state);
- }
- else if (type1 == FpType.QNaN)
- {
- return FPProcessNaN(type1, op1, state);
- }
- else if (type2 == FpType.QNaN)
- {
- return FPProcessNaN(type2, op2, state);
- }
- else if (type3 == FpType.QNaN)
- {
- return FPProcessNaN(type3, op3, state);
- }
- done = false;
- return FPZero(false);
- }
- private static float FPProcessNaN(FpType type, uint op, CpuThreadState state)
- {
- if (type == FpType.SNaN)
- {
- op |= 1u << 22;
- FPProcessException(FpExc.InvalidOp, state);
- }
- if (state.GetFpcrFlag(Fpcr.Dn))
- {
- return FPDefaultNaN();
- }
- return BitConverter.Int32BitsToSingle((int)op);
- }
- private static void FPProcessException(FpExc exc, CpuThreadState state)
- {
- int enable = (int)exc + 8;
- if ((state.CFpcr & (1 << enable)) != 0)
- {
- throw new NotImplementedException("Floating-point trap handling.");
- }
- else
- {
- state.CFpsr |= 1 << (int)exc;
- }
- }
- }
- static class SoftFloat64
- {
- public static double FPAdd(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPAdd: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- double result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if (inf1 && inf2 && sign1 == !sign2)
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if ((inf1 && !sign1) || (inf2 && !sign2))
- {
- result = FPInfinity(false);
- }
- else if ((inf1 && sign1) || (inf2 && sign2))
- {
- result = FPInfinity(true);
- }
- else if (zero1 && zero2 && sign1 == sign2)
- {
- result = FPZero(sign1);
- }
- else
- {
- result = value1 + value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- return result;
- }
- public static int FPCompare(double value1, double value2, bool signalNaNs, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPCompare: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out _, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out _, state);
- int result;
- if (type1 == FpType.SNaN || type1 == FpType.QNaN || type2 == FpType.SNaN || type2 == FpType.QNaN)
- {
- result = 0b0011;
- if (type1 == FpType.SNaN || type2 == FpType.SNaN || signalNaNs)
- {
- FPProcessException(FpExc.InvalidOp, state);
- }
- }
- else
- {
- if (value1 == value2)
- {
- result = 0b0110;
- }
- else if (value1 < value2)
- {
- result = 0b1000;
- }
- else
- {
- result = 0b0010;
- }
- }
- return result;
- }
- public static double FPCompareEQ(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPCompareEQ: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out _, out _, state);
- value2 = value2.FPUnpack(out FpType type2, out _, out _, state);
- double result;
- if (type1 == FpType.SNaN || type1 == FpType.QNaN || type2 == FpType.SNaN || type2 == FpType.QNaN)
- {
- result = ZerosOrOnes(false);
- if (type1 == FpType.SNaN || type2 == FpType.SNaN)
- {
- FPProcessException(FpExc.InvalidOp, state);
- }
- }
- else
- {
- result = ZerosOrOnes(value1 == value2);
- }
- return result;
- }
- public static double FPCompareGE(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPCompareGE: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out _, out _, state);
- value2 = value2.FPUnpack(out FpType type2, out _, out _, state);
- double result;
- if (type1 == FpType.SNaN || type1 == FpType.QNaN || type2 == FpType.SNaN || type2 == FpType.QNaN)
- {
- result = ZerosOrOnes(false);
- FPProcessException(FpExc.InvalidOp, state);
- }
- else
- {
- result = ZerosOrOnes(value1 >= value2);
- }
- return result;
- }
- public static double FPCompareGT(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPCompareGT: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out _, out _, state);
- value2 = value2.FPUnpack(out FpType type2, out _, out _, state);
- double result;
- if (type1 == FpType.SNaN || type1 == FpType.QNaN || type2 == FpType.SNaN || type2 == FpType.QNaN)
- {
- result = ZerosOrOnes(false);
- FPProcessException(FpExc.InvalidOp, state);
- }
- else
- {
- result = ZerosOrOnes(value1 > value2);
- }
- return result;
- }
- [MethodImpl(MethodImplOptions.AggressiveInlining)]
- public static double FPCompareLE(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPCompareLE: state.Fpcr = 0x{state.CFpcr:X8}");
- return FPCompareGE(value2, value1, state);
- }
- [MethodImpl(MethodImplOptions.AggressiveInlining)]
- public static double FPCompareLT(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPCompareLT: state.Fpcr = 0x{state.CFpcr:X8}");
- return FPCompareGT(value2, value1, state);
- }
- public static double FPDiv(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPDiv: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- double result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && inf2) || (zero1 && zero2))
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if (inf1 || zero2)
- {
- result = FPInfinity(sign1 ^ sign2);
- if (!inf1)
- {
- FPProcessException(FpExc.DivideByZero, state);
- }
- }
- else if (zero1 || inf2)
- {
- result = FPZero(sign1 ^ sign2);
- }
- else
- {
- result = value1 / value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- return result;
- }
- public static double FPMax(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPMax: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- double result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- if (value1 > value2)
- {
- if (type1 == FpType.Infinity)
- {
- result = FPInfinity(sign1);
- }
- else if (type1 == FpType.Zero)
- {
- result = FPZero(sign1 && sign2);
- }
- else
- {
- result = value1;
- }
- }
- else
- {
- if (type2 == FpType.Infinity)
- {
- result = FPInfinity(sign2);
- }
- else if (type2 == FpType.Zero)
- {
- result = FPZero(sign1 && sign2);
- }
- else
- {
- result = value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- }
- return result;
- }
- public static double FPMaxNum(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPMaxNum: state.Fpcr = 0x{state.CFpcr:X8}");
- value1.FPUnpack(out FpType type1, out _, out _, state);
- value2.FPUnpack(out FpType type2, out _, out _, state);
- if (type1 == FpType.QNaN && type2 != FpType.QNaN)
- {
- value1 = FPInfinity(true);
- }
- else if (type1 != FpType.QNaN && type2 == FpType.QNaN)
- {
- value2 = FPInfinity(true);
- }
- return FPMax(value1, value2, state);
- }
- public static double FPMin(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPMin: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- double result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- if (value1 < value2)
- {
- if (type1 == FpType.Infinity)
- {
- result = FPInfinity(sign1);
- }
- else if (type1 == FpType.Zero)
- {
- result = FPZero(sign1 || sign2);
- }
- else
- {
- result = value1;
- }
- }
- else
- {
- if (type2 == FpType.Infinity)
- {
- result = FPInfinity(sign2);
- }
- else if (type2 == FpType.Zero)
- {
- result = FPZero(sign1 || sign2);
- }
- else
- {
- result = value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- }
- return result;
- }
- public static double FPMinNum(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPMinNum: state.Fpcr = 0x{state.CFpcr:X8}");
- value1.FPUnpack(out FpType type1, out _, out _, state);
- value2.FPUnpack(out FpType type2, out _, out _, state);
- if (type1 == FpType.QNaN && type2 != FpType.QNaN)
- {
- value1 = FPInfinity(false);
- }
- else if (type1 != FpType.QNaN && type2 == FpType.QNaN)
- {
- value2 = FPInfinity(false);
- }
- return FPMin(value1, value2, state);
- }
- public static double FPMul(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPMul: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- double result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && zero2) || (zero1 && inf2))
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if (inf1 || inf2)
- {
- result = FPInfinity(sign1 ^ sign2);
- }
- else if (zero1 || zero2)
- {
- result = FPZero(sign1 ^ sign2);
- }
- else
- {
- result = value1 * value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- return result;
- }
- public static double FPMulAdd(
- double valueA,
- double value1,
- double value2,
- CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPMulAdd: state.Fpcr = 0x{state.CFpcr:X8}");
- valueA = valueA.FPUnpack(out FpType typeA, out bool signA, out ulong addend, state);
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- double result = FPProcessNaNs3(typeA, type1, type2, addend, op1, op2, out bool done, state);
- if (typeA == FpType.QNaN && ((inf1 && zero2) || (zero1 && inf2)))
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- if (!done)
- {
- bool infA = typeA == FpType.Infinity; bool zeroA = typeA == FpType.Zero;
- bool signP = sign1 ^ sign2;
- bool infP = inf1 || inf2;
- bool zeroP = zero1 || zero2;
- if ((inf1 && zero2) || (zero1 && inf2) || (infA && infP && signA != signP))
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if ((infA && !signA) || (infP && !signP))
- {
- result = FPInfinity(false);
- }
- else if ((infA && signA) || (infP && signP))
- {
- result = FPInfinity(true);
- }
- else if (zeroA && zeroP && signA == signP)
- {
- result = FPZero(signA);
- }
- else
- {
- // TODO: When available, use: T Math.FusedMultiplyAdd(T, T, T);
- // https://github.com/dotnet/corefx/issues/31903
- result = valueA + (value1 * value2);
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- return result;
- }
- [MethodImpl(MethodImplOptions.AggressiveInlining)]
- public static double FPMulSub(
- double valueA,
- double value1,
- double value2,
- CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPMulSub: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPNeg();
- return FPMulAdd(valueA, value1, value2, state);
- }
- public static double FPMulX(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPMulX: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- double result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && zero2) || (zero1 && inf2))
- {
- result = FPTwo(sign1 ^ sign2);
- }
- else if (inf1 || inf2)
- {
- result = FPInfinity(sign1 ^ sign2);
- }
- else if (zero1 || zero2)
- {
- result = FPZero(sign1 ^ sign2);
- }
- else
- {
- result = value1 * value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- return result;
- }
- public static double FPRecipEstimate(double value, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPRecipEstimate: state.Fpcr = 0x{state.CFpcr:X8}");
- value.FPUnpack(out FpType type, out bool sign, out ulong op, state);
- double result;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- result = FPProcessNaN(type, op, state);
- }
- else if (type == FpType.Infinity)
- {
- result = FPZero(sign);
- }
- else if (type == FpType.Zero)
- {
- result = FPInfinity(sign);
- FPProcessException(FpExc.DivideByZero, state);
- }
- else if (Math.Abs(value) < Math.Pow(2d, -1024))
- {
- bool overflowToInf;
- switch (state.FPRoundingMode())
- {
- default:
- case RoundMode.ToNearest: overflowToInf = true; break;
- case RoundMode.TowardsPlusInfinity: overflowToInf = !sign; break;
- case RoundMode.TowardsMinusInfinity: overflowToInf = sign; break;
- case RoundMode.TowardsZero: overflowToInf = false; break;
- }
- result = overflowToInf ? FPInfinity(sign) : FPMaxNormal(sign);
- FPProcessException(FpExc.Overflow, state);
- FPProcessException(FpExc.Inexact, state);
- }
- else if (state.GetFpcrFlag(Fpcr.Fz) && (Math.Abs(value) >= Math.Pow(2d, 1022)))
- {
- result = FPZero(sign);
- state.SetFpsrFlag(Fpsr.Ufc);
- }
- else
- {
- ulong fraction = op & 0x000FFFFFFFFFFFFFul;
- uint exp = (uint)((op & 0x7FF0000000000000ul) >> 52);
- if (exp == 0u)
- {
- if ((fraction & 0x0008000000000000ul) == 0ul)
- {
- fraction = (fraction & 0x0003FFFFFFFFFFFFul) << 2;
- exp -= 1u;
- }
- else
- {
- fraction = (fraction & 0x0007FFFFFFFFFFFFul) << 1;
- }
- }
- uint scaled = (uint)(((fraction & 0x000FF00000000000ul) | 0x0010000000000000ul) >> 44);
- uint resultExp = 2045u - exp;
- uint estimate = (uint)SoftFloat.RecipEstimateTable[scaled - 256u] + 256u;
- fraction = (ulong)(estimate & 0xFFu) << 44;
- if (resultExp == 0u)
- {
- fraction = ((fraction & 0x000FFFFFFFFFFFFEul) | 0x0010000000000000ul) >> 1;
- }
- else if (resultExp + 1u == 0u)
- {
- fraction = ((fraction & 0x000FFFFFFFFFFFFCul) | 0x0010000000000000ul) >> 2;
- resultExp = 0u;
- }
- result = BitConverter.Int64BitsToDouble(
- (long)((sign ? 1ul : 0ul) << 63 | (resultExp & 0x7FFul) << 52 | (fraction & 0x000FFFFFFFFFFFFFul)));
- }
- return result;
- }
- public static double FPRecipStepFused(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPRecipStepFused: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPNeg();
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- double result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && zero2) || (zero1 && inf2))
- {
- result = FPTwo(false);
- }
- else if (inf1 || inf2)
- {
- result = FPInfinity(sign1 ^ sign2);
- }
- else
- {
- // TODO: When available, use: T Math.FusedMultiplyAdd(T, T, T);
- // https://github.com/dotnet/corefx/issues/31903
- result = 2d + (value1 * value2);
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- return result;
- }
- public static double FPRecpX(double value, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPRecpX: state.Fpcr = 0x{state.CFpcr:X8}");
- value.FPUnpack(out FpType type, out bool sign, out ulong op, state);
- double result;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- result = FPProcessNaN(type, op, state);
- }
- else
- {
- ulong notExp = (~op >> 52) & 0x7FFul;
- ulong maxExp = 0x7FEul;
- result = BitConverter.Int64BitsToDouble(
- (long)((sign ? 1ul : 0ul) << 63 | (notExp == 0x7FFul ? maxExp : notExp) << 52));
- }
- return result;
- }
- public static double FPRSqrtEstimate(double value, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPRSqrtEstimate: state.Fpcr = 0x{state.CFpcr:X8}");
- value.FPUnpack(out FpType type, out bool sign, out ulong op, state);
- double result;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- result = FPProcessNaN(type, op, state);
- }
- else if (type == FpType.Zero)
- {
- result = FPInfinity(sign);
- FPProcessException(FpExc.DivideByZero, state);
- }
- else if (sign)
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if (type == FpType.Infinity)
- {
- result = FPZero(false);
- }
- else
- {
- ulong fraction = op & 0x000FFFFFFFFFFFFFul;
- uint exp = (uint)((op & 0x7FF0000000000000ul) >> 52);
- if (exp == 0u)
- {
- while ((fraction & 0x0008000000000000ul) == 0ul)
- {
- fraction = (fraction & 0x0007FFFFFFFFFFFFul) << 1;
- exp -= 1u;
- }
- fraction = (fraction & 0x0007FFFFFFFFFFFFul) << 1;
- }
- uint scaled;
- if ((exp & 1u) == 0u)
- {
- scaled = (uint)(((fraction & 0x000FF00000000000ul) | 0x0010000000000000ul) >> 44);
- }
- else
- {
- scaled = (uint)(((fraction & 0x000FE00000000000ul) | 0x0010000000000000ul) >> 45);
- }
- uint resultExp = (3068u - exp) >> 1;
- uint estimate = (uint)SoftFloat.RecipSqrtEstimateTable[scaled - 128u] + 256u;
- result = BitConverter.Int64BitsToDouble((long)((resultExp & 0x7FFul) << 52 | (estimate & 0xFFul) << 44));
- }
- return result;
- }
- public static double FPRSqrtStepFused(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPRSqrtStepFused: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPNeg();
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- double result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if ((inf1 && zero2) || (zero1 && inf2))
- {
- result = FPOnePointFive(false);
- }
- else if (inf1 || inf2)
- {
- result = FPInfinity(sign1 ^ sign2);
- }
- else
- {
- // TODO: When available, use: T Math.FusedMultiplyAdd(T, T, T);
- // https://github.com/dotnet/corefx/issues/31903
- result = (3d + (value1 * value2)) / 2d;
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- return result;
- }
- public static double FPSqrt(double value, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPSqrt: state.Fpcr = 0x{state.CFpcr:X8}");
- value = value.FPUnpack(out FpType type, out bool sign, out ulong op, state);
- double result;
- if (type == FpType.SNaN || type == FpType.QNaN)
- {
- result = FPProcessNaN(type, op, state);
- }
- else if (type == FpType.Zero)
- {
- result = FPZero(sign);
- }
- else if (type == FpType.Infinity && !sign)
- {
- result = FPInfinity(sign);
- }
- else if (sign)
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else
- {
- result = Math.Sqrt(value);
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- return result;
- }
- public static double FPSub(double value1, double value2, CpuThreadState state)
- {
- Debug.WriteLineIf(state.CFpcr != 0, $"SoftFloat64.FPSub: state.Fpcr = 0x{state.CFpcr:X8}");
- value1 = value1.FPUnpack(out FpType type1, out bool sign1, out ulong op1, state);
- value2 = value2.FPUnpack(out FpType type2, out bool sign2, out ulong op2, state);
- double result = FPProcessNaNs(type1, type2, op1, op2, out bool done, state);
- if (!done)
- {
- bool inf1 = type1 == FpType.Infinity; bool zero1 = type1 == FpType.Zero;
- bool inf2 = type2 == FpType.Infinity; bool zero2 = type2 == FpType.Zero;
- if (inf1 && inf2 && sign1 == sign2)
- {
- result = FPDefaultNaN();
- FPProcessException(FpExc.InvalidOp, state);
- }
- else if ((inf1 && !sign1) || (inf2 && sign2))
- {
- result = FPInfinity(false);
- }
- else if ((inf1 && sign1) || (inf2 && !sign2))
- {
- result = FPInfinity(true);
- }
- else if (zero1 && zero2 && sign1 == !sign2)
- {
- result = FPZero(sign1);
- }
- else
- {
- result = value1 - value2;
- if (state.GetFpcrFlag(Fpcr.Fz) && double.IsSubnormal(result))
- {
- state.SetFpsrFlag(Fpsr.Ufc);
- result = FPZero(result < 0d);
- }
- }
- }
- return result;
- }
- private static double FPDefaultNaN()
- {
- return -double.NaN;
- }
- private static double FPInfinity(bool sign)
- {
- return sign ? double.NegativeInfinity : double.PositiveInfinity;
- }
- private static double FPZero(bool sign)
- {
- return sign ? -0d : +0d;
- }
- private static double FPMaxNormal(bool sign)
- {
- return sign ? double.MinValue : double.MaxValue;
- }
- private static double FPTwo(bool sign)
- {
- return sign ? -2d : +2d;
- }
- private static double FPOnePointFive(bool sign)
- {
- return sign ? -1.5d : +1.5d;
- }
- private static double FPNeg(this double value)
- {
- return -value;
- }
- private static double ZerosOrOnes(bool ones)
- {
- return BitConverter.Int64BitsToDouble(ones ? -1L : 0L);
- }
- private static double FPUnpack(
- this double value,
- out FpType type,
- out bool sign,
- out ulong valueBits,
- CpuThreadState state)
- {
- valueBits = (ulong)BitConverter.DoubleToInt64Bits(value);
- sign = (~valueBits & 0x8000000000000000ul) == 0ul;
- if ((valueBits & 0x7FF0000000000000ul) == 0ul)
- {
- if ((valueBits & 0x000FFFFFFFFFFFFFul) == 0ul || state.GetFpcrFlag(Fpcr.Fz))
- {
- type = FpType.Zero;
- value = FPZero(sign);
- if ((valueBits & 0x000FFFFFFFFFFFFFul) != 0ul)
- {
- FPProcessException(FpExc.InputDenorm, state);
- }
- }
- else
- {
- type = FpType.Nonzero;
- }
- }
- else if ((~valueBits & 0x7FF0000000000000ul) == 0ul)
- {
- if ((valueBits & 0x000FFFFFFFFFFFFFul) == 0ul)
- {
- type = FpType.Infinity;
- }
- else
- {
- type = (~valueBits & 0x0008000000000000ul) == 0ul ? FpType.QNaN : FpType.SNaN;
- value = FPZero(sign);
- }
- }
- else
- {
- type = FpType.Nonzero;
- }
- return value;
- }
- private static double FPProcessNaNs(
- FpType type1,
- FpType type2,
- ulong op1,
- ulong op2,
- out bool done,
- CpuThreadState state)
- {
- done = true;
- if (type1 == FpType.SNaN)
- {
- return FPProcessNaN(type1, op1, state);
- }
- else if (type2 == FpType.SNaN)
- {
- return FPProcessNaN(type2, op2, state);
- }
- else if (type1 == FpType.QNaN)
- {
- return FPProcessNaN(type1, op1, state);
- }
- else if (type2 == FpType.QNaN)
- {
- return FPProcessNaN(type2, op2, state);
- }
- done = false;
- return FPZero(false);
- }
- private static double FPProcessNaNs3(
- FpType type1,
- FpType type2,
- FpType type3,
- ulong op1,
- ulong op2,
- ulong op3,
- out bool done,
- CpuThreadState state)
- {
- done = true;
- if (type1 == FpType.SNaN)
- {
- return FPProcessNaN(type1, op1, state);
- }
- else if (type2 == FpType.SNaN)
- {
- return FPProcessNaN(type2, op2, state);
- }
- else if (type3 == FpType.SNaN)
- {
- return FPProcessNaN(type3, op3, state);
- }
- else if (type1 == FpType.QNaN)
- {
- return FPProcessNaN(type1, op1, state);
- }
- else if (type2 == FpType.QNaN)
- {
- return FPProcessNaN(type2, op2, state);
- }
- else if (type3 == FpType.QNaN)
- {
- return FPProcessNaN(type3, op3, state);
- }
- done = false;
- return FPZero(false);
- }
- private static double FPProcessNaN(FpType type, ulong op, CpuThreadState state)
- {
- if (type == FpType.SNaN)
- {
- op |= 1ul << 51;
- FPProcessException(FpExc.InvalidOp, state);
- }
- if (state.GetFpcrFlag(Fpcr.Dn))
- {
- return FPDefaultNaN();
- }
- return BitConverter.Int64BitsToDouble((long)op);
- }
- private static void FPProcessException(FpExc exc, CpuThreadState state)
- {
- int enable = (int)exc + 8;
- if ((state.CFpcr & (1 << enable)) != 0)
- {
- throw new NotImplementedException("Floating-point trap handling.");
- }
- else
- {
- state.CFpsr |= 1 << (int)exc;
- }
- }
- }
- }
|