#include #include #include #include "storage.h" #include "storage_i.h" #include "storage_message.h" #include #include #include "toolbox/path.h" #define MAX_NAME_LENGTH 256 #define MAX_EXT_LEN 16 #define TAG "StorageAPI" #define S_API_PROLOGUE \ FuriSemaphore* semaphore = furi_semaphore_alloc(1, 0); \ furi_check(semaphore != NULL); #define S_FILE_API_PROLOGUE \ Storage* storage = file->storage; \ furi_assert(storage); #define S_API_EPILOGUE \ furi_check( \ furi_message_queue_put(storage->message_queue, &message, FuriWaitForever) == \ FuriStatusOk); \ furi_semaphore_acquire(semaphore, FuriWaitForever); \ furi_semaphore_free(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); FuriEventFlag* event = context; furi_event_flag_set(event, StorageEventFlagFileClose); } } bool storage_file_open( File* file, const char* path, FS_AccessMode access_mode, FS_OpenMode open_mode) { bool result; FuriEventFlag* event = furi_event_flag_alloc(); 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) { furi_event_flag_wait( event, StorageEventFlagFileClose, FuriFlagWaitAny, FuriWaitForever); } else { break; } } while(true); furi_pubsub_unsubscribe(storage_get_pubsub(file->storage), subscription); furi_event_flag_free(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; FuriEventFlag* event = furi_event_flag_alloc(); 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) { furi_event_flag_wait( event, StorageEventFlagFileClose, FuriFlagWaitAny, FuriWaitForever); } else { break; } } while(true); furi_pubsub_unsubscribe(storage_get_pubsub(file->storage), subscription); furi_event_flag_free(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; } static FS_Error storage_merge_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, file_basename, tmp_new_path; FileInfo fileinfo; string_init(path); string_init(file_basename); string_init(tmp_new_path); do { if((error != FSE_OK) && (error != FSE_EXIST)) break; dir_walk_set_recursive(dir_walk, false); 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 { path_extract_basename(string_get_cstr(path), file_basename); path_concat(new_path, string_get_cstr(file_basename), tmp_new_path); if(fileinfo.flags & FSF_DIRECTORY) { if(storage_common_stat(storage, string_get_cstr(tmp_new_path), &fileinfo) == FSE_OK) { if(fileinfo.flags & FSF_DIRECTORY) { error = storage_common_mkdir(storage, string_get_cstr(tmp_new_path)); if(error != FSE_OK) { break; } } } } error = storage_common_merge( storage, string_get_cstr(path), string_get_cstr(tmp_new_path)); if(error != FSE_OK) { break; } } } } while(false); string_clear(tmp_new_path); string_clear(file_basename); string_clear(path); dir_walk_free(dir_walk); return error; } FS_Error storage_common_merge(Storage* storage, const char* old_path, const char* new_path) { FS_Error error; const char* new_path_tmp; string_t new_path_next; string_init(new_path_next); FileInfo fileinfo; error = storage_common_stat(storage, old_path, &fileinfo); if(error == FSE_OK) { if(fileinfo.flags & FSF_DIRECTORY) { error = storage_merge_recursive(storage, old_path, new_path); } else { error = storage_common_stat(storage, new_path, &fileinfo); if(error == FSE_OK) { string_set_str(new_path_next, new_path); string_t dir_path; string_t filename; char extension[MAX_EXT_LEN]; string_init(dir_path); string_init(filename); path_extract_filename(new_path_next, filename, true); path_extract_dirname(new_path, dir_path); path_extract_extension(new_path_next, extension, MAX_EXT_LEN); storage_get_next_filename( storage, string_get_cstr(dir_path), string_get_cstr(filename), extension, new_path_next, 255); string_cat_printf(dir_path, "/%s%s", string_get_cstr(new_path_next), extension); string_set(new_path_next, dir_path); string_clear(dir_path); string_clear(filename); new_path_tmp = string_get_cstr(new_path_next); } else { new_path_tmp = new_path; } 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_tmp, 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); } } string_clear(new_path_next); 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); }