lfs_filebd.c 4.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162
  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. LFS_FILEBD_TRACE("lfs_filebd_create(%p {.context=%p, "
  17. ".read=%p, .prog=%p, .erase=%p, .sync=%p, "
  18. ".read_size=%"PRIu32", .prog_size=%"PRIu32", "
  19. ".block_size=%"PRIu32", .block_count=%"PRIu32"}, "
  20. "\"%s\")",
  21. (void*)cfg, cfg->context,
  22. (void*)(uintptr_t)cfg->read, (void*)(uintptr_t)cfg->prog,
  23. (void*)(uintptr_t)cfg->erase, (void*)(uintptr_t)cfg->sync,
  24. cfg->read_size, cfg->prog_size, cfg->block_size, cfg->block_count,
  25. path, (void*)bdcfg, bdcfg->erase_value);
  26. lfs_filebd_t *bd = cfg->context;
  27. // open file
  28. #ifdef _WIN32
  29. bd->fd = open(path, O_RDWR | O_CREAT | O_BINARY, 0666);
  30. #else
  31. bd->fd = open(path, O_RDWR | O_CREAT, 0666);
  32. #endif
  33. if (bd->fd < 0) {
  34. int err = -errno;
  35. LFS_FILEBD_TRACE("lfs_filebd_create -> %d", err);
  36. return err;
  37. }
  38. LFS_FILEBD_TRACE("lfs_filebd_create -> %d", 0);
  39. return 0;
  40. }
  41. int lfs_filebd_destroy(const struct lfs_config *cfg) {
  42. LFS_FILEBD_TRACE("lfs_filebd_destroy(%p)", (void*)cfg);
  43. lfs_filebd_t *bd = cfg->context;
  44. int err = close(bd->fd);
  45. if (err < 0) {
  46. err = -errno;
  47. LFS_FILEBD_TRACE("lfs_filebd_destroy -> %d", err);
  48. return err;
  49. }
  50. LFS_FILEBD_TRACE("lfs_filebd_destroy -> %d", 0);
  51. return 0;
  52. }
  53. int lfs_filebd_read(const struct lfs_config *cfg, lfs_block_t block,
  54. lfs_off_t off, void *buffer, lfs_size_t size) {
  55. LFS_FILEBD_TRACE("lfs_filebd_read(%p, "
  56. "0x%"PRIx32", %"PRIu32", %p, %"PRIu32")",
  57. (void*)cfg, block, off, buffer, size);
  58. lfs_filebd_t *bd = cfg->context;
  59. // check if read is valid
  60. LFS_ASSERT(block < cfg->block_count);
  61. LFS_ASSERT(off % cfg->read_size == 0);
  62. LFS_ASSERT(size % cfg->read_size == 0);
  63. LFS_ASSERT(off+size <= cfg->block_size);
  64. // zero for reproducibility (in case file is truncated)
  65. memset(buffer, 0, size);
  66. // read
  67. off_t res1 = lseek(bd->fd,
  68. (off_t)block*cfg->block_size + (off_t)off, SEEK_SET);
  69. if (res1 < 0) {
  70. int err = -errno;
  71. LFS_FILEBD_TRACE("lfs_filebd_read -> %d", err);
  72. return err;
  73. }
  74. ssize_t res2 = read(bd->fd, buffer, size);
  75. if (res2 < 0) {
  76. int err = -errno;
  77. LFS_FILEBD_TRACE("lfs_filebd_read -> %d", err);
  78. return err;
  79. }
  80. LFS_FILEBD_TRACE("lfs_filebd_read -> %d", 0);
  81. return 0;
  82. }
  83. int lfs_filebd_prog(const struct lfs_config *cfg, lfs_block_t block,
  84. lfs_off_t off, const void *buffer, lfs_size_t size) {
  85. LFS_FILEBD_TRACE("lfs_filebd_prog(%p, "
  86. "0x%"PRIx32", %"PRIu32", %p, %"PRIu32")",
  87. (void*)cfg, block, off, buffer, size);
  88. lfs_filebd_t *bd = cfg->context;
  89. // check if write is valid
  90. LFS_ASSERT(block < cfg->block_count);
  91. LFS_ASSERT(off % cfg->prog_size == 0);
  92. LFS_ASSERT(size % cfg->prog_size == 0);
  93. LFS_ASSERT(off+size <= cfg->block_size);
  94. // program data
  95. off_t res1 = lseek(bd->fd,
  96. (off_t)block*cfg->block_size + (off_t)off, SEEK_SET);
  97. if (res1 < 0) {
  98. int err = -errno;
  99. LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
  100. return err;
  101. }
  102. ssize_t res2 = write(bd->fd, buffer, size);
  103. if (res2 < 0) {
  104. int err = -errno;
  105. LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
  106. return err;
  107. }
  108. LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", 0);
  109. return 0;
  110. }
  111. int lfs_filebd_erase(const struct lfs_config *cfg, lfs_block_t block) {
  112. LFS_FILEBD_TRACE("lfs_filebd_erase(%p, 0x%"PRIx32" (%"PRIu32"))",
  113. (void*)cfg, block, cfg->block_size);
  114. // check if erase is valid
  115. LFS_ASSERT(block < cfg->block_count);
  116. // erase is a noop
  117. (void)block;
  118. LFS_FILEBD_TRACE("lfs_filebd_erase -> %d", 0);
  119. return 0;
  120. }
  121. int lfs_filebd_sync(const struct lfs_config *cfg) {
  122. LFS_FILEBD_TRACE("lfs_filebd_sync(%p)", (void*)cfg);
  123. // file sync
  124. lfs_filebd_t *bd = cfg->context;
  125. #ifdef _WIN32
  126. int err = FlushFileBuffers((HANDLE) _get_osfhandle(bd->fd)) ? 0 : -1;
  127. #else
  128. int err = fsync(bd->fd);
  129. #endif
  130. if (err) {
  131. err = -errno;
  132. LFS_FILEBD_TRACE("lfs_filebd_sync -> %d", 0);
  133. return err;
  134. }
  135. LFS_FILEBD_TRACE("lfs_filebd_sync -> %d", 0);
  136. return 0;
  137. }