diff --git a/bootloaders/stk500v2/stk500boot.c b/bootloaders/stk500v2/stk500boot.c index 0b49dffc5..c2dad4a88 100644 --- a/bootloaders/stk500v2/stk500boot.c +++ b/bootloaders/stk500v2/stk500boot.c @@ -1063,10 +1063,13 @@ int main(void) else { /* Read EEPROM */ + uint16_t ii = address >> 1; 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++; + EECR |= (1<