Diff: FlashWriter/FlashWriter.cpp

Revision:

16:903b5a4433b4

diff -r bd0d12728506 -r 903b5a4433b4 FlashWriter/FlashWriter.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/FlashWriter/FlashWriter.cpp	Mon Sep 02 13:32:33 2019 +0000
@@ -0,0 +1,56 @@
+#include "stm32f4xx_flash.h"
+#include "FlashWriter.h"
+
+FlashWriter::FlashWriter(int sector) {
+    if (sector > 7) sector = 7;
+    __sector = sector;
+    __base = __SECTOR_ADDRS[sector];
+    __ready = false;
+    
+    FLASH_Unlock();
+    FLASH_ClearFlag( FLASH_FLAG_EOP |  FLASH_FLAG_WRPERR | FLASH_FLAG_PGAERR | FLASH_FLAG_PGPERR | FLASH_FLAG_PGSERR);
+    FLASH_EraseSector(__SECTORS[sector], VoltageRange_3);
+}
+
+bool FlashWriter::ready() {
+    return __ready;
+}
+
+void FlashWriter::open() {
+    FLASH_Unlock();
+    FLASH_ClearFlag( FLASH_FLAG_EOP |  FLASH_FLAG_WRPERR | FLASH_FLAG_PGAERR | FLASH_FLAG_PGPERR | FLASH_FLAG_PGSERR);
+    FLASH_EraseSector(__SECTORS[__sector], VoltageRange_3);
+    __ready = true;
+}
+
+void FlashWriter::write(uint32_t index, int x) {
+    union {int a; uint32_t b;};
+    a = x;
+    FLASH_ProgramWord(__base + 4 * index, b);
+}
+
+void FlashWriter::write(uint32_t index, unsigned int x) {
+    FLASH_ProgramWord(__base + 4 * index, x);
+}
+
+void FlashWriter::write(uint32_t index, float x) {
+    union {float a; uint32_t b;};
+    a = x;
+    FLASH_ProgramWord(__base + 4 * index, b);
+}
+
+void FlashWriter::close() {
+    FLASH_Lock();
+}
+
+int flashReadInt(uint32_t sector, uint32_t index) {
+    return *(int*) (__SECTOR_ADDRS[sector] + 4 * index);
+}   
+
+uint32_t flashReadUint(uint32_t sector, uint32_t index) {
+    return *(uint32_t*) (__SECTOR_ADDRS[sector] + 4 * index);
+}   
+
+float flashReadFloat(uint32_t sector, uint32_t index) {
+    return *(float*) (__SECTOR_ADDRS[sector] + 4 * index);
+}