uint8_t EEPROMWearLeveler::read( uint16_t address )
{
if ( _num_of_vars == AVR_EEPROM_SIZE )
{
// Revert back to EEPROM class if the nubmer of variables is
// greater than AVR_EEPROM_SIZE/4
return EEPROM.read( address );
}
else
{
uint16_t write_offset = findNextWriteAddress( address );
uint16_t pb_start_addr = parameterBufferAddress( address );
uint16_t read_addr = pb_start_addr + write_offset;
if ( read_addr == pb_start_addr )
{
std::cout << read_addr << " BBBBBBBB\n";
read_addr += _buffer_len - 1;
}
else
{
read_addr -= 1;
std::cout << "AAAAAA\n";
}
std::cout << "read address: " << read_addr << std::endl;
std::cout << "pb_start_addr: " << pb_start_addr << std::endl;
std::cout << "write_offset: " << write_offset << std::endl;
std::cout << "address: " << address << std::endl;
return EEPROM.read( read_addr );
}
}
uint8_t EEPROMWearLeveler::read( uint16_t address )
{
if ( _num_of_vars == AVR_EEPROM_SIZE )
{
// Revert back to EEPROM class if the nubmer of variables is
// greater than AVR_EEPROM_SIZE/4
return EEPROM.read( address );
}
else
{
uint16_t write_offset = findNextWriteAddress( address );
uint16_t pb_start_addr = parameterBufferAddress( address );
uint16_t read_addr = pb_start_addr + write_offset;
if ( read_addr == pb_start_addr )
{
read_addr += _buffer_len - 1;
}
else
{
read_addr -= 1;
}
return EEPROM.read( read_addr );
}
}
void EEPROMWearLeveler::write( uint16_t address, uint8_t value )
{
if ( _num_of_vars == AVR_EEPROM_SIZE )
{
// Revert back to EEPROM class if the nubmer of variables is
// greater than AVR_EEPROM_SIZE/4
EEPROM.write( address, value );
}
else
{
// bounds check
if ( address >= _num_of_vars )
{
std::cout << " BAD address \n";
return;
}
uint16_t write_offset = findNextWriteAddress( address );
std::cout << "write_offset: " << write_offset << std::endl;
uint16_t pb_start_addr = parameterBufferAddress( address );
std::cout << "pb_start_addr: " << pb_start_addr << std::endl;
std::cout << "write address: " << pb_start_addr + write_offset << std::endl;
// Write value to paramater buffer
EEPROM.write( pb_start_addr + write_offset, value );
// Update status buffer
uint16_t sb_start_addr = statusBufferAddress( address );
uint16_t curr_index = sb_start_addr + write_offset;
uint16_t prev_index;
std::cout << "curr_index: " << (int)curr_index << std::endl;
std::cout << "sb_start_addr: " << (int)sb_start_addr << std::endl;
std::cout << "write_offset: " << (int)write_offset << std::endl;
// Wrap around case
if ( curr_index == sb_start_addr )
prev_index = sb_start_addr + _buffer_len - 1;
else
prev_index = curr_index - 1;
uint16_t sb_val = EEPROM.read(prev_index) + 1;
std::cout << "write status buffer at: " << (int)curr_index << std::endl;
std::cout << "\tstatus buffer value: " << (int)sb_val << std::endl;
EEPROM.write( curr_index, sb_val );
}
}
