#ifndef BSP_Q7S_CORE_CORECONTROLLER_H_
#define BSP_Q7S_CORE_CORECONTROLLER_H_

#include <fsfw/globalfunctions/PeriodicOperationDivider.h>
#include "fsfw/controller/ExtendedControllerBase.h"
#include "bsp_q7s/memory/SdCardManager.h"

#include "events/subsystemIdRanges.h"


class Timer;
class SdCardManager;

class CoreController: public ExtendedControllerBase {
public:
    enum Chip: uint8_t {
        CHIP_0,
        CHIP_1,
        NO_CHIP
    };

    enum Copy: uint8_t {
        COPY_0,
        COPY_1,
        NO_COPY
    };

    static constexpr ActionId_t LIST_DIRECTORY_INTO_FILE = 0;
    static constexpr ActionId_t REBOOT_OBC = 32;

    static constexpr uint8_t SUBSYSTEM_ID = SUBSYSTEM_ID::CORE;

    static constexpr Event ALLOC_FAILURE = event::makeEvent(SUBSYSTEM_ID, 0, severity::MEDIUM);


    CoreController(object_id_t objectId);
    virtual~ CoreController();

    ReturnValue_t initialize() override;

    ReturnValue_t initializeAfterTaskCreation() override;

    ReturnValue_t executeAction(ActionId_t actionId,
            MessageQueueId_t commandedBy, const uint8_t *data, size_t size) override;

    ReturnValue_t handleCommandMessage(CommandMessage *message) override;
    void performControlOperation() override;

    static ReturnValue_t incrementAllocationFailureCount();
    static void getCurrentBootCopy(Chip& chip, Copy& copy);
    bool sdInitFinished() const;

private:
    static Chip currentChip;
    static Copy currentCopy;

    ReturnValue_t initializeLocalDataPool(localpool::DataPool& localDataPoolMap,
            LocalDataPoolManager& poolManager) override;
    LocalPoolDataSetBase* getDataSetHandle(sid_t sid) override;
    ReturnValue_t checkModeCommand(Mode_t mode, Submode_t submode,
                uint32_t *msToReachTheMode);

    // States for SD state machine, which is used in non-blocking mode
    enum class SdStates {
        NONE,
        START,
        GET_INFO,
        SET_STATE_SELF,
        MOUNT_SELF,
        // Determine operations for other SD card, depending on redundancy configuration
        DETERMINE_OTHER,
        SET_STATE_OTHER,
        // Mount or unmount other
        MOUNT_UNMOUNT_OTHER,
        // Skip period because the shell command used to generate the info file sometimes is
        // missing the last performed operation if executed too early
        SKIP_CYCLE_BEFORE_INFO_UPDATE,
        UPDATE_INFO,
        // SD initialization done
        IDLE,
        // Used if SD switches or mount commands are issued via telecommand
        SET_STATE_FROM_COMMAND,
    };
    static constexpr bool BLOCKING_SD_INIT = false;

    SdCardManager* sdcMan = nullptr;

    ReturnValue_t initSdCardBlocking();
    ReturnValue_t sdStateMachine();

    struct SdInfo {
        sd::SdCard pref = sd::SdCard::NONE;
        sd::SdState prefState = sd::SdState::OFF;
        sd::SdCard other = sd::SdCard::NONE;
        sd::SdState otherState = sd::SdState::OFF;
        std::string prefChar = "0";
        std::string otherChar = "1";
        SdStates state = SdStates::START;
        // Used to track whether a command was executed
        bool commandExecuted = true;
        bool initFinished = false;
        SdCardManager::SdStatePair currentState;
        uint16_t cycleCount = 0;
        // These two flags are related to external commanding
        bool commandIssued = false;
        bool commandFinished = false;
        sd::SdState currentlyCommandedState = sd::SdState::OFF;
        sd::SdCard commandedCard = sd::SdCard::NONE;
        sd::SdState commandedState = sd::SdState::OFF;
    };

    SdInfo sdInfo;

    void updateSdInfoOther();
    ReturnValue_t sdCardSetup(sd::SdCard sdCard, sd::SdState targetState, std::string sdChar,
            bool printOutput = true);
    ReturnValue_t sdColdRedundantBlockingInit();
    void currentStateSetter(sd::SdCard sdCard, sd::SdState newState);
    void determinePreferredSdCard();
    void executeNextExternalSdCommand();
    void checkExternalSdCommandStatus();

    ReturnValue_t initVersionFile();
    ReturnValue_t initBootCopy();
    ReturnValue_t initWatchdogFifo();

    ReturnValue_t actionListDirectoryIntoFile(ActionId_t actionId, MessageQueueId_t commandedBy,
            const uint8_t *data, size_t size);
    ReturnValue_t actionPerformReboot(const uint8_t *data, size_t size);

    void initPrint();

    // Designated value for rechecking FIFO open
    static constexpr int RETRY_FIFO_OPEN = -2;
    int watchdogFifoFd = 0;

    PeriodicOperationDivider opDivider;
    void performWatchdogControlOperation();
};



#endif /* BSP_Q7S_CORE_CORECONTROLLER_H_ */