//
// Created by robtor on 05.01.23.
//

#ifndef FLOATPUMP_CONFIG_STORE_H
#define FLOATPUMP_CONFIG_STORE_H

#include <chrono>
#include "stm32f4xx_hal.h"

namespace floatpump {

    class Config_Store {
    public:
        Config_Store();

        static uint32_t StoreInFlash(uint32_t StartAddress, uint32_t *Data, uint16_t nData) {
            uint16_t progr = 0;
            HAL_FLASH_Unlock();
            FLASH_Erase_Sector(FLASH_SECTOR_7, VOLTAGE_RANGE_1);
            while( progr < nData) {
                if(HAL_FLASH_Program(FLASH_TYPEPROGRAM_WORD, StartAddress, Data[progr]) == HAL_OK) {
                    progr++;
                    StartAddress += 4; } else {
                    return HAL_FLASH_GetError();
                }
            }
            HAL_FLASH_Lock();
        }

        void saveToFlash() {
            uint32_t data[10];
            data[0] = TankCalibLow.getValue();
            data[1] = TankCalibHigh.getValue();
            data[2] = TankMinLevel.getValue();
            data[3] = TankHysteresis.getValue();
            data[4] = TankPumpInvert.getValue();
            data[5] = RefillEnable.getValue();
            data[6] = RefillBlockInvert.getValue();
            data[7] = RefillBlockEnable.getValue();
            data[8] = RefillBelow.getValue();
            data[9] = RefillHysteresis.getValue();

            StoreInFlash(0x08060000, data, 10);
        };

        void resetDefaults();

        void loadFromFlash() {
            this->RefillBelow.setValue(*(uint32_t *)0x08060000);
        };

        template<class T>
        class Config_Object {
        public:
            Config_Object(T initialValue) : m_data(initialValue) {};

            T getValue() {
                return m_data;
            }

            void setValue(T newValue) {
                m_data = newValue;
            }

            T *getLink() {
                return &m_data;
            }

        private:
            T m_data;
        };

        Config_Object<uint16_t> TankCalibLow = Config_Object<uint16_t>(0);
        Config_Object<uint16_t> TankCalibHigh = Config_Object<uint16_t>(65535);
        Config_Object<uint8_t> TankMinLevel = Config_Object<uint8_t>(20);
        Config_Object<uint8_t> TankHysteresis = Config_Object<uint8_t>(5);
        Config_Object<uint32_t> TankCooldown = Config_Object<uint32_t>(5);
        Config_Object<uint32_t> TankZeroLevelCM = Config_Object<uint32_t>(0);
        Config_Object<uint32_t> TankFullLevelCM = Config_Object<uint32_t>(200);
        Config_Object<bool> TankPumpInvert = Config_Object<bool>(false);

        Config_Object<bool> RefillEnable = Config_Object<bool>(false);
        Config_Object<bool> RefillBlockInvert = Config_Object<bool>(false);
        Config_Object<bool> RefillBlockEnable = Config_Object<bool>(true);
        Config_Object<uint8_t> RefillBelow = Config_Object<uint8_t>(false);
        Config_Object<uint8_t> RefillHysteresis = Config_Object<uint8_t>(false);
        Config_Object<uint32_t> RefillCooldown = Config_Object<uint32_t>(60);
    };

} // floatpump

#endif //FLOATPUMP_CONFIG_STORE_H