lfs_emubd.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710
  1. /*
  2. * Emulating block device, wraps filebd and rambd while providing a bunch
  3. * of hooks for testing littlefs in various conditions.
  4. *
  5. * Copyright (c) 2022, The littlefs authors.
  6. * Copyright (c) 2017, Arm Limited. All rights reserved.
  7. * SPDX-License-Identifier: BSD-3-Clause
  8. */
  9. #ifndef _POSIX_C_SOURCE
  10. #define _POSIX_C_SOURCE 199309L
  11. #endif
  12. #include "bd/lfs_emubd.h"
  13. #include <stdlib.h>
  14. #include <fcntl.h>
  15. #include <unistd.h>
  16. #include <errno.h>
  17. #include <time.h>
  18. #ifdef _WIN32
  19. #include <windows.h>
  20. #endif
  21. // access to lazily-allocated/copy-on-write blocks
  22. //
  23. // Note we can only modify a block if we have exclusive access to it (rc == 1)
  24. //
  25. static lfs_emubd_block_t *lfs_emubd_incblock(lfs_emubd_block_t *block) {
  26. if (block) {
  27. block->rc += 1;
  28. }
  29. return block;
  30. }
  31. static void lfs_emubd_decblock(lfs_emubd_block_t *block) {
  32. if (block) {
  33. block->rc -= 1;
  34. if (block->rc == 0) {
  35. free(block);
  36. }
  37. }
  38. }
  39. static lfs_emubd_block_t *lfs_emubd_mutblock(
  40. const struct lfs_config *cfg,
  41. lfs_emubd_block_t **block) {
  42. lfs_emubd_t *bd = cfg->context;
  43. lfs_emubd_block_t *block_ = *block;
  44. if (block_ && block_->rc == 1) {
  45. // rc == 1? can modify
  46. return block_;
  47. } else if (block_) {
  48. // rc > 1? need to create a copy
  49. lfs_emubd_block_t *nblock = malloc(
  50. sizeof(lfs_emubd_block_t) + bd->cfg->erase_size);
  51. if (!nblock) {
  52. return NULL;
  53. }
  54. memcpy(nblock, block_,
  55. sizeof(lfs_emubd_block_t) + bd->cfg->erase_size);
  56. nblock->rc = 1;
  57. lfs_emubd_decblock(block_);
  58. *block = nblock;
  59. return nblock;
  60. } else {
  61. // no block? need to allocate
  62. lfs_emubd_block_t *nblock = malloc(
  63. sizeof(lfs_emubd_block_t) + bd->cfg->erase_size);
  64. if (!nblock) {
  65. return NULL;
  66. }
  67. nblock->rc = 1;
  68. nblock->wear = 0;
  69. // zero for consistency
  70. memset(nblock->data,
  71. (bd->cfg->erase_value != -1) ? bd->cfg->erase_value : 0,
  72. bd->cfg->erase_size);
  73. *block = nblock;
  74. return nblock;
  75. }
  76. }
  77. // emubd create/destroy
  78. int lfs_emubd_create(const struct lfs_config *cfg,
  79. const struct lfs_emubd_config *bdcfg) {
  80. LFS_EMUBD_TRACE("lfs_emubd_create(%p {.context=%p, "
  81. ".read=%p, .prog=%p, .erase=%p, .sync=%p}, "
  82. "%p {.read_size=%"PRIu32", .prog_size=%"PRIu32", "
  83. ".erase_size=%"PRIu32", .erase_count=%"PRIu32", "
  84. ".erase_value=%"PRId32", .erase_cycles=%"PRIu32", "
  85. ".badblock_behavior=%"PRIu8", .power_cycles=%"PRIu32", "
  86. ".powerloss_behavior=%"PRIu8", .powerloss_cb=%p, "
  87. ".powerloss_data=%p, .track_branches=%d})",
  88. (void*)cfg, cfg->context,
  89. (void*)(uintptr_t)cfg->read, (void*)(uintptr_t)cfg->prog,
  90. (void*)(uintptr_t)cfg->erase, (void*)(uintptr_t)cfg->sync,
  91. (void*)bdcfg,
  92. bdcfg->read_size, bdcfg->prog_size, bdcfg->erase_size,
  93. bdcfg->erase_count, bdcfg->erase_value, bdcfg->erase_cycles,
  94. bdcfg->badblock_behavior, bdcfg->power_cycles,
  95. bdcfg->powerloss_behavior, (void*)(uintptr_t)bdcfg->powerloss_cb,
  96. bdcfg->powerloss_data, bdcfg->track_branches);
  97. lfs_emubd_t *bd = cfg->context;
  98. bd->cfg = bdcfg;
  99. // allocate our block array, all blocks start as uninitialized
  100. bd->blocks = malloc(bd->cfg->erase_count * sizeof(lfs_emubd_block_t*));
  101. if (!bd->blocks) {
  102. LFS_EMUBD_TRACE("lfs_emubd_create -> %d", LFS_ERR_NOMEM);
  103. return LFS_ERR_NOMEM;
  104. }
  105. memset(bd->blocks, 0, bd->cfg->erase_count * sizeof(lfs_emubd_block_t*));
  106. // setup testing things
  107. bd->readed = 0;
  108. bd->proged = 0;
  109. bd->erased = 0;
  110. bd->power_cycles = bd->cfg->power_cycles;
  111. bd->ooo_block = -1;
  112. bd->ooo_data = NULL;
  113. bd->disk = NULL;
  114. if (bd->cfg->disk_path) {
  115. bd->disk = malloc(sizeof(lfs_emubd_disk_t));
  116. if (!bd->disk) {
  117. LFS_EMUBD_TRACE("lfs_emubd_create -> %d", LFS_ERR_NOMEM);
  118. return LFS_ERR_NOMEM;
  119. }
  120. bd->disk->rc = 1;
  121. bd->disk->scratch = NULL;
  122. #ifdef _WIN32
  123. bd->disk->fd = open(bd->cfg->disk_path,
  124. O_RDWR | O_CREAT | O_BINARY, 0666);
  125. #else
  126. bd->disk->fd = open(bd->cfg->disk_path,
  127. O_RDWR | O_CREAT, 0666);
  128. #endif
  129. if (bd->disk->fd < 0) {
  130. int err = -errno;
  131. LFS_EMUBD_TRACE("lfs_emubd_create -> %d", err);
  132. return err;
  133. }
  134. // if we're emulating erase values, we can keep a block around in
  135. // memory of just the erase state to speed up emulated erases
  136. if (bd->cfg->erase_value != -1) {
  137. bd->disk->scratch = malloc(bd->cfg->erase_size);
  138. if (!bd->disk->scratch) {
  139. LFS_EMUBD_TRACE("lfs_emubd_create -> %d", LFS_ERR_NOMEM);
  140. return LFS_ERR_NOMEM;
  141. }
  142. memset(bd->disk->scratch,
  143. bd->cfg->erase_value,
  144. bd->cfg->erase_size);
  145. // go ahead and erase all of the disk, otherwise the file will not
  146. // match our internal representation
  147. for (size_t i = 0; i < bd->cfg->erase_count; i++) {
  148. ssize_t res = write(bd->disk->fd,
  149. bd->disk->scratch,
  150. bd->cfg->erase_size);
  151. if (res < 0) {
  152. int err = -errno;
  153. LFS_EMUBD_TRACE("lfs_emubd_create -> %d", err);
  154. return err;
  155. }
  156. }
  157. }
  158. }
  159. LFS_EMUBD_TRACE("lfs_emubd_create -> %d", 0);
  160. return 0;
  161. }
  162. int lfs_emubd_destroy(const struct lfs_config *cfg) {
  163. LFS_EMUBD_TRACE("lfs_emubd_destroy(%p)", (void*)cfg);
  164. lfs_emubd_t *bd = cfg->context;
  165. // decrement reference counts
  166. for (lfs_block_t i = 0; i < bd->cfg->erase_count; i++) {
  167. lfs_emubd_decblock(bd->blocks[i]);
  168. }
  169. free(bd->blocks);
  170. // clean up other resources
  171. lfs_emubd_decblock(bd->ooo_data);
  172. if (bd->disk) {
  173. bd->disk->rc -= 1;
  174. if (bd->disk->rc == 0) {
  175. close(bd->disk->fd);
  176. free(bd->disk->scratch);
  177. free(bd->disk);
  178. }
  179. }
  180. LFS_EMUBD_TRACE("lfs_emubd_destroy -> %d", 0);
  181. return 0;
  182. }
  183. // powerloss hook
  184. static int lfs_emubd_powerloss(const struct lfs_config *cfg) {
  185. lfs_emubd_t *bd = cfg->context;
  186. // emulate out-of-order writes?
  187. if (bd->cfg->powerloss_behavior == LFS_EMUBD_POWERLOSS_OOO
  188. && bd->ooo_block != -1) {
  189. // since writes between syncs are allowed to be out-of-order, it
  190. // shouldn't hurt to restore the first write on powerloss, right?
  191. lfs_emubd_decblock(bd->blocks[bd->ooo_block]);
  192. bd->blocks[bd->ooo_block] = bd->ooo_data;
  193. // mirror to disk file?
  194. if (bd->disk && (bd->ooo_data || bd->cfg->erase_value != -1)) {
  195. off_t res1 = lseek(bd->disk->fd,
  196. (off_t)bd->ooo_block*bd->cfg->erase_size,
  197. SEEK_SET);
  198. if (res1 < 0) {
  199. return -errno;
  200. }
  201. ssize_t res2 = write(bd->disk->fd,
  202. (bd->ooo_data)
  203. ? bd->ooo_data->data
  204. : bd->disk->scratch,
  205. bd->cfg->erase_size);
  206. if (res2 < 0) {
  207. return -errno;
  208. }
  209. }
  210. bd->ooo_block = -1;
  211. bd->ooo_data = NULL;
  212. }
  213. // simulate power loss
  214. bd->cfg->powerloss_cb(bd->cfg->powerloss_data);
  215. return 0;
  216. }
  217. // block device API
  218. int lfs_emubd_read(const struct lfs_config *cfg, lfs_block_t block,
  219. lfs_off_t off, void *buffer, lfs_size_t size) {
  220. LFS_EMUBD_TRACE("lfs_emubd_read(%p, "
  221. "0x%"PRIx32", %"PRIu32", %p, %"PRIu32")",
  222. (void*)cfg, block, off, buffer, size);
  223. lfs_emubd_t *bd = cfg->context;
  224. // check if read is valid
  225. LFS_ASSERT(block < bd->cfg->erase_count);
  226. LFS_ASSERT(off % bd->cfg->read_size == 0);
  227. LFS_ASSERT(size % bd->cfg->read_size == 0);
  228. LFS_ASSERT(off+size <= bd->cfg->erase_size);
  229. // get the block
  230. const lfs_emubd_block_t *b = bd->blocks[block];
  231. if (b) {
  232. // block bad?
  233. if (bd->cfg->erase_cycles && b->wear >= bd->cfg->erase_cycles &&
  234. bd->cfg->badblock_behavior == LFS_EMUBD_BADBLOCK_READERROR) {
  235. LFS_EMUBD_TRACE("lfs_emubd_read -> %d", LFS_ERR_CORRUPT);
  236. return LFS_ERR_CORRUPT;
  237. }
  238. // read data
  239. memcpy(buffer, &b->data[off], size);
  240. } else {
  241. // zero for consistency
  242. memset(buffer,
  243. (bd->cfg->erase_value != -1) ? bd->cfg->erase_value : 0,
  244. size);
  245. }
  246. // track reads
  247. bd->readed += size;
  248. if (bd->cfg->read_sleep) {
  249. int err = nanosleep(&(struct timespec){
  250. .tv_sec=bd->cfg->read_sleep/1000000000,
  251. .tv_nsec=bd->cfg->read_sleep%1000000000},
  252. NULL);
  253. if (err) {
  254. err = -errno;
  255. LFS_EMUBD_TRACE("lfs_emubd_read -> %d", err);
  256. return err;
  257. }
  258. }
  259. LFS_EMUBD_TRACE("lfs_emubd_read -> %d", 0);
  260. return 0;
  261. }
  262. int lfs_emubd_prog(const struct lfs_config *cfg, lfs_block_t block,
  263. lfs_off_t off, const void *buffer, lfs_size_t size) {
  264. LFS_EMUBD_TRACE("lfs_emubd_prog(%p, "
  265. "0x%"PRIx32", %"PRIu32", %p, %"PRIu32")",
  266. (void*)cfg, block, off, buffer, size);
  267. lfs_emubd_t *bd = cfg->context;
  268. // check if write is valid
  269. LFS_ASSERT(block < bd->cfg->erase_count);
  270. LFS_ASSERT(off % bd->cfg->prog_size == 0);
  271. LFS_ASSERT(size % bd->cfg->prog_size == 0);
  272. LFS_ASSERT(off+size <= bd->cfg->erase_size);
  273. // get the block
  274. lfs_emubd_block_t *b = lfs_emubd_mutblock(cfg, &bd->blocks[block]);
  275. if (!b) {
  276. LFS_EMUBD_TRACE("lfs_emubd_prog -> %d", LFS_ERR_NOMEM);
  277. return LFS_ERR_NOMEM;
  278. }
  279. // block bad?
  280. if (bd->cfg->erase_cycles && b->wear >= bd->cfg->erase_cycles) {
  281. if (bd->cfg->badblock_behavior ==
  282. LFS_EMUBD_BADBLOCK_PROGERROR) {
  283. LFS_EMUBD_TRACE("lfs_emubd_prog -> %d", LFS_ERR_CORRUPT);
  284. return LFS_ERR_CORRUPT;
  285. } else if (bd->cfg->badblock_behavior ==
  286. LFS_EMUBD_BADBLOCK_PROGNOOP ||
  287. bd->cfg->badblock_behavior ==
  288. LFS_EMUBD_BADBLOCK_ERASENOOP) {
  289. LFS_EMUBD_TRACE("lfs_emubd_prog -> %d", 0);
  290. return 0;
  291. }
  292. }
  293. // were we erased properly?
  294. if (bd->cfg->erase_value != -1) {
  295. for (lfs_off_t i = 0; i < size; i++) {
  296. LFS_ASSERT(b->data[off+i] == bd->cfg->erase_value);
  297. }
  298. }
  299. // prog data
  300. memcpy(&b->data[off], buffer, size);
  301. // mirror to disk file?
  302. if (bd->disk) {
  303. off_t res1 = lseek(bd->disk->fd,
  304. (off_t)block*bd->cfg->erase_size + (off_t)off,
  305. SEEK_SET);
  306. if (res1 < 0) {
  307. int err = -errno;
  308. LFS_EMUBD_TRACE("lfs_emubd_prog -> %d", err);
  309. return err;
  310. }
  311. ssize_t res2 = write(bd->disk->fd, buffer, size);
  312. if (res2 < 0) {
  313. int err = -errno;
  314. LFS_EMUBD_TRACE("lfs_emubd_prog -> %d", err);
  315. return err;
  316. }
  317. }
  318. // track progs
  319. bd->proged += size;
  320. if (bd->cfg->prog_sleep) {
  321. int err = nanosleep(&(struct timespec){
  322. .tv_sec=bd->cfg->prog_sleep/1000000000,
  323. .tv_nsec=bd->cfg->prog_sleep%1000000000},
  324. NULL);
  325. if (err) {
  326. err = -errno;
  327. LFS_EMUBD_TRACE("lfs_emubd_prog -> %d", err);
  328. return err;
  329. }
  330. }
  331. // lose power?
  332. if (bd->power_cycles > 0) {
  333. bd->power_cycles -= 1;
  334. if (bd->power_cycles == 0) {
  335. int err = lfs_emubd_powerloss(cfg);
  336. if (err) {
  337. LFS_EMUBD_TRACE("lfs_emubd_prog -> %d", err);
  338. return err;
  339. }
  340. }
  341. }
  342. LFS_EMUBD_TRACE("lfs_emubd_prog -> %d", 0);
  343. return 0;
  344. }
  345. int lfs_emubd_erase(const struct lfs_config *cfg, lfs_block_t block) {
  346. LFS_EMUBD_TRACE("lfs_emubd_erase(%p, 0x%"PRIx32" (%"PRIu32"))",
  347. (void*)cfg, block, ((lfs_emubd_t*)cfg->context)->cfg->erase_size);
  348. lfs_emubd_t *bd = cfg->context;
  349. // check if erase is valid
  350. LFS_ASSERT(block < bd->cfg->erase_count);
  351. // emulate out-of-order writes? save first write
  352. if (bd->cfg->powerloss_behavior == LFS_EMUBD_POWERLOSS_OOO
  353. && bd->ooo_block == -1) {
  354. bd->ooo_block = block;
  355. bd->ooo_data = lfs_emubd_incblock(bd->blocks[block]);
  356. }
  357. // get the block
  358. lfs_emubd_block_t *b = lfs_emubd_mutblock(cfg, &bd->blocks[block]);
  359. if (!b) {
  360. LFS_EMUBD_TRACE("lfs_emubd_erase -> %d", LFS_ERR_NOMEM);
  361. return LFS_ERR_NOMEM;
  362. }
  363. // block bad?
  364. if (bd->cfg->erase_cycles) {
  365. if (b->wear >= bd->cfg->erase_cycles) {
  366. if (bd->cfg->badblock_behavior ==
  367. LFS_EMUBD_BADBLOCK_ERASEERROR) {
  368. LFS_EMUBD_TRACE("lfs_emubd_erase -> %d", LFS_ERR_CORRUPT);
  369. return LFS_ERR_CORRUPT;
  370. } else if (bd->cfg->badblock_behavior ==
  371. LFS_EMUBD_BADBLOCK_ERASENOOP) {
  372. LFS_EMUBD_TRACE("lfs_emubd_erase -> %d", 0);
  373. return 0;
  374. }
  375. } else {
  376. // mark wear
  377. b->wear += 1;
  378. }
  379. }
  380. // emulate an erase value?
  381. if (bd->cfg->erase_value != -1) {
  382. memset(b->data, bd->cfg->erase_value, bd->cfg->erase_size);
  383. // mirror to disk file?
  384. if (bd->disk) {
  385. off_t res1 = lseek(bd->disk->fd,
  386. (off_t)block*bd->cfg->erase_size,
  387. SEEK_SET);
  388. if (res1 < 0) {
  389. int err = -errno;
  390. LFS_EMUBD_TRACE("lfs_emubd_erase -> %d", err);
  391. return err;
  392. }
  393. ssize_t res2 = write(bd->disk->fd,
  394. bd->disk->scratch,
  395. bd->cfg->erase_size);
  396. if (res2 < 0) {
  397. int err = -errno;
  398. LFS_EMUBD_TRACE("lfs_emubd_erase -> %d", err);
  399. return err;
  400. }
  401. }
  402. }
  403. // track erases
  404. bd->erased += bd->cfg->erase_size;
  405. if (bd->cfg->erase_sleep) {
  406. int err = nanosleep(&(struct timespec){
  407. .tv_sec=bd->cfg->erase_sleep/1000000000,
  408. .tv_nsec=bd->cfg->erase_sleep%1000000000},
  409. NULL);
  410. if (err) {
  411. err = -errno;
  412. LFS_EMUBD_TRACE("lfs_emubd_erase -> %d", err);
  413. return err;
  414. }
  415. }
  416. // lose power?
  417. if (bd->power_cycles > 0) {
  418. bd->power_cycles -= 1;
  419. if (bd->power_cycles == 0) {
  420. int err = lfs_emubd_powerloss(cfg);
  421. if (err) {
  422. LFS_EMUBD_TRACE("lfs_emubd_erase -> %d", err);
  423. return err;
  424. }
  425. }
  426. }
  427. LFS_EMUBD_TRACE("lfs_emubd_erase -> %d", 0);
  428. return 0;
  429. }
  430. int lfs_emubd_sync(const struct lfs_config *cfg) {
  431. LFS_EMUBD_TRACE("lfs_emubd_sync(%p)", (void*)cfg);
  432. lfs_emubd_t *bd = cfg->context;
  433. // emulate out-of-order writes? reset first write, writes
  434. // cannot be out-of-order across sync
  435. if (bd->cfg->powerloss_behavior == LFS_EMUBD_POWERLOSS_OOO) {
  436. bd->ooo_block = -1;
  437. bd->ooo_data = NULL;
  438. }
  439. LFS_EMUBD_TRACE("lfs_emubd_sync -> %d", 0);
  440. return 0;
  441. }
  442. /// Additional extended API for driving test features ///
  443. static int lfs_emubd_crc_(const struct lfs_config *cfg,
  444. lfs_block_t block, uint32_t *crc) {
  445. lfs_emubd_t *bd = cfg->context;
  446. // check if crc is valid
  447. LFS_ASSERT(block < cfg->block_count);
  448. // crc the block
  449. uint32_t crc_ = 0xffffffff;
  450. const lfs_emubd_block_t *b = bd->blocks[block];
  451. if (b) {
  452. crc_ = lfs_crc(crc_, b->data, cfg->block_size);
  453. } else {
  454. uint8_t erase_value = (bd->cfg->erase_value != -1)
  455. ? bd->cfg->erase_value
  456. : 0;
  457. for (lfs_size_t i = 0; i < cfg->block_size; i++) {
  458. crc_ = lfs_crc(crc_, &erase_value, 1);
  459. }
  460. }
  461. *crc = 0xffffffff ^ crc_;
  462. return 0;
  463. }
  464. int lfs_emubd_crc(const struct lfs_config *cfg,
  465. lfs_block_t block, uint32_t *crc) {
  466. LFS_EMUBD_TRACE("lfs_emubd_crc(%p, %"PRIu32", %p)",
  467. (void*)cfg, block, crc);
  468. int err = lfs_emubd_crc_(cfg, block, crc);
  469. LFS_EMUBD_TRACE("lfs_emubd_crc -> %d", err);
  470. return err;
  471. }
  472. int lfs_emubd_bdcrc(const struct lfs_config *cfg, uint32_t *crc) {
  473. LFS_EMUBD_TRACE("lfs_emubd_bdcrc(%p, %p)", (void*)cfg, crc);
  474. uint32_t crc_ = 0xffffffff;
  475. for (lfs_block_t i = 0; i < cfg->block_count; i++) {
  476. uint32_t i_crc;
  477. int err = lfs_emubd_crc_(cfg, i, &i_crc);
  478. if (err) {
  479. LFS_EMUBD_TRACE("lfs_emubd_bdcrc -> %d", err);
  480. return err;
  481. }
  482. crc_ = lfs_crc(crc_, &i_crc, sizeof(uint32_t));
  483. }
  484. *crc = 0xffffffff ^ crc_;
  485. LFS_EMUBD_TRACE("lfs_emubd_bdcrc -> %d", 0);
  486. return 0;
  487. }
  488. lfs_emubd_sio_t lfs_emubd_readed(const struct lfs_config *cfg) {
  489. LFS_EMUBD_TRACE("lfs_emubd_readed(%p)", (void*)cfg);
  490. lfs_emubd_t *bd = cfg->context;
  491. LFS_EMUBD_TRACE("lfs_emubd_readed -> %"PRIu64, bd->readed);
  492. return bd->readed;
  493. }
  494. lfs_emubd_sio_t lfs_emubd_proged(const struct lfs_config *cfg) {
  495. LFS_EMUBD_TRACE("lfs_emubd_proged(%p)", (void*)cfg);
  496. lfs_emubd_t *bd = cfg->context;
  497. LFS_EMUBD_TRACE("lfs_emubd_proged -> %"PRIu64, bd->proged);
  498. return bd->proged;
  499. }
  500. lfs_emubd_sio_t lfs_emubd_erased(const struct lfs_config *cfg) {
  501. LFS_EMUBD_TRACE("lfs_emubd_erased(%p)", (void*)cfg);
  502. lfs_emubd_t *bd = cfg->context;
  503. LFS_EMUBD_TRACE("lfs_emubd_erased -> %"PRIu64, bd->erased);
  504. return bd->erased;
  505. }
  506. int lfs_emubd_setreaded(const struct lfs_config *cfg, lfs_emubd_io_t readed) {
  507. LFS_EMUBD_TRACE("lfs_emubd_setreaded(%p, %"PRIu64")", (void*)cfg, readed);
  508. lfs_emubd_t *bd = cfg->context;
  509. bd->readed = readed;
  510. LFS_EMUBD_TRACE("lfs_emubd_setreaded -> %d", 0);
  511. return 0;
  512. }
  513. int lfs_emubd_setproged(const struct lfs_config *cfg, lfs_emubd_io_t proged) {
  514. LFS_EMUBD_TRACE("lfs_emubd_setproged(%p, %"PRIu64")", (void*)cfg, proged);
  515. lfs_emubd_t *bd = cfg->context;
  516. bd->proged = proged;
  517. LFS_EMUBD_TRACE("lfs_emubd_setproged -> %d", 0);
  518. return 0;
  519. }
  520. int lfs_emubd_seterased(const struct lfs_config *cfg, lfs_emubd_io_t erased) {
  521. LFS_EMUBD_TRACE("lfs_emubd_seterased(%p, %"PRIu64")", (void*)cfg, erased);
  522. lfs_emubd_t *bd = cfg->context;
  523. bd->erased = erased;
  524. LFS_EMUBD_TRACE("lfs_emubd_seterased -> %d", 0);
  525. return 0;
  526. }
  527. lfs_emubd_swear_t lfs_emubd_wear(const struct lfs_config *cfg,
  528. lfs_block_t block) {
  529. LFS_EMUBD_TRACE("lfs_emubd_wear(%p, %"PRIu32")", (void*)cfg, block);
  530. lfs_emubd_t *bd = cfg->context;
  531. // check if block is valid
  532. LFS_ASSERT(block < bd->cfg->erase_count);
  533. // get the wear
  534. lfs_emubd_wear_t wear;
  535. const lfs_emubd_block_t *b = bd->blocks[block];
  536. if (b) {
  537. wear = b->wear;
  538. } else {
  539. wear = 0;
  540. }
  541. LFS_EMUBD_TRACE("lfs_emubd_wear -> %"PRIi32, wear);
  542. return wear;
  543. }
  544. int lfs_emubd_setwear(const struct lfs_config *cfg,
  545. lfs_block_t block, lfs_emubd_wear_t wear) {
  546. LFS_EMUBD_TRACE("lfs_emubd_setwear(%p, %"PRIu32", %"PRIi32")",
  547. (void*)cfg, block, wear);
  548. lfs_emubd_t *bd = cfg->context;
  549. // check if block is valid
  550. LFS_ASSERT(block < bd->cfg->erase_count);
  551. // set the wear
  552. lfs_emubd_block_t *b = lfs_emubd_mutblock(cfg, &bd->blocks[block]);
  553. if (!b) {
  554. LFS_EMUBD_TRACE("lfs_emubd_setwear -> %d", LFS_ERR_NOMEM);
  555. return LFS_ERR_NOMEM;
  556. }
  557. b->wear = wear;
  558. LFS_EMUBD_TRACE("lfs_emubd_setwear -> %d", 0);
  559. return 0;
  560. }
  561. lfs_emubd_spowercycles_t lfs_emubd_powercycles(
  562. const struct lfs_config *cfg) {
  563. LFS_EMUBD_TRACE("lfs_emubd_powercycles(%p)", (void*)cfg);
  564. lfs_emubd_t *bd = cfg->context;
  565. LFS_EMUBD_TRACE("lfs_emubd_powercycles -> %"PRIi32, bd->power_cycles);
  566. return bd->power_cycles;
  567. }
  568. int lfs_emubd_setpowercycles(const struct lfs_config *cfg,
  569. lfs_emubd_powercycles_t power_cycles) {
  570. LFS_EMUBD_TRACE("lfs_emubd_setpowercycles(%p, %"PRIi32")",
  571. (void*)cfg, power_cycles);
  572. lfs_emubd_t *bd = cfg->context;
  573. bd->power_cycles = power_cycles;
  574. LFS_EMUBD_TRACE("lfs_emubd_powercycles -> %d", 0);
  575. return 0;
  576. }
  577. int lfs_emubd_copy(const struct lfs_config *cfg, lfs_emubd_t *copy) {
  578. LFS_EMUBD_TRACE("lfs_emubd_copy(%p, %p)", (void*)cfg, (void*)copy);
  579. lfs_emubd_t *bd = cfg->context;
  580. // lazily copy over our block array
  581. copy->blocks = malloc(bd->cfg->erase_count * sizeof(lfs_emubd_block_t*));
  582. if (!copy->blocks) {
  583. LFS_EMUBD_TRACE("lfs_emubd_copy -> %d", LFS_ERR_NOMEM);
  584. return LFS_ERR_NOMEM;
  585. }
  586. for (size_t i = 0; i < bd->cfg->erase_count; i++) {
  587. copy->blocks[i] = lfs_emubd_incblock(bd->blocks[i]);
  588. }
  589. // other state
  590. copy->readed = bd->readed;
  591. copy->proged = bd->proged;
  592. copy->erased = bd->erased;
  593. copy->power_cycles = bd->power_cycles;
  594. copy->ooo_block = bd->ooo_block;
  595. copy->ooo_data = lfs_emubd_incblock(bd->ooo_data);
  596. copy->disk = bd->disk;
  597. if (copy->disk) {
  598. copy->disk->rc += 1;
  599. }
  600. copy->cfg = bd->cfg;
  601. LFS_EMUBD_TRACE("lfs_emubd_copy -> %d", 0);
  602. return 0;
  603. }