20060303

1 files changed, 179 insertions, 0 deletions

diff --git a/os/mpc/cpmtimer.c b/os/mpc/cpmtimer.c
new file mode 100644
index 00000000..bda25dcf
--- /dev/null
+++ b/os/mpc/cpmtimer.c
@@ -0,0 +1,179 @@
+#include "u.h"
+#include "lib.h"
+#include "mem.h"
+#include "dat.h"
+#include "fns.h"
+#include "io.h"
+
+enum {
+	Ntimer = 4	/* maximum allowed by hardware */
+};
+
+static struct {
+	Lock;
+	int	init;
+	int	ntimer;	/* actual timers on this chip revision */
+	GTimer	t[Ntimer];
+} cpmtimers;
+
+static	uchar	timerirq[] = {0x19, 0x12, 0x0C, 0x07};
+
+static	void	gtimerinit(int, ushort*, ushort*);
+
+static void
+gtimerreset(void)
+{
+	IMM *io;
+	int i;
+
+	ilock(&cpmtimers);
+	if(!cpmtimers.init){
+		if(m->cputype == 0x50 && (getimmr() & 0xFFFF) <= 0x2001)
+			cpmtimers.ntimer = 2;
+		else
+			cpmtimers.ntimer = Ntimer;
+		io = m->iomem;
+		io->tgcr = 0x2222;	/* reset timers, low-power stop */
+		for(i=0; i<cpmtimers.ntimer; i++)
+			gtimerinit(i, &io->tmr1+i, &io->ter1+i);
+		cpmtimers.init = 1;
+	}
+	iunlock(&cpmtimers);
+}
+
+static void
+gtimerintr(Ureg *ur, void *arg)
+{
+	GTimer *t;
+
+	t = arg;
+	t->event = *t->ter;
+	*t->ter = t->event;
+	if(t->inuse && t->interrupt != nil)
+		t->interrupt(ur, t->arg, t);
+}
+
+static void
+gtimerinit(int i, ushort *tmr, ushort *ter)
+{
+	GTimer *t;
+	char name[KNAMELEN];
+
+	snprint(name, sizeof(name), "timer.%d", i);
+	t = &cpmtimers.t[i];
+	t->x = i*4;	/* field in tgcr */
+	t->inuse = 0;
+	t->interrupt = nil;
+	t->tmr = tmr;
+	t->trr = tmr+2;
+	t->tcr = tmr+4;
+	t->tcn = tmr+6;
+	t->ter = ter;
+	intrenable(VectorCPIC+timerirq[i], gtimerintr, t, BUSUNKNOWN, name);
+}
+
+GTimer*
+gtimer(ushort mode, ushort ref, void (*intr)(Ureg*,void*,GTimer*), void *arg)
+{
+	GTimer *t;
+	int i;
+
+	t = cpmtimers.t;
+	if(!cpmtimers.init)
+		gtimerreset();
+	ilock(&cpmtimers);
+	for(i=0; ; i++){
+		if(i >= cpmtimers.ntimer){
+			iunlock(&cpmtimers);
+			return nil;
+		}
+		if(t->inuse == 0)
+			break;
+		t++;
+	}
+	t->inuse = 1;
+	t->interrupt = intr;
+	t->arg = arg;
+	m->iomem->tgcr &= ~(0xF<<t->x);	/* reset */
+	*t->tmr = mode;
+	*t->tcn = 0;
+	*t->trr = ref;
+	*t->ter = 0xFFFF;
+	iunlock(&cpmtimers);
+	return t;
+}
+
+void
+gtimerset(GTimer *t, ushort mode, int usec)
+{
+	ulong ref, ps;
+	int clk;
+
+	if(usec <= 0)
+		return;
+	ref = usec*m->speed;
+	clk = mode & (3<<1);
+	if(ref >= 0x1000000 && clk == TimerSclk){
+		mode = (mode & ~clk) | TimerSclk16;
+		ref >>= 4;
+	} else if(clk == TimerSclk16)
+		ref >>= 4;
+	ps = (ref+(1<<16))/(1<<16);	/* round up */
+	ref /= ps;
+	*t->tmr = ((ps-1)<<8) | (mode&0xFF);
+	*t->trr = ref;
+}
+
+void
+gtimerstart(GTimer *t)
+{
+	if(t){
+		ilock(&cpmtimers);
+		m->iomem->tgcr = (m->iomem->tgcr & ~(0xF<<t->x)) | (1<<t->x);	/* enable */
+		iunlock(&cpmtimers);
+	}
+}
+
+void
+gtimerstop(GTimer *t)
+{
+	if(t){
+		ilock(&cpmtimers);
+		m->iomem->tgcr |= 2<<t->x;	/* stop */
+		iunlock(&cpmtimers);
+	}
+}
+
+void
+gtimerfree(GTimer *t)
+{
+	if(t){
+		ilock(&cpmtimers);
+		t->inuse = 0;
+		*t->tmr = 0;	/* disable interrupts */
+		*t->ter = 0xFFFF;
+		m->iomem->tgcr = (m->iomem->tgcr & ~(0xF<<t->x)) | (2<<t->x);	/* reset and stop */
+		iunlock(&cpmtimers);
+	}
+}
+
+#ifdef GTIMETEST
+static void
+gtintr(Ureg*, void*, GTimer*)
+{
+	m->bcsr[4] ^= DisableVideoLamp;	/* toggle an LED */
+}
+
+void
+gtimetest(void)
+{
+	GTimer *g;
+
+	g = gtimer(0, 0, gtintr, nil);
+	gtimerset(g, TimerORI|TimerRestart|TimerSclk, 64000);
+	gtimerstart(g);
+	delay(1);
+print("started timer: #%4.4ux #%4.4ux %8.8lux #%4.4ux #%4.4ux\n", *g->tmr, *g->trr, m->iomem->tgcr, *g->tcn, *g->ter);
+print("ter=#%8.8lux tmr=#%8.8lux trr=#%8.8lux\n", g->ter, g->tmr, g->trr);
+}
+#endif