mirror of
https://github.com/UpsilonNumworks/Upsilon.git
synced 2026-03-24 00:00:44 +01:00
69 lines
2.0 KiB
C++
69 lines
2.0 KiB
C++
#include <ion.h>
|
|
#include "battery.h"
|
|
#include "device.h"
|
|
#include "display.h"
|
|
#include "keyboard.h"
|
|
#include "led.h"
|
|
#include "usb.h"
|
|
#include "wakeup.h"
|
|
#include "regs/regs.h"
|
|
|
|
void Ion::Power::suspend(bool checkIfPowerKeyReleased) {
|
|
if (checkIfPowerKeyReleased) {
|
|
/* Wait until power is released to avoid restarting just after suspending */
|
|
bool isPowerDown = true;
|
|
while (isPowerDown) {
|
|
Keyboard::State scan = Keyboard::scan();
|
|
isPowerDown = Keyboard::keyDown(Keyboard::Key::B2, scan);
|
|
}
|
|
}
|
|
Device::shutdownPeripherals();
|
|
|
|
PWR.CR()->setLPDS(true); // Turn the regulator off. Takes longer to wake up.
|
|
PWR.CR()->setFPDS(true); // Put the flash to sleep. Takes longer to wake up.
|
|
CM4.SCR()->setSLEEPDEEP(true);
|
|
|
|
WakeUp::Device::onUSBPlugging();
|
|
#if LED_WHILE_CHARGING
|
|
WakeUp::Device::onChargingEvent();
|
|
#endif
|
|
while (1) {
|
|
#if LED_WHILE_CHARGING
|
|
/* Update LEDS
|
|
* if the standby mode was stopped due to a "stop charging" event, we wait
|
|
* a while to be sure that the plug state of the USB is up-to-date. */
|
|
msleep(200);
|
|
LED::Device::enforceState(Battery::isCharging(), USB::isPlugged(), false);
|
|
#endif
|
|
|
|
WakeUp::Device::onPowerKeyDown();
|
|
|
|
Device::shutdownClocks();
|
|
|
|
/* To enter sleep, we need to issue a WFE instruction, which waits for the
|
|
* event flag to be set and then clears it. However, the event flag might
|
|
* already be on. So the safest way to make sure we actually wait for a new
|
|
* event is to force the event flag to on (SEV instruction), use a first WFE
|
|
* to clear it, and then a second WFE to wait for a _new_ event. */
|
|
asm("sev");
|
|
asm("wfe");
|
|
msleep(1);
|
|
asm("wfe");
|
|
|
|
Device::initClocks();
|
|
|
|
Keyboard::Device::init();
|
|
Keyboard::State scan = Keyboard::scan();
|
|
Keyboard::Device::shutdown();
|
|
|
|
Ion::Keyboard::State OnlyPowerKeyDown = ((uint64_t)1 << (uint8_t)Keyboard::Key::B2);
|
|
if (scan == OnlyPowerKeyDown) {
|
|
// Wake up
|
|
break;
|
|
}
|
|
}
|
|
Device::initClocks();
|
|
|
|
Device::initPeripherals();
|
|
}
|