ref: 595fbddb1c9e152d9080d7b0faa301709fa6466d
dir: /sys/src/cmd/qi/qi.c/
#include <u.h> #include <libc.h> #include <bio.h> #include <mach.h> #include <tos.h> #define Extern #include "power.h" char *file = "q.out"; int datasize; ulong textbase; Biobuf bp, bi; Fhdr fhdr; ulong bits[32]; void main(int argc, char **argv) { int pid, i; argc--; argv++; bioout = &bp; bin = &bi; Binit(bioout, 1, OWRITE); Binit(bin, 0, OREAD); if(argc) { pid = atoi(argv[0]); if(pid != 0) { procinit(pid); cmd(); } file = argv[0]; } argc--; argv++; text = open(file, OREAD); if(text < 0) fatal(1, "open text '%s'", file); Bprint(bioout, "qi\n"); inithdr(text); initstk(argc, argv); for(i=0; i<32; i++) bits[i] = 1L << (31-i); fpreginit(); cmd(); } /* * we're rounding segment boundaries to the nearest 1MB on power now, * and mach->pgsize is actually what to round segment boundaries up to. */ #define SEGROUND mach->pgsize void initmap(void) { ulong t, d, b, bssend; Segment *s; t = (fhdr.txtaddr+fhdr.txtsz+(SEGROUND-1)) & ~(SEGROUND-1); d = (t + fhdr.datsz + (SEGROUND-1)) & ~(SEGROUND-1); bssend = t + fhdr.datsz + fhdr.bsssz; b = (bssend + (SEGROUND-1)) & ~(SEGROUND-1); s = &memory.seg[Text]; s->type = Text; s->base = fhdr.txtaddr - fhdr.hdrsz; s->end = t; s->fileoff = fhdr.txtoff - fhdr.hdrsz; s->fileend = s->fileoff + fhdr.txtsz; s->table = emalloc(((s->end-s->base)/BY2PG)*sizeof(uchar*)); iprofsize = (s->end-s->base)/PROFGRAN; iprof = emalloc(iprofsize*sizeof(long)); textbase = s->base; s = &memory.seg[Data]; s->type = Data; s->base = t; s->end = t+(d-t); s->fileoff = fhdr.datoff; s->fileend = s->fileoff + fhdr.datsz; datasize = fhdr.datsz; s->table = emalloc(((s->end-s->base)/BY2PG)*sizeof(uchar*)); s = &memory.seg[Bss]; s->type = Bss; s->base = d; s->end = d+(b-d); s->table = emalloc(((s->end-s->base)/BY2PG)*sizeof(uchar*)); s = &memory.seg[Stack]; s->type = Stack; s->base = STACKTOP-STACKSIZE; s->end = STACKTOP; s->table = emalloc(((s->end-s->base)/BY2PG)*sizeof(uchar*)); reg.pc = fhdr.entry; } void inithdr(int fd) { Symbol s; extern Machdata powermach; seek(fd, 0, 0); if (!crackhdr(fd, &fhdr)) fatal(0, "read text header"); if(fhdr.type != FPOWER) fatal(0, "bad magic number"); if(syminit(fd, &fhdr) < 0) fatal(0, "%r\n"); symmap = loadmap(symmap, fd, &fhdr); if (mach->sbreg && lookup(0, mach->sbreg, &s)) mach->sb = s.value; machdata = &powermach; } ulong greg(int f, ulong off) { int n; ulong l; uchar wd[BY2WD]; seek(f, off, 0); n = read(f, wd, BY2WD); if(n != BY2WD) fatal(1, "read register"); l = wd[0]<<24; l |= wd[1]<<16; l |= wd[2]<<8; l |= wd[3]; return l; } ulong roff[] = { REGOFF(r0), REGOFF(r1), REGOFF(r2), REGOFF(r3), REGOFF(r4), REGOFF(r5), REGOFF(r6), REGOFF(r7), REGOFF(r8), REGOFF(r9), REGOFF(r10), REGOFF(r11), REGOFF(r12), REGOFF(r13), REGOFF(r14), REGOFF(r15), REGOFF(r16), REGOFF(r17), REGOFF(r18), REGOFF(r19), REGOFF(r20), REGOFF(r21), REGOFF(r22), REGOFF(r23), REGOFF(r24), REGOFF(r25), REGOFF(r26), REGOFF(r27), REGOFF(r28), REGOFF(r29), REGOFF(r30), REGOFF(r31), }; void seginit(int fd, Segment *s, int idx, ulong vastart, ulong vaend) { int n; while(vastart < vaend) { seek(fd, vastart, 0); s->table[idx] = emalloc(BY2PG); n = read(fd, s->table[idx], BY2PG); if(n != BY2PG) fatal(1, "data read"); vastart += BY2PG; idx++; } } void procinit(int pid) { char *p; Segment *s; int n, m, sg, i; ulong vastart, vaend; char mfile[128], tfile[128], sfile[1024]; sprint(mfile, "/proc/%d/mem", pid); sprint(tfile, "/proc/%d/text", pid); sprint(sfile, "/proc/%d/segment", pid); text = open(tfile, OREAD); if(text < 0) fatal(1, "open text %s", tfile); inithdr(text); sg = open(sfile, OREAD); if(sg < 0) fatal(1, "open text %s", sfile); n = read(sg, sfile, sizeof(sfile)); if(n >= sizeof(sfile)) fatal(0, "segment file buffer too small"); close(sg); m = open(mfile, OREAD); if(m < 0) fatal(1, "open %s", mfile); initmap(); p = strstr(sfile, "Data"); if(p == 0) fatal(0, "no data"); vastart = strtoul(p+9, 0, 16); vaend = strtoul(p+18, 0, 16); s = &memory.seg[Data]; if(s->base != vastart || s->end != vaend) { s->base = vastart; s->end = vaend; free(s->table); s->table = malloc(((s->end-s->base)/BY2PG)*sizeof(uchar*)); } seginit(m, s, 0, vastart, vaend); p = strstr(sfile, "Bss"); if(p == 0) fatal(0, "no bss"); vastart = strtoul(p+9, 0, 16); vaend = strtoul(p+18, 0, 16); s = &memory.seg[Bss]; if(s->base != vastart || s->end != vaend) { s->base = vastart; s->end = vaend; free(s->table); s->table = malloc(((s->end-s->base)/BY2PG)*sizeof(uchar*)); } seginit(m, s, 0, vastart, vaend); reg.pc = greg(m, REGOFF(pc)); reg.r[1] = greg(m, REGOFF(sp)); reg.r[2] = greg(m, REGOFF(r2)); reg.r[30] = greg(m, REGOFF(r30)); reg.r[31] = greg(m, REGOFF(r31)); for(i = 0; i < 32; i++) reg.r[i] = greg(m, roff[i-1]); s = &memory.seg[Stack]; vastart = reg.r[1] & ~(BY2PG-1); seginit(m, s, (vastart-s->base)/BY2PG, vastart, STACKTOP); close(m); Bprint(bioout, "qi\n"); } void reset(void) { int i, l, m; Segment *s; Breakpoint *b; memset(®, 0, sizeof(Registers)); fpreginit(); for(i = 0; i > Nseg; i++) { s = &memory.seg[i]; l = ((s->end-s->base)/BY2PG)*sizeof(uchar*); for(m = 0; m < l; m++) if(s->table[m]) free(s->table[m]); free(s->table); } free(iprof); memset(&memory, 0, sizeof(memory)); for(b = bplist; b; b = b->next) b->done = b->count; } void initstk(int argc, char *argv[]) { ulong size, sp, ap, tos; int i; char *p; initmap(); tos = STACKTOP - sizeof(Tos)*2; /* we'll assume twice the host's is big enough */ sp = tos; for (i = 0; i < sizeof(Tos)*2; i++) putmem_b(tos + i, 0); /* * pid is second word from end of tos and needs to be set for nsec(). * we know power is a 32-bit cpu, so we'll assume knowledge of the Tos * struct for now, and use our pid. */ putmem_w(tos + 4*4 + 2*sizeof(ulong) + 3*sizeof(uvlong), getpid()); /* Build exec stack */ size = strlen(file)+1+BY2WD+BY2WD+(BY2WD*2); for(i = 0; i < argc; i++) size += strlen(argv[i])+BY2WD+1; sp -= size; sp &= ~7; reg.r[1] = sp; reg.r[3] = tos; /* Plan 9 profiling clock, etc. */ /* Push argc */ putmem_w(sp, argc+1); sp += BY2WD; /* Compute sizeof(argv) and push argv[0] */ ap = sp+((argc+1)*BY2WD)+BY2WD; putmem_w(sp, ap); sp += BY2WD; /* Build argv[0] string into stack */ for(p = file; *p; p++) putmem_b(ap++, *p); putmem_b(ap++, '\0'); /* Loop through pushing the arguments */ for(i = 0; i < argc; i++) { putmem_w(sp, ap); sp += BY2WD; for(p = argv[i]; *p; p++) putmem_b(ap++, *p); putmem_b(ap++, '\0'); } /* Null terminate argv */ putmem_w(sp, 0); } void fatal(int syserr, char *fmt, ...) { char buf[ERRMAX], *s; va_list ap; va_start(ap, fmt); vseprint(buf, buf+sizeof(buf), fmt, ap); va_end(ap); s = "qi: %s\n"; if(syserr) s = "qi: %s: %r\n"; fprint(2, s, buf); exits(buf); } void itrace(char *fmt, ...) { char buf[128]; va_list ap; va_start(ap, fmt); vseprint(buf, buf+sizeof(buf), fmt, ap); va_end(ap); Bprint(bioout, "%8lux %.8lux %s\n", reg.pc, reg.ir, buf); Bflush(bioout); } void dumpreg(void) { int i; Bprint(bioout, "PC #%-8lux SP #%-8lux CR #%-8lux LR #%-8lux CTR #%-8lux XER #%-8lux\n", reg.pc, reg.r[1], reg.cr, reg.lr, reg.ctr, reg.xer); for(i = 0; i < 32; i++) { if((i%4) == 0 && i != 0) Bprint(bioout, "\n"); Bprint(bioout, "R%-2d #%-8lux ", i, reg.r[i]); } Bprint(bioout, "\n"); } void dumpfreg(void) { dumpdreg(); } void dumpdreg(void) { int i; char buf[64]; FPdbleword d; i = 0; while(i < 32) { d.x = reg.fd[i]; ieeedftos(buf, sizeof(buf), d.hi, d.lo); Bprint(bioout, "F%-2d %s\t", i, buf); i++; d.x = reg.fd[i]; ieeedftos(buf, sizeof(buf), d.hi, d.lo); Bprint(bioout, "\tF%-2d %s\n", i, buf); i++; } } void * emalloc(ulong size) { void *a; a = malloc(size); if(a == 0) fatal(0, "no memory"); memset(a, 0, size); return a; } void * erealloc(void *a, ulong oldsize, ulong size) { void *n; n = malloc(size); if(n == 0) fatal(0, "no memory"); memset(n, 0, size); if(size > oldsize) size = oldsize; memmove(n, a, size); return n; }