eive-obsw/bsp_q7s/memory/SdCardManager.cpp

#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;
}