Bootloader Codevision

#include <mega16.h>

// Standard Input/Output functions

#define RXC         = 7;

#define SPMEM       = 0;

#define PGERS       = 1:

#define RWWSRE      = 4;

flash unsigned char PAGESIZE    = 64;         //Pagegröße in word -> 128Byte

flash unsigned char SITESIZE    = 128;        //Anzahl der Seiten -> 128Seiten * 128 Byte    

flash unsigned char DeviceID    = 16;

flash unsigned char PAGE_OK     = 1;

flash unsigned char PAGE_FALSE  = 0;

flash unsigned int  PageAdress  = 0x0200;

#pragma regalloc-        /* Deaktivierung der automatischen Vergabe von Adressen an Variablen*/

register unsigned int    daten               @0x0002;

register unsigned int    SiteAdress          @0x0004;

register unsigned int    CurrentAdress       @0x0006;

unsigned char            recbyte             @0x0062;

unsigned int             SendSite            @0x0064; 

unsigned int             i                   @0x0066;

unsigned int             j                   @0x0068;

unsigned char            PAGE_BUFFER[128]    @0x008A;

#pragma regalloc+        /* Aktivierung der automatischen Vergabe von Adressen an Variablen*/

//+++++++++++++++++++++++++++++++++++++++++++++++++++++

void BOOTLOAD(void);

void READ_COM_2_PUFFER(void);

void RAM_2_TEMP_PAGE(void);

void PAGE_ERASE(void);

void REENABLE_RWW(void);

void PAGE_WRITE(void);

void DO_SPM(void);

void RESTORE_ZPOINTER(void);

//+++++++++++++++++++++++++++++++++++++++++++++++++++++

// Get a character from the USART1 Receiver

char getchar(void)

{

     unsigned char data;

     while ( (UCSRA & 0x80)==0x00 );//0->keine Daten zum Lesen vorhanden 1->Daten bereit zum Lesen

     data=UDR;

     return data;

}

// Write a character to the USART1 Transmitter

void putchar(char c)

{

     while ( (UCSRA & 0x20)==0x00 );//0->Daten vorhanden zum senden 1->Frei zum Senden

     UDR=c;

}

//M A I N ++++++++++++++++++++++++++++++++++++++++++++++

void main(void)

{

//INIT USART

     UCSRB=0x18;

     UCSRC=0x86;

     UBRRL=0x17;

//##########

     i=0;

//Sende Startzeichen

     putchar(0x01);

//Warte um Daten zu empfangen - i>65000->Timeout führe Programm aus

     while ( ((UCSRA & 0x80)==0) & (i<65000) )i++;

     if (i<65000) 

     {

          recbyte=getchar();

          if(recbyte==0x02)BOOTLOAD();

     }

     #asm("jmp 0x00");   //Springe zur an Adresse0x00

}

void BOOTLOAD(void)

{

     putchar(DeviceID);

     i = 0;

//Warte um Daten zu empfangen - i->Timeout führe Programm aus

     while ( ((UCSRA&0x80)==0) & (i<65000) ) i++;

     if (i<65000)

     {    

         SendSite=getchar();

         for(SiteAdress=0; SiteAdress<=SendSite; SiteAdress++)

         {

         //Z-Pointer auf Adresse abstimmen

                    CurrentAdress = SiteAdress * (1<<6) + PageAdress;

         //Page löschen           

                    PAGE_ERASE();

         //Reaktivierung des RWW-Bereichs

                    REENABLE_RWW();

         //Daten aus serielle Schnittstelle lesen und in Array speichern

                    READ_COM_2_PUFFER();

         //Von Array in temporären Pagespeicher speichern       

                    RAM_2_TEMP_PAGE();

         //Page schreiben

                    PAGE_WRITE();

         //Reaktivierung des RWW-Bereichs

                    REENABLE_RWW();

                    //von temp Page nach Flash seitenweise kopieren

                    //Rückmelung an HOST, dass PAGE erfolgreich kopiert wurde und soll wenn i<SEND

/*                    if(SiteAdress<SendSite)

                    {    

                         putchar(0xFE);

                         while(!(UCSRA&0x80));

                         recbyte=getchar();

                         if(recbyte==1)SendSite++;

                    }

 */        }

     }

     putchar(0xFF);

}

void READ_COM_2_PUFFER(void)

{

     //Bereit zum Empfangen

     putchar(0x03);

     for(j=0;j<(PAGESIZE*2);j++)PAGE_BUFFER[j]=getchar();

}

void PAGE_ERASE(void)

{

     //Löscht Page die in PAGE-Adresse des Z-Pointer(Z6...Z12) steht 

     #asm   

          movw r30,r6;

          ldi  r17,0x03;

     #endasm     

     DO_SPM();

}

void REENABLE_RWW(void)

{

     #asm("ldi r17,0x11");

     DO_SPM();

}

void RAM_2_TEMP_PAGE(void)

{

     unsigned char n;

     for(n=0;n<128;n+=2)

     {    

          daten=PAGE_BUFFER[j]+256*PAGE_BUFFER[j+1];   //schreibt wort in registerpar r3+r2

          #asm("movw r0,r2");                             //kopiert wert r3+r2 in r1+r0

          DO_SPM();

          #asm("adiw r31:r30,2");                             //kopiert wert r3+r2 in r1+r0

     }

}

void PAGE_WRITE(void)

{

     #asm

          movw r30,r6;

          ldi r17,0x05;

     #endasm

     DO_SPM();

}

void DO_SPM(void)

{

     #asm

     WAIT_SPM:

          in   r16,0x37;           //SPMCR in Register r16 einlesen

          sbrc r16,0x01;           //Skip if Bit in Register is Cleared

          rjmp WAIT_SPM;

          out  0x37,r17;           //schreibe in SPMCR-Register und führe aus

          spm;

     #endasm

}