Add wakeup source mechanism

Should reduce amount of cpu wakeups with expensive computations.

1 files changed, 3 insertions, 10 deletions

diff --git a/ui.c b/ui.c
index 7bd393d..9175133 100644
--- a/ui.c
+++ b/ui.c
@@ -266,14 +266,6 @@ static void doInit () {
 	}
 }
 
-/*	Sleep CPU
- */
-static void cpuSleep () {
-	sleep_enable ();
-	sleep_cpu ();
-	sleep_disable ();
-}
-
 /*	Main loop
  */
 void uiLoop () {
@@ -329,7 +321,7 @@ void uiLoop () {
 
 	while (1) {
 		processSensors ();
-		
+
 		horizon newh = accelGetHorizon ();
 		if (newh != h) {
 			horizonChanged = true;
@@ -367,7 +359,8 @@ void uiLoop () {
 				assert (0 && "invalid ui mode");
 				break;
 		}
-		cpuSleep ();
+
+		sleepwhile (wakeup == 0);
 
 #if 0
 		printf ("t=%i, h=%i, s=%i\n", gyroGetZTicks (), accelGetHorizon (),