WIP state machine builds

2020-02-22 12:01:59 -08:00
parent 045529d91f
commit 509f9b6e2b
10 changed files with 174 additions and 55 deletions
--- a/src/PowerFSM.cpp
+++ b/src/PowerFSM.cpp
@@ -0,0 +1,106 @@
+
+#include "sleep.h"
+#include "MeshService.h"
+#include "NodeDB.h"
+#include "configuration.h"
+#include "screen.h"
+#include "PowerFSM.h"
+
+static void sdsEnter()
+{
+    /*
+
+  // Don't deepsleep if we have USB power or if the user as pressed a button recently
+  // !isUSBPowered <- doesn't work yet because the axp192 isn't letting the battery fully charge when we are awake - FIXME
+  if (millis() - lastPressMs > radioConfig.preferences.mesh_sds_timeout_secs)
+  {
+    doDeepSleep(radioConfig.preferences.sds_secs);
+  }
+*/
+
+    doDeepSleep(radioConfig.preferences.sds_secs * 1000LL);
+}
+
+static void lsEnter()
+{
+/*
+      // while we have bluetooth on, we can't do light sleep, but once off stay in light_sleep all the time
+  // we will wake from light sleep on button press or interrupt from the RF95 radio
+  if (!bluetoothOn && !is_screen_on() && service.radio.rf95.canSleep() && gps.canSleep())
+    doLightSleep(radioConfig.preferences.ls_secs); 
+  else
+  {
+    delay(msecstosleep);
+  } */
+
+    doLightSleep(radioConfig.preferences.ls_secs * 1000LL);
+}
+
+static void lsIdle()
+{
+    // FIXME - blink led when we occasionally wake from timer, then go back to light sleep
+}
+
+static void lsExit()
+{
+    // nothing
+}
+
+static void nbEnter()
+{
+    setBluetoothEnable(false);
+}
+
+static void darkEnter()
+{
+    DEBUG_MSG("screen timeout, turn it off for now...\n");
+    screen.setOn(true);
+}
+
+static void onEnter()
+{
+    screen.setOn(true);
+    setBluetoothEnable(true);
+}
+
+static void onExit()
+{
+    screen.setOn(false);
+}
+static void wakeForPing()
+{
+}
+
+static void screenPress()
+{
+    screen.onPress();
+}
+
+State stateSDS(sdsEnter, NULL, NULL);
+State stateLS(lsEnter, lsIdle, lsExit);
+State stateNB(nbEnter, NULL, NULL);
+State stateDARK(darkEnter, NULL, NULL);
+State stateON(onEnter, NULL, onExit);
+Fsm powerFSM(&stateDARK);
+
+void PowerFSM_setup()
+{
+    powerFSM.add_transition(&stateDARK, &stateON, EVENT_BOOT, NULL);
+    powerFSM.add_transition(&stateLS, &stateDARK, EVENT_WAKE_TIMER, wakeForPing);
+    powerFSM.add_transition(&stateLS, &stateNB, EVENT_RECEIVED_PACKET, NULL);
+
+    powerFSM.add_transition(&stateLS, &stateON, EVENT_PRESS, NULL);
+    powerFSM.add_transition(&stateNB, &stateON, EVENT_PRESS, NULL);
+    powerFSM.add_transition(&stateDARK, &stateON, EVENT_PRESS, NULL);
+    powerFSM.add_transition(&stateON, &stateON, EVENT_PRESS, screenPress); // reenter On to restart our timers
+
+    powerFSM.add_transition(&stateLS, &stateON, EVENT_RECEIVED_TEXT_MSG, NULL);
+    powerFSM.add_transition(&stateNB, &stateON, EVENT_RECEIVED_TEXT_MSG, NULL);
+    powerFSM.add_transition(&stateDARK, &stateON, EVENT_RECEIVED_TEXT_MSG, NULL);
+
+    powerFSM.add_transition(&stateNB, &stateDARK, EVENT_PACKET_FOR_PHONE, NULL);
+
+    powerFSM.add_timed_transition(&stateON, &stateDARK, radioConfig.preferences.screen_on_secs, NULL);
+
+    powerFSM.add_timed_transition(&stateDARK, &stateNB, radioConfig.preferences.phone_timeout_secs, NULL);
+}