123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208 |
- #include <hal.h>
- #include "flash_stm32.h"
- #if defined(STM32F1XX)
- # define FLASH_SR_WRPERR FLASH_SR_WRPRTERR
- #endif
- #if defined(MCU_GD32V)
- # include "gd32v_compatibility.h"
- #endif
- #if defined(STM32F4XX)
- # define FLASH_SR_PGERR (FLASH_SR_PGSERR | FLASH_SR_PGPERR | FLASH_SR_PGAERR)
- # define FLASH_KEY1 0x45670123U
- # define FLASH_KEY2 0xCDEF89ABU
- static uint8_t ADDR2PAGE(uint32_t Page_Address) {
- switch (Page_Address) {
- case 0x08000000 ... 0x08003FFF:
- return 0;
- case 0x08004000 ... 0x08007FFF:
- return 1;
- case 0x08008000 ... 0x0800BFFF:
- return 2;
- case 0x0800C000 ... 0x0800FFFF:
- return 3;
- }
-
- return 7;
- }
- #endif
- #define EraseTimeout ((uint32_t)0x00000FFF)
- #define ProgramTimeout ((uint32_t)0x0000001F)
- #define ASSERT(exp) (void)((0))
- static void delay(void) {
- __IO uint32_t i = 0;
- for (i = 0xFF; i != 0; i--) {
- }
- }
- FLASH_Status FLASH_GetStatus(void) {
- if ((FLASH->SR & FLASH_SR_BSY) == FLASH_SR_BSY) return FLASH_BUSY;
- if ((FLASH->SR & FLASH_SR_PGERR) != 0) return FLASH_ERROR_PG;
- if ((FLASH->SR & FLASH_SR_WRPERR) != 0) return FLASH_ERROR_WRP;
- #if defined(FLASH_OBR_OPTERR)
- if ((FLASH->SR & FLASH_OBR_OPTERR) != 0) return FLASH_ERROR_OPT;
- #endif
- return FLASH_COMPLETE;
- }
- FLASH_Status FLASH_WaitForLastOperation(uint32_t Timeout) {
- FLASH_Status status;
-
- status = FLASH_GetStatus();
-
- while ((status == FLASH_BUSY) && (Timeout != 0x00)) {
- delay();
- status = FLASH_GetStatus();
- Timeout--;
- }
- if (Timeout == 0) status = FLASH_TIMEOUT;
-
- return status;
- }
- FLASH_Status FLASH_ErasePage(uint32_t Page_Address) {
- FLASH_Status status = FLASH_COMPLETE;
-
- ASSERT(IS_FLASH_ADDRESS(Page_Address));
-
- status = FLASH_WaitForLastOperation(EraseTimeout);
- if (status == FLASH_COMPLETE) {
-
- #if defined(FLASH_CR_SNB)
- FLASH->CR &= ~FLASH_CR_SNB;
- FLASH->CR |= FLASH_CR_SER | (ADDR2PAGE(Page_Address) << FLASH_CR_SNB_Pos);
- #else
- FLASH->CR |= FLASH_CR_PER;
- FLASH->AR = Page_Address;
- #endif
- FLASH->CR |= FLASH_CR_STRT;
-
- status = FLASH_WaitForLastOperation(EraseTimeout);
- if (status != FLASH_TIMEOUT) {
-
- #if defined(FLASH_CR_SNB)
- FLASH->CR &= ~(FLASH_CR_SER | FLASH_CR_SNB);
- #else
- FLASH->CR &= ~FLASH_CR_PER;
- #endif
- }
- FLASH->SR = (FLASH_SR_EOP | FLASH_SR_PGERR | FLASH_SR_WRPERR);
- }
-
- return status;
- }
- FLASH_Status FLASH_ProgramHalfWord(uint32_t Address, uint16_t Data) {
- FLASH_Status status = FLASH_BAD_ADDRESS;
- if (IS_FLASH_ADDRESS(Address)) {
-
- status = FLASH_WaitForLastOperation(ProgramTimeout);
- if (status == FLASH_COMPLETE) {
-
- #if defined(FLASH_CR_PSIZE)
- FLASH->CR &= ~FLASH_CR_PSIZE;
- FLASH->CR |= FLASH_CR_PSIZE_0;
- #endif
- FLASH->CR |= FLASH_CR_PG;
- *(__IO uint16_t*)Address = Data;
-
- status = FLASH_WaitForLastOperation(ProgramTimeout);
- if (status != FLASH_TIMEOUT) {
-
- FLASH->CR &= ~FLASH_CR_PG;
- }
- FLASH->SR = (FLASH_SR_EOP | FLASH_SR_PGERR | FLASH_SR_WRPERR);
- }
- }
- return status;
- }
- void FLASH_Unlock(void) {
- if (FLASH->CR & FLASH_CR_LOCK) {
-
- FLASH->KEYR = FLASH_KEY1;
- FLASH->KEYR = FLASH_KEY2;
- }
- }
- void FLASH_Lock(void) {
-
- FLASH->CR |= FLASH_CR_LOCK;
- }
|