请教：STM8S因E2PROM不够，改用FLASH保存数据，但读数据时出错

1楼-- · 2020-01-11 19:58

/**************************************************/
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;
}
/**************************************************/