#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) {
//    if(sdCardActive(sdCard)) {
//        return ALREADY_ON;
//    }
    return setSdCardState(sdCard, true);

}

ReturnValue_t SdCardManager::switchOffSdCard(sd::SdCard sdCard) {
//    if(not sdCardActive(sdCard)) {
//        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 << "h7hw 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 HasReturnvaluesIF::RETURN_FAILED;
}

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;
    ReturnValue_t result = HasReturnvaluesIF::RETURN_OK;
    bool on = false;

    while (std::getline(sdStatus, line)) {
        istringstream iss(line);
        string word;
        while(iss >> word) {
            if(word == "on") {
                on = true;
            }
            else if (word == "off") {
                on = false;
            }
            else {
                continue;
            }
            if(idx == 0) {
                active.first = on;
            }
            else if(idx == 1) {
                active.second = on;
            }
            else if(idx > 1) {
                sif::warning << "SdCardManager::sdCardActive: Status file has more "
                        "than 2 lines!" << std::endl;
                return STATUS_FILE_FORMAT_INVALID;
            }
        }
        idx++;
    }
    return HasReturnvaluesIF::RETURN_OK;
}

sd::SdCard SdCardManager::getPreferredSdCard() const {
    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;
}