lfs_filebd.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167
  1. /*
  2. * Block device emulated in a file
  3. *
  4. * Copyright (c) 2022, The littlefs authors.
  5. * Copyright (c) 2017, Arm Limited. All rights reserved.
  6. * SPDX-License-Identifier: BSD-3-Clause
  7. */
  8. #include "bd/lfs_filebd.h"
  9. #include <fcntl.h>
  10. #include <unistd.h>
  11. #include <errno.h>
  12. #ifdef _WIN32
  13. #include <windows.h>
  14. #endif
  15. int lfs_filebd_create(const struct lfs_config *cfg, const char *path,
  16. const struct lfs_filebd_config *bdcfg) {
  17. LFS_FILEBD_TRACE("lfs_filebd_create(%p {.context=%p, "
  18. ".read=%p, .prog=%p, .erase=%p, .sync=%p}, "
  19. "\"%s\", "
  20. "%p {.read_size=%"PRIu32", .prog_size=%"PRIu32", "
  21. ".erase_size=%"PRIu32", .erase_count=%"PRIu32"})",
  22. (void*)cfg, cfg->context,
  23. (void*)(uintptr_t)cfg->read, (void*)(uintptr_t)cfg->prog,
  24. (void*)(uintptr_t)cfg->erase, (void*)(uintptr_t)cfg->sync,
  25. path,
  26. (void*)bdcfg,
  27. bdcfg->read_size, bdcfg->prog_size, bdcfg->erase_size,
  28. bdcfg->erase_count);
  29. lfs_filebd_t *bd = cfg->context;
  30. bd->cfg = bdcfg;
  31. // open file
  32. #ifdef _WIN32
  33. bd->fd = open(path, O_RDWR | O_CREAT | O_BINARY, 0666);
  34. #else
  35. bd->fd = open(path, O_RDWR | O_CREAT, 0666);
  36. #endif
  37. if (bd->fd < 0) {
  38. int err = -errno;
  39. LFS_FILEBD_TRACE("lfs_filebd_create -> %d", err);
  40. return err;
  41. }
  42. LFS_FILEBD_TRACE("lfs_filebd_create -> %d", 0);
  43. return 0;
  44. }
  45. int lfs_filebd_destroy(const struct lfs_config *cfg) {
  46. LFS_FILEBD_TRACE("lfs_filebd_destroy(%p)", (void*)cfg);
  47. lfs_filebd_t *bd = cfg->context;
  48. int err = close(bd->fd);
  49. if (err < 0) {
  50. err = -errno;
  51. LFS_FILEBD_TRACE("lfs_filebd_destroy -> %d", err);
  52. return err;
  53. }
  54. LFS_FILEBD_TRACE("lfs_filebd_destroy -> %d", 0);
  55. return 0;
  56. }
  57. int lfs_filebd_read(const struct lfs_config *cfg, lfs_block_t block,
  58. lfs_off_t off, void *buffer, lfs_size_t size) {
  59. LFS_FILEBD_TRACE("lfs_filebd_read(%p, "
  60. "0x%"PRIx32", %"PRIu32", %p, %"PRIu32")",
  61. (void*)cfg, block, off, buffer, size);
  62. lfs_filebd_t *bd = cfg->context;
  63. // check if read is valid
  64. LFS_ASSERT(block < bd->cfg->erase_count);
  65. LFS_ASSERT(off % bd->cfg->read_size == 0);
  66. LFS_ASSERT(size % bd->cfg->read_size == 0);
  67. LFS_ASSERT(off+size <= bd->cfg->erase_size);
  68. // zero for reproducibility (in case file is truncated)
  69. memset(buffer, 0, size);
  70. // read
  71. off_t res1 = lseek(bd->fd,
  72. (off_t)block*bd->cfg->erase_size + (off_t)off, SEEK_SET);
  73. if (res1 < 0) {
  74. int err = -errno;
  75. LFS_FILEBD_TRACE("lfs_filebd_read -> %d", err);
  76. return err;
  77. }
  78. ssize_t res2 = read(bd->fd, buffer, size);
  79. if (res2 < 0) {
  80. int err = -errno;
  81. LFS_FILEBD_TRACE("lfs_filebd_read -> %d", err);
  82. return err;
  83. }
  84. LFS_FILEBD_TRACE("lfs_filebd_read -> %d", 0);
  85. return 0;
  86. }
  87. int lfs_filebd_prog(const struct lfs_config *cfg, lfs_block_t block,
  88. lfs_off_t off, const void *buffer, lfs_size_t size) {
  89. LFS_FILEBD_TRACE("lfs_filebd_prog(%p, "
  90. "0x%"PRIx32", %"PRIu32", %p, %"PRIu32")",
  91. (void*)cfg, block, off, buffer, size);
  92. lfs_filebd_t *bd = cfg->context;
  93. // check if write is valid
  94. LFS_ASSERT(block < bd->cfg->erase_count);
  95. LFS_ASSERT(off % bd->cfg->prog_size == 0);
  96. LFS_ASSERT(size % bd->cfg->prog_size == 0);
  97. LFS_ASSERT(off+size <= bd->cfg->erase_size);
  98. // program data
  99. off_t res1 = lseek(bd->fd,
  100. (off_t)block*bd->cfg->erase_size + (off_t)off, SEEK_SET);
  101. if (res1 < 0) {
  102. int err = -errno;
  103. LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
  104. return err;
  105. }
  106. ssize_t res2 = write(bd->fd, buffer, size);
  107. if (res2 < 0) {
  108. int err = -errno;
  109. LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
  110. return err;
  111. }
  112. LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", 0);
  113. return 0;
  114. }
  115. int lfs_filebd_erase(const struct lfs_config *cfg, lfs_block_t block) {
  116. LFS_FILEBD_TRACE("lfs_filebd_erase(%p, 0x%"PRIx32" (%"PRIu32"))",
  117. (void*)cfg, block, ((lfs_filebd_t*)cfg->context)->cfg->erase_size);
  118. lfs_filebd_t *bd = cfg->context;
  119. // check if erase is valid
  120. LFS_ASSERT(block < bd->cfg->erase_count);
  121. // erase is a noop
  122. (void)block;
  123. LFS_FILEBD_TRACE("lfs_filebd_erase -> %d", 0);
  124. return 0;
  125. }
  126. int lfs_filebd_sync(const struct lfs_config *cfg) {
  127. LFS_FILEBD_TRACE("lfs_filebd_sync(%p)", (void*)cfg);
  128. // file sync
  129. lfs_filebd_t *bd = cfg->context;
  130. #ifdef _WIN32
  131. int err = FlushFileBuffers((HANDLE) _get_osfhandle(bd->fd)) ? 0 : -1;
  132. #else
  133. int err = fsync(bd->fd);
  134. #endif
  135. if (err) {
  136. err = -errno;
  137. LFS_FILEBD_TRACE("lfs_filebd_sync -> %d", 0);
  138. return err;
  139. }
  140. LFS_FILEBD_TRACE("lfs_filebd_sync -> %d", 0);
  141. return 0;
  142. }