dfs_lfs2.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900
  1. #include <rtdevice.h>
  2. #include <rtthread.h>
  3. #ifdef BSP_USING_WM_LIBRARIES
  4. #include <dfs_file.h>
  5. #include <dfs_fs.h>
  6. #include "lfs.h"
  7. #include <stdio.h>
  8. #include <string.h>
  9. #include "drv_flash.h"
  10. #define DBG_TAG "w60x.lfs2"
  11. #define DBG_LVL DBG_INFO
  12. #include <rtdbg.h>
  13. #ifndef RT_DEF_LFS_DRIVERS
  14. #define RT_DEF_LFS_DRIVERS 1
  15. #endif
  16. #if (RT_DEF_LFS_DRIVERS < 1)
  17. #error "#define RT_DEF_LFS_DRIVERS must > 0"
  18. #endif
  19. #ifndef LFS_READ_SIZE
  20. #define LFS_READ_SIZE 256
  21. #endif
  22. #ifndef LFS_PROG_SIZE
  23. #define LFS_PROG_SIZE 256
  24. #endif
  25. #ifndef LFS_BLOCK_SIZE
  26. #define LFS_BLOCK_SIZE 4096
  27. #endif
  28. #ifndef LFS_CACHE_SIZE
  29. #define LFS_CACHE_SIZE LFS_PROG_SIZE
  30. #endif
  31. #ifndef LFS_BLOCK_CYCLES
  32. #define LFS_BLOCK_CYCLES (-1)
  33. #endif
  34. #ifndef LFS_LOOKAHEAD_MAX
  35. #define LFS_LOOKAHEAD_MAX 128
  36. #endif
  37. typedef struct _dfs_lfs_s
  38. {
  39. struct lfs lfs;
  40. struct lfs_config cfg;
  41. } dfs_lfs_t;
  42. typedef struct _dfs_lfs_fd_s
  43. {
  44. struct lfs* lfs;
  45. union
  46. {
  47. struct lfs_file file;
  48. struct lfs_dir dir;
  49. } u;
  50. } dfs_lfs_fd_t;
  51. static struct _dfs_lfs_s* _lfs_mount_tbl[RT_DEF_LFS_DRIVERS] = {0};
  52. static struct rt_mutex _lfs_lock;
  53. #define lfs_dfs_lock() rt_mutex_take(&_lfs_lock, RT_WAITING_FOREVER);
  54. #define lfs_dfs_unlock() rt_mutex_release(&_lfs_lock);
  55. #define W600_FS_ADDR (0x00B0000)
  56. #define W600_FS_BCOUNT (64)
  57. // Read a region in a block. Negative error codes are propogated
  58. // to the user.
  59. static int _lfs_flash_read(const struct lfs_config* c, lfs_block_t block, lfs_off_t off, void* buffer, lfs_size_t size)
  60. {
  61. return wm_flash_read(W600_FS_ADDR + block*c->block_size + off, buffer, size) == size ? LFS_ERR_OK : LFS_ERR_IO;
  62. }
  63. // Program a region in a block. The block must have previously
  64. // been erased. Negative error codes are propogated to the user.
  65. // May return LFS_ERR_CORRUPT if the block should be considered bad.
  66. static int _lfs_flash_prog(const struct lfs_config* c, lfs_block_t block, lfs_off_t off, const void* buffer, lfs_size_t size)
  67. {
  68. return wm_flash_write(W600_FS_ADDR + block*c->block_size + off, buffer, size) == size ? LFS_ERR_OK : LFS_ERR_IO;
  69. }
  70. // Erase a block. A block must be erased before being programmed.
  71. // The state of an erased block is undefined. Negative error codes
  72. // are propogated to the user.
  73. // May return LFS_ERR_CORRUPT if the block should be considered bad.
  74. static int _lfs_flash_erase(const struct lfs_config* c, lfs_block_t block)
  75. {
  76. return wm_flash_erase(W600_FS_ADDR + block*c->block_size, c->block_size) == c->block_size ? LFS_ERR_OK : LFS_ERR_IO;
  77. }
  78. // Sync the state of the underlying block device. Negative error codes
  79. // are propogated to the user.
  80. static int _lfs_flash_sync(const struct lfs_config* c)
  81. {
  82. return LFS_ERR_OK;
  83. }
  84. /* results:
  85. * -1, no space to install fatfs driver
  86. * >= 0, there is an space to install littlefs driver
  87. */
  88. static int _get_disk(rt_device_t dev_id)
  89. {
  90. int index;
  91. if (dev_id == RT_NULL)
  92. {
  93. for (index = 0; index < RT_DEF_LFS_DRIVERS; index ++)
  94. {
  95. if(_lfs_mount_tbl[index] == RT_NULL)
  96. {
  97. return index;
  98. }
  99. }
  100. }
  101. else
  102. {
  103. for (index = 0; index < RT_DEF_LFS_DRIVERS; index ++)
  104. {
  105. if ((_lfs_mount_tbl[index] != RT_NULL) && (_lfs_mount_tbl[index]->cfg.context == (void *)dev_id))
  106. {
  107. return index;
  108. }
  109. }
  110. }
  111. return -1;
  112. }
  113. static int _lfs_result_to_dfs(int result)
  114. {
  115. int status = 0;
  116. switch (result)
  117. {
  118. case LFS_ERR_OK:
  119. break;
  120. case LFS_ERR_IO:
  121. status = -EIO;
  122. break; // Error during device operation
  123. case LFS_ERR_NOENT:
  124. status = -ENOENT;
  125. break; // No directory entry
  126. case LFS_ERR_EXIST:
  127. status = -EEXIST;
  128. break; // Entry already exists
  129. case LFS_ERR_NOTDIR:
  130. status = -ENOTDIR;
  131. break; // Entry is not a dir
  132. case LFS_ERR_ISDIR:
  133. status = -EISDIR;
  134. break; // Entry is a dir
  135. case LFS_ERR_NOTEMPTY:
  136. status = -ENOTEMPTY;
  137. break; // Dir is not empty
  138. case LFS_ERR_BADF:
  139. status = -EBADF;
  140. break; // Bad file number
  141. case LFS_ERR_INVAL:
  142. status = -EINVAL;
  143. break; // Invalid parameter
  144. case LFS_ERR_NOSPC:
  145. status = -ENOSPC;
  146. break; // No space left on device
  147. case LFS_ERR_NOMEM:
  148. status = -ENOMEM;
  149. break; // No more memory available
  150. case LFS_ERR_CORRUPT:
  151. status = -52;
  152. break; // Corrupted
  153. default:
  154. status = -EIO;
  155. break;
  156. }
  157. return status;
  158. }
  159. static void _lfs_load_config(struct lfs_config* lfs_cfg)
  160. {
  161. lfs_cfg->context = RT_NULL;
  162. lfs_cfg->read_size = LFS_READ_SIZE;
  163. lfs_cfg->prog_size = LFS_PROG_SIZE;
  164. lfs_cfg->block_size = LFS_BLOCK_SIZE;
  165. if (lfs_cfg->block_size < LFS_BLOCK_SIZE)
  166. {
  167. lfs_cfg->block_size = LFS_BLOCK_SIZE;
  168. }
  169. lfs_cfg->cache_size = LFS_CACHE_SIZE;
  170. lfs_cfg->block_cycles = LFS_BLOCK_CYCLES;
  171. lfs_cfg->block_count = W600_FS_BCOUNT;
  172. lfs_cfg->lookahead_size = 32 * ((lfs_cfg->block_count + 31) / 32);
  173. if (lfs_cfg->lookahead_size > LFS_LOOKAHEAD_MAX)
  174. {
  175. lfs_cfg->lookahead_size = LFS_LOOKAHEAD_MAX;
  176. }
  177. lfs_cfg->read = &_lfs_flash_read;
  178. lfs_cfg->prog = &_lfs_flash_prog;
  179. lfs_cfg->erase = &_lfs_flash_erase;
  180. lfs_cfg->sync = &_lfs_flash_sync;
  181. }
  182. static int _dfs_lfs_mount(struct dfs_filesystem* dfs, unsigned long rwflag, const void* data)
  183. {
  184. int result;
  185. int index;
  186. dfs_lfs_t* dfs_lfs;
  187. lfs_dfs_lock();
  188. /* get an empty position */
  189. index = _get_disk(RT_NULL);
  190. if (index == -1)
  191. {
  192. lfs_dfs_unlock();
  193. return -EIO;
  194. }
  195. /*create lfs handle */
  196. dfs_lfs = (dfs_lfs_t*)rt_malloc(sizeof(dfs_lfs_t));
  197. if (dfs_lfs == RT_NULL)
  198. {
  199. lfs_dfs_unlock();
  200. LOG_E("ERROR:no memory!");
  201. return -ENOMEM;
  202. }
  203. rt_memset(dfs_lfs, 0, sizeof(dfs_lfs_t));
  204. _lfs_load_config(&dfs_lfs->cfg);
  205. /* mount lfs*/
  206. result = lfs_mount(&dfs_lfs->lfs, &dfs_lfs->cfg);
  207. if (result != LFS_ERR_OK)
  208. {
  209. lfs_dfs_unlock();
  210. /* release memory */
  211. rt_free(dfs_lfs);
  212. return -EIO;
  213. }
  214. /* mount succeed! */
  215. dfs->data = (void*)dfs_lfs;
  216. _lfs_mount_tbl[index] = dfs_lfs;
  217. lfs_dfs_unlock();
  218. return RT_EOK;
  219. }
  220. static int _dfs_lfs_unmount(struct dfs_filesystem* dfs)
  221. {
  222. int result;
  223. int index;
  224. dfs_lfs_t* dfs_lfs;
  225. RT_ASSERT(dfs != RT_NULL);
  226. RT_ASSERT(dfs->data != RT_NULL);
  227. lfs_dfs_lock();
  228. /* find the device index and then umount it */
  229. //index = _get_disk(dfs->dev_id);
  230. //if (index == -1) index = 0;
  231. // if (index == -1)
  232. // {
  233. // lfs_dfs_unlock();
  234. // return -ENOENT;
  235. // }
  236. _lfs_mount_tbl[0] = RT_NULL;
  237. dfs_lfs = (dfs_lfs_t*)dfs->data;
  238. dfs->data = RT_NULL;
  239. result = lfs_unmount(&dfs_lfs->lfs);
  240. lfs_dfs_unlock();
  241. rt_free(dfs_lfs);
  242. return _lfs_result_to_dfs(result);
  243. }
  244. static int _dfs_lfs_mkfs(rt_device_t dev_id)
  245. {
  246. int result;
  247. int index;
  248. dfs_lfs_t* dfs_lfs;
  249. if (dev_id == RT_NULL)
  250. {
  251. return -EINVAL;
  252. }
  253. lfs_dfs_lock();
  254. index = _get_disk(dev_id);
  255. if (index == -1)
  256. {
  257. /* not found the device id */
  258. index = _get_disk(RT_NULL);
  259. if (index == -1)
  260. {
  261. lfs_dfs_unlock();
  262. /* no space to store an temp driver */
  263. LOG_W("sorry, there is no space to do mkfs!");
  264. return -ENOSPC;
  265. }
  266. /* create lfs handle */
  267. dfs_lfs = rt_malloc(sizeof(dfs_lfs_t));
  268. if (dfs_lfs == RT_NULL)
  269. {
  270. _lfs_mount_tbl[index] = RT_NULL;
  271. lfs_dfs_unlock();
  272. LOG_E("ERROR:no memory!");
  273. return -ENOMEM;
  274. }
  275. rt_memset(dfs_lfs, 0, sizeof(dfs_lfs_t));
  276. _lfs_load_config(&dfs_lfs->cfg);
  277. /* format flash device */
  278. result = lfs_format(&dfs_lfs->lfs, &dfs_lfs->cfg);
  279. lfs_dfs_unlock();
  280. return _lfs_result_to_dfs(result);
  281. }
  282. dfs_lfs = _lfs_mount_tbl[index];
  283. /* unmount it */
  284. result = lfs_unmount(&dfs_lfs->lfs);
  285. if (result != LFS_ERR_OK)
  286. {
  287. lfs_dfs_unlock();
  288. return _lfs_result_to_dfs(result);
  289. }
  290. _lfs_mount_tbl[index] = RT_NULL;
  291. /* format flash device */
  292. result = lfs_format(&dfs_lfs->lfs, &dfs_lfs->cfg);
  293. if (result != LFS_ERR_OK)
  294. {
  295. lfs_dfs_unlock();
  296. return _lfs_result_to_dfs(result);
  297. }
  298. _lfs_load_config(&dfs_lfs->cfg);
  299. /* mount lfs*/
  300. result = lfs_mount(&dfs_lfs->lfs, &dfs_lfs->cfg);
  301. if (result == LFS_ERR_OK)
  302. {
  303. _lfs_mount_tbl[index] = dfs_lfs;
  304. }
  305. lfs_dfs_unlock();
  306. return _lfs_result_to_dfs(result);
  307. }
  308. static int _dfs_lfs_statfs_count(void* p, lfs_block_t b)
  309. {
  310. *(lfs_size_t*)p += 1;
  311. return 0;
  312. }
  313. static int _dfs_lfs_statfs(struct dfs_filesystem* dfs, struct statfs* buf)
  314. {
  315. dfs_lfs_t* dfs_lfs;
  316. int result;
  317. lfs_size_t in_use = 0;
  318. RT_ASSERT(buf != RT_NULL);
  319. RT_ASSERT(dfs != RT_NULL);
  320. RT_ASSERT(dfs->data != RT_NULL);
  321. lfs_dfs_lock();
  322. dfs_lfs = (dfs_lfs_t*)dfs->data;
  323. /* Get total sectors and free sectors */
  324. result = lfs_fs_traverse(&dfs_lfs->lfs, _dfs_lfs_statfs_count, &in_use);
  325. if (result != LFS_ERR_OK)
  326. {
  327. lfs_dfs_unlock();
  328. return _lfs_result_to_dfs(result);
  329. }
  330. buf->f_bsize = dfs_lfs->cfg.block_size;
  331. buf->f_blocks = dfs_lfs->cfg.block_count;
  332. buf->f_bfree = dfs_lfs->cfg.block_count - in_use;
  333. lfs_dfs_unlock();
  334. return RT_EOK;
  335. }
  336. static int _dfs_lfs_unlink(struct dfs_filesystem* dfs, const char* path)
  337. {
  338. dfs_lfs_t* dfs_lfs;
  339. int result;
  340. RT_ASSERT(dfs != RT_NULL);
  341. RT_ASSERT(dfs->data != RT_NULL);
  342. lfs_dfs_lock();
  343. dfs_lfs = (dfs_lfs_t*)dfs->data;
  344. result = lfs_remove(&dfs_lfs->lfs, path);
  345. lfs_dfs_unlock();
  346. return _lfs_result_to_dfs(result);
  347. }
  348. static void _dfs_lfs_tostat(struct stat* st, struct lfs_info* info)
  349. {
  350. memset(st, 0, sizeof(struct stat));
  351. /* convert to dfs stat structure */
  352. st->st_dev = 0;
  353. st->st_size = info->size;
  354. st->st_mode = S_IRWXU | S_IRWXG | S_IRWXO;
  355. switch (info->type)
  356. {
  357. case LFS_TYPE_DIR:
  358. st->st_mode |= S_IFDIR;
  359. break;
  360. case LFS_TYPE_REG:
  361. st->st_mode |= S_IFREG;
  362. break;
  363. }
  364. }
  365. static int _dfs_lfs_stat(struct dfs_filesystem* dfs, const char* path, struct stat* st)
  366. {
  367. dfs_lfs_t* dfs_lfs;
  368. int result;
  369. struct lfs_info info;
  370. RT_ASSERT(dfs != RT_NULL);
  371. RT_ASSERT(dfs->data != RT_NULL);
  372. lfs_dfs_lock();
  373. dfs_lfs = (dfs_lfs_t*)dfs->data;
  374. result = lfs_stat(&dfs_lfs->lfs, path, &info);
  375. lfs_dfs_unlock();
  376. if (result != LFS_ERR_OK)
  377. {
  378. return _lfs_result_to_dfs(result);
  379. }
  380. _dfs_lfs_tostat(st, &info);
  381. return 0;
  382. }
  383. static int _dfs_lfs_rename(struct dfs_filesystem* dfs, const char* from, const char* to)
  384. {
  385. dfs_lfs_t* dfs_lfs;
  386. int result;
  387. RT_ASSERT(dfs != RT_NULL);
  388. RT_ASSERT(dfs->data != RT_NULL);
  389. lfs_dfs_lock();
  390. dfs_lfs = (dfs_lfs_t*)dfs->data;
  391. result = lfs_rename(&dfs_lfs->lfs, from, to);
  392. lfs_dfs_unlock();
  393. return _lfs_result_to_dfs(result);
  394. }
  395. /******************************************************************************
  396. * file operations
  397. ******************************************************************************/
  398. static int _dfs_lfs_open(struct dfs_fd* file)
  399. {
  400. struct dfs_filesystem* dfs;
  401. dfs_lfs_t* dfs_lfs;
  402. int result;
  403. int flags = 0;
  404. RT_ASSERT(file != RT_NULL);
  405. RT_ASSERT(file->data != RT_NULL);
  406. lfs_dfs_lock();
  407. dfs = (struct dfs_filesystem*)file->data;
  408. dfs_lfs = (dfs_lfs_t*)dfs->data;
  409. if (file->flags & O_DIRECTORY)
  410. {
  411. dfs_lfs_fd_t* dfs_lfs_fd = rt_malloc(sizeof(dfs_lfs_fd_t));
  412. if (dfs_lfs_fd == RT_NULL)
  413. {
  414. LOG_E("ERROR:no memory!");
  415. result = -ENOMEM;
  416. goto _error_dir;
  417. }
  418. rt_memset(dfs_lfs_fd, 0, sizeof(dfs_lfs_fd_t));
  419. dfs_lfs_fd->lfs = &dfs_lfs->lfs;
  420. if (file->flags & O_CREAT)
  421. {
  422. result = lfs_mkdir(dfs_lfs_fd->lfs, file->path);
  423. if (result != LFS_ERR_OK)
  424. {
  425. goto _error_dir;
  426. }
  427. }
  428. result = lfs_dir_open(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.dir, file->path);
  429. if (result != LFS_ERR_OK)
  430. {
  431. goto _error_dir;
  432. }
  433. else
  434. {
  435. file->data = (void*)dfs_lfs_fd;
  436. lfs_dfs_unlock();
  437. return RT_EOK;
  438. }
  439. _error_dir:
  440. if (dfs_lfs_fd != RT_NULL)
  441. {
  442. rt_free(dfs_lfs_fd);
  443. }
  444. lfs_dfs_unlock();
  445. return _lfs_result_to_dfs(result);
  446. }
  447. else
  448. {
  449. dfs_lfs_fd_t* dfs_lfs_fd = rt_malloc(sizeof(dfs_lfs_fd_t));
  450. if (dfs_lfs_fd == RT_NULL)
  451. {
  452. LOG_E("ERROR:no memory!");
  453. result = -ENOMEM;
  454. goto _error_file;
  455. }
  456. rt_memset(dfs_lfs_fd, 0, sizeof(dfs_lfs_fd_t));
  457. dfs_lfs_fd->lfs = &dfs_lfs->lfs;
  458. if ((file->flags & 3) == O_RDONLY)
  459. flags |= LFS_O_RDONLY;
  460. if ((file->flags & 3) == O_WRONLY)
  461. flags |= LFS_O_WRONLY;
  462. if ((file->flags & 3) == O_RDWR)
  463. flags |= LFS_O_RDWR;
  464. if (file->flags & O_CREAT)
  465. flags |= LFS_O_CREAT;
  466. if (file->flags & O_EXCL)
  467. flags |= LFS_O_EXCL;
  468. if (file->flags & O_TRUNC)
  469. flags |= LFS_O_TRUNC;
  470. if (file->flags & O_APPEND)
  471. flags |= LFS_O_APPEND;
  472. result = lfs_file_open(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file, file->path, flags);
  473. if (result != LFS_ERR_OK)
  474. {
  475. goto _error_file;
  476. }
  477. else
  478. {
  479. file->data = (void*)dfs_lfs_fd;
  480. file->pos = dfs_lfs_fd->u.file.pos;
  481. file->size = dfs_lfs_fd->u.file.ctz.size;
  482. lfs_dfs_unlock();
  483. return RT_EOK;
  484. }
  485. _error_file:
  486. if (dfs_lfs_fd != RT_NULL)
  487. {
  488. rt_free(dfs_lfs_fd);
  489. }
  490. lfs_dfs_unlock();
  491. return _lfs_result_to_dfs(result);
  492. }
  493. }
  494. static int _dfs_lfs_close(struct dfs_fd* file)
  495. {
  496. int result;
  497. dfs_lfs_fd_t* dfs_lfs_fd;
  498. RT_ASSERT(file != RT_NULL);
  499. RT_ASSERT(file->data != RT_NULL);
  500. lfs_dfs_lock();
  501. dfs_lfs_fd = (dfs_lfs_fd_t*)file->data;
  502. if (file->type == FT_DIRECTORY)
  503. {
  504. result = lfs_dir_close(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.dir);
  505. }
  506. else
  507. {
  508. result = lfs_file_close(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file);
  509. }
  510. rt_free(dfs_lfs_fd);
  511. lfs_dfs_unlock();
  512. return _lfs_result_to_dfs(result);
  513. }
  514. static int _dfs_lfs_ioctl(struct dfs_fd* file, int cmd, void* args)
  515. {
  516. return -ENOSYS;
  517. }
  518. static int _dfs_lfs_read(struct dfs_fd* file, void* buf, size_t len)
  519. {
  520. lfs_ssize_t ssize;
  521. dfs_lfs_fd_t* dfs_lfs_fd;
  522. RT_ASSERT(file != RT_NULL);
  523. RT_ASSERT(file->data != RT_NULL);
  524. lfs_dfs_lock();
  525. if (file->type == FT_DIRECTORY)
  526. {
  527. lfs_dfs_unlock();
  528. return -EISDIR;
  529. }
  530. dfs_lfs_fd = (dfs_lfs_fd_t*)file->data;
  531. #if 0
  532. if (lfs_file_tell(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file) != file->pos)
  533. {
  534. lfs_soff_t soff = lfs_file_seek(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file, file->pos, LFS_SEEK_SET);
  535. if (soff < 0)
  536. {
  537. lfs_dfs_unlock();
  538. return _lfs_result_to_dfs(soff);
  539. }
  540. }
  541. #endif
  542. ssize = lfs_file_read(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file, buf, len);
  543. if (ssize < 0)
  544. {
  545. lfs_dfs_unlock();
  546. return _lfs_result_to_dfs(ssize);
  547. }
  548. /* update position */
  549. file->pos = dfs_lfs_fd->u.file.pos;
  550. lfs_dfs_unlock();
  551. return ssize;
  552. }
  553. static int _dfs_lfs_write(struct dfs_fd* file, const void* buf, size_t len)
  554. {
  555. lfs_ssize_t ssize;
  556. dfs_lfs_fd_t* dfs_lfs_fd;
  557. RT_ASSERT(file != RT_NULL);
  558. RT_ASSERT(file->data != RT_NULL);
  559. lfs_dfs_lock();
  560. if (file->type == FT_DIRECTORY)
  561. {
  562. lfs_dfs_unlock();
  563. return -EISDIR;
  564. }
  565. dfs_lfs_fd = (dfs_lfs_fd_t*)file->data;
  566. #if 0
  567. if (lfs_file_tell(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file) != file->pos)
  568. {
  569. lfs_soff_t soff = lfs_file_seek(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file, file->pos, LFS_SEEK_SET);
  570. if (soff < 0)
  571. {
  572. lfs_dfs_unlock();
  573. return _lfs_result_to_dfs(soff);
  574. }
  575. }
  576. #endif
  577. ssize = lfs_file_write(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file, buf, len);
  578. if (ssize < 0)
  579. {
  580. lfs_dfs_unlock();
  581. return _lfs_result_to_dfs(ssize);
  582. }
  583. /* update position and file size */
  584. file->pos = dfs_lfs_fd->u.file.pos;
  585. file->size = dfs_lfs_fd->u.file.ctz.size;
  586. lfs_dfs_unlock();
  587. return ssize;
  588. }
  589. static int _dfs_lfs_flush(struct dfs_fd* file)
  590. {
  591. int result;
  592. dfs_lfs_fd_t* dfs_lfs_fd;
  593. RT_ASSERT(file != RT_NULL);
  594. RT_ASSERT(file->data != RT_NULL);
  595. lfs_dfs_lock();
  596. dfs_lfs_fd = (dfs_lfs_fd_t*)file->data;
  597. result = lfs_file_sync(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file);
  598. lfs_dfs_unlock();
  599. return _lfs_result_to_dfs(result);
  600. }
  601. static int _dfs_lfs_lseek(struct dfs_fd* file, rt_off_t offset)
  602. {
  603. dfs_lfs_fd_t* dfs_lfs_fd;
  604. RT_ASSERT(file != RT_NULL);
  605. RT_ASSERT(file->data != RT_NULL);
  606. lfs_dfs_lock();
  607. dfs_lfs_fd = (dfs_lfs_fd_t*)file->data;
  608. if (file->type == FT_REGULAR)
  609. {
  610. lfs_soff_t soff = lfs_file_seek(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.file, offset, LFS_SEEK_SET);
  611. if (soff < 0)
  612. {
  613. lfs_dfs_unlock();
  614. return _lfs_result_to_dfs(soff);
  615. }
  616. file->pos = dfs_lfs_fd->u.file.pos;
  617. }
  618. else if (file->type == FT_DIRECTORY)
  619. {
  620. lfs_soff_t soff = lfs_dir_seek(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.dir, offset);
  621. if (soff < 0)
  622. {
  623. lfs_dfs_unlock();
  624. return _lfs_result_to_dfs(soff);
  625. }
  626. file->pos = dfs_lfs_fd->u.dir.pos;
  627. }
  628. lfs_dfs_unlock();
  629. return (file->pos);
  630. }
  631. static int _dfs_lfs_getdents(struct dfs_fd* file, struct dirent* dirp, uint32_t count)
  632. {
  633. dfs_lfs_fd_t* dfs_lfs_fd;
  634. int result;
  635. int index;
  636. struct dirent* d;
  637. struct lfs_info info;
  638. RT_ASSERT(file->data != RT_NULL);
  639. lfs_dfs_lock();
  640. dfs_lfs_fd = (dfs_lfs_fd_t*)(file->data);
  641. /* make integer count */
  642. count = (count / sizeof(struct dirent)) * sizeof(struct dirent);
  643. if (count == 0)
  644. {
  645. lfs_dfs_unlock();
  646. return -EINVAL;
  647. }
  648. index = 0;
  649. while (1)
  650. {
  651. d = dirp + index;
  652. result = lfs_dir_read(dfs_lfs_fd->lfs, &dfs_lfs_fd->u.dir, &info);
  653. if ((result != 1) || (info.name[0] == 0))
  654. {
  655. break;
  656. }
  657. if (rt_strcmp(info.name, ".") == 0)
  658. {
  659. continue;
  660. }
  661. else if (rt_strcmp(info.name, "..") == 0)
  662. {
  663. continue;
  664. }
  665. d->d_type = DT_UNKNOWN;
  666. switch (info.type)
  667. {
  668. case LFS_TYPE_DIR:
  669. d->d_type |= DT_DIR;
  670. break;
  671. case LFS_TYPE_REG:
  672. d->d_type |= DT_REG;
  673. break;
  674. }
  675. d->d_namlen = (rt_uint8_t)rt_strlen(info.name);
  676. d->d_reclen = (rt_uint16_t)sizeof(struct dirent);
  677. rt_strncpy(d->d_name, info.name, rt_strlen(info.name) + 1);
  678. index++;
  679. if (index * sizeof(struct dirent) >= count)
  680. {
  681. break;
  682. }
  683. }
  684. if (index == 0)
  685. {
  686. lfs_dfs_unlock();
  687. return _lfs_result_to_dfs(result);
  688. }
  689. file->pos += index * sizeof(struct dirent);
  690. lfs_dfs_unlock();
  691. return index * sizeof(struct dirent);
  692. }
  693. static const struct dfs_file_ops _dfs_lfs_fops = {
  694. _dfs_lfs_open,
  695. _dfs_lfs_close,
  696. _dfs_lfs_ioctl,
  697. _dfs_lfs_read,
  698. _dfs_lfs_write,
  699. _dfs_lfs_flush,
  700. _dfs_lfs_lseek,
  701. _dfs_lfs_getdents,
  702. // RT_NULL, /* poll interface */
  703. };
  704. static const struct dfs_filesystem_ops _dfs_lfs_ops = {
  705. "lfs2",
  706. DFS_FS_FLAG_DEFAULT,
  707. &_dfs_lfs_fops,
  708. _dfs_lfs_mount,
  709. _dfs_lfs_unmount,
  710. _dfs_lfs_mkfs,
  711. _dfs_lfs_statfs,
  712. _dfs_lfs_unlink,
  713. _dfs_lfs_stat,
  714. _dfs_lfs_rename,
  715. };
  716. int dfs_lfs2_init(void)
  717. {
  718. /* init file system lock */
  719. rt_mutex_init(&_lfs_lock, "lfsmtx", RT_IPC_FLAG_FIFO);
  720. /* register ram file system */
  721. return dfs_register(&_dfs_lfs_ops);
  722. }
  723. INIT_COMPONENT_EXPORT(dfs_lfs2_init);
  724. #endif