mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
bbe9103944
This patch removes a test that silently hides failed writes to NULL. Instead, assert is used to ensure that the address is not NULL.
127 lines
2.9 KiB
C
127 lines
2.9 KiB
C
/*
|
|
* Copyright (C) 2016 Freie Universität Berlin
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU Lesser
|
|
* General Public License v2.1. See the file LICENSE in the top level
|
|
* directory for more details.
|
|
*/
|
|
|
|
/**
|
|
* @ingroup drivers_periph_flashpage
|
|
* @{
|
|
*
|
|
* @file
|
|
* @brief Common flash page functions
|
|
*
|
|
* @author Hauke Petersen <hauke.petersen@fu-berlin.de>
|
|
*
|
|
* @}
|
|
*/
|
|
|
|
#include <string.h>
|
|
#include "cpu.h"
|
|
#include "assert.h"
|
|
|
|
#include "periph/flashpage.h"
|
|
|
|
void flashpage_read(unsigned page, void *data)
|
|
{
|
|
assert(page < FLASHPAGE_NUMOF);
|
|
|
|
#if defined(CPU_FAM_STM32WB) || (defined(CPU_FAM_STM32WL) && \
|
|
!defined(CPU_LINE_STM32WLE5xx))
|
|
assert(page < (FLASH->SFR & FLASH_SFR_SFSA));
|
|
#endif
|
|
|
|
memcpy(data, flashpage_addr(page), flashpage_size(page));
|
|
}
|
|
|
|
int flashpage_verify(unsigned page, const void *data)
|
|
{
|
|
assert(page < (int)FLASHPAGE_NUMOF);
|
|
|
|
#if defined(CPU_FAM_STM32WB) || (defined(CPU_FAM_STM32WL) && \
|
|
!defined(CPU_LINE_STM32WLE5xx))
|
|
assert(page < (int)(FLASH->SFR & FLASH_SFR_SFSA));
|
|
#endif
|
|
|
|
if (memcmp(flashpage_addr(page), data, flashpage_size(page)) == 0) {
|
|
return FLASHPAGE_OK;
|
|
}
|
|
else {
|
|
return FLASHPAGE_NOMATCH;
|
|
}
|
|
}
|
|
|
|
int flashpage_write_and_verify(unsigned page, const void *data)
|
|
{
|
|
flashpage_write_page(page, data);
|
|
return flashpage_verify(page, data);
|
|
}
|
|
|
|
#ifdef FLASHPAGE_SIZE
|
|
void flashpage_write_page(unsigned page, const void *data)
|
|
{
|
|
assert((unsigned) page < FLASHPAGE_NUMOF);
|
|
assert(data != NULL);
|
|
|
|
flashpage_erase(page);
|
|
|
|
/* write page */
|
|
flashpage_write(flashpage_addr(page), data, FLASHPAGE_SIZE);
|
|
}
|
|
#endif
|
|
|
|
#if defined(FLASHPAGE_RWWEE_NUMOF)
|
|
void flashpage_rwwee_read(unsigned page, void *data)
|
|
{
|
|
assert(page < (int)FLASHPAGE_RWWEE_NUMOF);
|
|
|
|
memcpy(data, flashpage_rwwee_addr(page), FLASHPAGE_SIZE);
|
|
}
|
|
|
|
int flashpage_rwwee_verify(unsigned page, const void *data)
|
|
{
|
|
assert(page < (int)FLASHPAGE_RWWEE_NUMOF);
|
|
|
|
if (memcmp(flashpage_rwwee_addr(page), data, FLASHPAGE_SIZE) == 0) {
|
|
return FLASHPAGE_OK;
|
|
}
|
|
else {
|
|
return FLASHPAGE_NOMATCH;
|
|
}
|
|
}
|
|
|
|
int flashpage_rwwee_write_and_verify(unsigned page, const void *data)
|
|
{
|
|
flashpage_rwwee_write_page(page, data);
|
|
return flashpage_rwwee_verify(page, data);
|
|
}
|
|
#endif /* FLASHPAGE_RWWEE_NUMOF */
|
|
|
|
#ifdef PERIPH_FLASHPAGE_NEEDS_FLASHPAGE_ADDR
|
|
void *flashpage_addr(unsigned page)
|
|
{
|
|
uintptr_t addr = CPU_FLASH_BASE;
|
|
|
|
while (page) {
|
|
addr += flashpage_size(--page);
|
|
}
|
|
|
|
return (void*)addr;
|
|
}
|
|
#endif /* PERIPH_FLASHPAGE_NEEDS_FLASHPAGE_ADDR */
|
|
|
|
#ifdef PERIPH_FLASHPAGE_NEEDS_FLASHPAGE_PAGE
|
|
unsigned flashpage_page(const void *addr)
|
|
{
|
|
unsigned page = 0;
|
|
|
|
for (uintptr_t pos = CPU_FLASH_BASE; (uintptr_t)addr >= pos; ++page) {
|
|
pos += flashpage_size(page);
|
|
}
|
|
|
|
return page - 1;
|
|
}
|
|
#endif /* PERIPH_FLASHPAGE_NEEDS_FLASHPAGE_PAGE */
|