1 files changed, 106 insertions, 0 deletions
diff --git a/arch/mips/baget/time.c b/arch/mips/baget/time.c
new file mode 100644
index 000000000..b24f5b93e
--- /dev/null
+++ b/arch/mips/baget/time.c
@@ -0,0 +1,106 @@
+/* $Id$
+ * time.c: Baget/MIPS specific time handling details
+ *
+ * Copyright (C) 1998 Gleb Raiko & Vladimir Roganov
+ */
+
+#include <linux/errno.h>
+#include <linux/init.h>
+#include <linux/sched.h>
+#include <linux/kernel.h>
+#include <linux/param.h>
+#include <linux/string.h>
+#include <linux/mm.h>
+#include <linux/interrupt.h>
+#include <linux/timex.h>
+#include <linux/kernel_stat.h>
+
+#include <asm/bootinfo.h>
+#include <asm/io.h>
+#include <asm/irq.h>
+#include <asm/ptrace.h>
+#include <asm/system.h>  
+
+#include <asm/baget/baget.h>
+
+/* 
+ *  To have precision clock, we need to fix available clock frequency
+ */
+#define FREQ_NOM  79125  /* Baget frequency ratio */
+#define FREQ_DEN  10000
+static inline int timer_intr_valid() 
+{
+	static unsigned long long ticks, valid_ticks;
+
+	if (ticks++ * FREQ_DEN >= valid_ticks * FREQ_NOM) {
+		/* 
+		 *  We need no overflow checks, 
+		 *  due baget unable to work 3000 years...
+		 *  At least without reboot...
+		 */
+		valid_ticks++;
+		return 1;
+	}
+	return 0;
+}
+
+void static timer_interrupt(int irq, void *dev_id, struct pt_regs * regs)
+{
+	if (timer_intr_valid()) {
+	sti();
+	do_timer(regs);
+	}
+}
+
+__initfunc(static void rtc_enable(void))
+{
+        short ic;
+
+        ic = vac_inw(VAC_INT_CTRL) ;
+        vac_outw(ic & 0xfffc, VAC_INT_CTRL);
+        vac_outw(ic, VAC_INT_CTRL);
+	vic_outb(0xb9 & 0x7f, VIC_LINT6); 
+}
+
+__initfunc(static void timer_enable(void))
+{
+	unsigned char ss0cr0 = vic_inb(VIC_SS0CR0);
+	ss0cr0 &= ~VIC_SS0CR0_TIMER_FREQ_MASK;
+	ss0cr0 |= VIC_SS0CR0_TIMER_FREQ_1000HZ;
+	vic_outb(ss0cr0, VIC_SS0CR0);
+
+	vic_outb(VIC_INT_IPL(6)|VIC_INT_NOAUTO|VIC_INT_EDGE|
+		 VIC_INT_LOW|VIC_INT_ENABLE, VIC_LINT2); 
+}
+
+__initfunc(void time_init(void))
+{
+	if (request_irq(BAGET_VIC_TIMER_IRQ, timer_interrupt, 
+			SA_INTERRUPT|SA_STATIC_ALLOC, "timer", NULL) < 0) 
+		printk("time_init: unable request irq for system timer\n");
+
+	timer_enable();
+
+	/* We don't call sti() here, because it is too early for baget */
+}
+
+void do_gettimeofday(struct timeval *tv)
+{
+        unsigned long flags;
+
+        save_and_cli(flags);
+        *tv = xtime;
+        restore_flags(flags);
+}
+
+void do_settimeofday(struct timeval *tv)
+{
+        unsigned long flags;
+  
+        save_and_cli(flags);
+        xtime = *tv;
+        time_state = TIME_BAD;
+        time_maxerror = MAXPHASE;
+        time_esterror = MAXPHASE;
+        restore_flags(flags);
+}