#include #include "animation.h" #include "animation/constants.h" #include "display/eyes.h" #include "display/eyes/core/internal.h" #include "display/oled.h" #include "extensions/lcd1602/lcd1602.h" #include "hardware/servo_wrapper.h" #include "network/wifi_connect.h" #include "pins.h" #include "servos.h" #include "settings/settings.h" #include "sleep.h" namespace { enum class SleepState { Awake, Closing, Sleeping, Opening }; SleepState g_state = SleepState::Awake; uint32_t g_idleSinceMs = 0; void commandSleepHead(float n) { servoAt(SERVO_HEAD).setNormTarget(n, SERVO_BOOT_SPEED_DEG_S); } void fadeLcdWake() { if (!settingsLcd1602BacklightSleep()) { return; } lcd1602FadeBrightnessTo(100, anim::SLEEP_NOD_OFF_MS); } void fadeLcdSleep() { if (!settingsLcd1602BacklightSleep()) { return; } lcd1602FadeBrightnessTo(0, anim::SLEEP_NOD_OFF_MS); } void wakeFromSleep(uint32_t now) { wakeOled(); startEyesForWake(now); fadeLcdWake(); g_state = SleepState::Opening; } void beginSleepClosing(uint32_t now) { requestSleepEyeClose(now); fadeLcdSleep(); g_state = SleepState::Closing; } } // namespace void initSleep() { g_idleSinceMs = millis(); } void prepareSleepWakePose() { if (g_state != SleepState::Closing && g_state != SleepState::Sleeping) { return; } commandSleepHead(anim::SLEEP_HEAD_AWAKE); } void requestSleep(uint32_t now) { if (g_state == SleepState::Sleeping || g_state == SleepState::Closing) { return; } beginSleepClosing(now); } void noteActivity(uint32_t now) { g_idleSinceMs = now; } void onAnimationApplied(AnimationId id, uint32_t now) { if (id == AnimationId::None) { noteActivity(now); return; } if (id == AnimationId::Sleep) { return; } if (id == AnimationId::Wakeup) { clearSleepEyeAnim(); if (g_state == SleepState::Sleeping) { wakeOled(); eyes::setEyesRunning(true); } fadeLcdWake(); g_state = SleepState::Awake; return; } switch (g_state) { case SleepState::Sleeping: wakeFromSleep(now); break; case SleepState::Closing: requestSleepEyeOpen(now); fadeLcdWake(); g_state = SleepState::Opening; break; default: break; } } void updateSleep(uint32_t now) { if (wifiProvisioningMode()) { return; } switch (g_state) { case SleepState::Awake: // g_idleSinceMs may be set with millis() after this loop's `now` // (e.g. POST /anim during pollHttpServer). Guard against underflow. if (getAnimation() == AnimationId::None && now >= g_idleSinceMs && now - g_idleSinceMs >= settingsSleepTimeoutMs()) { setAnimation(AnimationId::Sleep); } break; case SleepState::Closing: if (updateSleepEyes(now) == SleepEyeResult::CloseComplete) { blankOled(); sleepOled(); stopEyes(); g_state = SleepState::Sleeping; } break; case SleepState::Sleeping: break; case SleepState::Opening: if (updateSleepEyes(now) == SleepEyeResult::OpenComplete) { g_state = SleepState::Awake; if (getAnimation() == AnimationId::None) { g_idleSinceMs = now; } } break; } } bool isSleeping() { return g_state == SleepState::Sleeping; } bool sleepAllowsWakeup() { return g_state == SleepState::Sleeping || g_state == SleepState::Closing; }