ref: 5c1feb0ef0b795e5de71e956f9ccddcd5c4b7f21
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;
}