void FLASH_WriteBlock(UInt16  startAddress, const UInt8*  pSrcData)
{
    UInt8  byteCount;
    UInt8  tblptru_temp;
    UInt8  tblptrh_temp;
    UInt8  tblptrl_temp;
    UInt8  address_lo;
    UInt8  address_hi;
    struct {
        UInt8  GIE :1;
    } temp;

    temp.GIE = 0;

    /* Store the current content TBLPTR regs */
    tblptru_temp = TBLPTRU;
    tblptrh_temp = TBLPTRH;
    tblptrl_temp = TBLPTRL;

    /* Load table pointer with the starting address to program */
    address_hi = (UInt8)(startAddress >> 8);
    address_lo = ((UInt8)startAddress) & (0xFF ^ (_FLASH_WRITE_SIZE - 1)); /* Align to 64-bit boundary */

    TBLPTRU = 0;
    TBLPTRH = address_hi;
    TBLPTRL = address_lo;

    /* Write all data to holding registers */
    byteCount = _FLASH_WRITE_SIZE;
    do
    {
        TABLAT = *pSrcData;
#ifndef WIN32
#asm
        TBLWT*+
#endasm
#endif
        pSrcData++;
        byteCount--;
    }
    while (0 < byteCount);

    /* Reload TBL pointer with initial value */
    TBLPTRH = address_hi;
    TBLPTRL = address_lo;

    /* Prepare the write operation */
    EECON1bits.EEPGD = 1; /* Point to Flash program memory */
    EECON1bits.CFGS  = 0; /* Access Flash program memory   */
    EECON1bits.WREN  = 1; /* Enable write to memory        */
    EECON1bits.FREE  = 0; /* Disable block Erase operation  */// Is it necessary?
   
    if (0 != INTCONbits.GIE) { temp.GIE = 1; }
    INTCONbits.GIE = 0; /* Disable interrupts */
   
    /* Do the 'magic sequence' */
    EECON2        = 0x55;
    EECON2        = 0xAA;
    EECON1bits.WR = 1;  /* Start write (CPU will stall here) */
   
    EECON1bits.WREN = 0;
   
    /* Restore the TBLPTR regs */
    TBLPTRU = tblptru_temp;
    TBLPTRH = tblptrh_temp;
    TBLPTRL = tblptrl_temp;

    if (0 != temp.GIE) { INTCONbits.GIE = 1; } /* Enable interrupts (if been enabled) */
}