#define FLASH_START_ADDR       0x08000000UL
#define FLASH_PAGE_SIZE        1024
#define FLASH_PAGES            16
#define FLASH_WORD_SIZE        4UL
#define FLASH_ERASED_STATE     0xFF
#define CONFIG_START_ADDR      (FLASH_START_ADDR + ((FLASH_PAGES - 1) * FLASH_PAGE_SIZE))
#define CONFIG_WORDS           (CONFIG_RECORD_SIZE / FLASH_WORD_SIZE)
#define CONFIG_RECORD_SIZE     ((sizeof(config) + FLASH_WORD_SIZE - 1) & (~(FLASH_WORD_SIZE - 1)))
#define CONFIG_RECORDS         (FLASH_PAGE_SIZE / CONFIG_RECORD_SIZE)
#define CONFIG_RECORD_ADDR(N)  ((struct config_struct *)(CONFIG_START_ADDR + ((N) * CONFIG_RECORD_SIZE)))

U16 config_record;

//calculate config CRC
U16 config_calc_crc(void *addr) {
   return crc16_modbus_buf((U8 *)addr, sizeof(config)-sizeof(config.crc), CRC16_MODBUS_INIT);
}

//check config validity
U8 config_check_crc(void *addr) {
   return (((struct config_struct *)addr)->crc == config_calc_crc(addr));
}

//find last used (valid) record. If not found, returns 0xFFFF;
U16 config_last_record(void) {
   struct config_struct *cfg = (void *)CONFIG_START_ADDR;
   for (U16 i=0; i<CONFIG_RECORDS; i++) {
      if (!config_check_crc(cfg)) return i - 1;
      cfg++;
   }
   return CONFIG_RECORDS - 1;
}

//clear configuration (fill with default values)
void config_clear(void) {
   memset(&config, 0, sizeof(config));
}

//read last valid configuration from EEPROM
U8 config_read(void) {
   if (config_record == 0xFFFF) {
      config_clear();
      return 0;
   } else {
      config = *CONFIG_RECORD_ADDR(config_record);
      return 1;
   }
}

//write config to next record
void config_write(void) {
   config.crc = config_calc_crc(&config);
   FLASH_Unlock();
   config_record++;
   if (config_record >= CONFIG_RECORDS) {
      config_record = 0;
      FLASH_ErasePage(CONFIG_START_ADDR);
   }
   U32 *source_addr = (void *)&config;
   U32 *dest_addr = (void *)CONFIG_RECORD_ADDR(config_record);
   for (U16 i=0; i<CONFIG_WORDS; i++) {
      FLASH_ProgramWord((U32 )dest_addr, *source_addr);
      source_addr++;
      dest_addr++;
   }
   FLASH_Lock();
}

void setup_config(void) {
   config_record = config_last_record(); //find last record
   config_read(); //read last record
}