b2132b2ec7
* Nfc: async pcap worker * nfc: add pcap save to classic emulation Co-authored-by: gornekich <n.gorbadey@gmail.com>
656 lines
17 KiB
C
656 lines
17 KiB
C
#include <furi/record.h>
|
|
#include <m-string.h>
|
|
#include "storage.h"
|
|
#include "storage_i.h"
|
|
#include "storage_message.h"
|
|
#include <toolbox/stream/file_stream.h>
|
|
#include <toolbox/dir_walk.h>
|
|
|
|
#define MAX_NAME_LENGTH 256
|
|
|
|
#define TAG "StorageAPI"
|
|
|
|
#define S_API_PROLOGUE \
|
|
osSemaphoreId_t semaphore = osSemaphoreNew(1, 0, NULL); \
|
|
furi_check(semaphore != NULL);
|
|
|
|
#define S_FILE_API_PROLOGUE \
|
|
Storage* storage = file->storage; \
|
|
furi_assert(storage);
|
|
|
|
#define S_API_EPILOGUE \
|
|
furi_check(osMessageQueuePut(storage->message_queue, &message, 0, osWaitForever) == osOK); \
|
|
osSemaphoreAcquire(semaphore, osWaitForever); \
|
|
osSemaphoreDelete(semaphore);
|
|
|
|
#define S_API_MESSAGE(_command) \
|
|
SAReturn return_data; \
|
|
StorageMessage message = { \
|
|
.semaphore = semaphore, \
|
|
.command = _command, \
|
|
.data = &data, \
|
|
.return_data = &return_data, \
|
|
};
|
|
|
|
#define S_API_DATA_FILE \
|
|
SAData data = { \
|
|
.file = { \
|
|
.file = file, \
|
|
}};
|
|
|
|
#define S_API_DATA_PATH \
|
|
SAData data = { \
|
|
.path = { \
|
|
.path = path, \
|
|
}};
|
|
|
|
#define S_RETURN_BOOL (return_data.bool_value);
|
|
#define S_RETURN_UINT16 (return_data.uint16_value);
|
|
#define S_RETURN_UINT64 (return_data.uint64_value);
|
|
#define S_RETURN_ERROR (return_data.error_value);
|
|
#define S_RETURN_CSTRING (return_data.cstring_value);
|
|
|
|
typedef enum {
|
|
StorageEventFlagFileClose = (1 << 0),
|
|
} StorageEventFlag;
|
|
/****************** FILE ******************/
|
|
|
|
static bool storage_file_open_internal(
|
|
File* file,
|
|
const char* path,
|
|
FS_AccessMode access_mode,
|
|
FS_OpenMode open_mode) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
|
|
SAData data = {
|
|
.fopen = {
|
|
.file = file,
|
|
.path = path,
|
|
.access_mode = access_mode,
|
|
.open_mode = open_mode,
|
|
}};
|
|
|
|
file->type = FileTypeOpenFile;
|
|
|
|
S_API_MESSAGE(StorageCommandFileOpen);
|
|
S_API_EPILOGUE;
|
|
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
static void storage_file_close_callback(const void* message, void* context) {
|
|
const StorageEvent* storage_event = message;
|
|
|
|
if(storage_event->type == StorageEventTypeFileClose ||
|
|
storage_event->type == StorageEventTypeDirClose) {
|
|
furi_assert(context);
|
|
osEventFlagsId_t event = context;
|
|
osEventFlagsSet(event, StorageEventFlagFileClose);
|
|
}
|
|
}
|
|
|
|
bool storage_file_open(
|
|
File* file,
|
|
const char* path,
|
|
FS_AccessMode access_mode,
|
|
FS_OpenMode open_mode) {
|
|
bool result;
|
|
osEventFlagsId_t event = osEventFlagsNew(NULL);
|
|
FuriPubSubSubscription* subscription = furi_pubsub_subscribe(
|
|
storage_get_pubsub(file->storage), storage_file_close_callback, event);
|
|
|
|
do {
|
|
result = storage_file_open_internal(file, path, access_mode, open_mode);
|
|
|
|
if(!result && file->error_id == FSE_ALREADY_OPEN) {
|
|
osEventFlagsWait(event, StorageEventFlagFileClose, osFlagsWaitAny, osWaitForever);
|
|
} else {
|
|
break;
|
|
}
|
|
} while(true);
|
|
|
|
furi_pubsub_unsubscribe(storage_get_pubsub(file->storage), subscription);
|
|
osEventFlagsDelete(event);
|
|
|
|
FURI_LOG_T(
|
|
TAG, "File %p - %p open (%s)", (uint32_t)file - SRAM_BASE, file->file_id - SRAM_BASE, path);
|
|
|
|
return result;
|
|
}
|
|
|
|
bool storage_file_close(File* file) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
|
|
S_API_DATA_FILE;
|
|
S_API_MESSAGE(StorageCommandFileClose);
|
|
S_API_EPILOGUE;
|
|
|
|
FURI_LOG_T(TAG, "File %p - %p closed", (uint32_t)file - SRAM_BASE, file->file_id - SRAM_BASE);
|
|
file->type = FileTypeClosed;
|
|
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
uint16_t storage_file_read(File* file, void* buff, uint16_t bytes_to_read) {
|
|
if(bytes_to_read == 0) {
|
|
return 0;
|
|
}
|
|
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
|
|
SAData data = {
|
|
.fread = {
|
|
.file = file,
|
|
.buff = buff,
|
|
.bytes_to_read = bytes_to_read,
|
|
}};
|
|
|
|
S_API_MESSAGE(StorageCommandFileRead);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_UINT16;
|
|
}
|
|
|
|
uint16_t storage_file_write(File* file, const void* buff, uint16_t bytes_to_write) {
|
|
if(bytes_to_write == 0) {
|
|
return 0;
|
|
}
|
|
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
|
|
SAData data = {
|
|
.fwrite = {
|
|
.file = file,
|
|
.buff = buff,
|
|
.bytes_to_write = bytes_to_write,
|
|
}};
|
|
|
|
S_API_MESSAGE(StorageCommandFileWrite);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_UINT16;
|
|
}
|
|
|
|
bool storage_file_seek(File* file, uint32_t offset, bool from_start) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
|
|
SAData data = {
|
|
.fseek = {
|
|
.file = file,
|
|
.offset = offset,
|
|
.from_start = from_start,
|
|
}};
|
|
|
|
S_API_MESSAGE(StorageCommandFileSeek);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
uint64_t storage_file_tell(File* file) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
S_API_DATA_FILE;
|
|
S_API_MESSAGE(StorageCommandFileTell);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_UINT64;
|
|
}
|
|
|
|
bool storage_file_truncate(File* file) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
S_API_DATA_FILE;
|
|
S_API_MESSAGE(StorageCommandFileTruncate);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
uint64_t storage_file_size(File* file) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
S_API_DATA_FILE;
|
|
S_API_MESSAGE(StorageCommandFileSize);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_UINT64;
|
|
}
|
|
|
|
bool storage_file_sync(File* file) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
S_API_DATA_FILE;
|
|
S_API_MESSAGE(StorageCommandFileSync);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
bool storage_file_eof(File* file) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
S_API_DATA_FILE;
|
|
S_API_MESSAGE(StorageCommandFileEof);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
/****************** DIR ******************/
|
|
|
|
static bool storage_dir_open_internal(File* file, const char* path) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
|
|
SAData data = {
|
|
.dopen = {
|
|
.file = file,
|
|
.path = path,
|
|
}};
|
|
|
|
file->type = FileTypeOpenDir;
|
|
|
|
S_API_MESSAGE(StorageCommandDirOpen);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
bool storage_dir_open(File* file, const char* path) {
|
|
bool result;
|
|
osEventFlagsId_t event = osEventFlagsNew(NULL);
|
|
FuriPubSubSubscription* subscription = furi_pubsub_subscribe(
|
|
storage_get_pubsub(file->storage), storage_file_close_callback, event);
|
|
|
|
do {
|
|
result = storage_dir_open_internal(file, path);
|
|
|
|
if(!result && file->error_id == FSE_ALREADY_OPEN) {
|
|
osEventFlagsWait(event, StorageEventFlagFileClose, osFlagsWaitAny, osWaitForever);
|
|
} else {
|
|
break;
|
|
}
|
|
} while(true);
|
|
|
|
furi_pubsub_unsubscribe(storage_get_pubsub(file->storage), subscription);
|
|
osEventFlagsDelete(event);
|
|
|
|
FURI_LOG_T(
|
|
TAG, "Dir %p - %p open (%s)", (uint32_t)file - SRAM_BASE, file->file_id - SRAM_BASE, path);
|
|
|
|
return result;
|
|
}
|
|
|
|
bool storage_dir_close(File* file) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
S_API_DATA_FILE;
|
|
S_API_MESSAGE(StorageCommandDirClose);
|
|
S_API_EPILOGUE;
|
|
|
|
FURI_LOG_T(TAG, "Dir %p - %p closed", (uint32_t)file - SRAM_BASE, file->file_id - SRAM_BASE);
|
|
|
|
file->type = FileTypeClosed;
|
|
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
bool storage_dir_read(File* file, FileInfo* fileinfo, char* name, uint16_t name_length) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
|
|
SAData data = {
|
|
.dread = {
|
|
.file = file,
|
|
.fileinfo = fileinfo,
|
|
.name = name,
|
|
.name_length = name_length,
|
|
}};
|
|
|
|
S_API_MESSAGE(StorageCommandDirRead);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
bool storage_dir_rewind(File* file) {
|
|
S_FILE_API_PROLOGUE;
|
|
S_API_PROLOGUE;
|
|
S_API_DATA_FILE;
|
|
S_API_MESSAGE(StorageCommandDirRewind);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_BOOL;
|
|
}
|
|
|
|
/****************** COMMON ******************/
|
|
|
|
FS_Error storage_common_stat(Storage* storage, const char* path, FileInfo* fileinfo) {
|
|
S_API_PROLOGUE;
|
|
|
|
SAData data = {.cstat = {.path = path, .fileinfo = fileinfo}};
|
|
|
|
S_API_MESSAGE(StorageCommandCommonStat);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_ERROR;
|
|
}
|
|
|
|
FS_Error storage_common_remove(Storage* storage, const char* path) {
|
|
S_API_PROLOGUE;
|
|
S_API_DATA_PATH;
|
|
S_API_MESSAGE(StorageCommandCommonRemove);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_ERROR;
|
|
}
|
|
|
|
FS_Error storage_common_rename(Storage* storage, const char* old_path, const char* new_path) {
|
|
FS_Error error = storage_common_copy(storage, old_path, new_path);
|
|
if(error == FSE_OK) {
|
|
if(storage_simply_remove_recursive(storage, old_path)) {
|
|
error = FSE_OK;
|
|
} else {
|
|
error = FSE_INTERNAL;
|
|
}
|
|
}
|
|
|
|
return error;
|
|
}
|
|
|
|
static FS_Error
|
|
storage_copy_recursive(Storage* storage, const char* old_path, const char* new_path) {
|
|
FS_Error error = storage_common_mkdir(storage, new_path);
|
|
DirWalk* dir_walk = dir_walk_alloc(storage);
|
|
string_t path;
|
|
string_t tmp_new_path;
|
|
string_t tmp_old_path;
|
|
FileInfo fileinfo;
|
|
string_init(path);
|
|
string_init(tmp_new_path);
|
|
string_init(tmp_old_path);
|
|
|
|
do {
|
|
if(error != FSE_OK) break;
|
|
|
|
if(!dir_walk_open(dir_walk, old_path)) {
|
|
error = dir_walk_get_error(dir_walk);
|
|
break;
|
|
}
|
|
|
|
while(1) {
|
|
DirWalkResult res = dir_walk_read(dir_walk, path, &fileinfo);
|
|
|
|
if(res == DirWalkError) {
|
|
error = dir_walk_get_error(dir_walk);
|
|
break;
|
|
} else if(res == DirWalkLast) {
|
|
break;
|
|
} else {
|
|
string_set(tmp_old_path, path);
|
|
string_right(path, strlen(old_path));
|
|
string_printf(tmp_new_path, "%s%s", new_path, string_get_cstr(path));
|
|
|
|
if(fileinfo.flags & FSF_DIRECTORY) {
|
|
error = storage_common_mkdir(storage, string_get_cstr(tmp_new_path));
|
|
} else {
|
|
error = storage_common_copy(
|
|
storage, string_get_cstr(tmp_old_path), string_get_cstr(tmp_new_path));
|
|
}
|
|
|
|
if(error != FSE_OK) break;
|
|
}
|
|
}
|
|
|
|
} while(false);
|
|
|
|
string_clear(tmp_new_path);
|
|
string_clear(tmp_old_path);
|
|
string_clear(path);
|
|
dir_walk_free(dir_walk);
|
|
return error;
|
|
}
|
|
|
|
FS_Error storage_common_copy(Storage* storage, const char* old_path, const char* new_path) {
|
|
FS_Error error;
|
|
|
|
FileInfo fileinfo;
|
|
error = storage_common_stat(storage, old_path, &fileinfo);
|
|
|
|
if(error == FSE_OK) {
|
|
if(fileinfo.flags & FSF_DIRECTORY) {
|
|
error = storage_copy_recursive(storage, old_path, new_path);
|
|
} else {
|
|
Stream* stream_from = file_stream_alloc(storage);
|
|
Stream* stream_to = file_stream_alloc(storage);
|
|
|
|
do {
|
|
if(!file_stream_open(stream_from, old_path, FSAM_READ, FSOM_OPEN_EXISTING)) break;
|
|
if(!file_stream_open(stream_to, new_path, FSAM_WRITE, FSOM_CREATE_NEW)) break;
|
|
stream_copy_full(stream_from, stream_to);
|
|
} while(false);
|
|
|
|
error = file_stream_get_error(stream_from);
|
|
if(error == FSE_OK) {
|
|
error = file_stream_get_error(stream_to);
|
|
}
|
|
|
|
stream_free(stream_from);
|
|
stream_free(stream_to);
|
|
}
|
|
}
|
|
|
|
return error;
|
|
}
|
|
|
|
FS_Error storage_common_mkdir(Storage* storage, const char* path) {
|
|
S_API_PROLOGUE;
|
|
S_API_DATA_PATH;
|
|
S_API_MESSAGE(StorageCommandCommonMkDir);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_ERROR;
|
|
}
|
|
|
|
FS_Error storage_common_fs_info(
|
|
Storage* storage,
|
|
const char* fs_path,
|
|
uint64_t* total_space,
|
|
uint64_t* free_space) {
|
|
S_API_PROLOGUE;
|
|
|
|
SAData data = {
|
|
.cfsinfo = {
|
|
.fs_path = fs_path,
|
|
.total_space = total_space,
|
|
.free_space = free_space,
|
|
}};
|
|
|
|
S_API_MESSAGE(StorageCommandCommonFSInfo);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_ERROR;
|
|
}
|
|
|
|
/****************** ERROR ******************/
|
|
|
|
const char* storage_error_get_desc(FS_Error error_id) {
|
|
return filesystem_api_error_get_desc(error_id);
|
|
}
|
|
|
|
FS_Error storage_file_get_error(File* file) {
|
|
furi_check(file != NULL);
|
|
return file->error_id;
|
|
}
|
|
|
|
int32_t storage_file_get_internal_error(File* file) {
|
|
furi_check(file != NULL);
|
|
return file->internal_error_id;
|
|
}
|
|
|
|
const char* storage_file_get_error_desc(File* file) {
|
|
furi_check(file != NULL);
|
|
return filesystem_api_error_get_desc(file->error_id);
|
|
}
|
|
|
|
/****************** Raw SD API ******************/
|
|
|
|
FS_Error storage_sd_format(Storage* storage) {
|
|
S_API_PROLOGUE;
|
|
SAData data = {};
|
|
S_API_MESSAGE(StorageCommandSDFormat);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_ERROR;
|
|
}
|
|
|
|
FS_Error storage_sd_unmount(Storage* storage) {
|
|
S_API_PROLOGUE;
|
|
SAData data = {};
|
|
S_API_MESSAGE(StorageCommandSDUnmount);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_ERROR;
|
|
}
|
|
|
|
FS_Error storage_sd_info(Storage* storage, SDInfo* info) {
|
|
S_API_PROLOGUE;
|
|
SAData data = {
|
|
.sdinfo = {
|
|
.info = info,
|
|
}};
|
|
S_API_MESSAGE(StorageCommandSDInfo);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_ERROR;
|
|
}
|
|
|
|
FS_Error storage_sd_status(Storage* storage) {
|
|
S_API_PROLOGUE;
|
|
SAData data = {};
|
|
S_API_MESSAGE(StorageCommandSDStatus);
|
|
S_API_EPILOGUE;
|
|
return S_RETURN_ERROR;
|
|
}
|
|
|
|
File* storage_file_alloc(Storage* storage) {
|
|
File* file = malloc(sizeof(File));
|
|
file->type = FileTypeClosed;
|
|
file->storage = storage;
|
|
|
|
FURI_LOG_T(TAG, "File/Dir %p alloc", (uint32_t)file - SRAM_BASE);
|
|
|
|
return file;
|
|
}
|
|
|
|
bool storage_file_is_open(File* file) {
|
|
return (file->type != FileTypeClosed);
|
|
}
|
|
|
|
bool storage_file_is_dir(File* file) {
|
|
return (file->type == FileTypeOpenDir);
|
|
}
|
|
|
|
void storage_file_free(File* file) {
|
|
if(storage_file_is_open(file)) {
|
|
if(storage_file_is_dir(file)) {
|
|
storage_dir_close(file);
|
|
} else {
|
|
storage_file_close(file);
|
|
}
|
|
}
|
|
|
|
FURI_LOG_T(TAG, "File/Dir %p free", (uint32_t)file - SRAM_BASE);
|
|
free(file);
|
|
}
|
|
|
|
FuriPubSub* storage_get_pubsub(Storage* storage) {
|
|
return storage->pubsub;
|
|
}
|
|
|
|
bool storage_simply_remove_recursive(Storage* storage, const char* path) {
|
|
furi_assert(storage);
|
|
furi_assert(path);
|
|
FileInfo fileinfo;
|
|
bool result = false;
|
|
string_t fullname;
|
|
string_t cur_dir;
|
|
|
|
if(storage_simply_remove(storage, path)) {
|
|
return true;
|
|
}
|
|
|
|
char* name = malloc(MAX_NAME_LENGTH + 1);
|
|
File* dir = storage_file_alloc(storage);
|
|
string_init_set_str(cur_dir, path);
|
|
bool go_deeper = false;
|
|
|
|
while(1) {
|
|
if(!storage_dir_open(dir, string_get_cstr(cur_dir))) {
|
|
storage_dir_close(dir);
|
|
break;
|
|
}
|
|
|
|
while(storage_dir_read(dir, &fileinfo, name, MAX_NAME_LENGTH)) {
|
|
if(fileinfo.flags & FSF_DIRECTORY) {
|
|
string_cat_printf(cur_dir, "/%s", name);
|
|
go_deeper = true;
|
|
break;
|
|
}
|
|
|
|
string_init_printf(fullname, "%s/%s", string_get_cstr(cur_dir), name);
|
|
FS_Error error = storage_common_remove(storage, string_get_cstr(fullname));
|
|
furi_check(error == FSE_OK);
|
|
string_clear(fullname);
|
|
}
|
|
storage_dir_close(dir);
|
|
|
|
if(go_deeper) {
|
|
go_deeper = false;
|
|
continue;
|
|
}
|
|
|
|
FS_Error error = storage_common_remove(storage, string_get_cstr(cur_dir));
|
|
furi_check(error == FSE_OK);
|
|
|
|
if(string_cmp(cur_dir, path)) {
|
|
size_t last_char = string_search_rchar(cur_dir, '/');
|
|
furi_assert(last_char != STRING_FAILURE);
|
|
string_left(cur_dir, last_char);
|
|
} else {
|
|
result = true;
|
|
break;
|
|
}
|
|
}
|
|
|
|
storage_file_free(dir);
|
|
string_clear(cur_dir);
|
|
free(name);
|
|
return result;
|
|
}
|
|
|
|
bool storage_simply_remove(Storage* storage, const char* path) {
|
|
FS_Error result;
|
|
result = storage_common_remove(storage, path);
|
|
return result == FSE_OK || result == FSE_NOT_EXIST;
|
|
}
|
|
|
|
bool storage_simply_mkdir(Storage* storage, const char* path) {
|
|
FS_Error result;
|
|
result = storage_common_mkdir(storage, path);
|
|
return result == FSE_OK || result == FSE_EXIST;
|
|
}
|
|
|
|
void storage_get_next_filename(
|
|
Storage* storage,
|
|
const char* dirname,
|
|
const char* filename,
|
|
const char* fileextension,
|
|
string_t nextfilename,
|
|
uint8_t max_len) {
|
|
string_t temp_str;
|
|
uint16_t num = 0;
|
|
|
|
string_init_printf(temp_str, "%s/%s%s", dirname, filename, fileextension);
|
|
|
|
while(storage_common_stat(storage, string_get_cstr(temp_str), NULL) == FSE_OK) {
|
|
num++;
|
|
string_printf(temp_str, "%s/%s%d%s", dirname, filename, num, fileextension);
|
|
}
|
|
if(num && (max_len > strlen(filename))) {
|
|
string_printf(nextfilename, "%s%d", filename, num);
|
|
} else {
|
|
string_printf(nextfilename, "%s", filename);
|
|
}
|
|
|
|
string_clear(temp_str);
|
|
}
|