12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165 |
- #include "vm.h"
- FILE* tape_01;
- FILE* tape_02;
- #ifdef tty_lib
- char tty_getchar();
- #endif
- /* Correctly write out bytes on little endian hardware */
- void writeout_Reg(struct lilith* vm, uint32_t p, uint32_t value)
- {
- uint8_t raw0, raw1, raw2, raw3;
- uint32_t tmp = value;
- raw3 = tmp%0x100;
- tmp = tmp/0x100;
- raw2 = tmp%0x100;
- tmp = tmp/0x100;
- raw1 = tmp%0x100;
- tmp = tmp/0x100;
- raw0 = tmp%0x100;
- vm->memory[p] = raw0;
- vm->memory[p + 1] = raw1;
- vm->memory[p + 2] = raw2;
- vm->memory[p + 3] = raw3;
- }
- /* Allow the use of native data format for Register operations */
- uint32_t readin_Reg(struct lilith* vm, uint32_t p)
- {
- uint8_t raw0, raw1, raw2, raw3;
- uint32_t sum;
- raw0 = vm->memory[p];
- raw1 = vm->memory[p + 1];
- raw2 = vm->memory[p + 2];
- raw3 = vm->memory[p + 3];
- sum = raw0*0x1000000 +
- raw1*0x10000 +
- raw2*0x100 +
- raw3;
- return sum;
- }
- /* Unify byte write functionality */
- void writeout_byte(struct lilith* vm, uint32_t p, uint32_t value)
- {
- vm->memory[p] = (uint8_t)(value%0x100);
- }
- /* Unify byte read functionality*/
- uint32_t readin_byte(struct lilith* vm, uint32_t p, bool Signed)
- {
- if(Signed)
- {
- int32_t raw0;
- raw0 = (int8_t)(vm->memory[p]);
- return (uint32_t)(raw0);
- }
- return (uint32_t)(vm->memory[p]);
- }
- /* Unify doublebyte write functionality */
- void writeout_doublebyte(struct lilith* vm, uint32_t p, uint32_t value)
- {
- uint8_t uraw0, uraw1;
- uint32_t utmp = value;
- utmp = utmp%0x10000;
- uraw1 = utmp%0x100;
- utmp = utmp/0x100;
- uraw0 = utmp%0x100;
- vm->memory[p] = uraw0;
- vm->memory[p + 1] = uraw1;
- }
- /* Unify doublebyte read functionality*/
- uint32_t readin_doublebyte(struct lilith* vm, uint32_t p, bool Signed)
- {
- if(Signed)
- {
- int8_t raw0, raw1;
- int32_t sum;
- raw0 = vm->memory[p];
- raw1 = vm->memory[p + 1];
- sum = raw0*0x100 + raw1;
- return (uint32_t)(sum);
- }
- uint8_t uraw0, uraw1;
- uint32_t usum;
- uraw0 = vm->memory[p];
- uraw1 = vm->memory[p + 1];
- usum = uraw0*0x100 + uraw1;
- return usum;
- }
- /* Determine the result of bit shifting */
- uint32_t shift_register(uint32_t source, uint32_t amount, bool left, bool zero)
- {
- uint32_t tmp = source;
- if(left)
- {
- while( amount > 0 )
- {
- tmp = tmp * 2;
- amount = amount - 1;
- if(!zero)
- {
- tmp = tmp + 1;
- }
- }
- }
- else
- {
- while( amount > 0 )
- {
- tmp = tmp / 2;
- amount = amount - 1;
- if(!zero)
- {
- tmp = tmp | (1 << 31);
- }
- }
- }
- return tmp;
- }
- void vm_FOPEN_READ(struct lilith* vm)
- {
- if(0x00001100 == vm->reg[0])
- {
- tape_01 = fopen("tape_01", "r");
- }
- if (0x00001101 == vm->reg[0])
- {
- tape_02 = fopen("tape_02", "r");
- }
- }
- void vm_FOPEN_WRITE(struct lilith* vm)
- {
- if(0x00001100 == vm->reg[0])
- {
- tape_01 = fopen("tape_01", "w");
- }
- if (0x00001101 == vm->reg[0])
- {
- tape_02 = fopen("tape_02", "w");
- }
- }
- void vm_FCLOSE(struct lilith* vm)
- {
- if(0x00001100 == vm->reg[0])
- {
- fclose(tape_01);
- }
- if (0x00001101 == vm->reg[0])
- {
- fclose(tape_02);
- }
- }
- void vm_FSEEK(struct lilith* vm)
- {
- if(0x00001100 == vm->reg[0])
- {
- fseek(tape_01, vm->reg[1], SEEK_CUR);
- }
- if (0x00001101 == vm->reg[0])
- {
- fseek(tape_02, vm->reg[1], SEEK_CUR);
- }
- }
- void vm_REWIND(struct lilith* vm)
- {
- if(0x00001100 == vm->reg[0])
- {
- rewind(tape_01);
- }
- if (0x00001101 == vm->reg[0])
- {
- rewind(tape_02);
- }
- }
- void vm_FGETC(struct lilith* vm)
- {
- int32_t byte = -1;
- if (0x00000000 == vm->reg[1])
- {
- #ifdef tty_lib
- byte = tty_getchar();
- #endif
- #ifndef tty_lib
- byte = fgetc(stdin);
- #endif
- }
- if(0x00001100 == vm->reg[1])
- {
- byte = fgetc(tape_01);
- }
- if (0x00001101 == vm->reg[1])
- {
- byte = fgetc(tape_02);
- }
- vm->reg[0] = byte;
- }
- void vm_FPUTC(struct lilith* vm)
- {
- int32_t byte = vm->reg[0];
- if (0x00000000 == vm->reg[1])
- {
- fputc(byte, stdout);
- #ifdef tty_lib
- fflush(stdout);
- #endif
- }
- if(0x00001100 == vm->reg[1])
- {
- fputc(byte, tape_01);
- }
- if (0x00001101 == vm->reg[1])
- {
- fputc(byte, tape_02);
- }
- }
- /* Condition Codes */
- enum condition
- {
- Carry = (1 << 5),
- Borrow = (1 << 4),
- Overflow = (1 << 3),
- GreaterThan = (1 << 2),
- EQual = (1 << 1),
- LessThan = 1
- };
- bool Carry_bit_set(uint32_t a)
- {
- return a & Carry;
- }
- bool Borrow_bit_set(uint32_t a)
- {
- return a & Borrow;
- }
- bool Overflow_bit_set(uint32_t a)
- {
- return a & Overflow;
- }
- bool GreaterThan_bit_set(uint32_t a)
- {
- return a & GreaterThan;
- }
- bool EQual_bit_set(uint32_t a)
- {
- return a & EQual;
- }
- bool LessThan_bit_set(uint32_t a)
- {
- return a & LessThan;
- }
- void ADD_CI(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- /* If carry bit set add in the carry */
- if(Carry_bit_set(vm->reg[c->reg3]))
- {
- vm->reg[c->reg0] = tmp1 + tmp2 + 1;
- }
- else
- {
- vm->reg[c->reg0] = tmp1 + tmp2;
- }
- }
- void ADD_CO(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- int64_t btmp1;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- btmp1 = ((int64_t)tmp1) + ((int64_t)tmp2);
- /* If addition exceeds int32_t MAX, set carry bit */
- if(1 == ( btmp1 >> 31 ))
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] | Carry;
- }
- else
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] & ~(Carry);
- }
- /* Standard addition */
- vm->reg[c->reg0] = (tmp1 + tmp2);
- }
- void ADD_CIO(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- int64_t btmp1;
- bool C = Carry_bit_set(vm->reg[c->reg3]);
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- btmp1 = ((int64_t)tmp1) + ((int64_t)tmp2);
- /* If addition exceeds int32_t MAX, set carry bit */
- if(1 == ( btmp1 >> 31 ))
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] | Carry;
- }
- else
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] & ~(Carry);
- }
- /* If carry bit set before operation add in the carry */
- if(C)
- {
- vm->reg[c->reg0] = tmp1 + tmp2 + 1;
- }
- else
- {
- vm->reg[c->reg0] = tmp1 + tmp2;
- }
- }
- void ADDU_CI(struct lilith* vm, struct Instruction* c)
- {
- uint32_t utmp1, utmp2;
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- /* If carry bit set add in the carry */
- if(Carry_bit_set(vm->reg[c->reg3]))
- {
- vm->reg[c->reg0] = utmp1 + utmp2 + 1;
- }
- else
- {
- vm->reg[c->reg0] = utmp1 + utmp2;
- }
- }
- void ADDU_CO(struct lilith* vm, struct Instruction* c)
- {
- uint32_t utmp1, utmp2;
- uint64_t ubtmp1;
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- ubtmp1 = ((uint64_t)utmp1) + ((uint64_t)utmp2);
- /* If addition exceeds uint32_t MAX, set carry bit */
- if(0 != ( ubtmp1 >> 32 ))
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] | Carry;
- }
- else
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] & ~(Carry);
- }
- /* Standard addition */
- vm->reg[c->reg0] = (utmp1 + utmp2);
- }
- void ADDU_CIO(struct lilith* vm, struct Instruction* c)
- {
- uint32_t utmp1, utmp2;
- uint64_t ubtmp1;
- bool C;
- C = Carry_bit_set(vm->reg[c->reg3]);
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- ubtmp1 = ((uint64_t)utmp1) + ((uint64_t)utmp2);
- /* If addition exceeds uint32_t MAX, set carry bit */
- if(0 != ( ubtmp1 >> 32 ))
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] | Carry;
- }
- else
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] & ~(Carry);
- }
- /* If carry bit was set before operation add in the carry */
- if(C)
- {
- vm->reg[c->reg0] = utmp1 + utmp2 + 1;
- }
- else
- {
- vm->reg[c->reg0] = utmp1 + utmp2;
- }
- }
- void SUB_BI(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- /* If borrow bit set subtract out the borrow */
- if(Borrow_bit_set(vm->reg[c->reg3]))
- {
- vm->reg[c->reg0] = tmp1 - tmp2 - 1;
- }
- else
- {
- vm->reg[c->reg0] = tmp1 - tmp2;
- }
- }
- void SUB_BO(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- int64_t btmp1;
- btmp1 = (int64_t)(vm->reg[c->reg1]);
- tmp1 = (int32_t)(vm->reg[c->reg2]);
- tmp2 = (int32_t)(btmp1 - tmp1);
- /* If subtraction goes below int32_t MIN set borrow */
- if(btmp1 != (tmp2 + tmp1))
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] | Borrow;
- }
- else
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] & ~(Borrow);
- }
- /* Standard subtraction */
- vm->reg[c->reg0] = tmp2;
- }
- void SUB_BIO(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- int64_t btmp1;
- bool B;
- B = Borrow_bit_set(vm->reg[c->reg3]);
- btmp1 = (int64_t)(vm->reg[c->reg1]);
- tmp1 = (int32_t)(vm->reg[c->reg2]);
- tmp2 = (int32_t)(btmp1 - tmp1);
- /* If subtraction goes below int32_t MIN set borrow */
- if(btmp1 != (tmp2 + tmp1))
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] | Borrow;
- }
- else
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] & ~(Borrow);
- }
- /* If borrow bit was set prior to operation subtract out the borrow */
- if(B)
- {
- vm->reg[c->reg0] = tmp2 - 1;
- }
- else
- {
- vm->reg[c->reg0] = tmp2;
- }
- }
- void SUBU_BI(struct lilith* vm, struct Instruction* c)
- {
- uint32_t utmp1, utmp2;
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- /* If borrow bit set subtract out the borrow */
- if(Borrow_bit_set(vm->reg[c->reg3]))
- {
- vm->reg[c->reg0] = utmp1 - utmp2 - 1;
- }
- else
- {
- vm->reg[c->reg0] = utmp1 - utmp2;
- }
- }
- void SUBU_BO(struct lilith* vm, struct Instruction* c)
- {
- uint32_t utmp1, utmp2;
- uint64_t ubtmp1;
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- ubtmp1 = (uint64_t)(utmp1 - utmp2);
- /* If subtraction goes below uint32_t MIN set borrow */
- if(utmp1 != (ubtmp1 + utmp2))
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] | Borrow;
- }
- else
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] & ~(Borrow);
- }
- /* Standard subtraction */
- vm->reg[c->reg0] = (utmp1 - utmp2);
- }
- void SUBU_BIO(struct lilith* vm, struct Instruction* c)
- {
- uint32_t utmp1, utmp2;
- uint64_t ubtmp1;
- bool B;
- B = Borrow_bit_set(vm->reg[c->reg3]);
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- ubtmp1 = (uint64_t)(utmp1 - utmp2);
- /* If subtraction goes below uint32_t MIN set borrow */
- if(utmp1 != (ubtmp1 + utmp2))
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] | Borrow;
- }
- else
- {
- vm->reg[c->reg3] = vm->reg[c->reg3] & ~(Borrow);
- }
- /* If borrow bit was set prior to operation subtract out the borrow */
- if(B)
- {
- vm->reg[c->reg0] = utmp1 - utmp2 - 1;
- }
- else
- {
- vm->reg[c->reg0] = utmp1 - utmp2;
- }
- }
- void MULTIPLY(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- int64_t btmp1;
- tmp1 = (int32_t)(vm->reg[c->reg2]);
- tmp2 = (int32_t)( vm->reg[c->reg3]);
- btmp1 = ((int64_t)tmp1) * ((int64_t)tmp2);
- vm->reg[c->reg0] = (int32_t)(btmp1 % 0x100000000);
- vm->reg[c->reg1] = (int32_t)(btmp1 / 0x100000000);
- }
- void MULTIPLYU(struct lilith* vm, struct Instruction* c)
- {
- uint64_t ubtmp1;
- ubtmp1 = (uint64_t)(vm->reg[c->reg2]) * (uint64_t)(vm->reg[c->reg3]);
- vm->reg[c->reg0] = ubtmp1 % 0x100000000;
- vm->reg[c->reg1] = ubtmp1 / 0x100000000;
- }
- void DIVIDE(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg2]);
- tmp2 = (int32_t)(vm->reg[c->reg3]);
- vm->reg[c->reg0] = tmp1 / tmp2;
- vm->reg[c->reg1] = tmp1 % tmp2;
- }
- void DIVIDEU(struct lilith* vm, struct Instruction* c)
- {
- uint32_t utmp1, utmp2;
- utmp1 = vm->reg[c->reg2];
- utmp2 = vm->reg[c->reg3];
- vm->reg[c->reg0] = utmp1 / utmp2;
- vm->reg[c->reg1] = utmp1 % utmp2;
- }
- void MUX(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ((vm->reg[c->reg2] & ~(vm->reg[c->reg1])) |
- (vm->reg[c->reg3] & vm->reg[c->reg1]));
- }
- void NMUX(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ((vm->reg[c->reg2] & vm->reg[c->reg1]) |
- (vm->reg[c->reg3] & ~(vm->reg[c->reg1])));
- }
- void SORT(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg2]);
- tmp2 = (int32_t)(vm->reg[c->reg3]);
- if(tmp1 > tmp2)
- {
- vm->reg[c->reg0] = tmp1;
- vm->reg[c->reg1] = tmp2;
- }
- else
- {
- vm->reg[c->reg1] = tmp1;
- vm->reg[c->reg0] = tmp2;
- }
- }
- void SORTU(struct lilith* vm, struct Instruction* c)
- {
- uint32_t utmp1, utmp2;
- utmp1 = vm->reg[c->reg2];
- utmp2 = vm->reg[c->reg3];
- if(utmp1 > utmp2)
- {
- vm->reg[c->reg0] = utmp1;
- vm->reg[c->reg1] = utmp2;
- }
- else
- {
- vm->reg[c->reg1] = utmp1;
- vm->reg[c->reg0] = utmp2;
- }
- }
- void ADD(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- vm->reg[c->reg0] = (int32_t)(tmp1 + tmp2);
- }
- void ADDU(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] + vm->reg[c->reg2];
- }
- void SUB(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- vm->reg[c->reg0] = (int32_t)(tmp1 - tmp2);
- }
- void SUBU(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] - vm->reg[c->reg2];
- }
- void CMP(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- uint32_t result = 0;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- /* Set condition bits accordingly*/
- if(tmp1 > tmp2)
- {
- vm->reg[c->reg0] = result | GreaterThan;
- }
- else if(tmp1 == tmp2)
- {
- vm->reg[c->reg0] = result | EQual;
- }
- else
- {
- vm->reg[c->reg0] = result | LessThan;
- }
- }
- void CMPU(struct lilith* vm, struct Instruction* c)
- {
- uint32_t result = 0;
- if(vm->reg[c->reg1] > vm->reg[c->reg2])
- {
- vm->reg[c->reg0] = result | GreaterThan;
- }
- else if(vm->reg[c->reg1] == vm->reg[c->reg2])
- {
- vm->reg[c->reg0] = result | EQual;
- }
- else
- {
- vm->reg[c->reg0] = result | LessThan;
- }
- }
- void MUL(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- int64_t sum = tmp1 * tmp2;
- /* We only want the bottom 32bits */
- vm->reg[c->reg0] = sum % 0x100000000;
- }
- void MULH(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- int64_t sum = tmp1 * tmp2;
- /* We only want the top 32bits */
- vm->reg[c->reg0] = sum / 0x100000000;
- }
- void MULU(struct lilith* vm, struct Instruction* c)
- {
- uint64_t tmp1, tmp2, sum;
- tmp1 = vm->reg[c->reg1];
- tmp2 = vm->reg[c->reg2];
- sum = tmp1 * tmp2;
- /* We only want the bottom 32bits */
- vm->reg[c->reg0] = sum % 0x100000000;
- }
- void MULUH(struct lilith* vm, struct Instruction* c)
- {
- uint64_t tmp1, tmp2, sum;
- tmp1 = vm->reg[c->reg1];
- tmp2 = vm->reg[c->reg2];
- sum = tmp1 * tmp2;
- /* We only want the top 32bits */
- vm->reg[c->reg0] = sum / 0x100000000;
- }
- void DIV(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- vm->reg[c->reg0] = tmp1 / tmp2;
- }
- void MOD(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- vm->reg[c->reg0] = tmp1 % tmp2;
- }
- void DIVU(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] / vm->reg[c->reg2];
- }
- void MODU(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] % vm->reg[c->reg2];
- }
- void MAX(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- if(tmp1 > tmp2)
- {
- vm->reg[c->reg0] = tmp1;
- }
- else
- {
- vm->reg[c->reg0] = tmp2;
- }
- }
- void MAXU(struct lilith* vm, struct Instruction* c)
- {
- if(vm->reg[c->reg1] > vm->reg[c->reg2])
- {
- vm->reg[c->reg0] = vm->reg[c->reg1];
- }
- else
- {
- vm->reg[c->reg0] = vm->reg[c->reg2];
- }
- }
- void MIN(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- tmp2 = (int32_t)(vm->reg[c->reg2]);
- if(tmp1 < tmp2)
- {
- vm->reg[c->reg0] = tmp1;
- }
- else
- {
- vm->reg[c->reg0] = tmp2;
- }
- }
- void MINU(struct lilith* vm, struct Instruction* c)
- {
- if(vm->reg[c->reg1] < vm->reg[c->reg2])
- {
- vm->reg[c->reg0] = vm->reg[c->reg1];
- }
- else
- {
- vm->reg[c->reg0] = vm->reg[c->reg2];
- }
- }
- void PACK(struct lilith* vm, struct Instruction* c)
- {
- uint8_t i;
- bool bit1, bit2;
- vm->reg[c->reg0] = 0;
- for(i = 31; i > 0; i = i - 1)
- {
- bit1 = (vm->reg[c->reg1] >> i) & 1;
- bit2 = (vm->reg[c->reg2] >> i) & 1;
- if(bit1)
- {
- if(bit2)
- {
- vm->reg[c->reg0] = vm->reg[c->reg0] * 2 + 1;
- }
- else
- {
- vm->reg[c->reg0] = vm->reg[c->reg0] * 2;
- }
- }
- }
- }
- void UNPACK(struct lilith* vm, struct Instruction* c)
- {
- uint8_t i;
- bool bit1, bit2;
- vm->reg[c->reg0] = 0;
- for(i = 0; i < 32; i = i + 1)
- {
- bit1 = (vm->reg[c->reg1] >> (31 - i)) & 1;
- bit2 = (vm->reg[c->reg2] >> (31 - i)) & 1;
- if(bit1)
- {
- vm->reg[c->reg0] = vm->reg[c->reg0] * 2 + bit2;
- }
- else
- {
- vm->reg[c->reg0] = vm->reg[c->reg0] * 2;
- }
- }
- }
- void PACK8_CO(struct lilith* vm, struct Instruction* c)
- {
- if(0x7F < (int32_t)(vm->reg[c->reg1]))
- {
- /* Saturate in the event of Overflow */
- vm->reg[c->reg0] = 0x7F;
- vm->reg[c->reg2] = vm->reg[c->reg2] | Overflow;
- }
- else if (-128 > (int32_t)(vm->reg[c->reg1]))
- {
- /* Saturate in the event of Underflow */
- vm->reg[c->reg0] = 0x80;
- vm->reg[c->reg2] = vm->reg[c->reg2] | Overflow;
- }
- else
- {
- /* Unset Overflow bit if set */
- vm->reg[c->reg0] = vm->reg[c->reg1];
- vm->reg[c->reg2] = vm->reg[c->reg2] & ~(Overflow);
- }
- }
- void PACK8U_CO(struct lilith* vm, struct Instruction* c)
- {
- if(0xFF < vm->reg[c->reg1])
- {
- /* Saturate in the event of Overflow */
- vm->reg[c->reg0] = 0xFF;
- vm->reg[c->reg2] = vm->reg[c->reg2] | Overflow;
- }
- else
- {
- /* Unset Overflow bit if set */
- vm->reg[c->reg0] = vm->reg[c->reg1];
- vm->reg[c->reg2] = vm->reg[c->reg2] & ~(Overflow);
- }
- }
- void PACK16_CO(struct lilith* vm, struct Instruction* c)
- {
- if(0x7FFF < (int32_t)(vm->reg[c->reg1]))
- {
- /* Saturate in the event of Overflow */
- vm->reg[c->reg0] = 0x7FFF;
- vm->reg[c->reg2] = vm->reg[c->reg2] | Overflow;
- }
- else if (-32768 > (int32_t)(vm->reg[c->reg1]))
- {
- /* Saturate in the event of Underflow */
- vm->reg[c->reg0] = 0x8000;
- vm->reg[c->reg2] = vm->reg[c->reg2] | Overflow;
- }
- else
- {
- /* Unset Overflow bit if set */
- vm->reg[c->reg0] = vm->reg[c->reg1];
- vm->reg[c->reg2] = vm->reg[c->reg2] & ~(Overflow);
- }
- }
- void PACK16U_CO(struct lilith* vm, struct Instruction* c)
- {
- if(0xFFFF < vm->reg[c->reg1])
- {
- /* Saturate in the event of Overflow */
- vm->reg[c->reg0] = 0xFFFF;
- vm->reg[c->reg2] = vm->reg[c->reg2] | Overflow;
- }
- else
- {
- /* Unset Overflow bit if set */
- vm->reg[c->reg0] = vm->reg[c->reg1];
- vm->reg[c->reg2] = vm->reg[c->reg2] & ~(Overflow);
- }
- }
- void PACK32_CO(struct lilith* vm, struct Instruction* c)
- {
- /* Unset Overflow bit if set */
- vm->reg[c->reg0] = vm->reg[c->reg1];
- vm->reg[c->reg2] = vm->reg[c->reg2] & ~(Overflow);
- }
- void PACK32U_CO(struct lilith* vm, struct Instruction* c)
- {
- /* Unset Overflow bit if set */
- vm->reg[c->reg0] = vm->reg[c->reg1];
- vm->reg[c->reg2] = vm->reg[c->reg2] & ~(Overflow);
- }
- void AND(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] & vm->reg[c->reg2];
- }
- void OR(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] | vm->reg[c->reg2];
- }
- void XOR(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] ^ vm->reg[c->reg2];
- }
- void NAND(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ~(vm->reg[c->reg1] & vm->reg[c->reg2]);
- }
- void NOR(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ~(vm->reg[c->reg1] | vm->reg[c->reg2]);
- }
- void XNOR(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ~(vm->reg[c->reg1] ^ vm->reg[c->reg2]);
- }
- void MPQ(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ~(vm->reg[c->reg1]) & vm->reg[c->reg2];
- }
- void LPQ(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] & ~(vm->reg[c->reg2]);
- }
- void CPQ(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ~(vm->reg[c->reg1]) | vm->reg[c->reg2];
- }
- void BPQ(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] | ~(vm->reg[c->reg2]);
- }
- void SAL(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] << vm->reg[c->reg2];
- }
- void SAR(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] >> vm->reg[c->reg2];
- }
- void SL0(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = shift_register(vm->reg[c->reg1], vm->reg[c->reg2], true, true);
- }
- void SR0(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = shift_register(vm->reg[c->reg1], vm->reg[c->reg2], false, true);
- }
- void SL1(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = shift_register(vm->reg[c->reg1], vm->reg[c->reg2], true, false);
- }
- void SR1(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = shift_register(vm->reg[c->reg1], vm->reg[c->reg2], false, false);
- }
- void ROL(struct lilith* vm, struct Instruction* c)
- {
- uint32_t i, tmp;
- bool bit;
- tmp = vm->reg[c->reg1];
- for(i = vm->reg[c->reg2]; i > 0; i = i - 1)
- {
- bit = (tmp & 1);
- tmp = (tmp / 2) + (bit << 31);
- }
- vm->reg[c->reg0] = tmp;
- }
- void ROR(struct lilith* vm, struct Instruction* c)
- {
- uint32_t i, tmp;
- bool bit;
- tmp = vm->reg[c->reg1];
- for(i = vm->reg[c->reg2]; i > 0; i = i - 1)
- {
- bit = ((tmp >> 31) & 1);
- tmp = (tmp * 2) + bit;
- }
- vm->reg[c->reg0] = tmp;
- }
- void LOADX(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_Reg(vm, vm->reg[c->reg1] + vm->reg[c->reg2]);
- }
- void LOADX8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_byte(vm, vm->reg[c->reg1] + vm->reg[c->reg2], true);
- }
- void LOADXU8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_byte(vm, vm->reg[c->reg1] + vm->reg[c->reg2], false);
- }
- void LOADX16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_doublebyte(vm, vm->reg[c->reg1] + vm->reg[c->reg2], true);
- }
- void LOADXU16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_doublebyte(vm, vm->reg[c->reg1] + vm->reg[c->reg2], false);
- }
- void LOADX32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_Reg(vm, vm->reg[c->reg1] + vm->reg[c->reg2]);
- }
- void LOADXU32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_Reg(vm, vm->reg[c->reg1] + vm->reg[c->reg2]);
- }
- void STOREX(struct lilith* vm, struct Instruction* c)
- {
- writeout_Reg(vm, vm->reg[c->reg1] + vm->reg[c->reg2] , vm->reg[c->reg0]);
- }
- void STOREX8(struct lilith* vm, struct Instruction* c)
- {
- writeout_byte(vm, vm->reg[c->reg1] + vm->reg[c->reg2] , vm->reg[c->reg0]);
- }
- void STOREX16(struct lilith* vm, struct Instruction* c)
- {
- writeout_doublebyte(vm, vm->reg[c->reg1] + vm->reg[c->reg2] , vm->reg[c->reg0]);
- }
- void STOREX32(struct lilith* vm, struct Instruction* c)
- {
- writeout_Reg(vm, vm->reg[c->reg1] + vm->reg[c->reg2] , vm->reg[c->reg0]);
- }
- void NEG(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = (int32_t)(vm->reg[c->reg1]) * -1;
- }
- void ABS(struct lilith* vm, struct Instruction* c)
- {
- if(0 <= (int32_t)(vm->reg[c->reg1]))
- {
- vm->reg[c->reg0] = vm->reg[c->reg1];
- }
- else
- {
- vm->reg[c->reg0] = (int32_t)(vm->reg[c->reg1]) * -1;
- }
- }
- void NABS(struct lilith* vm, struct Instruction* c)
- {
- if(0 > (int32_t)(vm->reg[c->reg1]))
- {
- vm->reg[c->reg0] = vm->reg[c->reg1];
- }
- else
- {
- vm->reg[c->reg0] = (int32_t)(vm->reg[c->reg1]) * -1;
- }
- }
- void SWAP(struct lilith* vm, struct Instruction* c)
- {
- uint32_t utmp1;
- utmp1 = vm->reg[c->reg1];
- vm->reg[c->reg1] = vm->reg[c->reg0];
- vm->reg[c->reg0] = utmp1;
- }
- void COPY(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1];
- }
- void MOVE(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1];
- vm->reg[c->reg1] = 0;
- }
- void BRANCH(struct lilith* vm, struct Instruction* c)
- {
- /* Write out the PC */
- writeout_Reg(vm, vm->reg[c->reg1], vm->ip);
- /* Update PC */
- vm->ip = vm->reg[c->reg0];
- }
- void CALL(struct lilith* vm, struct Instruction* c)
- {
- /* Write out the PC */
- writeout_Reg(vm, vm->reg[c->reg1], vm->ip);
- /* Update our index */
- vm->reg[c->reg1] = vm->reg[c->reg1] + 4;
- /* Update PC */
- vm->ip = vm->reg[c->reg0];
- }
- void READPC(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->ip;
- }
- void READSCID(struct lilith* vm, struct Instruction* c)
- {
- /* We only support Base 8,16 and 32*/
- vm->reg[c->reg0] = 0x00000007;
- }
- void FALSE(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = 0;
- }
- void TRUE(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = 0xFFFFFFFF;
- }
- void JSR_COROUTINE(struct lilith* vm, struct Instruction* c)
- {
- vm->ip = vm->reg[c->reg0];
- }
- void RET(struct lilith* vm, struct Instruction* c)
- {
- /* Update our index */
- vm->reg[c->reg0] = vm->reg[c->reg0] - 4;
- /* Read in the new PC */
- vm->ip = readin_Reg(vm, vm->reg[c->reg0]);
- /* Clear Stack Values */
- writeout_Reg(vm, vm->reg[c->reg0], 0);
- }
- void PUSHPC(struct lilith* vm, struct Instruction* c)
- {
- /* Write out the PC */
- writeout_Reg(vm, vm->reg[c->reg0], vm->ip);
- /* Update our index */
- vm->reg[c->reg0] = vm->reg[c->reg0] + 4;
- }
- void POPPC(struct lilith* vm, struct Instruction* c)
- {
- /* Update our index */
- vm->reg[c->reg0] = vm->reg[c->reg0] - 4;
- /* Read in the new PC */
- vm->ip = readin_Reg(vm, vm->reg[c->reg0]);
- /* Clear memory where PC was */
- writeout_Reg(vm, vm->reg[c->reg0], 0);
- }
- void ADDI(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- vm->reg[c->reg0] = (int32_t)(tmp1 + c->raw_Immediate);
- }
- void ADDUI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] + c->raw_Immediate;
- }
- void SUBI(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1;
- tmp1 = (int32_t)(vm->reg[c->reg1]);
- vm->reg[c->reg0] = (int32_t)(tmp1 - c->raw_Immediate);
- }
- void SUBUI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] - c->raw_Immediate;
- }
- void CMPI(struct lilith* vm, struct Instruction* c)
- {
- uint32_t result = 0;
- if((int32_t)(vm->reg[c->reg1]) > c->raw_Immediate)
- {
- vm->reg[c->reg0] = result | GreaterThan;
- }
- else if((int32_t)(vm->reg[c->reg1]) == c->raw_Immediate)
- {
- vm->reg[c->reg0] = result | EQual;
- }
- else
- {
- vm->reg[c->reg0] = result | LessThan;
- }
- }
- void LOAD(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_Reg(vm, (vm->reg[c->reg1] + c->raw_Immediate));
- }
- void LOAD8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_byte(vm, vm->reg[c->reg1] + c->raw_Immediate, true);
- }
- void LOADU8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_byte(vm, vm->reg[c->reg1] + c->raw_Immediate, false);
- }
- void LOAD16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_doublebyte(vm, vm->reg[c->reg1] + c->raw_Immediate, true);
- }
- void LOADU16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_doublebyte(vm, vm->reg[c->reg1] + c->raw_Immediate, false);
- }
- void LOAD32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_Reg(vm, (vm->reg[c->reg1] + c->raw_Immediate));
- }
- void LOADU32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_Reg(vm, (vm->reg[c->reg1] + c->raw_Immediate));
- }
- void CMPUI(struct lilith* vm, struct Instruction* c)
- {
- uint32_t result = 0;
- if(vm->reg[c->reg1] > (uint32_t)c->raw_Immediate)
- {
- vm->reg[c->reg0] = result | GreaterThan;
- }
- else if(vm->reg[c->reg1] == (uint32_t)c->raw_Immediate)
- {
- vm->reg[c->reg0] = result | EQual;
- }
- else
- {
- vm->reg[c->reg0] = result | LessThan;
- }
- }
- void STORE(struct lilith* vm, struct Instruction* c)
- {
- writeout_Reg(vm, (vm->reg[c->reg1] + c->raw_Immediate), vm->reg[c->reg0]);
- }
- void STORE8(struct lilith* vm, struct Instruction* c)
- {
- writeout_byte(vm, (vm->reg[c->reg1] + c->raw_Immediate), vm->reg[c->reg0]);
- }
- void STORE16(struct lilith* vm, struct Instruction* c)
- {
- writeout_doublebyte(vm, (vm->reg[c->reg1] + c->raw_Immediate), vm->reg[c->reg0]);
- }
- void STORE32(struct lilith* vm, struct Instruction* c)
- {
- writeout_Reg(vm, (vm->reg[c->reg1] + c->raw_Immediate), vm->reg[c->reg0]);
- }
- void JUMP_C(struct lilith* vm, struct Instruction* c)
- {
- if(Carry_bit_set(vm->reg[c->reg0]))
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_B(struct lilith* vm, struct Instruction* c)
- {
- if(Borrow_bit_set(vm->reg[c->reg0]))
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_O(struct lilith* vm, struct Instruction* c)
- {
- if(Overflow_bit_set(vm->reg[c->reg0]))
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_G(struct lilith* vm, struct Instruction* c)
- {
- if(GreaterThan_bit_set(vm->reg[c->reg0]))
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_GE(struct lilith* vm, struct Instruction* c)
- {
- if(GreaterThan_bit_set(vm->reg[c->reg0]) || EQual_bit_set(vm->reg[c->reg0]))
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_E(struct lilith* vm, struct Instruction* c)
- {
- if(EQual_bit_set(vm->reg[c->reg0]))
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_NE(struct lilith* vm, struct Instruction* c)
- {
- if(!EQual_bit_set(vm->reg[c->reg0]))
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_LE(struct lilith* vm, struct Instruction* c)
- {
- if(LessThan_bit_set(vm->reg[c->reg0]) || EQual_bit_set(vm->reg[c->reg0]))
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_L(struct lilith* vm, struct Instruction* c)
- {
- if(LessThan_bit_set(vm->reg[c->reg0]))
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_Z(struct lilith* vm, struct Instruction* c)
- {
- if(0 == vm->reg[c->reg0])
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_NZ(struct lilith* vm, struct Instruction* c)
- {
- if(0 != vm->reg[c->reg0])
- {
- /* Adust the IP relative the the start of this instruction*/
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CALLI(struct lilith* vm, struct Instruction* c)
- {
- /* Write out the PC */
- writeout_Reg(vm, vm->reg[c->reg0], vm->ip);
- /* Update our index */
- vm->reg[c->reg0] = vm->reg[c->reg0] + 4;
- /* Update PC */
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- void LOADI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = (int16_t)c->raw_Immediate;
- }
- void LOADUI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = c->raw_Immediate;
- }
- void SALI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg0] << c->raw_Immediate;
- }
- void SARI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg0] >> c->raw_Immediate;
- }
- void SL0I(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = shift_register(vm->reg[c->reg0], c->raw_Immediate, true, true);
- }
- void SR0I(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = shift_register(vm->reg[c->reg0], c->raw_Immediate, false, true);
- }
- void SL1I(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = shift_register(vm->reg[c->reg0], c->raw_Immediate, true, false);
- }
- void SR1I(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = shift_register(vm->reg[c->reg0], c->raw_Immediate, false, false);
- }
- void LOADR(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_Reg(vm, (vm->ip + c->raw_Immediate -4));
- }
- void LOADR8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_byte(vm, (vm->ip + c->raw_Immediate -4), true);
- }
- void LOADRU8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_byte(vm, (vm->ip + c->raw_Immediate -4), false);
- }
- void LOADR16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_doublebyte(vm, (vm->ip + c->raw_Immediate -4), true);
- }
- void LOADRU16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_doublebyte(vm, (vm->ip + c->raw_Immediate -4), false);
- }
- void LOADR32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_Reg(vm, (vm->ip + c->raw_Immediate -4));
- }
- void LOADRU32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_Reg(vm, (vm->ip + c->raw_Immediate -4));
- }
- void STORER(struct lilith* vm, struct Instruction* c)
- {
- writeout_Reg(vm, (vm->ip + c->raw_Immediate - 4), vm->reg[c->reg0]);
- }
- void STORER8(struct lilith* vm, struct Instruction* c)
- {
- writeout_byte(vm, (vm->ip + c->raw_Immediate - 4), vm->reg[c->reg0]);
- }
- void STORER16(struct lilith* vm, struct Instruction* c)
- {
- writeout_doublebyte(vm, (vm->ip + c->raw_Immediate - 4), vm->reg[c->reg0]);
- }
- void STORER32(struct lilith* vm, struct Instruction* c)
- {
- writeout_Reg(vm, (vm->ip + c->raw_Immediate - 4), vm->reg[c->reg0]);
- }
- void JUMP(struct lilith* vm, struct Instruction* c)
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- void JUMP_P(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- if(0 <= tmp1)
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void JUMP_NP(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- if(0 > tmp1)
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPI_G(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 > tmp2)
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPI_GE(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 >= tmp2)
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPI_E(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) == (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPI_NE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) != (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPI_LE(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 <= tmp2)
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPI_L(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 < tmp2)
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPUI_G(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) > (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPUI_GE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) >= (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPUI_LE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) <= (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPJUMPUI_L(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) < (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + c->raw_Immediate - 4;
- }
- }
- void CMPSKIPI_G(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(c->raw_Immediate);
- if(tmp1 > tmp2)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPI_GE(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(c->raw_Immediate);
- if(tmp1 >= tmp2)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPI_E(struct lilith* vm, struct Instruction* c)
- {
- uint16_t utmp1;
- utmp1 = (uint16_t)(c->raw_Immediate);
- if((vm->reg[c->reg0]) == utmp1)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPI_NE(struct lilith* vm, struct Instruction* c)
- {
- uint16_t utmp1;
- utmp1 = (uint16_t)(c->raw_Immediate);
- if((vm->reg[c->reg0]) != utmp1)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPI_LE(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(c->raw_Immediate);
- if(tmp1 <= tmp2)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPI_L(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(c->raw_Immediate);
- if(tmp1 < tmp2)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPUI_G(struct lilith* vm, struct Instruction* c)
- {
- uint16_t utmp1;
- utmp1 = (uint16_t)(c->raw_Immediate);
- if((vm->reg[c->reg0]) > utmp1)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPUI_GE(struct lilith* vm, struct Instruction* c)
- {
- uint16_t utmp1;
- utmp1 = (uint16_t)(c->raw_Immediate);
- if((vm->reg[c->reg0]) >= utmp1)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPUI_LE(struct lilith* vm, struct Instruction* c)
- {
- uint16_t utmp1;
- utmp1 = (uint16_t)(c->raw_Immediate);
- if((vm->reg[c->reg0]) <= utmp1)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPUI_L(struct lilith* vm, struct Instruction* c)
- {
- uint16_t utmp1;
- utmp1 = (uint16_t)(c->raw_Immediate);
- if((vm->reg[c->reg0]) < utmp1)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void PUSHR(struct lilith* vm, struct Instruction* c)
- {
- writeout_Reg(vm, vm->reg[c->reg1], vm->reg[c->reg0]);
- vm->reg[c->reg1] = vm->reg[c->reg1] + 4;
- }
- void PUSH8(struct lilith* vm, struct Instruction* c)
- {
- writeout_byte(vm, vm->reg[c->reg1] , vm->reg[c->reg0]);
- vm->reg[c->reg1] = vm->reg[c->reg1] + 1;
- }
- void PUSH16(struct lilith* vm, struct Instruction* c)
- {
- writeout_doublebyte(vm, vm->reg[c->reg1] , vm->reg[c->reg0]);
- vm->reg[c->reg1] = vm->reg[c->reg1] + 2;
- }
- void PUSH32(struct lilith* vm, struct Instruction* c)
- {
- writeout_Reg(vm, vm->reg[c->reg1] , vm->reg[c->reg0]);
- vm->reg[c->reg1] = vm->reg[c->reg1] + 4;
- }
- void POPR(struct lilith* vm, struct Instruction* c)
- {
- uint32_t tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - 4;
- tmp = readin_Reg(vm, vm->reg[c->reg1]);
- writeout_Reg(vm, vm->reg[c->reg1], 0);
- vm->reg[c->reg0] = tmp;
- }
- void POP8(struct lilith* vm, struct Instruction* c)
- {
- int8_t tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - 1;
- tmp = readin_byte(vm, vm->reg[c->reg1], true);
- writeout_byte(vm, vm->reg[c->reg1], 0);
- vm->reg[c->reg0] = tmp;
- }
- void POPU8(struct lilith* vm, struct Instruction* c)
- {
- uint8_t tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - 1;
- tmp = readin_byte(vm, vm->reg[c->reg1], false);
- writeout_byte(vm, vm->reg[c->reg1], 0);
- vm->reg[c->reg0] = tmp;
- }
- void POP16(struct lilith* vm, struct Instruction* c)
- {
- int16_t tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - 2;
- tmp = readin_doublebyte(vm, vm->reg[c->reg1], true);
- writeout_doublebyte(vm, vm->reg[c->reg1], 0);
- vm->reg[c->reg0] = tmp;
- }
- void POPU16(struct lilith* vm, struct Instruction* c)
- {
- uint16_t tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - 2;
- tmp = readin_doublebyte(vm, vm->reg[c->reg1], false);
- writeout_doublebyte(vm, vm->reg[c->reg1], 0);
- vm->reg[c->reg0] = tmp;
- }
- void POP32(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - 4;
- tmp = readin_Reg(vm, vm->reg[c->reg1]);
- writeout_Reg(vm, vm->reg[c->reg1], 0);
- vm->reg[c->reg0] = tmp;
- }
- void POPU32(struct lilith* vm, struct Instruction* c)
- {
- uint32_t tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - 4;
- tmp = readin_Reg(vm, vm->reg[c->reg1]);
- writeout_Reg(vm, vm->reg[c->reg1], 0);
- vm->reg[c->reg0] = tmp;
- }
- void ANDI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] & c->raw_Immediate;
- }
- void ORI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] | c->raw_Immediate;
- }
- void XORI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = vm->reg[c->reg1] ^ c->raw_Immediate;
- }
- void NANDI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ~(vm->reg[c->reg1] & c->raw_Immediate);
- }
- void NORI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ~(vm->reg[c->reg1] | c->raw_Immediate);
- }
- void XNORI(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ~(vm->reg[c->reg1] ^ c->raw_Immediate);
- }
- void NOT(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = ~(vm->reg[c->reg1]);
- }
- void CMPSKIP_G(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 > tmp2)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIP_GE(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 >= tmp2)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIP_E(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) == (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIP_NE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) != (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIP_LE(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 <= tmp2)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIP_L(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 < tmp2)
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPU_G(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) > (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPU_GE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) >= (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPU_LE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) <= (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPSKIPU_L(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) < (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + 4;
- }
- }
- void CMPJUMP_G(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 > tmp2)
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMP_GE(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 >= tmp2)
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMP_E(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) == (vm->reg[c->reg1]))
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMP_NE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) != (vm->reg[c->reg1]))
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMP_LE(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 <= tmp2)
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMP_L(struct lilith* vm, struct Instruction* c)
- {
- int32_t tmp1, tmp2;
- tmp1 = (int32_t)(vm->reg[c->reg0]);
- tmp2 = (int32_t)(vm->reg[c->reg1]);
- if(tmp1 < tmp2)
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMPU_G(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) > (vm->reg[c->reg1]))
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMPU_GE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) >= (vm->reg[c->reg1]))
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMPU_LE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) <= (vm->reg[c->reg1]))
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMPU_L(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) < (vm->reg[c->reg1]))
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
|