lfs_filebd.c 4.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160
  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, 0x%"PRIx32", %"PRIu32", %p, %"PRIu32")",
  86. (void*)cfg, block, off, buffer, size);
  87. lfs_filebd_t *bd = cfg->context;
  88. // check if write is valid
  89. LFS_ASSERT(block < cfg->block_count);
  90. LFS_ASSERT(off % cfg->prog_size == 0);
  91. LFS_ASSERT(size % cfg->prog_size == 0);
  92. LFS_ASSERT(off+size <= cfg->block_size);
  93. // program data
  94. off_t res1 = lseek(bd->fd,
  95. (off_t)block*cfg->block_size + (off_t)off, SEEK_SET);
  96. if (res1 < 0) {
  97. int err = -errno;
  98. LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
  99. return err;
  100. }
  101. ssize_t res2 = write(bd->fd, buffer, size);
  102. if (res2 < 0) {
  103. int err = -errno;
  104. LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
  105. return err;
  106. }
  107. LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", 0);
  108. return 0;
  109. }
  110. int lfs_filebd_erase(const struct lfs_config *cfg, lfs_block_t block) {
  111. LFS_FILEBD_TRACE("lfs_filebd_erase(%p, 0x%"PRIx32")", (void*)cfg, block);
  112. // check if erase is valid
  113. LFS_ASSERT(block < cfg->block_count);
  114. // erase is a noop
  115. (void)block;
  116. LFS_FILEBD_TRACE("lfs_filebd_erase -> %d", 0);
  117. return 0;
  118. }
  119. int lfs_filebd_sync(const struct lfs_config *cfg) {
  120. LFS_FILEBD_TRACE("lfs_filebd_sync(%p)", (void*)cfg);
  121. // file sync
  122. lfs_filebd_t *bd = cfg->context;
  123. #ifdef _WIN32
  124. int err = FlushFileBuffers((HANDLE) _get_osfhandle(fd)) ? 0 : -1;
  125. #else
  126. int err = fsync(bd->fd);
  127. #endif
  128. if (err) {
  129. err = -errno;
  130. LFS_FILEBD_TRACE("lfs_filebd_sync -> %d", 0);
  131. return err;
  132. }
  133. LFS_FILEBD_TRACE("lfs_filebd_sync -> %d", 0);
  134. return 0;
  135. }