/**************************************************/
void Unlock(u32 address)
{   if(address >= FLASH_START)
    {   FLASH_PUKR= 0x56;
        FLASH_PUKR= 0xae;
    }
    else
    {   FLASH_DUKR= 0xae;
        FLASH_DUKR= 0x56;
    }
}
/**************************************************/
void Lock(u32 address)
{   if(address >= FLASH_START)
    {   FLASH_IAPSR_bit.PUL= 0;
    }
    else
    {   FLASH_IAPSR_bit.DUL= 0;
    }
}
/**************************************************/
void Read(u32 address,u8 *buf,u16 number)
{   u8 __far *ptr= (__far u8*) address;
    for(u16 i=0;i<number;i++)
    {   *buf++= *ptr++;
    }
}
/**************************************************/
__ramfunc void ProgramBlock(u32 address,u8 *buf)
{   u8 __far *ptr= (__far u8*) address;
    FLASH_CR2_bit.PRG= 1;
    FLASH_NCR2_bit.NPRG= 0;
    for(u8 i=0;i<BLOCK_SIZE;i++)
    {   *ptr++= buf[i];
    }
    while(!FLASH_IAPSR_bit.HVOFF);
    FLASH_CR2_bit.PRG= 0;
    FLASH_NCR2_bit.NPRG= 1;
}
/**************************************************/
u8 VerifiyBlock(u32 address,u8 *buf,u16 number)
{   u8 __far *ptr= (__far u8*) address;
    for(u8 i=0;i<number;i++)
    {   if(*ptr++ != buf[i])
        {   return false;
        }
    }
    return true;
}
/**************************************************/
u8 ProgramAndVerifiyBlock(u32 address,u8 *buf)
{   u8 pass=false;
    if(address>=FLASH_START && address<(FLASH_START+BOOT_SIZE)) return true;
    if(VerifiyBlock(address,buf,BLOCK_SIZE)) return true;
    Unlock(address);
    for(u8 i=0;i<3;i++)
    {   ProgramBlock(address,buf);
        if(VerifiyBlock(address,buf,BLOCK_SIZE))
        {   pass= true;
            break;
        }
    }
    Lock(address);
    return pass;
}
/**************************************************/
u8 ProgramOptionByte(u16 address,u8 *buf,u16 number)
{   Unlock(address);
    FLASH_CR2_bit.OPT= 1;
    FLASH_NCR2_bit.NOPT= 0;
    for(u16 i=0;i<number;i++)
    {   *((u8*)(address+i)) = buf[i];
        if(address+i > OPTION_END) return false;
    }
    while(!FLASH_IAPSR_bit.HVOFF);
    FLASH_CR2_bit.OPT= 0;
    FLASH_NCR2_bit.NOPT= 1;
    Lock(address);

    if(!VerifiyBlock(address,buf,number)) return false;
    return true;
}
/**************************************************/
u8 Program(u32 address,u8 *buf,u16 number)
{   if(address>=OPTION_START && address<=OPTION_END)
    {   if(!ProgramOptionByte(address,buf,number)) return false;
    }
    else
    {   u8 temp[BLOCK_SIZE];
        u32 blockaddr= address/BLOCK_SIZE;
        blockaddr*= BLOCK_SIZE;
        if(blockaddr != address)
        {   Read(blockaddr,temp,BLOCK_SIZE);
            for(u16 i=address;i<(blockaddr+BLOCK_SIZE) && number>0;i++)
            {   temp[address-blockaddr]= *buf++;
                address++;
                number--;
            }
            if(!ProgramAndVerifiyBlock(blockaddr,temp)) return false;
        }

        while(number >= BLOCK_SIZE)
        {   if(!ProgramAndVerifiyBlock(address,buf)) return false;
            address+= BLOCK_SIZE;
            buf+= BLOCK_SIZE;
            number-= BLOCK_SIZE;
        }

        if(number > 0)
        {   Read(address,temp,BLOCK_SIZE);
            for(u16 i=0;i<number;i++)
            {   temp[i]= *buf++;
            }
            if(!ProgramAndVerifiyBlock(address,temp)) return false;
        }
    }
    return true;
}
/**************************************************/