DrvFlash.cpp

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

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

void DrvFlash::unlock() {
    FLASH ->SR |= (FLASH_SR_EOP | FLASH_SR_PGERR | FLASH_SR_WRPERR ); //Reset 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;
    }
    uint32_t addr = (uint32_t) getPageStartAddress(page);

    FLASH ->CR = FLASH_CR_PER;
    FLASH ->AR = addr;
    FLASH ->CR |= FLASH_CR_STRT;

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

    return true;
}

bool DrvFlash::write(const void* dst, const void* src, size_t len) {
    DRV_ASSERT((len&1)==0); //Len must by a multiple of 2
    DRV_ASSERT(((uint32_t)dst&1)==0); //Dst must be aligned to 16bits boundary
    DRV_ASSERT(((uint32_t)src&1)==0); //Src must be aligned to 16bits boundary

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

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

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