AVR: Probleme mit Flash

[Henry (Gast)]

Hallo,

ich habe hier zwei Funktionen:

void Fls_WritePage(uint16_t page, const uint8_t *buf)
{
  uint32_t addr = page * SPM_PAGESIZE;

  uint8_t sreg;
  // Disable interrupts.
  sreg = SREG;
  cli();

  // clear page
  eeprom_busy_wait ();
  boot_page_erase (addr);
  boot_spm_busy_wait (); // Wait until the memory is erased.

  for (uint16_t i=0; i<SPM_PAGESIZE; i+=2)
  {
    // Set up little-endian word.
    uint16_t w = *buf++;
    w += (*buf++) << 8;
    boot_page_fill (addr+i, w);
  }

  boot_page_write (page); // Store buffer in flash page.
  boot_spm_busy_wait(); // Wait until the memory is written.
  // Reenable RWW-section again. We need this if we want to jump back
  // to the application after bootloading.
  boot_rww_enable ();
  // Re-enable interrupts (if they were ever enabled).
  SREG = sreg;
}

void Fls_ReadPage(uint16_t page, uint8_t *buf)
{
  uint32_t addr = page * SPM_PAGESIZE;

  uint8_t sreg;

  // Disable interrupts.
  sreg = SREG;
  cli();

  for (uint16_t i=0; i<SPM_PAGESIZE; i+=2u)
  {
    uint16_t dataWord = pgm_read_word_far( addr+i );

    buf[0] = (uint8_t) dataWord;
    buf[1] = (uint8_t) (dataWord >> 8);

    buf += 2;
  }

  SREG = sreg;
}

Die erste sollte mir Daten in den Flash speichern, und zwar eine 
komplette Page auf einmal.
Die zweite liest eine komplette Page und schreibt sie in den Puffer.

Zum Testen schreibe ich:

uint8_t TEST_pbRead[256];
uint8_t TEST_pbWrite[256];
...
  for (uint16_t i=0; i<256; i++)
  {
    TEST_pbWrite[i] = i;
  }
...
...
Fls_WritePage(0, TEST_pbWrite);
...
...
Fls_ReadPage(0, TEST_pbRead);

Eigentlich einfach: ich fülle mir ein Array mit Daten, schreibe sie in 
Page 0.
Danach lese ich Page 0 in ein zweites Array.
Die Arrays gebe ich mir mittels UART später aus.

So, wo liegt also das Problem.
Grundsätzlich läuft das Ganze. Allerdings nur, wenn ich Page 0 
lese/schreibe.

Ändere ich den Code in Page 1,2,3 ... geht entweder das Lesen oder das 
Schreiben daneben.
Das Lesearray enthält dann nur lauter 0xFF, deswegen gehe ich davon aus 
dass aus einem jungfräulichen Flashbereich gelesen wird.

Passt evtl. was in der Adressenberechnung nicht?
Ich denke, alle Makros aus der avr-libc arbeiten mit Byteaddressen. Sagt 
zumindest die Doku.
Was mich eben irritiert ist dass es mit Page 0 klappt...
Jemand ne Idee?

Achja:
ATmega1284P, Code wird aus dem Bootloaderbereich ausgeführt.