2016-08-18 10:07:46 +00:00
/*
* Part of esp - open - rtos
* Copyright ( C ) 2016 Alex Stewart
* BSD Licensed as described in the file LICENSE
*/
# include <stdlib.h>
# include <string.h>
# include <stdio.h>
# include <sysparam.h>
# include <espressif/spi_flash.h>
# include <common_macros.h>
2016-08-21 05:47:40 +00:00
# include "FreeRTOS.h"
# include "semphr.h"
2016-08-18 10:07:46 +00:00
/* The "magic" value that indicates the start of a sysparam region in flash.
*/
# define SYSPARAM_MAGIC 0x70524f45 // "EORp" in little-endian
/* The size of the initial buffer created by sysparam_iter_start, etc, to hold
* returned key - value pairs . Setting this too small may result in a lot of
* unnecessary reallocs . Setting it too large will waste memory when iterating
* through entries .
*/
# define DEFAULT_ITER_BUF_SIZE 64
/* The size of the buffer (in words) used by `sysparam_create_area` when
* scanning a potential area to make sure it ' s currently empty . Note that this
* space is taken from the stack , so it should not be too large .
*/
# define SCAN_BUFFER_SIZE 8 // words
2016-08-19 04:58:29 +00:00
/* The size in words of the buffer used for reading keys when searching for a
* match , for reading payloads to check if the value has changed , and reading
* back from the flash to verify writes . Will work well if big enough for
* commonly used keys , and must be at least one word . Stack allocated so not too
* large !
2016-08-18 10:07:46 +00:00
*/
2016-08-19 04:58:29 +00:00
# define BOUNCE_BUFFER_WORDS 3
# define BOUNCE_BUFFER_SIZE (BOUNCE_BUFFER_WORDS * sizeof(uint32_t))
2016-08-18 10:07:46 +00:00
/* Size of region/entry headers. These should not normally need tweaking (and
* will probably require some code changes if they are tweaked ) .
*/
# define REGION_HEADER_SIZE 8 // NOTE: Must be multiple of 4
# define ENTRY_HEADER_SIZE 4 // NOTE: Must be multiple of 4
/* These are limited by the format to 0xffff, but could be set lower if desired
*/
# define MAX_KEY_LEN 0xffff
# define MAX_VALUE_LEN 0xffff
/* Maximum value that can be used for a key_id. This is limited by the format
* to 0xffe ( 0xfff indicates end / unwritten space )
*/
# define MAX_KEY_ID 0x0ffe
# define REGION_FLAG_SECOND 0x8000 // First (0) or second (1) region
# define REGION_FLAG_ACTIVE 0x4000 // Stale (0) or active (1) region
# define REGION_MASK_SIZE 0x0fff // Region size in sectors
# define ENTRY_FLAG_ALIVE 0x8000 // Deleted (0) or active (1)
# define ENTRY_FLAG_INVALID 0x4000 // Valid (0) or invalid (1) entry
# define ENTRY_FLAG_VALUE 0x2000 // Key (0) or value (1)
# define ENTRY_FLAG_BINARY 0x1000 // Text (0) or binary (1) data
# define ENTRY_MASK_ID 0xfff
# define ENTRY_ID_END 0xfff
# define ENTRY_ID_ANY 0x1000
# ifndef SYSPARAM_DEBUG
# define SYSPARAM_DEBUG 0
# endif
/******************************* Useful Macros *******************************/
# define ROUND_TO_WORD_BOUNDARY(x) (((x) + 3) & 0xfffffffc)
# define ENTRY_SIZE(payload_len) (ENTRY_HEADER_SIZE + ROUND_TO_WORD_BOUNDARY(payload_len))
# define max(x, y) ((x) > (y) ? (x) : (y))
# define min(x, y) ((x) < (y) ? (x) : (y))
# define debug(level, format, ...) if (SYSPARAM_DEBUG >= (level)) { printf("%s" format "\n", "sysparam: ", ## __VA_ARGS__); }
# define CHECK_FLASH_OP(x) do { int __x = (x); if ((__x) != SPI_FLASH_RESULT_OK) { debug(1, "FLASH ERR: %d", __x); return SYSPARAM_ERR_IO; } } while (0);
/********************* Internal datatypes and structures *********************/
struct region_header {
uint32_t magic ;
uint16_t flags_size ;
uint16_t reserved ;
} __attribute__ ( ( packed ) ) ;
struct entry_header {
uint16_t idflags ;
uint16_t len ;
} __attribute__ ( ( packed ) ) ;
struct sysparam_context {
uint32_t addr ;
struct entry_header entry ;
int unused_keys ;
size_t compactable ;
uint16_t max_key_id ;
} ;
/*************************** Global variables/data ***************************/
static struct {
uint32_t cur_base ;
uint32_t alt_base ;
uint32_t end_addr ;
size_t region_size ;
bool force_compact ;
2016-08-21 05:47:40 +00:00
xSemaphoreHandle sem ;
2016-08-18 10:07:46 +00:00
} _sysparam_info ;
/***************************** Internal routines *****************************/
2016-08-19 04:58:29 +00:00
static inline sysparam_status_t _do_write ( uint32_t addr , const void * data , void * buffer , size_t data_size ) {
memcpy ( buffer , data , data_size ) ;
CHECK_FLASH_OP ( sdk_spi_flash_write ( addr , buffer , data_size ) ) ;
2016-08-18 10:07:46 +00:00
return SYSPARAM_OK ;
}
2016-08-19 04:58:29 +00:00
static inline sysparam_status_t _do_verify ( uint32_t addr , const void * data , void * buffer , size_t len ) {
2016-08-18 10:07:46 +00:00
CHECK_FLASH_OP ( sdk_spi_flash_read ( addr , buffer , len ) ) ;
if ( memcmp ( data , buffer , len ) ) {
return SYSPARAM_ERR_IO ;
}
2016-08-19 04:58:29 +00:00
2016-08-18 10:07:46 +00:00
return SYSPARAM_OK ;
}
2016-08-19 04:58:29 +00:00
static sysparam_status_t _write_and_verify ( uint32_t addr , const void * data , size_t data_size ) {
2016-08-18 10:07:46 +00:00
int i ;
size_t count ;
sysparam_status_t status = SYSPARAM_OK ;
2016-08-19 04:58:29 +00:00
uint32_t buf [ BOUNCE_BUFFER_WORDS ] ;
2016-08-18 10:07:46 +00:00
2016-08-19 04:58:29 +00:00
for ( i = 0 ; i < data_size ; i + = BOUNCE_BUFFER_SIZE ) {
count = min ( data_size - i , BOUNCE_BUFFER_SIZE ) ;
status = _do_write ( addr + i , data + i , buf , count ) ;
2016-08-18 10:07:46 +00:00
if ( status ! = SYSPARAM_OK ) break ;
2016-08-19 04:58:29 +00:00
status = _do_verify ( addr + i , data + i , buf , count ) ;
if ( status ! = SYSPARAM_OK ) {
debug ( 1 , " Flash write (@ 0x%08x) verify failed! " , addr ) ;
break ;
2016-08-18 10:07:46 +00:00
}
2016-08-19 04:58:29 +00:00
}
2016-08-18 10:07:46 +00:00
return status ;
}
/** Erase the sectors of a region */
static sysparam_status_t _format_region ( uint32_t addr , uint16_t num_sectors ) {
uint16_t sector = addr / sdk_flashchip . sector_size ;
int i ;
for ( i = 0 ; i < num_sectors ; i + + ) {
CHECK_FLASH_OP ( sdk_spi_flash_erase_sector ( sector + i ) ) ;
}
return SYSPARAM_OK ;
}
/** Write the magic data at the beginning of a region */
static inline sysparam_status_t _write_region_header ( uint32_t addr , uint32_t other , bool active ) {
struct region_header header ;
sysparam_status_t status ;
int16_t num_sectors ;
header . magic = SYSPARAM_MAGIC ;
if ( addr < other ) {
num_sectors = ( other - addr ) / sdk_flashchip . sector_size ;
header . flags_size = num_sectors & REGION_MASK_SIZE ;
} else {
num_sectors = ( addr - other ) / sdk_flashchip . sector_size ;
header . flags_size = num_sectors & REGION_MASK_SIZE ;
header . flags_size | = REGION_FLAG_SECOND ;
}
if ( active ) {
header . flags_size | = REGION_FLAG_ACTIVE ;
}
header . reserved = 0 ;
debug ( 3 , " write region header (0x%04x) @ 0x%08x " , header . flags_size , addr ) ;
status = _write_and_verify ( addr , & header , REGION_HEADER_SIZE ) ;
if ( status ! = SYSPARAM_OK ) {
// Uh oh.. Something failed, so we don't know whether what we wrote is
// actually in the flash or not. Try to zero it out to be sure and
// return an error.
debug ( 3 , " zero region header @ 0x%08x " , addr ) ;
memset ( & header , 0 , REGION_HEADER_SIZE ) ;
_write_and_verify ( addr , & header , REGION_HEADER_SIZE ) ;
return SYSPARAM_ERR_IO ;
}
return SYSPARAM_OK ;
}
/** Initialize a context structure at the beginning of the active region */
static void _init_context ( struct sysparam_context * ctx ) {
memset ( ctx , 0 , sizeof ( * ctx ) ) ;
ctx - > addr = _sysparam_info . cur_base ;
}
/** Initialize a context structure at the end of the active region */
static sysparam_status_t init_write_context ( struct sysparam_context * ctx ) {
memset ( ctx , 0 , sizeof ( * ctx ) ) ;
ctx - > addr = _sysparam_info . end_addr ;
debug ( 3 , " read entry header @ 0x%08x " , ctx - > addr ) ;
CHECK_FLASH_OP ( sdk_spi_flash_read ( ctx - > addr , ( void * ) & ctx - > entry , ENTRY_HEADER_SIZE ) ) ;
return SYSPARAM_OK ;
}
/** Search through the region for an entry matching the specified id
*
* @ param match_id The id to match , or 0 to match any key , or 0xfff to scan
* to the end .
*/
static sysparam_status_t _find_entry ( struct sysparam_context * ctx , uint16_t match_id , bool find_value ) {
uint16_t id ;
while ( true ) {
if ( ctx - > addr = = _sysparam_info . cur_base ) {
ctx - > addr + = REGION_HEADER_SIZE ;
} else {
uint32_t next_addr = ctx - > addr + ENTRY_SIZE ( ctx - > entry . len ) ;
if ( next_addr > _sysparam_info . cur_base + _sysparam_info . region_size ) {
// This entry has an obviously impossible length, so we need to
// stop reading here.
// We can report this as the end of the valid entries, but then
// any future writes (to the end) will write over
// previously-written data and result in garbage. The best
// workaround is to make sure that the next write operation
// will always start with a compaction, which will leave off
// the invalid data at the end and fix the issue going forward.
debug ( 1 , " Encountered entry with invalid length (0x%04x) @ 0x%08x (region end is 0x%08x). Truncating entries. " , ctx - > entry . len , ctx - > addr , _sysparam_info . end_addr ) ;
_sysparam_info . force_compact = true ;
break ;
}
ctx - > addr = next_addr ;
if ( ctx - > addr = = _sysparam_info . cur_base + _sysparam_info . region_size ) {
// This is the last entry in the available space, but it
// exactly fits. Stop reading here.
break ;
}
}
debug ( 3 , " read entry header @ 0x%08x " , ctx - > addr ) ;
CHECK_FLASH_OP ( sdk_spi_flash_read ( ctx - > addr , ( void * ) & ctx - > entry , ENTRY_HEADER_SIZE ) ) ;
debug ( 3 , " idflags = 0x%04x " , ctx - > entry . idflags ) ;
if ( ctx - > entry . idflags = = 0xffff ) {
// 0xffff is never a valid id field, so this means we've hit the
// end and are looking at unwritten flash space from here on.
break ;
}
id = ctx - > entry . idflags & ENTRY_MASK_ID ;
if ( ( ctx - > entry . idflags & ( ENTRY_FLAG_ALIVE | ENTRY_FLAG_INVALID ) ) = = ENTRY_FLAG_ALIVE ) {
debug ( 3 , " entry is alive and valid " ) ;
if ( ! ( ctx - > entry . idflags & ENTRY_FLAG_VALUE ) ) {
debug ( 3 , " entry is a key " ) ;
ctx - > max_key_id = id ;
ctx - > unused_keys + + ;
if ( ! find_value ) {
if ( ( id = = match_id ) | | ( match_id = = ENTRY_ID_ANY ) ) {
return SYSPARAM_OK ;
}
}
} else {
debug ( 3 , " entry is a value " ) ;
ctx - > unused_keys - - ;
if ( find_value ) {
if ( ( id = = match_id ) | | ( match_id = = ENTRY_ID_ANY ) ) {
return SYSPARAM_OK ;
}
}
}
debug ( 3 , " (not a match) " ) ;
} else {
debug ( 3 , " entry is deleted or invalid " ) ;
ctx - > compactable + = ENTRY_SIZE ( ctx - > entry . len ) ;
}
}
if ( match_id = = ENTRY_ID_END ) {
return SYSPARAM_OK ;
}
ctx - > entry . len = 0 ;
ctx - > entry . idflags = 0 ;
return SYSPARAM_NOTFOUND ;
}
/** Read the payload from the current entry pointed to by `ctx` */
static inline sysparam_status_t _read_payload ( struct sysparam_context * ctx , uint8_t * buffer , size_t buffer_size ) {
debug ( 3 , " read payload (%d) @ 0x%08x " , min ( buffer_size , ctx - > entry . len ) , ctx - > addr ) ;
2016-08-19 04:58:29 +00:00
uint32_t addr = ctx - > addr + ENTRY_HEADER_SIZE ;
size_t size = min ( buffer_size , ctx - > entry . len ) ;
size_t align = ( uint32_t ) buffer & 3 ;
if ( align ) {
// Unaligned buffer, use a bounce buffer to align.
uint32_t bounce [ 1 ] ;
size_t align_size = min ( size , align ) ;
CHECK_FLASH_OP ( sdk_spi_flash_read ( addr , ( void * ) bounce , align_size ) ) ;
memcpy ( buffer , bounce , align_size ) ;
size - = align_size ;
addr + = align_size ;
buffer + = align_size ;
}
if ( size > 0 ) {
CHECK_FLASH_OP ( sdk_spi_flash_read ( addr , ( void * ) buffer , size ) ) ;
}
return SYSPARAM_OK ;
}
static inline sysparam_status_t _compare_payload ( struct sysparam_context * ctx , uint8_t * value , size_t size ) {
debug ( 3 , " compare payload (%d) @ 0x%08x " , size , ctx - > addr ) ;
if ( ctx - > entry . len ! = size ) return SYSPARAM_NOTFOUND ;
uint32_t * bounce [ BOUNCE_BUFFER_WORDS ] ;
uint32_t addr = ctx - > addr + ENTRY_HEADER_SIZE ;
int i ;
for ( i = 0 ; i < size ; i + = BOUNCE_BUFFER_SIZE ) {
int len = min ( size - i , BOUNCE_BUFFER_SIZE ) ;
CHECK_FLASH_OP ( sdk_spi_flash_read ( addr + i , ( void * ) bounce , len ) ) ;
if ( memcmp ( value + i , bounce , len ) ) {
// Mismatch.
return SYSPARAM_NOTFOUND ;
}
}
2016-08-18 10:07:46 +00:00
return SYSPARAM_OK ;
}
/** Find the entry corresponding to the specified key name */
2016-08-19 04:58:29 +00:00
static sysparam_status_t _find_key ( struct sysparam_context * ctx , const char * key , uint16_t key_len ) {
2016-08-18 10:07:46 +00:00
sysparam_status_t status ;
2016-08-19 04:58:29 +00:00
debug ( 3 , " find key len %d: %s " , key_len , key ? key : " (null) " ) ;
2016-08-18 10:07:46 +00:00
while ( true ) {
// Find the next key entry
status = _find_entry ( ctx , ENTRY_ID_ANY , false ) ;
if ( status ! = SYSPARAM_OK ) return status ;
debug ( 3 , " found a key entry @ 0x%08x " , ctx - > addr ) ;
if ( ! key ) {
// We're looking for the next (any) key, so we're done.
break ;
}
if ( ctx - > entry . len = = key_len ) {
2016-08-19 04:58:29 +00:00
status = _compare_payload ( ctx , ( uint8_t * ) key , key_len ) ;
if ( status = = SYSPARAM_OK ) {
2016-08-18 10:07:46 +00:00
// We have a match
break ;
}
2016-08-19 04:58:29 +00:00
if ( status ! = SYSPARAM_NOTFOUND ) return status ;
2016-08-18 10:07:46 +00:00
debug ( 3 , " entry payload does not match " ) ;
} else {
debug ( 3 , " key length (%d) does not match (%d) " , ctx - > entry . len , key_len ) ;
}
}
debug ( 3 , " key match @ 0x%08x (idflags = 0x%04x) " , ctx - > addr , ctx - > entry . idflags ) ;
return SYSPARAM_OK ;
}
/** Find the value entry matching the id field from a particular key */
static inline sysparam_status_t _find_value ( struct sysparam_context * ctx , uint16_t id_field ) {
debug ( 3 , " find value: 0x%04x " , id_field ) ;
return _find_entry ( ctx , id_field & ENTRY_MASK_ID , true ) ;
}
/** Write an entry at the specified address */
static inline sysparam_status_t _write_entry ( uint32_t addr , uint16_t id , const uint8_t * payload , uint16_t len ) {
struct entry_header entry ;
sysparam_status_t status ;
debug ( 2 , " Writing entry 0x%02x @ 0x%08x " , id , addr ) ;
entry . idflags = id | ENTRY_FLAG_ALIVE | ENTRY_FLAG_INVALID ;
entry . len = len ;
debug ( 3 , " write initial entry header @ 0x%08x " , addr ) ;
status = _write_and_verify ( addr , & entry , ENTRY_HEADER_SIZE ) ;
if ( status = = SYSPARAM_ERR_IO ) {
// Uh-oh.. Either the flash call failed in some way or we didn't get
// back what we wrote. This could be a problem because depending on
// how it went wrong it could screw up all reads/writes from this point
// forward. Try to salvage the on-flash structure by overwriting the
// failed header with all zeros, which (if successful) will be
// interpreted on later reads as a deleted empty-payload entry (and it
// will just skip to the next spot).
memset ( & entry , 0 , ENTRY_HEADER_SIZE ) ;
debug ( 3 , " zeroing entry header @ 0x%08x " , addr ) ;
status = _write_and_verify ( addr , & entry , ENTRY_HEADER_SIZE ) ;
if ( status ! = SYSPARAM_OK ) return status ;
// Make sure future writes skip past this zeroed bit
if ( _sysparam_info . end_addr = = addr ) {
_sysparam_info . end_addr + = ENTRY_HEADER_SIZE ;
}
// We could just skip to the next space and try again, but
// unfortunately now we can't be sure there's enough space remaining to
// fit the entry, so we just have to fail this operation. Hopefully,
// at least, future requests will still succeed, though.
status = SYSPARAM_ERR_IO ;
}
if ( status ! = SYSPARAM_OK ) return status ;
// If we've gotten this far, we've committed to writing the full entry.
if ( _sysparam_info . end_addr = = addr ) {
_sysparam_info . end_addr + = ENTRY_SIZE ( len ) ;
}
debug ( 3 , " write payload (%d) @ 0x%08x " , len , addr + ENTRY_HEADER_SIZE ) ;
status = _write_and_verify ( addr + ENTRY_HEADER_SIZE , payload , len ) ;
if ( status ! = SYSPARAM_OK ) return status ;
debug ( 3 , " set entry valid @ 0x%08x " , addr ) ;
entry . idflags & = ~ ENTRY_FLAG_INVALID ;
status = _write_and_verify ( addr , & entry , ENTRY_HEADER_SIZE ) ;
return status ;
}
/** Mark an entry as "deleted" so it won't be considered in future reads */
static inline sysparam_status_t _delete_entry ( uint32_t addr ) {
struct entry_header entry ;
debug ( 2 , " Deleting entry @ 0x%08x " , addr ) ;
debug ( 3 , " read entry header @ 0x%08x " , addr ) ;
CHECK_FLASH_OP ( sdk_spi_flash_read ( addr , ( void * ) & entry , ENTRY_HEADER_SIZE ) ) ;
// Set the ID to zero to mark it as "deleted"
entry . idflags & = ~ ENTRY_FLAG_ALIVE ;
debug ( 3 , " write entry header @ 0x%08x " , addr ) ;
CHECK_FLASH_OP ( sdk_spi_flash_write ( addr , ( void * ) & entry , ENTRY_HEADER_SIZE ) ) ;
return SYSPARAM_OK ;
}
/** Compact the current region, removing all deleted/unused entries, and write
* the result to the alternate region , then make the new alternate region the
* active one .
*
* @ param key_id A pointer to the " current " key ID .
*
* NOTE : The value corresponding to the passed key ID will not be written to
* the output ( because it is assumed it will be overwritten as the next step
* in ` sysparam_set_data ` anyway ) . When compacting , this routine will
* automatically update * key_id to contain the ID of this key in the new
* compacted result as well .
*/
static sysparam_status_t _compact_params ( struct sysparam_context * ctx , int * key_id ) {
uint32_t new_base = _sysparam_info . alt_base ;
sysparam_status_t status ;
uint32_t addr = new_base + REGION_HEADER_SIZE ;
uint16_t current_key_id = 0 ;
sysparam_iter_t iter ;
uint16_t binary_flag ;
uint16_t num_sectors = _sysparam_info . region_size / sdk_flashchip . sector_size ;
debug ( 1 , " compacting region (current size %d, expect to recover %d%s bytes)... " , _sysparam_info . end_addr - _sysparam_info . cur_base , ctx - > compactable , ( ctx - > unused_keys > 0 ) ? " + (unused keys present) " : " " ) ;
status = _format_region ( new_base , num_sectors ) ;
if ( status < 0 ) return status ;
status = sysparam_iter_start ( & iter ) ;
if ( status < 0 ) return status ;
while ( true ) {
status = sysparam_iter_next ( & iter ) ;
if ( status ! = SYSPARAM_OK ) break ;
current_key_id + + ;
// Write the key to the new region
debug ( 2 , " writing %d key @ 0x%08x " , current_key_id , addr ) ;
status = _write_entry ( addr , current_key_id , ( uint8_t * ) iter . key , iter . key_len ) ;
if ( status < 0 ) break ;
addr + = ENTRY_SIZE ( iter . key_len ) ;
if ( ( iter . ctx - > entry . idflags & ENTRY_MASK_ID ) = = * key_id ) {
// Update key_id to have the correct id for the compacted result
* key_id = current_key_id ;
// Don't copy the old value, since we'll just be deleting it
// and writing a new one as soon as we return.
continue ;
}
// Copy the value to the new region
debug ( 2 , " writing %d value @ 0x%08x " , current_key_id , addr ) ;
binary_flag = iter . binary ? ENTRY_FLAG_BINARY : 0 ;
status = _write_entry ( addr , current_key_id | ENTRY_FLAG_VALUE | binary_flag , iter . value , iter . value_len ) ;
if ( status < 0 ) break ;
addr + = ENTRY_SIZE ( iter . value_len ) ;
}
sysparam_iter_end ( & iter ) ;
// If we broke out with an error, return the error instead of continuing.
if ( status < 0 ) {
debug ( 1 , " error encountered during compacting (%d) " , status ) ;
return status ;
}
// Switch to officially using the new region.
status = _write_region_header ( new_base , _sysparam_info . cur_base , true ) ;
if ( status < 0 ) return status ;
status = _write_region_header ( _sysparam_info . cur_base , new_base , false ) ;
if ( status < 0 ) return status ;
_sysparam_info . alt_base = _sysparam_info . cur_base ;
_sysparam_info . cur_base = new_base ;
_sysparam_info . end_addr = addr ;
_sysparam_info . force_compact = false ;
// Fix up ctx so it doesn't point to invalid stuff
memset ( ctx , 0 , sizeof ( * ctx ) ) ;
ctx - > addr = addr ;
ctx - > max_key_id = current_key_id ;
debug ( 1 , " done compacting (current size %d) " , _sysparam_info . end_addr - _sysparam_info . cur_base ) ;
return SYSPARAM_OK ;
}
/***************************** Public Functions ******************************/
sysparam_status_t sysparam_init ( uint32_t base_addr , uint32_t top_addr ) {
sysparam_status_t status ;
uint32_t addr0 , addr1 ;
struct region_header header0 , header1 ;
struct sysparam_context ctx ;
uint16_t num_sectors ;
// Make sure we're starting at the beginning of the sector
base_addr - = ( base_addr % sdk_flashchip . sector_size ) ;
if ( ! top_addr | | top_addr = = base_addr ) {
// Only scan the specified sector, nowhere else.
top_addr = base_addr + sdk_flashchip . sector_size ;
}
for ( addr0 = base_addr ; addr0 < top_addr ; addr0 + = sdk_flashchip . sector_size ) {
CHECK_FLASH_OP ( sdk_spi_flash_read ( addr0 , ( void * ) & header0 , REGION_HEADER_SIZE ) ) ;
if ( header0 . magic = = SYSPARAM_MAGIC ) {
// Found a starting point...
break ;
}
}
if ( addr0 > = top_addr ) {
return SYSPARAM_NOTFOUND ;
}
// We've found a valid header at addr0. Now find the other half of the sysparam area.
num_sectors = header0 . flags_size & REGION_MASK_SIZE ;
if ( header0 . flags_size & REGION_FLAG_SECOND ) {
addr1 = addr0 - num_sectors * sdk_flashchip . sector_size ;
} else {
addr1 = addr0 + num_sectors * sdk_flashchip . sector_size ;
}
CHECK_FLASH_OP ( sdk_spi_flash_read ( addr1 , ( void * ) & header1 , REGION_HEADER_SIZE ) ) ;
if ( header1 . magic = = SYSPARAM_MAGIC ) {
// Yay! Found the other one. Sanity-check it..
if ( ( header0 . flags_size & REGION_FLAG_SECOND ) = = ( header1 . flags_size & REGION_FLAG_SECOND ) ) {
// Hmm.. they both say they're the same region. That can't be right...
debug ( 1 , " Found region headers @ 0x%08x and 0x%08x, but both claim to be the same region. " , addr0 , addr1 ) ;
return SYSPARAM_ERR_CORRUPT ;
}
} else {
// Didn't find a valid header at the alternate location (which probably means something clobbered it or something went wrong at a critical point when rewriting it. Is the one we did find the active or stale one?
if ( header0 . flags_size & REGION_FLAG_ACTIVE ) {
// Found the active one. We can work with this. Try to recreate the missing stale region...
debug ( 2 , " Found active region header @ 0x%08x but no stale region @ 0x%08x. Trying to recreate stale region. " , addr0 , addr1 ) ;
status = _format_region ( addr1 , num_sectors ) ;
if ( status ! = SYSPARAM_OK ) return status ;
status = _write_region_header ( addr1 , addr0 , false ) ;
if ( status ! = SYSPARAM_OK ) return status ;
} else {
// Found the stale one. We have no idea how old it is, so we shouldn't use it without some sort of confirmation/recovery. We'll have to bail for now.
debug ( 1 , " Found stale-region header @ 0x%08x, but no active region. " , addr0 ) ;
return SYSPARAM_ERR_CORRUPT ;
}
}
// At this point we have confirmed valid regions at addr0 and addr1.
_sysparam_info . region_size = num_sectors * sdk_flashchip . sector_size ;
if ( header0 . flags_size & REGION_FLAG_ACTIVE ) {
_sysparam_info . cur_base = addr0 ;
_sysparam_info . alt_base = addr1 ;
debug ( 3 , " Active region @ 0x%08x (0x%04x). Stale region @ 0x%08x (0x%04x). " , addr0 , header0 . flags_size , addr1 , header1 . flags_size ) ;
} else {
_sysparam_info . cur_base = addr1 ;
_sysparam_info . alt_base = addr0 ;
debug ( 3 , " Active region @ 0x%08x (0x%04x). Stale region @ 0x%08x (0x%04x). " , addr1 , header1 . flags_size , addr0 , header0 . flags_size ) ;
}
// Find the actual end
_sysparam_info . end_addr = _sysparam_info . cur_base + _sysparam_info . region_size ;
_sysparam_info . force_compact = false ;
_init_context ( & ctx ) ;
status = _find_entry ( & ctx , ENTRY_ID_END , false ) ;
if ( status < 0 ) {
_sysparam_info . cur_base = 0 ;
_sysparam_info . alt_base = 0 ;
_sysparam_info . end_addr = 0 ;
return status ;
}
if ( status = = SYSPARAM_OK ) {
_sysparam_info . end_addr = ctx . addr ;
}
2016-08-21 05:47:40 +00:00
_sysparam_info . sem = xSemaphoreCreateMutex ( ) ;
2016-08-18 10:07:46 +00:00
return SYSPARAM_OK ;
}
sysparam_status_t sysparam_create_area ( uint32_t base_addr , uint16_t num_sectors , bool force ) {
size_t region_size ;
sysparam_status_t status ;
uint32_t buffer [ SCAN_BUFFER_SIZE ] ;
uint32_t addr ;
int i ;
// Convert "number of sectors for area" into "number of sectors per region"
if ( num_sectors < 1 | | ( num_sectors & 1 ) ) {
return SYSPARAM_ERR_BADVALUE ;
}
num_sectors > > = 1 ;
region_size = num_sectors * sdk_flashchip . sector_size ;
if ( ! force ) {
// First, scan through the area and make sure it's actually empty and
// we're not going to be clobbering something else important.
for ( addr = base_addr ; addr < base_addr + region_size * 2 ; addr + = SCAN_BUFFER_SIZE ) {
debug ( 3 , " read %d words @ 0x%08x " , SCAN_BUFFER_SIZE , addr ) ;
CHECK_FLASH_OP ( sdk_spi_flash_read ( addr , buffer , SCAN_BUFFER_SIZE * 4 ) ) ;
for ( i = 0 ; i < SCAN_BUFFER_SIZE ; i + + ) {
if ( buffer [ i ] ! = 0xffffffff ) {
// Uh oh, not empty.
return SYSPARAM_NOTFOUND ;
}
}
}
}
if ( _sysparam_info . cur_base = = base_addr | | _sysparam_info . alt_base = = base_addr ) {
// We're reformating the same region we're already using.
// De-initialize everything to force the caller to do a clean
// `sysparam_init()` afterwards.
memset ( & _sysparam_info , 0 , sizeof ( _sysparam_info ) ) ;
}
status = _format_region ( base_addr , num_sectors ) ;
if ( status < 0 ) return status ;
status = _format_region ( base_addr + region_size , num_sectors ) ;
if ( status < 0 ) return status ;
status = _write_region_header ( base_addr , base_addr + region_size , true ) ;
if ( status < 0 ) return status ;
status = _write_region_header ( base_addr + region_size , base_addr , false ) ;
if ( status < 0 ) return status ;
return SYSPARAM_OK ;
}
sysparam_status_t sysparam_get_info ( uint32_t * base_addr , uint32_t * num_sectors ) {
if ( ! _sysparam_info . cur_base ) return SYSPARAM_ERR_NOINIT ;
* base_addr = min ( _sysparam_info . cur_base , _sysparam_info . alt_base ) ;
* num_sectors = ( _sysparam_info . region_size / sdk_flashchip . sector_size ) * 2 ;
return SYSPARAM_OK ;
}
sysparam_status_t sysparam_get_data ( const char * key , uint8_t * * destptr , size_t * actual_length , bool * is_binary ) {
struct sysparam_context ctx ;
sysparam_status_t status ;
size_t key_len = strlen ( key ) ;
uint8_t * buffer ;
2016-08-19 04:58:29 +00:00
xSemaphoreTake ( _sysparam_info . sem , portMAX_DELAY ) ;
2016-08-18 10:07:46 +00:00
2016-08-19 04:58:29 +00:00
if ( actual_length ) * actual_length = 0 ;
2016-08-18 10:07:46 +00:00
2016-08-19 04:58:29 +00:00
if ( ! _sysparam_info . cur_base ) {
status = SYSPARAM_ERR_NOINIT ;
goto done ;
}
2016-08-18 10:07:46 +00:00
2016-08-19 04:58:29 +00:00
_init_context ( & ctx ) ;
status = _find_key ( & ctx , key , key_len ) ;
if ( status ! = SYSPARAM_OK ) goto done ;
2016-08-18 10:07:46 +00:00
2016-08-19 04:58:29 +00:00
// Find the associated value
status = _find_value ( & ctx , ctx . entry . idflags ) ;
if ( status ! = SYSPARAM_OK ) goto done ;
2016-08-18 10:07:46 +00:00
2016-08-19 04:58:29 +00:00
buffer = malloc ( ctx . entry . len + 1 ) ;
if ( ! buffer ) {
status = SYSPARAM_ERR_NOMEM ;
goto done ;
}
2016-08-18 10:07:46 +00:00
2016-08-19 04:58:29 +00:00
status = _read_payload ( & ctx , buffer , ctx . entry . len ) ;
if ( status ! = SYSPARAM_OK ) {
free ( buffer ) ;
goto done ;
}
// Zero-terminate the result, just in case (doesn't hurt anything for
// non-string data, and can avoid nasty mistakes if the caller wants to
// interpret the result as a string).
buffer [ ctx . entry . len ] = 0 ;
* destptr = buffer ;
if ( actual_length ) * actual_length = ctx . entry . len ;
if ( is_binary ) * is_binary = ( bool ) ( ctx . entry . idflags & ENTRY_FLAG_BINARY ) ;
status = SYSPARAM_OK ;
done :
xSemaphoreGive ( _sysparam_info . sem ) ;
2016-08-18 10:07:46 +00:00
return status ;
}
2016-08-19 04:58:29 +00:00
sysparam_status_t sysparam_get_data_static ( const char * key , uint8_t * dest , size_t dest_size , size_t * actual_length , bool * is_binary ) {
2016-08-18 10:07:46 +00:00
struct sysparam_context ctx ;
sysparam_status_t status = SYSPARAM_OK ;
size_t key_len = strlen ( key ) ;
2016-08-19 04:58:29 +00:00
xSemaphoreTake ( _sysparam_info . sem , portMAX_DELAY ) ;
2016-08-18 10:07:46 +00:00
if ( actual_length ) * actual_length = 0 ;
2016-08-19 04:58:29 +00:00
if ( ! _sysparam_info . cur_base ) {
status = SYSPARAM_ERR_NOINIT ;
goto done ;
}
2016-08-18 10:07:46 +00:00
_init_context ( & ctx ) ;
2016-08-19 04:58:29 +00:00
status = _find_key ( & ctx , key , key_len ) ;
if ( status ! = SYSPARAM_OK ) goto done ;
2016-08-18 10:07:46 +00:00
status = _find_value ( & ctx , ctx . entry . idflags ) ;
2016-08-19 04:58:29 +00:00
if ( status ! = SYSPARAM_OK ) goto done ;
status = _read_payload ( & ctx , dest , dest_size ) ;
if ( status ! = SYSPARAM_OK ) goto done ;
2016-08-18 10:07:46 +00:00
if ( actual_length ) * actual_length = ctx . entry . len ;
if ( is_binary ) * is_binary = ( bool ) ( ctx . entry . idflags & ENTRY_FLAG_BINARY ) ;
2016-08-19 04:58:29 +00:00
done :
xSemaphoreGive ( _sysparam_info . sem ) ;
return status ;
2016-08-18 10:07:46 +00:00
}
sysparam_status_t sysparam_get_string ( const char * key , char * * destptr ) {
bool is_binary ;
sysparam_status_t status ;
uint8_t * buf ;
status = sysparam_get_data ( key , & buf , NULL , & is_binary ) ;
if ( status ! = SYSPARAM_OK ) return status ;
if ( is_binary ) {
// Value was saved as binary data, which means we shouldn't try to
// interpret it as a string.
free ( buf ) ;
return SYSPARAM_PARSEFAILED ;
}
// `sysparam_get_data` will zero-terminate the result as a matter of course,
// so no need to do that here.
* destptr = ( char * ) buf ;
return SYSPARAM_OK ;
}
2016-08-19 04:58:29 +00:00
sysparam_status_t sysparam_get_int32 ( const char * key , int32_t * result ) {
2016-08-18 10:07:46 +00:00
int32_t value ;
2016-08-19 04:58:29 +00:00
size_t actual_length ;
bool is_binary ;
2016-08-18 10:07:46 +00:00
sysparam_status_t status ;
2016-08-19 04:58:29 +00:00
status = sysparam_get_data_static ( key , ( uint8_t * ) & value , sizeof ( int32_t ) ,
& actual_length , & is_binary ) ;
2016-08-18 10:07:46 +00:00
if ( status ! = SYSPARAM_OK ) return status ;
2016-08-19 04:58:29 +00:00
if ( ! is_binary | | actual_length ! = sizeof ( int32_t ) )
2016-08-18 10:07:46 +00:00
return SYSPARAM_PARSEFAILED ;
* result = value ;
2016-08-19 04:58:29 +00:00
return status ;
2016-08-18 10:07:46 +00:00
}
2016-08-19 04:58:29 +00:00
sysparam_status_t sysparam_get_int8 ( const char * key , int8_t * result ) {
int8_t value ;
size_t actual_length ;
bool is_binary ;
2016-08-18 10:07:46 +00:00
sysparam_status_t status ;
2016-08-19 04:58:29 +00:00
status = sysparam_get_data_static ( key , ( uint8_t * ) & value , sizeof ( int8_t ) ,
& actual_length , & is_binary ) ;
2016-08-18 10:07:46 +00:00
if ( status ! = SYSPARAM_OK ) return status ;
2016-08-19 04:58:29 +00:00
if ( ! is_binary | | actual_length ! = sizeof ( int8_t ) )
return SYSPARAM_PARSEFAILED ;
* result = value ;
2016-08-18 10:07:46 +00:00
return status ;
}
2016-08-19 04:58:29 +00:00
sysparam_status_t sysparam_set_data ( const char * key , uint8_t * value , size_t value_len , bool is_binary ) {
2016-08-18 10:07:46 +00:00
struct sysparam_context ctx ;
struct sysparam_context write_ctx ;
sysparam_status_t status = SYSPARAM_OK ;
uint16_t key_len = strlen ( key ) ;
size_t free_space ;
size_t needed_space ;
int key_id = - 1 ;
uint32_t old_value_addr = 0 ;
uint16_t binary_flag ;
if ( ! key_len ) return SYSPARAM_ERR_BADVALUE ;
if ( key_len > MAX_KEY_LEN ) return SYSPARAM_ERR_BADVALUE ;
if ( value_len > MAX_VALUE_LEN ) return SYSPARAM_ERR_BADVALUE ;
if ( ! value ) value_len = 0 ;
debug ( 1 , " updating value for '%s' (%d bytes) " , key , value_len ) ;
2016-08-19 04:58:29 +00:00
xSemaphoreTake ( _sysparam_info . sem , portMAX_DELAY ) ;
if ( ! _sysparam_info . cur_base ) {
status = SYSPARAM_ERR_NOINIT ;
2016-08-21 05:47:40 +00:00
goto done ;
2016-08-18 10:07:46 +00:00
}
do {
_init_context ( & ctx ) ;
2016-08-19 04:58:29 +00:00
status = _find_key ( & ctx , key , key_len ) ;
2016-08-18 10:07:46 +00:00
if ( status = = SYSPARAM_OK ) {
// Key already exists, see if there's a current value.
key_id = ctx . entry . idflags & ENTRY_MASK_ID ;
status = _find_value ( & ctx , key_id ) ;
if ( status = = SYSPARAM_OK ) {
old_value_addr = ctx . addr ;
}
}
if ( status < 0 ) break ;
binary_flag = is_binary ? ENTRY_FLAG_BINARY : 0 ;
if ( value_len ) {
if ( old_value_addr ) {
2016-08-19 04:58:29 +00:00
if ( ( ctx . entry . idflags & ENTRY_FLAG_BINARY ) = = binary_flag & &
ctx . entry . len = = value_len ) {
2016-08-18 10:07:46 +00:00
// Are we trying to write the same value that's already there?
2016-08-19 04:58:29 +00:00
status = _compare_payload ( & ctx , ( uint8_t * ) value , value_len ) ;
if ( status = = SYSPARAM_OK ) {
2016-08-18 10:07:46 +00:00
// Yup, it's a match! No need to do anything further,
// just leave the current value as-is.
status = SYSPARAM_OK ;
break ;
}
2016-08-19 04:58:29 +00:00
if ( status ! = SYSPARAM_NOTFOUND ) goto done ;
2016-08-18 10:07:46 +00:00
}
// Since we will be deleting the old value (if any) make sure
// that the compactable count includes the space taken up by
// that entry too (even though it's not actually deleted yet)
ctx . compactable + = ENTRY_SIZE ( ctx . entry . len ) ;
}
// Append new value to the end, but first make sure we have enough
// space.
free_space = _sysparam_info . cur_base + _sysparam_info . region_size - _sysparam_info . end_addr ;
needed_space = ENTRY_SIZE ( value_len ) ;
if ( key_id < 0 ) {
// We did not find a previous key entry matching this key. We
// will need to add a key entry as well.
key_len = strlen ( key ) ;
needed_space + = ENTRY_SIZE ( key_len ) ;
}
if ( needed_space > free_space ) {
// Can we compact things?
// First, scan all remaining entries up to the end so we can
// get a reasonably accurate "compactable" reading.
_find_entry ( & ctx , ENTRY_ID_END , false ) ;
if ( needed_space < = free_space + ctx . compactable ) {
// We should be able to get enough space by compacting.
status = _compact_params ( & ctx , & key_id ) ;
if ( status < 0 ) break ;
old_value_addr = 0 ;
} else if ( ctx . unused_keys > 0 ) {
// Compacting will gain more space than expected, because
// there are some keys that can be omitted too, but we
// don't know exactly how much that will gain, so all we
// can do is give it a try and see if it gives us enough.
status = _compact_params ( & ctx , & key_id ) ;
if ( status < 0 ) break ;
old_value_addr = 0 ;
}
free_space = _sysparam_info . cur_base + _sysparam_info . region_size - _sysparam_info . end_addr ;
}
if ( needed_space > free_space ) {
// Nothing we can do here.. We're full.
// (at least full enough that compacting won't help us store
// this value)
debug ( 1 , " region full (need %d of %d remaining) " , needed_space , free_space ) ;
status = SYSPARAM_ERR_FULL ;
break ;
}
if ( key_id < 0 ) {
// We need to write a key entry for a new key.
// If we didn't find the key, then we already know _find_entry
// has gone through the entire contents, and thus
// ctx.max_key_id has the largest key_id found in the whole
// region.
if ( ctx . max_key_id > = MAX_KEY_ID ) {
if ( ctx . unused_keys > 0 ) {
status = _compact_params ( & ctx , & key_id ) ;
if ( status < 0 ) break ;
old_value_addr = 0 ;
} else {
debug ( 1 , " out of ids! " ) ;
status = SYSPARAM_ERR_FULL ;
break ;
}
}
}
if ( _sysparam_info . force_compact ) {
// We didn't need to compact above, but due to previously
// detected inconsistencies, we should compact anyway before
// writing anything new, so do that.
status = _compact_params ( & ctx , & key_id ) ;
if ( status < 0 ) break ;
}
init_write_context ( & write_ctx ) ;
if ( key_id < 0 ) {
// Write a new key entry
key_id = ctx . max_key_id + 1 ;
status = _write_entry ( write_ctx . addr , key_id , ( uint8_t * ) key , key_len ) ;
if ( status < 0 ) break ;
write_ctx . addr + = ENTRY_SIZE ( key_len ) ;
}
// Write new value
status = _write_entry ( write_ctx . addr , key_id | ENTRY_FLAG_VALUE | binary_flag , value , value_len ) ;
if ( status < 0 ) break ;
write_ctx . addr + = ENTRY_SIZE ( value_len ) ;
_sysparam_info . end_addr = write_ctx . addr ;
}
// Delete old value (if present) by clearing its "alive" flag
if ( old_value_addr ) {
status = _delete_entry ( old_value_addr ) ;
if ( status < 0 ) break ;
}
debug ( 1 , " New addr is 0x%08x (%d bytes remaining) " , _sysparam_info . end_addr , _sysparam_info . cur_base + _sysparam_info . region_size - _sysparam_info . end_addr ) ;
} while ( false ) ;
2016-08-21 05:47:40 +00:00
done :
xSemaphoreGive ( _sysparam_info . sem ) ;
2016-08-18 10:07:46 +00:00
return status ;
}
2016-08-19 04:58:29 +00:00
sysparam_status_t sysparam_set_string ( const char * key , char * value ) {
return sysparam_set_data ( key , ( uint8_t * ) value , strlen ( value ) , false ) ;
2016-08-18 10:07:46 +00:00
}
2016-08-19 04:58:29 +00:00
sysparam_status_t sysparam_set_int32 ( const char * key , int32_t value ) {
return sysparam_set_data ( key , ( uint8_t * ) & value , sizeof ( value ) , true ) ;
2016-08-18 10:07:46 +00:00
}
2016-08-19 04:58:29 +00:00
sysparam_status_t sysparam_set_int8 ( const char * key , int8_t value ) {
return sysparam_set_data ( key , ( uint8_t * ) & value , sizeof ( uint8_t ) , true ) ;
2016-08-18 10:07:46 +00:00
}
sysparam_status_t sysparam_iter_start ( sysparam_iter_t * iter ) {
if ( ! _sysparam_info . cur_base ) return SYSPARAM_ERR_NOINIT ;
iter - > bufsize = DEFAULT_ITER_BUF_SIZE ;
iter - > key = malloc ( iter - > bufsize ) ;
if ( ! iter - > key ) {
iter - > bufsize = 0 ;
return SYSPARAM_ERR_NOMEM ;
}
iter - > key_len = 0 ;
iter - > value_len = 0 ;
iter - > ctx = malloc ( sizeof ( struct sysparam_context ) ) ;
if ( ! iter - > ctx ) {
free ( iter - > key ) ;
iter - > bufsize = 0 ;
return SYSPARAM_ERR_NOMEM ;
}
_init_context ( iter - > ctx ) ;
return SYSPARAM_OK ;
}
sysparam_status_t sysparam_iter_next ( sysparam_iter_t * iter ) {
sysparam_status_t status ;
size_t required_len ;
struct sysparam_context * ctx = iter - > ctx ;
struct sysparam_context value_ctx ;
size_t key_space ;
char * newbuf ;
while ( true ) {
2016-08-19 04:58:29 +00:00
status = _find_key ( ctx , NULL , 0 ) ;
2016-08-18 10:07:46 +00:00
if ( status ! = SYSPARAM_OK ) return status ;
memcpy ( & value_ctx , ctx , sizeof ( value_ctx ) ) ;
status = _find_value ( & value_ctx , ctx - > entry . idflags ) ;
if ( status < 0 ) return status ;
if ( status = = SYSPARAM_NOTFOUND ) continue ;
key_space = ROUND_TO_WORD_BOUNDARY ( ctx - > entry . len + 1 ) ;
required_len = key_space + value_ctx . entry . len + 1 ;
if ( required_len > iter - > bufsize ) {
newbuf = realloc ( iter - > key , required_len ) ;
if ( ! newbuf ) {
return SYSPARAM_ERR_NOMEM ;
}
iter - > key = newbuf ;
iter - > bufsize = required_len ;
}
status = _read_payload ( ctx , ( uint8_t * ) iter - > key , iter - > bufsize ) ;
if ( status < 0 ) return status ;
// Null-terminate the key
iter - > key [ ctx - > entry . len ] = 0 ;
iter - > key_len = ctx - > entry . len ;
iter - > value = ( uint8_t * ) ( iter - > key + key_space ) ;
status = _read_payload ( & value_ctx , iter - > value , iter - > bufsize - key_space ) ;
if ( status < 0 ) return status ;
// Null-terminate the value (just in case)
iter - > value [ value_ctx . entry . len ] = 0 ;
iter - > value_len = value_ctx . entry . len ;
if ( value_ctx . entry . idflags & ENTRY_FLAG_BINARY ) {
iter - > binary = true ;
debug ( 2 , " iter_next: (0x%08x) '%s' = (0x%08x) <binary-data> (%d) " , ctx - > addr , iter - > key , value_ctx . addr , iter - > value_len ) ;
} else {
iter - > binary = false ;
debug ( 2 , " iter_next: (0x%08x) '%s' = (0x%08x) '%s' (%d) " , ctx - > addr , iter - > key , value_ctx . addr , iter - > value , iter - > value_len ) ;
}
return SYSPARAM_OK ;
}
}
void sysparam_iter_end ( sysparam_iter_t * iter ) {
if ( iter - > key ) free ( iter - > key ) ;
if ( iter - > ctx ) free ( iter - > ctx ) ;
}