read stdio via callback instead of manually

1 files changed, 29 insertions, 24 deletions

diff --git a/src/main.c b/src/main.c
index afcdb30..fa53c3e 100644
--- a/src/main.c
+++ b/src/main.c
@@ -29,6 +29,32 @@ absolute_time_t wifi_connected_time;
 #define LEVEL_START 95.0
 #define LEVEL_END 85.0
 
+static void key_pressed_func(void *param)
+{
+    int input = stdio_getchar_timeout_us(0);
+    if (input != PICO_ERROR_TIMEOUT)
+    {
+        LogDebug("input => %i", input);
+
+        switch(input)
+        {
+            case 'd':
+                LogInfo("disconnecting");
+                modbus_close_connection();
+                break;
+
+            case 'p':
+                LogInfo("rebooting into programming mode");
+                modbus_close_connection();
+                rom_reset_usb_boot_extra(-1, 0, false);
+                break;
+
+            default:
+                break;
+        }
+    }
+}
+
 int main()
 {
     stdio_init_all();
@@ -37,6 +63,9 @@ int main()
     busy_wait_ms(5000);
 #endif
 
+    LogInfo("initializing stdio callback");
+    stdio_set_chars_available_callback(key_pressed_func, NULL);
+
     LogInfo("initializing relay");
     init_relay();
 
@@ -127,30 +156,6 @@ int main()
             }
         }
 
-        LogDebug("checking for inputs");
-        int input = stdio_getchar_timeout_us(0);
-        if (input != PICO_ERROR_TIMEOUT)
-        {
-            LogDebug("input => %i", input);
-
-            switch(input)
-            {
-                case 'd':
-                    LogInfo("disconnecting");
-                    modbus_close_connection();
-                    break;
-
-                case 'p':
-                    LogInfo("rebooting into programming mode");
-                    modbus_close_connection();
-                    rom_reset_usb_boot_extra(-1, 0, false);
-                    break;
-
-                default:
-                    break;
-            }
-        }
-
         if (state != last_state)
         {
             LogInfo("state change %i => %i", last_state, state);