initial import of openbios--main--1.0--patch-26

git-svn-id: svn://coreboot.org/openbios/openbios-devel@1 f158a5a8-5612-0410-a976-696ce0be7e32

1 files changed, 104 insertions, 0 deletions

diff --git a/drivers/timer.c b/drivers/timer.c
new file mode 100644
index 0000000..6b58ea1
--- /dev/null
+++ b/drivers/timer.c
@@ -0,0 +1,104 @@
+/*
+ *   OpenBIOS native timer driver
+ *
+ *   (C) 2004 Stefan Reinauer <stepan@openbios.org>
+ *
+ *   This program is free software; you can redistribute it and/or
+ *   modify it under the terms of the GNU General Public License
+ *   version 2
+ *
+ */
+
+#include "openbios/config.h"
+#include "timer.h"
+#include "asm/io.h"
+
+#if defined(CONFIG_X86) || defined(CONFIG_AMD64)
+
+void setup_timers(void)
+{
+	/* nothing to do */
+}
+
+static void load_timer2(unsigned int ticks)
+{
+	/* Set up the timer gate, turn off the speaker */
+	outb((inb(PPC_PORTB) & ~PPCB_SPKR) | PPCB_T2GATE, PPC_PORTB);
+	outb(TIMER2_SEL | WORD_ACCESS | MODE0 | BINARY_COUNT,
+	     TIMER_MODE_PORT);
+	outb(ticks & 0xFF, TIMER2_PORT);
+	outb(ticks >> 8, TIMER2_PORT);
+}
+
+void udelay(unsigned int usecs)
+{
+	load_timer2((usecs * TICKS_PER_MS) / 1000);
+	while ((inb(PPC_PORTB) & PPCB_T2OUT) == 0);
+}
+
+unsigned long currticks(void)
+{
+	static unsigned long totticks = 0UL;	/* High resolution */
+	unsigned long ticks = 0;
+	unsigned char portb = inb(PPC_PORTB);
+
+	/* 
+	 * Read the timer, and hope it hasn't wrapped around 
+	 * (call this again within 54ms), then restart it 
+	 */
+	outb(TIMER2_SEL | LATCH_COUNT, TIMER_MODE_PORT);
+	ticks = inb(TIMER2_PORT);
+	ticks |= inb(TIMER2_PORT) << 8;
+	outb(TIMER2_SEL | WORD_ACCESS | MODE0 | BINARY_COUNT,
+	     TIMER_MODE_PORT);
+	outb(0, TIMER2_PORT);
+	outb(0, TIMER2_PORT);
+
+	/* 
+	 * Check if the timer was running. If not, 
+	 * result is rubbish and need to start it 
+	 */
+	if (portb & PPCB_T2GATE) {
+		totticks += (0x10000 - ticks);
+	} else {
+		/* Set up the timer gate, turn off the speaker */
+		outb((portb & ~PPCB_SPKR) | PPCB_T2GATE, PPC_PORTB);
+	}
+	return totticks / TICKS_PER_MS;
+}
+#endif
+
+#ifdef CONFIG_PPC
+
+void setup_timers(void)
+{
+	/* nothing to do */
+}
+
+/*
+ * TODO: pass via lb table
+ */
+
+unsigned long get_timer_freq()
+{
+	return 100000000 / 4;
+}
+
+void udelay(unsigned int usecs)
+{
+	extern void _wait_ticks(unsigned long);
+	unsigned long ticksperusec = get_timer_freq() / 1000000;
+	_wait_ticks(ticksperusec * usecs);
+}
+
+#endif
+
+void ndelay(unsigned int nsecs)
+{
+	udelay((nsecs + 999) / 1000);
+}
+
+void mdelay(unsigned int msecs)
+{
+	udelay(msecs * 1000);
+}