storage_int.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755
  1. #include "storage_int.h"
  2. #include <lfs.h>
  3. #include <furi_hal.h>
  4. #include <toolbox/path.h>
  5. #define TAG "StorageInt"
  6. #define STORAGE_PATH STORAGE_INT_PATH_PREFIX
  7. #define LFS_CLEAN_FINGERPRINT 0
  8. /* When less than LFS_RESERVED_PAGES_COUNT are left free, creation &
  9. * modification of non-dot files is restricted */
  10. #define LFS_RESERVED_PAGES_COUNT 3
  11. typedef struct {
  12. const size_t start_address;
  13. const size_t start_page;
  14. struct lfs_config config;
  15. lfs_t lfs;
  16. } LFSData;
  17. typedef struct {
  18. void* data;
  19. bool open;
  20. } LFSHandle;
  21. static LFSHandle* lfs_handle_alloc_file() {
  22. LFSHandle* handle = malloc(sizeof(LFSHandle));
  23. handle->data = malloc(sizeof(lfs_file_t));
  24. return handle;
  25. }
  26. static LFSHandle* lfs_handle_alloc_dir() {
  27. LFSHandle* handle = malloc(sizeof(LFSHandle));
  28. handle->data = malloc(sizeof(lfs_dir_t));
  29. return handle;
  30. }
  31. /* INTERNALS */
  32. static lfs_dir_t* lfs_handle_get_dir(LFSHandle* handle) {
  33. return handle->data;
  34. }
  35. static lfs_file_t* lfs_handle_get_file(LFSHandle* handle) {
  36. return handle->data;
  37. }
  38. static void lfs_handle_free(LFSHandle* handle) {
  39. free(handle->data);
  40. free(handle);
  41. }
  42. static void lfs_handle_set_open(LFSHandle* handle) {
  43. handle->open = true;
  44. }
  45. static bool lfs_handle_is_open(LFSHandle* handle) {
  46. return handle->open;
  47. }
  48. static lfs_t* lfs_get_from_storage(StorageData* storage) {
  49. return &((LFSData*)storage->data)->lfs;
  50. }
  51. static LFSData* lfs_data_get_from_storage(StorageData* storage) {
  52. return (LFSData*)storage->data;
  53. }
  54. static int storage_int_device_read(
  55. const struct lfs_config* c,
  56. lfs_block_t block,
  57. lfs_off_t off,
  58. void* buffer,
  59. lfs_size_t size) {
  60. LFSData* lfs_data = c->context;
  61. size_t address = lfs_data->start_address + block * c->block_size + off;
  62. FURI_LOG_T(
  63. TAG,
  64. "Device read: block %d, off %d, buffer: %p, size %d, translated address: %p",
  65. block,
  66. off,
  67. buffer,
  68. size,
  69. address);
  70. memcpy(buffer, (void*)address, size);
  71. return 0;
  72. }
  73. static int storage_int_device_prog(
  74. const struct lfs_config* c,
  75. lfs_block_t block,
  76. lfs_off_t off,
  77. const void* buffer,
  78. lfs_size_t size) {
  79. LFSData* lfs_data = c->context;
  80. size_t address = lfs_data->start_address + block * c->block_size + off;
  81. FURI_LOG_T(
  82. TAG,
  83. "Device prog: block %d, off %d, buffer: %p, size %d, translated address: %p",
  84. block,
  85. off,
  86. buffer,
  87. size,
  88. address);
  89. int ret = 0;
  90. while(size > 0) {
  91. furi_hal_flash_write_dword(address, *(uint64_t*)buffer);
  92. address += c->prog_size;
  93. buffer += c->prog_size;
  94. size -= c->prog_size;
  95. }
  96. return ret;
  97. }
  98. static int storage_int_device_erase(const struct lfs_config* c, lfs_block_t block) {
  99. LFSData* lfs_data = c->context;
  100. size_t page = lfs_data->start_page + block;
  101. FURI_LOG_D(TAG, "Device erase: page %d, translated page: %x", block, page);
  102. furi_hal_flash_erase(page);
  103. return 0;
  104. }
  105. static int storage_int_device_sync(const struct lfs_config* c) {
  106. UNUSED(c);
  107. FURI_LOG_D(TAG, "Device sync: skipping");
  108. return 0;
  109. }
  110. static LFSData* storage_int_lfs_data_alloc() {
  111. LFSData* lfs_data = malloc(sizeof(LFSData));
  112. // Internal storage start address
  113. *(size_t*)(&lfs_data->start_address) = furi_hal_flash_get_free_page_start_address();
  114. *(size_t*)(&lfs_data->start_page) =
  115. (lfs_data->start_address - furi_hal_flash_get_base()) / furi_hal_flash_get_page_size();
  116. // LFS configuration
  117. // Glue and context
  118. lfs_data->config.context = lfs_data;
  119. lfs_data->config.read = storage_int_device_read;
  120. lfs_data->config.prog = storage_int_device_prog;
  121. lfs_data->config.erase = storage_int_device_erase;
  122. lfs_data->config.sync = storage_int_device_sync;
  123. // Block device description
  124. lfs_data->config.read_size = furi_hal_flash_get_read_block_size();
  125. lfs_data->config.prog_size = furi_hal_flash_get_write_block_size();
  126. lfs_data->config.block_size = furi_hal_flash_get_page_size();
  127. lfs_data->config.block_count = furi_hal_flash_get_free_page_count();
  128. lfs_data->config.block_cycles = furi_hal_flash_get_cycles_count();
  129. lfs_data->config.cache_size = 16;
  130. lfs_data->config.lookahead_size = 16;
  131. return lfs_data;
  132. };
  133. // Returns true if fingerprint was invalid and LFS reformatting is needed
  134. static bool storage_int_check_and_set_fingerprint(LFSData* lfs_data) {
  135. bool value = false;
  136. uint32_t os_fingerprint = 0;
  137. os_fingerprint |= ((lfs_data->start_page & 0xFF) << 0);
  138. os_fingerprint |= ((lfs_data->config.block_count & 0xFF) << 8);
  139. os_fingerprint |= ((LFS_DISK_VERSION_MAJOR & 0xFFFF) << 16);
  140. uint32_t rtc_fingerprint = furi_hal_rtc_get_register(FuriHalRtcRegisterLfsFingerprint);
  141. if(rtc_fingerprint == LFS_CLEAN_FINGERPRINT) {
  142. FURI_LOG_I(TAG, "Storing LFS fingerprint in RTC");
  143. furi_hal_rtc_set_register(FuriHalRtcRegisterLfsFingerprint, os_fingerprint);
  144. } else if(rtc_fingerprint != os_fingerprint) {
  145. FURI_LOG_E(TAG, "LFS fingerprint mismatch");
  146. furi_hal_rtc_set_register(FuriHalRtcRegisterLfsFingerprint, os_fingerprint);
  147. value = true;
  148. }
  149. return value;
  150. }
  151. static void storage_int_lfs_mount(LFSData* lfs_data, StorageData* storage) {
  152. int err;
  153. lfs_t* lfs = &lfs_data->lfs;
  154. bool was_fingerprint_outdated = storage_int_check_and_set_fingerprint(lfs_data);
  155. bool need_format = furi_hal_rtc_is_flag_set(FuriHalRtcFlagFactoryReset) ||
  156. was_fingerprint_outdated;
  157. if(need_format) {
  158. // Format storage
  159. err = lfs_format(lfs, &lfs_data->config);
  160. if(err == 0) {
  161. FURI_LOG_I(TAG, "Factory reset: Format successful, trying to mount");
  162. furi_hal_rtc_reset_flag(FuriHalRtcFlagFactoryReset);
  163. err = lfs_mount(lfs, &lfs_data->config);
  164. if(err == 0) {
  165. FURI_LOG_I(TAG, "Factory reset: Mounted");
  166. storage->status = StorageStatusOK;
  167. } else {
  168. FURI_LOG_E(TAG, "Factory reset: Mount after format failed");
  169. storage->status = StorageStatusNotMounted;
  170. }
  171. } else {
  172. FURI_LOG_E(TAG, "Factory reset: Format failed");
  173. storage->status = StorageStatusNoFS;
  174. }
  175. } else {
  176. // Normal
  177. err = lfs_mount(lfs, &lfs_data->config);
  178. if(err == 0) {
  179. FURI_LOG_I(TAG, "Mounted");
  180. storage->status = StorageStatusOK;
  181. } else {
  182. FURI_LOG_E(TAG, "Mount failed, formatting");
  183. err = lfs_format(lfs, &lfs_data->config);
  184. if(err == 0) {
  185. FURI_LOG_I(TAG, "Format successful, trying to mount");
  186. err = lfs_mount(lfs, &lfs_data->config);
  187. if(err == 0) {
  188. FURI_LOG_I(TAG, "Mounted");
  189. storage->status = StorageStatusOK;
  190. } else {
  191. FURI_LOG_E(TAG, "Mount after format failed");
  192. storage->status = StorageStatusNotMounted;
  193. }
  194. } else {
  195. FURI_LOG_E(TAG, "Format failed");
  196. storage->status = StorageStatusNoFS;
  197. }
  198. }
  199. }
  200. }
  201. /****************** Common Functions ******************/
  202. static FS_Error storage_int_parse_error(int error) {
  203. FS_Error result = FSE_INTERNAL;
  204. if(error >= LFS_ERR_OK) {
  205. result = FSE_OK;
  206. } else {
  207. switch(error) {
  208. case LFS_ERR_IO:
  209. result = FSE_INTERNAL;
  210. break;
  211. case LFS_ERR_CORRUPT:
  212. result = FSE_INTERNAL;
  213. break;
  214. case LFS_ERR_NOENT:
  215. result = FSE_NOT_EXIST;
  216. break;
  217. case LFS_ERR_EXIST:
  218. result = FSE_EXIST;
  219. break;
  220. case LFS_ERR_NOTDIR:
  221. result = FSE_INVALID_NAME;
  222. break;
  223. case LFS_ERR_ISDIR:
  224. result = FSE_INVALID_NAME;
  225. break;
  226. case LFS_ERR_NOTEMPTY:
  227. result = FSE_DENIED;
  228. break;
  229. case LFS_ERR_BADF:
  230. result = FSE_INVALID_NAME;
  231. break;
  232. case LFS_ERR_FBIG:
  233. result = FSE_INTERNAL;
  234. break;
  235. case LFS_ERR_INVAL:
  236. result = FSE_INVALID_PARAMETER;
  237. break;
  238. case LFS_ERR_NOSPC:
  239. result = FSE_INTERNAL;
  240. break;
  241. case LFS_ERR_NOMEM:
  242. result = FSE_INTERNAL;
  243. break;
  244. case LFS_ERR_NOATTR:
  245. result = FSE_INVALID_PARAMETER;
  246. break;
  247. case LFS_ERR_NAMETOOLONG:
  248. result = FSE_INVALID_NAME;
  249. break;
  250. default:
  251. break;
  252. }
  253. }
  254. return result;
  255. }
  256. /* Returns false if less than reserved space is left free */
  257. static bool storage_int_check_for_free_space(StorageData* storage) {
  258. LFSData* lfs_data = lfs_data_get_from_storage(storage);
  259. lfs_ssize_t result = lfs_fs_size(lfs_get_from_storage(storage));
  260. if(result >= 0) {
  261. lfs_size_t free_space =
  262. (lfs_data->config.block_count - result) * lfs_data->config.block_size;
  263. return (free_space > LFS_RESERVED_PAGES_COUNT * furi_hal_flash_get_page_size());
  264. }
  265. return false;
  266. }
  267. /******************* File Functions *******************/
  268. static bool storage_int_file_open(
  269. void* ctx,
  270. File* file,
  271. const char* path,
  272. FS_AccessMode access_mode,
  273. FS_OpenMode open_mode) {
  274. StorageData* storage = ctx;
  275. lfs_t* lfs = lfs_get_from_storage(storage);
  276. bool enough_free_space = storage_int_check_for_free_space(storage);
  277. int flags = 0;
  278. if(access_mode & FSAM_READ) flags |= LFS_O_RDONLY;
  279. if(access_mode & FSAM_WRITE) flags |= LFS_O_WRONLY;
  280. if(open_mode & FSOM_OPEN_EXISTING) flags |= 0;
  281. if(open_mode & FSOM_OPEN_ALWAYS) flags |= LFS_O_CREAT;
  282. if(open_mode & FSOM_OPEN_APPEND) flags |= LFS_O_CREAT | LFS_O_APPEND;
  283. if(open_mode & FSOM_CREATE_NEW) flags |= LFS_O_CREAT | LFS_O_EXCL;
  284. if(open_mode & FSOM_CREATE_ALWAYS) flags |= LFS_O_CREAT | LFS_O_TRUNC;
  285. LFSHandle* handle = lfs_handle_alloc_file();
  286. storage_set_storage_file_data(file, handle, storage);
  287. if(!enough_free_space) {
  288. string_t filename;
  289. string_init(filename);
  290. path_extract_basename(path, filename);
  291. bool is_dot_file = (!string_empty_p(filename) && (string_get_char(filename, 0) == '.'));
  292. string_clear(filename);
  293. /* Restrict write & creation access to all non-dot files */
  294. if(!is_dot_file && (flags & (LFS_O_CREAT | LFS_O_WRONLY))) {
  295. file->internal_error_id = LFS_ERR_NOSPC;
  296. file->error_id = FSE_DENIED;
  297. FURI_LOG_W(TAG, "Denied access to '%s': no free space", path);
  298. return false;
  299. }
  300. }
  301. file->internal_error_id = lfs_file_open(lfs, lfs_handle_get_file(handle), path, flags);
  302. if(file->internal_error_id >= LFS_ERR_OK) {
  303. lfs_handle_set_open(handle);
  304. }
  305. file->error_id = storage_int_parse_error(file->internal_error_id);
  306. return (file->error_id == FSE_OK);
  307. }
  308. static bool storage_int_file_close(void* ctx, File* file) {
  309. StorageData* storage = ctx;
  310. lfs_t* lfs = lfs_get_from_storage(storage);
  311. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  312. if(lfs_handle_is_open(handle)) {
  313. file->internal_error_id = lfs_file_close(lfs, lfs_handle_get_file(handle));
  314. } else {
  315. file->internal_error_id = LFS_ERR_BADF;
  316. }
  317. file->error_id = storage_int_parse_error(file->internal_error_id);
  318. lfs_handle_free(handle);
  319. return (file->error_id == FSE_OK);
  320. }
  321. static uint16_t
  322. storage_int_file_read(void* ctx, File* file, void* buff, uint16_t const bytes_to_read) {
  323. StorageData* storage = ctx;
  324. lfs_t* lfs = lfs_get_from_storage(storage);
  325. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  326. uint16_t bytes_read = 0;
  327. if(lfs_handle_is_open(handle)) {
  328. file->internal_error_id =
  329. lfs_file_read(lfs, lfs_handle_get_file(handle), buff, bytes_to_read);
  330. } else {
  331. file->internal_error_id = LFS_ERR_BADF;
  332. }
  333. file->error_id = storage_int_parse_error(file->internal_error_id);
  334. if(file->error_id == FSE_OK) {
  335. bytes_read = file->internal_error_id;
  336. file->internal_error_id = 0;
  337. }
  338. return bytes_read;
  339. }
  340. static uint16_t
  341. storage_int_file_write(void* ctx, File* file, const void* buff, uint16_t const bytes_to_write) {
  342. StorageData* storage = ctx;
  343. lfs_t* lfs = lfs_get_from_storage(storage);
  344. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  345. uint16_t bytes_written = 0;
  346. if(lfs_handle_is_open(handle)) {
  347. file->internal_error_id =
  348. lfs_file_write(lfs, lfs_handle_get_file(handle), buff, bytes_to_write);
  349. } else {
  350. file->internal_error_id = LFS_ERR_BADF;
  351. }
  352. file->error_id = storage_int_parse_error(file->internal_error_id);
  353. if(file->error_id == FSE_OK) {
  354. bytes_written = file->internal_error_id;
  355. file->internal_error_id = 0;
  356. }
  357. return bytes_written;
  358. }
  359. static bool
  360. storage_int_file_seek(void* ctx, File* file, const uint32_t offset, const bool from_start) {
  361. StorageData* storage = ctx;
  362. lfs_t* lfs = lfs_get_from_storage(storage);
  363. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  364. if(lfs_handle_is_open(handle)) {
  365. if(from_start) {
  366. file->internal_error_id =
  367. lfs_file_seek(lfs, lfs_handle_get_file(handle), offset, LFS_SEEK_SET);
  368. } else {
  369. file->internal_error_id =
  370. lfs_file_seek(lfs, lfs_handle_get_file(handle), offset, LFS_SEEK_CUR);
  371. }
  372. } else {
  373. file->internal_error_id = LFS_ERR_BADF;
  374. }
  375. file->error_id = storage_int_parse_error(file->internal_error_id);
  376. return (file->error_id == FSE_OK);
  377. }
  378. static uint64_t storage_int_file_tell(void* ctx, File* file) {
  379. StorageData* storage = ctx;
  380. lfs_t* lfs = lfs_get_from_storage(storage);
  381. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  382. if(lfs_handle_is_open(handle)) {
  383. file->internal_error_id = lfs_file_tell(lfs, lfs_handle_get_file(handle));
  384. } else {
  385. file->internal_error_id = LFS_ERR_BADF;
  386. }
  387. file->error_id = storage_int_parse_error(file->internal_error_id);
  388. int32_t position = 0;
  389. if(file->error_id == FSE_OK) {
  390. position = file->internal_error_id;
  391. file->internal_error_id = 0;
  392. }
  393. return position;
  394. }
  395. static bool storage_int_file_truncate(void* ctx, File* file) {
  396. StorageData* storage = ctx;
  397. lfs_t* lfs = lfs_get_from_storage(storage);
  398. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  399. if(lfs_handle_is_open(handle)) {
  400. file->internal_error_id = lfs_file_tell(lfs, lfs_handle_get_file(handle));
  401. file->error_id = storage_int_parse_error(file->internal_error_id);
  402. if(file->error_id == FSE_OK) {
  403. uint32_t position = file->internal_error_id;
  404. file->internal_error_id =
  405. lfs_file_truncate(lfs, lfs_handle_get_file(handle), position);
  406. file->error_id = storage_int_parse_error(file->internal_error_id);
  407. }
  408. } else {
  409. file->internal_error_id = LFS_ERR_BADF;
  410. file->error_id = storage_int_parse_error(file->internal_error_id);
  411. }
  412. return (file->error_id == FSE_OK);
  413. }
  414. static bool storage_int_file_sync(void* ctx, File* file) {
  415. StorageData* storage = ctx;
  416. lfs_t* lfs = lfs_get_from_storage(storage);
  417. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  418. if(lfs_handle_is_open(handle)) {
  419. file->internal_error_id = lfs_file_sync(lfs, lfs_handle_get_file(handle));
  420. } else {
  421. file->internal_error_id = LFS_ERR_BADF;
  422. }
  423. file->error_id = storage_int_parse_error(file->internal_error_id);
  424. return (file->error_id == FSE_OK);
  425. }
  426. static uint64_t storage_int_file_size(void* ctx, File* file) {
  427. StorageData* storage = ctx;
  428. lfs_t* lfs = lfs_get_from_storage(storage);
  429. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  430. if(lfs_handle_is_open(handle)) {
  431. file->internal_error_id = lfs_file_size(lfs, lfs_handle_get_file(handle));
  432. } else {
  433. file->internal_error_id = LFS_ERR_BADF;
  434. }
  435. file->error_id = storage_int_parse_error(file->internal_error_id);
  436. uint32_t size = 0;
  437. if(file->error_id == FSE_OK) {
  438. size = file->internal_error_id;
  439. file->internal_error_id = 0;
  440. }
  441. return size;
  442. }
  443. static bool storage_int_file_eof(void* ctx, File* file) {
  444. StorageData* storage = ctx;
  445. lfs_t* lfs = lfs_get_from_storage(storage);
  446. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  447. bool eof = true;
  448. if(lfs_handle_is_open(handle)) {
  449. int32_t position = lfs_file_tell(lfs, lfs_handle_get_file(handle));
  450. int32_t size = lfs_file_size(lfs, lfs_handle_get_file(handle));
  451. if(position < 0) {
  452. file->internal_error_id = position;
  453. } else if(size < 0) {
  454. file->internal_error_id = size;
  455. } else {
  456. file->internal_error_id = LFS_ERR_OK;
  457. eof = (position >= size);
  458. }
  459. } else {
  460. file->internal_error_id = LFS_ERR_BADF;
  461. }
  462. file->error_id = storage_int_parse_error(file->internal_error_id);
  463. return eof;
  464. }
  465. /******************* Dir Functions *******************/
  466. static bool storage_int_dir_open(void* ctx, File* file, const char* path) {
  467. StorageData* storage = ctx;
  468. lfs_t* lfs = lfs_get_from_storage(storage);
  469. LFSHandle* handle = lfs_handle_alloc_dir();
  470. storage_set_storage_file_data(file, handle, storage);
  471. file->internal_error_id = lfs_dir_open(lfs, lfs_handle_get_dir(handle), path);
  472. if(file->internal_error_id >= LFS_ERR_OK) {
  473. lfs_handle_set_open(handle);
  474. }
  475. file->error_id = storage_int_parse_error(file->internal_error_id);
  476. return (file->error_id == FSE_OK);
  477. }
  478. static bool storage_int_dir_close(void* ctx, File* file) {
  479. StorageData* storage = ctx;
  480. lfs_t* lfs = lfs_get_from_storage(storage);
  481. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  482. if(lfs_handle_is_open(handle)) {
  483. file->internal_error_id = lfs_dir_close(lfs, lfs_handle_get_dir(handle));
  484. } else {
  485. file->internal_error_id = LFS_ERR_BADF;
  486. }
  487. file->error_id = storage_int_parse_error(file->internal_error_id);
  488. lfs_handle_free(handle);
  489. return (file->error_id == FSE_OK);
  490. }
  491. static bool storage_int_dir_read(
  492. void* ctx,
  493. File* file,
  494. FileInfo* fileinfo,
  495. char* name,
  496. const uint16_t name_length) {
  497. StorageData* storage = ctx;
  498. lfs_t* lfs = lfs_get_from_storage(storage);
  499. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  500. if(lfs_handle_is_open(handle)) {
  501. struct lfs_info _fileinfo;
  502. // LFS returns virtual directories "." and "..", so we read until we get something meaningful or an empty string
  503. do {
  504. file->internal_error_id = lfs_dir_read(lfs, lfs_handle_get_dir(handle), &_fileinfo);
  505. file->error_id = storage_int_parse_error(file->internal_error_id);
  506. } while(strcmp(_fileinfo.name, ".") == 0 || strcmp(_fileinfo.name, "..") == 0);
  507. if(fileinfo != NULL) {
  508. fileinfo->size = _fileinfo.size;
  509. fileinfo->flags = 0;
  510. if(_fileinfo.type & LFS_TYPE_DIR) fileinfo->flags |= FSF_DIRECTORY;
  511. }
  512. if(name != NULL) {
  513. snprintf(name, name_length, "%s", _fileinfo.name);
  514. }
  515. // set FSE_NOT_EXIST error on end of directory
  516. if(file->internal_error_id == 0) {
  517. file->error_id = FSE_NOT_EXIST;
  518. }
  519. } else {
  520. file->internal_error_id = LFS_ERR_BADF;
  521. file->error_id = storage_int_parse_error(file->internal_error_id);
  522. }
  523. return (file->error_id == FSE_OK);
  524. }
  525. static bool storage_int_dir_rewind(void* ctx, File* file) {
  526. StorageData* storage = ctx;
  527. lfs_t* lfs = lfs_get_from_storage(storage);
  528. LFSHandle* handle = storage_get_storage_file_data(file, storage);
  529. if(lfs_handle_is_open(handle)) {
  530. file->internal_error_id = lfs_dir_rewind(lfs, lfs_handle_get_dir(handle));
  531. } else {
  532. file->internal_error_id = LFS_ERR_BADF;
  533. }
  534. file->error_id = storage_int_parse_error(file->internal_error_id);
  535. return (file->error_id == FSE_OK);
  536. }
  537. /******************* Common FS Functions *******************/
  538. static FS_Error storage_int_common_stat(void* ctx, const char* path, FileInfo* fileinfo) {
  539. StorageData* storage = ctx;
  540. lfs_t* lfs = lfs_get_from_storage(storage);
  541. struct lfs_info _fileinfo;
  542. int result = lfs_stat(lfs, path, &_fileinfo);
  543. if(fileinfo != NULL) {
  544. fileinfo->size = _fileinfo.size;
  545. fileinfo->flags = 0;
  546. if(_fileinfo.type & LFS_TYPE_DIR) fileinfo->flags |= FSF_DIRECTORY;
  547. }
  548. return storage_int_parse_error(result);
  549. }
  550. static FS_Error storage_int_common_remove(void* ctx, const char* path) {
  551. StorageData* storage = ctx;
  552. lfs_t* lfs = lfs_get_from_storage(storage);
  553. int result = lfs_remove(lfs, path);
  554. return storage_int_parse_error(result);
  555. }
  556. static FS_Error storage_int_common_mkdir(void* ctx, const char* path) {
  557. StorageData* storage = ctx;
  558. lfs_t* lfs = lfs_get_from_storage(storage);
  559. int result = lfs_mkdir(lfs, path);
  560. return storage_int_parse_error(result);
  561. }
  562. static FS_Error storage_int_common_fs_info(
  563. void* ctx,
  564. const char* fs_path,
  565. uint64_t* total_space,
  566. uint64_t* free_space) {
  567. UNUSED(fs_path);
  568. StorageData* storage = ctx;
  569. lfs_t* lfs = lfs_get_from_storage(storage);
  570. LFSData* lfs_data = lfs_data_get_from_storage(storage);
  571. if(total_space) {
  572. *total_space = lfs_data->config.block_size * lfs_data->config.block_count;
  573. }
  574. lfs_ssize_t result = lfs_fs_size(lfs);
  575. if(free_space && (result >= 0)) {
  576. *free_space = (lfs_data->config.block_count - result) * lfs_data->config.block_size;
  577. }
  578. return storage_int_parse_error(result);
  579. }
  580. /******************* Init Storage *******************/
  581. static const FS_Api fs_api = {
  582. .file =
  583. {
  584. .open = storage_int_file_open,
  585. .close = storage_int_file_close,
  586. .read = storage_int_file_read,
  587. .write = storage_int_file_write,
  588. .seek = storage_int_file_seek,
  589. .tell = storage_int_file_tell,
  590. .truncate = storage_int_file_truncate,
  591. .size = storage_int_file_size,
  592. .sync = storage_int_file_sync,
  593. .eof = storage_int_file_eof,
  594. },
  595. .dir =
  596. {
  597. .open = storage_int_dir_open,
  598. .close = storage_int_dir_close,
  599. .read = storage_int_dir_read,
  600. .rewind = storage_int_dir_rewind,
  601. },
  602. .common =
  603. {
  604. .stat = storage_int_common_stat,
  605. .mkdir = storage_int_common_mkdir,
  606. .remove = storage_int_common_remove,
  607. .fs_info = storage_int_common_fs_info,
  608. },
  609. };
  610. void storage_int_init(StorageData* storage) {
  611. FURI_LOG_I(TAG, "Starting");
  612. LFSData* lfs_data = storage_int_lfs_data_alloc();
  613. FURI_LOG_I(
  614. TAG,
  615. "Config: start %p, read %d, write %d, page size: %d, page count: %d, cycles: %d",
  616. lfs_data->start_address,
  617. lfs_data->config.read_size,
  618. lfs_data->config.prog_size,
  619. lfs_data->config.block_size,
  620. lfs_data->config.block_count,
  621. lfs_data->config.block_cycles);
  622. storage_int_lfs_mount(lfs_data, storage);
  623. storage->data = lfs_data;
  624. storage->api.tick = NULL;
  625. storage->fs_api = &fs_api;
  626. }