12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529 |
- #include "l.h"
- short opa[20];
- short *op;
- long
- entryvalue(void)
- {
- char *a;
- Sym *s;
- a = INITENTRY;
- if(*a >= '0' && *a <= '9')
- return atolwhex(a);
- s = lookup(a, 0);
- if(s->type == 0)
- return INITTEXT;
- if(s->type != STEXT)
- diag("entry not text: %s", s->name);
- return s->value;
- }
- void
- asmb(void)
- {
- Prog *p;
- long v;
- int a;
- short *op1;
- if(debug['v'])
- Bprint(&bso, "%5.2f asmb\n", cputime());
- Bflush(&bso);
- seek(cout, HEADR, 0);
- pc = INITTEXT;
- curp = firstp;
- for(p = firstp; p != P; p = p->link) {
- if(p->as == ATEXT)
- curtext = p;
- if(p->pc != pc) {
- if(!debug['a'])
- print("%P\n", curp);
- diag("phase error %.4lux sb %.4lux in %s", p->pc, pc, TNAME);
- pc = p->pc;
- }
- curp = p;
- if(debug['a'])
- Bprint(&bso, "%lux:%P\n", pc, curp);
- asmins(p);
- if(cbc < sizeof(opa))
- cflush();
- for(op1 = opa; op1 < op; op1++) {
- a = *op1;
- *cbp++ = a >> 8;
- *cbp++ = a;
- }
- a = 2*(op - opa);
- pc += a;
- cbc -= a;
- if(debug['a']) {
- for(op1 = opa; op1 < op; op1++)
- if(op1 == opa)
- Bprint(&bso, "\t\t%4ux", *op1 & 0xffff);
- else
- Bprint(&bso, " %4ux", *op1 & 0xffff);
- if(op != opa)
- Bprint(&bso, "\n");
- }
- }
- cflush();
- switch(HEADTYPE) {
- case 0: /* this is garbage */
- seek(cout, rnd(HEADR+textsize, 8192), 0);
- break;
- case 1: /* plan9 boot data goes into text */
- seek(cout, rnd(HEADR+textsize, INITRND), 0);
- break;
- case 2: /* plan 9 */
- seek(cout, HEADR+textsize, 0);
- break;
- case 3: /* next boot */
- seek(cout, HEADR+rnd(textsize, INITRND), 0);
- break;
- case 4: /* preprocess pilot */
- seek(cout, HEADR+textsize, 0);
- break;
- }
- if(debug['v'])
- Bprint(&bso, "%5.2f datblk\n", cputime());
- Bflush(&bso);
- for(v = 0; v < datsize; v += sizeof(buf)-100) {
- if(datsize-v > sizeof(buf)-100)
- datblk(v, sizeof(buf)-100);
- else
- datblk(v, datsize-v);
- }
- symsize = 0;
- spsize = 0;
- lcsize = 0;
- relocsize = 0;
- Bflush(&bso);
- switch(HEADTYPE) {
- default:
- seek(cout, rnd(HEADR+textsize, 8192)+datsize, 0);
- break;
- case 1: /* plan9 boot data goes into text */
- seek(cout, rnd(HEADR+textsize, INITRND)+datsize, 0);
- break;
- case 2: /* plan 9 */
- seek(cout, HEADR+textsize+datsize, 0);
- break;
- case 3: /* next boot */
- seek(cout, HEADR+rnd(textsize, INITRND)+datsize, 0);
- break;
- case 4: /* preprocess pilot */
- seek(cout, HEADR+textsize+datsize, 0);
- break;
- }
- if(!debug['s']) {
- if(debug['v'])
- Bprint(&bso, "%5.2f sym\n", cputime());
- asmsym();
- }
- Bflush(&bso);
- if(!debug['s']) {
- if(debug['v'])
- Bprint(&bso, "%5.2f sp\n", cputime());
- asmsp();
- }
- Bflush(&bso);
- if(!debug['s']) {
- if(debug['v'])
- Bprint(&bso, "%5.2f pc\n", cputime());
- asmlc();
- }
- Bflush(&bso);
- if(!debug['s']) {
- if(debug['v'])
- Bprint(&bso, "%5.2f reloc\n", cputime());
- asmreloc();
- }
- cflush();
- if(debug['v'])
- Bprint(&bso, "%5.2f headr\n", cputime());
- Bflush(&bso);
- seek(cout, 0L, 0);
- switch(HEADTYPE) {
- default:
- lput(0x160L<<16); /* magic and sections */
- lput(0L); /* time and date */
- lput(rnd(HEADR+textsize, 4096)+datsize);
- lput(symsize); /* nsyms */
- lput((0x38L<<16)|7L); /* size of optional hdr and flags */
- lput((0413<<16)|0437L); /* magic and version */
- lput(rnd(HEADR+textsize, 4096)); /* sizes */
- lput(datsize);
- lput(bsssize);
- lput(entryvalue()); /* va of entry */
- lput(INITTEXT-HEADR); /* va of base of text */
- lput(INITDAT); /* va of base of data */
- lput(INITDAT+datsize); /* va of base of bss */
- lput(~0L); /* gp reg mask */
- lput(0L);
- lput(0L);
- lput(0L);
- lput(0L);
- lput(~0L); /* gp value ?? */
- break;
- case 1: /* plan9 boot data goes into text */
- lput(0407); /* magic */
- lput(rnd(HEADR+textsize, INITRND)-HEADR+datsize); /* sizes */
- lput(0);
- lput(bsssize);
- lput(symsize); /* nsyms */
- lput(entryvalue()); /* va of entry */
- lput(spsize); /* sp offsets */
- lput(lcsize); /* line offsets */
- break;
- case 2: /* plan 9 */
- lput(0407); /* magic */
- lput(textsize); /* sizes */
- lput(datsize);
- lput(bsssize);
- lput(symsize); /* nsyms */
- lput(entryvalue()); /* va of entry */
- lput(spsize); /* sp offsets */
- lput(lcsize); /* line offsets */
- break;
- case 3: /* next boot */
- /* header */
- lput(0xfeedfaceL); /* magic */
- lput(6); /* 68040 */
- lput(1); /* more 68040 */
- lput(5); /* file type 'boot' */
- lput(HEADTYPE); /* number commands */
- lput(HEADR-7*4); /* sizeof commands */
- lput(1); /* no undefineds */
- /* command 1 text */
- lput(1); /* command = 'segment' */
- lput(124); /* command size */
- s16put("__TEXT");
- /* botch?? entryvalue() */
- lput(INITTEXT); /* va of start */
- lput(rnd(textsize, 8192)); /* va size */
- lput(HEADR); /* file offset */
- lput(rnd(textsize, 8192)); /* file size */
- lput(7); /* max prot */
- lput(7); /* init prot */
- lput(1); /* number of sections */
- lput(0); /* flags */
- /* text section */
- s16put("__text");
- s16put("__TEXT");
- /* botch?? entryvalue() */
- lput(INITTEXT); /* va of start */
- lput(textsize); /* va size */
- lput(HEADR); /* file offset */
- lput(2); /* align */
- lput(0); /* reloff */
- lput(0); /* nreloc */
- lput(0); /* flags */
- lput(0); /* reserved1 */
- lput(0); /* reserved2 */
- /* command 1 data */
- lput(1); /* command = 'segment' */
- lput(192); /* command size */
- s16put("__DATA");
- lput(INITDAT); /* va of start */
- lput(rnd(datsize, 8192)); /* va size */
- lput(HEADR+rnd(textsize, 8192)); /* file offset */
- lput(rnd(datsize, 8192)); /* file size */
- lput(7); /* max prot */
- lput(7); /* init prot */
- lput(2); /* number of sections */
- lput(0); /* flags */
- /* data section */
- s16put("__data");
- s16put("__DATA");
- lput(INITDAT); /* va of start */
- lput(datsize); /* va size */
- lput(HEADR+rnd(textsize, 8192)); /* file offset */
- lput(2); /* align */
- lput(0); /* reloff */
- lput(0); /* nreloc */
- lput(0); /* flags */
- lput(0); /* reserved1 */
- lput(0); /* reserved2 */
- /* bss section */
- s16put("__bss");
- s16put("__DATA");
- lput(INITDAT+datsize); /* va of start */
- lput(bsssize); /* va size */
- lput(0); /* file offset */
- lput(2); /* align */
- lput(0); /* reloff */
- lput(0); /* nreloc */
- lput(1); /* flags = zero fill */
- lput(0); /* reserved1 */
- lput(0); /* reserved2 */
- /* command 2 symbol */
- lput(2); /* command = 'symbol' */
- lput(24); /* command size */
- lput(HEADR+rnd(textsize, INITRND)
- +datsize); /* symoff */
- lput(symsize); /* nsyms */
- lput(spsize); /* sp offsets */
- lput(lcsize); /* line offsets */
- break;
- case 4: /* preprocess pilot */
- lput(0407); /* magic */
- lput(textsize); /* sizes */
- lput(datsize);
- lput(bsssize);
- lput(symsize); /* nsyms */
- lput(entryvalue()); /* va of entry */
- lput(spsize); /* sp offsets */
- lput(lcsize); /* line offsets */
- lput(relocsize); /* relocation */
- break;
- }
- cflush();
- }
- void
- asmins(Prog *p)
- {
- Optab *o;
- int t, a, b;
- long v;
- op = opa + 1;
- if(special[p->from.type])
- switch(p->from.type) {
- case D_CCR:
- if(p->as != AMOVW)
- goto bad;
- a = asmea(p, &p->to);
- if((a & 0170) == 010)
- goto bad;
- opa[0] = 0x42c0 | a; /* mov from ccr */
- return;
- case D_SR:
- if(p->as != AMOVW)
- goto bad;
- a = asmea(p, &p->to);
- if((a & 0170) == 010)
- goto bad;
- opa[0] = 0x40c0 | a; /* mov from sr */
- return;
- case D_USP:
- if(p->as != AMOVL)
- goto bad;
- a = asmea(p, &p->to);
- if((a & 0170) == 010) {
- opa[0] = 0x4e68|(a&7); /* mov usp An */
- return;
- }
- t = 0x800;
- goto movec1;
- case D_SFC:
- t = 0x000;
- goto movec1;
- case D_DFC:
- t = 0x001;
- goto movec1;
- case D_CACR:
- t = 0x002;
- goto movec1;
- case D_TC:
- t = 0x003;
- goto movec1;
- case D_ITT0:
- t = 0x004;
- goto movec1;
- case D_ITT1:
- t = 0x005;
- goto movec1;
- case D_DTT0:
- t = 0x006;
- goto movec1;
- case D_DTT1:
- t = 0x007;
- goto movec1;
- case D_VBR:
- t = 0x801;
- goto movec1;
- case D_CAAR:
- t = 0x802;
- goto movec1;
- case D_MSP:
- t = 0x803;
- goto movec1;
- case D_ISP:
- t = 0x804;
- goto movec1;
- case D_MMUSR:
- t = 0x805;
- goto movec1;
- case D_URP:
- t = 0x806;
- goto movec1;
- case D_SRP:
- t = 0x807;
- goto movec1;
- movec1:
- if(p->as != AMOVL)
- goto bad;
- opa[0] = 0x4e7a; /* mov spc Dn */
- a = asmea(p, &p->to);
- b = a & 0170;
- if(b == 0 || b == 010) {
- *op++ = (a<<12) | t;
- return;
- }
- goto bad;
- case D_FPCR:
- t = 0xb000;
- goto movec3;
- case D_FPSR:
- t = 0xa800;
- goto movec3;
- case D_FPIAR:
- t = 0xa400;
- movec3:
- if(p->as != AMOVL)
- goto bad;
- op++;
- a = asmea(p, &p->to);
- opa[0] = optab[AFMOVEL].opcode0 | a;
- opa[1] = t;
- return;
- }
- if(special[p->to.type])
- switch(p->to.type) {
- case D_CCR:
- if(p->as != AMOVW) /* botch, needs and, eor etc. */
- goto bad;
- a = asmea(p, &p->from);
- if((a & 0170) == 010)
- goto bad;
- opa[0] = 0x44c0 | a; /* mov to ccr */
- return;
- case D_SR:
- if(p->as != AMOVW) /* botch, needs and, eor etc. */
- goto bad;
- a = asmea(p, &p->from);
- if((a & 0170) == 010)
- goto bad;
- opa[0] = 0x46c0 | a; /* mov to sr */
- return;
- case D_USP:
- if(p->as != AMOVL)
- goto bad;
- a = asmea(p, &p->from);
- if((a & 0170) == 010) {
- opa[0] = 0x4e60|(a&7); /* mov An usp */
- return;
- }
- t = 0x800;
- goto movec2;
- case D_SFC:
- t = 0x000;
- goto movec2;
- case D_DFC:
- t = 0x001;
- goto movec2;
- case D_CACR:
- t = 0x002;
- goto movec2;
- case D_TC:
- t = 0x003;
- goto movec2;
- case D_ITT0:
- t = 0x004;
- goto movec2;
- case D_ITT1:
- t = 0x005;
- goto movec2;
- case D_DTT0:
- t = 0x006;
- goto movec2;
- case D_DTT1:
- t = 0x007;
- goto movec2;
- case D_VBR:
- t = 0x801;
- goto movec2;
- case D_CAAR:
- t = 0x802;
- goto movec2;
- case D_MSP:
- t = 0x803;
- goto movec2;
- case D_ISP:
- t = 0x804;
- goto movec2;
- case D_MMUSR:
- t = 0x805;
- goto movec2;
- case D_URP:
- t = 0x806;
- goto movec2;
- case D_SRP:
- t = 0x807;
- goto movec2;
- movec2:
- if(p->as != AMOVL)
- goto bad;
- opa[0] = 0x4e7b; /* mov Dn spc */
- a = asmea(p, &p->from);
- b = a & 0170;
- if(b == 0 || b == 010) {
- *op++ = (a<<12) | t;
- return;
- }
- goto bad;
- case D_FPCR:
- t = 0x9000;
- goto movec4;
- case D_FPSR:
- t = 0x8800;
- goto movec4;
- case D_FPIAR:
- t = 0x8400;
- movec4:
- if(p->as != AMOVL)
- goto bad;
- op++;
- a = asmea(p, &p->from);
- opa[0] = optab[AFMOVEL].opcode0 | a;
- opa[1] = t;
- return;
- }
- o = &optab[p->as];
- t = o->opcode0;
- switch(o->optype) {
- case 0: /* pseudo ops */
- if(p->as != ATEXT && p->as != ANOP) {
- if(!debug['a'])
- print("%P\n", p);
- diag("unimplemented instruction in %s", TNAME);
- return;
- }
- op = opa;
- return;
- case 1: /* branches */
- if(p->to.type != D_BRANCH)
- goto bad;
- a = asmea(p, &p->to);
- if(a == 071)
- t = o->opcode1;
- t |= a;
- break;
- case 2: /* move */
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((a & 0170) == 0110) { /* src quick */
- t = o->opcode1;
- if((b & 0170) != 0)
- goto bad;
- t |= a >> 7;
- t |= b << 9;
- break;
- }
- t |= a;
- t |= (b&7) << 9;
- t |= (b&070) << 3;
- break;
- case 3: /* add */
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((a & 0170) == 0110) { /* src quick */
- t = o->opcode1;
- t |= (a&01600) << 2;
- t |= b;
- break;
- }
- if((b & 0170) == 0) { /* dst Dn */
- t |= a;
- t |= (b & 7) << 9;
- break;
- }
- if((b & 0170) == 010) { /* dst An */
- if((t & 0xc0) == 0)
- goto bad;
- t = o->opcode2;
- t |= a;
- t |= (b & 7) << 9;
- break;
- }
- if((a & 0170) == 0) { /* src Dn */
- t |= 0x100;
- t |= (a & 7) << 9;
- t |= b;
- break;
- }
- if((a & 0177) == 074) { /* src immed */
- t = o->opcode3;
- t |= b;
- break;
- }
- goto bad;
- case 4: /* no operands */
- break;
- case 5: /* tst */
- t |= asmea(p, &p->to);
- if((t&0170) == 010)
- goto bad;
- break;
- case 6: /* lea */
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((b & 0170) != 010)
- goto bad;
- t |= a;
- t |= (b & 7) << 9;
- break;
- case 7: /* cmp */
- b = asmea(p, &p->to);
- a = asmea(p, &p->from);
- if((a & 0170) == 010) { /* dst An */
- t = o->opcode1;
- if(t == 0) /* cmpb illegal */
- goto bad;
- t |= 0xc0;
- t |= b;
- t |= (a & 7) << 9;
- break;
- }
- if((b & 0177) == 074) { /* src immed */
- t = o->opcode2;
- t |= a;
- break;
- }
- if((a & 0170) == 0) { /* dst Dn */
- t |= b;
- t |= (a&7) << 9;
- break;
- }
- if((b&0170) == 030 && (a&0170) == 030) { /* (A)+,(A)+ */
- t = o->opcode3;
- t |= b & 7;
- t |= (a & 7) << 9;
- break;
- }
- goto bad;
- case 8: /* svc */
- *op++ = optab[ARTS].opcode0;
- break;
- case 9: /* and */
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((a & 0170) == 010)
- goto bad;
- if((b & 0170) == 0) { /* dst Dn */
- t |= a;
- t |= (b&7) << 9;
- break;
- }
- if((a & 0170) == 0) { /* src Dn */
- t = o->opcode1;
- t |= b;
- t |= (a&7) << 9;
- break;
- }
- if((a & 0177) == 074) { /* src immed */
- t = o->opcode2;
- t |= b;
- break;
- }
- goto bad;
- case 10: /* eor */
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((a & 0170) == 010)
- goto bad;
- if((a & 0170) == 0) { /* src Dn */
- t |= b;
- t |= (a&7) << 9;
- break;
- }
- if((a & 0177) == 074) { /* src immed */
- t = o->opcode1;
- t |= b;
- break;
- }
- goto bad;
- case 11: /* ext */
- b = asmea(p, &p->to);
- if((b & 0170) == 0) { /* dst Dn */
- t |= b;
- break;
- }
- goto bad;
- case 12: /* shift */
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((b & 0170) == 0) { /* dst Dn */
- if((a & 0177) == 0110) { /* src quick */
- t |= (a & 01600) << 2;
- t |= b;
- break;
- }
- if((a & 0170) == 0) { /* src Dn */
- t |= 0x20;
- t |= a << 9;
- t |= b;
- break;
- }
- goto bad;
- }
- goto bad;
- case 13: /* mul, div short */
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((b & 0170) == 0) { /* dst Dn */
- if((a & 0170) == 010)
- goto bad;
- t |= a;
- t |= b << 9;
- break;
- }
- goto bad;
- case 14: /* mul, div long */
- *op++ = o->opcode1;
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((b & 0170) == 0) { /* dst Dn */
- if((a & 0170) == 010)
- goto bad;
- t |= a;
- opa[1] |= b << 12;
- opa[1] |= b+1;
- break;
- }
- goto bad;
- case 15: /* dec and branch */
- if(p->to.type != D_BRANCH)
- goto bad;
- v = p->pcond->pc - p->pc - 2;
- if(v < -32768L || v >= 32768L)
- goto bad;
- *op++ = v;
- a = asmea(p, &p->from);
- if((a & 0170) != 0)
- goto bad;
- t |= a;
- break;
- case 16: /* fmove */
- *op++ = o->opcode1;
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((a & 0170) == 0100) { /* src Fn */
- if((b & 0170) == 0100) { /* both Fn */
- opa[1] |= (a&7) << 10;
- opa[1] |= (b&7) << 7;
- break;
- }
- t |= b;
- opa[1] = o->opcode2;
- opa[1] |= (a&7) << 7;
- break;
- }
- if((b & 0170) != 0100) /* dst Fn */
- goto bad;
- t |= a;
- opa[1] = o->opcode3;
- opa[1] |= (b&7) << 7;
- break;
- case 17: /* floating ea,Fn */
- *op++ = o->opcode1;
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((b & 0170) != 0100) /* dst Fn */
- goto bad;
- if((a & 0170) == 0100) { /* both Fn */
- opa[1] |= (a&7) << 10;
- opa[1] |= (b&7) << 7;
- break;
- }
- t |= a;
- opa[1] = o->opcode2;
- opa[1] |= (b&7) << 7;
- break;
- case 18: /* floating branchs */
- if(p->to.type != D_BRANCH)
- goto bad;
- v = p->pcond->pc - p->pc - 2;
- if(v < -32768L || v >= 32768L)
- goto bad;
- *op++ = v;
- break;
- case 19: /* floating dec and branch */
- if(p->to.type != D_BRANCH)
- goto bad;
- *op++ = o->opcode1;
- v = p->pcond->pc - p->pc - 2;
- if(v < -32768L || v >= 32768L)
- goto bad;
- *op++ = v;
- a = asmea(p, &p->from);
- if((a & 0170) != 0)
- goto bad;
- t |= a;
- break;
- case 20: /* ftst ea */
- *op++ = o->opcode1;
- if(p->from.type != D_NONE)
- goto bad;
- a = asmea(p, &p->to);
- if((a & 0170) == 0100) { /* Fn */
- opa[1] |= (a&7) << 10;
- break;
- }
- t |= a;
- opa[1] = o->opcode2;
- break;
- case 21: /* fneg */
- *op++ = o->opcode1;
- if(p->from.type == D_NONE) {
- b = asmea(p, &p->to);
- a = b;
- } else {
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- }
- if((b & 0170) != 0100) /* dst Fn */
- goto bad;
- if((a & 0170) == 0100) { /* both Fn */
- opa[1] |= (a&7) << 10;
- opa[1] |= (b&7) << 7;
- break;
- }
- t |= a;
- opa[1] = o->opcode2;
- opa[1] |= (b&7) << 7;
- break;
- case 22: /* floating cmp Fn,ea */
- *op++ = o->opcode1;
- a = asmea(p, &p->from);
- b = asmea(p, &p->to);
- if((a & 0170) != 0100) /* dst Fn */
- goto bad;
- if((b & 0170) == 0100) { /* both Fn */
- opa[1] |= (b&7) << 10;
- opa[1] |= (a&7) << 7;
- break;
- }
- t |= b;
- opa[1] = o->opcode2;
- opa[1] |= (a&7) << 7;
- break;
- case 23: /* word, long */
- op = opa;
- a = asmea(p, &p->to);
- if(a == ((7<<3)|4))
- return;
- if(a == ((7<<3)|1)) {
- if(p->as == AWORD) {
- op = opa;
- *op++ = opa[1];
- }
- return;
- }
- if(a == ((7<<3)|0)) {
- if(p->as == ALONG) {
- *op++ = opa[0];
- opa[0] = 0;
- }
- return;
- }
- goto bad;
- case 24: /* bit field */
- a = ((p->to.field&31)<<6) | (p->from.field&31);
- if(p->as == ABFINS) {
- b = asmea(p, &p->from);
- if((b&0170) != 0)
- goto bad;
- a |= b<<12;
- *op++ = a;
- a = asmea(p, &p->to);
- } else {
- if(p->to.type != D_NONE) {
- b = asmea(p, &p->to);
- if((b&0170) != 0)
- goto bad;
- a |= b<<12;
- }
- *op++ = a;
- a = asmea(p, &p->from);
- }
- t |= a;
- a &= 0170;
- if(a == 010 || a == 030 || a == 040 || a == 074)
- goto bad;
- break;
- case 25: /* movem */
- if(p->from.type == D_CONST) { /* registers -> memory */
- asmea(p, &p->from);
- a = asmea(p, &p->to);
- if(a == 074)
- goto bad;
- b = a & 0170;
- if(b == 000 || b == 010 || b == 030)
- goto bad;
- t |= a;
- break;
- }
- if(p->to.type == D_CONST) { /* memory -> registers */
- t |= 0x400;
- asmea(p, &p->to);
- a = asmea(p, &p->from);
- if(a == 074)
- goto bad;
- b = a & 0170;
- if(b == 000 || b == 010 || b == 040)
- goto bad;
- t |= a;
- break;
- }
- goto bad;
- case 26: /* chk */
- a = asmea(p, &p->from);
- if((a&0170) == 010)
- goto bad;
- b = asmea(p, &p->to);
- if((b&0170) != 0)
- goto bad;
- t |= a;
- t |= b<<9;
- break;
- case 27: /* btst */
- a = asmea(p, &p->from);
- if(a == 074) {
- t = o->opcode1;
- } else
- if((a&0170) != 0)
- goto bad;
- b = asmea(p, &p->to);
- if(b == 074 || (b&0170) == 010)
- goto bad;
- t |= b;
- break;
- case 28: /* fmovem */
- if(p->from.type == D_CONST) { /* registers -> memory */
- b = p->from.offset & 0xff;
- b |= 0xf000; /* control or postinc */
- *op++ = b;
- a = asmea(p, &p->to);
- if(a == 074)
- goto bad;
- b = a & 0170;
- if(b == 000 || b == 010 || b == 030)
- goto bad;
- if(b == 040)
- op[-1] &= ~0x1000; /* predec */
- t |= a;
- break;
- }
- if(p->to.type == D_CONST) { /* memory -> registers */
- b = p->to.offset & 0xff;
- b |= 0xd000; /* control or postinc */
- *op++ = b;
- a = asmea(p, &p->from);
- if(a == 074)
- goto bad;
- b = a & 0170;
- if(b == 000 || b == 010 || b == 040)
- goto bad;
- t |= a;
- break;
- }
- goto bad;
- case 29: /* fmovemc */
- if(p->from.type == D_CONST) { /* registers -> memory */
- b = (p->from.offset & 0x7) << 10;
- b |= 0xa000;
- *op++ = b;
- a = asmea(p, &p->to);
- if(a == 074)
- goto bad;
- b = a & 0170;
- if(b == 000 || b == 010 || b == 030)
- goto bad;
- t |= a;
- break;
- }
- if(p->to.type == D_CONST) { /* memory -> registers */
- b = (p->to.offset & 0x7) << 10;
- b |= 0x8000;
- *op++ = b;
- a = asmea(p, &p->from);
- if(a == 074)
- goto bad;
- b = a & 0170;
- if(b == 000 || b == 010 || b == 040)
- goto bad;
- t |= a;
- break;
- }
- goto bad;
- case 30: /* trap */
- if(p->to.type == D_CONST) {
- t |= p->to.offset & 0xf;
- break;
- }
- goto bad;
- case 31: /* chk2, cmp2 */
- b = asmea(p, &p->to);
- a = b & 0170;
- if(a == 000 || a == 010) {
- *op++ = o->opcode1 | (b << 12);
- t |= asmea(p, &p->from);
- break;
- }
- goto bad;
- case 32: /* casew */
- /* jmp (0,pc,r0.w*1) */
- casepc = p->pc;
- *op++ = o->opcode1;
- break;
- case 34: /* moves */
- op++;
- a = asmea(p, &p->from);
- b = a & 0170;
- if(b == 0 || b == 010) {
- opa[1] = (a << 12) | 0x800;
- b = asmea(p, &p->to);
- a = b & 0170;
- if(a == 0 || a == 010)
- goto bad;
- t |= b;
- break;
- }
- t |= a;
- b = asmea(p, &p->to);
- a = b & 0170;
- if(a != 0 && a != 010)
- goto bad;
- opa[1] = (b << 12);
- break;
- case 35: /* swap */
- a = asmea(p, &p->to);
- if((a & 0170) == 0) {
- t |= a;
- break;
- }
- goto bad;
- }
- opa[0] = t;
- return;
- bad:
- if(!debug['a'])
- print("%P\n", p);
- diag("bad combination of addressing in %s", TNAME);
- opa[0] = 0;
- }
- int
- asmea(Prog *p, Adr *a)
- {
- Optab *o;
- int f, t, r, i;
- long v;
- t = a->type;
- r = simple[t];
- v = a->offset;
- if(r != 0177) {
- if(v == 0)
- return r;
- if((r & 070) != 020)
- return r;
- if(v >= -32768L && v < 32768L) {
- *op++ = v;
- return t-D_A0-I_INDIR+050; /* d(Ax) */
- }
- goto toobig;
- }
- f = 0;
- if(a == &p->from)
- f++;
- o = &optab[p->as];
- switch(t) {
- case D_TOS:
- if(f) {
- if(o->srcsp)
- return (3<<3) | 7; /* (A7)+ */
- } else
- if(o->dstsp)
- return (4<<3) | 7; /* -(A7) */
- return (2<<3) | 7; /* (A7) */
-
- case D_BRANCH:
- v = p->pcond->pc - p->pc - 2;
- if(v < -32768L || v >= 32768L) {
- if(p->as == ABSR || p->as == ABRA) {
- v = p->pcond->pc;
- *op++ = v>>16;
- *op++ = v;
- return (7<<3) | 1;
- }
- goto toobig;
- }
- if(v < -128 || v >= 128 || p->mark == 4) {
- *op++ = v;
- return 0;
- }
- return v & 0xff;
- case I_ADDR|D_STATIC:
- case I_ADDR|D_EXTERN:
- t = a->sym->type;
- if(t == 0 || t == SXREF) {
- diag("undefined external: %s in %s",
- a->sym->name, TNAME);
- a->sym->type = SDATA;
- }
- v = a->sym->value + a->offset;
- if(t != STEXT)
- v += INITDAT;
- if(strcmp(a->sym->name, "a6base"))
- break;
- case D_CONST:
- switch(f? o->srcsp: o->dstsp) {
- case 4:
- *op++ = v>>16;
- case 2:
- *op++ = v;
- break;
- default:
- diag("unknown srcsp asmea in %s", TNAME);
- }
- return (7<<3) | 4;
- case D_FCONST:
- r = f? o->srcsp: o->dstsp;
- for(i=0; i<r; i++)
- ((char*)op)[i] = gnuxi(&a->ieee, i, r);
- op += r/2;
- return (7<<3) | 4;
- case D_QUICK:
- v = a->offset & 0xff;
- return 0110 | (v<<7);
-
- case D_STACK:
- case D_AUTO:
- case D_PARAM:
- if(v == 0)
- return (2<<3) | 7; /* (A7) */
- if(v >= -32768L && v < 32768L) {
- *op++ = v;
- return (5<<3) | 7; /* d(A7) */
- }
- goto toobig;
- case I_INDIR|D_CONST:
- if(v >= -32768L && v < 32768L) {
- *op++ = v;
- return (7<<3) | 0;
- }
- *op++ = v>>16;
- *op++ = v;
- return (7<<3) | 1;
- case D_STATIC:
- case D_EXTERN:
- t = a->sym->type;
- if(t == 0 || t == SXREF) {
- diag("undefined external: %s in %s",
- a->sym->name, TNAME);
- a->sym->type = SDATA;
- }
- if(t == STEXT) {
- if(HEADTYPE == 4) {
- v = a->sym->value + a->offset - p->pc - 2;
- if(v >= -32768L && v < 32768L) {
- *op++ = v;
- return (7<<3) | 2;
- }
- goto toobig;
- }
- v = a->sym->value + a->offset;
- *op++ = v>>16;
- *op++ = v;
- return (7<<3) | 1;
- }
- v = a->sym->value + a->offset - A6OFFSET;
- if(v < -32768L || v >= 32768L) {
- v += INITDAT + A6OFFSET;
- if(v >= -32768L && v < 32768L) {
- *op++ = v;
- return (7<<3) | 0;
- }
- *op++ = v>>16;
- *op++ = v;
- return (7<<3) | 1;
- }
- if(v == 0)
- return (2<<3) | 6;
- *op++ = v;
- return (5<<3) | 6;
- }
- if(!debug['a'])
- print("%P\n", p);
- diag("unknown addressing mode: %d in %s", t, TNAME);
- return 0;
- toobig:
- if(!debug['a'])
- print("%P\n", p);
- diag("addressing mode >> 2^16: %d in %s", t, TNAME);
- return 0;
- }
- void
- lput(long l)
- {
- CPUT(l>>24)
- CPUT(l>>16)
- CPUT(l>>8)
- CPUT(l)
- }
- void
- s16put(char *n)
- {
- char name[16];
- int i;
- strncpy(name, n, sizeof(name));
- for(i=0; i<sizeof(name); i++)
- CPUT(name[i])
- }
- void
- cflush(void)
- {
- int n;
- n = sizeof(buf.cbuf) - cbc;
- if(n)
- write(cout, buf.cbuf, n);
- cbp = buf.cbuf;
- cbc = sizeof(buf.cbuf);
- }
- void
- datblk(long s, long n)
- {
- Prog *p;
- char *cast;
- long l, fl, j;
- int i, c;
- memset(buf.dbuf, 0, n+100);
- for(p = datap; p != P; p = p->link) {
- curp = p;
- l = p->from.sym->value + p->from.offset - s;
- c = p->from.displace;
- i = 0;
- if(l < 0) {
- if(l+c <= 0)
- continue;
- while(l < 0) {
- l++;
- i++;
- }
- }
- if(l >= n)
- continue;
- for(j=l+(c-i)-1; j>=l; j--)
- if(buf.dbuf[j]) {
- print("%P\n", p);
- diag("multiple initialization");
- break;
- }
- switch(p->to.type) {
- case D_FCONST:
- switch(c) {
- default:
- case 4:
- fl = ieeedtof(&p->to.ieee);
- cast = (char*)&fl;
- if(debug['a'] && i == 0) {
- Bprint(&bso, "%lux:%P\n\t\t", l+s+INITDAT, curp);
- for(j=0; j<c; j++)
- Bprint(&bso, "%.2ux", cast[fnuxi8[j+4]] & 0xff);
- Bprint(&bso, "\n");
- }
- for(; i<c; i++) {
- buf.dbuf[l] = cast[fnuxi8[i+4]];
- l++;
- }
- break;
- case 8:
- cast = (char*)&p->to.ieee;
- if(debug['a'] && i == 0) {
- Bprint(&bso, "%lux:%P\n\t\t", l+s+INITDAT, curp);
- for(j=0; j<c; j++)
- Bprint(&bso, "%.2ux", cast[fnuxi8[j]] & 0xff);
- Bprint(&bso, "\n");
- }
- for(; i<c; i++) {
- buf.dbuf[l] = cast[fnuxi8[i]];
- l++;
- }
- break;
- }
- break;
- case D_SCONST:
- if(debug['a'] && i == 0) {
- Bprint(&bso, "%.4lux:%P\n\t\t", l+s+INITDAT, curp);
- for(j=0; j<c; j++)
- Bprint(&bso, "%.2ux", p->to.scon[j] & 0xff);
- Bprint(&bso, "\n");
- }
- for(; i<c; i++) {
- buf.dbuf[l] = p->to.scon[i];
- l++;
- }
- break;
- default:
- fl = p->to.offset;
- if(p->to.sym) {
- if(p->to.sym->type == STEXT)
- fl += p->to.sym->value;
- if(p->to.sym->type == SDATA)
- fl += p->to.sym->value + INITDAT;
- if(p->to.sym->type == SBSS)
- fl += p->to.sym->value + INITDAT;
- }
- cast = (char*)&fl;
- switch(c) {
- default:
- diag("bad nuxi %d %d\n%P", c, i, curp);
- break;
- case 1:
- if(debug['a'] && i == 0) {
- Bprint(&bso, "%.4lux:%P\n\t\t", l+s+INITDAT, curp);
- for(j=0; j<c; j++)
- Bprint(&bso, "%.2ux",cast[inuxi1[j]] & 0xff);
- Bprint(&bso, "\n");
- }
- for(; i<c; i++) {
- buf.dbuf[l] = cast[inuxi1[i]];
- l++;
- }
- break;
- case 2:
- if(debug['a'] && i == 0) {
- Bprint(&bso, "%.4lux:%P\n\t\t", l+s+INITDAT, curp);
- for(j=0; j<c; j++)
- Bprint(&bso, "%.2ux",cast[inuxi2[j]] & 0xff);
- Bprint(&bso, "\n");
- }
- for(; i<c; i++) {
- buf.dbuf[l] = cast[inuxi2[i]];
- l++;
- }
- break;
- case 4:
- if(debug['a'] && i == 0) {
- Bprint(&bso, "%.4lux:%P\n\t\t", l+s+INITDAT, curp);
- for(j=0; j<c; j++)
- Bprint(&bso, "%.2ux",cast[inuxi4[j]] & 0xff);
- Bprint(&bso, "\n");
- }
- for(; i<c; i++) {
- buf.dbuf[l] = cast[inuxi4[i]];
- l++;
- }
- break;
- }
- break;
- }
- }
- write(cout, buf.dbuf, n);
- }
- void
- asmreloc(void)
- {
- Prog *p;
- Sym *s1, *s2;
- int c1, c2, c3;
- long v;
- if(HEADTYPE != 4)
- return;
- for(p = datap; p != P; p = p->link) {
- curp = p;
- s1 = p->to.sym;
- if(s1 == S)
- continue;
- c1 = 'D';
- c3 = p->from.displace;
- s2 = p->from.sym;
- v = s2->value + INITDAT;
- switch(s1->type) {
- default:
- diag("unknown reloc %d", s1->type);
- continue;
- case STEXT:
- c2 = 'T';
- break;
- case SDATA:
- c2 = 'D';
- break;
- case SBSS:
- c2 = 'B';
- break;
- }
- CPUT(c1);
- CPUT(c2);
- CPUT(c3);
- lput(v);
- if(debug['a'])
- Bprint(&bso, "r %c%c%d %.8lux %s $%s\n",
- c1, c2, c3, v, s2->name, s1->name);
- relocsize += 7;
- }
- }
- int
- gnuxi(Ieee *d, int i, int c)
- {
- char *p;
- long l;
- switch(c) {
- default:
- diag("bad nuxi %d %d\n%P", c, i, curp);
- return 0;
-
- /*
- * 2301 vax
- * 0123 68k
- */
- case 4:
- l = ieeedtof(d);
- p = (char*)&l;
- i = gnuxi8[i+4];
- break;
- /*
- * 67452301 vax
- * 45670123 68k
- */
- case 8:
- p = (char*)d;
- i = gnuxi8[i];
- break;
- }
- return p[i];
- }
- long
- rnd(long v, long r)
- {
- long c;
- if(r <= 0)
- return v;
- v += r - 1;
- c = v % r;
- if(c < 0)
- c += r;
- v -= c;
- return v;
- }
|