59 lines
1.1 KiB
C++
59 lines
1.1 KiB
C++
#include "Power.h"
|
|
|
|
#include "WatchDog.h"
|
|
|
|
// 低功耗处理器
|
|
static TArray<Power*, 0x40> _powers(0);
|
|
|
|
void Power::SetPower()
|
|
{
|
|
AddPower(this);
|
|
}
|
|
|
|
void Power::ChangePower(int level) { }
|
|
|
|
void Power::Stop(uint msTime)
|
|
{
|
|
debug_printf("Power::Stop Time=%d \r\n", msTime);
|
|
|
|
if(!msTime) msTime = 0xFFFF;
|
|
WatchDog::Start(msTime);
|
|
PWR_EnterSTOPMode(PWR_Regulator_LowPower, PWR_STOPEntry_WFI);
|
|
}
|
|
|
|
void Power::DeepSleep(uint msTime)
|
|
{
|
|
debug_printf("Power::DeepSleep Time=%d \r\n", msTime);
|
|
|
|
#ifdef STM32F0
|
|
PWR_EnterSleepMode(PWR_SLEEPEntry_WFI);
|
|
#endif
|
|
}
|
|
|
|
void Power::Standby(uint msTime)
|
|
{
|
|
debug_printf("Power::Standby Time=%d \r\n", msTime);
|
|
|
|
for(int i=0; i<_powers.Length(); i++)
|
|
{
|
|
Power* pwr = _powers[i];
|
|
if(pwr)
|
|
{
|
|
debug_printf("Power::LowPower 0x%08X\r\n", pwr);
|
|
pwr->ChangePower(msTime);
|
|
}
|
|
}
|
|
|
|
if(!msTime) msTime = 0xFFFF;
|
|
WatchDog::Start(msTime);
|
|
PWR_EnterSTANDBYMode();
|
|
}
|
|
|
|
// 各模块向系统注册低功耗句柄，供系统进入低功耗前调用
|
|
void Power::AddPower(Power* power)
|
|
{
|
|
debug_printf("Power::AddPower 0x%08X\r\n", power);
|
|
|
|
_powers.Push(power);
|
|
}
|