Helmut Tschemernjak / NVProperty

NVProperty generic key value store using the MCU flash area.

Dependents:   Turtle_RadioShuttle

NVProperty_MBEDFlash.cpp@13:2436a800c0fa, 2019-02-10 (annotated)

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