mirror of
				https://github.com/mfulz/qmk_firmware.git
				synced 2025-10-31 13:22:31 +01:00 
			
		
		
		
	
		
			
				
	
	
		
			209 lines
		
	
	
		
			6.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			209 lines
		
	
	
		
			6.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * This software is experimental and a work in progress.
 | |
|  * Under no circumstances should these files be used in relation to any critical system(s).
 | |
|  * Use of these files is at your own risk.
 | |
|  *
 | |
|  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED,
 | |
|  * INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR
 | |
|  * PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
 | |
|  * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
 | |
|  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 | |
|  * DEALINGS IN THE SOFTWARE.
 | |
|  *
 | |
|  * This files are free to use from https://github.com/rogerclarkmelbourne/Arduino_STM32 and
 | |
|  * https://github.com/leaflabs/libmaple
 | |
|  *
 | |
|  * Modifications for QMK and STM32F303 by Yiancar
 | |
|  */
 | |
| 
 | |
| #include <hal.h>
 | |
| #include "flash_stm32.h"
 | |
| 
 | |
| #if defined(STM32F1XX)
 | |
| #    define FLASH_SR_WRPERR FLASH_SR_WRPRTERR
 | |
| #endif
 | |
| 
 | |
| #if defined(MCU_GD32V)
 | |
| /* GigaDevice GD32VF103 is a STM32F103 clone at heart. */
 | |
| #    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;
 | |
|     }
 | |
| 
 | |
|     // TODO: bad times...
 | |
|     return 7;
 | |
| }
 | |
| #endif
 | |
| 
 | |
| /* Delay definition */
 | |
| #define EraseTimeout ((uint32_t)0x00000FFF)
 | |
| #define ProgramTimeout ((uint32_t)0x0000001F)
 | |
| 
 | |
| #define ASSERT(exp) (void)((0))
 | |
| 
 | |
| /**
 | |
|  * @brief  Inserts a time delay.
 | |
|  * @param  None
 | |
|  * @retval None
 | |
|  */
 | |
| static void delay(void) {
 | |
|     __IO uint32_t i = 0;
 | |
|     for (i = 0xFF; i != 0; i--) {
 | |
|     }
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * @brief  Returns the FLASH Status.
 | |
|  * @param  None
 | |
|  * @retval FLASH Status: The returned value can be: FLASH_BUSY, FLASH_ERROR_PG,
 | |
|  *   FLASH_ERROR_WRP or FLASH_COMPLETE
 | |
|  */
 | |
| 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;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * @brief  Waits for a Flash operation to complete or a TIMEOUT to occur.
 | |
|  * @param  Timeout: FLASH progamming Timeout
 | |
|  * @retval FLASH Status: The returned value can be: FLASH_ERROR_PG,
 | |
|  *   FLASH_ERROR_WRP, FLASH_COMPLETE or FLASH_TIMEOUT.
 | |
|  */
 | |
| FLASH_Status FLASH_WaitForLastOperation(uint32_t Timeout) {
 | |
|     FLASH_Status status;
 | |
| 
 | |
|     /* Check for the Flash Status */
 | |
|     status = FLASH_GetStatus();
 | |
|     /* Wait for a Flash operation to complete or a TIMEOUT to occur */
 | |
|     while ((status == FLASH_BUSY) && (Timeout != 0x00)) {
 | |
|         delay();
 | |
|         status = FLASH_GetStatus();
 | |
|         Timeout--;
 | |
|     }
 | |
|     if (Timeout == 0) status = FLASH_TIMEOUT;
 | |
|     /* Return the operation status */
 | |
|     return status;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * @brief  Erases a specified FLASH page.
 | |
|  * @param  Page_Address: The page address to be erased.
 | |
|  * @retval FLASH Status: The returned value can be: FLASH_BUSY, FLASH_ERROR_PG,
 | |
|  *   FLASH_ERROR_WRP, FLASH_COMPLETE or FLASH_TIMEOUT.
 | |
|  */
 | |
| FLASH_Status FLASH_ErasePage(uint32_t Page_Address) {
 | |
|     FLASH_Status status = FLASH_COMPLETE;
 | |
|     /* Check the parameters */
 | |
|     ASSERT(IS_FLASH_ADDRESS(Page_Address));
 | |
|     /* Wait for last operation to be completed */
 | |
|     status = FLASH_WaitForLastOperation(EraseTimeout);
 | |
| 
 | |
|     if (status == FLASH_COMPLETE) {
 | |
|         /* if the previous operation is completed, proceed to erase the page */
 | |
| #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;
 | |
| 
 | |
|         /* Wait for last operation to be completed */
 | |
|         status = FLASH_WaitForLastOperation(EraseTimeout);
 | |
|         if (status != FLASH_TIMEOUT) {
 | |
|             /* if the erase operation is completed, disable the configured Bits */
 | |
| #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 the Erase Status */
 | |
|     return status;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * @brief  Programs a half word at a specified address.
 | |
|  * @param  Address: specifies the address to be programmed.
 | |
|  * @param  Data: specifies the data to be programmed.
 | |
|  * @retval FLASH Status: The returned value can be: FLASH_ERROR_PG,
 | |
|  *   FLASH_ERROR_WRP, FLASH_COMPLETE or FLASH_TIMEOUT.
 | |
|  */
 | |
| FLASH_Status FLASH_ProgramHalfWord(uint32_t Address, uint16_t Data) {
 | |
|     FLASH_Status status = FLASH_BAD_ADDRESS;
 | |
| 
 | |
|     if (IS_FLASH_ADDRESS(Address)) {
 | |
|         /* Wait for last operation to be completed */
 | |
|         status = FLASH_WaitForLastOperation(ProgramTimeout);
 | |
|         if (status == FLASH_COMPLETE) {
 | |
|             /* if the previous operation is completed, proceed to program the new data */
 | |
| 
 | |
| #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;
 | |
|             /* Wait for last operation to be completed */
 | |
|             status = FLASH_WaitForLastOperation(ProgramTimeout);
 | |
|             if (status != FLASH_TIMEOUT) {
 | |
|                 /* if the program operation is completed, disable the PG Bit */
 | |
|                 FLASH->CR &= ~FLASH_CR_PG;
 | |
|             }
 | |
|             FLASH->SR = (FLASH_SR_EOP | FLASH_SR_PGERR | FLASH_SR_WRPERR);
 | |
|         }
 | |
|     }
 | |
|     return status;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * @brief  Unlocks the FLASH Program Erase Controller.
 | |
|  * @param  None
 | |
|  * @retval None
 | |
|  */
 | |
| void FLASH_Unlock(void) {
 | |
|     if (FLASH->CR & FLASH_CR_LOCK) {
 | |
|         /* Authorize the FPEC Access */
 | |
|         FLASH->KEYR = FLASH_KEY1;
 | |
|         FLASH->KEYR = FLASH_KEY2;
 | |
|     }
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * @brief  Locks the FLASH Program Erase Controller.
 | |
|  * @param  None
 | |
|  * @retval None
 | |
|  */
 | |
| void FLASH_Lock(void) {
 | |
|     /* Set the Lock Bit to lock the FPEC and the FCR */
 | |
|     FLASH->CR |= FLASH_CR_LOCK;
 | |
| }
 | 
