ref: 99db038e2825266e84ddb381718f3d047dc6d733
dir: /sys/src/libmach/vcodas.c/
#include <u.h> #include <libc.h> #include <bio.h> #include <mach.h> /* mips native disassembler */ typedef struct { uvlong addr; /* pc of instr */ uchar op; /* bits 31-26 */ uchar rs; /* bits 25-21 */ uchar rt; /* bits 20-16 */ uchar rd; /* bits 15-11 */ uchar sa; /* bits 10-6 */ uchar function; /* bits 5-0 */ long immediate; /* bits 15-0 */ ulong cofun; /* bits 24-0 */ ulong target; /* bits 25-0 */ long w0; char *curr; /* current fill point */ char *end; /* end of buffer */ char *err; } Instr; typedef struct { char *mnemonic; char *mipsco; } Opcode; static char mipscoload[] = "r%t,%l"; static char mipscoalui[] = "r%t,r%s,%i"; static char mipscoalu3op[] = "r%d,r%s,r%t"; static char mipscoboc[] = "r%s,r%t,%b"; static char mipscoboc0[] = "r%s,%b"; static char mipscorsrt[] = "r%s,r%t"; static char mipscorsi[] = "r%s,%i"; static char mipscoxxx[] = "%w"; static char mipscofp3[] = "f%a,f%d,f%t"; /* fd,fs,ft */ static char mipscofp2[] = "f%a,f%d"; /* fd,fs */ static char mipscofpc[] = "f%d,f%t"; /* fs,ft */ static Opcode opcodes[64] = { 0, 0, 0, 0, "j", "%j", "jal", "%j", "beq", mipscoboc, "bne", mipscoboc, "blez", mipscoboc0, "bgtz", mipscoboc0, "addi", mipscoalui, "addiu", mipscoalui, "slti", mipscoalui, "sltiu", mipscoalui, "andi", mipscoalui, "ori", mipscoalui, "xori", mipscoalui, "lui", "r%t,%u", "cop0", 0, "cop1", 0, "cop2", 0, "cop3", 0, "beql", mipscoboc, "bnel", mipscoboc, "blezl", mipscoboc0, "bgtzl", mipscoboc0, "instr18", mipscoxxx, "instr19", mipscoxxx, "instr1A", mipscoxxx, "instr1B", mipscoxxx, "instr1C", mipscoxxx, "instr1D", mipscoxxx, "instr1E", mipscoxxx, "instr1F", mipscoxxx, "lb", mipscoload, "lh", mipscoload, "lwl", mipscoload, "lw", mipscoload, "lbu", mipscoload, "lhu", mipscoload, "lwr", mipscoload, "instr27", mipscoxxx, "sb", mipscoload, "sh", mipscoload, "swl", mipscoload, "sw", mipscoload, "instr2C", mipscoxxx, "instr2D", mipscoxxx, "swr", mipscoload, "cache", "", "ll", mipscoload, "lwc1", mipscoload, "lwc2", mipscoload, "lwc3", mipscoload, "instr34", mipscoxxx, "ld", mipscoload, "ld", mipscoload, "ld", mipscoload, "sc", mipscoload, "swc1", mipscoload, "swc2", mipscoload, "swc3", mipscoload, "instr3C", mipscoxxx, "sd", mipscoload, "sd", mipscoload, "sd", mipscoload, }; static Opcode sopcodes[64] = { "sll", "r%d,r%t,$%a", "special01", mipscoxxx, "srl", "r%d,r%t,$%a", "sra", "r%d,r%t,$%a", "sllv", "r%d,r%t,R%s", "special05", mipscoxxx, "srlv", "r%d,r%t,r%s", "srav", "r%d,r%t,r%s", "jr", "r%s", "jalr", "r%d,r%s", "special0A", mipscoxxx, "special0B", mipscoxxx, "syscall", "", "break", "", "special0E", mipscoxxx, "sync", "", "mfhi", "r%d", "mthi", "r%s", "mflo", "r%d", "mtlo", "r%s", "special14", mipscoxxx, "special15", mipscoxxx, "special16", mipscoxxx, "special17", mipscoxxx, "mult", mipscorsrt, "multu", mipscorsrt, "div", mipscorsrt, "divu", mipscorsrt, "special1C", mipscoxxx, "special1D", mipscoxxx, "special1E", mipscoxxx, "special1F", mipscoxxx, "add", mipscoalu3op, "addu", mipscoalu3op, "sub", mipscoalu3op, "subu", mipscoalu3op, "and", mipscoalu3op, "or", mipscoalu3op, "xor", mipscoalu3op, "nor", mipscoalu3op, "special28", mipscoxxx, "special29", mipscoxxx, "slt", mipscoalu3op, "sltu", mipscoalu3op, "special2C", mipscoxxx, "special2D", mipscoxxx, "special2E", mipscoxxx, "special2F", mipscoxxx, "tge", mipscorsrt, "tgeu", mipscorsrt, "tlt", mipscorsrt, "tltu", mipscorsrt, "teq", mipscorsrt, "special35", mipscoxxx, "tne", mipscorsrt, "special37", mipscoxxx, "special38", mipscoxxx, "special39", mipscoxxx, "special3A", mipscoxxx, "special3B", mipscoxxx, "special3C", mipscoxxx, "special3D", mipscoxxx, "special3E", mipscoxxx, "special3F", mipscoxxx, }; static Opcode ropcodes[32] = { "bltz", mipscoboc0, "bgez", mipscoboc0, "bltzl", mipscoboc0, "bgezl", mipscoboc0, "regimm04", mipscoxxx, "regimm05", mipscoxxx, "regimm06", mipscoxxx, "regimm07", mipscoxxx, "tgei", mipscorsi, "tgeiu", mipscorsi, "tlti", mipscorsi, "tltiu", mipscorsi, "teqi", mipscorsi, "regimm0D", mipscoxxx, "tnei", mipscorsi, "regimm0F", mipscoxxx, "bltzal", mipscoboc0, "bgezal", mipscoboc0, "bltzall", mipscoboc0, "bgezall", mipscoboc0, "regimm14", mipscoxxx, "regimm15", mipscoxxx, "regimm16", mipscoxxx, "regimm17", mipscoxxx, "regimm18", mipscoxxx, "regimm19", mipscoxxx, "regimm1A", mipscoxxx, "regimm1B", mipscoxxx, "regimm1C", mipscoxxx, "regimm1D", mipscoxxx, "regimm1E", mipscoxxx, "regimm1F", mipscoxxx, }; static Opcode fopcodes[64] = { "add.%f", mipscofp3, "sub.%f", mipscofp3, "mul.%f", mipscofp3, "div.%f", mipscofp3, "sqrt.%f", mipscofp2, "abs.%f", mipscofp2, "mov.%f", mipscofp2, "neg.%f", mipscofp2, "finstr08", mipscoxxx, "finstr09", mipscoxxx, "finstr0A", mipscoxxx, "finstr0B", mipscoxxx, "round.w.%f", mipscofp2, "trunc.w%f", mipscofp2, "ceil.w%f", mipscofp2, "floor.w%f", mipscofp2, "finstr10", mipscoxxx, "finstr11", mipscoxxx, "finstr12", mipscoxxx, "finstr13", mipscoxxx, "finstr14", mipscoxxx, "finstr15", mipscoxxx, "finstr16", mipscoxxx, "finstr17", mipscoxxx, "finstr18", mipscoxxx, "finstr19", mipscoxxx, "finstr1A", mipscoxxx, "finstr1B", mipscoxxx, "finstr1C", mipscoxxx, "finstr1D", mipscoxxx, "finstr1E", mipscoxxx, "finstr1F", mipscoxxx, "cvt.s.%f", mipscofp2, "cvt.d.%f", mipscofp2, "cvt.e.%f", mipscofp2, "cvt.q.%f", mipscofp2, "cvt.w.%f", mipscofp2, "finstr25", mipscoxxx, "finstr26", mipscoxxx, "finstr27", mipscoxxx, "finstr28", mipscoxxx, "finstr29", mipscoxxx, "finstr2A", mipscoxxx, "finstr2B", mipscoxxx, "finstr2C", mipscoxxx, "finstr2D", mipscoxxx, "finstr2E", mipscoxxx, "finstr2F", mipscoxxx, "c.f.%f", mipscofpc, "c.un.%f", mipscofpc, "c.eq.%f", mipscofpc, "c.ueq.%f", mipscofpc, "c.olt.%f", mipscofpc, "c.ult.%f", mipscofpc, "c.ole.%f", mipscofpc, "c.ule.%f", mipscofpc, "c.sf.%f", mipscofpc, "c.ngle.%f", mipscofpc, "c.seq.%f", mipscofpc, "c.ngl.%f", mipscofpc, "c.lt.%f", mipscofpc, "c.nge.%f", mipscofpc, "c.le.%f", mipscofpc, "c.ngt.%f", mipscofpc, }; static char fsub[16] = { 's', 'd', 'e', 'q', 'w', '?', '?', '?', '?', '?', '?', '?', '?', '?', '?', '?' }; static int mkinstr(Instr *i, Map *map, uvlong pc) { ulong w; if (get4(map, pc, &w) < 0) { werrstr("can't read instruction: %r"); return -1; } i->addr = pc; i->op = (w >> 26) & 0x3F; i->rs = (w >> 21) & 0x1F; i->rt = (w >> 16) & 0x1F; i->rd = (w >> 11) & 0x1F; i->sa = (w >> 6) & 0x1F; i->function = w & 0x3F; i->immediate = w & 0x0000FFFF; if (i->immediate & 0x8000) i->immediate |= ~0x0000FFFF; i->cofun = w & 0x01FFFFFF; i->target = w & 0x03FFFFFF; i->w0 = w; return 1; } #pragma varargck argpos bprint 2 static void bprint(Instr *i, char *fmt, ...) { va_list arg; va_start(arg, fmt); i->curr = vseprint(i->curr, i->end, fmt, arg); va_end(arg); } static void format(char *mnemonic, Instr *i, char *f) { if (mnemonic) format(0, i, mnemonic); if (f == 0) return; if (i->curr < i->end) *i->curr++ = '\t'; for ( ; *f && i->curr < i->end; f++) { if (*f != '%') { *i->curr++ = *f; continue; } switch (*++f) { case 's': bprint(i, "%d", i->rs); break; case 't': bprint(i, "%d", i->rt); break; case 'd': bprint(i, "%d", i->rd); break; case 'a': bprint(i, "%d", i->sa); break; case 'l': if (i->rs == 30) { i->curr += symoff(i->curr, i->end-i->curr, i->immediate+mach->sb, CANY); bprint(i, "(SB)"); } else bprint(i, "%lx(r%d)", i->immediate, i->rs); break; case 'i': bprint(i, "$%lx", i->immediate); break; case 'u': *i->curr++ = '$'; i->curr += symoff(i->curr, i->end-i->curr, i->immediate, CANY); bprint(i, "(SB)"); break; case 'j': i->curr += symoff(i->curr, i->end-i->curr, (i->target<<2)|(i->addr & 0xF0000000), CANY); bprint(i, "(SB)"); break; case 'b': i->curr += symoff(i->curr, i->end-i->curr, (i->immediate<<2)+i->addr+4, CANY); break; case 'c': bprint(i, "%lux", i->cofun); break; case 'w': bprint(i, "[%lux]", i->w0); break; case 'f': *i->curr++ = fsub[i->rs & 0x0F]; break; case '\0': *i->curr++ = '%'; return; default: bprint(i, "%%%c", *f); break; } } } static void copz(int cop, Instr *i) { char *f, *m, buf[16]; m = buf; f = "%t,%d"; switch (i->rs) { case 0: sprint(buf, "mfc%d", cop); break; case 2: sprint(buf, "cfc%d", cop); break; case 4: sprint(buf, "mtc%d", cop); break; case 6: sprint(buf, "ctc%d", cop); break; case 8: f = "%b"; switch (i->rt) { case 0: sprint(buf, "bc%df", cop); break; case 1: sprint(buf, "bc%dt", cop); break; case 2: sprint(buf, "bc%dfl", cop); break; case 3: sprint(buf, "bc%dtl", cop); break; default: sprint(buf, "cop%d", cop); f = mipscoxxx; break; } break; default: sprint(buf, "cop%d", cop); if (i->rs & 0x10) f = "function %c"; else f = mipscoxxx; break; } format(m, i, f); } static void cop0(Instr *i) { char *m = 0; if (i->rs >= 0x10) { switch (i->cofun) { case 1: m = "tlbr"; break; case 2: m = "tlbwi"; break; case 6: m = "tlbwr"; break; case 8: m = "tlbp"; break; case 16: m = "rfe"; break; case 24: m = "eret"; break; case 32: m = "wait"; break; } if (m) { format(m, i, 0); if (i->curr < i->end) *i->curr++ = 0; return; } } copz(0, i); } int _mipscoinst(Map *map, uvlong pc, char *buf, int n) { Instr i; Opcode *o; uchar op; i.curr = buf; i.end = buf+n-1; if (mkinstr(&i, map, pc) < 0) return -1; switch (i.op) { case 0x00: /* SPECIAL */ o = sopcodes; op = i.function; break; case 0x01: /* REGIMM */ o = ropcodes; op = i.rt; break; case 0x10: /* COP0 */ cop0(&i); return 4; case 0x11: /* COP1 */ if (i.rs & 0x10) { o = fopcodes; op = i.function; break; } /*FALLTHROUGH*/ case 0x12: /* COP2 */ case 0x13: /* COP3 */ copz(i.op-0x10, &i); return 4; default: o = opcodes; op = i.op; break; } format(o[op].mnemonic, &i, o[op].mipsco); return 4; }