123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449 |
- /*
- * This file is part of the UCB release of Plan 9. It is subject to the license
- * terms in the LICENSE file found in the top-level directory of this
- * distribution and at http://akaros.cs.berkeley.edu/files/Plan9License. No
- * part of the UCB release of Plan 9, including this file, may be copied,
- * modified, propagated, or distributed except according to the terms contained
- * in the LICENSE file.
- */
- #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;
- uint32_t textbase;
- Biobuf bp, bi;
- Fhdr fhdr;
- uint32_t 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)
- {
- uint32_t 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(uint8_t*));
- iprofsize = (s->end-s->base)/PROFGRAN;
- iprof = emalloc(iprofsize*sizeof(int32_t));
- 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(uint8_t*));
- s = &memory.seg[Bss];
- s->type = Bss;
- s->base = d;
- s->end = d+(b-d);
- s->table = emalloc(((s->end-s->base)/BY2PG)*sizeof(uint8_t*));
- s = &memory.seg[Stack];
- s->type = Stack;
- s->base = STACKTOP-STACKSIZE;
- s->end = STACKTOP;
- s->table = emalloc(((s->end-s->base)/BY2PG)*sizeof(uint8_t*));
- 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;
- }
- uint32_t
- greg(int f, uint32_t off)
- {
- int n;
- uint32_t l;
- uint8_t 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;
- }
- uint32_t
- 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, uint32_t vastart, uint32_t 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;
- uint32_t 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(uint8_t*));
- }
- 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(uint8_t*));
- }
- 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(uint8_t*);
- 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[])
- {
- uint32_t 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(uint32_t) + 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(uint32_t size)
- {
- void *a;
- a = malloc(size);
- if(a == 0)
- fatal(0, "no memory");
- memset(a, 0, size);
- return a;
- }
- void *
- erealloc(void *a, uint32_t oldsize, uint32_t 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;
- }
|