143 lines
5.1 KiB
C++
143 lines
5.1 KiB
C++
#include "CoreController.h"
|
|
#include "q7sConfig.h"
|
|
|
|
#include "../memory/SdCardManager.h"
|
|
|
|
CoreController::CoreController(object_id_t objectId):
|
|
ExtendedControllerBase(objectId, objects::NO_OBJECT, 5) {
|
|
}
|
|
|
|
ReturnValue_t CoreController::handleCommandMessage(CommandMessage *message) {
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|
|
void CoreController::performControlOperation() {
|
|
}
|
|
|
|
ReturnValue_t CoreController::initializeLocalDataPool(localpool::DataPool &localDataPoolMap,
|
|
LocalDataPoolManager &poolManager) {
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|
|
LocalPoolDataSetBase* CoreController::getDataSetHandle(sid_t sid) {
|
|
return nullptr;
|
|
}
|
|
|
|
ReturnValue_t CoreController::initialize() {
|
|
return sdCardInit();
|
|
}
|
|
|
|
ReturnValue_t CoreController::checkModeCommand(Mode_t mode, Submode_t submode,
|
|
uint32_t *msToReachTheMode) {
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|
|
ReturnValue_t CoreController::sdCardInit() {
|
|
#if Q7S_SD_CARD_CONFIG == Q7S_SD_NONE
|
|
sif::info << "No SD card initialization will be performed" << std::endl;
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
#else
|
|
// Creator or update status file
|
|
ReturnValue_t result = SdCardManager::instance()->updateSdCardStateFile();
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::warning << "CoreController::initialize: Updating SD card state file failed"
|
|
<< std::endl;
|
|
}
|
|
|
|
SdCardManager* sdcMan = SdCardManager::instance();
|
|
auto sdStatus = std::pair<sd::SdStatus, sd::SdStatus>(sd::SdStatus::OFF, sd::SdStatus::OFF);
|
|
result = sdcMan->getSdCardActiveStatus(sdStatus);
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::warning << "Getting SD card activity status failed" << std::endl;
|
|
}
|
|
|
|
#if Q7S_SD_CARD_CONFIG == Q7S_SD_COLD_REDUNDANT
|
|
sif::info << "Cold redundant SD card configuration" << std::endl;
|
|
sd::SdCard preferredSdCard = sd::SdCard::SLOT_0;
|
|
result = sdcMan->getPreferredSdCard(preferredSdCard);
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::warning << "Could not get prefered SD card information from the scratch buffer"
|
|
<< std::endl;
|
|
}
|
|
sd::SdCard otherSdc = sd::SdCard::SLOT_0;
|
|
std::string printoutString;
|
|
std::string otherString;
|
|
if(preferredSdCard == sd::SdCard::SLOT_0) {
|
|
printoutString = "0";
|
|
otherSdc = sd::SdCard::SLOT_1;
|
|
otherString = "1";
|
|
}
|
|
else {
|
|
printoutString = "1";
|
|
otherSdc = sd::SdCard::SLOT_0;
|
|
otherString = "0";
|
|
}
|
|
|
|
sd::SdStatus targetStatus = sd::SdStatus::OFF;
|
|
if(preferredSdCard == sd::SdCard::SLOT_0) {
|
|
targetStatus = sdStatus.first;
|
|
}
|
|
else if(preferredSdCard == sd::SdCard::SLOT_1) {
|
|
targetStatus = sdStatus.second;
|
|
}
|
|
|
|
if(targetStatus == sd::SdStatus::MOUNTED) {
|
|
sif::info << "SD card " << printoutString << " is already switched on and mounted" <<
|
|
std::endl;
|
|
result = HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
else if(targetStatus == sd::SdStatus::ON) {
|
|
sif::info << "Mounting SD card " << printoutString << std::endl;
|
|
result = sdcMan->mountSdCard(preferredSdCard);
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::warning << "Mounting SD card failed" << std::endl;
|
|
}
|
|
}
|
|
else if(targetStatus == sd::SdStatus::OFF) {
|
|
sif::info << "Switching on and mounting SD card " << printoutString << std::endl;
|
|
result = sdcMan->switchOnSdCard(preferredSdCard, true);
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::warning << "Switching on and mounting SD card failed" << std::endl;
|
|
}
|
|
}
|
|
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
// This should not happen.. Switch on other SD card for now
|
|
sdcMan->switchOnSdCard(otherSdc, true);
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
}
|
|
|
|
sif::info << "Switching off SD card " << otherString << std::endl;
|
|
// Switch off other SD card in cold-redundant mode
|
|
result = sdcMan->switchOffSdCard(otherSdc, true);
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::warning << "Switching off SD card " << otherString << " failed" << std::endl;
|
|
}
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
#elif Q7S_SD_CARD_CONFIG == Q7S_SD_HOT_REDUNDANT
|
|
sif::info << "Hot redundant SD card configuration" << std::endl;
|
|
|
|
// Use a lambda to avoid duplicate code
|
|
auto setUpSdCard = [sdcMan](sd::SdCard sdCard, sd::SdStatus status, std::string sdString) {
|
|
if(status == sd::SdStatus::OFF) {
|
|
sif::info << "Switching on and mounting SD card " << sdString << std::endl;
|
|
sdcMan->switchOnSdCard(sdCard, true);
|
|
}
|
|
else if(status == sd::SdStatus::ON) {
|
|
sif::info << "Mounting SD card " << sdString << std::endl;
|
|
sdcMan->mountSdCard(sdCard);
|
|
}
|
|
else {
|
|
sif::info << "SD card " << sdString << " already on and mounted" << std::endl;
|
|
}
|
|
};
|
|
|
|
setUpSdCard(sd::SdCard::SLOT_0, sdStatus.first, "0");
|
|
setUpSdCard(sd::SdCard::SLOT_1, sdStatus.second, "1");
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
#endif
|
|
|
|
#endif /* Q7S_SD_CARD_CONFIG != Q7S_SD_NONE */
|
|
|
|
}
|