Start on converting gpio expander interupts to fsm events

1 files changed, 38 insertions, 0 deletions

diff --git a/src/system_fsm/system_fsm.cpp b/src/system_fsm/system_fsm.cpp
index c59c0908..dd5161ed 100644
--- a/src/system_fsm/system_fsm.cpp
+++ b/src/system_fsm/system_fsm.cpp
@@ -5,6 +5,8 @@
  */
 
 #include "system_fsm.hpp"
+#include "audio_fsm.hpp"
+#include "event_queue.hpp"
 #include "relative_wheel.hpp"
 #include "system_events.hpp"
 
@@ -28,6 +30,42 @@ void SystemState::react(const FatalError& err) {
   }
 }
 
+void SystemState::react(const internal::GpioInterrupt& ev) {
+  ESP_LOGI("sys", "gpios changed");
+  bool prev_key_up = sGpioExpander->get_input(drivers::GpioExpander::KEY_UP);
+  bool prev_key_down =
+      sGpioExpander->get_input(drivers::GpioExpander::KEY_DOWN);
+  bool prev_key_lock =
+      sGpioExpander->get_input(drivers::GpioExpander::KEY_LOCK);
+  bool prev_has_headphones =
+      sGpioExpander->get_input(drivers::GpioExpander::PHONE_DETECT);
+
+  sGpioExpander->Read();
+
+  bool key_up = sGpioExpander->get_input(drivers::GpioExpander::KEY_UP);
+  bool key_down = sGpioExpander->get_input(drivers::GpioExpander::KEY_DOWN);
+  bool key_lock = sGpioExpander->get_input(drivers::GpioExpander::KEY_LOCK);
+  bool has_headphones =
+      sGpioExpander->get_input(drivers::GpioExpander::PHONE_DETECT);
+
+  if (key_up != prev_key_up) {
+    events::Dispatch<KeyUpChanged, audio::AudioState, ui::UiState>(
+        {.falling = prev_key_up});
+  }
+  if (key_down != prev_key_down) {
+    events::Dispatch<KeyDownChanged, audio::AudioState, ui::UiState>(
+        {.falling = prev_key_down});
+  }
+  if (key_lock != prev_key_lock) {
+    events::Dispatch<KeyLockChanged, SystemState, ui::UiState>(
+        {.falling = prev_key_lock});
+  }
+  if (has_headphones != prev_has_headphones) {
+    events::Dispatch<HasPhonesChanged, audio::AudioState>(
+        {.falling = prev_has_headphones});
+  }
+}
+
 }  // namespace system_fsm
 
 FSM_INITIAL_STATE(system_fsm::SystemState, system_fsm::states::Booting)