From 34c91a6726f42b444955f7e148fc654c89b5898a Mon Sep 17 00:00:00 2001
From: Mariano Alvira <mar@devl.org>
Date: Thu, 21 May 2009 14:52:27 -0400
Subject: [PATCH] this code starts up the 32kHZ clock

---
 include/crm.h   |  2 +-
 include/utils.h |  5 +++++
 tests/sleep.c   | 47 ++++++++++++++++++++++++++++++++++++++++++++---
 3 files changed, 50 insertions(+), 4 deletions(-)

diff --git a/include/crm.h b/include/crm.h
index e7b80710f..0110074c1 100644
--- a/include/crm.h
+++ b/include/crm.h
@@ -16,7 +16,7 @@
 #define CRM_RTC_TIMEOUT  (CRM_BASE+0x2c)
 #define CRM_CAL_CNTL     (CRM_BASE+0x34)
 #define CRM_CAL_COUNT    (CRM_BASE+0x38)
-#define CRM_RINGOSC_CTNL (CRM_BASE+0x3c)
+#define CRM_RINGOSC_CNTL (CRM_BASE+0x3c)
 #define CRM_XTAL_CNTL    (CRM_BASE+0x40)
 #define CRM_XTAL32_CNTL  (CRM_BASE+0x44)
 #define CRM_VREG_CNTL    (CRM_BASE+0x48)
diff --git a/include/utils.h b/include/utils.h
index 87bbf5bb4..21ad6f711 100644
--- a/include/utils.h
+++ b/include/utils.h
@@ -4,4 +4,9 @@
 #define reg32(x) (*(volatile uint32_t *)(x))
 #define reg16(x) (*(volatile uint16_t *)(x))
 
+#define bit(bit) (1<<bit)
+#define bit_is_set(val,bit) (((val & (1<<bit)) >> bit) == 1)
+#define clear_bit(val,bit)  (val=(val & ~(1<<bit)))
+#define set_bit(val,bit)  (val=(val | (1<<bit)))
+
 #endif
diff --git a/tests/sleep.c b/tests/sleep.c
index e7b61b965..08fbc33a0 100644
--- a/tests/sleep.c
+++ b/tests/sleep.c
@@ -24,10 +24,13 @@
 
 #define DELAY 400000
 
+#define USE_32KHZ 1
+
 #include "embedded_types.h"
 #include "isr.h"
 #include "utils.h"
 #include "maca.h"
+#include "crm.h"
 
 void putc(uint8_t c);
 void puts(uint8_t *s);
@@ -113,18 +116,56 @@ __attribute__ ((section ("startup"))) void main(void) {
 
 //	reg16(CRM_XTAL_CNTL) = 0x052; /* default is 0xf52 */ /* doesn't anything w.r.t. power */
 
+#if USE_32KHZ
+	/* turn on the 32kHz crystal */
+	puts("enabling 32kHz crystal\n\r");
+	/* you have to hold it's hand with this on */
+	/* once you start the 32xHz crystal it can only be stopped with a reset (hard or soft) */
+	/* first, disable the ring osc */
+	clear_bit(reg32(CRM_RINGOSC_CNTL),0);
+	/* enable the 32kHZ crystal */
+	set_bit(reg32(CRM_XTAL32_CNTL),0);
+//	reg32(CRM_XTAL_CNTL) = 0;
+
+	/* set the XTAL32_EXISTS bit */
+	/* the datasheet says to do this after you've check that RTC_COUNT is changing */
+	/* the datasheet is not correct */
+	set_bit(reg32(CRM_SYS_CNTL),5);
+	{
+		static volatile uint32_t old;
+		old = reg32(CRM_RTC_COUNT);
+		puts("waiting for xtal\n\r");
+		while(reg32(CRM_RTC_COUNT) == old) { 
+//			put_hex32(reg32(CRM_RTC_COUNT));
+//			puts("\n\r");
+			continue; 
+		}
+		/* RTC has started up */
+
+		set_bit(reg32(CRM_SYS_CNTL),5);
+		puts("32kHZ xtal started\n\r");
+
+/* 		while(1) { */
+/* 			put_hex32(reg32(CRM_RTC_COUNT)); */
+/* 			puts("\n\r"); */
+/* 		} */
+
+	}
+#endif	
+		
+
 	/* go to sleep */
 //	reg32(CRM_WU_CNTL) = 0; /* don't wake up */
-	reg32(CRM_WU_CNTL) = 0x1; /* enable wakeup from wakeup timer */
+//	reg32(CRM_WU_CNTL) = 0x1; /* enable wakeup from wakeup timer */
 //	reg32(CRM_WU_TIMEOUT) = 1875000; /* wake 10 sec later if doze */
-	reg32(CRM_WU_TIMEOUT) = 20000; /* wake 10 sec later  if hibernate w/2kHz*/
+//	reg32(CRM_WU_TIMEOUT) = 20000; /* wake 10 sec later  if hibernate w/2kHz*/
 
 //	reg32(CRM_SLEEP_CNTL) = 1; /* hibernate, RAM page 0 only, don't retain state, don't power GPIO */ /* approx. 2.0uA */
 //	reg32(CRM_SLEEP_CNTL) = 0x41; /* hibernate, RAM page 0 only, retain state, don't power GPIO */ /* approx. 10.0uA */
 //	reg32(CRM_SLEEP_CNTL) = 0x51; /* hibernate, RAM page 0&1 only, retain state, don't power GPIO */ /* approx. 11.7uA */
 //	reg32(CRM_SLEEP_CNTL) = 0x61; /* hibernate, RAM page 0,1,2 only, retain state, don't power GPIO */ /* approx. 13.9uA */
 //	reg32(CRM_SLEEP_CNTL) = 0x71; /* hibernate, all RAM pages, retain state, don't power GPIO */ /* approx. 16.1uA - possibly with periodic refresh*/
-	reg32(CRM_SLEEP_CNTL) = 0xf1; /* hibernate, all RAM pages, retain state,       power GPIO */ /* approx. 16.1uA - possibly with periodic refresh*/
+//	reg32(CRM_SLEEP_CNTL) = 0xf1; /* hibernate, all RAM pages, retain state,       power GPIO */ /* approx. 16.1uA - possibly with periodic refresh*/
 
 //	reg32(CRM_SLEEP_CNTL) = 2; /* doze     , RAM page 0 only, don't retain state, don't power GPIO */ /* approx. 69.2 uA */
 //	reg32(CRM_SLEEP_CNTL) = 0x42; /* doze     , RAM page 0 only, retain state, don't power GPIO */ /* approx. 77.3uA */