uint16_t EEPROMWearLeveler::findNextWriteAddress( int address )
{
uint16_t sb_start_addr = statusBufferAddress( address );
uint16_t i;
for ( i = sb_start_addr; i < ( _buffer_len + sb_start_addr ); i++ )
{
uint16_t prev_index;
// Wrap around case
if ( i == sb_start_addr )
{
prev_index = sb_start_addr + _buffer_len - 1;
}
else
prev_index = i - 1;
uint8_t prev_elem = EEPROM.read( prev_index );
uint8_t curr_elem = EEPROM.read( i );
// Must truncate the addition because the index tracking relies of wrap around
if ( ( ( prev_elem + 1 ) & 0xFF ) != curr_elem )
{
// Return the relative write position
uint16_t offset = i - sb_start_addr;
return offset;
}
}
//exit(0);
// Should never get here. Just in case return first index
return 0;
}
uint16_t EEPROMWearLeveler::findNextWriteAddress( int address )
{
uint16_t sb_start_addr = statusBufferAddress( address );
std::cout << "sb_start_addr: " << (int)sb_start_addr << std::endl;
uint16_t i;
for ( i = sb_start_addr; i < ( _buffer_len + sb_start_addr ); i++ )
{
uint16_t prev_index;
// Wrap around case
if ( i == sb_start_addr )
{
prev_index = sb_start_addr + _buffer_len - 1;
}
else
prev_index = i - 1;
uint8_t prev_elem = EEPROM.read( prev_index );
uint8_t curr_elem = EEPROM.read( i );
#if 0
std::cout << "prev_index: " << (int)prev_index << std::endl;
std::cout << "prev_elem: " << (int)prev_elem << std::endl;
std::cout << "curr_index: " << (int)i << std::endl;
std::cout << "curr_elem: " << (int)curr_elem << std::endl << std::endl;
#endif
// Must truncate the addition because the index tracking relies of wrap around
if ( ( ( prev_elem + 1 ) & 0xFF ) != curr_elem )
{
// Return the relative write position
uint16_t offset = i - sb_start_addr;
std::cout << "prev_elem + 1: " << prev_elem + 1 << " curr_elem: " << (int)curr_elem << std::endl;
std::cout << "prev_index: " << (int)prev_index << std::endl;
std::cout << "prev_elem: " << (int)prev_elem << std::endl;
std::cout << "curr_index: " << (int)i << std::endl;
std::cout << "curr_elem: " << (int)curr_elem << std::endl ;
std::cout << "offset: " << (int)offset << std::endl << std::endl;
return offset;
}
}
std::cout << "ERROR!!!!!!!!!!!!!!!!!!!!" << std::endl;
//exit(0);
// Should never get here. Just in case return first index
return 0;
}
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 );
}
}
