mega64 Bootloader schreibt nur erste Seite.

/*

register unsigned int Pagedata @2;

register unsigned int PageAddress @4;

register unsigned int CurrentAddress @6;

register unsigned char k @8;

register char spmcrval @10;

*/

//rx_buffer[0]-[1] = PageNumber --> PageAdress

//rx_buffer[2]-[257] = PageData

for (i=0;i<256;i+=2) {

  Pagedata=rx_buffer1[i+2]+(rx_buffer1[i+3]<<8);

  while (SPMCR&1); //wait for spm complete

  CurrentAddress=(PageAddress*256)+i; 

  spmcrval=1;

  #asm 

  movw r30, r6;       //move CurrentAddress to Z pointer   

  mov r1, r3;         //move Pagedata MSB reg 1

  mov r0, r2;         //move Pagedata LSB reg 1  

  sts SpmcrAddr, r10; //move spmcrval to SPM control register

  spm;                //store program memory

  #endasm

}    

while (SPMCR&1);    //wait for spm complete

spmcrval=3;         //erase page

#asm 

movw r30, r4;       //move PageAddress to Z pointer

sts SpmcrAddr, r10; //move spmcrval to SPM control register              

spm;                //erase page

#endasm

while (SPMCR&1);    //wait for spm complete

spmcrval=5;         //write page

#asm 

movw r30, r4;       //move PageAddress to Z pointer

sts SpmcrAddr, r10; //move spmcrval to SPM control register              

spm;                //write page

#endasm

while (SPMCR&1);    // wait for spm complete

spmcrval=0x11;      // enableRWW  see mega8 datasheet for explanation

                    // P. 212 Section "Prevent reading the RWW section

                    // during self-programming

#asm 

sts SpmcrAddr, r10; //move spmcrval to SPMCR              

spm;

#endasm

for (j=0;j<256;j+=2) {

  CurrentAddress=(PageAddress*256)+j; 

  #asm

  movw r30, r6; //move  CurrentAddress to Z pointer  

  lpm r2, Z+;   //read LSB

  lpm r3, Z;    //read MSB

  #endasm    

  Checkdata = rx_buffer1[j+2] +(rx_buffer1[j+3]<<8);

  // PAGEDATA HAS BEEN FILLED BY ASM PART ABOVE!

  // Verify schlägt ab PageNumber 1 / CurrentAddress=256 fehl,

  // es werden immer 0xFFFF zurückgelesen.

  if (Pagedata != Checkdata) { 

    //ERROR

  }

}