Add supsend and wakeup to pjrc stack

[tmk_firmware.git] / common / suspend.c

diff --git a/common/suspend.c b/common/suspend.c
index 397e0729a60959a9d0754c8423d2819e1315dde6..6029fe7ffa409c2caa3351f3a9d60a16b0bfb7eb 100644 (file)
--- a/common/suspend.c
+++ b/common/suspend.c
@@ -44,8 +44,27 @@ bool suspend_wakeup_condition(void)
     return false;
 }
 
+// run immediately after wakeup
 void suspend_wakeup_init(void)
 {
+    // clear matrix and keyboard state
     matrix_init();
     clear_keyboard();
 }
+
+#ifndef NO_SUSPEND_POWER_DOWN
+/* watchdog timeout */
+ISR(WDT_vect)
+{
+    /* wakeup from MCU sleep mode */
+/*
+    // blink LED
+    static uint8_t led_state = 0;
+    static uint8_t led_count = 0;
+    led_count++;
+    if ((led_count & 0x07) == 0) {
+        led_set((led_state ^= (1<<USB_LED_CAPS_LOCK)));
+    }
+*/
+}
+#endif