Restructured Folders

2022-05-07 23:24:42 +02:00
parent f514ee62fc
commit ad6332acd4
39 changed files with 0 additions and 0 deletions
--- a/Software/src/config.cpp
+++ b/Software/src/config.cpp
@@ -0,0 +1,226 @@
+#include "config.h"
+
+I2C_eeprom ee(0x50, EEPROM_SIZE_BYTES);
+
+LubeConfig_t LubeConfig;
+persistenceData_t PersistenceData;
+uint16_t eePersistenceMarker = 0;
+const uint16_t eeVersion = 1; // inc
+boolean eeAvailable = false;
+
+const uint16_t startofLubeConfig = 16;
+const uint16_t startofPersistence = 16 + sizeof(LubeConfig) + (sizeof(LubeConfig) % 16);
+
+boolean checkEEPROMavailable();
+
+void InitEEPROM()
+{
+  ee.begin();
+  if (!checkEEPROMavailable())
+  {
+    globals.systemStatus = sysStat_Error;
+    MaintainDTC(DTC_NO_EEPROM_FOUND, true);
+    return;
+  }
+  GetConfig_EEPROM();
+
+  if (LubeConfig.EEPROM_Version != eeVersion)
+  {
+    FormatConfig_EEPROM();
+    globals.systemStatus = sysStat_Error;
+    MaintainDTC(DTC_EEPROM_VERSION_BAD, true);
+    return;
+  }
+}
+
+void EEPROM_Process()
+{
+
+  switch (globals.requestEEAction)
+  {
+  case EE_CFG_SAVE:
+    StoreConfig_EEPROM();
+    globals.requestEEAction = EE_IDLE;
+    break;
+  case EE_CFG_LOAD:
+    GetConfig_EEPROM();
+    globals.requestEEAction = EE_IDLE;
+    break;
+  case EE_PDS_SAVE:
+    StorePersistence_EEPROM();
+    globals.requestEEAction = EE_IDLE;
+    break;
+  case EE_PDS_LOAD:
+    GetPersistence_EEPROM();
+    globals.requestEEAction = EE_IDLE;
+    break;
+  case EE_IDLE:
+  default:
+    globals.requestEEAction = EE_IDLE;
+  }
+}
+
+void StoreConfig_EEPROM()
+{
+  LubeConfig.checksum = 0;
+  LubeConfig.checksum = Checksum_EEPROM((uint8_t *)&LubeConfig, sizeof(LubeConfig));
+  if (!checkEEPROMavailable())
+    return;
+
+  ee.updateBlock(startofLubeConfig, (uint8_t *)&LubeConfig, sizeof(LubeConfig));
+}
+
+void GetConfig_EEPROM()
+{
+  if (!checkEEPROMavailable())
+    return;
+
+  ee.readBlock(startofLubeConfig, (uint8_t *)&LubeConfig, sizeof(LubeConfig));
+
+  uint32_t checksum = LubeConfig.checksum;
+  LubeConfig.checksum = 0;
+
+  if (Checksum_EEPROM((uint8_t *)&LubeConfig, sizeof(LubeConfig)) != checksum)
+  {
+    MaintainDTC(DTC_EEPROM_CFG_BAD, true);
+    FormatConfig_EEPROM();
+  }
+  LubeConfig.checksum = checksum;
+}
+
+uint16_t getPersistanceAddress()
+{
+  return startofPersistence + eePersistenceMarker;
+}
+
+void StorePersistence_EEPROM()
+{
+  if (PersistenceData.writeCycleCounter >= 0xFFF0)
+    MovePersistencePage_EEPROM(false);
+  else
+    PersistenceData.writeCycleCounter++;
+
+  PersistenceData.checksum = 0;
+  PersistenceData.checksum = Checksum_EEPROM((uint8_t *)&PersistenceData, sizeof(PersistenceData));
+
+  if (!checkEEPROMavailable())
+    return;
+
+  ee.updateBlock(getPersistanceAddress(), (uint8_t *)&PersistenceData, sizeof(PersistenceData));
+}
+
+void GetPersistence_EEPROM()
+{
+  if (!checkEEPROMavailable())
+    return;
+
+  eePersistenceMarker = (ee.readByte(0) << 8) | ee.readByte(1);
+  ee.readBlock(getPersistanceAddress(), (uint8_t *)&PersistenceData, sizeof(PersistenceData));
+
+  uint32_t checksum = PersistenceData.checksum;
+  PersistenceData.checksum = 0;
+
+  if (Checksum_EEPROM((uint8_t *)&PersistenceData, sizeof(PersistenceData)) != checksum)
+  {
+    MaintainDTC(DTC_EEPROM_PDS_BAD, true);
+    FormatPersistence_EEPROM();
+  }
+  PersistenceData.checksum = checksum;
+}
+
+void FormatConfig_EEPROM()
+{
+  LubeConfig_t defaults;
+  LubeConfig = defaults;
+  LubeConfig.EEPROM_Version = eeVersion;
+  StoreConfig_EEPROM();
+}
+
+void FormatPersistence_EEPROM()
+{
+  persistenceData_t defaults;
+  PersistenceData = defaults;
+  eePersistenceMarker = 0;
+  StorePersistence_EEPROM();
+}
+
+void MovePersistencePage_EEPROM(boolean reset)
+{
+  if (!checkEEPROMavailable())
+    return;
+
+  eePersistenceMarker = eePersistenceMarker + sizeof(PersistenceData);
+  PersistenceData.writeCycleCounter = 0;
+
+  // check if we reached the End of the EEPROM and Startover at the beginning
+  // if ((startofPersistence + eePersistenceMarker + sizeof(PersistenceData)) > ee.getDeviceSize() || reset)
+  // {
+  //   eePersistenceMarker = 0;
+  // }
+
+  ee.updateByte(0, (uint8_t)(eePersistenceMarker >> 8));
+  ee.updateByte(1, (uint8_t)(eePersistenceMarker & 0xFF));
+}
+
+uint32_t Checksum_EEPROM(uint8_t const *data, size_t len)
+{
+  if (data == NULL)
+    return 0;
+  uint32_t crc, mask;
+  crc = 0xFFFFFFFF;
+
+  while (len--)
+  {
+    crc ^= *data++;
+    for (uint8_t k = 0; k < 8; k++)
+    {
+      mask = -(crc & 1);
+      crc = (crc >> 1) ^ (0xEDB88320 & mask);
+    }
+  }
+  return ~crc;
+}
+
+void dumpEEPROM(uint16_t memoryAddress, uint16_t length)
+{
+#define BLOCK_TO_LENGTH 16
+
+  if (!checkEEPROMavailable())
+    return;
+
+  char ascii_buf[BLOCK_TO_LENGTH + 1];
+  sprintf(ascii_buf, "%*s", BLOCK_TO_LENGTH, "ASCII");
+  Serial.print(PSTR("\nAddress "));
+  for (int x = 0; x < BLOCK_TO_LENGTH; x++)
+    Serial.printf("%3d", x);
+
+  memoryAddress = memoryAddress / BLOCK_TO_LENGTH * BLOCK_TO_LENGTH;
+  length = (length + BLOCK_TO_LENGTH - 1) / BLOCK_TO_LENGTH * BLOCK_TO_LENGTH;
+
+  for (unsigned int i = 0; i < length; i++)
+  {
+    int blockpoint = memoryAddress % BLOCK_TO_LENGTH;
+    if (blockpoint == 0)
+    {
+      ascii_buf[BLOCK_TO_LENGTH] = 0;
+      Serial.printf("  %s", ascii_buf);
+      Serial.printf("\n0x%05X:", memoryAddress);
+    }
+    ascii_buf[blockpoint] = ee.readByte(memoryAddress);
+    Serial.printf(" %02X", ascii_buf[blockpoint]);
+    if (ascii_buf[blockpoint] < 0x20 || ascii_buf[blockpoint] > 0x7E)
+      ascii_buf[blockpoint] = '.';
+    memoryAddress++;
+  }
+  Serial.println();
+}
+
+boolean checkEEPROMavailable()
+{
+  if (!ee.isConnected())
+  {
+    MaintainDTC(DTC_NO_EEPROM_FOUND, true);
+    return false;
+  }
+  return true;
+}