X-Git-Url: https://www.fi.muni.cz/~kas/git//home/kas/public_html/git/?a=blobdiff_plain;f=firmware%2Fmain.c;h=a83884b86f9408101f9bbf3a2bc91fa010b7b1be;hb=4728997cb5f6eff94c8a9d9e253d1675b7516987;hp=26b8f1c9ea8af83419e5157a65c9e7564dc3fa98;hpb=5160421f0d1725356e74a24b334e68eaaa9b398c;p=bike-lights.git

diff --git a/firmware/main.c b/firmware/main.c
index 26b8f1c..a83884b 100644
--- a/firmware/main.c
+++ b/firmware/main.c
@@ -3,14 +3,11 @@
 #include <avr/sleep.h>
 #include <avr/interrupt.h>
 #include <avr/power.h>
-#include <avr/wdt.h>
 
 #include "lights.h"
 
 static void hw_setup()
 {
-	wdt_enable(WDTO_1S);
-
 	init_battery();
 	init_pwm();
 	init_adc();
@@ -21,6 +18,7 @@ static void hw_setup()
 	init_gpio();
 	init_ambient();
 	init_pattern();
+	init_control();
 
 	set_sleep_mode(SLEEP_MODE_IDLE);
 }
@@ -31,9 +29,8 @@ static void hw_suspend()
 	susp_adc();
 	susp_tmr();
 	susp_gpio();
+	susp_ambient();
 	susp_buttons();
-
-	wdt_disable();
 }
 
 void power_down()
@@ -74,8 +71,20 @@ int main(void)
 	sei();
 #if 1
 	while (1) {
-		wdt_reset();
-		sleep_mode();
+		cli();
+		if (TIMER1_IS_ON()) {
+			set_sleep_mode(SLEEP_MODE_IDLE);
+		} else if (adc_is_on) {
+			set_sleep_mode(SLEEP_MODE_ADC);
+		} else {
+			set_sleep_mode(SLEEP_MODE_PWR_DOWN);
+		}
+
+		sleep_enable();
+		// keep BOD active, no sleep_bod_disable();
+		sei();
+		sleep_cpu();
+		sleep_disable();
 	}
 #endif