Форум РадиоКот

Код: Выделить всё

#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
}