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 ); } }