123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569 |
- #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 %lux sb %lux 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;
- 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;
- }
- 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();
- }
- 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;
- }
- cflush();
- }
- void
- asmins(Prog *p)
- {
- Optab *o;
- int t, a, b;
- long v;
- Prog *q;
- 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);
- /* hack to turn 3-word bsr into 2-word jsr */
- if(a == 0xff && p->as == ABSR &&
- p->pcond->pc < 32768L && p->pcond->pc >= 0) {
- op = opa + 1;
- t = o->opcode1;
- *op++ = p->pcond->pc;
- break;
- }
- 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 33: /* bcase */
- q = copyp(p);
- q->as = ADATA;
- q->to.type = D_CONST;
- q->to.offset = p->pcond->pc - casepc - 2;
- q->from.displace = 2;
- q->link = datap;
- datap = q;
- if(debug['a'])
- Bprint(&bso, "%P\n", q);
- op = opa;
- return;
- 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;
- short *top;
- long v;
- if(a->index != D_NONE)
- goto index;
- 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) */
- }
- *op++ = 0x170; /* is, no indirect */
- *op++ = v>>16;
- *op++ = v;
- return t-D_A0-I_INDIR+060; /* (d,Ax) */
- }
- 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) {
- *op++ = v>>16;
- *op++ = v;
- return 0xff;
- }
- 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;
- 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) */
- }
- *op++ = 0x170; /* is, no indirect */
- *op++ = v>>16;
- *op++ = v;
- return (6<<3) | 7; /* (d,A7) */
- case I_INDIR|D_CONST:
- goto adr;
- 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) {
- v = a->sym->value + a->offset;
- *op++ = v>>16;
- *op++ = v;
- return (7<<3) | 1;
- }
- v = a->sym->value + a->offset - A6OFFSET;
- if(debug['6']) {
- v += INITDAT + A6OFFSET;
- goto adr;
- }
- if(v == 0)
- return (2<<3) | 6;
- if(v >= -32768L && v < 32768L) {
- *op++ = v;
- return (5<<3) | 6;
- }
- v += INITDAT + A6OFFSET;
- adr:
- if(v >= -32768L && v < 32768L) {
- *op++ = v;
- return (7<<3) | 0;
- }
- *op++ = v>>16;
- *op++ = v;
- return (7<<3) | 1;
- }
- if(!debug['a'])
- print("%P\n", p);
- diag("unknown addressing mode: %d in %s", t, TNAME);
- return 0;
- index:
- top = op++;
- t = a->index & D_MASK;
- f = (a->scale & 7) << 9; /* w/l scale */
- f |= (t & 7) << 12; /* register */
- if(t < D_R0 || t >= D_R0+8) {
- if(t >= D_A0 && t < D_A0+8) {
- f |= 0x8000; /* d/a */
- } else
- if(t == D_NONE)
- f = 0x40; /* is */
- else
- goto bad;
- }
- t = a->type;
- r = t & 7;
- v = a->offset;
- if(t < (I_INDIR|D_A0) || t >= (I_INDIR|(D_A0+8)))
- switch(t) {
- default:
- goto bad;
- case I_INDIR|D_NONE:
- f |= 0x80; /* bs */
- r = 0;
- break;
- case D_AUTO:
- case D_PARAM:
- case D_STACK:
- r = 7;
- break;
- 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;
- }
- r = 6;
- v += a->sym->value - A6OFFSET;
- if(t == STEXT) {
- f |= 0x80; /* bs */
- r = 0;
- v += A6OFFSET;
- goto bdlong;
- }
- if(debug['6']) {
- f |= 0x80; /* bs */
- r = 0;
- v += INITDAT + A6OFFSET;
- }
- }
- if(v == 0)
- f |= 0x10; /* bd size = null */
- else
- if(v >= -32768L && v < 32768L) {
- f |= 0x20; /* bd size = word */
- *op++ = v;
- } else {
- bdlong:
- f |= 0x30; /* bd size = long */
- *op++ = v>>16;
- *op++ = v;
- }
- v = a->displace;
- t = a->index & I_MASK;
- if(t != I_INDEX1) { /* non-memory index */
- if(t == I_INDEX2)
- f |= 5; /* post indexing */
- else
- if(t == I_INDEX3)
- f |= 1; /* pre indexing */
- else
- goto bad;
- }
- if(v != 0) {
- if(v >= -32768L && v < 32768L) {
- f++; /* is size = word */
- *op++ = v;
- } else {
- f += 2; /* is size = long */
- *op++ = v>>16;
- *op++ = v;
- }
- }
- *top = f | 0x100;
- return (6<<3) | r;
- bad:
- if(!debug['a'])
- print("%P\n", p);
- diag("bad operand in %s", 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, "%lux:%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, "%lux:%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, "%lux:%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, "%lux:%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);
- }
- 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;
- }
|