X-Git-Url: https://www.fi.muni.cz/~kas/git//home/kas/public_html/git/?p=bike-lights.git;a=blobdiff_plain;f=firmware%2Fmain.c;h=0e3395779e9c7a2c84afd71d912ef4b64868bb9f;hp=efebdabafb5d2aa30571b65e49ca1683b006a2c6;hb=90ffd122f4387d18e8d7cf7d2a507c719409d4e5;hpb=f956c1fa7f47b0e8b8afe323c2eff1b6c2607c2a

diff --git a/firmware/main.c b/firmware/main.c
index efebdab..0e33957 100644
--- a/firmware/main.c
+++ b/firmware/main.c
@@ -2,40 +2,75 @@
 #include <util/delay.h>
 #include <avr/sleep.h>
 #include <avr/interrupt.h>
-#include <avr/wdt.h>
+#include <avr/power.h>
 
 #include "lights.h"
 
-void hw_setup()
+static void hw_setup()
 {
+	init_battery();
 	init_pwm();
 	init_adc();
 	init_tmr();
 	init_buttons();
 
-	pwmled_init();
-	gpio_init();
-	ambient_init();
-	pattern_init();
+	init_pwmled();
+	init_gpio();
+	init_ambient();
+	init_pattern();
+	init_control();
 
 	set_sleep_mode(SLEEP_MODE_IDLE);
 }
 
-int main(void)
+static void hw_suspend()
+{
+	susp_pwm();
+	susp_adc();
+	susp_tmr();
+	susp_gpio();
+	susp_ambient();
+	susp_buttons();
+}
+
+void power_down()
 {
-	log_init();
-	wdt_enable(WDTO_1S);
+	hw_suspend();
 
-	_delay_ms(100);
+	do {
+		// G'night
+		set_sleep_mode(SLEEP_MODE_PWR_DOWN);
+		sleep_enable();
+		sleep_bod_disable();
+		sei();
+		sleep_cpu();
 
+		// G'morning
+		cli();
+		sleep_disable();
+
+		// allow wakeup by long button-press only
+	} while (!buttons_wait_for_release());
+
+	// ok, so I will wake up
 	hw_setup();
+}
+
+int main(void)
+{
+	init_log();
+
+	power_usi_disable(); // Once for lifetime
+	ACSRA |= _BV(ACD);   // disable analog comparator
 
 	log_set_state(3);
 
+	hw_setup();
+	power_down();
+
 	sei();
 #if 1
 	while (1) {
-		wdt_reset();
 		sleep_mode();
 	}
 #endif