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 ); } }
// retrieve an integer from the EEPROM at nOffset. // return the integer int R5EEPROM::getIntAtOffset(const unsigned int nOffset) { unsigned int byte1 = EEPROM.read(nOffset); unsigned int byte2 = EEPROM.read(nOffset+1); return int(byte1+(byte2 << 8));
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; }
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 ); } }
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; }
// retrieve a stream of bytes from the EEPROM at nOffset into pBuff. return bytes read unsigned int R5EEPROM::getBytesAtOffset(unsigned char *pBuff, const unsigned int nLength, const unsigned int nOffset) { unsigned int nLen = 0; while(nLen < nLength) { *pBuff = EEPROM.read(nOffset + nLen); pBuff++; nLen++; } return nLen;
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 ); } }
// load data from EEPROM // return: the size loaded, 0 for error. static uint32_t EEPROM_Load(uint32_t addr, uint8_t * data, uint32_t size) { // the EEPROM size is 1K (0x000-0x3FF) if (addr + size < 0x400) { for (int i = 0; i < size; ++i) { data[i] = EEPROM.read(addr + i); } return size; } else { return 0; } }
// retrieve a zero terminated string from the EEPROM at nOffset into pBuff. // return length of string unsigned int R5EEPROM::getStringAtOffset(char *pBuff, const unsigned int nBuffLen, const unsigned int nOffset) { unsigned int nLen = 0; unsigned char byte; while(nLen < (nBuffLen-1)) { byte = EEPROM.read(nOffset + nLen); *pBuff = byte; pBuff++; if (byte == 0) break; nLen++; } *pBuff = 0; return nLen;
//--------------------------------------------------------------------- bool StateMachine::LoadFromEEPROM() { c1.threshold = EEPROM.read(CHANELSADDRES); c1.timeS = EEPROM.read(CHANELSADDRES + 1); c1.timeBan = EEPROM.read(CHANELSADDRES + 2); c2.threshold = EEPROM.read(CHANELSADDRES + 3); c2.timeS = EEPROM.read(CHANELSADDRES + 4); c2.timeBan = EEPROM.read(CHANELSADDRES + 5); c3.threshold = EEPROM.read(CHANELSADDRES + 6); c3.timeS = EEPROM.read(CHANELSADDRES + 7); c3.timeBan = EEPROM.read(CHANELSADDRES + 8); }