struct
{byte       DAT_LNG;
byte       buffer[128];
}rx_buffer;
#define CMD rx_buffer.buffer[0]
...
...
#ROM 0x7D00,0x7FFF
void Bootloader()
{int8 i,cnt1,cnt2,cnt3,bltmp1,bltmp2;
int16 wrdata;
int32 fladr;
Disable_Interrupts(GLOBAL);
Disable_Interrupts(INT_RDA);
Disable_Interrupts(INT_RTCC);
Disable_Interrupts(LOW_VOLT);
Disable_Interrupts(INT_TIMER2);
// restart_wdt();
INTCON = 0x00;   // Колкото и тъпо да звучи,
INTCON2 = 0x80; // тия 5 реда помагат с 4-5 %
INTCON3 = 0;
PIE_1 = 0;
PIE_2 = 0;
cnt1  = 0;
cnt2  = 0;
rx_stat = 0;
If (CON_BTLDR == True) // Тия редове ми пращат ID на FIRMWARE-а
{printf("K");putc(0x09);printf("My Recent Device    1.1");}
else printf("RE");
CON_BTLDR = False;
boot_check:
if (!kbhit())  goto poll_boot_end;
  if (!ch1)
   {
   fladr = (int32)getc()<<24;
   ch1 = True;       // Set ID_H reception
   }else
   if (!ch2)
   {fladr+= (int32)getc()<<16;
    ch2 = True;      // Set ID_L reception
   }else
   if (!ch3)
   {fladr+= (int16)getc()<<8;
    ch3 = True;
   }else
   if (!ch4)
   {fladr+= getc();
    ch4 = True;
   }else
   if (!ch5)
   {rx_buffer.DAT_LNG = getc();        // Retrieve Data Length in rx_buffer
   if (rx_buffer.DAT_LNG > 0)
          {ch5 = True;
          bltmp1 = 0;
          bltmp2 = 0;} else rx_stat = 0;   // If Data Length is 0 (ERROR) then reset connection
   }else
   if (!ch6)
       {rx_buffer.buffer[bltmp1] = getc();
      bltmp2 = bltmp2 + rx_buffer.buffer[bltmp1];           // Update checksum
      bltmp1 ++;
      if (bltmp1 > rx_buffer.DAT_LNG ) {
         bltmp2 = bltmp2 - rx_buffer.buffer[bltmp1-1];      // Substract last byte from checksum
         ch6 = True;
         if (bltmp2 == rx_buffer.buffer[bltmp1-1])           // Verify last byte with checksum
         {rx_stat = 0;
          cnt1 = 0;
          cnt2 = 0;
BootSector:
         i = 0;
         if (fladr<0xF00000)
         {//do {erase_program_eeprom(fladr+l);l++;} while (l<rx_buffer.DAT_LNG);
            INTCON = 0x00;   // Аха, много е тъпо...
            INTCON2 = 0x80;
            INTCON3 = 0;
            PIE_1 = 0;
            PIE_2 = 0;
            //SETUP_WDT(WDT_ON);
            write_program_memory(fladr,rx_buffer.buffer,rx_buffer.DAT_LNG);
         }
          else
           do
            {write_eeprom(fladr,rx_buffer.buffer[i]);
             fladr++;
             i=i+2;
             #ASM
             write_wait:
               btfsc   EECON1,1
             goto   write_wait
             #ENDASM
            }
          while (i<rx_buffer.DAT_LNG);
         printf("OK");
         }};
      };

poll_boot_end:
//    restart_wdt();
#use rs232(baud=500000,parity=N,xmit=PIN_C6,rcv=PIN_C7,bits=8,enable=PIN_D0)
#ASM
decfsz cnt1,f
goto   boot_check
decfsz cnt2,f
goto   boot_check
decfsz cnt3,f
goto   boot_check
#ENDASM
reset_cpu();//Restart
}

unsigned char WriteFlash(unsigned char *UserBuffer, unsigned char AddrH){

   unsigned char i,j;
   unsigned int n;

   Store[0]=TBLPTRU; Store[1]=TBLPTRH;   Store[2]=TBLPTRL; Store[3]=TABLAT;
   TBLPTRU = 0; TBLPTRH = AddrH;

   for (i=0;i<4;i++){
      TBLPTRL = i*64;
      EECON1 = 0b10010100;
      EECON2 = 0x55;
      EECON2 = 0xAA;
      EECON1bits.WR = 1;
   }
   TBLPTRL=0;TBLPTRH = AddrH;
   for(i=0;i<32;i++) {
      for(j=0;j<8;j++) {
         TABLAT=UserBuffer[i*8+j];
         _asm TBLWTPOSTINC _endasm
      }
      _asm TBLRDPOSTDEC _endasm
      EECON1 = 0b10000100;
      EECON2 = 0x55;
      EECON2 = 0xAA;
      EECON1bits.WR = 1;
      Nop();
      _asm TBLRDPOSTINC _endasm         
   }
   EECON1=0;

   TBLPTRL=0;TBLPTRH = AddrH;
   for(n=0;n<256;n++) {
      _asm TBLRDPOSTINC _endasm
      if(TABLAT != UserBuffer[n]) {
         TBLPTRU = Store[0]; TBLPTRH = Store[1];   TBLPTRL = Store[2]; TABLAT = Store[3];
         return FLASH_WRITE_ERROR;
      }
   }   
   TBLPTRU=Store[0]; TBLPTRH=Store[1];   TBLPTRL=Store[2]; TABLAT=Store[3];
   return 0;
}

INTCON=0;INTCON3=0;PIE1=0;PIE2=0;

#use RS232...