Добавлена библиотека eeprom
This commit was merged in pull request #5.
This commit is contained in:
klassents committed
1 parent
033aaf9968
commit
1bffc28767
16 files changed
+942
-1
No files matched your search
@@ -0,0 +1,125 @@
|
||||
#include "EEPROM.h"
|
||||
#include "mik32_hal_eeprom.h"
|
||||
#include "mik32_hal.h"
|
||||
|
||||
HAL_EEPROM_HandleTypeDef heeprom;
|
||||
|
||||
|
||||
void EEPROMClass:: begin()
|
||||
{
|
||||
heeprom.Instance = EEPROM_REGS;
|
||||
heeprom.Mode = HAL_EEPROM_MODE_TWO_STAGE;
|
||||
heeprom.ErrorCorrection = HAL_EEPROM_ECC_ENABLE;
|
||||
heeprom.EnableInterrupt = HAL_EEPROM_SERR_DISABLE;
|
||||
|
||||
HAL_EEPROM_Init(&heeprom);
|
||||
HAL_EEPROM_CalculateTimings(&heeprom, OSC_SYSTEM_VALUE);
|
||||
}
|
||||
|
||||
uint8_t read_byte( int idx )
|
||||
{
|
||||
// Проверка адекватности адреса idx
|
||||
if (idx < 0)
|
||||
{
|
||||
idx = -idx;
|
||||
ErrorMsgHandler("EEPROM.read(): The eeprom cell address must be non-negative");
|
||||
}
|
||||
if ((uint32_t)idx >= (uint32_t)EEPROM_LENGHT)
|
||||
{
|
||||
idx = (int)((uint32_t)idx % EEPROM_LENGHT);
|
||||
ErrorMsgHandler("EEPROM.read(): The address of the eeprom cell goes beyond the eeprom");
|
||||
}
|
||||
|
||||
uint32_t read_data_buf[EEPROM_PAGE_WORDS] = {};
|
||||
|
||||
// Вычисление адреса начала нужной страницы
|
||||
uint32_t addr = EEPROM_START_ADDR + (((uint32_t)idx) / EEPROM_PAGE_SIZE) * EEPROM_PAGE_SIZE;
|
||||
// Чтение нужной страницы
|
||||
HAL_EEPROM_Read(&heeprom, (uint16_t)addr, read_data_buf, EEPROM_PAGE_WORDS, EEPROM_OP_TIMEOUT);
|
||||
// Адрес искомого слова в eeprom: EEPROM_START_ADDR + (uint32_t)idx
|
||||
uint32_t word_addr = EEPROM_START_ADDR + (((uint32_t)idx) / EEPROM_WORD_SIZE) * EEPROM_WORD_SIZE;
|
||||
// Индекс искомого слова в массиве read_data_buf: адрес слова в eeprom за вычетом адреса начала страницы
|
||||
uint32_t word_idx = (word_addr - addr) / EEPROM_WORD_SIZE;
|
||||
// Номер байта в составе слова
|
||||
uint32_t byte_idx = ((uint32_t)idx) % EEPROM_WORD_SIZE;
|
||||
// Вычленение нужного байта из страницы
|
||||
return (uint8_t)(( read_data_buf[word_idx] & (((uint32_t)0xFF) << ((EEPROM_WORD_SIZE - byte_idx - 1) * 8)) ) >> ((EEPROM_WORD_SIZE - byte_idx - 1) * 8));
|
||||
}
|
||||
|
||||
void write_byte( int idx, uint8_t val )
|
||||
{
|
||||
// Проверка адекватности адреса idx
|
||||
if (idx < 0)
|
||||
{
|
||||
idx = -idx;
|
||||
ErrorMsgHandler("EEPROM.write(): The eeprom cell address must be non-negative");
|
||||
}
|
||||
if ((uint32_t)idx >= (uint32_t)EEPROM_LENGHT)
|
||||
{
|
||||
idx = (int)((uint32_t)idx % EEPROM_LENGHT);
|
||||
ErrorMsgHandler("EEPROM.write(): The address of the eeprom cell goes beyond the eeprom");
|
||||
}
|
||||
update_byte(idx, val);
|
||||
}
|
||||
|
||||
// Делает то же, что и write, но записывает только если новый байт отличается от уже записанного
|
||||
void update_byte( int idx, uint8_t val )
|
||||
{
|
||||
// Проверка адекватности адреса idx
|
||||
if (idx < 0)
|
||||
{
|
||||
idx = -idx;
|
||||
ErrorMsgHandler("EEPROM.update(): The eeprom cell address must be non-negative");
|
||||
}
|
||||
if ((uint32_t)idx >= (uint32_t)EEPROM_LENGHT)
|
||||
{
|
||||
idx = (int)((uint32_t)idx % EEPROM_LENGHT);
|
||||
ErrorMsgHandler("EEPROM.update(): The address of the eeprom cell goes beyond the eeprom");
|
||||
}
|
||||
|
||||
uint32_t write_data_buf[EEPROM_PAGE_WORDS] = {};
|
||||
|
||||
// Вычисление адреса начала нужной страницы
|
||||
uint32_t addr = EEPROM_START_ADDR + (((uint32_t)idx) / EEPROM_PAGE_SIZE) * EEPROM_PAGE_SIZE;
|
||||
// Читаем нужную страницу
|
||||
HAL_EEPROM_Read(&heeprom, (uint16_t)addr, write_data_buf, EEPROM_PAGE_WORDS, EEPROM_OP_TIMEOUT);
|
||||
// Адрес искомого слова в eeprom: EEPROM_START_ADDR + (uint32_t)idx
|
||||
uint32_t word_addr = EEPROM_START_ADDR + (((uint32_t)idx) / EEPROM_WORD_SIZE) * EEPROM_WORD_SIZE;
|
||||
// Индекс искомого слова в массиве write_data_buf: адрес слова в eeprom за вычетом адреса начала страницы
|
||||
uint32_t word_idx = (word_addr - addr) / EEPROM_WORD_SIZE;
|
||||
// Номер байта в составе слова
|
||||
uint32_t byte_idx = ((uint32_t)idx) % EEPROM_WORD_SIZE;
|
||||
// Извлечение нужного байта
|
||||
uint32_t byte = ((uint32_t)val) << ((EEPROM_WORD_SIZE - byte_idx - 1) * 8);
|
||||
uint8_t oldVal = (uint8_t)(*((uint8_t*)write_data_buf + word_idx * EEPROM_WORD_SIZE + (EEPROM_WORD_SIZE - byte_idx - 1)));
|
||||
// Проверка того, что записанный байт отличается от нового
|
||||
if(oldVal != val)
|
||||
{
|
||||
// Очистка нужной страницы
|
||||
HAL_EEPROM_Erase(&heeprom, (uint16_t)addr, EEPROM_PAGE_WORDS, HAL_EEPROM_WRITE_SINGLE, EEPROM_OP_TIMEOUT);
|
||||
// Вычленение и замена нужного байта из страницы
|
||||
write_data_buf[word_idx] = (write_data_buf[word_idx] & (~((uint32_t)(0xFF) << ((EEPROM_WORD_SIZE - byte_idx - 1) * 8)))) | byte;
|
||||
|
||||
HAL_EEPROM_Write(&heeprom, (uint16_t)addr, write_data_buf, EEPROM_PAGE_WORDS, HAL_EEPROM_WRITE_SINGLE, EEPROM_OP_TIMEOUT);
|
||||
}
|
||||
}
|
||||
|
||||
// uint16_t EEPROMClass:: length( void )
|
||||
// {
|
||||
// return (uint16_t)EEPROM_LENGHT;
|
||||
// }
|
||||
|
||||
void HAL_read(uint16_t addr, uint32_t * data)
|
||||
{
|
||||
HAL_EEPROM_Read(&heeprom, (uint16_t)addr, data, EEPROM_PAGE_WORDS, EEPROM_OP_TIMEOUT);
|
||||
}
|
||||
|
||||
void HAL_write(uint16_t addr, uint32_t * data)
|
||||
{
|
||||
HAL_EEPROM_Write(&heeprom, (uint16_t)addr, data, EEPROM_PAGE_WORDS, HAL_EEPROM_WRITE_SINGLE, EEPROM_OP_TIMEOUT);
|
||||
}
|
||||
|
||||
void HAL_erase(uint16_t addr)
|
||||
{
|
||||
HAL_EEPROM_Erase(&heeprom, (uint16_t)addr, EEPROM_PAGE_WORDS, HAL_EEPROM_WRITE_SINGLE, EEPROM_OP_TIMEOUT);
|
||||
}
|
||||
@@ -0,0 +1,254 @@
|
||||
#ifndef EEPROM_h
|
||||
#define EEPROM_h
|
||||
|
||||
#include <inttypes.h>
|
||||
#include "string.h"
|
||||
|
||||
#define EEPROM_OP_TIMEOUT 100000
|
||||
#define EEPROM_PAGE_WORDS 32 // Количество слов на странице
|
||||
#define EEPROM_PAGE_COUNT 8 // КОличество страниц пользовательской EEPROM
|
||||
#define EEPROM_START_ADDR 0x1C00 // Адрес начала пользовательской EEPROM
|
||||
#define EEPROM_WORD_SIZE 4 // Слово занимает 4 байта
|
||||
#define EEPROM_PAGE_SIZE ( EEPROM_PAGE_WORDS * EEPROM_WORD_SIZE ) // Страница занимает 32*4 = 128 байт
|
||||
#define EEPROM_END 0x1FFF
|
||||
#define EEPROM_LENGHT (EEPROM_PAGE_SIZE * EEPROM_PAGE_COUNT)
|
||||
|
||||
void HAL_read(uint16_t addr, uint32_t * data);
|
||||
void HAL_write(uint16_t addr, uint32_t * data);
|
||||
void HAL_erase(uint16_t addr);
|
||||
uint8_t read_byte( int idx );
|
||||
void write_byte( int idx, uint8_t val );
|
||||
void update_byte( int idx, uint8_t val );
|
||||
|
||||
extern void ErrorMsgHandler(const char * msg);
|
||||
|
||||
struct EERef{
|
||||
|
||||
EERef( const int index )
|
||||
: index( index ) {}
|
||||
|
||||
uint8_t operator*() const { return read_byte( index ); }
|
||||
operator uint8_t() const { return **this; }
|
||||
|
||||
EERef &operator=( const EERef &ref ) { return *this = *ref; }
|
||||
EERef &operator=( uint8_t in ) { return write_byte( index, in ), *this; }
|
||||
EERef &operator +=( uint8_t in ) { return *this = **this + in; }
|
||||
EERef &operator -=( uint8_t in ) { return *this = **this - in; }
|
||||
EERef &operator *=( uint8_t in ) { return *this = **this * in; }
|
||||
EERef &operator /=( uint8_t in ) { return *this = **this / in; }
|
||||
EERef &operator ^=( uint8_t in ) { return *this = **this ^ in; }
|
||||
EERef &operator %=( uint8_t in ) { return *this = **this % in; }
|
||||
EERef &operator &=( uint8_t in ) { return *this = **this & in; }
|
||||
EERef &operator |=( uint8_t in ) { return *this = **this | in; }
|
||||
EERef &operator <<=( uint8_t in ) { return *this = **this << in; }
|
||||
EERef &operator >>=( uint8_t in ) { return *this = **this >> in; }
|
||||
|
||||
EERef &update( uint8_t in ) { return in != *this ? *this = in : *this; }
|
||||
|
||||
/** Prefix increment/decrement **/
|
||||
EERef& operator++() { return *this += 1; }
|
||||
EERef& operator--() { return *this -= 1; }
|
||||
|
||||
/** Postfix increment/decrement **/
|
||||
uint8_t operator++ (int){
|
||||
uint8_t ret = **this;
|
||||
return ++(*this), ret;
|
||||
}
|
||||
|
||||
uint8_t operator-- (int){
|
||||
uint8_t ret = **this;
|
||||
return --(*this), ret;
|
||||
}
|
||||
|
||||
int index;
|
||||
};
|
||||
|
||||
struct EEPtr{
|
||||
|
||||
EEPtr( const int index )
|
||||
: index( index ) {}
|
||||
|
||||
operator int() const { return index; }
|
||||
EEPtr &operator=( int in ) { return index = in, *this; }
|
||||
|
||||
bool operator!=( const EEPtr &ptr ) { return index != ptr.index; }
|
||||
EERef operator*() { return index; }
|
||||
|
||||
EEPtr& operator++() { return ++index, *this; }
|
||||
EEPtr& operator--() { return --index, *this; }
|
||||
EEPtr operator++ (int) { return index++; }
|
||||
EEPtr operator-- (int) { return index--; }
|
||||
|
||||
int index;
|
||||
};
|
||||
|
||||
struct EEPROMClass{
|
||||
|
||||
//Basic user access methods.
|
||||
EERef operator[]( const int idx ) { return idx; }
|
||||
uint8_t read( int idx ) { return EERef( idx ); }
|
||||
void write( int idx, uint8_t val ) { (EERef( idx )) = val; }
|
||||
void update( int idx, uint8_t val ) { update_byte(idx, val); }
|
||||
|
||||
void begin();
|
||||
EEPtr end() { return length(); } // Standards requires this to be the item after the last valid entry. The returned pointer is invalid.
|
||||
uint16_t length() { return (uint16_t)EEPROM_LENGHT; }
|
||||
|
||||
template< typename T >
|
||||
T &put(int idx, T &data)
|
||||
{
|
||||
void* dataPointer = (void*)&data;
|
||||
// Проверка адекватности адреса idx
|
||||
if (idx < 0)
|
||||
{
|
||||
idx = -idx;
|
||||
ErrorMsgHandler("EEPROM.put(): The eeprom cell address must be non-negative");
|
||||
}
|
||||
if ((uint32_t)idx >= (uint32_t)EEPROM_LENGHT)
|
||||
{
|
||||
idx = (int)((uint32_t)idx % EEPROM_LENGHT);
|
||||
ErrorMsgHandler("EEPROM.put(): The address of the eeprom cell goes beyond the eeprom");
|
||||
}
|
||||
|
||||
uint32_t write_data_buf[EEPROM_PAGE_WORDS] = {};
|
||||
// Размер данных под запись
|
||||
uint32_t dataSize = sizeof(data);
|
||||
// Сдвиг начала записи данных
|
||||
uint32_t dataShift = 0;
|
||||
uint32_t writeSize = dataSize;
|
||||
|
||||
// Вычисление адреса начала нужной страницы
|
||||
uint32_t addr = EEPROM_START_ADDR + (((uint32_t)idx) / EEPROM_PAGE_SIZE) * EEPROM_PAGE_SIZE;
|
||||
// Адрес искомого слова в eeprom: EEPROM_START_ADDR + (uint32_t)idx
|
||||
uint32_t word_addr = EEPROM_START_ADDR + (((uint32_t)idx) / EEPROM_WORD_SIZE) * EEPROM_WORD_SIZE;
|
||||
// Индекс искомого слова в массиве write_data_buf: адрес слова в eeprom за вычетом адреса начала страницы
|
||||
uint32_t word_idx = (word_addr - addr) / EEPROM_WORD_SIZE;
|
||||
// Адрес начала данных на странице
|
||||
uint32_t byte_addr = (uint32_t)idx % EEPROM_PAGE_SIZE;
|
||||
// Номер байта в составе слова
|
||||
uint32_t byte_idx = ((uint32_t)idx) % EEPROM_WORD_SIZE;
|
||||
// Чтение первой страницы
|
||||
HAL_read((uint16_t)addr, write_data_buf);
|
||||
// Если данные не влезут на первую страницу, то записываем только то, что влезло
|
||||
if (EEPROM_PAGE_SIZE - byte_addr < dataSize)
|
||||
writeSize = EEPROM_PAGE_SIZE - byte_addr;
|
||||
uint32_t lastWord = (writeSize + byte_idx - 1) / EEPROM_WORD_SIZE + word_idx;
|
||||
dataSize -= writeSize;
|
||||
// Запись данных постранично, сначала записываем первую страницу - отдельно
|
||||
memcpy((void *)((uint8_t *)write_data_buf + byte_addr), (void*)dataPointer, writeSize);
|
||||
// Разворачиваем слова
|
||||
for(uint8_t i = word_idx; i <= lastWord; i++)
|
||||
{
|
||||
uint32_t word = write_data_buf[i];
|
||||
write_data_buf[i] = 0;
|
||||
write_data_buf[i] = ((word & 0xFF)<<24) | ((word & (0xFF<<8))<<8) | ((word & (0xFF<<16))>>8) | ((word & (0xFF<<24))>>24);
|
||||
}
|
||||
HAL_erase((uint16_t)addr);
|
||||
HAL_write((uint16_t)addr, write_data_buf);
|
||||
// Если данные остались после записи первой страницы, то пишем их постранично, пока не закончатся
|
||||
while (dataSize > 0)
|
||||
{
|
||||
addr += EEPROM_PAGE_SIZE;
|
||||
// При достижении крайнего адреса eeprom возвращаемся к начальному адресу
|
||||
if (addr == EEPROM_START_ADDR + EEPROM_LENGHT)
|
||||
addr = EEPROM_START_ADDR;
|
||||
HAL_read((uint16_t)addr, write_data_buf);
|
||||
dataShift += writeSize;
|
||||
writeSize = dataSize;
|
||||
if (EEPROM_PAGE_SIZE < dataSize)
|
||||
writeSize = EEPROM_PAGE_SIZE;
|
||||
lastWord = (writeSize - 1) / EEPROM_WORD_SIZE;
|
||||
memcpy((void *)(write_data_buf), (void*)((uint8_t *)dataPointer + dataShift), writeSize);
|
||||
// Разворачиваем слова
|
||||
for(uint8_t i = 0; i <= lastWord; i++)
|
||||
{
|
||||
uint32_t word = write_data_buf[i];
|
||||
write_data_buf[i] = 0;
|
||||
write_data_buf[i] = ((word & 0xFF)<<24) | ((word & (0xFF<<8))<<8) | ((word & (0xFF<<16))>>8) | ((word & (0xFF<<24))>>24);
|
||||
}
|
||||
// write_data_buf[0] = writeSize;
|
||||
HAL_erase((uint16_t)addr);
|
||||
HAL_write((uint16_t)addr, write_data_buf);
|
||||
dataSize -= writeSize;
|
||||
}
|
||||
return data;
|
||||
}
|
||||
|
||||
template< typename T >
|
||||
T &get(int idx, T &data)
|
||||
{
|
||||
void* dataPointer = (void*)&data;
|
||||
// Проверка адекватности адреса idx
|
||||
if (idx < 0)
|
||||
{
|
||||
idx = -idx;
|
||||
ErrorMsgHandler("EEPROM.get(): The eeprom cell address must be non-negative");
|
||||
}
|
||||
if ((uint32_t)idx >= (uint32_t)EEPROM_LENGHT)
|
||||
{
|
||||
idx = (int)((uint32_t)idx % EEPROM_LENGHT);
|
||||
ErrorMsgHandler("EEPROM.get(): The address of the eeprom cell goes beyond the eeprom");
|
||||
}
|
||||
|
||||
uint32_t read_data_buf[EEPROM_PAGE_WORDS] = {};
|
||||
// Размер данных
|
||||
uint32_t dataSize = sizeof(data);
|
||||
// Сдвиг начала чтения данных
|
||||
uint32_t dataShift = 0;
|
||||
uint32_t readSize = dataSize;
|
||||
|
||||
// Вычисление адреса начала нужной страницы
|
||||
uint32_t addr = EEPROM_START_ADDR + (((uint32_t)idx) / EEPROM_PAGE_SIZE) * EEPROM_PAGE_SIZE;
|
||||
// Адрес искомого слова в eeprom: EEPROM_START_ADDR + (uint32_t)idx
|
||||
uint32_t word_addr = EEPROM_START_ADDR + (((uint32_t)idx) / EEPROM_WORD_SIZE) * EEPROM_WORD_SIZE;
|
||||
// Индекс искомого слова в массиве write_data_buf: адрес слова в eeprom за вычетом адреса начала страницы
|
||||
uint32_t word_idx = (word_addr - addr) / EEPROM_WORD_SIZE;
|
||||
// Адрес начала данных на странице
|
||||
uint32_t byte_addr = (uint32_t)idx % EEPROM_PAGE_SIZE;
|
||||
// Номер байта в составе слова
|
||||
uint32_t byte_idx = ((uint32_t)idx) % EEPROM_WORD_SIZE;
|
||||
// Чтение первой страницы
|
||||
HAL_read((uint16_t)addr, read_data_buf);
|
||||
if (EEPROM_PAGE_SIZE - byte_addr < dataSize)
|
||||
readSize = EEPROM_PAGE_SIZE - byte_addr;
|
||||
uint32_t lastWord = (readSize + byte_idx - 1) / EEPROM_WORD_SIZE + word_idx;
|
||||
dataSize -= readSize;
|
||||
// Разворачиваем слова
|
||||
for(uint8_t i = word_idx; i <= lastWord; i++)
|
||||
{
|
||||
uint32_t word = read_data_buf[i];
|
||||
read_data_buf[i] = 0;
|
||||
read_data_buf[i] = ((word & 0xFF)<<24) | ((word & (0xFF<<8))<<8) | ((word & (0xFF<<16))>>8) | ((word & (0xFF<<24))>>24);
|
||||
}
|
||||
// Чтение данных постранично, сначала читаем первую страницу - отдельно
|
||||
memcpy((void *)dataPointer, (void*)((uint8_t *)read_data_buf + byte_addr), readSize);
|
||||
|
||||
// Если данные остались после записи первой страницы, то пишем их постранично, пока не закончатся
|
||||
while (dataSize > 0)
|
||||
{
|
||||
addr += EEPROM_PAGE_SIZE;
|
||||
// При достижении крайнего адреса eeprom возвращаемся к начальному адресу
|
||||
if (addr == EEPROM_START_ADDR + EEPROM_LENGHT)
|
||||
addr = EEPROM_START_ADDR;
|
||||
HAL_read((uint16_t)addr, read_data_buf);
|
||||
dataShift += readSize;
|
||||
readSize = dataSize;
|
||||
if (EEPROM_PAGE_SIZE < dataSize)
|
||||
readSize = EEPROM_PAGE_SIZE;
|
||||
lastWord = (dataSize - 1) / EEPROM_WORD_SIZE;
|
||||
// Разворачиваем слова
|
||||
for(uint8_t i = 0; i <= lastWord; i++)
|
||||
{
|
||||
uint32_t word = read_data_buf[i];
|
||||
read_data_buf[i] = 0;
|
||||
read_data_buf[i] = ((word & 0xFF)<<24) | ((word & (0xFF<<8))<<8) | ((word & (0xFF<<16))>>8) | ((word & (0xFF<<24))>>24);
|
||||
}
|
||||
memcpy((void *)((uint8_t *)dataPointer + dataShift), (void*)(read_data_buf), readSize);
|
||||
dataSize -= readSize;
|
||||
}
|
||||
return data; // Возвращаем ссылку на переданный объект с прочитанными данными
|
||||
}
|
||||
};
|
||||
|
||||
static EEPROMClass EEPROM;
|
||||
#endif
|
||||
Reference in new issue
Block a user