nvs_page.cpp 32 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126
  1. /*
  2. * SPDX-FileCopyrightText: 2015-2022 Espressif Systems (Shanghai) CO LTD
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. #include "nvs_page.hpp"
  7. #include <esp_rom_crc.h>
  8. #include <cstdio>
  9. #include <cstring>
  10. #include "nvs_internal.h"
  11. namespace nvs
  12. {
  13. Page::Page() : mPartition(nullptr) { }
  14. uint32_t Page::Header::calculateCrc32()
  15. {
  16. return esp_rom_crc32_le(0xffffffff,
  17. reinterpret_cast<uint8_t*>(this) + offsetof(Header, mSeqNumber),
  18. offsetof(Header, mCrc32) - offsetof(Header, mSeqNumber));
  19. }
  20. esp_err_t Page::load(Partition *partition, uint32_t sectorNumber)
  21. {
  22. if (partition == nullptr) {
  23. return ESP_ERR_INVALID_ARG;
  24. }
  25. mPartition = partition;
  26. mBaseAddress = sectorNumber * SEC_SIZE;
  27. mUsedEntryCount = 0;
  28. mErasedEntryCount = 0;
  29. Header header;
  30. auto rc = mPartition->read_raw(mBaseAddress, &header, sizeof(header));
  31. if (rc != ESP_OK) {
  32. mState = PageState::INVALID;
  33. return rc;
  34. }
  35. if (header.mState == PageState::UNINITIALIZED) {
  36. mState = header.mState;
  37. // check if the whole page is really empty
  38. // reading the whole page takes ~40 times less than erasing it
  39. const int BLOCK_SIZE = 128;
  40. uint32_t* block = new (std::nothrow) uint32_t[BLOCK_SIZE];
  41. if (!block) return ESP_ERR_NO_MEM;
  42. for (uint32_t i = 0; i < SPI_FLASH_SEC_SIZE; i += 4 * BLOCK_SIZE) {
  43. rc = mPartition->read_raw(mBaseAddress + i, block, 4 * BLOCK_SIZE);
  44. if (rc != ESP_OK) {
  45. mState = PageState::INVALID;
  46. delete[] block;
  47. return rc;
  48. }
  49. if (std::any_of(block, block + BLOCK_SIZE, [](uint32_t val) -> bool { return val != 0xffffffff; })) {
  50. // page isn't as empty after all, mark it as corrupted
  51. mState = PageState::CORRUPT;
  52. break;
  53. }
  54. }
  55. delete[] block;
  56. } else if (header.mCrc32 != header.calculateCrc32()) {
  57. header.mState = PageState::CORRUPT;
  58. } else {
  59. mState = header.mState;
  60. mSeqNumber = header.mSeqNumber;
  61. if(header.mVersion < NVS_VERSION) {
  62. return ESP_ERR_NVS_NEW_VERSION_FOUND;
  63. } else {
  64. mVersion = header.mVersion;
  65. }
  66. }
  67. switch (mState) {
  68. case PageState::UNINITIALIZED:
  69. break;
  70. case PageState::FULL:
  71. case PageState::ACTIVE:
  72. case PageState::FREEING:
  73. return mLoadEntryTable();
  74. break;
  75. default:
  76. mState = PageState::CORRUPT;
  77. break;
  78. }
  79. return ESP_OK;
  80. }
  81. esp_err_t Page::writeEntry(const Item& item)
  82. {
  83. uint32_t phyAddr;
  84. esp_err_t err = getEntryAddress(mNextFreeEntry, &phyAddr);
  85. if (err != ESP_OK) {
  86. return err;
  87. }
  88. err = mPartition->write(phyAddr, &item, sizeof(item));
  89. if (err != ESP_OK) {
  90. mState = PageState::INVALID;
  91. return err;
  92. }
  93. err = alterEntryState(mNextFreeEntry, EntryState::WRITTEN);
  94. if (err != ESP_OK) {
  95. return err;
  96. }
  97. if (mFirstUsedEntry == INVALID_ENTRY) {
  98. mFirstUsedEntry = mNextFreeEntry;
  99. }
  100. ++mUsedEntryCount;
  101. ++mNextFreeEntry;
  102. return ESP_OK;
  103. }
  104. esp_err_t Page::writeEntryData(const uint8_t* data, size_t size)
  105. {
  106. NVS_ASSERT_OR_RETURN(size % ENTRY_SIZE == 0, ESP_FAIL);
  107. NVS_ASSERT_OR_RETURN(mNextFreeEntry != INVALID_ENTRY, ESP_FAIL);
  108. NVS_ASSERT_OR_RETURN(mFirstUsedEntry != INVALID_ENTRY, ESP_FAIL);
  109. const uint16_t count = size / ENTRY_SIZE;
  110. uint32_t phyAddr;
  111. esp_err_t rc = getEntryAddress(mNextFreeEntry, &phyAddr);
  112. if (rc == ESP_OK) {
  113. rc = mPartition->write(phyAddr, data, size);
  114. }
  115. if (rc != ESP_OK) {
  116. mState = PageState::INVALID;
  117. return rc;
  118. }
  119. auto err = alterEntryRangeState(mNextFreeEntry, mNextFreeEntry + count, EntryState::WRITTEN);
  120. if (err != ESP_OK) {
  121. return err;
  122. }
  123. mUsedEntryCount += count;
  124. mNextFreeEntry += count;
  125. return ESP_OK;
  126. }
  127. esp_err_t Page::writeItem(uint8_t nsIndex, ItemType datatype, const char* key, const void* data, size_t dataSize, uint8_t chunkIdx)
  128. {
  129. Item item;
  130. esp_err_t err;
  131. if (mState == PageState::INVALID) {
  132. return ESP_ERR_NVS_INVALID_STATE;
  133. }
  134. if (mState == PageState::UNINITIALIZED) {
  135. err = initialize();
  136. if (err != ESP_OK) {
  137. return err;
  138. }
  139. }
  140. if (mState == PageState::FULL) {
  141. return ESP_ERR_NVS_PAGE_FULL;
  142. }
  143. const size_t keySize = strlen(key);
  144. if (keySize > Item::MAX_KEY_LENGTH) {
  145. return ESP_ERR_NVS_KEY_TOO_LONG;
  146. }
  147. if (dataSize > Page::CHUNK_MAX_SIZE) {
  148. return ESP_ERR_NVS_VALUE_TOO_LONG;
  149. }
  150. if ((!isVariableLengthType(datatype)) && dataSize > 8) {
  151. return ESP_ERR_INVALID_ARG;
  152. }
  153. size_t totalSize = ENTRY_SIZE;
  154. size_t entriesCount = 1;
  155. if (isVariableLengthType(datatype)) {
  156. size_t roundedSize = (dataSize + ENTRY_SIZE - 1) & ~(ENTRY_SIZE - 1);
  157. totalSize += roundedSize;
  158. entriesCount += roundedSize / ENTRY_SIZE;
  159. }
  160. // primitive types should fit into one entry
  161. NVS_ASSERT_OR_RETURN(totalSize == ENTRY_SIZE ||
  162. isVariableLengthType(datatype), ESP_ERR_NVS_VALUE_TOO_LONG);
  163. if (mNextFreeEntry == INVALID_ENTRY || mNextFreeEntry + entriesCount > ENTRY_COUNT) {
  164. // page will not fit this amount of data
  165. return ESP_ERR_NVS_PAGE_FULL;
  166. }
  167. // write first item
  168. size_t span = (totalSize + ENTRY_SIZE - 1) / ENTRY_SIZE;
  169. item = Item(nsIndex, datatype, span, key, chunkIdx);
  170. err = mHashList.insert(item, mNextFreeEntry);
  171. if (err != ESP_OK) {
  172. return err;
  173. }
  174. if (!isVariableLengthType(datatype)) {
  175. memcpy(item.data, data, dataSize);
  176. item.crc32 = item.calculateCrc32();
  177. err = writeEntry(item);
  178. if (err != ESP_OK) {
  179. return err;
  180. }
  181. } else {
  182. const uint8_t* src = reinterpret_cast<const uint8_t*>(data);
  183. item.varLength.dataCrc32 = Item::calculateCrc32(src, dataSize);
  184. item.varLength.dataSize = dataSize;
  185. item.varLength.reserved = 0xffff;
  186. item.crc32 = item.calculateCrc32();
  187. err = writeEntry(item);
  188. if (err != ESP_OK) {
  189. return err;
  190. }
  191. size_t rest = dataSize % ENTRY_SIZE;
  192. size_t left = dataSize - rest;
  193. if (left > 0) {
  194. err = writeEntryData(static_cast<const uint8_t*>(data), left);
  195. if (err != ESP_OK) {
  196. return err;
  197. }
  198. }
  199. size_t tail = rest;
  200. if (tail > 0) {
  201. std::fill_n(item.rawData, ENTRY_SIZE, 0xff);
  202. memcpy(item.rawData, static_cast<const uint8_t*>(data) + left, tail);
  203. err = writeEntry(item);
  204. if (err != ESP_OK) {
  205. return err;
  206. }
  207. }
  208. }
  209. return ESP_OK;
  210. }
  211. esp_err_t Page::readItem(uint8_t nsIndex, ItemType datatype, const char* key, void* data, size_t dataSize, uint8_t chunkIdx, VerOffset chunkStart)
  212. {
  213. size_t index = 0;
  214. Item item;
  215. if (mState == PageState::INVALID) {
  216. return ESP_ERR_NVS_INVALID_STATE;
  217. }
  218. esp_err_t rc = findItem(nsIndex, datatype, key, index, item, chunkIdx, chunkStart);
  219. if (rc != ESP_OK) {
  220. return rc;
  221. }
  222. if (!isVariableLengthType(datatype)) {
  223. if (dataSize != getAlignmentForType(datatype)) {
  224. return ESP_ERR_NVS_TYPE_MISMATCH;
  225. }
  226. memcpy(data, item.data, dataSize);
  227. return ESP_OK;
  228. }
  229. if (dataSize < static_cast<size_t>(item.varLength.dataSize)) {
  230. return ESP_ERR_NVS_INVALID_LENGTH;
  231. }
  232. uint8_t* dst = reinterpret_cast<uint8_t*>(data);
  233. size_t left = item.varLength.dataSize;
  234. for (size_t i = index + 1; i < index + item.span; ++i) {
  235. Item ditem;
  236. rc = readEntry(i, ditem);
  237. if (rc != ESP_OK) {
  238. return rc;
  239. }
  240. size_t willCopy = ENTRY_SIZE;
  241. willCopy = (left < willCopy)?left:willCopy;
  242. memcpy(dst, ditem.rawData, willCopy);
  243. left -= willCopy;
  244. dst += willCopy;
  245. }
  246. if (Item::calculateCrc32(reinterpret_cast<uint8_t*>(data), item.varLength.dataSize) != item.varLength.dataCrc32) {
  247. rc = eraseEntryAndSpan(index);
  248. if (rc != ESP_OK) {
  249. return rc;
  250. }
  251. return ESP_ERR_NVS_NOT_FOUND;
  252. }
  253. return ESP_OK;
  254. }
  255. esp_err_t Page::cmpItem(uint8_t nsIndex, ItemType datatype, const char* key, const void* data, size_t dataSize, uint8_t chunkIdx, VerOffset chunkStart)
  256. {
  257. size_t index = 0;
  258. Item item;
  259. if (mState == PageState::INVALID) {
  260. return ESP_ERR_NVS_INVALID_STATE;
  261. }
  262. esp_err_t rc = findItem(nsIndex, datatype, key, index, item, chunkIdx, chunkStart);
  263. if (rc != ESP_OK) {
  264. return rc;
  265. }
  266. if (!isVariableLengthType(datatype)) {
  267. if (dataSize != getAlignmentForType(datatype)) {
  268. return ESP_ERR_NVS_TYPE_MISMATCH;
  269. }
  270. if (memcmp(data, item.data, dataSize)) {
  271. return ESP_ERR_NVS_CONTENT_DIFFERS;
  272. }
  273. return ESP_OK;
  274. }
  275. if (dataSize < static_cast<size_t>(item.varLength.dataSize)) {
  276. return ESP_ERR_NVS_INVALID_LENGTH;
  277. }
  278. const uint8_t* dst = reinterpret_cast<const uint8_t*>(data);
  279. size_t left = item.varLength.dataSize;
  280. for (size_t i = index + 1; i < index + item.span; ++i) {
  281. Item ditem;
  282. rc = readEntry(i, ditem);
  283. if (rc != ESP_OK) {
  284. return rc;
  285. }
  286. size_t willCopy = ENTRY_SIZE;
  287. willCopy = (left < willCopy)?left:willCopy;
  288. if (memcmp(dst, ditem.rawData, willCopy)) {
  289. return ESP_ERR_NVS_CONTENT_DIFFERS;
  290. }
  291. left -= willCopy;
  292. dst += willCopy;
  293. }
  294. if (Item::calculateCrc32(reinterpret_cast<const uint8_t*>(data), item.varLength.dataSize) != item.varLength.dataCrc32) {
  295. return ESP_ERR_NVS_NOT_FOUND;
  296. }
  297. return ESP_OK;
  298. }
  299. esp_err_t Page::eraseItem(uint8_t nsIndex, ItemType datatype, const char* key, uint8_t chunkIdx, VerOffset chunkStart)
  300. {
  301. size_t index = 0;
  302. Item item;
  303. esp_err_t rc = findItem(nsIndex, datatype, key, index, item, chunkIdx, chunkStart);
  304. if (rc != ESP_OK) {
  305. return rc;
  306. }
  307. return eraseEntryAndSpan(index);
  308. }
  309. esp_err_t Page::findItem(uint8_t nsIndex, ItemType datatype, const char* key, uint8_t chunkIdx, VerOffset chunkStart)
  310. {
  311. size_t index = 0;
  312. Item item;
  313. return findItem(nsIndex, datatype, key, index, item, chunkIdx, chunkStart);
  314. }
  315. esp_err_t Page::eraseEntryAndSpan(size_t index)
  316. {
  317. uint32_t seq_num;
  318. getSeqNumber(seq_num);
  319. EntryState state;
  320. esp_err_t err = mEntryTable.get(index, &state);
  321. if (err != ESP_OK) {
  322. return err;
  323. }
  324. size_t span = 1;
  325. if (state == EntryState::WRITTEN) {
  326. Item item;
  327. auto rc = readEntry(index, item);
  328. if (rc != ESP_OK) {
  329. return rc;
  330. }
  331. if (item.calculateCrc32() != item.crc32) {
  332. mHashList.erase(index);
  333. rc = alterEntryState(index, EntryState::ERASED);
  334. --mUsedEntryCount;
  335. ++mErasedEntryCount;
  336. if (rc != ESP_OK) {
  337. return rc;
  338. }
  339. } else {
  340. mHashList.erase(index);
  341. span = item.span;
  342. for (ptrdiff_t i = index + span - 1; i >= static_cast<ptrdiff_t>(index); --i) {
  343. rc = mEntryTable.get(i, &state);
  344. if (rc != ESP_OK) {
  345. return rc;
  346. }
  347. if (state == EntryState::WRITTEN) {
  348. --mUsedEntryCount;
  349. }
  350. ++mErasedEntryCount;
  351. }
  352. if (span == 1) {
  353. rc = alterEntryState(index, EntryState::ERASED);
  354. } else {
  355. rc = alterEntryRangeState(index, index + span, EntryState::ERASED);
  356. }
  357. if (rc != ESP_OK) {
  358. return rc;
  359. }
  360. }
  361. } else {
  362. auto rc = alterEntryState(index, EntryState::ERASED);
  363. if (rc != ESP_OK) {
  364. return rc;
  365. }
  366. }
  367. if (index == mFirstUsedEntry) {
  368. auto rc = updateFirstUsedEntry(index, span);
  369. if (rc != ESP_OK) {
  370. return rc;
  371. }
  372. }
  373. if (index + span > mNextFreeEntry) {
  374. mNextFreeEntry = index + span;
  375. }
  376. return ESP_OK;
  377. }
  378. esp_err_t Page::updateFirstUsedEntry(size_t index, size_t span)
  379. {
  380. NVS_ASSERT_OR_RETURN(index == mFirstUsedEntry, ESP_FAIL);
  381. mFirstUsedEntry = INVALID_ENTRY;
  382. size_t end = mNextFreeEntry;
  383. EntryState state;
  384. esp_err_t err;
  385. if (end > ENTRY_COUNT) {
  386. end = ENTRY_COUNT;
  387. }
  388. for (size_t i = index + span; i < end; ++i) {
  389. err = mEntryTable.get(i, &state);
  390. if (err != ESP_OK) {
  391. return err;
  392. }
  393. if (state == EntryState::WRITTEN) {
  394. mFirstUsedEntry = i;
  395. break;
  396. }
  397. }
  398. return ESP_OK;
  399. }
  400. esp_err_t Page::copyItems(Page& other)
  401. {
  402. if (mFirstUsedEntry == INVALID_ENTRY) {
  403. return ESP_ERR_NVS_NOT_FOUND;
  404. }
  405. if (other.mState == PageState::UNINITIALIZED) {
  406. auto err = other.initialize();
  407. if (err != ESP_OK) {
  408. return err;
  409. }
  410. }
  411. Item entry;
  412. size_t readEntryIndex = mFirstUsedEntry;
  413. EntryState state;
  414. esp_err_t err;
  415. while (readEntryIndex < ENTRY_COUNT) {
  416. err = mEntryTable.get(readEntryIndex, &state);
  417. if (err != ESP_OK) {
  418. return err;
  419. }
  420. if (state != EntryState::WRITTEN) {
  421. NVS_ASSERT_OR_RETURN(readEntryIndex != mFirstUsedEntry, ESP_FAIL);
  422. readEntryIndex++;
  423. continue;
  424. }
  425. err = readEntry(readEntryIndex, entry);
  426. if (err != ESP_OK) {
  427. return err;
  428. }
  429. err = other.mHashList.insert(entry, other.mNextFreeEntry);
  430. if (err != ESP_OK) {
  431. return err;
  432. }
  433. err = other.writeEntry(entry);
  434. if (err != ESP_OK) {
  435. return err;
  436. }
  437. size_t span = entry.span;
  438. size_t end = readEntryIndex + span;
  439. NVS_ASSERT_OR_RETURN(end <= ENTRY_COUNT, ESP_FAIL);
  440. for (size_t i = readEntryIndex + 1; i < end; ++i) {
  441. readEntry(i, entry);
  442. err = other.writeEntry(entry);
  443. if (err != ESP_OK) {
  444. return err;
  445. }
  446. }
  447. readEntryIndex = end;
  448. }
  449. return ESP_OK;
  450. }
  451. esp_err_t Page::mLoadEntryTable()
  452. {
  453. // for states where we actually care about data in the page, read entry state table
  454. if (mState == PageState::ACTIVE ||
  455. mState == PageState::FULL ||
  456. mState == PageState::FREEING) {
  457. auto rc = mPartition->read_raw(mBaseAddress + ENTRY_TABLE_OFFSET, mEntryTable.data(),
  458. mEntryTable.byteSize());
  459. if (rc != ESP_OK) {
  460. mState = PageState::INVALID;
  461. return rc;
  462. }
  463. }
  464. EntryState state;
  465. esp_err_t err;
  466. mErasedEntryCount = 0;
  467. mUsedEntryCount = 0;
  468. for (size_t i = 0; i < ENTRY_COUNT; ++i) {
  469. err = mEntryTable.get(i, &state);
  470. if (err != ESP_OK) {
  471. return err;
  472. }
  473. if (state == EntryState::WRITTEN) {
  474. if (mFirstUsedEntry == INVALID_ENTRY) {
  475. mFirstUsedEntry = i;
  476. }
  477. ++mUsedEntryCount;
  478. } else if (state == EntryState::ERASED) {
  479. ++mErasedEntryCount;
  480. }
  481. }
  482. // for PageState::ACTIVE, we may have more data written to this page
  483. // as such, we need to figure out where the first unused entry is
  484. if (mState == PageState::ACTIVE) {
  485. for (size_t i = 0; i < ENTRY_COUNT; ++i) {
  486. err = mEntryTable.get(i, &state);
  487. if (err != ESP_OK) {
  488. return err;
  489. }
  490. if (state == EntryState::EMPTY) {
  491. mNextFreeEntry = i;
  492. break;
  493. }
  494. }
  495. // however, if power failed after some data was written into the entry.
  496. // but before the entry state table was altered, the entry locacted via
  497. // entry state table may actually be half-written.
  498. // this is easy to check by reading EntryHeader (i.e. first word)
  499. while (mNextFreeEntry < ENTRY_COUNT) {
  500. uint32_t entryAddress;
  501. err = getEntryAddress(mNextFreeEntry, &entryAddress);
  502. if (err != ESP_OK) {
  503. return err;
  504. }
  505. uint32_t header;
  506. auto rc = mPartition->read_raw(entryAddress, &header, sizeof(header));
  507. if (rc != ESP_OK) {
  508. mState = PageState::INVALID;
  509. return rc;
  510. }
  511. if (header != 0xffffffff) {
  512. auto oldState = state;
  513. rc = mEntryTable.get(mNextFreeEntry, &oldState);
  514. if (rc != ESP_OK) {
  515. return rc;
  516. }
  517. err = alterEntryState(mNextFreeEntry, EntryState::ERASED);
  518. if (err != ESP_OK) {
  519. mState = PageState::INVALID;
  520. return err;
  521. }
  522. ++mNextFreeEntry;
  523. if (oldState == EntryState::WRITTEN) {
  524. --mUsedEntryCount;
  525. }
  526. ++mErasedEntryCount;
  527. }
  528. else {
  529. break;
  530. }
  531. }
  532. // check that all variable-length items are written or erased fully
  533. Item item;
  534. size_t lastItemIndex = INVALID_ENTRY;
  535. size_t end = mNextFreeEntry;
  536. if (end > ENTRY_COUNT) {
  537. end = ENTRY_COUNT;
  538. }
  539. size_t span;
  540. for (size_t i = 0; i < end; i += span) {
  541. span = 1;
  542. err = mEntryTable.get(i, &state);
  543. if (err != ESP_OK) {
  544. return err;
  545. }
  546. if (state == EntryState::ERASED) {
  547. lastItemIndex = INVALID_ENTRY;
  548. continue;
  549. }
  550. if (state == EntryState::ILLEGAL) {
  551. lastItemIndex = INVALID_ENTRY;
  552. auto err = eraseEntryAndSpan(i);
  553. if (err != ESP_OK) {
  554. mState = PageState::INVALID;
  555. return err;
  556. }
  557. continue;
  558. }
  559. lastItemIndex = i;
  560. auto err = readEntry(i, item);
  561. if (err != ESP_OK) {
  562. mState = PageState::INVALID;
  563. return err;
  564. }
  565. if (item.crc32 != item.calculateCrc32()) {
  566. err = eraseEntryAndSpan(i);
  567. if (err != ESP_OK) {
  568. mState = PageState::INVALID;
  569. return err;
  570. }
  571. continue;
  572. }
  573. err = mHashList.insert(item, i);
  574. if (err != ESP_OK) {
  575. mState = PageState::INVALID;
  576. return err;
  577. }
  578. // search for potential duplicate item
  579. size_t duplicateIndex = mHashList.find(0, item);
  580. if (isVariableLengthType(item.datatype)) {
  581. span = item.span;
  582. bool needErase = false;
  583. for (size_t j = i; j < i + span; ++j) {
  584. err = mEntryTable.get(j, &state);
  585. if (err != ESP_OK) {
  586. return err;
  587. }
  588. if (state != EntryState::WRITTEN) {
  589. needErase = true;
  590. lastItemIndex = INVALID_ENTRY;
  591. break;
  592. }
  593. }
  594. if (needErase) {
  595. eraseEntryAndSpan(i);
  596. continue;
  597. }
  598. }
  599. /* Note that logic for duplicate detections works fine even
  600. * when old-format blob is present along with new-format blob-index
  601. * for same key on active page. Since datatype is not used in hash calculation,
  602. * old-format blob will be removed.*/
  603. if (duplicateIndex < i) {
  604. eraseEntryAndSpan(duplicateIndex);
  605. }
  606. }
  607. // check that last item is not duplicate
  608. if (lastItemIndex != INVALID_ENTRY) {
  609. size_t findItemIndex = 0;
  610. Item dupItem;
  611. if (findItem(item.nsIndex, item.datatype, item.key, findItemIndex, dupItem) == ESP_OK) {
  612. if (findItemIndex < lastItemIndex) {
  613. auto err = eraseEntryAndSpan(findItemIndex);
  614. if (err != ESP_OK) {
  615. mState = PageState::INVALID;
  616. return err;
  617. }
  618. }
  619. }
  620. }
  621. } else if (mState == PageState::FULL || mState == PageState::FREEING) {
  622. // We have already filled mHashList for page in active state.
  623. // Do the same for the case when page is in full or freeing state.
  624. Item item;
  625. for (size_t i = mFirstUsedEntry; i < ENTRY_COUNT; ++i) {
  626. auto err = mEntryTable.get(i, &state);
  627. if (err != ESP_OK) {
  628. return err;
  629. }
  630. if (state != EntryState::WRITTEN) {
  631. continue;
  632. }
  633. err = readEntry(i, item);
  634. if (err != ESP_OK) {
  635. mState = PageState::INVALID;
  636. return err;
  637. }
  638. if (item.crc32 != item.calculateCrc32()) {
  639. err = eraseEntryAndSpan(i);
  640. if (err != ESP_OK) {
  641. mState = PageState::INVALID;
  642. return err;
  643. }
  644. continue;
  645. }
  646. NVS_ASSERT_OR_RETURN(item.span > 0, ESP_FAIL);
  647. err = mHashList.insert(item, i);
  648. if (err != ESP_OK) {
  649. mState = PageState::INVALID;
  650. return err;
  651. }
  652. size_t span = item.span;
  653. if (isVariableLengthType(item.datatype)) {
  654. for (size_t j = i + 1; j < i + span; ++j) {
  655. err = mEntryTable.get(j, &state);
  656. if (err != ESP_OK) {
  657. return err;
  658. }
  659. if (state != EntryState::WRITTEN) {
  660. eraseEntryAndSpan(i);
  661. break;
  662. }
  663. }
  664. }
  665. i += span - 1;
  666. }
  667. }
  668. return ESP_OK;
  669. }
  670. esp_err_t Page::initialize()
  671. {
  672. NVS_ASSERT_OR_RETURN(mState == PageState::UNINITIALIZED, ESP_FAIL);
  673. mState = PageState::ACTIVE;
  674. Header header;
  675. header.mState = mState;
  676. header.mSeqNumber = mSeqNumber;
  677. header.mVersion = mVersion;
  678. header.mCrc32 = header.calculateCrc32();
  679. auto rc = mPartition->write_raw(mBaseAddress, &header, sizeof(header));
  680. if (rc != ESP_OK) {
  681. mState = PageState::INVALID;
  682. return rc;
  683. }
  684. mNextFreeEntry = 0;
  685. std::fill_n(mEntryTable.data(), mEntryTable.byteSize() / sizeof(uint32_t), 0xffffffff);
  686. return ESP_OK;
  687. }
  688. esp_err_t Page::alterEntryState(size_t index, EntryState state)
  689. {
  690. NVS_ASSERT_OR_RETURN(index < ENTRY_COUNT, ESP_FAIL);
  691. esp_err_t err = mEntryTable.set(index, state);
  692. if (err != ESP_OK) {
  693. return err;
  694. }
  695. size_t wordToWrite = mEntryTable.getWordIndex(index);
  696. uint32_t word = mEntryTable.data()[wordToWrite];
  697. err = mPartition->write_raw(mBaseAddress + ENTRY_TABLE_OFFSET + static_cast<uint32_t>(wordToWrite) * 4,
  698. &word, sizeof(word));
  699. if (err != ESP_OK) {
  700. mState = PageState::INVALID;
  701. return err;
  702. }
  703. return ESP_OK;
  704. }
  705. esp_err_t Page::alterEntryRangeState(size_t begin, size_t end, EntryState state)
  706. {
  707. NVS_ASSERT_OR_RETURN(end <= ENTRY_COUNT, ESP_FAIL);
  708. NVS_ASSERT_OR_RETURN(end > begin, ESP_FAIL);
  709. size_t wordIndex = mEntryTable.getWordIndex(end - 1);
  710. esp_err_t err;
  711. for (ptrdiff_t i = end - 1; i >= static_cast<ptrdiff_t>(begin); --i) {
  712. err = mEntryTable.set(i, state);
  713. if (err != ESP_OK){
  714. return err;
  715. }
  716. size_t nextWordIndex;
  717. if (i == static_cast<ptrdiff_t>(begin)) {
  718. nextWordIndex = (size_t) -1;
  719. } else {
  720. nextWordIndex = mEntryTable.getWordIndex(i - 1);
  721. }
  722. if (nextWordIndex != wordIndex) {
  723. uint32_t word = mEntryTable.data()[wordIndex];
  724. auto rc = mPartition->write_raw(mBaseAddress + ENTRY_TABLE_OFFSET + static_cast<uint32_t>(wordIndex) * 4,
  725. &word, 4);
  726. if (rc != ESP_OK) {
  727. return rc;
  728. }
  729. }
  730. wordIndex = nextWordIndex;
  731. }
  732. return ESP_OK;
  733. }
  734. esp_err_t Page::alterPageState(PageState state)
  735. {
  736. uint32_t state_val = static_cast<uint32_t>(state);
  737. auto rc = mPartition->write_raw(mBaseAddress, &state_val, sizeof(state));
  738. if (rc != ESP_OK) {
  739. mState = PageState::INVALID;
  740. return rc;
  741. }
  742. mState = (PageState) state;
  743. return ESP_OK;
  744. }
  745. esp_err_t Page::readEntry(size_t index, Item& dst) const
  746. {
  747. uint32_t phyAddr;
  748. esp_err_t rc = getEntryAddress(index, &phyAddr);
  749. if (rc != ESP_OK) {
  750. return rc;
  751. }
  752. rc = mPartition->read(phyAddr, &dst, sizeof(dst));
  753. if (rc != ESP_OK) {
  754. return rc;
  755. }
  756. return ESP_OK;
  757. }
  758. esp_err_t Page::findItem(uint8_t nsIndex, ItemType datatype, const char* key, size_t &itemIndex, Item& item, uint8_t chunkIdx, VerOffset chunkStart)
  759. {
  760. if (mState == PageState::CORRUPT || mState == PageState::INVALID || mState == PageState::UNINITIALIZED) {
  761. return ESP_ERR_NVS_NOT_FOUND;
  762. }
  763. size_t findBeginIndex = itemIndex;
  764. if (findBeginIndex >= ENTRY_COUNT) {
  765. return ESP_ERR_NVS_NOT_FOUND;
  766. }
  767. size_t start = mFirstUsedEntry;
  768. if (findBeginIndex > mFirstUsedEntry && findBeginIndex < ENTRY_COUNT) {
  769. start = findBeginIndex;
  770. }
  771. size_t end = mNextFreeEntry;
  772. if (end > ENTRY_COUNT) {
  773. end = ENTRY_COUNT;
  774. }
  775. if (nsIndex != NS_ANY && datatype != ItemType::ANY && key != NULL) {
  776. size_t cachedIndex = mHashList.find(start, Item(nsIndex, datatype, 0, key, chunkIdx));
  777. if (cachedIndex < ENTRY_COUNT) {
  778. start = cachedIndex;
  779. } else {
  780. return ESP_ERR_NVS_NOT_FOUND;
  781. }
  782. }
  783. size_t next;
  784. EntryState state;
  785. esp_err_t rc;
  786. for (size_t i = start; i < end; i = next) {
  787. next = i + 1;
  788. rc = mEntryTable.get(i, &state);
  789. if (rc != ESP_OK) {
  790. return rc;
  791. }
  792. if (state != EntryState::WRITTEN) {
  793. continue;
  794. }
  795. rc = readEntry(i, item);
  796. if (rc != ESP_OK) {
  797. mState = PageState::INVALID;
  798. return rc;
  799. }
  800. auto crc32 = item.calculateCrc32();
  801. if (item.crc32 != crc32) {
  802. rc = eraseEntryAndSpan(i);
  803. if (rc != ESP_OK) {
  804. mState = PageState::INVALID;
  805. return rc;
  806. }
  807. continue;
  808. }
  809. if (isVariableLengthType(item.datatype)) {
  810. next = i + item.span;
  811. }
  812. if (nsIndex != NS_ANY && item.nsIndex != nsIndex) {
  813. continue;
  814. }
  815. if (key != nullptr && strncmp(key, item.key, Item::MAX_KEY_LENGTH) != 0) {
  816. continue;
  817. }
  818. /* For blob data, chunkIndex should match*/
  819. if (chunkIdx != CHUNK_ANY
  820. && datatype == ItemType::BLOB_DATA
  821. && item.chunkIndex != chunkIdx) {
  822. continue;
  823. }
  824. /* Blob-index will match the <ns,key> with blob data.
  825. * Skip data chunks when searching for blob index*/
  826. if (datatype == ItemType::BLOB_IDX
  827. && item.chunkIndex != CHUNK_ANY) {
  828. continue;
  829. }
  830. /* Match the version for blob-index*/
  831. if (datatype == ItemType::BLOB_IDX
  832. && chunkStart != VerOffset::VER_ANY
  833. && item.blobIndex.chunkStart != chunkStart) {
  834. continue;
  835. }
  836. if (datatype != ItemType::ANY && item.datatype != datatype) {
  837. if (key == nullptr && nsIndex == NS_ANY && chunkIdx == CHUNK_ANY) {
  838. continue; // continue for bruteforce search on blob indices.
  839. }
  840. itemIndex = i;
  841. return ESP_ERR_NVS_TYPE_MISMATCH;
  842. }
  843. itemIndex = i;
  844. return ESP_OK;
  845. }
  846. return ESP_ERR_NVS_NOT_FOUND;
  847. }
  848. esp_err_t Page::getSeqNumber(uint32_t& seqNumber) const
  849. {
  850. if (mState != PageState::UNINITIALIZED && mState != PageState::INVALID && mState != PageState::CORRUPT) {
  851. seqNumber = mSeqNumber;
  852. return ESP_OK;
  853. }
  854. return ESP_ERR_NVS_NOT_INITIALIZED;
  855. }
  856. esp_err_t Page::setSeqNumber(uint32_t seqNumber)
  857. {
  858. if (mState != PageState::UNINITIALIZED) {
  859. return ESP_ERR_NVS_INVALID_STATE;
  860. }
  861. mSeqNumber = seqNumber;
  862. return ESP_OK;
  863. }
  864. esp_err_t Page::setVersion(uint8_t ver)
  865. {
  866. if (mState != PageState::UNINITIALIZED) {
  867. return ESP_ERR_NVS_INVALID_STATE;
  868. }
  869. mVersion = ver;
  870. return ESP_OK;
  871. }
  872. esp_err_t Page::erase()
  873. {
  874. auto rc = mPartition->erase_range(mBaseAddress, SPI_FLASH_SEC_SIZE);
  875. if (rc != ESP_OK) {
  876. mState = PageState::INVALID;
  877. return rc;
  878. }
  879. mUsedEntryCount = 0;
  880. mErasedEntryCount = 0;
  881. mFirstUsedEntry = INVALID_ENTRY;
  882. mNextFreeEntry = INVALID_ENTRY;
  883. mState = PageState::UNINITIALIZED;
  884. mHashList.clear();
  885. return ESP_OK;
  886. }
  887. esp_err_t Page::markFreeing()
  888. {
  889. if (mState != PageState::FULL && mState != PageState::ACTIVE) {
  890. return ESP_ERR_NVS_INVALID_STATE;
  891. }
  892. return alterPageState(PageState::FREEING);
  893. }
  894. esp_err_t Page::markFull()
  895. {
  896. if (mState != PageState::ACTIVE) {
  897. return ESP_ERR_NVS_INVALID_STATE;
  898. }
  899. return alterPageState(PageState::FULL);
  900. }
  901. size_t Page::getVarDataTailroom() const
  902. {
  903. if (mState == PageState::UNINITIALIZED) {
  904. return CHUNK_MAX_SIZE;
  905. } else if (mState == PageState::FULL) {
  906. return 0;
  907. }
  908. /* Skip one entry for blob data item precessing the data */
  909. return ((mNextFreeEntry < (ENTRY_COUNT-1)) ? ((ENTRY_COUNT - mNextFreeEntry - 1) * ENTRY_SIZE): 0);
  910. }
  911. const char* Page::pageStateToName(PageState ps)
  912. {
  913. switch (ps) {
  914. case PageState::CORRUPT:
  915. return "CORRUPT";
  916. case PageState::ACTIVE:
  917. return "ACTIVE";
  918. case PageState::FREEING:
  919. return "FREEING";
  920. case PageState::FULL:
  921. return "FULL";
  922. case PageState::INVALID:
  923. return "INVALID";
  924. case PageState::UNINITIALIZED:
  925. return "UNINITIALIZED";
  926. default:
  927. assert(0 && "invalid state value");
  928. return "";
  929. }
  930. }
  931. void Page::debugDump() const
  932. {
  933. printf("state=%x (%s) addr=%x seq=%d\nfirstUsed=%d nextFree=%d used=%d erased=%d\n", (uint32_t) mState, pageStateToName(mState), mBaseAddress, mSeqNumber, static_cast<int>(mFirstUsedEntry), static_cast<int>(mNextFreeEntry), mUsedEntryCount, mErasedEntryCount);
  934. size_t skip = 0;
  935. for (size_t i = 0; i < ENTRY_COUNT; ++i) {
  936. printf("%3d: ", static_cast<int>(i));
  937. EntryState state;
  938. if (mEntryTable.get(i, &state) != ESP_OK) {
  939. printf("Failed to read entry state\n");
  940. return;
  941. }
  942. if (state == EntryState::EMPTY) {
  943. printf("E\n");
  944. } else if (state == EntryState::ERASED) {
  945. printf("X\n");
  946. } else if (state == EntryState::WRITTEN) {
  947. Item item;
  948. readEntry(i, item);
  949. if (skip == 0) {
  950. printf("W ns=%2u type=%2u span=%3u key=\"%s\" chunkIdx=%d len=%d\n", item.nsIndex, static_cast<unsigned>(item.datatype), item.span, item.key, item.chunkIndex, (item.span != 1)?((int)item.varLength.dataSize):-1);
  951. if (item.span > 0 && item.span <= ENTRY_COUNT - i) {
  952. skip = item.span - 1;
  953. } else {
  954. skip = 0;
  955. }
  956. } else {
  957. printf("D\n");
  958. skip--;
  959. }
  960. }
  961. }
  962. }
  963. esp_err_t Page::calcEntries(nvs_stats_t &nvsStats)
  964. {
  965. NVS_ASSERT_OR_RETURN(mState != PageState::FREEING, ESP_FAIL);
  966. nvsStats.total_entries += ENTRY_COUNT;
  967. switch (mState) {
  968. case PageState::UNINITIALIZED:
  969. case PageState::CORRUPT:
  970. nvsStats.free_entries += ENTRY_COUNT;
  971. break;
  972. case PageState::FULL:
  973. case PageState::ACTIVE:
  974. nvsStats.used_entries += mUsedEntryCount;
  975. nvsStats.free_entries += ENTRY_COUNT - mUsedEntryCount; // it's equivalent free + erase entries.
  976. break;
  977. case PageState::INVALID:
  978. return ESP_ERR_INVALID_STATE;
  979. break;
  980. default:
  981. assert(false && "Unhandled state");
  982. break;
  983. }
  984. return ESP_OK;
  985. }
  986. } // namespace nvs