1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044 |
- /* Copyright (C) 2016 Jeremiah Orians
- * This file is part of stage0.
- *
- * stage0 is free software: you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation, either version 3 of the License, or
- * (at your option) any later version.
- *
- * stage0 is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with stage0. If not, see <http://www.gnu.org/licenses/>.
- */
- #include "vm.h"
- #include <sys/stat.h>
- FILE* tape_01;
- FILE* tape_02;
- #ifdef tty_lib
- char tty_getchar();
- #endif
- /* Use first byte of next instruction to identify size */
- int next_instruction_size(struct lilith* vm)
- {
- uint8_t c = (uint8_t)vm->memory[vm->ip];
- switch(c)
- {
- case 0xE0: return 6;
- case 0xE1: return 6;
- default: return 4;
- }
- }
- /* Correctly write out bytes on little endian hardware */
- void writeout_bytes(struct lilith* vm, unsigned_vm_register pointer, unsigned_vm_register value, int count)
- {
- uint8_t raw0;
- outside_of_world(vm, pointer, "Writeout bytes Address_1 is outside of World");
- outside_of_world(vm, pointer+count, "Writeout bytes Address_2 is outside of World");
- while(0 < count)
- {
- raw0 = (value >> (8 * (count - 1))) & 0xff;
- vm->memory[pointer] = raw0;
- pointer = pointer + 1;
- count = count - 1;
- }
- }
- /* Allow the use of native data format for Register operations */
- unsigned_vm_register readin_bytes(struct lilith* vm, unsigned_vm_register pointer, bool Signed, int count)
- {
- outside_of_world(vm, pointer, "READIN bytes Address_1 is outside of World");
- outside_of_world(vm, pointer+count, "READIN bytes Address_2 is outside of World");
- uint8_t raw0;
- if(Signed)
- {
- signed_vm_register sum = (int8_t) vm->memory[pointer];
- while(1 < count)
- {
- pointer = pointer + 1;
- count = count - 1;
- raw0 = vm->memory[pointer];
- sum = (sum << 8) + raw0;
- }
- return sum;
- }
- unsigned_vm_register sum = 0;
- while(0 < count)
- {
- raw0 = vm->memory[pointer];
- sum = (sum << 8) + raw0;
- pointer = pointer + 1;
- count = count - 1;
- }
- return sum;
- }
- /* Determine the result of bit shifting */
- unsigned_vm_register shift_register(unsigned_vm_register source, unsigned_vm_register amount, bool left, bool zero)
- {
- unsigned_vm_register 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 << imax);
- }
- }
- }
- return tmp;
- }
- void vm_FOPEN_READ(struct lilith* vm)
- {
- struct stat sb;
- if(0x00001100 == vm->reg[0])
- {
- if(-1 == stat(tape_01_name, &sb))
- {
- fprintf(stderr, "File named %s does not exist\n", tape_01_name);
- exit(EXIT_FAILURE);
- }
- tape_01 = fopen(tape_01_name, "r");
- }
- if (0x00001101 == vm->reg[0])
- {
- if(-1 == stat(tape_02_name, &sb))
- {
- fprintf(stderr, "File named %s does not exist\n", tape_02_name);
- exit(EXIT_FAILURE);
- }
- tape_02 = fopen(tape_02_name, "r");
- }
- }
- void vm_FOPEN_WRITE(struct lilith* vm)
- {
- if(0x00001100 == vm->reg[0])
- {
- tape_01 = fopen(tape_01_name, "w");
- }
- if (0x00001101 == vm->reg[0])
- {
- tape_02 = fopen(tape_02_name, "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)
- {
- signed_vm_register 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)
- {
- signed_vm_register 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);
- }
- }
- void vm_HAL_MEM(struct lilith* vm)
- {
- vm->reg[0] = vm->amount_of_Ram;
- }
- /* 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(unsigned_vm_register a)
- {
- return a & Carry;
- }
- bool Borrow_bit_set(unsigned_vm_register a)
- {
- return a & Borrow;
- }
- bool Overflow_bit_set(unsigned_vm_register a)
- {
- return a & Overflow;
- }
- bool GreaterThan_bit_set(unsigned_vm_register a)
- {
- return a & GreaterThan;
- }
- bool EQual_bit_set(unsigned_vm_register a)
- {
- return a & EQual;
- }
- bool LessThan_bit_set(unsigned_vm_register a)
- {
- return a & LessThan;
- }
- void ADD_CI(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(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)
- {
- signed_vm_register tmp1, tmp2;
- signed_wide_register btmp1;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg2]);
- btmp1 = ((signed_wide_register)tmp1) + ((signed_wide_register)tmp2);
- /* If addition exceeds int32_t MAX, set carry bit */
- if(1 == ( btmp1 >> imax ))
- {
- 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)
- {
- signed_vm_register tmp1, tmp2;
- signed_wide_register btmp1;
- bool C = Carry_bit_set(vm->reg[c->reg3]);
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg2]);
- btmp1 = ((signed_wide_register)tmp1) + ((signed_wide_register)tmp2);
- /* If addition exceeds int32_t MAX, set carry bit */
- if(1 == ( btmp1 >> imax ))
- {
- 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)
- {
- unsigned_vm_register 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)
- {
- unsigned_vm_register utmp1, utmp2;
- unsigned_wide_register ubtmp1;
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- ubtmp1 = ((unsigned_wide_register)utmp1) + ((unsigned_wide_register)utmp2);
- /* If addition exceeds uint32_t MAX, set carry bit */
- if(0 != ( ubtmp1 >> umax ))
- {
- 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)
- {
- unsigned_vm_register utmp1, utmp2;
- unsigned_wide_register ubtmp1;
- bool C;
- C = Carry_bit_set(vm->reg[c->reg3]);
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- ubtmp1 = ((unsigned_wide_register)utmp1) + ((unsigned_wide_register)utmp2);
- /* If addition exceeds uint32_t MAX, set carry bit */
- if(0 != ( ubtmp1 >> umax ))
- {
- 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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(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)
- {
- signed_vm_register tmp1, tmp2;
- signed_wide_register btmp1;
- btmp1 = (signed_wide_register)(vm->reg[c->reg1]);
- tmp1 = (signed_vm_register)(vm->reg[c->reg2]);
- tmp2 = (signed_vm_register)(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)
- {
- signed_vm_register tmp1, tmp2;
- signed_wide_register btmp1;
- bool B;
- B = Borrow_bit_set(vm->reg[c->reg3]);
- btmp1 = (signed_wide_register)(vm->reg[c->reg1]);
- tmp1 = (signed_vm_register)(vm->reg[c->reg2]);
- tmp2 = (signed_vm_register)(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)
- {
- unsigned_vm_register 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)
- {
- unsigned_vm_register utmp1, utmp2;
- unsigned_wide_register ubtmp1;
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- ubtmp1 = (unsigned_wide_register)(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)
- {
- unsigned_vm_register utmp1, utmp2;
- unsigned_wide_register ubtmp1;
- bool B;
- B = Borrow_bit_set(vm->reg[c->reg3]);
- utmp1 = vm->reg[c->reg1];
- utmp2 = vm->reg[c->reg2];
- ubtmp1 = (unsigned_wide_register)(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)
- {
- signed_vm_register tmp1, tmp2;
- signed_wide_register btmp1;
- tmp1 = (signed_vm_register)(vm->reg[c->reg2]);
- tmp2 = (signed_vm_register)( vm->reg[c->reg3]);
- btmp1 = ((signed_wide_register)tmp1) * ((signed_wide_register)tmp2);
- vm->reg[c->reg0] = (signed_vm_register)(btmp1 % 0x100000000);
- vm->reg[c->reg1] = (signed_vm_register)(btmp1 / 0x100000000);
- }
- void MULTIPLYU(struct lilith* vm, struct Instruction* c)
- {
- unsigned_wide_register ubtmp1;
- ubtmp1 = (unsigned_wide_register)(vm->reg[c->reg2]) * (unsigned_wide_register)(vm->reg[c->reg3]);
- vm->reg[c->reg0] = ubtmp1 % 0x100000000;
- vm->reg[c->reg1] = ubtmp1 / 0x100000000;
- }
- void DIVIDE(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg2]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg3]);
- vm->reg[c->reg0] = tmp1 / tmp2;
- vm->reg[c->reg1] = tmp1 % tmp2;
- }
- void DIVIDEU(struct lilith* vm, struct Instruction* c)
- {
- unsigned_vm_register 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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg2]);
- tmp2 = (signed_vm_register)(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)
- {
- unsigned_vm_register 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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg2]);
- vm->reg[c->reg0] = (signed_vm_register)(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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg2]);
- vm->reg[c->reg0] = (signed_vm_register)(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)
- {
- signed_vm_register tmp1, tmp2;
- unsigned_vm_register result = 0;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(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)
- {
- unsigned_vm_register 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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg2]);
- signed_wide_register sum = tmp1 * tmp2;
- /* We only want the bottom 32bits */
- vm->reg[c->reg0] = sum % 0x100000000;
- }
- void MULH(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg2]);
- signed_wide_register sum = tmp1 * tmp2;
- /* We only want the top 32bits */
- vm->reg[c->reg0] = sum / 0x100000000;
- }
- void MULU(struct lilith* vm, struct Instruction* c)
- {
- unsigned_wide_register 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)
- {
- unsigned_wide_register 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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg2]);
- vm->reg[c->reg0] = tmp1 / tmp2;
- }
- void MOD(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- tmp2 = (signed_vm_register)(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 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)
- {
- unsigned_vm_register 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 << imax);
- }
- vm->reg[c->reg0] = tmp;
- }
- void ROR(struct lilith* vm, struct Instruction* c)
- {
- unsigned_vm_register i, tmp;
- bool bit;
- tmp = vm->reg[c->reg1];
- for(i = vm->reg[c->reg2]; i > 0; i = i - 1)
- {
- bit = ((tmp >> imax) & 1);
- tmp = (tmp * 2) + bit;
- }
- vm->reg[c->reg0] = tmp;
- }
- void LOADX(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2], true, reg_size);
- }
- void LOADX8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2], true, 1);
- }
- void LOADXU8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2], false, 1);
- }
- void LOADX16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2], true, 2);
- }
- void LOADXU16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2], false, 2);
- }
- void LOADX32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2], true, 4);
- }
- void LOADXU32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2], true, 4);
- }
- void STOREX(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2] , vm->reg[c->reg0], reg_size);
- }
- void STOREX8(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2] , vm->reg[c->reg0], 1);
- }
- void STOREX16(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2] , vm->reg[c->reg0], 2);
- }
- void STOREX32(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, vm->reg[c->reg1] + vm->reg[c->reg2] , vm->reg[c->reg0], 4);
- }
- void NEG(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = (signed_vm_register)(vm->reg[c->reg1]) * -1;
- }
- void ABS(struct lilith* vm, struct Instruction* c)
- {
- if(0 <= (signed_vm_register)(vm->reg[c->reg1]))
- {
- vm->reg[c->reg0] = vm->reg[c->reg1];
- }
- else
- {
- vm->reg[c->reg0] = (signed_vm_register)(vm->reg[c->reg1]) * -1;
- }
- }
- void NABS(struct lilith* vm, struct Instruction* c)
- {
- if(0 > (signed_vm_register)(vm->reg[c->reg1]))
- {
- vm->reg[c->reg0] = vm->reg[c->reg1];
- }
- else
- {
- vm->reg[c->reg0] = (signed_vm_register)(vm->reg[c->reg1]) * -1;
- }
- }
- void SWAP(struct lilith* vm, struct Instruction* c)
- {
- unsigned_vm_register 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_bytes(vm, vm->reg[c->reg1], vm->ip, reg_size);
- /* Update PC */
- vm->ip = vm->reg[c->reg0];
- }
- void CALL(struct lilith* vm, struct Instruction* c)
- {
- /* Write out the PC */
- writeout_bytes(vm, vm->reg[c->reg1], vm->ip, reg_size);
- /* Update our index */
- vm->reg[c->reg1] = vm->reg[c->reg1] + reg_size;
- /* 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)
- {
- #ifdef VM256
- /* We only support Base 8, 16, 32, 64, 128 and 256 */
- vm->reg[c->reg0] = 0x00000005;
- #elif VM128
- /* We only support Base 8, 16, 32, 64 and 128 */
- vm->reg[c->reg0] = 0x00000004;
- #elif VM64
- /* We only support Base 8, 16, 32 and 64 */
- vm->reg[c->reg0] = 0x00000003;
- #elif VM32
- /* We only support Base 8, 16 and 32 */
- vm->reg[c->reg0] = 0x00000002;
- #else
- /* We only support Base 8 and 16 */
- vm->reg[c->reg0] = 0x00000001;
- #endif
- }
- void FALSE(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = 0;
- }
- void TRUE(struct lilith* vm, struct Instruction* c)
- {
- #ifdef VM256
- vm->reg[c->reg0] = 0xFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFF;
- #elif VM128
- vm->reg[c->reg0] = 0xFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFF;
- #elif VM64
- vm->reg[c->reg0] = 0xFFFFFFFFFFFFFFFF;
- #elif VM32
- vm->reg[c->reg0] = 0xFFFFFFFF;
- #else
- vm->reg[c->reg0] = 0xFFFF;
- #endif
- }
- 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] - reg_size;
- /* Read in the new PC */
- vm->ip = readin_bytes(vm, vm->reg[c->reg0], false, reg_size);
- /* Clear Stack Values */
- writeout_bytes(vm, vm->reg[c->reg0], 0, reg_size);
- }
- void PUSHPC(struct lilith* vm, struct Instruction* c)
- {
- /* Write out the PC */
- writeout_bytes(vm, vm->reg[c->reg0], vm->ip, reg_size);
- /* Update our index */
- vm->reg[c->reg0] = vm->reg[c->reg0] + reg_size;
- }
- void POPPC(struct lilith* vm, struct Instruction* c)
- {
- /* Update our index */
- vm->reg[c->reg0] = vm->reg[c->reg0] - reg_size;
- /* Read in the new PC */
- vm->ip = readin_bytes(vm, vm->reg[c->reg0], false, reg_size);
- /* Clear memory where PC was */
- writeout_bytes(vm, vm->reg[c->reg0], 0, reg_size);
- }
- void ADDI(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- vm->reg[c->reg0] = (signed_vm_register)(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)
- {
- signed_vm_register tmp1;
- tmp1 = (signed_vm_register)(vm->reg[c->reg1]);
- vm->reg[c->reg0] = (signed_vm_register)(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)
- {
- unsigned_vm_register result = 0;
- if((signed_vm_register)(vm->reg[c->reg1]) > c->raw_Immediate)
- {
- vm->reg[c->reg0] = result | GreaterThan;
- }
- else if((signed_vm_register)(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_bytes(vm, (vm->reg[c->reg1] + c->raw_Immediate), false,reg_size);
- }
- void LOAD8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + c->raw_Immediate, true, 1);
- }
- void LOADU8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + c->raw_Immediate, false, 1);
- }
- void LOAD16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + c->raw_Immediate, true, 2);
- }
- void LOADU16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, vm->reg[c->reg1] + c->raw_Immediate, false, 2);
- }
- void LOAD32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, (vm->reg[c->reg1] + c->raw_Immediate), true, 4);
- }
- void LOADU32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, (vm->reg[c->reg1] + c->raw_Immediate), false, 4);
- }
- void CMPUI(struct lilith* vm, struct Instruction* c)
- {
- unsigned_vm_register result = 0;
- if(vm->reg[c->reg1] > (unsigned_vm_register)c->raw_Immediate)
- {
- vm->reg[c->reg0] = result | GreaterThan;
- }
- else if(vm->reg[c->reg1] == (unsigned_vm_register)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_bytes(vm, (vm->reg[c->reg1] + c->raw_Immediate), vm->reg[c->reg0], reg_size);
- }
- void STORE8(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, (vm->reg[c->reg1] + c->raw_Immediate), vm->reg[c->reg0], 1);
- }
- void STORE16(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, (vm->reg[c->reg1] + c->raw_Immediate), vm->reg[c->reg0], 2);
- }
- void STORE32(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, (vm->reg[c->reg1] + c->raw_Immediate), vm->reg[c->reg0], 4);
- }
- void JUMP_C(struct lilith* vm, struct Instruction* c)
- {
- if(Carry_bit_set(vm->reg[c->reg0]))
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_B(struct lilith* vm, struct Instruction* c)
- {
- if(Borrow_bit_set(vm->reg[c->reg0]))
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_O(struct lilith* vm, struct Instruction* c)
- {
- if(Overflow_bit_set(vm->reg[c->reg0]))
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_G(struct lilith* vm, struct Instruction* c)
- {
- if(GreaterThan_bit_set(vm->reg[c->reg0]))
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_GE(struct lilith* vm, struct Instruction* c)
- {
- if(GreaterThan_bit_set(vm->reg[c->reg0]) || EQual_bit_set(vm->reg[c->reg0]))
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_E(struct lilith* vm, struct Instruction* c)
- {
- if(EQual_bit_set(vm->reg[c->reg0]))
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_NE(struct lilith* vm, struct Instruction* c)
- {
- if(!EQual_bit_set(vm->reg[c->reg0]))
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_LE(struct lilith* vm, struct Instruction* c)
- {
- if(LessThan_bit_set(vm->reg[c->reg0]) || EQual_bit_set(vm->reg[c->reg0]))
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_L(struct lilith* vm, struct Instruction* c)
- {
- if(LessThan_bit_set(vm->reg[c->reg0]))
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_Z(struct lilith* vm, struct Instruction* c)
- {
- if(0 == vm->reg[c->reg0])
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_NZ(struct lilith* vm, struct Instruction* c)
- {
- if(0 != vm->reg[c->reg0])
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void CALLI(struct lilith* vm, struct Instruction* c)
- {
- /* Write out the PC */
- writeout_bytes(vm, vm->reg[c->reg0], vm->ip, reg_size);
- /* Update our index */
- vm->reg[c->reg0] = vm->reg[c->reg0] + reg_size;
- /* Update PC */
- vm->ip = vm->ip + c->raw_Immediate;
- }
- 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_bytes(vm, (vm->ip + c->raw_Immediate), false, reg_size);
- }
- void LOADR8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, (vm->ip + c->raw_Immediate), true, 1);
- }
- void LOADRU8(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, (vm->ip + c->raw_Immediate), false, 1);
- }
- void LOADR16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, (vm->ip + c->raw_Immediate), true, 2);
- }
- void LOADRU16(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, (vm->ip + c->raw_Immediate), false, 2);
- }
- void LOADR32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, (vm->ip + c->raw_Immediate), true, 4);
- }
- void LOADRU32(struct lilith* vm, struct Instruction* c)
- {
- vm->reg[c->reg0] = readin_bytes(vm, (vm->ip + c->raw_Immediate), false, 4);
- }
- void STORER(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, (vm->ip + c->raw_Immediate), vm->reg[c->reg0], reg_size);
- }
- void STORER8(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, (vm->ip + c->raw_Immediate), vm->reg[c->reg0], 1);
- }
- void STORER16(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, (vm->ip + c->raw_Immediate), vm->reg[c->reg0], 2);
- }
- void STORER32(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, (vm->ip + c->raw_Immediate), vm->reg[c->reg0], 4);
- }
- void JUMP(struct lilith* vm, struct Instruction* c)
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- void JUMP_P(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- if(0 <= tmp1)
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void JUMP_NP(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- if(0 > tmp1)
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void CMPJUMPI_G(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 > tmp2)
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void CMPJUMPI_GE(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 >= tmp2)
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- 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;
- }
- }
- 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;
- }
- }
- void CMPJUMPI_LE(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 <= tmp2)
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- void CMPJUMPI_L(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 < tmp2)
- {
- vm->ip = vm->ip + c->raw_Immediate;
- }
- }
- 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;
- }
- }
- 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;
- }
- }
- 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;
- }
- }
- 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;
- }
- }
- void CMPSKIPI_G(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(c->raw_Immediate);
- if(tmp1 > tmp2)
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIPI_GE(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(c->raw_Immediate);
- if(tmp1 >= tmp2)
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- 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 + next_instruction_size(vm);
- }
- }
- 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 + next_instruction_size(vm);
- }
- }
- void CMPSKIPI_LE(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(c->raw_Immediate);
- if(tmp1 <= tmp2)
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIPI_L(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(c->raw_Immediate);
- if(tmp1 < tmp2)
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- 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 + next_instruction_size(vm);
- }
- }
- 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 + next_instruction_size(vm);
- }
- }
- 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 + next_instruction_size(vm);
- }
- }
- 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 + next_instruction_size(vm);
- }
- }
- void PUSHR(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, vm->reg[c->reg1], vm->reg[c->reg0], reg_size);
- vm->reg[c->reg1] = vm->reg[c->reg1] + reg_size;
- }
- void PUSH8(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, vm->reg[c->reg1] , vm->reg[c->reg0], 1);
- vm->reg[c->reg1] = vm->reg[c->reg1] + 1;
- }
- void PUSH16(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, vm->reg[c->reg1] , vm->reg[c->reg0], 2);
- vm->reg[c->reg1] = vm->reg[c->reg1] + 2;
- }
- void PUSH32(struct lilith* vm, struct Instruction* c)
- {
- writeout_bytes(vm, vm->reg[c->reg1] , vm->reg[c->reg0], 4);
- vm->reg[c->reg1] = vm->reg[c->reg1] + 4;
- }
- void POPR(struct lilith* vm, struct Instruction* c)
- {
- unsigned_vm_register tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - reg_size;
- tmp = readin_bytes(vm, vm->reg[c->reg1], false, reg_size);
- writeout_bytes(vm, vm->reg[c->reg1], 0, reg_size);
- 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_bytes(vm, vm->reg[c->reg1], true, 1);
- writeout_bytes(vm, vm->reg[c->reg1], 0, 1);
- 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_bytes(vm, vm->reg[c->reg1], false, 1);
- writeout_bytes(vm, vm->reg[c->reg1], 0, 1);
- 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_bytes(vm, vm->reg[c->reg1], true, 2);
- writeout_bytes(vm, vm->reg[c->reg1], 0, 2);
- 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_bytes(vm, vm->reg[c->reg1], false, 2);
- writeout_bytes(vm, vm->reg[c->reg1], 0, 2);
- vm->reg[c->reg0] = tmp;
- }
- void POP32(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - 4;
- tmp = readin_bytes(vm, vm->reg[c->reg1], true, 4);
- writeout_bytes(vm, vm->reg[c->reg1], 0, 4);
- vm->reg[c->reg0] = tmp;
- }
- void POPU32(struct lilith* vm, struct Instruction* c)
- {
- unsigned_vm_register tmp;
- vm->reg[c->reg1] = vm->reg[c->reg1] - 4;
- tmp = readin_bytes(vm, vm->reg[c->reg1], false, 4);
- writeout_bytes(vm, vm->reg[c->reg1], 0, 4);
- 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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 > tmp2)
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIP_GE(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 >= tmp2)
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIP_E(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) == (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIP_NE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) != (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIP_LE(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 <= tmp2)
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIP_L(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 < tmp2)
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIPU_G(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) > (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIPU_GE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) >= (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIPU_LE(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) <= (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPSKIPU_L(struct lilith* vm, struct Instruction* c)
- {
- if((vm->reg[c->reg0]) < (vm->reg[c->reg1]))
- {
- vm->ip = vm->ip + next_instruction_size(vm);
- }
- }
- void CMPJUMP_G(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 > tmp2)
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMP_GE(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(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)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(vm->reg[c->reg1]);
- if(tmp1 <= tmp2)
- {
- vm->ip = vm->reg[c->reg2];
- }
- }
- void CMPJUMP_L(struct lilith* vm, struct Instruction* c)
- {
- signed_vm_register tmp1, tmp2;
- tmp1 = (signed_vm_register)(vm->reg[c->reg0]);
- tmp2 = (signed_vm_register)(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];
- }
- }
|