mirror/MuditaOS
1
0
Fork 0
mirror of https://github.com/mudita/MuditaOS.git synced 2026-07-29 01:08:43 -04:00
Code Issues Packages Projects Releases Wiki Activity

WiP: Added Suspend/Resume API

Browse Source
This commit is contained in:
Mateusz
2019-08-30 10:37:51 +02:00
parent e8babd16d5
commit 8b4cf5e35a
4 changed files with 83 additions and 54 deletions
Download Patch File Download Diff File Expand all files Collapse all files

125
module-sys/SystemManager/SystemManager.cpp
View File

@@ -14,34 +14,31 @@
#include <algorithm>
namespace sys
{
namespace sys {
using namespace cpp_freertos;
using namespace std;
using namespace sys;
const char* systemManagerServiceName = "SysMgrService";
const char *systemManagerServiceName = "SysMgrService";
SystemManager::SystemManager(TickType_t pingInterval)
: Service(systemManagerServiceName),
pingInterval(pingInterval)
{
pingInterval(pingInterval) {
// Specify list of channels which System Manager is registered to
busChannels = {BusChannels ::SystemManagerRequests};
busChannels = {BusChannels::SystemManagerRequests};
}
SystemManager::~SystemManager()
{
SystemManager::~SystemManager() {
LogOutput::Output(GetName() + ":destructor");
}
void SystemManager::Run(){
void SystemManager::Run() {
InitHandler();
if(userInit){
if (userInit) {
userInit();
}
@@ -55,8 +52,7 @@ namespace sys
EndScheduler();
}
void SystemManager::StartSystem(std::function<int()> init)
{
void SystemManager::StartSystem(std::function<int()> init) {
LogOutput::Output("Initializing system...");
userInit = init;
@@ -64,18 +60,49 @@ namespace sys
// Start System manager
StartService();
pingPongTimerID = CreateTimer(Ticks::MsToTicks(pingInterval),true);
ReloadTimer(pingPongTimerID);
//M.P: Ping/pong mechanism is turned off. It doesn't bring any value to the system.
//pingPongTimerID = CreateTimer(Ticks::MsToTicks(pingInterval), true);
//ReloadTimer(pingPongTimerID);
}
bool SystemManager::CloseSystem(Service* s){
bool SystemManager::CloseSystem(Service *s) {
Bus::SendUnicast(std::make_shared<SystemManagerMsg>(SystemManagerMsgType::CloseSystem),systemManagerServiceName,s);
Bus::SendUnicast(std::make_shared<SystemManagerMsg>(SystemManagerMsgType::CloseSystem),
systemManagerServiceName, s);
return true;
}
bool SystemManager::CreateService(std::shared_ptr<Service> service,Service* caller,TickType_t timeout){
bool SystemManager::SuspendSystem(Service *caller) {
for(const auto &w : servicesList){
if(w->GetName() != caller->GetName()){
auto ret = Bus::SendUnicast(std::make_shared<SystemMessage>(SystemMessageType::SwitchPowerMode,ServicePowerMode::SuspendToRAM),
w->GetName(), caller);
if(!ret){
LOG_FATAL("Service %s failed to enter low-power mode",w->GetName().c_str());
}
}
}
}
bool SystemManager::ResumeSystem(Service *caller) {
for(const auto &w : servicesList){
if(w->GetName() != caller->GetName()){
auto ret = Bus::SendUnicast(std::make_shared<SystemMessage>(SystemMessageType::SwitchPowerMode,ServicePowerMode::Active),
w->GetName(), caller);
if(!ret){
LOG_FATAL("Service %s failed to exit low-power mode",w->GetName().c_str());
}
}
}
}
bool SystemManager::CreateService(std::shared_ptr<Service> service, Service *caller, TickType_t timeout) {
CriticalSection::Enter();
@@ -85,74 +112,70 @@ namespace sys
service->StartService();
auto msg = std::make_shared<SystemMessage>(SystemMessageType::Start);
auto ret = Bus::SendUnicast(msg,service->GetName(),caller,timeout);
auto ret = Bus::SendUnicast(msg, service->GetName(), caller, timeout);
auto resp = std::static_pointer_cast<ResponseMessage>(ret.second);
if(ret.first == ReturnCodes::Success && (resp->retCode == ReturnCodes::Success)){
if (ret.first == ReturnCodes::Success && (resp->retCode == ReturnCodes::Success)) {
return true;
}
else{
} else {
return false;
}
}
bool SystemManager::DestroyService(const std::string& name,Service* caller,TickType_t timeout){
bool SystemManager::DestroyService(const std::string &name, Service *caller, TickType_t timeout) {
auto msg = std::make_shared<SystemMessage>(SystemMessageType::Exit);
auto ret = Bus::SendUnicast(msg,name,caller,timeout);
auto ret = Bus::SendUnicast(msg, name, caller, timeout);
auto resp = std::static_pointer_cast<ResponseMessage>(ret.second);
if(ret.first == ReturnCodes::Success && (resp->retCode == ReturnCodes::Success)){
if (ret.first == ReturnCodes::Success && (resp->retCode == ReturnCodes::Success)) {
cpp_freertos::LockGuard lck(destroyMutex);
auto serv = std::find_if(servicesList.begin(),servicesList.end(),[&](std::shared_ptr<Service>const &s) { return s->GetName() == name; });
if(serv == servicesList.end()){
auto serv = std::find_if(servicesList.begin(), servicesList.end(),
[&](std::shared_ptr<Service> const &s) { return s->GetName() == name; });
if (serv == servicesList.end()) {
return false;
}
servicesList.erase(serv);
return true;
}
else{
} else {
return false;
}
}
ReturnCodes SystemManager::InitHandler(){
ReturnCodes SystemManager::InitHandler() {
isReady = true;
return ReturnCodes ::Success;
return ReturnCodes::Success;
}
void SystemManager::TickHandler(uint32_t id)
{
if(id == pingPongTimerID){
void SystemManager::TickHandler(uint32_t id) {
if (id == pingPongTimerID) {
for(auto &w : servicesList){
if(w->pingTimestamp==0){
for (auto &w : servicesList) {
if (w->pingTimestamp == 0) {
//no reponse for ping messages, restart system
LogOutput::Output(w->GetName() + " failed to response to ping message");
exit(1);
}
else{
} else {
w->pingTimestamp = 0;
}
}
Bus::SendBroadcast(std::make_shared<SystemMessage>(SystemMessageType::Ping),this);
Bus::SendBroadcast(std::make_shared<SystemMessage>(SystemMessageType::Ping), this);
}
}
Message_t SystemManager::DataReceivedHandler(DataMessage* msg,ResponseMessage* resp)
{
if(msg->channel == BusChannels::SystemManagerRequests){
SystemManagerMsg* data = static_cast<SystemManagerMsg*>(msg);
Message_t SystemManager::DataReceivedHandler(DataMessage *msg, ResponseMessage *resp) {
if (msg->channel == BusChannels::SystemManagerRequests) {
SystemManagerMsg *data = static_cast<SystemManagerMsg *>(msg);
switch(data->type){
switch (data->type) {
case SystemManagerMsgType::CloseSystem:
CloseSystemHandler();
@@ -166,25 +189,25 @@ namespace sys
}
void SystemManager:: CloseSystemHandler(){
void SystemManager::CloseSystemHandler() {
LogOutput::Output("Invoking closing procedure...");
DeleteTimer(pingPongTimerID);
// We are going to remove services in reversed order of creation
CriticalSection::Enter();
std::reverse(servicesList.begin(),servicesList.end());
std::reverse(servicesList.begin(), servicesList.end());
CriticalSection::Exit();
retry:
for(auto &w : servicesList){
for (auto &w : servicesList) {
// Sysmgr stores list of all active services but some of them are under control of parent services.
// Parent services ought to manage lifetime of child services hence we are sending DestroyRequests only to parents.
if(w->parent == ""){
auto ret = DestroyService(w->GetName(),this);
if(!ret){
if (w->parent == "") {
auto ret = DestroyService(w->GetName(), this);
if (!ret) {
//no response to exit message,
LogOutput::Output(w->GetName() + " failed to response to exit message");
exit(1);
@@ -193,8 +216,8 @@ namespace sys
}
}
if(servicesList.size() == 0){
enableRunLoop = false;
if (servicesList.size() == 0) {
enableRunLoop = false;
}
}