220 lines
6.8 KiB
C
220 lines
6.8 KiB
C
|
/*
|
||
|
|
* Block device emulated in a file
|
||
|
|
*
|
||
|
|
* Copyright (c) 2022, The littlefs authors.
|
||
|
|
* Copyright (c) 2017, Arm Limited. All rights reserved.
|
||
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
||
|
|
*/
|
||
|
|
#include "bd/lfs_filebd.h"
|
||
|
|
|
||
|
|
#include <fcntl.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
#include <errno.h>
|
||
|
|
|
||
|
|
#ifdef _WIN32
|
||
|
|
#include <windows.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
int lfs_filebd_createcfg(const struct lfs_config *cfg, const char *path,
|
||
|
|
const struct lfs_filebd_config *bdcfg) {
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_createcfg(%p {.context=%p, "
|
||
|
|
".read=%p, .prog=%p, .erase=%p, .sync=%p, "
|
||
|
|
".read_size=%"PRIu32", .prog_size=%"PRIu32", "
|
||
|
|
".block_size=%"PRIu32", .block_count=%"PRIu32"}, "
|
||
|
|
"\"%s\", "
|
||
|
|
"%p {.erase_value=%"PRId32"})",
|
||
|
|
(void*)cfg, cfg->context,
|
||
|
|
(void*)(uintptr_t)cfg->read, (void*)(uintptr_t)cfg->prog,
|
||
|
|
(void*)(uintptr_t)cfg->erase, (void*)(uintptr_t)cfg->sync,
|
||
|
|
cfg->read_size, cfg->prog_size, cfg->block_size, cfg->block_count,
|
||
|
|
path, (void*)bdcfg, bdcfg->erase_value);
|
||
|
|
lfs_filebd_t *bd = cfg->context;
|
||
|
|
bd->cfg = bdcfg;
|
||
|
|
|
||
|
|
// open file
|
||
|
|
#ifdef _WIN32
|
||
|
|
bd->fd = open(path, O_RDWR | O_CREAT | O_BINARY, 0666);
|
||
|
|
#else
|
||
|
|
bd->fd = open(path, O_RDWR | O_CREAT, 0666);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
if (bd->fd < 0) {
|
||
|
|
int err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_createcfg -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_createcfg -> %d", 0);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int lfs_filebd_create(const struct lfs_config *cfg, const char *path) {
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_create(%p {.context=%p, "
|
||
|
|
".read=%p, .prog=%p, .erase=%p, .sync=%p, "
|
||
|
|
".read_size=%"PRIu32", .prog_size=%"PRIu32", "
|
||
|
|
".block_size=%"PRIu32", .block_count=%"PRIu32"}, "
|
||
|
|
"\"%s\")",
|
||
|
|
(void*)cfg, cfg->context,
|
||
|
|
(void*)(uintptr_t)cfg->read, (void*)(uintptr_t)cfg->prog,
|
||
|
|
(void*)(uintptr_t)cfg->erase, (void*)(uintptr_t)cfg->sync,
|
||
|
|
cfg->read_size, cfg->prog_size, cfg->block_size, cfg->block_count,
|
||
|
|
path);
|
||
|
|
static const struct lfs_filebd_config defaults = {.erase_value=-1};
|
||
|
|
int err = lfs_filebd_createcfg(cfg, path, &defaults);
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_create -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
int lfs_filebd_destroy(const struct lfs_config *cfg) {
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_destroy(%p)", (void*)cfg);
|
||
|
|
lfs_filebd_t *bd = cfg->context;
|
||
|
|
int err = close(bd->fd);
|
||
|
|
if (err < 0) {
|
||
|
|
err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_destroy -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_destroy -> %d", 0);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int lfs_filebd_read(const struct lfs_config *cfg, lfs_block_t block,
|
||
|
|
lfs_off_t off, void *buffer, lfs_size_t size) {
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_read(%p, "
|
||
|
|
"0x%"PRIx32", %"PRIu32", %p, %"PRIu32")",
|
||
|
|
(void*)cfg, block, off, buffer, size);
|
||
|
|
lfs_filebd_t *bd = cfg->context;
|
||
|
|
|
||
|
|
// check if read is valid
|
||
|
|
LFS_ASSERT(off % cfg->read_size == 0);
|
||
|
|
LFS_ASSERT(size % cfg->read_size == 0);
|
||
|
|
LFS_ASSERT(block < cfg->block_count);
|
||
|
|
|
||
|
|
// zero for reproducibility (in case file is truncated)
|
||
|
|
if (bd->cfg->erase_value != -1) {
|
||
|
|
memset(buffer, bd->cfg->erase_value, size);
|
||
|
|
}
|
||
|
|
|
||
|
|
// read
|
||
|
|
off_t res1 = lseek(bd->fd,
|
||
|
|
(off_t)block*cfg->block_size + (off_t)off, SEEK_SET);
|
||
|
|
if (res1 < 0) {
|
||
|
|
int err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_read -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
ssize_t res2 = read(bd->fd, buffer, size);
|
||
|
|
if (res2 < 0) {
|
||
|
|
int err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_read -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_read -> %d", 0);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int lfs_filebd_prog(const struct lfs_config *cfg, lfs_block_t block,
|
||
|
|
lfs_off_t off, const void *buffer, lfs_size_t size) {
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_prog(%p, 0x%"PRIx32", %"PRIu32", %p, %"PRIu32")",
|
||
|
|
(void*)cfg, block, off, buffer, size);
|
||
|
|
lfs_filebd_t *bd = cfg->context;
|
||
|
|
|
||
|
|
// check if write is valid
|
||
|
|
LFS_ASSERT(off % cfg->prog_size == 0);
|
||
|
|
LFS_ASSERT(size % cfg->prog_size == 0);
|
||
|
|
LFS_ASSERT(block < cfg->block_count);
|
||
|
|
|
||
|
|
// check that data was erased? only needed for testing
|
||
|
|
if (bd->cfg->erase_value != -1) {
|
||
|
|
off_t res1 = lseek(bd->fd,
|
||
|
|
(off_t)block*cfg->block_size + (off_t)off, SEEK_SET);
|
||
|
|
if (res1 < 0) {
|
||
|
|
int err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
for (lfs_off_t i = 0; i < size; i++) {
|
||
|
|
uint8_t c;
|
||
|
|
ssize_t res2 = read(bd->fd, &c, 1);
|
||
|
|
if (res2 < 0) {
|
||
|
|
int err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
LFS_ASSERT(c == bd->cfg->erase_value);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// program data
|
||
|
|
off_t res1 = lseek(bd->fd,
|
||
|
|
(off_t)block*cfg->block_size + (off_t)off, SEEK_SET);
|
||
|
|
if (res1 < 0) {
|
||
|
|
int err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
ssize_t res2 = write(bd->fd, buffer, size);
|
||
|
|
if (res2 < 0) {
|
||
|
|
int err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_prog -> %d", 0);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int lfs_filebd_erase(const struct lfs_config *cfg, lfs_block_t block) {
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_erase(%p, 0x%"PRIx32")", (void*)cfg, block);
|
||
|
|
lfs_filebd_t *bd = cfg->context;
|
||
|
|
|
||
|
|
// check if erase is valid
|
||
|
|
LFS_ASSERT(block < cfg->block_count);
|
||
|
|
|
||
|
|
// erase, only needed for testing
|
||
|
|
if (bd->cfg->erase_value != -1) {
|
||
|
|
off_t res1 = lseek(bd->fd, (off_t)block*cfg->block_size, SEEK_SET);
|
||
|
|
if (res1 < 0) {
|
||
|
|
int err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_erase -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
for (lfs_off_t i = 0; i < cfg->block_size; i++) {
|
||
|
|
ssize_t res2 = write(bd->fd, &(uint8_t){bd->cfg->erase_value}, 1);
|
||
|
|
if (res2 < 0) {
|
||
|
|
int err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_erase -> %d", err);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_erase -> %d", 0);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int lfs_filebd_sync(const struct lfs_config *cfg) {
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_sync(%p)", (void*)cfg);
|
||
|
|
// file sync
|
||
|
|
lfs_filebd_t *bd = cfg->context;
|
||
|
|
#ifdef _WIN32
|
||
|
|
int err = FlushFileBuffers((HANDLE) _get_osfhandle(fd)) ? 0 : -1;
|
||
|
|
#else
|
||
|
|
int err = fsync(bd->fd);
|
||
|
|
#endif
|
||
|
|
if (err) {
|
||
|
|
err = -errno;
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_sync -> %d", 0);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
LFS_FILEBD_TRACE("lfs_filebd_sync -> %d", 0);
|
||
|
|
return 0;
|
||
|
|
}
|