xref: /nrf52832-nimble/rt-thread/components/dfs/filesystems/elmfat/dfs_elm.c (revision 104654410c56c573564690304ae786df310c91fc)
1*10465441SEvalZero /*
2*10465441SEvalZero  * Copyright (c) 2006-2018, RT-Thread Development Team
3*10465441SEvalZero  *
4*10465441SEvalZero  * SPDX-License-Identifier: Apache-2.0
5*10465441SEvalZero  *
6*10465441SEvalZero  * Change Logs:
7*10465441SEvalZero  * Date           Author       Notes
8*10465441SEvalZero  * 2008-02-22     QiuYi        The first version.
9*10465441SEvalZero  * 2011-10-08     Bernard      fixed the block size in statfs.
10*10465441SEvalZero  * 2011-11-23     Bernard      fixed the rename issue.
11*10465441SEvalZero  * 2012-07-26     aozima       implement ff_memalloc and ff_memfree.
12*10465441SEvalZero  * 2012-12-19     Bernard      fixed the O_APPEND and lseek issue.
13*10465441SEvalZero  * 2013-03-01     aozima       fixed the stat(st_mtime) issue.
14*10465441SEvalZero  * 2014-01-26     Bernard      Check the sector size before mount.
15*10465441SEvalZero  * 2017-02-13     Hichard      Update Fatfs version to 0.12b, support exFAT.
16*10465441SEvalZero  * 2017-04-11     Bernard      fix the st_blksize issue.
17*10465441SEvalZero  * 2017-05-26     Urey         fix f_mount error when mount more fats
18*10465441SEvalZero  */
19*10465441SEvalZero 
20*10465441SEvalZero #include <rtthread.h>
21*10465441SEvalZero #include "ffconf.h"
22*10465441SEvalZero #include "ff.h"
23*10465441SEvalZero #include <string.h>
24*10465441SEvalZero #include <time.h>
25*10465441SEvalZero 
26*10465441SEvalZero /* ELM FatFs provide a DIR struct */
27*10465441SEvalZero #define HAVE_DIR_STRUCTURE
28*10465441SEvalZero 
29*10465441SEvalZero #include <dfs_fs.h>
30*10465441SEvalZero #include <dfs_file.h>
31*10465441SEvalZero 
32*10465441SEvalZero static rt_device_t disk[_VOLUMES] = {0};
33*10465441SEvalZero 
elm_result_to_dfs(FRESULT result)34*10465441SEvalZero static int elm_result_to_dfs(FRESULT result)
35*10465441SEvalZero {
36*10465441SEvalZero     int status = RT_EOK;
37*10465441SEvalZero 
38*10465441SEvalZero     switch (result)
39*10465441SEvalZero     {
40*10465441SEvalZero     case FR_OK:
41*10465441SEvalZero         break;
42*10465441SEvalZero 
43*10465441SEvalZero     case FR_NO_FILE:
44*10465441SEvalZero     case FR_NO_PATH:
45*10465441SEvalZero     case FR_NO_FILESYSTEM:
46*10465441SEvalZero         status = -ENOENT;
47*10465441SEvalZero         break;
48*10465441SEvalZero 
49*10465441SEvalZero     case FR_INVALID_NAME:
50*10465441SEvalZero         status = -EINVAL;
51*10465441SEvalZero         break;
52*10465441SEvalZero 
53*10465441SEvalZero     case FR_EXIST:
54*10465441SEvalZero     case FR_INVALID_OBJECT:
55*10465441SEvalZero         status = -EEXIST;
56*10465441SEvalZero         break;
57*10465441SEvalZero 
58*10465441SEvalZero     case FR_DISK_ERR:
59*10465441SEvalZero     case FR_NOT_READY:
60*10465441SEvalZero     case FR_INT_ERR:
61*10465441SEvalZero         status = -EIO;
62*10465441SEvalZero         break;
63*10465441SEvalZero 
64*10465441SEvalZero     case FR_WRITE_PROTECTED:
65*10465441SEvalZero     case FR_DENIED:
66*10465441SEvalZero         status = -EROFS;
67*10465441SEvalZero         break;
68*10465441SEvalZero 
69*10465441SEvalZero     case FR_MKFS_ABORTED:
70*10465441SEvalZero         status = -EINVAL;
71*10465441SEvalZero         break;
72*10465441SEvalZero 
73*10465441SEvalZero     default:
74*10465441SEvalZero         status = -1;
75*10465441SEvalZero         break;
76*10465441SEvalZero     }
77*10465441SEvalZero 
78*10465441SEvalZero     return status;
79*10465441SEvalZero }
80*10465441SEvalZero 
81*10465441SEvalZero /* results:
82*10465441SEvalZero  *  -1, no space to install fatfs driver
83*10465441SEvalZero  *  >= 0, there is an space to install fatfs driver
84*10465441SEvalZero  */
get_disk(rt_device_t id)85*10465441SEvalZero static int get_disk(rt_device_t id)
86*10465441SEvalZero {
87*10465441SEvalZero     int index;
88*10465441SEvalZero 
89*10465441SEvalZero     for (index = 0; index < _VOLUMES; index ++)
90*10465441SEvalZero     {
91*10465441SEvalZero         if (disk[index] == id)
92*10465441SEvalZero             return index;
93*10465441SEvalZero     }
94*10465441SEvalZero 
95*10465441SEvalZero     return -1;
96*10465441SEvalZero }
97*10465441SEvalZero 
dfs_elm_mount(struct dfs_filesystem * fs,unsigned long rwflag,const void * data)98*10465441SEvalZero int dfs_elm_mount(struct dfs_filesystem *fs, unsigned long rwflag, const void *data)
99*10465441SEvalZero {
100*10465441SEvalZero     FATFS *fat;
101*10465441SEvalZero     FRESULT result;
102*10465441SEvalZero     int index;
103*10465441SEvalZero     struct rt_device_blk_geometry geometry;
104*10465441SEvalZero     char logic_nbr[2] = {'0',':'};
105*10465441SEvalZero 
106*10465441SEvalZero     /* get an empty position */
107*10465441SEvalZero     index = get_disk(RT_NULL);
108*10465441SEvalZero     if (index == -1)
109*10465441SEvalZero         return -ENOENT;
110*10465441SEvalZero     logic_nbr[0] = '0' + index;
111*10465441SEvalZero 
112*10465441SEvalZero     /* save device */
113*10465441SEvalZero     disk[index] = fs->dev_id;
114*10465441SEvalZero     /* check sector size */
115*10465441SEvalZero     if (rt_device_control(fs->dev_id, RT_DEVICE_CTRL_BLK_GETGEOME, &geometry) == RT_EOK)
116*10465441SEvalZero     {
117*10465441SEvalZero         if (geometry.bytes_per_sector > _MAX_SS)
118*10465441SEvalZero         {
119*10465441SEvalZero             rt_kprintf("The sector size of device is greater than the sector size of FAT.\n");
120*10465441SEvalZero             return -EINVAL;
121*10465441SEvalZero         }
122*10465441SEvalZero     }
123*10465441SEvalZero 
124*10465441SEvalZero     fat = (FATFS *)rt_malloc(sizeof(FATFS));
125*10465441SEvalZero     if (fat == RT_NULL)
126*10465441SEvalZero     {
127*10465441SEvalZero         disk[index] = RT_NULL;
128*10465441SEvalZero         return -ENOMEM;
129*10465441SEvalZero     }
130*10465441SEvalZero 
131*10465441SEvalZero     /* mount fatfs, always 0 logic driver */
132*10465441SEvalZero     result = f_mount(fat, (const TCHAR*)logic_nbr, 1);
133*10465441SEvalZero     if (result == FR_OK)
134*10465441SEvalZero     {
135*10465441SEvalZero         char drive[8];
136*10465441SEvalZero         DIR *dir;
137*10465441SEvalZero 
138*10465441SEvalZero         rt_snprintf(drive, sizeof(drive), "%d:/", index);
139*10465441SEvalZero         dir = (DIR *)rt_malloc(sizeof(DIR));
140*10465441SEvalZero         if (dir == RT_NULL)
141*10465441SEvalZero         {
142*10465441SEvalZero             f_mount(RT_NULL, (const TCHAR*)logic_nbr, 1);
143*10465441SEvalZero             disk[index] = RT_NULL;
144*10465441SEvalZero             rt_free(fat);
145*10465441SEvalZero             return -ENOMEM;
146*10465441SEvalZero         }
147*10465441SEvalZero 
148*10465441SEvalZero         /* open the root directory to test whether the fatfs is valid */
149*10465441SEvalZero         result = f_opendir(dir, drive);
150*10465441SEvalZero         if (result != FR_OK)
151*10465441SEvalZero             goto __err;
152*10465441SEvalZero 
153*10465441SEvalZero         /* mount succeed! */
154*10465441SEvalZero         fs->data = fat;
155*10465441SEvalZero         rt_free(dir);
156*10465441SEvalZero         return 0;
157*10465441SEvalZero     }
158*10465441SEvalZero 
159*10465441SEvalZero __err:
160*10465441SEvalZero     f_mount(RT_NULL, (const TCHAR*)logic_nbr, 1);
161*10465441SEvalZero     disk[index] = RT_NULL;
162*10465441SEvalZero     rt_free(fat);
163*10465441SEvalZero     return elm_result_to_dfs(result);
164*10465441SEvalZero }
165*10465441SEvalZero 
dfs_elm_unmount(struct dfs_filesystem * fs)166*10465441SEvalZero int dfs_elm_unmount(struct dfs_filesystem *fs)
167*10465441SEvalZero {
168*10465441SEvalZero     FATFS *fat;
169*10465441SEvalZero     FRESULT result;
170*10465441SEvalZero     int  index;
171*10465441SEvalZero     char logic_nbr[2] = {'0',':'};
172*10465441SEvalZero 
173*10465441SEvalZero     fat = (FATFS *)fs->data;
174*10465441SEvalZero 
175*10465441SEvalZero     RT_ASSERT(fat != RT_NULL);
176*10465441SEvalZero 
177*10465441SEvalZero     /* find the device index and then umount it */
178*10465441SEvalZero     index = get_disk(fs->dev_id);
179*10465441SEvalZero     if (index == -1) /* not found */
180*10465441SEvalZero         return -ENOENT;
181*10465441SEvalZero 
182*10465441SEvalZero     logic_nbr[0] = '0' + index;
183*10465441SEvalZero     result = f_mount(RT_NULL, logic_nbr, (BYTE)1);
184*10465441SEvalZero     if (result != FR_OK)
185*10465441SEvalZero         return elm_result_to_dfs(result);
186*10465441SEvalZero 
187*10465441SEvalZero     fs->data = RT_NULL;
188*10465441SEvalZero     disk[index] = RT_NULL;
189*10465441SEvalZero     rt_free(fat);
190*10465441SEvalZero 
191*10465441SEvalZero     return RT_EOK;
192*10465441SEvalZero }
193*10465441SEvalZero 
dfs_elm_mkfs(rt_device_t dev_id)194*10465441SEvalZero int dfs_elm_mkfs(rt_device_t dev_id)
195*10465441SEvalZero {
196*10465441SEvalZero #define FSM_STATUS_INIT            0
197*10465441SEvalZero #define FSM_STATUS_USE_TEMP_DRIVER 1
198*10465441SEvalZero     FATFS *fat = RT_NULL;
199*10465441SEvalZero     BYTE *work;
200*10465441SEvalZero     int flag;
201*10465441SEvalZero     FRESULT result;
202*10465441SEvalZero     int index;
203*10465441SEvalZero     char logic_nbr[2] = {'0',':'};
204*10465441SEvalZero 
205*10465441SEvalZero     work = rt_malloc(_MAX_SS);
206*10465441SEvalZero     if(RT_NULL == work) {
207*10465441SEvalZero         return -ENOMEM;
208*10465441SEvalZero     }
209*10465441SEvalZero 
210*10465441SEvalZero     if (dev_id == RT_NULL)
211*10465441SEvalZero     {
212*10465441SEvalZero         rt_free(work); /* release memory */
213*10465441SEvalZero         return -EINVAL;
214*10465441SEvalZero     }
215*10465441SEvalZero 
216*10465441SEvalZero     /* if the device is already mounted, then just do mkfs to the drv,
217*10465441SEvalZero      * while if it is not mounted yet, then find an empty drive to do mkfs
218*10465441SEvalZero      */
219*10465441SEvalZero 
220*10465441SEvalZero     flag = FSM_STATUS_INIT;
221*10465441SEvalZero     index = get_disk(dev_id);
222*10465441SEvalZero     if (index == -1)
223*10465441SEvalZero     {
224*10465441SEvalZero         /* not found the device id */
225*10465441SEvalZero         index = get_disk(RT_NULL);
226*10465441SEvalZero         if (index == -1)
227*10465441SEvalZero         {
228*10465441SEvalZero             /* no space to store an temp driver */
229*10465441SEvalZero             rt_kprintf("sorry, there is no space to do mkfs! \n");
230*10465441SEvalZero             rt_free(work); /* release memory */
231*10465441SEvalZero             return -ENOSPC;
232*10465441SEvalZero         }
233*10465441SEvalZero         else
234*10465441SEvalZero         {
235*10465441SEvalZero             fat = rt_malloc(sizeof(FATFS));
236*10465441SEvalZero             if (fat == RT_NULL)
237*10465441SEvalZero             {
238*10465441SEvalZero                 rt_free(work); /* release memory */
239*10465441SEvalZero                 return -ENOMEM;
240*10465441SEvalZero             }
241*10465441SEvalZero 
242*10465441SEvalZero             flag = FSM_STATUS_USE_TEMP_DRIVER;
243*10465441SEvalZero 
244*10465441SEvalZero             disk[index] = dev_id;
245*10465441SEvalZero             /* try to open device */
246*10465441SEvalZero             rt_device_open(dev_id, RT_DEVICE_OFLAG_RDWR);
247*10465441SEvalZero 
248*10465441SEvalZero             /* just fill the FatFs[vol] in ff.c, or mkfs will failded!
249*10465441SEvalZero              * consider this condition: you just umount the elm fat,
250*10465441SEvalZero              * then the space in FatFs[index] is released, and now do mkfs
251*10465441SEvalZero              * on the disk, you will get a failure. so we need f_mount here,
252*10465441SEvalZero              * just fill the FatFS[index] in elm fatfs to make mkfs work.
253*10465441SEvalZero              */
254*10465441SEvalZero             logic_nbr[0] = '0' + index;
255*10465441SEvalZero             f_mount(fat, logic_nbr, (BYTE)index);
256*10465441SEvalZero         }
257*10465441SEvalZero     }
258*10465441SEvalZero     else
259*10465441SEvalZero     {
260*10465441SEvalZero         logic_nbr[0] = '0' + index;
261*10465441SEvalZero     }
262*10465441SEvalZero 
263*10465441SEvalZero     /* [IN] Logical drive number */
264*10465441SEvalZero     /* [IN] Format options */
265*10465441SEvalZero     /* [IN] Size of the allocation unit */
266*10465441SEvalZero     /* [-]  Working buffer */
267*10465441SEvalZero     /* [IN] Size of working buffer */
268*10465441SEvalZero     result = f_mkfs(logic_nbr, FM_ANY|FM_SFD, 0, work, _MAX_SS);
269*10465441SEvalZero     rt_free(work); work = RT_NULL;
270*10465441SEvalZero 
271*10465441SEvalZero     /* check flag status, we need clear the temp driver stored in disk[] */
272*10465441SEvalZero     if (flag == FSM_STATUS_USE_TEMP_DRIVER)
273*10465441SEvalZero     {
274*10465441SEvalZero         rt_free(fat);
275*10465441SEvalZero         f_mount(RT_NULL, logic_nbr,(BYTE)index);
276*10465441SEvalZero         disk[index] = RT_NULL;
277*10465441SEvalZero         /* close device */
278*10465441SEvalZero         rt_device_close(dev_id);
279*10465441SEvalZero     }
280*10465441SEvalZero 
281*10465441SEvalZero     if (result != FR_OK)
282*10465441SEvalZero     {
283*10465441SEvalZero         rt_kprintf("format error\n");
284*10465441SEvalZero         return elm_result_to_dfs(result);
285*10465441SEvalZero     }
286*10465441SEvalZero 
287*10465441SEvalZero     return RT_EOK;
288*10465441SEvalZero }
289*10465441SEvalZero 
dfs_elm_statfs(struct dfs_filesystem * fs,struct statfs * buf)290*10465441SEvalZero int dfs_elm_statfs(struct dfs_filesystem *fs, struct statfs *buf)
291*10465441SEvalZero {
292*10465441SEvalZero     FATFS *f;
293*10465441SEvalZero     FRESULT res;
294*10465441SEvalZero     char driver[4];
295*10465441SEvalZero     DWORD fre_clust, fre_sect, tot_sect;
296*10465441SEvalZero 
297*10465441SEvalZero     RT_ASSERT(fs != RT_NULL);
298*10465441SEvalZero     RT_ASSERT(buf != RT_NULL);
299*10465441SEvalZero 
300*10465441SEvalZero     f = (FATFS *)fs->data;
301*10465441SEvalZero 
302*10465441SEvalZero     rt_snprintf(driver, sizeof(driver), "%d:", f->drv);
303*10465441SEvalZero     res = f_getfree(driver, &fre_clust, &f);
304*10465441SEvalZero     if (res)
305*10465441SEvalZero         return elm_result_to_dfs(res);
306*10465441SEvalZero 
307*10465441SEvalZero     /* Get total sectors and free sectors */
308*10465441SEvalZero     tot_sect = (f->n_fatent - 2) * f->csize;
309*10465441SEvalZero     fre_sect = fre_clust * f->csize;
310*10465441SEvalZero 
311*10465441SEvalZero     buf->f_bfree = fre_sect;
312*10465441SEvalZero     buf->f_blocks = tot_sect;
313*10465441SEvalZero #if _MAX_SS != 512
314*10465441SEvalZero     buf->f_bsize = f->ssize;
315*10465441SEvalZero #else
316*10465441SEvalZero     buf->f_bsize = 512;
317*10465441SEvalZero #endif
318*10465441SEvalZero 
319*10465441SEvalZero     return 0;
320*10465441SEvalZero }
321*10465441SEvalZero 
dfs_elm_open(struct dfs_fd * file)322*10465441SEvalZero int dfs_elm_open(struct dfs_fd *file)
323*10465441SEvalZero {
324*10465441SEvalZero     FIL *fd;
325*10465441SEvalZero     BYTE mode;
326*10465441SEvalZero     FRESULT result;
327*10465441SEvalZero     char *drivers_fn;
328*10465441SEvalZero 
329*10465441SEvalZero #if (_VOLUMES > 1)
330*10465441SEvalZero     int vol;
331*10465441SEvalZero     struct dfs_filesystem *fs = (struct dfs_filesystem *)file->data;
332*10465441SEvalZero     extern int elm_get_vol(FATFS * fat);
333*10465441SEvalZero 
334*10465441SEvalZero     if (fs == NULL)
335*10465441SEvalZero         return -ENOENT;
336*10465441SEvalZero 
337*10465441SEvalZero     /* add path for ELM FatFS driver support */
338*10465441SEvalZero     vol = elm_get_vol((FATFS *)fs->data);
339*10465441SEvalZero     if (vol < 0)
340*10465441SEvalZero         return -ENOENT;
341*10465441SEvalZero     drivers_fn = rt_malloc(256);
342*10465441SEvalZero     if (drivers_fn == RT_NULL)
343*10465441SEvalZero         return -ENOMEM;
344*10465441SEvalZero 
345*10465441SEvalZero     rt_snprintf(drivers_fn, 256, "%d:%s", vol, file->path);
346*10465441SEvalZero #else
347*10465441SEvalZero     drivers_fn = file->path;
348*10465441SEvalZero #endif
349*10465441SEvalZero 
350*10465441SEvalZero     if (file->flags & O_DIRECTORY)
351*10465441SEvalZero     {
352*10465441SEvalZero         DIR *dir;
353*10465441SEvalZero 
354*10465441SEvalZero         if (file->flags & O_CREAT)
355*10465441SEvalZero         {
356*10465441SEvalZero             result = f_mkdir(drivers_fn);
357*10465441SEvalZero             if (result != FR_OK)
358*10465441SEvalZero             {
359*10465441SEvalZero #if _VOLUMES > 1
360*10465441SEvalZero                 rt_free(drivers_fn);
361*10465441SEvalZero #endif
362*10465441SEvalZero                 return elm_result_to_dfs(result);
363*10465441SEvalZero             }
364*10465441SEvalZero         }
365*10465441SEvalZero 
366*10465441SEvalZero         /* open directory */
367*10465441SEvalZero         dir = (DIR *)rt_malloc(sizeof(DIR));
368*10465441SEvalZero         if (dir == RT_NULL)
369*10465441SEvalZero         {
370*10465441SEvalZero #if _VOLUMES > 1
371*10465441SEvalZero             rt_free(drivers_fn);
372*10465441SEvalZero #endif
373*10465441SEvalZero             return -ENOMEM;
374*10465441SEvalZero         }
375*10465441SEvalZero 
376*10465441SEvalZero         result = f_opendir(dir, drivers_fn);
377*10465441SEvalZero #if _VOLUMES > 1
378*10465441SEvalZero         rt_free(drivers_fn);
379*10465441SEvalZero #endif
380*10465441SEvalZero         if (result != FR_OK)
381*10465441SEvalZero         {
382*10465441SEvalZero             rt_free(dir);
383*10465441SEvalZero             return elm_result_to_dfs(result);
384*10465441SEvalZero         }
385*10465441SEvalZero 
386*10465441SEvalZero         file->data = dir;
387*10465441SEvalZero         return RT_EOK;
388*10465441SEvalZero     }
389*10465441SEvalZero     else
390*10465441SEvalZero     {
391*10465441SEvalZero         mode = FA_READ;
392*10465441SEvalZero 
393*10465441SEvalZero         if (file->flags & O_WRONLY)
394*10465441SEvalZero             mode |= FA_WRITE;
395*10465441SEvalZero         if ((file->flags & O_ACCMODE) & O_RDWR)
396*10465441SEvalZero             mode |= FA_WRITE;
397*10465441SEvalZero         /* Opens the file, if it is existing. If not, a new file is created. */
398*10465441SEvalZero         if (file->flags & O_CREAT)
399*10465441SEvalZero             mode |= FA_OPEN_ALWAYS;
400*10465441SEvalZero         /* Creates a new file. If the file is existing, it is truncated and overwritten. */
401*10465441SEvalZero         if (file->flags & O_TRUNC)
402*10465441SEvalZero             mode |= FA_CREATE_ALWAYS;
403*10465441SEvalZero         /* Creates a new file. The function fails if the file is already existing. */
404*10465441SEvalZero         if (file->flags & O_EXCL)
405*10465441SEvalZero             mode |= FA_CREATE_NEW;
406*10465441SEvalZero 
407*10465441SEvalZero         /* allocate a fd */
408*10465441SEvalZero         fd = (FIL *)rt_malloc(sizeof(FIL));
409*10465441SEvalZero         if (fd == RT_NULL)
410*10465441SEvalZero         {
411*10465441SEvalZero #if _VOLUMES > 1
412*10465441SEvalZero             rt_free(drivers_fn);
413*10465441SEvalZero #endif
414*10465441SEvalZero             return -ENOMEM;
415*10465441SEvalZero         }
416*10465441SEvalZero 
417*10465441SEvalZero         result = f_open(fd, drivers_fn, mode);
418*10465441SEvalZero #if _VOLUMES > 1
419*10465441SEvalZero         rt_free(drivers_fn);
420*10465441SEvalZero #endif
421*10465441SEvalZero         if (result == FR_OK)
422*10465441SEvalZero         {
423*10465441SEvalZero             file->pos  = fd->fptr;
424*10465441SEvalZero             file->size = f_size(fd);
425*10465441SEvalZero             file->data = fd;
426*10465441SEvalZero 
427*10465441SEvalZero             if (file->flags & O_APPEND)
428*10465441SEvalZero             {
429*10465441SEvalZero                 /* seek to the end of file */
430*10465441SEvalZero                 f_lseek(fd, f_size(fd));
431*10465441SEvalZero                 file->pos = fd->fptr;
432*10465441SEvalZero             }
433*10465441SEvalZero         }
434*10465441SEvalZero         else
435*10465441SEvalZero         {
436*10465441SEvalZero             /* open failed, return */
437*10465441SEvalZero             rt_free(fd);
438*10465441SEvalZero             return elm_result_to_dfs(result);
439*10465441SEvalZero         }
440*10465441SEvalZero     }
441*10465441SEvalZero 
442*10465441SEvalZero     return RT_EOK;
443*10465441SEvalZero }
444*10465441SEvalZero 
dfs_elm_close(struct dfs_fd * file)445*10465441SEvalZero int dfs_elm_close(struct dfs_fd *file)
446*10465441SEvalZero {
447*10465441SEvalZero     FRESULT result;
448*10465441SEvalZero 
449*10465441SEvalZero     result = FR_OK;
450*10465441SEvalZero     if (file->type == FT_DIRECTORY)
451*10465441SEvalZero     {
452*10465441SEvalZero         DIR *dir;
453*10465441SEvalZero 
454*10465441SEvalZero         dir = (DIR *)(file->data);
455*10465441SEvalZero         RT_ASSERT(dir != RT_NULL);
456*10465441SEvalZero 
457*10465441SEvalZero         /* release memory */
458*10465441SEvalZero         rt_free(dir);
459*10465441SEvalZero     }
460*10465441SEvalZero     else if (file->type == FT_REGULAR)
461*10465441SEvalZero     {
462*10465441SEvalZero         FIL *fd;
463*10465441SEvalZero         fd = (FIL *)(file->data);
464*10465441SEvalZero         RT_ASSERT(fd != RT_NULL);
465*10465441SEvalZero 
466*10465441SEvalZero         result = f_close(fd);
467*10465441SEvalZero         if (result == FR_OK)
468*10465441SEvalZero         {
469*10465441SEvalZero             /* release memory */
470*10465441SEvalZero             rt_free(fd);
471*10465441SEvalZero         }
472*10465441SEvalZero     }
473*10465441SEvalZero 
474*10465441SEvalZero     return elm_result_to_dfs(result);
475*10465441SEvalZero }
476*10465441SEvalZero 
dfs_elm_ioctl(struct dfs_fd * file,int cmd,void * args)477*10465441SEvalZero int dfs_elm_ioctl(struct dfs_fd *file, int cmd, void *args)
478*10465441SEvalZero {
479*10465441SEvalZero     return -ENOSYS;
480*10465441SEvalZero }
481*10465441SEvalZero 
dfs_elm_read(struct dfs_fd * file,void * buf,size_t len)482*10465441SEvalZero int dfs_elm_read(struct dfs_fd *file, void *buf, size_t len)
483*10465441SEvalZero {
484*10465441SEvalZero     FIL *fd;
485*10465441SEvalZero     FRESULT result;
486*10465441SEvalZero     UINT byte_read;
487*10465441SEvalZero 
488*10465441SEvalZero     if (file->type == FT_DIRECTORY)
489*10465441SEvalZero     {
490*10465441SEvalZero         return -EISDIR;
491*10465441SEvalZero     }
492*10465441SEvalZero 
493*10465441SEvalZero     fd = (FIL *)(file->data);
494*10465441SEvalZero     RT_ASSERT(fd != RT_NULL);
495*10465441SEvalZero 
496*10465441SEvalZero     result = f_read(fd, buf, len, &byte_read);
497*10465441SEvalZero     /* update position */
498*10465441SEvalZero     file->pos  = fd->fptr;
499*10465441SEvalZero     if (result == FR_OK)
500*10465441SEvalZero         return byte_read;
501*10465441SEvalZero 
502*10465441SEvalZero     return elm_result_to_dfs(result);
503*10465441SEvalZero }
504*10465441SEvalZero 
dfs_elm_write(struct dfs_fd * file,const void * buf,size_t len)505*10465441SEvalZero int dfs_elm_write(struct dfs_fd *file, const void *buf, size_t len)
506*10465441SEvalZero {
507*10465441SEvalZero     FIL *fd;
508*10465441SEvalZero     FRESULT result;
509*10465441SEvalZero     UINT byte_write;
510*10465441SEvalZero 
511*10465441SEvalZero     if (file->type == FT_DIRECTORY)
512*10465441SEvalZero     {
513*10465441SEvalZero         return -EISDIR;
514*10465441SEvalZero     }
515*10465441SEvalZero 
516*10465441SEvalZero     fd = (FIL *)(file->data);
517*10465441SEvalZero     RT_ASSERT(fd != RT_NULL);
518*10465441SEvalZero 
519*10465441SEvalZero     result = f_write(fd, buf, len, &byte_write);
520*10465441SEvalZero     /* update position and file size */
521*10465441SEvalZero     file->pos  = fd->fptr;
522*10465441SEvalZero     file->size = f_size(fd);
523*10465441SEvalZero     if (result == FR_OK)
524*10465441SEvalZero         return byte_write;
525*10465441SEvalZero 
526*10465441SEvalZero     return elm_result_to_dfs(result);
527*10465441SEvalZero }
528*10465441SEvalZero 
dfs_elm_flush(struct dfs_fd * file)529*10465441SEvalZero int dfs_elm_flush(struct dfs_fd *file)
530*10465441SEvalZero {
531*10465441SEvalZero     FIL *fd;
532*10465441SEvalZero     FRESULT result;
533*10465441SEvalZero 
534*10465441SEvalZero     fd = (FIL *)(file->data);
535*10465441SEvalZero     RT_ASSERT(fd != RT_NULL);
536*10465441SEvalZero 
537*10465441SEvalZero     result = f_sync(fd);
538*10465441SEvalZero     return elm_result_to_dfs(result);
539*10465441SEvalZero }
540*10465441SEvalZero 
dfs_elm_lseek(struct dfs_fd * file,rt_off_t offset)541*10465441SEvalZero int dfs_elm_lseek(struct dfs_fd *file, rt_off_t offset)
542*10465441SEvalZero {
543*10465441SEvalZero     FRESULT result = FR_OK;
544*10465441SEvalZero     if (file->type == FT_REGULAR)
545*10465441SEvalZero     {
546*10465441SEvalZero         FIL *fd;
547*10465441SEvalZero 
548*10465441SEvalZero         /* regular file type */
549*10465441SEvalZero         fd = (FIL *)(file->data);
550*10465441SEvalZero         RT_ASSERT(fd != RT_NULL);
551*10465441SEvalZero 
552*10465441SEvalZero         result = f_lseek(fd, offset);
553*10465441SEvalZero         if (result == FR_OK)
554*10465441SEvalZero         {
555*10465441SEvalZero             /* return current position */
556*10465441SEvalZero             file->pos = fd->fptr;
557*10465441SEvalZero             return fd->fptr;
558*10465441SEvalZero         }
559*10465441SEvalZero     }
560*10465441SEvalZero     else if (file->type == FT_DIRECTORY)
561*10465441SEvalZero     {
562*10465441SEvalZero         /* which is a directory */
563*10465441SEvalZero         DIR *dir;
564*10465441SEvalZero 
565*10465441SEvalZero         dir = (DIR *)(file->data);
566*10465441SEvalZero         RT_ASSERT(dir != RT_NULL);
567*10465441SEvalZero 
568*10465441SEvalZero         result = f_seekdir(dir, offset / sizeof(struct dirent));
569*10465441SEvalZero         if (result == FR_OK)
570*10465441SEvalZero         {
571*10465441SEvalZero             /* update file position */
572*10465441SEvalZero             file->pos = offset;
573*10465441SEvalZero             return file->pos;
574*10465441SEvalZero         }
575*10465441SEvalZero     }
576*10465441SEvalZero 
577*10465441SEvalZero     return elm_result_to_dfs(result);
578*10465441SEvalZero }
579*10465441SEvalZero 
dfs_elm_getdents(struct dfs_fd * file,struct dirent * dirp,uint32_t count)580*10465441SEvalZero int dfs_elm_getdents(struct dfs_fd *file, struct dirent *dirp, uint32_t count)
581*10465441SEvalZero {
582*10465441SEvalZero     DIR *dir;
583*10465441SEvalZero     FILINFO fno;
584*10465441SEvalZero     FRESULT result;
585*10465441SEvalZero     rt_uint32_t index;
586*10465441SEvalZero     struct dirent *d;
587*10465441SEvalZero 
588*10465441SEvalZero     dir = (DIR *)(file->data);
589*10465441SEvalZero     RT_ASSERT(dir != RT_NULL);
590*10465441SEvalZero 
591*10465441SEvalZero     /* make integer count */
592*10465441SEvalZero     count = (count / sizeof(struct dirent)) * sizeof(struct dirent);
593*10465441SEvalZero     if (count == 0)
594*10465441SEvalZero         return -EINVAL;
595*10465441SEvalZero 
596*10465441SEvalZero     index = 0;
597*10465441SEvalZero     while (1)
598*10465441SEvalZero     {
599*10465441SEvalZero         char *fn;
600*10465441SEvalZero 
601*10465441SEvalZero         d = dirp + index;
602*10465441SEvalZero 
603*10465441SEvalZero         result = f_readdir(dir, &fno);
604*10465441SEvalZero         if (result != FR_OK || fno.fname[0] == 0)
605*10465441SEvalZero             break;
606*10465441SEvalZero 
607*10465441SEvalZero #if _USE_LFN
608*10465441SEvalZero         fn = *fno.fname ? fno.fname : fno.altname;
609*10465441SEvalZero #else
610*10465441SEvalZero         fn = fno.fname;
611*10465441SEvalZero #endif
612*10465441SEvalZero 
613*10465441SEvalZero         d->d_type = DT_UNKNOWN;
614*10465441SEvalZero         if (fno.fattrib & AM_DIR)
615*10465441SEvalZero             d->d_type = DT_DIR;
616*10465441SEvalZero         else
617*10465441SEvalZero             d->d_type = DT_REG;
618*10465441SEvalZero 
619*10465441SEvalZero         d->d_namlen = (rt_uint8_t)rt_strlen(fn);
620*10465441SEvalZero         d->d_reclen = (rt_uint16_t)sizeof(struct dirent);
621*10465441SEvalZero         rt_strncpy(d->d_name, fn, rt_strlen(fn) + 1);
622*10465441SEvalZero 
623*10465441SEvalZero         index ++;
624*10465441SEvalZero         if (index * sizeof(struct dirent) >= count)
625*10465441SEvalZero             break;
626*10465441SEvalZero     }
627*10465441SEvalZero 
628*10465441SEvalZero     if (index == 0)
629*10465441SEvalZero         return elm_result_to_dfs(result);
630*10465441SEvalZero 
631*10465441SEvalZero     file->pos += index * sizeof(struct dirent);
632*10465441SEvalZero 
633*10465441SEvalZero     return index * sizeof(struct dirent);
634*10465441SEvalZero }
635*10465441SEvalZero 
dfs_elm_unlink(struct dfs_filesystem * fs,const char * path)636*10465441SEvalZero int dfs_elm_unlink(struct dfs_filesystem *fs, const char *path)
637*10465441SEvalZero {
638*10465441SEvalZero     FRESULT result;
639*10465441SEvalZero 
640*10465441SEvalZero #if _VOLUMES > 1
641*10465441SEvalZero     int vol;
642*10465441SEvalZero     char *drivers_fn;
643*10465441SEvalZero     extern int elm_get_vol(FATFS * fat);
644*10465441SEvalZero 
645*10465441SEvalZero     /* add path for ELM FatFS driver support */
646*10465441SEvalZero     vol = elm_get_vol((FATFS *)fs->data);
647*10465441SEvalZero     if (vol < 0)
648*10465441SEvalZero         return -ENOENT;
649*10465441SEvalZero     drivers_fn = rt_malloc(256);
650*10465441SEvalZero     if (drivers_fn == RT_NULL)
651*10465441SEvalZero         return -ENOMEM;
652*10465441SEvalZero 
653*10465441SEvalZero     rt_snprintf(drivers_fn, 256, "%d:%s", vol, path);
654*10465441SEvalZero #else
655*10465441SEvalZero     const char *drivers_fn;
656*10465441SEvalZero     drivers_fn = path;
657*10465441SEvalZero #endif
658*10465441SEvalZero 
659*10465441SEvalZero     result = f_unlink(drivers_fn);
660*10465441SEvalZero #if _VOLUMES > 1
661*10465441SEvalZero     rt_free(drivers_fn);
662*10465441SEvalZero #endif
663*10465441SEvalZero     return elm_result_to_dfs(result);
664*10465441SEvalZero }
665*10465441SEvalZero 
dfs_elm_rename(struct dfs_filesystem * fs,const char * oldpath,const char * newpath)666*10465441SEvalZero int dfs_elm_rename(struct dfs_filesystem *fs, const char *oldpath, const char *newpath)
667*10465441SEvalZero {
668*10465441SEvalZero     FRESULT result;
669*10465441SEvalZero 
670*10465441SEvalZero #if _VOLUMES > 1
671*10465441SEvalZero     char *drivers_oldfn;
672*10465441SEvalZero     const char *drivers_newfn;
673*10465441SEvalZero     int vol;
674*10465441SEvalZero     extern int elm_get_vol(FATFS * fat);
675*10465441SEvalZero 
676*10465441SEvalZero     /* add path for ELM FatFS driver support */
677*10465441SEvalZero     vol = elm_get_vol((FATFS *)fs->data);
678*10465441SEvalZero     if (vol < 0)
679*10465441SEvalZero         return -ENOENT;
680*10465441SEvalZero 
681*10465441SEvalZero     drivers_oldfn = rt_malloc(256);
682*10465441SEvalZero     if (drivers_oldfn == RT_NULL)
683*10465441SEvalZero         return -ENOMEM;
684*10465441SEvalZero     drivers_newfn = newpath;
685*10465441SEvalZero 
686*10465441SEvalZero     rt_snprintf(drivers_oldfn, 256, "%d:%s", vol, oldpath);
687*10465441SEvalZero #else
688*10465441SEvalZero     const char *drivers_oldfn, *drivers_newfn;
689*10465441SEvalZero 
690*10465441SEvalZero     drivers_oldfn = oldpath;
691*10465441SEvalZero     drivers_newfn = newpath;
692*10465441SEvalZero #endif
693*10465441SEvalZero 
694*10465441SEvalZero     result = f_rename(drivers_oldfn, drivers_newfn);
695*10465441SEvalZero #if _VOLUMES > 1
696*10465441SEvalZero     rt_free(drivers_oldfn);
697*10465441SEvalZero #endif
698*10465441SEvalZero     return elm_result_to_dfs(result);
699*10465441SEvalZero }
700*10465441SEvalZero 
dfs_elm_stat(struct dfs_filesystem * fs,const char * path,struct stat * st)701*10465441SEvalZero int dfs_elm_stat(struct dfs_filesystem *fs, const char *path, struct stat *st)
702*10465441SEvalZero {
703*10465441SEvalZero     FILINFO file_info;
704*10465441SEvalZero     FRESULT result;
705*10465441SEvalZero 
706*10465441SEvalZero #if _VOLUMES > 1
707*10465441SEvalZero     int vol;
708*10465441SEvalZero     char *drivers_fn;
709*10465441SEvalZero     extern int elm_get_vol(FATFS * fat);
710*10465441SEvalZero 
711*10465441SEvalZero     /* add path for ELM FatFS driver support */
712*10465441SEvalZero     vol = elm_get_vol((FATFS *)fs->data);
713*10465441SEvalZero     if (vol < 0)
714*10465441SEvalZero         return -ENOENT;
715*10465441SEvalZero     drivers_fn = rt_malloc(256);
716*10465441SEvalZero     if (drivers_fn == RT_NULL)
717*10465441SEvalZero         return -ENOMEM;
718*10465441SEvalZero 
719*10465441SEvalZero     rt_snprintf(drivers_fn, 256, "%d:%s", vol, path);
720*10465441SEvalZero #else
721*10465441SEvalZero     const char *drivers_fn;
722*10465441SEvalZero     drivers_fn = path;
723*10465441SEvalZero #endif
724*10465441SEvalZero 
725*10465441SEvalZero     result = f_stat(drivers_fn, &file_info);
726*10465441SEvalZero #if _VOLUMES > 1
727*10465441SEvalZero     rt_free(drivers_fn);
728*10465441SEvalZero #endif
729*10465441SEvalZero     if (result == FR_OK)
730*10465441SEvalZero     {
731*10465441SEvalZero         /* convert to dfs stat structure */
732*10465441SEvalZero         st->st_dev = 0;
733*10465441SEvalZero 
734*10465441SEvalZero         st->st_mode = S_IFREG | S_IRUSR | S_IRGRP | S_IROTH |
735*10465441SEvalZero                       S_IWUSR | S_IWGRP | S_IWOTH;
736*10465441SEvalZero         if (file_info.fattrib & AM_DIR)
737*10465441SEvalZero         {
738*10465441SEvalZero             st->st_mode &= ~S_IFREG;
739*10465441SEvalZero             st->st_mode |= S_IFDIR | S_IXUSR | S_IXGRP | S_IXOTH;
740*10465441SEvalZero         }
741*10465441SEvalZero         if (file_info.fattrib & AM_RDO)
742*10465441SEvalZero             st->st_mode &= ~(S_IWUSR | S_IWGRP | S_IWOTH);
743*10465441SEvalZero 
744*10465441SEvalZero         st->st_size  = file_info.fsize;
745*10465441SEvalZero 
746*10465441SEvalZero         /* get st_mtime. */
747*10465441SEvalZero         {
748*10465441SEvalZero             struct tm tm_file;
749*10465441SEvalZero             int year, mon, day, hour, min, sec;
750*10465441SEvalZero             WORD tmp;
751*10465441SEvalZero 
752*10465441SEvalZero             tmp = file_info.fdate;
753*10465441SEvalZero             day = tmp & 0x1F;           /* bit[4:0] Day(1..31) */
754*10465441SEvalZero             tmp >>= 5;
755*10465441SEvalZero             mon = tmp & 0x0F;           /* bit[8:5] Month(1..12) */
756*10465441SEvalZero             tmp >>= 4;
757*10465441SEvalZero             year = (tmp & 0x7F) + 1980; /* bit[15:9] Year origin from 1980(0..127) */
758*10465441SEvalZero 
759*10465441SEvalZero             tmp = file_info.ftime;
760*10465441SEvalZero             sec = (tmp & 0x1F) * 2;     /* bit[4:0] Second/2(0..29) */
761*10465441SEvalZero             tmp >>= 5;
762*10465441SEvalZero             min = tmp & 0x3F;           /* bit[10:5] Minute(0..59) */
763*10465441SEvalZero             tmp >>= 6;
764*10465441SEvalZero             hour = tmp & 0x1F;          /* bit[15:11] Hour(0..23) */
765*10465441SEvalZero 
766*10465441SEvalZero             memset(&tm_file, 0, sizeof(tm_file));
767*10465441SEvalZero             tm_file.tm_year = year - 1900; /* Years since 1900 */
768*10465441SEvalZero             tm_file.tm_mon  = mon - 1;     /* Months *since* january: 0-11 */
769*10465441SEvalZero             tm_file.tm_mday = day;         /* Day of the month: 1-31 */
770*10465441SEvalZero             tm_file.tm_hour = hour;        /* Hours since midnight: 0-23 */
771*10465441SEvalZero             tm_file.tm_min  = min;         /* Minutes: 0-59 */
772*10465441SEvalZero             tm_file.tm_sec  = sec;         /* Seconds: 0-59 */
773*10465441SEvalZero 
774*10465441SEvalZero             st->st_mtime = mktime(&tm_file);
775*10465441SEvalZero         } /* get st_mtime. */
776*10465441SEvalZero     }
777*10465441SEvalZero 
778*10465441SEvalZero     return elm_result_to_dfs(result);
779*10465441SEvalZero }
780*10465441SEvalZero 
781*10465441SEvalZero static const struct dfs_file_ops dfs_elm_fops =
782*10465441SEvalZero {
783*10465441SEvalZero     dfs_elm_open,
784*10465441SEvalZero     dfs_elm_close,
785*10465441SEvalZero     dfs_elm_ioctl,
786*10465441SEvalZero     dfs_elm_read,
787*10465441SEvalZero     dfs_elm_write,
788*10465441SEvalZero     dfs_elm_flush,
789*10465441SEvalZero     dfs_elm_lseek,
790*10465441SEvalZero     dfs_elm_getdents,
791*10465441SEvalZero     RT_NULL, /* poll interface */
792*10465441SEvalZero };
793*10465441SEvalZero 
794*10465441SEvalZero static const struct dfs_filesystem_ops dfs_elm =
795*10465441SEvalZero {
796*10465441SEvalZero     "elm",
797*10465441SEvalZero     DFS_FS_FLAG_DEFAULT,
798*10465441SEvalZero     &dfs_elm_fops,
799*10465441SEvalZero 
800*10465441SEvalZero     dfs_elm_mount,
801*10465441SEvalZero     dfs_elm_unmount,
802*10465441SEvalZero     dfs_elm_mkfs,
803*10465441SEvalZero     dfs_elm_statfs,
804*10465441SEvalZero 
805*10465441SEvalZero     dfs_elm_unlink,
806*10465441SEvalZero     dfs_elm_stat,
807*10465441SEvalZero     dfs_elm_rename,
808*10465441SEvalZero };
809*10465441SEvalZero 
elm_init(void)810*10465441SEvalZero int elm_init(void)
811*10465441SEvalZero {
812*10465441SEvalZero     /* register fatfs file system */
813*10465441SEvalZero     dfs_register(&dfs_elm);
814*10465441SEvalZero 
815*10465441SEvalZero     return 0;
816*10465441SEvalZero }
817*10465441SEvalZero INIT_COMPONENT_EXPORT(elm_init);
818*10465441SEvalZero 
819*10465441SEvalZero /*
820*10465441SEvalZero  * RT-Thread Device Interface for ELM FatFs
821*10465441SEvalZero  */
822*10465441SEvalZero #include "diskio.h"
823*10465441SEvalZero 
824*10465441SEvalZero /* Initialize a Drive */
disk_initialize(BYTE drv)825*10465441SEvalZero DSTATUS disk_initialize(BYTE drv)
826*10465441SEvalZero {
827*10465441SEvalZero     return 0;
828*10465441SEvalZero }
829*10465441SEvalZero 
830*10465441SEvalZero /* Return Disk Status */
disk_status(BYTE drv)831*10465441SEvalZero DSTATUS disk_status(BYTE drv)
832*10465441SEvalZero {
833*10465441SEvalZero     return 0;
834*10465441SEvalZero }
835*10465441SEvalZero 
836*10465441SEvalZero /* Read Sector(s) */
disk_read(BYTE drv,BYTE * buff,DWORD sector,UINT count)837*10465441SEvalZero DRESULT disk_read (BYTE drv, BYTE* buff, DWORD sector, UINT count)
838*10465441SEvalZero {
839*10465441SEvalZero     rt_size_t result;
840*10465441SEvalZero     rt_device_t device = disk[drv];
841*10465441SEvalZero 
842*10465441SEvalZero     result = rt_device_read(device, sector, buff, count);
843*10465441SEvalZero     if (result == count)
844*10465441SEvalZero     {
845*10465441SEvalZero         return RES_OK;
846*10465441SEvalZero     }
847*10465441SEvalZero 
848*10465441SEvalZero     return RES_ERROR;
849*10465441SEvalZero }
850*10465441SEvalZero 
851*10465441SEvalZero /* Write Sector(s) */
disk_write(BYTE drv,const BYTE * buff,DWORD sector,UINT count)852*10465441SEvalZero DRESULT disk_write (BYTE drv, const BYTE* buff, DWORD sector, UINT count)
853*10465441SEvalZero {
854*10465441SEvalZero     rt_size_t result;
855*10465441SEvalZero     rt_device_t device = disk[drv];
856*10465441SEvalZero 
857*10465441SEvalZero     result = rt_device_write(device, sector, buff, count);
858*10465441SEvalZero     if (result == count)
859*10465441SEvalZero     {
860*10465441SEvalZero         return RES_OK;
861*10465441SEvalZero     }
862*10465441SEvalZero 
863*10465441SEvalZero     return RES_ERROR;
864*10465441SEvalZero }
865*10465441SEvalZero 
866*10465441SEvalZero /* Miscellaneous Functions */
disk_ioctl(BYTE drv,BYTE ctrl,void * buff)867*10465441SEvalZero DRESULT disk_ioctl(BYTE drv, BYTE ctrl, void *buff)
868*10465441SEvalZero {
869*10465441SEvalZero     rt_device_t device = disk[drv];
870*10465441SEvalZero 
871*10465441SEvalZero     if (device == RT_NULL)
872*10465441SEvalZero         return RES_ERROR;
873*10465441SEvalZero 
874*10465441SEvalZero     if (ctrl == GET_SECTOR_COUNT)
875*10465441SEvalZero     {
876*10465441SEvalZero         struct rt_device_blk_geometry geometry;
877*10465441SEvalZero 
878*10465441SEvalZero         rt_memset(&geometry, 0, sizeof(geometry));
879*10465441SEvalZero         rt_device_control(device, RT_DEVICE_CTRL_BLK_GETGEOME, &geometry);
880*10465441SEvalZero 
881*10465441SEvalZero         *(DWORD *)buff = geometry.sector_count;
882*10465441SEvalZero         if (geometry.sector_count == 0)
883*10465441SEvalZero             return RES_ERROR;
884*10465441SEvalZero     }
885*10465441SEvalZero     else if (ctrl == GET_SECTOR_SIZE)
886*10465441SEvalZero     {
887*10465441SEvalZero         struct rt_device_blk_geometry geometry;
888*10465441SEvalZero 
889*10465441SEvalZero         rt_memset(&geometry, 0, sizeof(geometry));
890*10465441SEvalZero         rt_device_control(device, RT_DEVICE_CTRL_BLK_GETGEOME, &geometry);
891*10465441SEvalZero 
892*10465441SEvalZero         *(WORD *)buff = (WORD)(geometry.bytes_per_sector);
893*10465441SEvalZero     }
894*10465441SEvalZero     else if (ctrl == GET_BLOCK_SIZE) /* Get erase block size in unit of sectors (DWORD) */
895*10465441SEvalZero     {
896*10465441SEvalZero         struct rt_device_blk_geometry geometry;
897*10465441SEvalZero 
898*10465441SEvalZero         rt_memset(&geometry, 0, sizeof(geometry));
899*10465441SEvalZero         rt_device_control(device, RT_DEVICE_CTRL_BLK_GETGEOME, &geometry);
900*10465441SEvalZero 
901*10465441SEvalZero         *(DWORD *)buff = geometry.block_size / geometry.bytes_per_sector;
902*10465441SEvalZero     }
903*10465441SEvalZero     else if (ctrl == CTRL_SYNC)
904*10465441SEvalZero     {
905*10465441SEvalZero         rt_device_control(device, RT_DEVICE_CTRL_BLK_SYNC, RT_NULL);
906*10465441SEvalZero     }
907*10465441SEvalZero     else if (ctrl == CTRL_TRIM)
908*10465441SEvalZero     {
909*10465441SEvalZero         rt_device_control(device, RT_DEVICE_CTRL_BLK_ERASE, buff);
910*10465441SEvalZero     }
911*10465441SEvalZero 
912*10465441SEvalZero     return RES_OK;
913*10465441SEvalZero }
914*10465441SEvalZero 
get_fattime(void)915*10465441SEvalZero DWORD get_fattime(void)
916*10465441SEvalZero {
917*10465441SEvalZero     DWORD fat_time = 0;
918*10465441SEvalZero 
919*10465441SEvalZero #ifdef RT_USING_LIBC
920*10465441SEvalZero     time_t now;
921*10465441SEvalZero     struct tm *p_tm;
922*10465441SEvalZero     struct tm tm_now;
923*10465441SEvalZero 
924*10465441SEvalZero     /* get current time */
925*10465441SEvalZero     now = time(RT_NULL);
926*10465441SEvalZero 
927*10465441SEvalZero     /* lock scheduler. */
928*10465441SEvalZero     rt_enter_critical();
929*10465441SEvalZero     /* converts calendar time time into local time. */
930*10465441SEvalZero     p_tm = localtime(&now);
931*10465441SEvalZero     /* copy the statically located variable */
932*10465441SEvalZero     memcpy(&tm_now, p_tm, sizeof(struct tm));
933*10465441SEvalZero     /* unlock scheduler. */
934*10465441SEvalZero     rt_exit_critical();
935*10465441SEvalZero 
936*10465441SEvalZero     fat_time =  (DWORD)(tm_now.tm_year - 80) << 25 |
937*10465441SEvalZero                 (DWORD)(tm_now.tm_mon + 1)   << 21 |
938*10465441SEvalZero                 (DWORD)tm_now.tm_mday        << 16 |
939*10465441SEvalZero                 (DWORD)tm_now.tm_hour        << 11 |
940*10465441SEvalZero                 (DWORD)tm_now.tm_min         <<  5 |
941*10465441SEvalZero                 (DWORD)tm_now.tm_sec / 2 ;
942*10465441SEvalZero #endif /* RT_USING_LIBC  */
943*10465441SEvalZero 
944*10465441SEvalZero     return fat_time;
945*10465441SEvalZero }
946*10465441SEvalZero 
947*10465441SEvalZero #if _FS_REENTRANT
ff_cre_syncobj(BYTE drv,_SYNC_t * m)948*10465441SEvalZero int ff_cre_syncobj(BYTE drv, _SYNC_t *m)
949*10465441SEvalZero {
950*10465441SEvalZero     char name[8];
951*10465441SEvalZero     rt_mutex_t mutex;
952*10465441SEvalZero 
953*10465441SEvalZero     rt_snprintf(name, sizeof(name), "fat%d", drv);
954*10465441SEvalZero     mutex = rt_mutex_create(name, RT_IPC_FLAG_FIFO);
955*10465441SEvalZero     if (mutex != RT_NULL)
956*10465441SEvalZero     {
957*10465441SEvalZero         *m = mutex;
958*10465441SEvalZero         return RT_TRUE;
959*10465441SEvalZero     }
960*10465441SEvalZero 
961*10465441SEvalZero     return RT_FALSE;
962*10465441SEvalZero }
963*10465441SEvalZero 
ff_del_syncobj(_SYNC_t m)964*10465441SEvalZero int ff_del_syncobj(_SYNC_t m)
965*10465441SEvalZero {
966*10465441SEvalZero     if (m != RT_NULL)
967*10465441SEvalZero         rt_mutex_delete(m);
968*10465441SEvalZero 
969*10465441SEvalZero     return RT_TRUE;
970*10465441SEvalZero }
971*10465441SEvalZero 
ff_req_grant(_SYNC_t m)972*10465441SEvalZero int ff_req_grant(_SYNC_t m)
973*10465441SEvalZero {
974*10465441SEvalZero     if (rt_mutex_take(m, _FS_TIMEOUT) == RT_EOK)
975*10465441SEvalZero         return RT_TRUE;
976*10465441SEvalZero 
977*10465441SEvalZero     return RT_FALSE;
978*10465441SEvalZero }
979*10465441SEvalZero 
ff_rel_grant(_SYNC_t m)980*10465441SEvalZero void ff_rel_grant(_SYNC_t m)
981*10465441SEvalZero {
982*10465441SEvalZero     rt_mutex_release(m);
983*10465441SEvalZero }
984*10465441SEvalZero 
985*10465441SEvalZero #endif
986*10465441SEvalZero 
987*10465441SEvalZero /* Memory functions */
988*10465441SEvalZero #if _USE_LFN == 3
989*10465441SEvalZero /* Allocate memory block */
ff_memalloc(UINT size)990*10465441SEvalZero void *ff_memalloc(UINT size)
991*10465441SEvalZero {
992*10465441SEvalZero     return rt_malloc(size);
993*10465441SEvalZero }
994*10465441SEvalZero 
995*10465441SEvalZero /* Free memory block */
ff_memfree(void * mem)996*10465441SEvalZero void ff_memfree(void *mem)
997*10465441SEvalZero {
998*10465441SEvalZero     rt_free(mem);
999*10465441SEvalZero }
1000*10465441SEvalZero #endif /* _USE_LFN == 3 */
1001*10465441SEvalZero 
1002