code: 9ferno

ref: e81c54ba2ecc673a4d5f8aed0e9b52841fe07b0d
dir: /os/port/devboot.c/

View raw version
#include	"u.h"
#include	"../port/lib.h"
#include	"mem.h"
#include	"dat.h"
#include	"fns.h"
#include	"../port/error.h"

enum{
	Qdir,
	Qboot,
	Qmem,
	Qkexec,

	Maxkexec = 1536*1024,
};

static 
Dirtab bootdir[]={
	".",			{Qdir, 0, QTDIR},	0,	0555,
	"boot",		{Qboot},	0,	0220,
	"mem",		{Qmem},		0,	0660,
	"kexec",		{Qkexec},		0,	0220,
};

static Chan*
bootattach(char *spec)
{
	return devattach('B', spec);
}

static Walkqid*
bootwalk(Chan *c, Chan *nc, char **name, int nname)
{
	return devwalk(c, nc, name, nname, bootdir, nelem(bootdir), devgen);
}

static int
bootstat(Chan *c, uchar *dp, int n)
{
	return devstat(c, dp, n, bootdir, nelem(bootdir), devgen);
}

static Chan*
bootopen(Chan *c, int omode)
{
	if (c->qid.path == Qkexec) {
		c->aux = malloc(Maxkexec);
		print("kexec buffer: %lux\n", c->aux);
	}
	return devopen(c, omode, bootdir, nelem(bootdir), devgen);
}

static void	 
bootclose(Chan *c)
{
	if(c->qid.path == Qkexec && c->aux != nil){
		print("exec new kernel @%lux\n", (ulong)c->aux);
		splhi();
		segflush(c->aux, 64*1024);
		gotopc((ulong)c->aux);
	}
}

static long	 
bootread(Chan *c, void *buf, long n, vlong offset)
{
	switch((u64)c->qid.path){

	case Qdir:
		return devdirread(c, buf, n, bootdir, nelem(bootdir), devgen);

	case Qmem:
		/* kernel memory */
		if(offset>=KZERO && offset<KZERO+conf.npage*BY2PG){
			if(offset+n > KZERO+conf.npage*BY2PG)
				n = KZERO+conf.npage*BY2PG - offset;
			memmove(buf, (char*)offset, n);
			return n;
		}
		error(Ebadarg);
	}

	error(Egreg);
	return 0;	/* not reached */
}

static long	 
bootwrite(Chan *c, void *buf, long n, vlong offset)
{
	ulong pc;
	uchar *p;

	switch((u64)c->qid.path){
	case Qmem:
		/* kernel memory */
		if(offset>=KZERO && offset<KZERO+conf.npage*BY2PG){
			if(offset+n > KZERO+conf.npage*BY2PG)
				n = KZERO+conf.npage*BY2PG - offset;
			memmove((char*)offset, buf, n);
			segflush((void*)offset, n);
			return n;
		}
		error(Ebadarg);

	case Qboot:
		p = (uchar*)buf;
		pc = (((((p[0]<<8)|p[1])<<8)|p[2])<<8)|p[3];
		if(pc < KZERO || pc >= KZERO+conf.npage*BY2PG)
			error(Ebadarg);
		splhi();
		segflush((void*)pc, 64*1024);
		gotopc(pc);

	case Qkexec:
		print(".");
		if(c->aux != nil && offset <= Maxkexec){
			if(offset+n > Maxkexec)
				n = Maxkexec - offset;
			memmove((char*)c->aux+offset, buf, n);
			segflush((char*)c->aux+offset, n);
			return n;
		}
		free(c->aux);
		c->aux = nil;
		error(Ebadarg);
	}
	error(Ebadarg);
	return 0;	/* not reached */
}

Dev bootdevtab = {
	'B',
	"boot",

	devreset,
	devinit,
	devshutdown,
	bootattach,
	bootwalk,
	bootstat,
	bootopen,
	devcreate,
	bootclose,
	bootread,
	devbread,
	bootwrite,
	devbwrite,
	devremove,
	devwstat,
};