diff options
Diffstat (limited to 'Core/Src/Loader_Src.c')
| -rwxr-xr-x | Core/Src/Loader_Src.c | 250 |
1 files changed, 250 insertions, 0 deletions
diff --git a/Core/Src/Loader_Src.c b/Core/Src/Loader_Src.c new file mode 100755 index 0000000..e0dd405 --- /dev/null +++ b/Core/Src/Loader_Src.c @@ -0,0 +1,250 @@ +#include "quadspi.h"
+#include "main.h"
+#include "gpio.h"
+
+#define LOADER_OK 0x1
+#define LOADER_FAIL 0x0
+extern void SystemClock_Config(void);
+
+/**
+ * @brief System initialization.
+ * @param None
+ * @retval LOADER_OK = 1 : Operation succeeded
+ * @retval LOADER_FAIL = 0 : Operation failed
+ */
+__attribute__((used)) int Init(void) {
+ *(uint32_t*)0xE000EDF0 = 0xA05F0000; //enable interrupts in debug
+
+
+ SystemInit();
+
+ /* ADAPTATION TO THE DEVICE
+ *
+ * change VTOR setting for H7 device
+ * SCB->VTOR = 0x24000000 | 0x200;
+ *
+ * change VTOR setting for other devices
+ * SCB->VTOR = 0x20000000 | 0x200;
+ *
+ * */
+
+ SCB->VTOR = 0x24000000 | 0x200;
+
+ __set_PRIMASK(0); //enable interrupts
+
+ HAL_Init();
+
+ SystemClock_Config();
+
+ MX_GPIO_Init();
+
+ __HAL_RCC_QSPI_FORCE_RESET(); //completely reset peripheral
+ __HAL_RCC_QSPI_RELEASE_RESET();
+
+ if (CSP_QUADSPI_Init() != HAL_OK) {
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_FAIL;
+ }
+
+
+ if (CSP_QSPI_EnableMemoryMappedMode() != HAL_OK) {
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_FAIL;
+ }
+
+ /*Trigger read access before HAL_QSPI_Abort() otherwise abort functionality gets stuck*/
+ uint32_t a = *(uint32_t*) 0x90000000;
+ a++;
+
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_OK;
+}
+
+/**
+ * @brief Program memory.
+ * @param Address: page address
+ * @param Size : size of data
+ * @param buffer : pointer to data buffer
+ * @retval LOADER_OK = 1 : Operation succeeded
+ * @retval LOADER_FAIL = 0 : Operation failed
+ */
+__attribute__((used)) int Write(uint32_t Address, uint32_t Size, uint8_t* buffer) {
+ __set_PRIMASK(0); //enable interrupts
+
+ if (HAL_QSPI_Abort(&hqspi) != HAL_OK) {
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_FAIL;
+ }
+
+
+ if (CSP_QSPI_WriteMemory((uint8_t*) buffer, (Address & (0x0fffffff)), Size) != HAL_OK) {
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_FAIL;
+ }
+
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_OK;
+}
+
+/**
+ * @brief Sector erase.
+ * @param EraseStartAddress : erase start address
+ * @param EraseEndAddress : erase end address
+ * @retval LOADER_OK = 1 : Operation succeeded
+ * @retval LOADER_FAIL = 0 : Operation failed
+ */
+__attribute__((used)) int SectorErase(uint32_t EraseStartAddress, uint32_t EraseEndAddress) {
+ __set_PRIMASK(0); //enable interrupts
+
+ if (HAL_QSPI_Abort(&hqspi) != HAL_OK) {
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_FAIL;
+ }
+
+
+ if (CSP_QSPI_EraseSector(EraseStartAddress, EraseEndAddress) != HAL_OK) {
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_FAIL;
+ }
+
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_OK;
+}
+
+/**
+ * Description :
+ * Mass erase of external flash area
+ * Optional command - delete in case usage of mass erase is not planed
+ * Inputs :
+ * none
+ * outputs :
+ * none
+ * Note: Optional for all types of device
+ */
+__attribute__((used)) int MassErase(void) {
+ __set_PRIMASK(0); //enable interrupts
+
+ if (HAL_QSPI_Abort(&hqspi) != HAL_OK) {
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_FAIL;
+ }
+
+
+ if (CSP_QSPI_Erase_Chip() != HAL_OK) {
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_FAIL;
+ }
+
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_OK;
+}
+
+/**
+ * Description :
+ * Calculates checksum value of the memory zone
+ * Inputs :
+ * StartAddress : Flash start address
+ * Size : Size (in WORD)
+ * InitVal : Initial CRC value
+ * outputs :
+ * R0 : Checksum value
+ * Note: Optional for all types of device
+ */
+__attribute__((used)) uint32_t CheckSum(uint32_t StartAddress, uint32_t Size, uint32_t InitVal) {
+ uint8_t missalignementAddress = StartAddress % 4;
+ uint8_t missalignementSize = Size;
+ int cnt;
+ uint32_t Val;
+
+ StartAddress -= StartAddress % 4;
+ Size += (Size % 4 == 0) ? 0 : 4 - (Size % 4);
+
+ for (cnt = 0; cnt < Size; cnt += 4) {
+ Val = *(uint32_t*) StartAddress;
+ if (missalignementAddress) {
+ switch (missalignementAddress) {
+ case 1:
+ InitVal += (uint8_t) (Val >> 8 & 0xff);
+ InitVal += (uint8_t) (Val >> 16 & 0xff);
+ InitVal += (uint8_t) (Val >> 24 & 0xff);
+ missalignementAddress -= 1;
+ break;
+ case 2:
+ InitVal += (uint8_t) (Val >> 16 & 0xff);
+ InitVal += (uint8_t) (Val >> 24 & 0xff);
+ missalignementAddress -= 2;
+ break;
+ case 3:
+ InitVal += (uint8_t) (Val >> 24 & 0xff);
+ missalignementAddress -= 3;
+ break;
+ }
+ } else if ((Size - missalignementSize) % 4 && (Size - cnt) <= 4) {
+ switch (Size - missalignementSize) {
+ case 1:
+ InitVal += (uint8_t) Val;
+ InitVal += (uint8_t) (Val >> 8 & 0xff);
+ InitVal += (uint8_t) (Val >> 16 & 0xff);
+ missalignementSize -= 1;
+ break;
+ case 2:
+ InitVal += (uint8_t) Val;
+ InitVal += (uint8_t) (Val >> 8 & 0xff);
+ missalignementSize -= 2;
+ break;
+ case 3:
+ InitVal += (uint8_t) Val;
+ missalignementSize -= 3;
+ break;
+ }
+ } else {
+ InitVal += (uint8_t) Val;
+ InitVal += (uint8_t) (Val >> 8 & 0xff);
+ InitVal += (uint8_t) (Val >> 16 & 0xff);
+ InitVal += (uint8_t) (Val >> 24 & 0xff);
+ }
+ StartAddress += 4;
+ }
+
+ return (InitVal);
+}
+
+/**
+ * Description :
+ * Verify flash memory with RAM buffer and calculates checksum value of
+ * the programmed memory
+ * Inputs :
+ * FlashAddr : Flash address
+ * RAMBufferAddr : RAM buffer address
+ * Size : Size (in WORD)
+ * InitVal : Initial CRC value
+ * outputs :
+ * R0 : Operation failed (address of failure)
+ * R1 : Checksum value
+ * Note: Optional for all types of device
+ */
+__attribute__((used)) uint64_t Verify(uint32_t MemoryAddr, uint32_t RAMBufferAddr, uint32_t Size, uint32_t missalignement) {
+ __set_PRIMASK(0); //enable interrupts
+ uint32_t VerifiedData = 0, InitVal = 0;
+ uint64_t checksum;
+ Size *= 4;
+
+ if (CSP_QSPI_EnableMemoryMappedMode() != HAL_OK) {
+ __set_PRIMASK(1); //disable interrupts
+ return LOADER_FAIL;
+ }
+
+ checksum = CheckSum((uint32_t) MemoryAddr + (missalignement & 0xf),
+ Size - ((missalignement >> 16) & 0xF), InitVal);
+ while (Size > VerifiedData) {
+ if (*(uint8_t*) MemoryAddr++
+ != *((uint8_t*) RAMBufferAddr + VerifiedData)) {
+ __set_PRIMASK(1); //disable interrupts
+ return ((checksum << 32) + (MemoryAddr + VerifiedData));
+ }
+ VerifiedData++;
+ }
+
+ __set_PRIMASK(1); //disable interrupts
+ return (checksum << 32);
+}
|