/*
 * flash.c
 *
 *  Created on: 2021年10月15日
 *      Author: wuwenfeng
 */


#include "flash.h"


uint32_t STMFLASH_ReadWord(uint32_t faddr)
{
	return *(uint32_t*)faddr;
}

void STMFLASH_Write(uint32_t WriteAddr,uint32_t *pBuffer,uint32_t NumToWrite)
{
	FLASH_EraseInitTypeDef FlashEraseInit;
	HAL_StatusTypeDef FlashStatus=HAL_OK;
	uint32_t PageError=0;
	uint32_t addrx=0;
	uint32_t endaddr=0;
	if(WriteAddr<STM32_FLASH_BASE||WriteAddr%4)return;	//非法地址

	HAL_FLASH_Unlock();             //解锁
	addrx=WriteAddr;				//写入的起始地址
	endaddr=WriteAddr+NumToWrite*8;	//写入的结束地址
	if(addrx<0X1FFF0000)
	{
		while(addrx<endaddr)		//扫清一切障碍.(对非FFFFFFFF的地方,先擦除)
		{
			 if(STMFLASH_ReadWord(addrx)!=0XFFFFFFFF)	//有非0XFFFFFFFF的地方,要擦除这个扇区
			 {
				FlashEraseInit.TypeErase=FLASH_TYPEERASE_PAGES;    //擦除类型，页擦除
				FlashEraseInit.PageAddress=31;   						   //从哪页开始擦除
				FlashEraseInit.NbPages=1;                          //一次只擦除一页
				if(HAL_FLASHEx_Erase(&FlashEraseInit,&PageError)!=HAL_OK)
				{
					break;//发生错误了
				}
			}else addrx+=4;
			FLASH_WaitForLastOperation(FLASH_WAITETIME);            //等待上次操作完成
		}
	}
	FlashStatus=FLASH_WaitForLastOperation(FLASH_WAITETIME);        //等待上次操作完成
	if(FlashStatus==HAL_OK)
	{
		 while(WriteAddr<endaddr)									//写数据
		 {
			if(HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD,WriteAddr,*(uint64_t*) pBuffer)!=HAL_OK)//写入数据
			{
				break;												//写入异常
			}
			WriteAddr+=8;
			pBuffer+=2;
		}
	}
	HAL_FLASH_Lock();           									//上锁
}

void STMFLASH_Read(uint32_t ReadAddr,uint32_t *pBuffer,uint32_t NumToRead)   		//连续读取
{
	uint32_t i;
	for(i=0;i<NumToRead;i++)
	{
		pBuffer[i]=STMFLASH_ReadWord(ReadAddr);	//读取4个字节.
		ReadAddr+=4;												//偏移4个字节.
	}
}