#include "u.h"
#include "../port/lib.h"
#include "mem.h"
#include "dat.h"
#include "fns.h"
#include "io.h"
#include "../port/error.h"
#include "msaturn.h"

enum {
	Isr = Saturn + 0x0400,
	Ipol = Saturn + 0x0404,
	Issr = Saturn + 0x0500,
	Ier = Saturn + 0x0504,
	Ipri = Saturn + 0x0600,
	Ithresh = Saturn + 0x0706,
#define Iar	Ithresh
};

enum{
	Syscfg = Saturn + 0x0100,
};

static uchar intprio[] = {
		Vecuart0,			// uart 0
		Vecunused,		// uart 1
		Vecunused,		// sint
		Vectimer0,		// timer 0
		Vecunused,		// timer 1
		Vecether,			// ethernet
		Vecunused,		// tea
		Vecunused,		// irq0	
		Vecunused,		// irq1	
		Vecunused,		// irq2	
		Vecunused,		// irq3	
		Vecunused,		// irq4	
		Vecunused,		// irq5	
		Vecunused,		// irq6	
		Vecunused,		// irq7	
		Vecunused,		// irq8	
};

void
intend(int)
{
}

void
hwintrinit(void)
{
	int i;

	*(ulong*)Ier=0;

	for(i=0; i<nelem(intprio)/2; i++)
		((uchar*)Ipri)[i] = (intprio[2*i]<<4)|intprio[2*i+1];
}

int
vectorenable(Vctl*v)
{
	int i;

	for(i=0; i<nelem(intprio); i++)
		if(v->irq==intprio[i]){
			*(ulong*)Ier |= 1<<(31-i);
			return v->irq;
		}
	print("intrenable: cannot enable intr %d\n", v->irq);
	return -1;
}

void
vectordisable(Vctl*v)
{
	int i;

	for(i=0; i<nelem(intprio); i++)
		if(v->irq==intprio[i]){
			*(ulong*)Ier &= ~(1<<(31-i));
			return;
		}
}

int
intvec(void)
{
	ushort iar;
	int i;

	iar = *(ushort*)Iar;		// push(prio) onto stack
	for(i=0; i<nelem(intprio); i++)
		if(iar==intprio[i])
			return iar;
		
	iprint("saturnint: no vector %d\n", iar);
	intack();
	return -1;
}

void
intack(void)
{
	*(ushort*)Ithresh = 0;	// pop(prio) stack
}

void
machinit(void)
{
	int rrate;
	ulong hid;
	extern char* plan9inistr;
	ulong l2cr;

	memset(m, 0, sizeof(*m));
	m->cputype = getpvr()>>16;
	m->imap = (Imap*)INTMEM;

	m->loopconst = 1096;

	rrate = (*(ushort*)Syscfg >> 6) & 3;
	switch(rrate){
	case 0:
		m->bushz = 66666666;
		break;
	case 1:
		m->bushz = 83333333;
		break;
	case 2:
		m->bushz = 100000000;
		break;
	case 3:
		m->bushz = 133333333;
		break;
	}

	if(getpll() == 0x80000000)
		m->cpuhz = 300000000;
	else
		m->cpuhz = 200000000;		/* 750FX? */
	m->cyclefreq = m->bushz / 4;

	active.machs = 1;
	active.exiting = 0;

	putmsr(getmsr() | MSR_ME);

	dcflush((void*)KZERO, 0x2000000);
	l2cr = getl2cr();
	putl2cr(l2cr|BIT(10));

	kfpinit();

	hid=gethid0();
	hid |= BIT(28)|BIT(26)|BIT(24);
	puthid0(hid);

	plan9inistr =
		"console=0\n"
		"ether0=type=saturn\n"
		"fs=135.104.9.42\n"
		"auth=135.104.9.7\n"
		"authdom=cs.bell-labs.com\n"
		"sys=ucu\n"
		"ntp=135.104.9.52\n";
}

void
sharedseginit(void)
{
}

void
trapinit(void)
{
	int i;

	for(i = 0x0; i < 0x2000; i += 0x100)
		sethvec(i, trapvec);

	dcflush(KADDR(0), 0x2000);
	icflush(KADDR(0), 0x2000);

	putmsr(getmsr() & ~MSR_IP);
}

void
reboot(void*, void*, ulong)
{
}