1 files changed, 17 insertions, 0 deletions
diff --git a/spaghetti-monster/fsm-standby.c b/spaghetti-monster/fsm-standby.c
index 44a2e0a..5312f94 100644
--- a/spaghetti-monster/fsm-standby.c
+++ b/spaghetti-monster/fsm-standby.c
@@ -40,6 +40,9 @@ void sleep_until_eswitch_pressed()
 
     PCINT_on();  // wake on e-switch event
 
+    // configure sleep mode
+    set_sleep_mode(SLEEP_MODE_PWR_DOWN);
+
     sleep_enable();
     sleep_bod_disable();
     sleep_cpu();  // wait here
@@ -57,4 +60,18 @@ void sleep_until_eswitch_pressed()
     WDT_on();
 }
 
+#ifdef USE_IDLE_MODE
+void idle_mode()
+{
+    // configure sleep mode
+    set_sleep_mode(SLEEP_MODE_IDLE);
+
+    sleep_enable();
+    sleep_cpu();  // wait here
+
+    // something happened; wake up
+    sleep_disable();
+}
+#endif
+
 #endif