123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783 |
- #include <u.h>
- #include <libc.h>
- #include <bio.h>
- #include <mach.h>
- #define Extern extern
- #include "mips.h"
- void unimp(ulong);
- void Ifcmp(ulong);
- void Ifdiv(ulong);
- void Ifmul(ulong);
- void Ifadd(ulong);
- void Ifsub(ulong);
- void Ifmov(ulong);
- void Icvtd(ulong);
- void Icvtw(ulong);
- void Icvts(ulong);
- void Ifabs(ulong);
- void Ifneg(ulong);
- Inst cop1[] = {
- { Ifadd, "add.f", Ifloat },
- { Ifsub, "sub.f", Ifloat },
- { Ifmul, "mul.f", Ifloat },
- { Ifdiv, "div.f", Ifloat },
- { unimp, "", },
- { Ifabs, "abs.f", Ifloat },
- { Ifmov, "mov.f", Ifloat },
- { Ifneg, "neg.f", Ifloat },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { Icvts, "cvt.s", Ifloat },
- { Icvtd, "cvt.d", Ifloat },
- { unimp, "", },
- { unimp, "", },
- { Icvtw, "cvt.w", Ifloat },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { unimp, "", },
- { Ifcmp, "c.f", Ifloat },
- { Ifcmp, "c.un", Ifloat },
- { Ifcmp, "c.eq", Ifloat },
- { Ifcmp, "c.ueq", Ifloat },
- { Ifcmp, "c.olt", Ifloat },
- { Ifcmp, "c.ult", Ifloat },
- { Ifcmp, "c.ole", Ifloat },
- { Ifcmp, "c.ule", Ifloat },
- { Ifcmp, "c,sf", Ifloat },
- { Ifcmp, "c.ngle",Ifloat },
- { Ifcmp, "c.seq", Ifloat },
- { Ifcmp, "c.ngl", Ifloat },
- { Ifcmp, "c.lt", Ifloat },
- { Ifcmp, "c.nge", Ifloat },
- { Ifcmp, "c.le", Ifloat },
- { Ifcmp, "c.ngt", Ifloat },
- { 0 }
- };
- void
- unimp(ulong inst)
- {
- print("op %ld\n", inst&0x3f);
- Bprint(bioout, "Unimplemented floating point Trap IR %.8lux\n", inst);
- longjmp(errjmp, 0);
- }
- void
- inval(ulong inst)
- {
- Bprint(bioout, "Invalid Operation Exception IR %.8lux\n", inst);
- longjmp(errjmp, 0);
- }
- void
- ifmt(int r)
- {
- Bprint(bioout, "Invalid Floating Data Format f%d pc 0x%lux\n", r, reg.pc);
- longjmp(errjmp, 0);
- }
- void
- floatop(int dst, int s1, int s2)
- {
- if(reg.ft[s1] == FPd && s1 != 24)
- ifmt(s1);
- if(reg.ft[s2] == FPd && s2 != 24)
- ifmt(s2);
- reg.ft[dst] = FPs;
- }
- void
- doubop(int dst, int s1, int s2)
- {
- ulong l;
- if(reg.ft[s1] != FPd) {
- if(reg.ft[s1] == FPs && s1 != 24)
- ifmt(s1);
- l = reg.di[s1];
- reg.di[s1] = reg.di[s1+1];
- reg.di[s1+1] = l;
- reg.ft[s1] = FPd;
- }
- if(reg.ft[s2] != FPd) {
- if(reg.ft[s2] == FPs && s2 != 24)
- ifmt(s2);
- l = reg.di[s2];
- reg.di[s2] = reg.di[s2+1];
- reg.di[s2+1] = l;
- reg.ft[s2] = FPd;
- }
- reg.ft[dst] = FPd;
- }
- void
- Iswc1(ulong inst)
- {
- int off;
- ulong l;
- int rt, rb, ert;
- Getrbrt(rb, rt, inst);
- off = (short)(inst&0xffff);
- if(trace)
- itrace("swc1\tf%d,0x%x(r%d) ea=%lux", rt, off, rb, reg.r[rb]+off);
- ert = rt&~1;
- if(reg.ft[ert] == FPd) {
- l = reg.di[ert];
- reg.di[ert] = reg.di[ert+1];
- reg.di[ert+1] = l;
- reg.ft[ert] = FPmemory;
- }
- putmem_w(reg.r[rb]+off, reg.di[rt]);
- }
- void
- Ifsub(ulong ir)
- {
- char fmt;
- int fs, ft, fd;
- Getf3(fs, ft, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fd, fs, ft);
- reg.fl[fd] = reg.fl[fs] - reg.fl[ft];
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fd, fs, ft);
- reg.fd[fd>>1] = reg.fd[fs>>1] - reg.fd[ft>>1];
- break;
- case 4:
- fmt = 'w';
- reg.di[fd] = reg.di[fs] - reg.di[ft];
- break;
- }
- if(trace)
- itrace("sub.%c\tf%d,f%d,f%d", fmt, fd, fs, ft);
- }
- void
- Ifmov(ulong ir)
- {
- char fmt;
- int fs, fd;
- Getf2(fs, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- reg.fl[fd] = reg.fl[fs];
- reg.ft[fd] = reg.ft[fs];
- break;
- case 1: /* double */
- fmt = 'd';
- reg.fd[fd>>1] = reg.fd[fs>>1];
- reg.ft[fd] = reg.ft[fs];
- break;
- case 4:
- fmt = 'w';
- reg.di[fd] = reg.di[fs];
- reg.ft[fd] = reg.ft[fs];
- break;
- }
- if(trace)
- itrace("mov.%c\tf%d,f%d", fmt, fd, fs);
- }
- void
- Ifabs(ulong ir)
- {
- char fmt;
- int fs, fd;
- Getf2(fs, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fd, fs, fs);
- if(reg.fl[fs] < 0.0)
- reg.fl[fd] = -reg.fl[fs];
- else
- reg.fl[fd] = reg.fl[fs];
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fd, fs, fs);
- if(reg.fd[fs>>1] < 0.0)
- reg.fd[fd>>1] = -reg.fd[fs>>1];
- else
- reg.fd[fd>>1] = reg.fd[fs>>1];
- break;
- case 4:
- fmt = 'w';
- if((long)reg.di[fs] < 0)
- reg.di[fd] = -reg.di[fs];
- else
- reg.di[fd] = reg.di[fs];
- break;
- }
- if(trace)
- itrace("abs.%c\tf%d,f%d", fmt, fd, fs);
- }
- void
- Ifneg(ulong ir)
- {
- char fmt;
- int fs, fd;
- Getf2(fs, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fd, fs, fs);
- reg.fl[fd] = -reg.fl[fs];
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fd, fs, fs);
- reg.fd[fd>>1] = -reg.fd[fs>>1];
- break;
- case 4:
- fmt = 'w';
- reg.di[fd] = -reg.di[fs];
- break;
- }
- if(trace)
- itrace("neg.%c\tf%d,f%d", fmt, fd, fs);
- }
- void
- Icvtd(ulong ir)
- {
- char fmt;
- int fs, fd;
- Getf2(fs, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fs, fs, fs);
- reg.fd[fd>>1] = reg.fl[fs];
- reg.ft[fd] = FPd;
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fd, fs, fs);
- reg.fd[fd>>1] = reg.fd[fs>>1];
- break;
- case 4:
- fmt = 'w';
- reg.fd[fd>>1] = (long)reg.di[fs];
- reg.ft[fd] = FPd;
- break;
- }
- if(trace)
- itrace("cvt.d.%c\tf%d,f%d", fmt, fd, fs);
- }
- void
- Icvts(ulong ir)
- {
- char fmt;
- int fs, fd;
- Getf2(fs, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fd, fs, fs);
- reg.fl[fd] = reg.fl[fs];
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fs, fs, fs);
- reg.fl[fd] = reg.fd[fs>>1];
- reg.ft[fd] = FPs;
- break;
- case 4:
- fmt = 'w';
- reg.fl[fd] = (long)reg.di[fs];
- reg.ft[fd] = FPs;
- break;
- }
- if(trace)
- itrace("cvt.s.%c\tf%d,f%d", fmt, fd, fs);
- }
- void
- Icvtw(ulong ir)
- {
- long v;
- char fmt;
- int fs, fd;
- Getf2(fs, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fs, fs, fs);
- v = reg.fl[fs];
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fs, fs, fs);
- v = reg.fd[fs>>1];
- break;
- case 4:
- fmt = 'w';
- v = reg.di[fs];
- break;
- }
- reg.di[fd] = v;
- reg.ft[fd] = FPmemory;
- if(trace)
- itrace("cvt.w.%c\tf%d,f%d", fmt, fd, fs);
- }
- void
- Ifadd(ulong ir)
- {
- char fmt;
- int fs, ft, fd;
- Getf3(fs, ft, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fd, fs, ft);
- reg.fl[fd] = reg.fl[fs] + reg.fl[ft];
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fd, fs, ft);
- reg.fd[fd>>1] = reg.fd[fs>>1] + reg.fd[ft>>1];
- break;
- case 4:
- fmt = 'w';
- reg.di[fd] = reg.di[fs] + reg.di[ft];
- break;
- }
- if(trace)
- itrace("add.%c\tf%d,f%d,f%d", fmt, fd, fs, ft);
- }
- void
- Ifmul(ulong ir)
- {
- char fmt;
- int fs, ft, fd;
- Getf3(fs, ft, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fd, fs, ft);
- reg.fl[fd] = reg.fl[fs] * reg.fl[ft];
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fd, fs, ft);
- reg.fd[fd>>1] = reg.fd[fs>>1] * reg.fd[ft>>1];
- break;
- case 4:
- fmt = 'w';
- reg.di[fd] = reg.di[fs] * reg.di[ft];
- break;
- }
- if(trace)
- itrace("mul.%c\tf%d,f%d,f%d", fmt, fd, fs, ft);
- }
- void
- Ifdiv(ulong ir)
- {
- char fmt;
- int fs, ft, fd;
- Getf3(fs, ft, fd, ir);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fd, fs, ft);
- reg.fl[fd] = reg.fl[fs] / reg.fl[ft];
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fd, fs, ft);
- reg.fd[fd>>1] = reg.fd[fs>>1] / reg.fd[ft>>1];
- break;
- case 4:
- fmt = 'w';
- reg.di[fd] = reg.di[fs] / reg.di[ft];
- break;
- }
- if(trace)
- itrace("div.%c\tf%d,f%d,f%d", fmt, fd, fs, ft);
- }
- void
- Ilwc1(ulong inst)
- {
- int rt, rb;
- int off;
- Getrbrt(rb, rt, inst);
- off = (short)(inst&0xffff);
- if(trace)
- itrace("lwc1\tf%d,0x%x(r%d) ea=%lux", rt, off, rb, reg.r[rb]+off);
- reg.di[rt] = getmem_w(reg.r[rb]+off);
- reg.ft[rt] = FPmemory;
- }
- void
- Ibcfbct(ulong inst)
- {
- int takeit;
- int off;
- ulong npc;
- off = (short)(inst&0xffff);
- takeit = 0;
- npc = reg.pc + (off<<2) + 4;
- if(inst&(1<<16)) {
- if(trace)
- itrace("bc1t\t0x%lux", npc);
- if(reg.fpsr&FP_CBIT)
- takeit = 1;
- }
- else {
- if(trace)
- itrace("bc1f\t0x%lux", npc);
- if((reg.fpsr&FP_CBIT) == 0)
- takeit = 1;
- }
- if(takeit) {
- /* Do the delay slot */
- reg.ir = ifetch(reg.pc+4);
- Statbra();
- Iexec(reg.ir);
- reg.pc = npc-4;
- }
- }
- void
- Imtct(ulong ir)
- {
- int rt, fs;
- SpecialGetrtrd(rt, fs, ir);
- if(ir&(1<<22)) { /* CT */
- if(trace)
- itrace("ctc1\tr%d,f%d", rt, fs);
- }
- else { /* MT */
- if(trace)
- itrace("mtc1\tr%d,f%d", rt, fs);
- reg.di[fs] = reg.r[rt];
- reg.ft[fs] = FPmemory;
- }
- }
- void
- Imfcf(ulong ir)
- {
- int rt, fs;
- SpecialGetrtrd(rt, fs, ir);
- if(ir&(1<<22)) { /* CF */
- if(trace)
- itrace("cfc1\tr%d,f%d", rt, fs);
- }
- else { /* MF */
- if(trace)
- itrace("mfc1\tr%d,f%d", rt, fs);
- reg.r[rt] = reg.di[fs];
- }
- }
- void
- Icop1(ulong ir)
- {
- Inst *i;
- switch((ir>>23)&7) {
- case 0:
- Imfcf(ir);
- break;
- case 1:
- Imtct(ir);
- break;
- case 2:
- case 3:
- Ibcfbct(ir);
- break;
- case 4:
- case 5:
- case 6:
- case 7:
- i = &cop1[ir&0x3f];
- i->count++;
- (*i->func)(ir);
- }
- }
- void
- Ifcmp(ulong ir)
- {
- char fmt;
- int fc;
- int ft, fs;
- SpecialGetrtrd(ft, fs, ir);
- SET(fc);
- switch((ir>>21)&0xf) {
- default:
- unimp(ir);
- case 0: /* single */
- fmt = 's';
- floatop(fs, fs, ft);
- if(isNaN(reg.fl[fs]) || isNaN(reg.fl[ft])) {
- fc = FP_U;
- break;
- }
- if(reg.fl[fs] == reg.fl[ft]) {
- fc = FP_E;
- break;
- }
- if(reg.fl[fs] < reg.fl[ft]) {
- fc = FP_L;
- break;
- }
- if(reg.fl[fs] > reg.fl[ft]) {
- fc = FP_G;
- break;
- }
- print("vi: bad in fcmp");
- break;
- case 1: /* double */
- fmt = 'd';
- doubop(fs, fs, ft);
- if(isNaN(reg.fd[fs>>1]) || isNaN(reg.fd[ft>>1])) {
- fc = FP_U;
- break;
- }
- if(reg.fd[fs>>1] == reg.fd[ft>>1]) {
- fc = FP_E;
- break;
- }
- if(reg.fd[fs>>1] < reg.fd[ft>>1]) {
- fc = FP_L;
- break;
- }
- if(reg.fd[fs>>1] > reg.fd[ft>>1]) {
- fc = FP_G;
- break;
- }
- print("vi: bad in fcmp");
- break;
- case 4:
- fmt = 'w';
- if(reg.di[fs] == reg.di[ft]) {
- fc = FP_E;
- break;
- }
- if(reg.di[fs] < reg.di[ft]) {
- fc = FP_L;
- break;
- }
- if(reg.di[fs] > reg.di[ft]) {
- fc = FP_G;
- break;
- }
- break;
- }
- reg.fpsr &= ~FP_CBIT;
- switch(ir&0xf) {
- case 0:
- if(trace)
- itrace("c.f.%c\tf%d,f%d", fmt, fs, ft);
- break;
- case 1:
- if(trace)
- itrace("c.un.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_U)
- reg.fpsr |= FP_CBIT;
- break;
- case 2:
- if(trace)
- itrace("c.eq.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_E)
- reg.fpsr |= FP_CBIT;
- break;
- case 3:
- if(trace)
- itrace("c.ueq.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_E || fc == FP_U)
- reg.fpsr |= FP_CBIT;
- break;
- case 4:
- if(trace)
- itrace("c.lt.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_L)
- reg.fpsr |= FP_CBIT;
- break;
- case 5:
- if(trace)
- itrace("c.ult.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_L || fc == FP_U)
- reg.fpsr |= FP_CBIT;
- break;
- case 6:
- if(trace)
- itrace("c.le.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_E || fc == FP_L)
- reg.fpsr |= FP_CBIT;
- break;
- case 7:
- if(trace)
- itrace("c.ule.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_E || fc == FP_L || fc == FP_U)
- reg.fpsr |= FP_CBIT;
- break;
- case 8:
- if(trace)
- itrace("c.sf.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_U)
- inval(ir);
- break;
- case 9:
- if(trace)
- itrace("c.ngle.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_U) {
- reg.fpsr |= FP_CBIT;
- inval(ir);
- }
- break;
- case 10:
- if(trace)
- itrace("c.seq.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_E)
- reg.fpsr |= FP_CBIT;
- if(fc == FP_U)
- inval(ir);
- break;
- case 11:
- if(trace)
- itrace("c.ngl.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_E || fc == FP_U)
- reg.fpsr |= FP_CBIT;
- if(fc == FP_U)
- inval(ir);
- break;
- case 12:
- if(trace)
- itrace("c.lt.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_L)
- reg.fpsr |= FP_CBIT;
- if(fc == FP_U)
- inval(ir);
- break;
- case 13:
- if(trace)
- itrace("c.nge.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_L || fc == FP_U)
- reg.fpsr |= FP_CBIT;
- if(fc == FP_U)
- inval(ir);
- break;
- case 14:
- if(trace)
- itrace("c.le.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_E || fc == FP_L)
- reg.fpsr |= FP_CBIT;
- if(fc == FP_U)
- inval(ir);
- break;
- case 15:
- if(trace)
- itrace("c.ngt.%c\tf%d,f%d", fmt, fs, ft);
- if(fc == FP_E || fc == FP_L || fc == FP_U)
- reg.fpsr |= FP_CBIT;
- if(fc == FP_U)
- inval(ir);
- break;
- }
- USED(fmt);
- }
|