Helmut Tschemernjak / NVProperty

NVProperty generic key value store using the MCU flash area.

Dependents:   Turtle_RadioShuttle

NVProperty_MBEDFlash.cpp@12:5539cdc8be4b, 2019-02-10 (annotated)

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