mirror of
https://github.com/Keychron/qmk_firmware.git
synced 2024-11-30 20:56:32 +06:00
256 lines
8.1 KiB
C
256 lines
8.1 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
|
|
|
|
#if defined(STM32L4XX)
|
|
# define FLASH_SR_PGERR FLASH_SR_PROGERR
|
|
# define FLASH_OBR_OPTERR FLASH_SR_OPERR
|
|
# define FLASH_KEY1 0x45670123U
|
|
# define FLASH_KEY2 0xCDEF89ABU
|
|
|
|
static uint32_t ADDR2PAGE(uint32_t Page_Address) { return (Page_Address - FLASH_BASE) / 0x800; }
|
|
#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);
|
|
#elif defined(FLASH_CR_PNB)
|
|
FLASH->CR &= ~FLASH_CR_PNB;
|
|
FLASH->CR |= FLASH_CR_PER | (ADDR2PAGE(Page_Address) << FLASH_CR_PNB_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);
|
|
#elif defined(FLASH_CR_PNB)
|
|
FLASH->CR &= ~(FLASH_CR_PER | FLASH_CR_PNB);
|
|
#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;
|
|
}
|
|
|
|
#if defined(STM32L4XX)
|
|
/**
|
|
* @brief Programs double words 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_ProgramDoubleWord(uint32_t Address, uint64_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 */
|
|
FLASH->CR |= FLASH_CR_PG;
|
|
*(__IO uint32_t*)Address = (uint32_t)Data;
|
|
__ISB();
|
|
*(__IO uint32_t*)(Address + 4U) = (uint32_t)(Data >> 32);
|
|
/* 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;
|
|
}
|
|
#endif
|
|
|
|
/**
|
|
* @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;
|
|
}
|