/*  * 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;ulong	textbase;Biobuf	bp, bi;Fhdr	fhdr;ulong	bits[32]; voidmain(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 voidinitmap(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;} voidinithdr(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;} ulonggreg(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;} ulongroff[] = {	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),}; voidseginit(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++;	}} voidprocinit(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"); } voidreset(void){	int i, l, m;	Segment *s;	Breakpoint *b; 	memset(&reg, 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;} voidinitstk(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); } voidfatal(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);} voiditrace(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);} voiddumpreg(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");} voiddumpfreg(void){	dumpdreg();} voiddumpdreg(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;}