/*  EEPROM LAYOUT
                  "BOOTMODE;SSID;PASSWORD;HOSTNAME;MQTT_SERVER;MQTT_USERNAME;MQTT_PASSWD;MQTT_PORT;IP_CONFIG;IP;GATEWAY;NETMASK;DNS1;DNS2;WIFI_CHANNEL;WIFI_BSSID;"
    BOOTMODE could be 0 for Setup, 1 for normal use, 2 for OTA
    IP_CONFIG could be 0 for DHCP, 1 for static
    Setup mode is trigger by setting GPIO3 to ground or at first boot
*/
#include "EEPROM.h" 

#define BME680_BSEC_EEPROM_ORIG (CONFIG_EEPROM_SIZE)

#if (CONFIG_EEPROM_SIZE + BSEC_MAX_STATE_BLOB_SIZE) >= SPI_FLASH_SEC_SIZE
#error "CONFIG_EEPROM_SIZE too big"
#endif

char eeprom[CONFIG_EEPROM_SIZE];

int EepromSaveConfig(productConfig &config) {
  String eeprom;

  eeprom = String(config.bootMode) + ";" + config.ssid + ";" + config.password + ";"
           + config.host + ";" + config.mqttServer +  ";"
           + config.mqttUser + ";" + config.mqttPasswd + ";"
           + String(config.mqttPort) + ";"
           + String(config.ip_mode) + ";"
           + config.ip + ";" + config.gw + ";" + config.mask + ";"
           + config.dns + ";" + config.dns2 + ";" + config.channel + ";"
           + config.bssid + ";";

  if (eeprom.length() > CONFIG_EEPROM_SIZE )
    return -EMSGSIZE;

  SKETCH_DEBUG_PRINTLN("Saving " + eeprom);

  for (uint i = 0; i < eeprom.length() && i < CONFIG_EEPROM_SIZE; i++) {
    EEPROM.write(i, eeprom.charAt(i));
  }

  EEPROM.commit();
  delay(100);

  return 0;
}

int EepromSaveBootMode(uint8_t bootMode) {
  EEPROM.write(0, String(bootMode).charAt(0));
  EEPROM.commit();
  delay(100);
  return 0;
}

void readConfElement(char** element, int &i) {
  *element = &eeprom[i];
  do {
    eeprom[i] = EEPROM.read(i);
    i++;
  } while (i < CONFIG_EEPROM_SIZE && eeprom[i - 1] != ';');
  eeprom[i - 1] = '\0';

  if (i >= CONFIG_EEPROM_SIZE){
    SKETCH_DEBUG_PRINTLN("Looks like there is a configuration issue (too long)");
    **element = '\0';
  }
}

void EepromReadConfig(productConfig &config) {

  int i = 2;

  uint8_t boot = EEPROM.read(0);
  char *tmpString;

  if (boot == '1') {
    config.bootMode = BOOTMODE_SETUP;
  } else if (boot == '2') {
    config.bootMode = BOOTMODE_NORMAL;
  } else if (boot == '3') {
    config.bootMode = BOOTMODE_OTA;
  } else {
    //Do not need to parse EEPROM when not configured
    config.bootMode = BOOTMODE_SETUP;
    return;
  }

  readConfElement(&config.ssid, i);
  readConfElement(&config.password, i);
  readConfElement(&config.host, i);
  readConfElement(&config.mqttServer, i);
  readConfElement(&config.mqttUser, i);
  readConfElement(&config.mqttPasswd, i);
  readConfElement(&tmpString, i);
  config.mqttPort = atoi(tmpString);
  readConfElement(&tmpString, i);
  config.ip_mode = atoi(tmpString);
  readConfElement(&tmpString, i);
  config.ip = atoll(tmpString);
  readConfElement(&tmpString, i);
  config.gw = atoll(tmpString);
  readConfElement(&tmpString, i);
  config.mask = atoll(tmpString);
  readConfElement(&tmpString, i);
  config.dns = atoll(tmpString);
  readConfElement(&tmpString, i);
  config.dns2 = atoll(tmpString);
  readConfElement(&tmpString, i);
  config.channel = atoi(tmpString);
  readConfElement(&config.bssid, i);

}

int EepromSaveBME680State(uint8_t *bsecState)
{
  for (uint16_t i = BME680_BSEC_EEPROM_ORIG;
       i < BME680_BSEC_EEPROM_ORIG + BSEC_MAX_STATE_BLOB_SIZE; i++) {
    EEPROM.write(i + 1, bsecState[i]);
  }

  EEPROM.write(BME680_BSEC_EEPROM_ORIG, BSEC_MAX_STATE_BLOB_SIZE);
  EEPROM.commit();

  return 0;
}

int EepromLoadBME680State(uint8_t *bsecState)
{
  if (EEPROM.read(BME680_BSEC_EEPROM_ORIG) == BSEC_MAX_STATE_BLOB_SIZE) {
    // Existing state in EEPROM
    SKETCH_DEBUG_PRINTLN("Reading BME680 state from EEPROM");

    for (uint16_t i = BME680_BSEC_EEPROM_ORIG;
         i < BME680_BSEC_EEPROM_ORIG + BSEC_MAX_STATE_BLOB_SIZE; i++) {
      bsecState[i] = EEPROM.read(i + 1);
    }

    return 0;
  } else {
    // Erase the EEPROM with zeroes
    SKETCH_DEBUG_PRINTLN("Erasing EEPROM for BME680 state");

    for (uint16_t i = BME680_BSEC_EEPROM_ORIG;
         i < BME680_BSEC_EEPROM_ORIG + BSEC_MAX_STATE_BLOB_SIZE + 1; i++)
      EEPROM.write(i, 0);

    EEPROM.commit();

    return -1;
  }
}