Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

HAL_AVR: avoid writing bytes to EEPROM that are already correct 

this speeds up writing of waypoint data, reducing latency
This commit is contained in:
Andrew Tridgell 2013-06-04 13:33:41 +10:00
parent 1c6baba7d8
commit 3c9d45d7d0
1 changed files with 10 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
libraries/AP_HAL_AVR/Storage.cpp
View File

@ -23,19 +23,25 @@ void AVREEPROMStorage::read_block(void *dst, uint16_t src, size_t n) {
}
void AVREEPROMStorage::write_byte(uint16_t loc, uint8_t value) {
eeprom_write_byte((uint8_t*)loc,value);
uint8_t b = eeprom_read_byte((uint8_t*)loc);
if (b != value) {
eeprom_write_byte((uint8_t*)loc, value);
}
}
void AVREEPROMStorage::write_word(uint16_t loc, uint16_t value) {
eeprom_write_word((uint16_t*)loc,value);
write_block(loc, &value, sizeof(value));
}
void AVREEPROMStorage::write_dword(uint16_t loc, uint32_t value) {
eeprom_write_dword((uint32_t*)loc,value);
write_block(loc, &value, sizeof(value));
}
void AVREEPROMStorage::write_block(uint16_t dst, void *src, size_t n) {
eeprom_write_block(src,(void*)dst,n);
uint8_t *p = (uint8_t *)src;
while (n--) {
write_byte(dst++, *p++);
}
}
#endif