DrvFlash.cpp

//------------------------------------------------------------------------------
//This file is part of embKernel. 
//See license.txt for the full license governing this code.
//------------------------------------------------------------------------------

#include "DrvFlash.hpp"
#include "RtosInclude.hpp"

void DrvFlash::unlock() {
    FLASH ->SR |= (FLASH_SR_PGSERR | FLASH_SR_PGPERR | FLASH_SR_PGAERR | FLASH_SR_WRPERR | FLASH_SR_SOP ); //Reset error flags
    FLASH ->KEYR = ((uint32_t) 0x45670123); //Key1
    FLASH ->KEYR = ((uint32_t) 0xCDEF89AB); //Key2
}

void DrvFlash::lock() {
    FLASH ->CR |= FLASH_CR_LOCK;
}

bool DrvFlash::erasePage(unsigned int page) {
    if (!waitActionComplete()) {
        return false;
    }

    FLASH ->CR = (page << 3) | FLASH_CR_SER;
    FLASH ->CR |= FLASH_CR_STRT;

    if (!waitActionComplete()) {
        return false;
    }

    return true;
}

bool DrvFlash::write(const void* dst, const void* src, size_t len) {
    if (!waitActionComplete()) {
        return false;
    }

    uint8_t* dst8 = (uint8_t*) dst;
    uint8_t* src8 = (uint8_t*) src;
    for (size_t i = 0; i < len; i++) {
        FLASH ->CR = FLASH_CR_PG;
        *dst8++ = *src8++;
        if (!waitActionComplete()) {
            return false;
        }
        FLASH ->CR &= ~FLASH_CR_PG;
    }
    return true;
}

bool DrvFlash::waitActionComplete() {
    while (FLASH ->SR & FLASH_SR_BSY ) {
    }
    if (FLASH ->SR & (FLASH_SR_PGSERR | FLASH_SR_PGPERR | FLASH_SR_PGAERR | FLASH_SR_WRPERR | FLASH_SR_SOP )) {
        return false;
    }
    return true;
}