Helmut Tschemernjak / NVProperty

NVProperty generic key value store using the MCU flash area.

Dependents:   Turtle_RadioShuttle

NVProperty_MBEDFlash.cpp@6:633f80228fc8, 2019-02-01 (annotated)

Committer:
Helmut Tschemernjak
Date:
Fri Feb 01 13:37:08 2019 +0100
Revision:
6:633f80228fc8
Parent:
5:2560e615ccd5
Child:
8:b42bb4130002
Updated

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Helmut Tschemernjak 4:eb6850e3bc21 1 /*
Helmut Tschemernjak 4:eb6850e3bc21 2 * This is an unpublished work copyright
Helmut Tschemernjak 4:eb6850e3bc21 3 * (c) 2019 Helmut Tschemernjak
Helmut Tschemernjak 4:eb6850e3bc21 4 * 30826 Garbsen (Hannover) Germany
Helmut Tschemernjak 4:eb6850e3bc21 5 *
Helmut Tschemernjak 4:eb6850e3bc21 6 *
Helmut Tschemernjak 4:eb6850e3bc21 7 * Use is granted to registered RadioShuttle licensees only.
Helmut Tschemernjak 4:eb6850e3bc21 8 * Licensees must own a valid serial number and product code.
Helmut Tschemernjak 4:eb6850e3bc21 9 * Details see: www.radioshuttle.de
Helmut Tschemernjak 4:eb6850e3bc21 10 */
Helmut Tschemernjak 4:eb6850e3bc21 11
Helmut Tschemernjak 4:eb6850e3bc21 12 #ifdef __MBED__
Helmut Tschemernjak 4:eb6850e3bc21 13
Helmut Tschemernjak 4:eb6850e3bc21 14 #include <mbed.h>
Helmut Tschemernjak 4:eb6850e3bc21 15 #include "main.h"
Helmut Tschemernjak 4:eb6850e3bc21 16 #include "arch.h"
Helmut Tschemernjak 4:eb6850e3bc21 17 #include <algorithm>
Helmut Tschemernjak 4:eb6850e3bc21 18 #include <NVPropertyProviderInterface.h>
Helmut Tschemernjak 4:eb6850e3bc21 19 #include <NVProperty_MBEDFlash.h>
Helmut Tschemernjak 4:eb6850e3bc21 20 #include <NVProperty.h>
Helmut Tschemernjak 4:eb6850e3bc21 21
Helmut Tschemernjak 4:eb6850e3bc21 22
Helmut Tschemernjak 5:2560e615ccd5 23 #if 0 // sample test code for a main app.
Helmut Tschemernjak 4:eb6850e3bc21 24 {
Helmut Tschemernjak 5:2560e615ccd5 25 NVProperty p;
Helmut Tschemernjak 5:2560e615ccd5 26 p.OpenPropertyStore(true);
Helmut Tschemernjak 5:2560e615ccd5 27
Helmut Tschemernjak 5:2560e615ccd5 28 dprintf("LORA_REMOTE_ID: %d", p.GetProperty(p.LORA_REMOTE_ID, 0));
Helmut Tschemernjak 5:2560e615ccd5 29 p.SetProperty(p.LORA_REMOTE_ID, p.T_32BIT, 123);
Helmut Tschemernjak 5:2560e615ccd5 30 dprintf("LORA_REMOTE_ID: %d", p.GetProperty(p.LORA_REMOTE_ID, 0));
Helmut Tschemernjak 5:2560e615ccd5 31 dprintf("Host: %s", p.GetProperty(p.HOSTNAME, "MyHost"));
Helmut Tschemernjak 5:2560e615ccd5 32 p.SetProperty(p.HOSTNAME, p.T_STR, "Wunstorf", p.S_FLASH);
Helmut Tschemernjak 5:2560e615ccd5 33 dprintf("Host: %s", p.GetProperty(p.HOSTNAME, "MyHost"));
Helmut Tschemernjak 5:2560e615ccd5 34 p.SetProperty(p.LORA_REMOTE_ID, p.T_32BIT, 456);
Helmut Tschemernjak 5:2560e615ccd5 35 dprintf("LORA_REMOTE_ID: %d", p.GetProperty(p.LORA_REMOTE_ID, 0));
Helmut Tschemernjak 5:2560e615ccd5 36 dprintf("Host: %s", p.GetProperty(p.HOSTNAME, "MyHost"));
Helmut Tschemernjak 4:eb6850e3bc21 37 }
Helmut Tschemernjak 4:eb6850e3bc21 38 #endif
Helmut Tschemernjak 4:eb6850e3bc21 39
Helmut Tschemernjak 4:eb6850e3bc21 40
Helmut Tschemernjak 4:eb6850e3bc21 41
Helmut Tschemernjak 4:eb6850e3bc21 42 NVProperty_MBEDFlash::NVProperty_MBEDFlash(int propSizekB, bool erase)
Helmut Tschemernjak 4:eb6850e3bc21 43 {
Helmut Tschemernjak 4:eb6850e3bc21 44 _flashIAP = new FlashIAP();
Helmut Tschemernjak 4:eb6850e3bc21 45 _flashIAP->init();
Helmut Tschemernjak 4:eb6850e3bc21 46
Helmut Tschemernjak 5:2560e615ccd5 47 // at present erased flash bits are assumed with 0xff value
Helmut Tschemernjak 6:633f80228fc8 48 // MBED_ASSERT(_flashIAP->get_erase_value() == NVProperty::PROPERTIES_EOF);
Helmut Tschemernjak 5:2560e615ccd5 49 // a min page size > 8 looks strange
Helmut Tschemernjak 5:2560e615ccd5 50 MBED_ASSERT(_flashIAP->get_page_size() <= sizeof(int64_t));
Helmut Tschemernjak 5:2560e615ccd5 51
Helmut Tschemernjak 5:2560e615ccd5 52
Helmut Tschemernjak 4:eb6850e3bc21 53 _debug = false;
Helmut Tschemernjak 4:eb6850e3bc21 54 _propSizekB = propSizekB;
Helmut Tschemernjak 4:eb6850e3bc21 55 _pageSize = _flashIAP->get_page_size();
Helmut Tschemernjak 4:eb6850e3bc21 56 _numPages = _flashIAP->get_flash_size() / _pageSize;
Helmut Tschemernjak 4:eb6850e3bc21 57 _rowSize = _flashIAP->get_sector_size(_flashIAP->get_flash_start()); // pageSize * 4;
Helmut Tschemernjak 4:eb6850e3bc21 58 _startAddress = (uint8_t*)_flashIAP->get_flash_start() + ((_numPages-(_propSizekB * 1024)/_pageSize) * _pageSize);
Helmut Tschemernjak 4:eb6850e3bc21 59 _endAddress = _startAddress + (_propSizekB * 1024);
Helmut Tschemernjak 4:eb6850e3bc21 60 _lastEntry = NULL;
Helmut Tschemernjak 4:eb6850e3bc21 61
Helmut Tschemernjak 4:eb6850e3bc21 62 if (_debug) {
Helmut Tschemernjak 4:eb6850e3bc21 63 dprintf("_propSizekB: %d kB", _propSizekB);
Helmut Tschemernjak 4:eb6850e3bc21 64 dprintf("_pageSize: %d", _pageSize);
Helmut Tschemernjak 4:eb6850e3bc21 65 dprintf("_numPages: %d", _numPages);
Helmut Tschemernjak 4:eb6850e3bc21 66 dprintf("_rowSize: %d", _rowSize);
Helmut Tschemernjak 4:eb6850e3bc21 67 dprintf("PageOffset: %d", _numPages-((_propSizekB * 1024)/_pageSize));
Helmut Tschemernjak 4:eb6850e3bc21 68 dprintf("total: %d", _pageSize * _numPages);
Helmut Tschemernjak 4:eb6850e3bc21 69 dprintf("_startAddress: %d", (int)_startAddress);
Helmut Tschemernjak 4:eb6850e3bc21 70 }
Helmut Tschemernjak 4:eb6850e3bc21 71
Helmut Tschemernjak 4:eb6850e3bc21 72 _FlashInititalize(erase);
Helmut Tschemernjak 4:eb6850e3bc21 73 }
Helmut Tschemernjak 4:eb6850e3bc21 74
Helmut Tschemernjak 4:eb6850e3bc21 75
Helmut Tschemernjak 4:eb6850e3bc21 76 NVProperty_MBEDFlash::~NVProperty_MBEDFlash()
Helmut Tschemernjak 4:eb6850e3bc21 77 {
Helmut Tschemernjak 4:eb6850e3bc21 78 _flashIAP->deinit();
Helmut Tschemernjak 4:eb6850e3bc21 79 delete _flashIAP;
Helmut Tschemernjak 5:2560e615ccd5 80 #if 0
Helmut Tschemernjak 4:eb6850e3bc21 81 _debug = true;
Helmut Tschemernjak 4:eb6850e3bc21 82 wait_ms(100);
Helmut Tschemernjak 4:eb6850e3bc21 83 _DumpAllEntires();
Helmut Tschemernjak 4:eb6850e3bc21 84 wait_ms(100);
Helmut Tschemernjak 5:2560e615ccd5 85 dump("buffer: ", _startAddress, 100);
Helmut Tschemernjak 5:2560e615ccd5 86 wait_ms(100);
Helmut Tschemernjak 5:2560e615ccd5 87 #endif
Helmut Tschemernjak 4:eb6850e3bc21 88 }
Helmut Tschemernjak 4:eb6850e3bc21 89
Helmut Tschemernjak 4:eb6850e3bc21 90
Helmut Tschemernjak 4:eb6850e3bc21 91 void
Helmut Tschemernjak 4:eb6850e3bc21 92 NVProperty_MBEDFlash::_FlashInititalize(bool force)
Helmut Tschemernjak 4:eb6850e3bc21 93 {
Helmut Tschemernjak 4:eb6850e3bc21 94 _flash_header *fh = (_flash_header *)_startAddress;
Helmut Tschemernjak 4:eb6850e3bc21 95 if (fh->magic == FLASH_PROP_MAGIC && fh->version == FLASH_PROP_VERSION && fh->sizeKB == _propSizekB) {
Helmut Tschemernjak 4:eb6850e3bc21 96 if (_debug)
Helmut Tschemernjak 4:eb6850e3bc21 97 dprintf("Flash OK");
Helmut Tschemernjak 4:eb6850e3bc21 98 if (!force)
Helmut Tschemernjak 4:eb6850e3bc21 99 return;
Helmut Tschemernjak 4:eb6850e3bc21 100 }
Helmut Tschemernjak 4:eb6850e3bc21 101
Helmut Tschemernjak 4:eb6850e3bc21 102 if (_debug)
Helmut Tschemernjak 4:eb6850e3bc21 103 dprintf("Formatting Flash");
Helmut Tschemernjak 4:eb6850e3bc21 104
Helmut Tschemernjak 4:eb6850e3bc21 105 _flash_header f;
Helmut Tschemernjak 4:eb6850e3bc21 106 memset(&f, 0, sizeof(f));
Helmut Tschemernjak 4:eb6850e3bc21 107 f.magic = FLASH_PROP_MAGIC;
Helmut Tschemernjak 4:eb6850e3bc21 108 f.version = FLASH_PROP_VERSION;
Helmut Tschemernjak 4:eb6850e3bc21 109 f.sizeKB = _propSizekB;
Helmut Tschemernjak 4:eb6850e3bc21 110
Helmut Tschemernjak 4:eb6850e3bc21 111 int count = (_propSizekB * 1024) / _rowSize;
Helmut Tschemernjak 4:eb6850e3bc21 112 int startRow = (int)_startAddress / _rowSize;
Helmut Tschemernjak 4:eb6850e3bc21 113 _FlashEraseRow(startRow, count);
Helmut Tschemernjak 4:eb6850e3bc21 114 _FlashWrite(_startAddress, &f, sizeof(f));
Helmut Tschemernjak 4:eb6850e3bc21 115 }
Helmut Tschemernjak 4:eb6850e3bc21 116
Helmut Tschemernjak 4:eb6850e3bc21 117
Helmut Tschemernjak 4:eb6850e3bc21 118 void
Helmut Tschemernjak 4:eb6850e3bc21 119 NVProperty_MBEDFlash::_FlashEraseRow(int startRow, int count)
Helmut Tschemernjak 4:eb6850e3bc21 120 {
Helmut Tschemernjak 4:eb6850e3bc21 121 // dprintf("_FlashEraseRow: startRow=%d, count=%d", startRow, count);
Helmut Tschemernjak 4:eb6850e3bc21 122
Helmut Tschemernjak 4:eb6850e3bc21 123 for(int i = 0; i < count; i++) {
Helmut Tschemernjak 4:eb6850e3bc21 124 uint32_t *startAddr = (uint32_t *)((startRow + i) * _rowSize);
Helmut Tschemernjak 4:eb6850e3bc21 125 uint32_t *addr = startAddr;
Helmut Tschemernjak 4:eb6850e3bc21 126 bool foundData = false;
Helmut Tschemernjak 4:eb6850e3bc21 127 for (int offset = 0; offset < _rowSize; offset += sizeof(uint32_t)) {
Helmut Tschemernjak 4:eb6850e3bc21 128 if (*addr++ != 0xffffffff) {
Helmut Tschemernjak 4:eb6850e3bc21 129 foundData = true;
Helmut Tschemernjak 4:eb6850e3bc21 130 break;
Helmut Tschemernjak 4:eb6850e3bc21 131 }
Helmut Tschemernjak 4:eb6850e3bc21 132 }
Helmut Tschemernjak 4:eb6850e3bc21 133 if (_debug)
Helmut Tschemernjak 4:eb6850e3bc21 134 dprintf("_FlashEraseRow: addr=0x%x, count=%d (%s)", (unsigned int)startAddr, i,
Helmut Tschemernjak 4:eb6850e3bc21 135 foundData ? "erased" : "skipped");
Helmut Tschemernjak 4:eb6850e3bc21 136 if (!foundData)
Helmut Tschemernjak 4:eb6850e3bc21 137 continue;
Helmut Tschemernjak 4:eb6850e3bc21 138
Helmut Tschemernjak 4:eb6850e3bc21 139 _flashIAP->erase((startRow + i) * _rowSize, _rowSize);
Helmut Tschemernjak 4:eb6850e3bc21 140 }
Helmut Tschemernjak 4:eb6850e3bc21 141 }
Helmut Tschemernjak 4:eb6850e3bc21 142
Helmut Tschemernjak 4:eb6850e3bc21 143
Helmut Tschemernjak 4:eb6850e3bc21 144 /*
Helmut Tschemernjak 4:eb6850e3bc21 145 * Find out start page, number of pages
Helmut Tschemernjak 4:eb6850e3bc21 146 * Check if the page contins FF's than write, otherwise erase first
Helmut Tschemernjak 4:eb6850e3bc21 147 */
Helmut Tschemernjak 4:eb6850e3bc21 148 void
Helmut Tschemernjak 4:eb6850e3bc21 149 NVProperty_MBEDFlash::_FlashWrite(uint8_t *address, const void *d, size_t length)
Helmut Tschemernjak 4:eb6850e3bc21 150 {
Helmut Tschemernjak 4:eb6850e3bc21 151 uint8_t *data = (uint8_t *)d;
Helmut Tschemernjak 4:eb6850e3bc21 152
Helmut Tschemernjak 4:eb6850e3bc21 153 if (address < _startAddress || address > _startAddress + (_pageSize * _numPages))
Helmut Tschemernjak 4:eb6850e3bc21 154 return;
Helmut Tschemernjak 4:eb6850e3bc21 155
Helmut Tschemernjak 4:eb6850e3bc21 156 int done = 0;
Helmut Tschemernjak 4:eb6850e3bc21 157
Helmut Tschemernjak 4:eb6850e3bc21 158 do {
Helmut Tschemernjak 4:eb6850e3bc21 159 uint32_t startPage = (uint32_t)(address + done) / _pageSize;
Helmut Tschemernjak 4:eb6850e3bc21 160 int pageOffset = (uint32_t)(address + done) % _pageSize;
Helmut Tschemernjak 4:eb6850e3bc21 161 int pageWriteSize = _pageSize - pageOffset;
Helmut Tschemernjak 4:eb6850e3bc21 162
Helmut Tschemernjak 4:eb6850e3bc21 163 if (_FlashIsCleared((uint8_t *)(startPage * _pageSize) + pageOffset, pageWriteSize)) {
Helmut Tschemernjak 4:eb6850e3bc21 164 // single page write
Helmut Tschemernjak 4:eb6850e3bc21 165 int writeLength = std::min(pageWriteSize, (int)length);
Helmut Tschemernjak 4:eb6850e3bc21 166 _FlashWritePage(startPage, pageOffset, data, writeLength);
Helmut Tschemernjak 4:eb6850e3bc21 167 length -= writeLength;
Helmut Tschemernjak 4:eb6850e3bc21 168 done += writeLength;
Helmut Tschemernjak 4:eb6850e3bc21 169 data += writeLength;
Helmut Tschemernjak 4:eb6850e3bc21 170 } else {
Helmut Tschemernjak 4:eb6850e3bc21 171 // row write
Helmut Tschemernjak 4:eb6850e3bc21 172 // load row copy
Helmut Tschemernjak 4:eb6850e3bc21 173 // erase row
Helmut Tschemernjak 4:eb6850e3bc21 174 // merge in new data
Helmut Tschemernjak 4:eb6850e3bc21 175 // write row in page copies
Helmut Tschemernjak 4:eb6850e3bc21 176 uint32_t startRow = (uint32_t)(address + done) / _rowSize;
Helmut Tschemernjak 4:eb6850e3bc21 177 int rowOffset = (uint32_t)(address + done) - (startRow * _rowSize);
Helmut Tschemernjak 4:eb6850e3bc21 178 int cplen = std::min((int)length, _rowSize - rowOffset);
Helmut Tschemernjak 4:eb6850e3bc21 179 uint8_t *saveddata = new uint8_t[_rowSize];
Helmut Tschemernjak 4:eb6850e3bc21 180 if (!saveddata)
Helmut Tschemernjak 4:eb6850e3bc21 181 return;
Helmut Tschemernjak 4:eb6850e3bc21 182
Helmut Tschemernjak 4:eb6850e3bc21 183 memcpy(saveddata, (uint8_t *)(startRow * _rowSize), _rowSize);
Helmut Tschemernjak 4:eb6850e3bc21 184 // dprintf("startRow=%d rowOffset=%d, cplen=%d", startRow, rowOffset, cplen);
Helmut Tschemernjak 4:eb6850e3bc21 185
Helmut Tschemernjak 4:eb6850e3bc21 186 memcpy(saveddata + rowOffset, data, cplen);
Helmut Tschemernjak 4:eb6850e3bc21 187
Helmut Tschemernjak 4:eb6850e3bc21 188 _FlashEraseRow(startRow);
Helmut Tschemernjak 4:eb6850e3bc21 189 for (int i = 0; i < _rowSize/_pageSize; i++) {
Helmut Tschemernjak 4:eb6850e3bc21 190 _FlashWritePage(((startRow * _rowSize) / _pageSize) + i, 0, saveddata + (i * _pageSize), _pageSize);
Helmut Tschemernjak 4:eb6850e3bc21 191 }
Helmut Tschemernjak 4:eb6850e3bc21 192 length -= cplen;
Helmut Tschemernjak 4:eb6850e3bc21 193 done += cplen;
Helmut Tschemernjak 4:eb6850e3bc21 194 data += cplen;
Helmut Tschemernjak 4:eb6850e3bc21 195
Helmut Tschemernjak 4:eb6850e3bc21 196 delete[] saveddata;
Helmut Tschemernjak 4:eb6850e3bc21 197 }
Helmut Tschemernjak 4:eb6850e3bc21 198 } while(length > 0);
Helmut Tschemernjak 4:eb6850e3bc21 199 }
Helmut Tschemernjak 4:eb6850e3bc21 200
Helmut Tschemernjak 4:eb6850e3bc21 201
Helmut Tschemernjak 4:eb6850e3bc21 202 bool
Helmut Tschemernjak 4:eb6850e3bc21 203 NVProperty_MBEDFlash::_FlashIsCleared(uint8_t *address, int len)
Helmut Tschemernjak 4:eb6850e3bc21 204 {
Helmut Tschemernjak 5:2560e615ccd5 205 while (len-- > 0) {
Helmut Tschemernjak 4:eb6850e3bc21 206 if (*address++ != NVProperty::PROPERTIES_EOF) {
Helmut Tschemernjak 4:eb6850e3bc21 207 return false;
Helmut Tschemernjak 4:eb6850e3bc21 208 }
Helmut Tschemernjak 4:eb6850e3bc21 209 }
Helmut Tschemernjak 4:eb6850e3bc21 210 return true;
Helmut Tschemernjak 4:eb6850e3bc21 211 }
Helmut Tschemernjak 4:eb6850e3bc21 212
Helmut Tschemernjak 4:eb6850e3bc21 213
Helmut Tschemernjak 4:eb6850e3bc21 214 void
Helmut Tschemernjak 4:eb6850e3bc21 215 NVProperty_MBEDFlash::_FlashWritePage(int page, int offset, uint8_t *data, int length)
Helmut Tschemernjak 4:eb6850e3bc21 216 {
Helmut Tschemernjak 4:eb6850e3bc21 217 uint8_t *addr = (uint8_t *)(page * _pageSize) + offset;
Helmut Tschemernjak 4:eb6850e3bc21 218 if (length < 1)
Helmut Tschemernjak 4:eb6850e3bc21 219 return;
Helmut Tschemernjak 4:eb6850e3bc21 220
Helmut Tschemernjak 4:eb6850e3bc21 221 _flashIAP->program(data, (uint32_t)addr, length);
Helmut Tschemernjak 4:eb6850e3bc21 222 }
Helmut Tschemernjak 4:eb6850e3bc21 223
Helmut Tschemernjak 4:eb6850e3bc21 224
Helmut Tschemernjak 4:eb6850e3bc21 225
Helmut Tschemernjak 4:eb6850e3bc21 226 int
Helmut Tschemernjak 4:eb6850e3bc21 227 NVProperty_MBEDFlash::GetProperty(int key)
Helmut Tschemernjak 4:eb6850e3bc21 228 {
Helmut Tschemernjak 4:eb6850e3bc21 229 return GetProperty64(key);
Helmut Tschemernjak 4:eb6850e3bc21 230 }
Helmut Tschemernjak 4:eb6850e3bc21 231
Helmut Tschemernjak 4:eb6850e3bc21 232
Helmut Tschemernjak 4:eb6850e3bc21 233 int64_t
Helmut Tschemernjak 4:eb6850e3bc21 234 NVProperty_MBEDFlash::GetProperty64(int key)
Helmut Tschemernjak 4:eb6850e3bc21 235 {
Helmut Tschemernjak 4:eb6850e3bc21 236 _flashEntry *p = _GetFlashEntry(key);
Helmut Tschemernjak 4:eb6850e3bc21 237 if (!p)
Helmut Tschemernjak 4:eb6850e3bc21 238 return NVProperty::NVP_ENOENT;
Helmut Tschemernjak 4:eb6850e3bc21 239
Helmut Tschemernjak 4:eb6850e3bc21 240 int64_t value = 0;
Helmut Tschemernjak 4:eb6850e3bc21 241
Helmut Tschemernjak 4:eb6850e3bc21 242 switch(p->t.type) {
Helmut Tschemernjak 4:eb6850e3bc21 243 case NVProperty::T_BIT:
Helmut Tschemernjak 4:eb6850e3bc21 244 if (p->t.t_bit)
Helmut Tschemernjak 4:eb6850e3bc21 245 value = 1;
Helmut Tschemernjak 4:eb6850e3bc21 246 else
Helmut Tschemernjak 4:eb6850e3bc21 247 value = 0;
Helmut Tschemernjak 4:eb6850e3bc21 248 break;
Helmut Tschemernjak 4:eb6850e3bc21 249 case NVProperty::T_8BIT:
Helmut Tschemernjak 4:eb6850e3bc21 250 value = p->u.v_8bit;
Helmut Tschemernjak 4:eb6850e3bc21 251 break;
Helmut Tschemernjak 4:eb6850e3bc21 252 case NVProperty::T_16BIT:
Helmut Tschemernjak 4:eb6850e3bc21 253 {
Helmut Tschemernjak 4:eb6850e3bc21 254 int16_t v;
Helmut Tschemernjak 4:eb6850e3bc21 255 memcpy(&v, &p->u.v_16bit, sizeof(p->u.v_16bit));
Helmut Tschemernjak 4:eb6850e3bc21 256 value = v;
Helmut Tschemernjak 4:eb6850e3bc21 257 }
Helmut Tschemernjak 4:eb6850e3bc21 258 break;
Helmut Tschemernjak 4:eb6850e3bc21 259 case NVProperty::T_32BIT:
Helmut Tschemernjak 4:eb6850e3bc21 260 {
Helmut Tschemernjak 4:eb6850e3bc21 261 int32_t v;
Helmut Tschemernjak 4:eb6850e3bc21 262 memcpy(&v, &p->data.v_32bit, sizeof(p->data.v_32bit));
Helmut Tschemernjak 4:eb6850e3bc21 263 value = v;
Helmut Tschemernjak 4:eb6850e3bc21 264 }
Helmut Tschemernjak 4:eb6850e3bc21 265 break;
Helmut Tschemernjak 4:eb6850e3bc21 266 case NVProperty::T_64BIT:
Helmut Tschemernjak 4:eb6850e3bc21 267 memcpy(&value, p->data.v_64bit, sizeof(p->data.v_64bit));
Helmut Tschemernjak 4:eb6850e3bc21 268 break;
Helmut Tschemernjak 4:eb6850e3bc21 269 case NVProperty::T_STR:
Helmut Tschemernjak 4:eb6850e3bc21 270 case NVProperty::T_BLOB:
Helmut Tschemernjak 4:eb6850e3bc21 271 value = p->u.option.d_len;
Helmut Tschemernjak 4:eb6850e3bc21 272 break;
Helmut Tschemernjak 4:eb6850e3bc21 273 }
Helmut Tschemernjak 4:eb6850e3bc21 274 return value;
Helmut Tschemernjak 4:eb6850e3bc21 275 }
Helmut Tschemernjak 4:eb6850e3bc21 276
Helmut Tschemernjak 4:eb6850e3bc21 277 const char *
Helmut Tschemernjak 4:eb6850e3bc21 278 NVProperty_MBEDFlash::GetPropertyStr(int key)
Helmut Tschemernjak 4:eb6850e3bc21 279 {
Helmut Tschemernjak 4:eb6850e3bc21 280 _flashEntry *p = _GetFlashEntry(key);
Helmut Tschemernjak 4:eb6850e3bc21 281 if (!p || p->t.type != NVProperty::T_STR)
Helmut Tschemernjak 4:eb6850e3bc21 282 return NULL;
Helmut Tschemernjak 4:eb6850e3bc21 283 return strdup(p->data.v_str);
Helmut Tschemernjak 4:eb6850e3bc21 284 }
Helmut Tschemernjak 4:eb6850e3bc21 285
Helmut Tschemernjak 4:eb6850e3bc21 286 int
Helmut Tschemernjak 4:eb6850e3bc21 287 NVProperty_MBEDFlash::GetPropertyBlob(int key, const void *blob, int *size)
Helmut Tschemernjak 4:eb6850e3bc21 288 {
Helmut Tschemernjak 4:eb6850e3bc21 289 _flashEntry *p = _GetFlashEntry(key);
Helmut Tschemernjak 4:eb6850e3bc21 290 if (!p || p->t.type != NVProperty::T_BLOB)
Helmut Tschemernjak 4:eb6850e3bc21 291 return NVProperty::NVP_ENOENT;
Helmut Tschemernjak 4:eb6850e3bc21 292
Helmut Tschemernjak 4:eb6850e3bc21 293 int cplen = std::min(*size, (int)p->u.option.d_len);
Helmut Tschemernjak 4:eb6850e3bc21 294 if (blob)
Helmut Tschemernjak 4:eb6850e3bc21 295 memcpy((void *)blob, p->data.v_blob, cplen);
Helmut Tschemernjak 4:eb6850e3bc21 296 *size = cplen;
Helmut Tschemernjak 4:eb6850e3bc21 297
Helmut Tschemernjak 4:eb6850e3bc21 298 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 299 }
Helmut Tschemernjak 4:eb6850e3bc21 300
Helmut Tschemernjak 4:eb6850e3bc21 301
Helmut Tschemernjak 4:eb6850e3bc21 302 int
Helmut Tschemernjak 4:eb6850e3bc21 303 NVProperty_MBEDFlash::SetProperty(int key, int64_t value, int type)
Helmut Tschemernjak 4:eb6850e3bc21 304 {
Helmut Tschemernjak 4:eb6850e3bc21 305 UNUSED(type);
Helmut Tschemernjak 5:2560e615ccd5 306 uint8_t valbuf[16];
Helmut Tschemernjak 4:eb6850e3bc21 307 _flashEntry *p = (_flashEntry *) valbuf;
Helmut Tschemernjak 4:eb6850e3bc21 308 int storeType;
Helmut Tschemernjak 4:eb6850e3bc21 309
Helmut Tschemernjak 4:eb6850e3bc21 310 if (GetProperty64(key) == value) // no need to save it again.
Helmut Tschemernjak 4:eb6850e3bc21 311 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 312
Helmut Tschemernjak 4:eb6850e3bc21 313 memset(valbuf, 0, sizeof(valbuf));
Helmut Tschemernjak 4:eb6850e3bc21 314
Helmut Tschemernjak 4:eb6850e3bc21 315 if (value == 0 || value == 1)
Helmut Tschemernjak 4:eb6850e3bc21 316 storeType = NVProperty::T_BIT;
Helmut Tschemernjak 4:eb6850e3bc21 317 else if (value >= -128 && value < 128)
Helmut Tschemernjak 4:eb6850e3bc21 318 storeType = NVProperty::T_8BIT;
Helmut Tschemernjak 4:eb6850e3bc21 319 else if (value >= -32768 && value < 32768)
Helmut Tschemernjak 4:eb6850e3bc21 320 storeType = NVProperty::T_16BIT;
Helmut Tschemernjak 4:eb6850e3bc21 321 else if (value > -2147483647LL && value < 2147483648LL)
Helmut Tschemernjak 4:eb6850e3bc21 322 storeType = NVProperty::T_32BIT;
Helmut Tschemernjak 4:eb6850e3bc21 323 else
Helmut Tschemernjak 4:eb6850e3bc21 324 storeType = NVProperty::T_64BIT;
Helmut Tschemernjak 4:eb6850e3bc21 325
Helmut Tschemernjak 4:eb6850e3bc21 326 p->key = key;
Helmut Tschemernjak 4:eb6850e3bc21 327 p->t.type = storeType;
Helmut Tschemernjak 4:eb6850e3bc21 328
Helmut Tschemernjak 4:eb6850e3bc21 329
Helmut Tschemernjak 4:eb6850e3bc21 330 switch(storeType) {
Helmut Tschemernjak 4:eb6850e3bc21 331 case NVProperty::T_BIT:
Helmut Tschemernjak 4:eb6850e3bc21 332 p->t.t_bit = value;
Helmut Tschemernjak 4:eb6850e3bc21 333 break;
Helmut Tschemernjak 4:eb6850e3bc21 334 case NVProperty::T_8BIT:
Helmut Tschemernjak 4:eb6850e3bc21 335 p->u.v_8bit = value;
Helmut Tschemernjak 4:eb6850e3bc21 336 break;
Helmut Tschemernjak 4:eb6850e3bc21 337 case NVProperty::T_16BIT:
Helmut Tschemernjak 4:eb6850e3bc21 338 p->u.v_16bit = value;
Helmut Tschemernjak 4:eb6850e3bc21 339 break;
Helmut Tschemernjak 4:eb6850e3bc21 340 case NVProperty::T_32BIT:
Helmut Tschemernjak 4:eb6850e3bc21 341 p->u.option.d_len = sizeof(p->data.v_32bit);
Helmut Tschemernjak 4:eb6850e3bc21 342 {
Helmut Tschemernjak 4:eb6850e3bc21 343 int32_t v = value;
Helmut Tschemernjak 4:eb6850e3bc21 344 memcpy(&p->data.v_32bit, &v, sizeof(p->data.v_32bit));
Helmut Tschemernjak 4:eb6850e3bc21 345 }
Helmut Tschemernjak 4:eb6850e3bc21 346 break;
Helmut Tschemernjak 4:eb6850e3bc21 347 case NVProperty::T_64BIT:
Helmut Tschemernjak 4:eb6850e3bc21 348 p->u.option.d_len = sizeof(p->data.v_64bit);
Helmut Tschemernjak 4:eb6850e3bc21 349 memcpy(p->data.v_64bit, &value, sizeof(p->data.v_64bit));
Helmut Tschemernjak 4:eb6850e3bc21 350 break;
Helmut Tschemernjak 4:eb6850e3bc21 351 }
Helmut Tschemernjak 4:eb6850e3bc21 352 int len;
Helmut Tschemernjak 5:2560e615ccd5 353 if (storeType == NVProperty::T_BIT)
Helmut Tschemernjak 5:2560e615ccd5 354 len = FLASH_ENTRY_HEADER_SHORT;
Helmut Tschemernjak 5:2560e615ccd5 355 else if (storeType == NVProperty::T_8BIT || storeType == NVProperty::T_16BIT)
Helmut Tschemernjak 5:2560e615ccd5 356 len = FLASH_ENTRY_HEADER;
Helmut Tschemernjak 5:2560e615ccd5 357 else // 32/64/STR/BLOB
Helmut Tschemernjak 5:2560e615ccd5 358 len = FLASH_ENTRY_HEADER + p->u.option.d_len;
Helmut Tschemernjak 5:2560e615ccd5 359 len += _GetFlashPaddingSize(len);
Helmut Tschemernjak 4:eb6850e3bc21 360 if ((uint8_t *)_lastEntry + len >= _endAddress) {
Helmut Tschemernjak 4:eb6850e3bc21 361 if (!_FlashReorgEntries(len))
Helmut Tschemernjak 4:eb6850e3bc21 362 return NVProperty::NVP_ERR_NOSPACE;
Helmut Tschemernjak 4:eb6850e3bc21 363 }
Helmut Tschemernjak 4:eb6850e3bc21 364
Helmut Tschemernjak 4:eb6850e3bc21 365 _FlashWrite((uint8_t *)_lastEntry, p, len);
Helmut Tschemernjak 4:eb6850e3bc21 366 _lastEntry = (_flashEntry *)((uint8_t *)_lastEntry + len);
Helmut Tschemernjak 4:eb6850e3bc21 367
Helmut Tschemernjak 4:eb6850e3bc21 368 // _DumpAllEntires();
Helmut Tschemernjak 4:eb6850e3bc21 369 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 370 }
Helmut Tschemernjak 4:eb6850e3bc21 371
Helmut Tschemernjak 4:eb6850e3bc21 372
Helmut Tschemernjak 4:eb6850e3bc21 373 int
Helmut Tschemernjak 4:eb6850e3bc21 374 NVProperty_MBEDFlash::SetPropertyStr(int key, const char *value, int type)
Helmut Tschemernjak 4:eb6850e3bc21 375 {
Helmut Tschemernjak 4:eb6850e3bc21 376 if (type != NVProperty::T_STR)
Helmut Tschemernjak 4:eb6850e3bc21 377 return NVProperty::NVP_INVALD_PARM;
Helmut Tschemernjak 4:eb6850e3bc21 378
Helmut Tschemernjak 4:eb6850e3bc21 379 _flashEntry *p = _GetFlashEntry(key);
Helmut Tschemernjak 4:eb6850e3bc21 380 if (p && p->t.type == NVProperty::T_STR && strcmp(p->data.v_str, value) == 0) {
Helmut Tschemernjak 4:eb6850e3bc21 381 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 382 }
Helmut Tschemernjak 4:eb6850e3bc21 383
Helmut Tschemernjak 4:eb6850e3bc21 384 int err = NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 385
Helmut Tschemernjak 4:eb6850e3bc21 386 p = new _flashEntry();
Helmut Tschemernjak 4:eb6850e3bc21 387 if (!p)
Helmut Tschemernjak 4:eb6850e3bc21 388 return NVProperty::NVP_ERR_NOSPACE;
Helmut Tschemernjak 4:eb6850e3bc21 389
Helmut Tschemernjak 4:eb6850e3bc21 390 p->key = key;
Helmut Tschemernjak 4:eb6850e3bc21 391 p->t.type = NVProperty::T_STR;
Helmut Tschemernjak 4:eb6850e3bc21 392 int cplen = std::min(strlen(value), sizeof(p->data.v_str)-1);
Helmut Tschemernjak 4:eb6850e3bc21 393 memcpy(p->data.v_str, value, cplen);
Helmut Tschemernjak 4:eb6850e3bc21 394 p->u.option.d_len = cplen + 1; // zero term
Helmut Tschemernjak 4:eb6850e3bc21 395
Helmut Tschemernjak 5:2560e615ccd5 396 int len = FLASH_ENTRY_HEADER + p->u.option.d_len;
Helmut Tschemernjak 4:eb6850e3bc21 397 len += _GetFlashPaddingSize(len);
Helmut Tschemernjak 4:eb6850e3bc21 398
Helmut Tschemernjak 4:eb6850e3bc21 399 if ((uint8_t *)_lastEntry + len >= _endAddress) {
Helmut Tschemernjak 4:eb6850e3bc21 400 if (!_FlashReorgEntries(len)) {
Helmut Tschemernjak 4:eb6850e3bc21 401 err = NVProperty::NVP_ERR_NOSPACE;
Helmut Tschemernjak 4:eb6850e3bc21 402 goto done;
Helmut Tschemernjak 4:eb6850e3bc21 403 }
Helmut Tschemernjak 4:eb6850e3bc21 404 }
Helmut Tschemernjak 4:eb6850e3bc21 405
Helmut Tschemernjak 4:eb6850e3bc21 406 _FlashWrite((uint8_t *)_lastEntry, p, len);
Helmut Tschemernjak 4:eb6850e3bc21 407 _lastEntry = (_flashEntry *)((uint8_t *)_lastEntry + len);
Helmut Tschemernjak 4:eb6850e3bc21 408
Helmut Tschemernjak 4:eb6850e3bc21 409 done:
Helmut Tschemernjak 4:eb6850e3bc21 410 delete[] p;
Helmut Tschemernjak 4:eb6850e3bc21 411 // _DumpAllEntires();
Helmut Tschemernjak 4:eb6850e3bc21 412 return err;
Helmut Tschemernjak 4:eb6850e3bc21 413 }
Helmut Tschemernjak 4:eb6850e3bc21 414
Helmut Tschemernjak 4:eb6850e3bc21 415 int
Helmut Tschemernjak 4:eb6850e3bc21 416 NVProperty_MBEDFlash::SetPropertyBlob(int key, const void *blob, int size, int type)
Helmut Tschemernjak 4:eb6850e3bc21 417 {
Helmut Tschemernjak 4:eb6850e3bc21 418 if (type != NVProperty::T_BLOB)
Helmut Tschemernjak 4:eb6850e3bc21 419 return NVProperty::NVP_INVALD_PARM;
Helmut Tschemernjak 4:eb6850e3bc21 420
Helmut Tschemernjak 4:eb6850e3bc21 421 _flashEntry *p = _GetFlashEntry(key);
Helmut Tschemernjak 4:eb6850e3bc21 422 if (p && p->t.type == NVProperty::T_BLOB && size == p->u.option.d_len) { // check for duplicate
Helmut Tschemernjak 4:eb6850e3bc21 423 if (memcmp(blob, p->data.v_blob, size) == 0)
Helmut Tschemernjak 4:eb6850e3bc21 424 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 425 }
Helmut Tschemernjak 4:eb6850e3bc21 426 int err = NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 427
Helmut Tschemernjak 4:eb6850e3bc21 428 p = new _flashEntry();
Helmut Tschemernjak 4:eb6850e3bc21 429 if (!p)
Helmut Tschemernjak 4:eb6850e3bc21 430 return NVProperty::NVP_ERR_NOSPACE;
Helmut Tschemernjak 4:eb6850e3bc21 431
Helmut Tschemernjak 4:eb6850e3bc21 432 p->key = key;
Helmut Tschemernjak 4:eb6850e3bc21 433 p->t.type = NVProperty::T_BLOB;
Helmut Tschemernjak 4:eb6850e3bc21 434 int cplen = std::min(size, (int)sizeof(p->data.v_blob));
Helmut Tschemernjak 4:eb6850e3bc21 435 p->u.option.d_len = cplen;
Helmut Tschemernjak 4:eb6850e3bc21 436 memcpy(p->data.v_blob, blob, cplen);
Helmut Tschemernjak 4:eb6850e3bc21 437
Helmut Tschemernjak 5:2560e615ccd5 438 int len = FLASH_ENTRY_HEADER + p->u.option.d_len;
Helmut Tschemernjak 4:eb6850e3bc21 439 len += _GetFlashPaddingSize(len);
Helmut Tschemernjak 4:eb6850e3bc21 440
Helmut Tschemernjak 4:eb6850e3bc21 441 if ((uint8_t *)_lastEntry + len >= _endAddress) {
Helmut Tschemernjak 4:eb6850e3bc21 442 if (!_FlashReorgEntries(len)) {
Helmut Tschemernjak 4:eb6850e3bc21 443 err = NVProperty::NVP_ERR_NOSPACE;
Helmut Tschemernjak 4:eb6850e3bc21 444 goto done;
Helmut Tschemernjak 4:eb6850e3bc21 445 }
Helmut Tschemernjak 4:eb6850e3bc21 446 }
Helmut Tschemernjak 4:eb6850e3bc21 447
Helmut Tschemernjak 4:eb6850e3bc21 448 _FlashWrite((uint8_t *)_lastEntry, p, len);
Helmut Tschemernjak 4:eb6850e3bc21 449 _lastEntry = (_flashEntry *)((uint8_t *)_lastEntry + len);
Helmut Tschemernjak 4:eb6850e3bc21 450
Helmut Tschemernjak 4:eb6850e3bc21 451 done:
Helmut Tschemernjak 4:eb6850e3bc21 452 delete[] p;
Helmut Tschemernjak 4:eb6850e3bc21 453 // _DumpAllEntires();
Helmut Tschemernjak 4:eb6850e3bc21 454 return err;
Helmut Tschemernjak 4:eb6850e3bc21 455 }
Helmut Tschemernjak 4:eb6850e3bc21 456
Helmut Tschemernjak 4:eb6850e3bc21 457 int
Helmut Tschemernjak 4:eb6850e3bc21 458 NVProperty_MBEDFlash::EraseProperty(int key)
Helmut Tschemernjak 4:eb6850e3bc21 459 {
Helmut Tschemernjak 5:2560e615ccd5 460 uint8_t valbuf[16];
Helmut Tschemernjak 4:eb6850e3bc21 461 _flashEntry *p = (_flashEntry *) valbuf;
Helmut Tschemernjak 4:eb6850e3bc21 462
Helmut Tschemernjak 4:eb6850e3bc21 463 _flashEntry *op = _GetFlashEntry(key);
Helmut Tschemernjak 4:eb6850e3bc21 464 if (!op)
Helmut Tschemernjak 4:eb6850e3bc21 465 return NVProperty::NVP_ENOENT;
Helmut Tschemernjak 4:eb6850e3bc21 466 if (op->t.deleted)
Helmut Tschemernjak 4:eb6850e3bc21 467 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 468
Helmut Tschemernjak 4:eb6850e3bc21 469 memset(valbuf, 0, sizeof(valbuf));
Helmut Tschemernjak 4:eb6850e3bc21 470 p->key = key;
Helmut Tschemernjak 4:eb6850e3bc21 471 p->t.type = op->t.type;
Helmut Tschemernjak 4:eb6850e3bc21 472 p->t.deleted = true;
Helmut Tschemernjak 4:eb6850e3bc21 473
Helmut Tschemernjak 5:2560e615ccd5 474 int len = FLASH_ENTRY_HEADER_SHORT;
Helmut Tschemernjak 5:2560e615ccd5 475 len += _GetFlashPaddingSize(len);
Helmut Tschemernjak 5:2560e615ccd5 476
Helmut Tschemernjak 5:2560e615ccd5 477 if ((uint8_t *)_lastEntry + len > _endAddress) {
Helmut Tschemernjak 5:2560e615ccd5 478 if (!_FlashReorgEntries(len))
Helmut Tschemernjak 5:2560e615ccd5 479 return NVProperty::NVP_ERR_NOSPACE;
Helmut Tschemernjak 4:eb6850e3bc21 480 }
Helmut Tschemernjak 4:eb6850e3bc21 481
Helmut Tschemernjak 5:2560e615ccd5 482 _FlashWrite((uint8_t *)_lastEntry, p, len);
Helmut Tschemernjak 5:2560e615ccd5 483 _lastEntry = (_flashEntry *)((uint8_t *)_lastEntry + len);
Helmut Tschemernjak 4:eb6850e3bc21 484
Helmut Tschemernjak 4:eb6850e3bc21 485 // _DumpAllEntires();
Helmut Tschemernjak 4:eb6850e3bc21 486 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 487 }
Helmut Tschemernjak 4:eb6850e3bc21 488
Helmut Tschemernjak 4:eb6850e3bc21 489 int
Helmut Tschemernjak 4:eb6850e3bc21 490 NVProperty_MBEDFlash::ReorgProperties(void)
Helmut Tschemernjak 4:eb6850e3bc21 491 {
Helmut Tschemernjak 5:2560e615ccd5 492 if (_FlashReorgEntries(FLASH_ENTRY_HEADER))
Helmut Tschemernjak 4:eb6850e3bc21 493 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 494 return NVProperty::NVP_ERR_NOSPACE;
Helmut Tschemernjak 4:eb6850e3bc21 495 }
Helmut Tschemernjak 4:eb6850e3bc21 496
Helmut Tschemernjak 4:eb6850e3bc21 497
Helmut Tschemernjak 4:eb6850e3bc21 498 int
Helmut Tschemernjak 4:eb6850e3bc21 499 NVProperty_MBEDFlash::OpenPropertyStore(bool forWrite)
Helmut Tschemernjak 4:eb6850e3bc21 500 {
Helmut Tschemernjak 4:eb6850e3bc21 501 UNUSED(forWrite);
Helmut Tschemernjak 4:eb6850e3bc21 502 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 503 }
Helmut Tschemernjak 4:eb6850e3bc21 504
Helmut Tschemernjak 4:eb6850e3bc21 505 int
Helmut Tschemernjak 4:eb6850e3bc21 506 NVProperty_MBEDFlash::ClosePropertyStore(bool flush)
Helmut Tschemernjak 4:eb6850e3bc21 507 {
Helmut Tschemernjak 4:eb6850e3bc21 508 return NVProperty::NVP_OK;
Helmut Tschemernjak 4:eb6850e3bc21 509 }
Helmut Tschemernjak 4:eb6850e3bc21 510
Helmut Tschemernjak 4:eb6850e3bc21 511 #if 1
Helmut Tschemernjak 4:eb6850e3bc21 512 void
Helmut Tschemernjak 4:eb6850e3bc21 513 NVProperty_MBEDFlash::_DumpAllEntires(void)
Helmut Tschemernjak 4:eb6850e3bc21 514 {
Helmut Tschemernjak 4:eb6850e3bc21 515 if (!_debug)
Helmut Tschemernjak 4:eb6850e3bc21 516 return;
Helmut Tschemernjak 4:eb6850e3bc21 517
Helmut Tschemernjak 4:eb6850e3bc21 518 dprintf("------------- DumpAllEntires -------- ");
Helmut Tschemernjak 4:eb6850e3bc21 519
Helmut Tschemernjak 4:eb6850e3bc21 520 int index = 0;
Helmut Tschemernjak 4:eb6850e3bc21 521 _flashEntry *p = (_flashEntry *)(_startAddress + sizeof(_flash_header));
Helmut Tschemernjak 4:eb6850e3bc21 522 while((uint8_t *)p < _endAddress && p->key != NVProperty::PROPERTIES_EOF) {
Helmut Tschemernjak 4:eb6850e3bc21 523
Helmut Tschemernjak 4:eb6850e3bc21 524 int64_t value = 0;
Helmut Tschemernjak 4:eb6850e3bc21 525 switch(p->t.type) {
Helmut Tschemernjak 4:eb6850e3bc21 526 case NVProperty::T_BIT:
Helmut Tschemernjak 4:eb6850e3bc21 527 if (p->t.t_bit)
Helmut Tschemernjak 4:eb6850e3bc21 528 value = 1;
Helmut Tschemernjak 4:eb6850e3bc21 529 else
Helmut Tschemernjak 4:eb6850e3bc21 530 value = 0;
Helmut Tschemernjak 4:eb6850e3bc21 531 break;
Helmut Tschemernjak 4:eb6850e3bc21 532 case NVProperty::T_8BIT:
Helmut Tschemernjak 4:eb6850e3bc21 533 value = p->u.v_8bit;
Helmut Tschemernjak 4:eb6850e3bc21 534 break;
Helmut Tschemernjak 4:eb6850e3bc21 535 case NVProperty::T_16BIT:
Helmut Tschemernjak 4:eb6850e3bc21 536 {
Helmut Tschemernjak 4:eb6850e3bc21 537 int16_t v;
Helmut Tschemernjak 4:eb6850e3bc21 538 memcpy(&v, &p->u.v_16bit, sizeof(p->u.v_16bit));
Helmut Tschemernjak 4:eb6850e3bc21 539 value = v;
Helmut Tschemernjak 4:eb6850e3bc21 540 }
Helmut Tschemernjak 4:eb6850e3bc21 541 break;
Helmut Tschemernjak 4:eb6850e3bc21 542 case NVProperty::T_32BIT:
Helmut Tschemernjak 4:eb6850e3bc21 543 {
Helmut Tschemernjak 4:eb6850e3bc21 544 int32_t v;
Helmut Tschemernjak 4:eb6850e3bc21 545 memcpy(&v, &p->data.v_32bit, sizeof(p->data.v_32bit));
Helmut Tschemernjak 4:eb6850e3bc21 546 value = v;
Helmut Tschemernjak 4:eb6850e3bc21 547 }
Helmut Tschemernjak 4:eb6850e3bc21 548 break;
Helmut Tschemernjak 4:eb6850e3bc21 549 case NVProperty::T_64BIT:
Helmut Tschemernjak 4:eb6850e3bc21 550 memcpy(&value, p->data.v_64bit, sizeof(p->data.v_64bit));
Helmut Tschemernjak 4:eb6850e3bc21 551 break;
Helmut Tschemernjak 4:eb6850e3bc21 552 case NVProperty::T_STR:
Helmut Tschemernjak 4:eb6850e3bc21 553 case NVProperty::T_BLOB:
Helmut Tschemernjak 4:eb6850e3bc21 554 value = p->u.option.d_len;
Helmut Tschemernjak 4:eb6850e3bc21 555 break;
Helmut Tschemernjak 4:eb6850e3bc21 556 }
Helmut Tschemernjak 4:eb6850e3bc21 557 index++;
Helmut Tschemernjak 4:eb6850e3bc21 558 if (p->t.deleted) {
Helmut Tschemernjak 4:eb6850e3bc21 559 dprintf("Dump[%.2d] Key: %d Type: %d deleted(%d)", index, p->key, p->t.type, p->t.deleted);
Helmut Tschemernjak 4:eb6850e3bc21 560
Helmut Tschemernjak 4:eb6850e3bc21 561 } else if (p->t.type == NVProperty::T_STR) {
Helmut Tschemernjak 4:eb6850e3bc21 562 dprintf("Dump[%.2d] Key: %d Type: %d value: %s", index, p->key, p->t.type, p->data.v_str);
Helmut Tschemernjak 4:eb6850e3bc21 563 } else if (p->t.type == NVProperty::T_BLOB) {
Helmut Tschemernjak 4:eb6850e3bc21 564 dprintf("Dump[%.2d] Key: %d Type: %d len: %d", index, p->key, p->t.type, p->u.option.d_len);
Helmut Tschemernjak 4:eb6850e3bc21 565 dump("Blob", p->data.v_str, p->u.option.d_len);
Helmut Tschemernjak 4:eb6850e3bc21 566 } else {
Helmut Tschemernjak 4:eb6850e3bc21 567 if (p->t.type == NVProperty::T_64BIT) {
Helmut Tschemernjak 4:eb6850e3bc21 568 dprintf("Dump[%.2d] Key: %d Type: %d value: %lld (0x%llx)", index, p->key, p->t.type, value, value);
Helmut Tschemernjak 4:eb6850e3bc21 569 } else {
Helmut Tschemernjak 4:eb6850e3bc21 570 dprintf("Dump[%.2d] Key: %d Type: %d value: %ld (0x%x)", index, p->key, p->t.type, (int32_t)value, (unsigned int)value);
Helmut Tschemernjak 4:eb6850e3bc21 571 }
Helmut Tschemernjak 4:eb6850e3bc21 572 }
Helmut Tschemernjak 4:eb6850e3bc21 573
Helmut Tschemernjak 4:eb6850e3bc21 574 p = (_flashEntry *)((uint8_t *)p + _GetFlashEntryLen(p));
Helmut Tschemernjak 4:eb6850e3bc21 575 }
Helmut Tschemernjak 4:eb6850e3bc21 576 int freebytes = _endAddress -(uint8_t *)_lastEntry;
Helmut Tschemernjak 4:eb6850e3bc21 577 if (_lastEntry)
Helmut Tschemernjak 4:eb6850e3bc21 578 dprintf("------ %d bytes free -------", freebytes);
Helmut Tschemernjak 4:eb6850e3bc21 579 }
Helmut Tschemernjak 4:eb6850e3bc21 580 #endif
Helmut Tschemernjak 4:eb6850e3bc21 581
Helmut Tschemernjak 4:eb6850e3bc21 582 NVProperty_MBEDFlash::_flashEntry *
Helmut Tschemernjak 4:eb6850e3bc21 583 NVProperty_MBEDFlash::_GetFlashEntry(int key, uint8_t *start)
Helmut Tschemernjak 4:eb6850e3bc21 584 {
Helmut Tschemernjak 4:eb6850e3bc21 585 _flashEntry *p;
Helmut Tschemernjak 4:eb6850e3bc21 586
Helmut Tschemernjak 4:eb6850e3bc21 587 if (start)
Helmut Tschemernjak 4:eb6850e3bc21 588 p = (_flashEntry *)start;
Helmut Tschemernjak 4:eb6850e3bc21 589 else
Helmut Tschemernjak 4:eb6850e3bc21 590 p = (_flashEntry *)(_startAddress + sizeof(_flash_header));
Helmut Tschemernjak 4:eb6850e3bc21 591 _flashEntry *lastP = NULL;
Helmut Tschemernjak 4:eb6850e3bc21 592 while(true) {
Helmut Tschemernjak 4:eb6850e3bc21 593 if ((uint8_t*)p >= _endAddress || p->key == NVProperty::PROPERTIES_EOF) {
Helmut Tschemernjak 4:eb6850e3bc21 594 if ((uint8_t*)p <= _endAddress)
Helmut Tschemernjak 4:eb6850e3bc21 595 _lastEntry = p;
Helmut Tschemernjak 4:eb6850e3bc21 596 if (!lastP || lastP->t.deleted)
Helmut Tschemernjak 4:eb6850e3bc21 597 return NULL;
Helmut Tschemernjak 4:eb6850e3bc21 598 break;
Helmut Tschemernjak 4:eb6850e3bc21 599 }
Helmut Tschemernjak 4:eb6850e3bc21 600 if (p->key == key)
Helmut Tschemernjak 4:eb6850e3bc21 601 lastP = p;
Helmut Tschemernjak 4:eb6850e3bc21 602
Helmut Tschemernjak 4:eb6850e3bc21 603 p = (_flashEntry *)((uint8_t *)p + _GetFlashEntryLen(p));
Helmut Tschemernjak 4:eb6850e3bc21 604 }
Helmut Tschemernjak 4:eb6850e3bc21 605 return lastP;
Helmut Tschemernjak 4:eb6850e3bc21 606 }
Helmut Tschemernjak 4:eb6850e3bc21 607
Helmut Tschemernjak 4:eb6850e3bc21 608
Helmut Tschemernjak 4:eb6850e3bc21 609 int
Helmut Tschemernjak 4:eb6850e3bc21 610 NVProperty_MBEDFlash::_GetFlashEntryLen(_flashEntry *p)
Helmut Tschemernjak 4:eb6850e3bc21 611 {
Helmut Tschemernjak 4:eb6850e3bc21 612 int len = 0;
Helmut Tschemernjak 4:eb6850e3bc21 613
Helmut Tschemernjak 5:2560e615ccd5 614 if (p->t.type == NVProperty::T_BIT || p->t.deleted)
Helmut Tschemernjak 5:2560e615ccd5 615 len = FLASH_ENTRY_HEADER_SHORT;
Helmut Tschemernjak 5:2560e615ccd5 616 else if (p->t.type == NVProperty::T_8BIT || p->t.type == NVProperty::T_16BIT)
Helmut Tschemernjak 5:2560e615ccd5 617 len = FLASH_ENTRY_HEADER;
Helmut Tschemernjak 5:2560e615ccd5 618 else
Helmut Tschemernjak 5:2560e615ccd5 619 len = FLASH_ENTRY_HEADER + p->u.option.d_len;
Helmut Tschemernjak 5:2560e615ccd5 620
Helmut Tschemernjak 5:2560e615ccd5 621 len += _GetFlashPaddingSize(len);
Helmut Tschemernjak 5:2560e615ccd5 622
Helmut Tschemernjak 4:eb6850e3bc21 623 return len;
Helmut Tschemernjak 4:eb6850e3bc21 624 }
Helmut Tschemernjak 4:eb6850e3bc21 625
Helmut Tschemernjak 4:eb6850e3bc21 626 int
Helmut Tschemernjak 4:eb6850e3bc21 627 NVProperty_MBEDFlash::_GetFlashPaddingSize(int len)
Helmut Tschemernjak 4:eb6850e3bc21 628 {
Helmut Tschemernjak 5:2560e615ccd5 629 int remain = len % _pageSize;
Helmut Tschemernjak 4:eb6850e3bc21 630
Helmut Tschemernjak 4:eb6850e3bc21 631 if (remain == 0)
Helmut Tschemernjak 4:eb6850e3bc21 632 return 0;
Helmut Tschemernjak 4:eb6850e3bc21 633
Helmut Tschemernjak 5:2560e615ccd5 634 return (len + _pageSize - remain) - len;
Helmut Tschemernjak 4:eb6850e3bc21 635 }
Helmut Tschemernjak 4:eb6850e3bc21 636
Helmut Tschemernjak 4:eb6850e3bc21 637
Helmut Tschemernjak 4:eb6850e3bc21 638 int
Helmut Tschemernjak 4:eb6850e3bc21 639 NVProperty_MBEDFlash::_FlashReorgEntries(int minRequiredSpace)
Helmut Tschemernjak 4:eb6850e3bc21 640 {
Helmut Tschemernjak 4:eb6850e3bc21 641 if (_debug) {
Helmut Tschemernjak 4:eb6850e3bc21 642 dprintf("_FlashReorgEntries: start");
Helmut Tschemernjak 4:eb6850e3bc21 643 // _DumpAllEntires();
Helmut Tschemernjak 4:eb6850e3bc21 644 }
Helmut Tschemernjak 4:eb6850e3bc21 645
Helmut Tschemernjak 4:eb6850e3bc21 646 int totalLen = 0;
Helmut Tschemernjak 4:eb6850e3bc21 647 int freeSpace = 0;
Helmut Tschemernjak 4:eb6850e3bc21 648
Helmut Tschemernjak 4:eb6850e3bc21 649 _flashEntry *p = (_flashEntry *)(_startAddress + sizeof(_flash_header));
Helmut Tschemernjak 4:eb6850e3bc21 650 while((uint8_t *)p < _endAddress && p->key != NVProperty::PROPERTIES_EOF) {
Helmut Tschemernjak 4:eb6850e3bc21 651 _flashEntry *k = _GetFlashEntry(p->key);
Helmut Tschemernjak 4:eb6850e3bc21 652 if (k == p) { // current entry is the lastest one.
Helmut Tschemernjak 4:eb6850e3bc21 653 totalLen += _GetFlashEntryLen(k);
Helmut Tschemernjak 4:eb6850e3bc21 654 }
Helmut Tschemernjak 4:eb6850e3bc21 655 p = (_flashEntry *)((uint8_t *)p + _GetFlashEntryLen(p));
Helmut Tschemernjak 4:eb6850e3bc21 656 }
Helmut Tschemernjak 4:eb6850e3bc21 657
Helmut Tschemernjak 4:eb6850e3bc21 658 if (_startAddress + sizeof(_flash_header) + totalLen + minRequiredSpace >= _endAddress)
Helmut Tschemernjak 4:eb6850e3bc21 659 return 0;
Helmut Tschemernjak 4:eb6850e3bc21 660
Helmut Tschemernjak 4:eb6850e3bc21 661 freeSpace = _endAddress - (_startAddress + sizeof(_flash_header) + totalLen);
Helmut Tschemernjak 4:eb6850e3bc21 662 if (_debug)
Helmut Tschemernjak 4:eb6850e3bc21 663 dprintf("freeSpace: %d, totalLen: %d", freeSpace, totalLen);
Helmut Tschemernjak 4:eb6850e3bc21 664
Helmut Tschemernjak 4:eb6850e3bc21 665 /*
Helmut Tschemernjak 4:eb6850e3bc21 666 * Copy header
Helmut Tschemernjak 4:eb6850e3bc21 667 * while (content {
Helmut Tschemernjak 4:eb6850e3bc21 668 * - scan until tmp page is full
Helmut Tschemernjak 4:eb6850e3bc21 669 * - write page
Helmut Tschemernjak 4:eb6850e3bc21 670 * }
Helmut Tschemernjak 4:eb6850e3bc21 671 * Erase remaining pages.
Helmut Tschemernjak 4:eb6850e3bc21 672 *
Helmut Tschemernjak 4:eb6850e3bc21 673 */
Helmut Tschemernjak 4:eb6850e3bc21 674
Helmut Tschemernjak 4:eb6850e3bc21 675 p = (_flashEntry *)(_startAddress + sizeof(_flash_header));
Helmut Tschemernjak 4:eb6850e3bc21 676 uint8_t *saveddata = new uint8_t[_rowSize+sizeof(struct _flashEntry)];
Helmut Tschemernjak 4:eb6850e3bc21 677 if (!saveddata)
Helmut Tschemernjak 4:eb6850e3bc21 678 return 0;
Helmut Tschemernjak 4:eb6850e3bc21 679 uint8_t *t = saveddata;
Helmut Tschemernjak 4:eb6850e3bc21 680 int currentRow = (uint32_t)_startAddress / _rowSize;
Helmut Tschemernjak 4:eb6850e3bc21 681 int totalCopied = 0;
Helmut Tschemernjak 4:eb6850e3bc21 682
Helmut Tschemernjak 4:eb6850e3bc21 683 t = saveddata;
Helmut Tschemernjak 4:eb6850e3bc21 684 memcpy(t, _startAddress, sizeof(_flash_header));
Helmut Tschemernjak 4:eb6850e3bc21 685 t += sizeof(_flash_header);
Helmut Tschemernjak 4:eb6850e3bc21 686
Helmut Tschemernjak 4:eb6850e3bc21 687 while((uint8_t *)p < _endAddress && p->key != NVProperty::PROPERTIES_EOF) {
Helmut Tschemernjak 4:eb6850e3bc21 688 _flashEntry *k = _GetFlashEntry(p->key, (uint8_t *)p);
Helmut Tschemernjak 4:eb6850e3bc21 689 if (k == p) { // current entry is the lastest one.
Helmut Tschemernjak 4:eb6850e3bc21 690 if (!p->t.deleted) {
Helmut Tschemernjak 4:eb6850e3bc21 691 int plen = _GetFlashEntryLen(p);
Helmut Tschemernjak 4:eb6850e3bc21 692 memcpy(t, p, plen);
Helmut Tschemernjak 4:eb6850e3bc21 693 t += plen;
Helmut Tschemernjak 4:eb6850e3bc21 694 totalCopied += plen;
Helmut Tschemernjak 4:eb6850e3bc21 695 if (t - saveddata >= _rowSize) { // copy page
Helmut Tschemernjak 4:eb6850e3bc21 696 _FlashEraseRow(currentRow);
Helmut Tschemernjak 4:eb6850e3bc21 697 _FlashWrite((uint8_t *)(currentRow++ * _rowSize), saveddata, _rowSize);
Helmut Tschemernjak 4:eb6850e3bc21 698 int remainLen = (t - saveddata) - _rowSize;
Helmut Tschemernjak 4:eb6850e3bc21 699 if (remainLen) {
Helmut Tschemernjak 4:eb6850e3bc21 700 memcpy(saveddata, t - remainLen, remainLen);
Helmut Tschemernjak 4:eb6850e3bc21 701 }
Helmut Tschemernjak 4:eb6850e3bc21 702 t = saveddata + remainLen;
Helmut Tschemernjak 4:eb6850e3bc21 703 }
Helmut Tschemernjak 4:eb6850e3bc21 704 }
Helmut Tschemernjak 4:eb6850e3bc21 705 }
Helmut Tschemernjak 4:eb6850e3bc21 706 p = (_flashEntry *)((uint8_t *)p + _GetFlashEntryLen(p));
Helmut Tschemernjak 4:eb6850e3bc21 707 }
Helmut Tschemernjak 4:eb6850e3bc21 708
Helmut Tschemernjak 4:eb6850e3bc21 709 if (t > saveddata) { // copy remaining
Helmut Tschemernjak 4:eb6850e3bc21 710 _FlashEraseRow(currentRow);
Helmut Tschemernjak 4:eb6850e3bc21 711 _FlashWrite((uint8_t *)(currentRow++ * _rowSize), saveddata, t - saveddata);
Helmut Tschemernjak 4:eb6850e3bc21 712 }
Helmut Tschemernjak 4:eb6850e3bc21 713
Helmut Tschemernjak 4:eb6850e3bc21 714 while((uint32_t)0 + currentRow * _rowSize < (uint32_t)_endAddress) {
Helmut Tschemernjak 4:eb6850e3bc21 715 _FlashEraseRow(currentRow++);
Helmut Tschemernjak 4:eb6850e3bc21 716 }
Helmut Tschemernjak 4:eb6850e3bc21 717 delete[] saveddata;
Helmut Tschemernjak 4:eb6850e3bc21 718 _GetFlashEntry(0); // inits the _lastEntry record
Helmut Tschemernjak 4:eb6850e3bc21 719
Helmut Tschemernjak 4:eb6850e3bc21 720 if (_debug) {
Helmut Tschemernjak 4:eb6850e3bc21 721 dprintf("_FlashReorgEntries: end");
Helmut Tschemernjak 4:eb6850e3bc21 722 _DumpAllEntires();
Helmut Tschemernjak 4:eb6850e3bc21 723 }
Helmut Tschemernjak 4:eb6850e3bc21 724
Helmut Tschemernjak 4:eb6850e3bc21 725 return _endAddress - _startAddress - (sizeof(_flash_header) + totalCopied);
Helmut Tschemernjak 4:eb6850e3bc21 726 }
Helmut Tschemernjak 4:eb6850e3bc21 727
Helmut Tschemernjak 4:eb6850e3bc21 728
Helmut Tschemernjak 4:eb6850e3bc21 729 #endif // __MBED__