From d114e89ca8223fc37118cfc47768be87b64f1e99 Mon Sep 17 00:00:00 2001
From: Vladimir 'phcoder' Serbinenko <phcoder@gmail.com>
Date: Wed, 9 Dec 2009 17:58:48 +0100
Subject: [PATCH] Add clock

---
 include/grub/mips/yeeloong/memory.h |  2 --
 include/grub/mips/yeeloong/time.h   |  7 +++++--
 include/grub/time.h                 |  2 +-
 kern/mips/yeeloong/init.c           | 14 +++++++++++---
 loader/mips/linux.c                 |  1 +
 5 files changed, 18 insertions(+), 8 deletions(-)

diff --git a/include/grub/mips/yeeloong/memory.h b/include/grub/mips/yeeloong/memory.h
index c85db712a..922db2404 100644
--- a/include/grub/mips/yeeloong/memory.h
+++ b/include/grub/mips/yeeloong/memory.h
@@ -62,8 +62,6 @@ grub_uint64_t grub_mmap_get_upper (void);
 
 extern grub_uint32_t EXPORT_VAR (grub_arch_memsize);
 extern grub_uint32_t EXPORT_VAR (grub_arch_highmemsize);
-extern grub_uint32_t EXPORT_VAR (grub_arch_busclock);
-extern grub_uint32_t EXPORT_VAR (grub_arch_cpuclock);
 
 #endif
 
diff --git a/include/grub/mips/yeeloong/time.h b/include/grub/mips/yeeloong/time.h
index a73f64dea..7f468bf12 100644
--- a/include/grub/mips/yeeloong/time.h
+++ b/include/grub/mips/yeeloong/time.h
@@ -21,10 +21,13 @@
 
 #include <grub/symbol.h>
 
-#define GRUB_TICKS_PER_SECOND	1000
+#define GRUB_TICKS_PER_SECOND	(grub_arch_cpuclock / 2)
 
 /* Return the real time in ticks.  */
-grub_uint32_t EXPORT_FUNC (grub_get_rtc) (void);
+grub_uint64_t EXPORT_FUNC (grub_get_rtc) (void);
+
+extern grub_uint32_t EXPORT_VAR (grub_arch_busclock);
+extern grub_uint32_t EXPORT_VAR (grub_arch_cpuclock);
 
 static inline void
 grub_cpu_idle(void)
diff --git a/include/grub/time.h b/include/grub/time.h
index 115fbd95e..5aafdc9ed 100644
--- a/include/grub/time.h
+++ b/include/grub/time.h
@@ -23,7 +23,7 @@
 #include <grub/symbol.h>
 #include <grub/cpu/time.h>
 
-#ifdef GRUB_MACHINE_EMU
+#if defined (GRUB_MACHINE_EMU) || defined (GRUB_UTIL)
 #define GRUB_TICKS_PER_SECOND 100000
 #else
 #include <grub/machine/time.h>
diff --git a/kern/mips/yeeloong/init.c b/kern/mips/yeeloong/init.c
index 1bd9d2ed9..8b93ac18f 100644
--- a/kern/mips/yeeloong/init.c
+++ b/kern/mips/yeeloong/init.c
@@ -28,12 +28,20 @@
 #include <grub/machine/memory.h>
 #include <grub/cpu/kernel.h>
 
-grub_uint32_t
+/* FIXME: use interrupt to count high.  */
+grub_uint64_t
 grub_get_rtc (void)
 {
-  static grub_uint64_t calln = 0;
+  static grub_uint32_t high = 0;
+  static grub_uint32_t last = 0;
+  grub_uint32_t low;
 
-  return (calln++) >> 8;
+  asm volatile ("mfc0 %0, $9": "=r" (low));
+  if (low < last)
+    high++;
+  last = low;
+
+  return (((grub_uint64_t) high) << 32) | low;
 }
 
 grub_err_t
diff --git a/loader/mips/linux.c b/loader/mips/linux.c
index bb71d63e9..8d7cda0ed 100644
--- a/loader/mips/linux.c
+++ b/loader/mips/linux.c
@@ -30,6 +30,7 @@
 
 /* For frequencies.  */
 #include <grub/pci.h>
+#include <grub/machine/time.h>
 
 #define ELF32_LOADMASK (0x00000000UL)
 #define ELF64_LOADMASK (0x0000000000000000ULL)