151 lines
4.2 KiB
C++
151 lines
4.2 KiB
C++
#include "SdCardManager.h"
|
|
#include "fsfw/ipc/MutexFactory.h"
|
|
#include "fsfw/serviceinterface/ServiceInterface.h"
|
|
|
|
#include <fstream>
|
|
#include <filesystem>
|
|
|
|
SdCardManager* SdCardManager::factoryInstance = nullptr;
|
|
|
|
SdCardManager::SdCardManager() {
|
|
}
|
|
|
|
SdCardManager::~SdCardManager() {
|
|
}
|
|
|
|
void SdCardManager::create() {
|
|
if(factoryInstance == nullptr) {
|
|
factoryInstance = new SdCardManager();
|
|
}
|
|
}
|
|
|
|
SdCardManager* SdCardManager::instance() {
|
|
SdCardManager::create();
|
|
return SdCardManager::factoryInstance;
|
|
}
|
|
|
|
ReturnValue_t SdCardManager::switchOnSdCard(sd::SdCard sdCard) {
|
|
std::pair<bool, bool> active;
|
|
ReturnValue_t result = sdCardActive(active);
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
return result;
|
|
}
|
|
if((sdCard == sd::SdCard::SLOT_0 and active.first) or
|
|
(sdCard == sd::SdCard::SLOT_1 and active.second)) {
|
|
return ALREADY_ON;
|
|
}
|
|
return setSdCardState(sdCard, true);
|
|
}
|
|
|
|
ReturnValue_t SdCardManager::switchOffSdCard(sd::SdCard sdCard) {
|
|
std::pair<bool, bool> active;
|
|
ReturnValue_t result = sdCardActive(active);
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
|
return result;
|
|
}
|
|
if((sdCard == sd::SdCard::SLOT_0 and not active.first) or
|
|
(sdCard == sd::SdCard::SLOT_1 and not active.second)) {
|
|
return ALREADY_OFF;
|
|
}
|
|
return setSdCardState(sdCard, false);
|
|
}
|
|
|
|
ReturnValue_t SdCardManager::setSdCardState(sd::SdCard sdCard, bool on) {
|
|
std::string sdstring = "";
|
|
std::string statestring = "";
|
|
if(sdCard == sd::SdCard::SLOT_0) {
|
|
sdstring = "0";
|
|
}
|
|
else if(sdCard == sd::SdCard::SLOT_1) {
|
|
sdstring = "1";
|
|
}
|
|
if(on) {
|
|
statestring = "on";
|
|
}
|
|
else {
|
|
statestring = "off";
|
|
}
|
|
std::ostringstream command;
|
|
command << "q7hw sd set " << sdstring << " " << statestring;
|
|
int result = std::system(command.str().c_str());
|
|
if(result == 0) {
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
sif::warning << "SdCardManager::setSdCardState: system call failed with code " <<
|
|
result << std::endl;
|
|
return SYSTEM_CALL_ERROR;
|
|
}
|
|
|
|
ReturnValue_t SdCardManager::sdCardActive(std::pair<bool, bool>& active) {
|
|
using namespace std;
|
|
if(not filesystem::exists("/tmp/sd_status.txt")) {
|
|
return STATUS_FILE_NEXISTS;
|
|
}
|
|
|
|
// Now the file should exist in any case. Still check whether it exists.
|
|
fstream sdStatus("/tmp/sd_status.txt");
|
|
if (not sdStatus.good()) {
|
|
return STATUS_FILE_NEXISTS;
|
|
}
|
|
string line;
|
|
uint8_t idx = 0;
|
|
|
|
while (std::getline(sdStatus, line)) {
|
|
istringstream iss(line);
|
|
string word;
|
|
sd::SdCard currentSd = sd::SdCard::SLOT_0;
|
|
while(iss >> word) {
|
|
if (word == "1:") {
|
|
currentSd = sd::SdCard::SLOT_1;
|
|
}
|
|
|
|
if(word == "on") {
|
|
if(currentSd == sd::SdCard::SLOT_0) {
|
|
active.first = true;
|
|
}
|
|
else {
|
|
active.second = true;
|
|
}
|
|
}
|
|
else if (word == "off") {
|
|
if(currentSd == sd::SdCard::SLOT_0) {
|
|
active.first = false;
|
|
}
|
|
else {
|
|
active.second = false;
|
|
}
|
|
}
|
|
else {
|
|
continue;
|
|
}
|
|
|
|
if(idx > 3) {
|
|
sif::warning << "SdCardManager::sdCardActive: Status file has more "
|
|
"than 4 lines!" << std::endl;
|
|
return STATUS_FILE_FORMAT_INVALID;
|
|
}
|
|
}
|
|
idx++;
|
|
}
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|
|
sd::SdCard SdCardManager::getPreferredSdCard() const {
|
|
//int result = std::system("xsc_scratch read PREFSD > /tmp/pref_sd.txt");
|
|
return preferredSdCard;
|
|
}
|
|
|
|
void SdCardManager::setPreferredSdCard(sd::SdCard sdCard) {
|
|
preferredSdCard = sdCard;
|
|
}
|
|
|
|
ReturnValue_t SdCardManager::updateSdCardStateFile() {
|
|
int result = std::system("q7hw sd info all > /tmp/sd_status.txt");
|
|
if(result == 0) {
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
sif::warning << "SdCardManager::updateSdCardStateFile: system call failed with code " <<
|
|
result << std::endl;
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
}
|