Mega2560 bootloader: fix wrong eeprom addressing

This commit is contained in:
Cristian Maglie 2013-03-07 22:00:26 +01:00
parent 06ee62afc6
commit 1066766bfa
1 changed files with 8 additions and 7 deletions

View File

@ -1021,13 +1021,14 @@ int main(void)
else
{
//* issue 543, this should work, It has not been tested.
// #if (!defined(__AVR_ATmega1280__) && !defined(__AVR_ATmega2560__) && !defined(__AVR_ATmega2561__) && !defined(__AVR_ATmega1284P__) && !defined(__AVR_ATmega640__))
#if (defined(EEARL) && defined(EEARH) && defined(EEMWE) && defined(EEWE) && defined(EEDR))
uint16_t ii = address >> 1;
/* write EEPROM */
do {
EEARL = address; // Setup EEPROM address
EEARH = (address >> 8);
address++; // Select next EEPROM byte
EEARL = ii; // Setup EEPROM address
EEARH = (ii >> 8);
address+=2; // Select next EEPROM byte
ii++;
EEDR = *p++; // get byte from buffer
EECR |= (1<<EEMWE); // Write data into EEPROM