mirror of
https://github.com/meshtastic/firmware.git
synced 2025-02-04 03:39:56 +00:00
256 lines
10 KiB
C++
256 lines
10 KiB
C++
|
|
#include "PowerFSM.h"
|
|
#include "GPS.h"
|
|
#include "MeshService.h"
|
|
#include "NodeDB.h"
|
|
#include "configuration.h"
|
|
#include "graphics/Screen.h"
|
|
#include "main.h"
|
|
#include "sleep.h"
|
|
#include "target_specific.h"
|
|
|
|
static void sdsEnter()
|
|
{
|
|
// FIXME - make sure GPS and LORA radio are off first - because we want close to zero current draw
|
|
doDeepSleep(getPref_sds_secs() * 1000LL);
|
|
}
|
|
|
|
#include "error.h"
|
|
|
|
static uint32_t secsSlept;
|
|
|
|
static void lsEnter()
|
|
{
|
|
DEBUG_MSG("lsEnter begin, ls_secs=%u\n", getPref_ls_secs());
|
|
screen.setOn(false);
|
|
secsSlept = 0; // How long have we been sleeping this time
|
|
|
|
DEBUG_MSG("lsEnter end\n");
|
|
}
|
|
|
|
static void lsIdle()
|
|
{
|
|
// DEBUG_MSG("lsIdle begin ls_secs=%u\n", getPref_ls_secs());
|
|
|
|
#ifndef NO_ESP32
|
|
esp_sleep_source_t wakeCause = ESP_SLEEP_WAKEUP_UNDEFINED;
|
|
|
|
// Do we have more sleeping to do?
|
|
if (secsSlept < getPref_ls_secs()) {
|
|
// Briefly come out of sleep long enough to blink the led once every few seconds
|
|
uint32_t sleepTime = 30;
|
|
|
|
// If some other service would stall sleep, don't let sleep happen yet
|
|
if (doPreflightSleep()) {
|
|
setLed(false); // Never leave led on while in light sleep
|
|
wakeCause = doLightSleep(sleepTime * 1000LL);
|
|
|
|
switch (wakeCause) {
|
|
case ESP_SLEEP_WAKEUP_TIMER:
|
|
// Normal case: timer expired, we should just go back to sleep ASAP
|
|
|
|
setLed(true); // briefly turn on led
|
|
wakeCause = doLightSleep(1); // leave led on for 1ms
|
|
|
|
secsSlept += sleepTime;
|
|
// DEBUG_MSG("sleeping, flash led!\n");
|
|
break;
|
|
|
|
case ESP_SLEEP_WAKEUP_UART:
|
|
// Not currently used (because uart triggers in hw have problems)
|
|
powerFSM.trigger(EVENT_SERIAL_CONNECTED);
|
|
break;
|
|
|
|
default:
|
|
// We woke for some other reason (button press, device interrupt)
|
|
// uint64_t status = esp_sleep_get_ext1_wakeup_status();
|
|
DEBUG_MSG("wakeCause %d\n", wakeCause);
|
|
|
|
#ifdef BUTTON_PIN
|
|
bool pressed = !digitalRead(BUTTON_PIN);
|
|
#else
|
|
bool pressed = false;
|
|
#endif
|
|
if (pressed) // If we woke because of press, instead generate a PRESS event.
|
|
{
|
|
powerFSM.trigger(EVENT_PRESS);
|
|
} else {
|
|
// Otherwise let the NB state handle the IRQ (and that state will handle stuff like IRQs etc)
|
|
// we lie and say "wake timer" because the interrupt will be handled by the regular IRQ code
|
|
powerFSM.trigger(EVENT_WAKE_TIMER);
|
|
}
|
|
break;
|
|
}
|
|
} else {
|
|
// Someone says we can't sleep now, so just save some power by sleeping the CPU for 100ms or so
|
|
delay(100);
|
|
}
|
|
} else {
|
|
// Time to stop sleeping!
|
|
setLed(false);
|
|
DEBUG_MSG("reached ls_secs, servicing loop()\n");
|
|
powerFSM.trigger(EVENT_WAKE_TIMER);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
static void lsExit()
|
|
{
|
|
// setGPSPower(true); // restore GPS power
|
|
gps->forceWake(true);
|
|
}
|
|
|
|
static void nbEnter()
|
|
{
|
|
screen.setOn(false);
|
|
setBluetoothEnable(false);
|
|
|
|
// FIXME - check if we already have packets for phone and immediately trigger EVENT_PACKETS_FOR_PHONE
|
|
}
|
|
|
|
static void darkEnter()
|
|
{
|
|
setBluetoothEnable(true);
|
|
screen.setOn(false);
|
|
}
|
|
|
|
static void serialEnter()
|
|
{
|
|
setBluetoothEnable(false);
|
|
screen.setOn(true);
|
|
}
|
|
|
|
static void powerEnter()
|
|
{
|
|
screen.setOn(true);
|
|
setBluetoothEnable(true);
|
|
}
|
|
|
|
static void onEnter()
|
|
{
|
|
screen.setOn(true);
|
|
setBluetoothEnable(true);
|
|
|
|
static uint32_t lastPingMs;
|
|
|
|
uint32_t now = millis();
|
|
|
|
if (now - lastPingMs > 30 * 1000) { // if more than a minute since our last press, ask other nodes to update their state
|
|
if (displayedNodeNum)
|
|
service.sendNetworkPing(displayedNodeNum, true); // Refresh the currently displayed node
|
|
lastPingMs = now;
|
|
}
|
|
}
|
|
|
|
static void screenPress()
|
|
{
|
|
screen.onPress();
|
|
}
|
|
|
|
static void bootEnter() {}
|
|
|
|
State stateSDS(sdsEnter, NULL, NULL, "SDS");
|
|
State stateLS(lsEnter, lsIdle, lsExit, "LS");
|
|
State stateNB(nbEnter, NULL, NULL, "NB");
|
|
State stateDARK(darkEnter, NULL, NULL, "DARK");
|
|
State stateSERIAL(serialEnter, NULL, NULL, "SERIAL");
|
|
State stateBOOT(bootEnter, NULL, NULL, "BOOT");
|
|
State stateON(onEnter, NULL, NULL, "ON");
|
|
State statePOWER(powerEnter, NULL, NULL, "POWER");
|
|
Fsm powerFSM(&stateBOOT);
|
|
|
|
void PowerFSM_setup()
|
|
{
|
|
// If we are not a router and we already have AC power go to POWER state after init, otherwise go to ON
|
|
// We assume routers might be powered all the time, but from a low current (solar) source
|
|
bool isLowPower = radioConfig.preferences.is_low_power;
|
|
bool hasPower = !isLowPower && powerStatus && powerStatus->getHasUSB();
|
|
bool isRouter = radioConfig.preferences.is_router;
|
|
DEBUG_MSG("PowerFSM init, USB power=%d\n", hasPower);
|
|
powerFSM.add_timed_transition(&stateBOOT, hasPower ? &statePOWER : &stateON, 3 * 1000, NULL, "boot timeout");
|
|
|
|
// wake timer expired or a packet arrived
|
|
// if we are a router node, we go to NB (no need for bluetooth) otherwise we go to DARK (so we can send message to phone)
|
|
powerFSM.add_transition(&stateLS, isRouter ? &stateNB : &stateDARK, EVENT_WAKE_TIMER, NULL, "Wake timer");
|
|
|
|
// Note we don't really use this transition, because when we wake from light sleep we _always_ transition to NB or dark and
|
|
// then it handles things powerFSM.add_transition(&stateLS, &stateNB, EVENT_RECEIVED_PACKET, NULL, "Received packet");
|
|
|
|
powerFSM.add_transition(&stateNB, &stateNB, EVENT_RECEIVED_PACKET, NULL, "Received packet, resetting win wake");
|
|
|
|
// Handle press events - note: we ignore button presses when in API mode
|
|
powerFSM.add_transition(&stateLS, &stateON, EVENT_PRESS, NULL, "Press");
|
|
powerFSM.add_transition(&stateNB, &stateON, EVENT_PRESS, NULL, "Press");
|
|
powerFSM.add_transition(&stateDARK, &stateON, EVENT_PRESS, NULL, "Press");
|
|
powerFSM.add_transition(&statePOWER, &statePOWER, EVENT_PRESS, screenPress, "Press");
|
|
powerFSM.add_transition(&stateON, &stateON, EVENT_PRESS, screenPress, "Press"); // reenter On to restart our timers
|
|
powerFSM.add_transition(&stateSERIAL, &stateSERIAL, EVENT_PRESS, screenPress,
|
|
"Press"); // Allow button to work while in serial API
|
|
|
|
// Handle critically low power battery by forcing deep sleep
|
|
powerFSM.add_transition(&stateBOOT, &stateSDS, EVENT_LOW_BATTERY, NULL, "LowBat");
|
|
powerFSM.add_transition(&stateLS, &stateSDS, EVENT_LOW_BATTERY, NULL, "LowBat");
|
|
powerFSM.add_transition(&stateNB, &stateSDS, EVENT_LOW_BATTERY, NULL, "LowBat");
|
|
powerFSM.add_transition(&stateDARK, &stateSDS, EVENT_LOW_BATTERY, NULL, "LowBat");
|
|
powerFSM.add_transition(&stateON, &stateSDS, EVENT_LOW_BATTERY, NULL, "LowBat");
|
|
powerFSM.add_transition(&stateSERIAL, &stateSDS, EVENT_LOW_BATTERY, NULL, "LowBat");
|
|
|
|
powerFSM.add_transition(&stateDARK, &stateON, EVENT_BLUETOOTH_PAIR, NULL, "Bluetooth pairing");
|
|
powerFSM.add_transition(&stateON, &stateON, EVENT_BLUETOOTH_PAIR, NULL, "Bluetooth pairing");
|
|
|
|
// if we are a router we don't turn the screen on for these things
|
|
if (!isRouter) {
|
|
// show the latest node when we get a new node db update
|
|
powerFSM.add_transition(&stateNB, &stateON, EVENT_NODEDB_UPDATED, NULL, "NodeDB update");
|
|
powerFSM.add_transition(&stateDARK, &stateON, EVENT_NODEDB_UPDATED, NULL, "NodeDB update");
|
|
powerFSM.add_transition(&stateON, &stateON, EVENT_NODEDB_UPDATED, NULL, "NodeDB update");
|
|
|
|
// Show the received text message
|
|
powerFSM.add_transition(&stateLS, &stateON, EVENT_RECEIVED_TEXT_MSG, NULL, "Received text");
|
|
powerFSM.add_transition(&stateNB, &stateON, EVENT_RECEIVED_TEXT_MSG, NULL, "Received text");
|
|
powerFSM.add_transition(&stateDARK, &stateON, EVENT_RECEIVED_TEXT_MSG, NULL, "Received text");
|
|
powerFSM.add_transition(&stateON, &stateON, EVENT_RECEIVED_TEXT_MSG, NULL, "Received text"); // restarts the sleep timer
|
|
}
|
|
|
|
powerFSM.add_transition(&stateLS, &stateSERIAL, EVENT_SERIAL_CONNECTED, NULL, "serial API");
|
|
powerFSM.add_transition(&stateNB, &stateSERIAL, EVENT_SERIAL_CONNECTED, NULL, "serial API");
|
|
powerFSM.add_transition(&stateDARK, &stateSERIAL, EVENT_SERIAL_CONNECTED, NULL, "serial API");
|
|
powerFSM.add_transition(&stateON, &stateSERIAL, EVENT_SERIAL_CONNECTED, NULL, "serial API");
|
|
|
|
if (!isLowPower) {
|
|
powerFSM.add_transition(&stateLS, &statePOWER, EVENT_POWER_CONNECTED, NULL, "power connect");
|
|
powerFSM.add_transition(&stateNB, &statePOWER, EVENT_POWER_CONNECTED, NULL, "power connect");
|
|
powerFSM.add_transition(&stateDARK, &statePOWER, EVENT_POWER_CONNECTED, NULL, "power connect");
|
|
powerFSM.add_transition(&stateON, &statePOWER, EVENT_POWER_CONNECTED, NULL, "power connect");
|
|
}
|
|
|
|
powerFSM.add_transition(&statePOWER, &stateON, EVENT_POWER_DISCONNECTED, NULL, "power disconnected");
|
|
powerFSM.add_transition(&stateSERIAL, &stateON, EVENT_POWER_DISCONNECTED, NULL, "power disconnected");
|
|
|
|
powerFSM.add_transition(&stateSERIAL, &stateNB, EVENT_SERIAL_DISCONNECTED, NULL, "serial disconnect");
|
|
|
|
powerFSM.add_transition(&stateDARK, &stateDARK, EVENT_CONTACT_FROM_PHONE, NULL, "Contact from phone");
|
|
|
|
powerFSM.add_transition(&stateNB, &stateDARK, EVENT_PACKET_FOR_PHONE, NULL, "Packet for phone");
|
|
|
|
powerFSM.add_timed_transition(&stateON, &stateDARK, getPref_screen_on_secs() * 1000, NULL, "Screen-on timeout");
|
|
|
|
powerFSM.add_timed_transition(&stateDARK, &stateNB, getPref_phone_timeout_secs() * 1000, NULL, "Phone timeout");
|
|
|
|
#ifndef NRF52_SERIES
|
|
// We never enter light-sleep state on NRF52 (because the CPU uses so little power normally)
|
|
powerFSM.add_timed_transition(&stateNB, &stateLS, getPref_min_wake_secs() * 1000, NULL, "Min wake timeout");
|
|
|
|
powerFSM.add_timed_transition(&stateDARK, &stateLS, getPref_wait_bluetooth_secs() * 1000, NULL, "Bluetooth timeout");
|
|
#endif
|
|
|
|
auto meshSds = getPref_mesh_sds_timeout_secs();
|
|
if (meshSds != UINT32_MAX)
|
|
powerFSM.add_timed_transition(&stateLS, &stateSDS, meshSds * 1000, NULL, "mesh timeout");
|
|
// removing for now, because some users don't even have phones
|
|
// powerFSM.add_timed_transition(&stateLS, &stateSDS, getPref_phone_sds_timeout_sec() * 1000, NULL, "phone
|
|
// timeout");
|
|
|
|
powerFSM.run_machine(); // run one interation of the state machine, so we run our on enter tasks for the initial DARK state
|
|
}
|