1002 lines
		
	
	
		
			22 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			1002 lines
		
	
	
		
			22 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
|  | /*
 | ||
|  |  * Copyright (c) 2006-2018, RT-Thread Development Team | ||
|  |  * | ||
|  |  * SPDX-License-Identifier: Apache-2.0 | ||
|  |  * | ||
|  |  * Change Logs: | ||
|  |  * Date           Author       Notes | ||
|  |  * 2008-02-22     QiuYi        The first version. | ||
|  |  * 2011-10-08     Bernard      fixed the block size in statfs. | ||
|  |  * 2011-11-23     Bernard      fixed the rename issue. | ||
|  |  * 2012-07-26     aozima       implement ff_memalloc and ff_memfree. | ||
|  |  * 2012-12-19     Bernard      fixed the O_APPEND and lseek issue. | ||
|  |  * 2013-03-01     aozima       fixed the stat(st_mtime) issue. | ||
|  |  * 2014-01-26     Bernard      Check the sector size before mount. | ||
|  |  * 2017-02-13     Hichard      Update Fatfs version to 0.12b, support exFAT. | ||
|  |  * 2017-04-11     Bernard      fix the st_blksize issue. | ||
|  |  * 2017-05-26     Urey         fix f_mount error when mount more fats | ||
|  |  */ | ||
|  | 
 | ||
|  | #include <rtthread.h>
 | ||
|  | #include "ffconf.h"
 | ||
|  | #include "ff.h"
 | ||
|  | #include <string.h>
 | ||
|  | #include <time.h>
 | ||
|  | 
 | ||
|  | /* ELM FatFs provide a DIR struct */ | ||
|  | #define HAVE_DIR_STRUCTURE
 | ||
|  | 
 | ||
|  | #include <dfs_fs.h>
 | ||
|  | #include <dfs_file.h>
 | ||
|  | 
 | ||
|  | static rt_device_t disk[_VOLUMES] = {0}; | ||
|  | 
 | ||
|  | static int elm_result_to_dfs(FRESULT result) | ||
|  | { | ||
|  |     int status = RT_EOK; | ||
|  | 
 | ||
|  |     switch (result) | ||
|  |     { | ||
|  |     case FR_OK: | ||
|  |         break; | ||
|  | 
 | ||
|  |     case FR_NO_FILE: | ||
|  |     case FR_NO_PATH: | ||
|  |     case FR_NO_FILESYSTEM: | ||
|  |         status = -ENOENT; | ||
|  |         break; | ||
|  | 
 | ||
|  |     case FR_INVALID_NAME: | ||
|  |         status = -EINVAL; | ||
|  |         break; | ||
|  | 
 | ||
|  |     case FR_EXIST: | ||
|  |     case FR_INVALID_OBJECT: | ||
|  |         status = -EEXIST; | ||
|  |         break; | ||
|  | 
 | ||
|  |     case FR_DISK_ERR: | ||
|  |     case FR_NOT_READY: | ||
|  |     case FR_INT_ERR: | ||
|  |         status = -EIO; | ||
|  |         break; | ||
|  | 
 | ||
|  |     case FR_WRITE_PROTECTED: | ||
|  |     case FR_DENIED: | ||
|  |         status = -EROFS; | ||
|  |         break; | ||
|  | 
 | ||
|  |     case FR_MKFS_ABORTED: | ||
|  |         status = -EINVAL; | ||
|  |         break; | ||
|  | 
 | ||
|  |     default: | ||
|  |         status = -1; | ||
|  |         break; | ||
|  |     } | ||
|  | 
 | ||
|  |     return status; | ||
|  | } | ||
|  | 
 | ||
|  | /* results:
 | ||
|  |  *  -1, no space to install fatfs driver | ||
|  |  *  >= 0, there is an space to install fatfs driver | ||
|  |  */ | ||
|  | static int get_disk(rt_device_t id) | ||
|  | { | ||
|  |     int index; | ||
|  | 
 | ||
|  |     for (index = 0; index < _VOLUMES; index ++) | ||
|  |     { | ||
|  |         if (disk[index] == id) | ||
|  |             return index; | ||
|  |     } | ||
|  | 
 | ||
|  |     return -1; | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_mount(struct dfs_filesystem *fs, unsigned long rwflag, const void *data) | ||
|  | { | ||
|  |     FATFS *fat; | ||
|  |     FRESULT result; | ||
|  |     int index; | ||
|  |     struct rt_device_blk_geometry geometry; | ||
|  |     char logic_nbr[2] = {'0',':'}; | ||
|  | 
 | ||
|  |     /* get an empty position */ | ||
|  |     index = get_disk(RT_NULL); | ||
|  |     if (index == -1) | ||
|  |         return -ENOENT; | ||
|  |     logic_nbr[0] = '0' + index; | ||
|  | 
 | ||
|  |     /* save device */ | ||
|  |     disk[index] = fs->dev_id; | ||
|  |     /* check sector size */ | ||
|  |     if (rt_device_control(fs->dev_id, RT_DEVICE_CTRL_BLK_GETGEOME, &geometry) == RT_EOK) | ||
|  |     { | ||
|  |         if (geometry.bytes_per_sector > _MAX_SS) | ||
|  |         { | ||
|  |             rt_kprintf("The sector size of device is greater than the sector size of FAT.\n"); | ||
|  |             return -EINVAL; | ||
|  |         } | ||
|  |     } | ||
|  | 
 | ||
|  |     fat = (FATFS *)rt_malloc(sizeof(FATFS)); | ||
|  |     if (fat == RT_NULL) | ||
|  |     { | ||
|  |         disk[index] = RT_NULL; | ||
|  |         return -ENOMEM; | ||
|  |     } | ||
|  | 
 | ||
|  |     /* mount fatfs, always 0 logic driver */ | ||
|  |     result = f_mount(fat, (const TCHAR*)logic_nbr, 1); | ||
|  |     if (result == FR_OK) | ||
|  |     { | ||
|  |         char drive[8]; | ||
|  |         DIR *dir; | ||
|  | 
 | ||
|  |         rt_snprintf(drive, sizeof(drive), "%d:/", index); | ||
|  |         dir = (DIR *)rt_malloc(sizeof(DIR)); | ||
|  |         if (dir == RT_NULL) | ||
|  |         { | ||
|  |             f_mount(RT_NULL, (const TCHAR*)logic_nbr, 1); | ||
|  |             disk[index] = RT_NULL; | ||
|  |             rt_free(fat); | ||
|  |             return -ENOMEM; | ||
|  |         } | ||
|  | 
 | ||
|  |         /* open the root directory to test whether the fatfs is valid */ | ||
|  |         result = f_opendir(dir, drive); | ||
|  |         if (result != FR_OK) | ||
|  |             goto __err; | ||
|  | 
 | ||
|  |         /* mount succeed! */ | ||
|  |         fs->data = fat; | ||
|  |         rt_free(dir); | ||
|  |         return 0; | ||
|  |     } | ||
|  | 
 | ||
|  | __err: | ||
|  |     f_mount(RT_NULL, (const TCHAR*)logic_nbr, 1); | ||
|  |     disk[index] = RT_NULL; | ||
|  |     rt_free(fat); | ||
|  |     return elm_result_to_dfs(result); | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_unmount(struct dfs_filesystem *fs) | ||
|  | { | ||
|  |     FATFS *fat; | ||
|  |     FRESULT result; | ||
|  |     int  index; | ||
|  |     char logic_nbr[2] = {'0',':'}; | ||
|  | 
 | ||
|  |     fat = (FATFS *)fs->data; | ||
|  | 
 | ||
|  |     RT_ASSERT(fat != RT_NULL); | ||
|  | 
 | ||
|  |     /* find the device index and then umount it */ | ||
|  |     index = get_disk(fs->dev_id); | ||
|  |     if (index == -1) /* not found */ | ||
|  |         return -ENOENT; | ||
|  | 
 | ||
|  |     logic_nbr[0] = '0' + index; | ||
|  |     result = f_mount(RT_NULL, logic_nbr, (BYTE)1);  | ||
|  |     if (result != FR_OK) | ||
|  |         return elm_result_to_dfs(result); | ||
|  | 
 | ||
|  |     fs->data = RT_NULL; | ||
|  |     disk[index] = RT_NULL; | ||
|  |     rt_free(fat); | ||
|  | 
 | ||
|  |     return RT_EOK; | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_mkfs(rt_device_t dev_id) | ||
|  | { | ||
|  | #define FSM_STATUS_INIT            0
 | ||
|  | #define FSM_STATUS_USE_TEMP_DRIVER 1
 | ||
|  |     FATFS *fat = RT_NULL; | ||
|  |     BYTE *work; | ||
|  |     int flag; | ||
|  |     FRESULT result; | ||
|  |     int index; | ||
|  |     char logic_nbr[2] = {'0',':'}; | ||
|  |      | ||
|  |     work = rt_malloc(_MAX_SS); | ||
|  |     if(RT_NULL == work) { | ||
|  |         return -ENOMEM; | ||
|  |     } | ||
|  | 
 | ||
|  |     if (dev_id == RT_NULL) | ||
|  |     { | ||
|  |         rt_free(work); /* release memory */ | ||
|  |         return -EINVAL; | ||
|  |     } | ||
|  | 
 | ||
|  |     /* if the device is already mounted, then just do mkfs to the drv,
 | ||
|  |      * while if it is not mounted yet, then find an empty drive to do mkfs | ||
|  |      */ | ||
|  | 
 | ||
|  |     flag = FSM_STATUS_INIT; | ||
|  |     index = get_disk(dev_id); | ||
|  |     if (index == -1) | ||
|  |     { | ||
|  |         /* not found the device id */ | ||
|  |         index = get_disk(RT_NULL); | ||
|  |         if (index == -1) | ||
|  |         { | ||
|  |             /* no space to store an temp driver */ | ||
|  |             rt_kprintf("sorry, there is no space to do mkfs! \n"); | ||
|  |             rt_free(work); /* release memory */ | ||
|  |             return -ENOSPC; | ||
|  |         } | ||
|  |         else | ||
|  |         { | ||
|  |             fat = rt_malloc(sizeof(FATFS)); | ||
|  |             if (fat == RT_NULL) | ||
|  |             { | ||
|  |                 rt_free(work); /* release memory */ | ||
|  |                 return -ENOMEM; | ||
|  |             } | ||
|  | 
 | ||
|  |             flag = FSM_STATUS_USE_TEMP_DRIVER; | ||
|  | 
 | ||
|  |             disk[index] = dev_id; | ||
|  |             /* try to open device */ | ||
|  |             rt_device_open(dev_id, RT_DEVICE_OFLAG_RDWR); | ||
|  | 
 | ||
|  |             /* just fill the FatFs[vol] in ff.c, or mkfs will failded!
 | ||
|  |              * consider this condition: you just umount the elm fat, | ||
|  |              * then the space in FatFs[index] is released, and now do mkfs | ||
|  |              * on the disk, you will get a failure. so we need f_mount here, | ||
|  |              * just fill the FatFS[index] in elm fatfs to make mkfs work. | ||
|  |              */ | ||
|  |             logic_nbr[0] = '0' + index; | ||
|  |             f_mount(fat, logic_nbr, (BYTE)index); | ||
|  |         } | ||
|  |     } | ||
|  |     else | ||
|  |     { | ||
|  |         logic_nbr[0] = '0' + index; | ||
|  |     } | ||
|  | 
 | ||
|  |     /* [IN] Logical drive number */ | ||
|  |     /* [IN] Format options */ | ||
|  |     /* [IN] Size of the allocation unit */ | ||
|  |     /* [-]  Working buffer */ | ||
|  |     /* [IN] Size of working buffer */ | ||
|  |     result = f_mkfs(logic_nbr, FM_ANY|FM_SFD, 0, work, _MAX_SS); | ||
|  |     rt_free(work); work = RT_NULL; | ||
|  | 
 | ||
|  |     /* check flag status, we need clear the temp driver stored in disk[] */ | ||
|  |     if (flag == FSM_STATUS_USE_TEMP_DRIVER) | ||
|  |     { | ||
|  |         rt_free(fat); | ||
|  |         f_mount(RT_NULL, logic_nbr,(BYTE)index); | ||
|  |         disk[index] = RT_NULL; | ||
|  |         /* close device */ | ||
|  |         rt_device_close(dev_id); | ||
|  |     } | ||
|  | 
 | ||
|  |     if (result != FR_OK) | ||
|  |     { | ||
|  |         rt_kprintf("format error\n"); | ||
|  |         return elm_result_to_dfs(result); | ||
|  |     } | ||
|  | 
 | ||
|  |     return RT_EOK; | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_statfs(struct dfs_filesystem *fs, struct statfs *buf) | ||
|  | { | ||
|  |     FATFS *f; | ||
|  |     FRESULT res; | ||
|  |     char driver[4]; | ||
|  |     DWORD fre_clust, fre_sect, tot_sect; | ||
|  | 
 | ||
|  |     RT_ASSERT(fs != RT_NULL); | ||
|  |     RT_ASSERT(buf != RT_NULL); | ||
|  | 
 | ||
|  |     f = (FATFS *)fs->data; | ||
|  | 
 | ||
|  |     rt_snprintf(driver, sizeof(driver), "%d:", f->drv); | ||
|  |     res = f_getfree(driver, &fre_clust, &f); | ||
|  |     if (res) | ||
|  |         return elm_result_to_dfs(res); | ||
|  | 
 | ||
|  |     /* Get total sectors and free sectors */ | ||
|  |     tot_sect = (f->n_fatent - 2) * f->csize; | ||
|  |     fre_sect = fre_clust * f->csize; | ||
|  | 
 | ||
|  |     buf->f_bfree = fre_sect; | ||
|  |     buf->f_blocks = tot_sect; | ||
|  | #if _MAX_SS != 512
 | ||
|  |     buf->f_bsize = f->ssize; | ||
|  | #else
 | ||
|  |     buf->f_bsize = 512; | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     return 0; | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_open(struct dfs_fd *file) | ||
|  | { | ||
|  |     FIL *fd; | ||
|  |     BYTE mode; | ||
|  |     FRESULT result; | ||
|  |     char *drivers_fn; | ||
|  | 
 | ||
|  | #if (_VOLUMES > 1)
 | ||
|  |     int vol; | ||
|  |     struct dfs_filesystem *fs = (struct dfs_filesystem *)file->data; | ||
|  |     extern int elm_get_vol(FATFS * fat); | ||
|  | 
 | ||
|  |     if (fs == NULL) | ||
|  |         return -ENOENT; | ||
|  | 
 | ||
|  |     /* add path for ELM FatFS driver support */ | ||
|  |     vol = elm_get_vol((FATFS *)fs->data); | ||
|  |     if (vol < 0) | ||
|  |         return -ENOENT; | ||
|  |     drivers_fn = rt_malloc(256); | ||
|  |     if (drivers_fn == RT_NULL) | ||
|  |         return -ENOMEM; | ||
|  | 
 | ||
|  |     rt_snprintf(drivers_fn, 256, "%d:%s", vol, file->path); | ||
|  | #else
 | ||
|  |     drivers_fn = file->path; | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     if (file->flags & O_DIRECTORY) | ||
|  |     { | ||
|  |         DIR *dir; | ||
|  | 
 | ||
|  |         if (file->flags & O_CREAT) | ||
|  |         { | ||
|  |             result = f_mkdir(drivers_fn); | ||
|  |             if (result != FR_OK) | ||
|  |             { | ||
|  | #if _VOLUMES > 1
 | ||
|  |                 rt_free(drivers_fn); | ||
|  | #endif
 | ||
|  |                 return elm_result_to_dfs(result); | ||
|  |             } | ||
|  |         } | ||
|  | 
 | ||
|  |         /* open directory */ | ||
|  |         dir = (DIR *)rt_malloc(sizeof(DIR)); | ||
|  |         if (dir == RT_NULL) | ||
|  |         { | ||
|  | #if _VOLUMES > 1
 | ||
|  |             rt_free(drivers_fn); | ||
|  | #endif
 | ||
|  |             return -ENOMEM; | ||
|  |         } | ||
|  | 
 | ||
|  |         result = f_opendir(dir, drivers_fn); | ||
|  | #if _VOLUMES > 1
 | ||
|  |         rt_free(drivers_fn); | ||
|  | #endif
 | ||
|  |         if (result != FR_OK) | ||
|  |         { | ||
|  |             rt_free(dir); | ||
|  |             return elm_result_to_dfs(result); | ||
|  |         } | ||
|  | 
 | ||
|  |         file->data = dir; | ||
|  |         return RT_EOK; | ||
|  |     } | ||
|  |     else | ||
|  |     { | ||
|  |         mode = FA_READ; | ||
|  | 
 | ||
|  |         if (file->flags & O_WRONLY) | ||
|  |             mode |= FA_WRITE; | ||
|  |         if ((file->flags & O_ACCMODE) & O_RDWR) | ||
|  |             mode |= FA_WRITE; | ||
|  |         /* Opens the file, if it is existing. If not, a new file is created. */ | ||
|  |         if (file->flags & O_CREAT) | ||
|  |             mode |= FA_OPEN_ALWAYS; | ||
|  |         /* Creates a new file. If the file is existing, it is truncated and overwritten. */ | ||
|  |         if (file->flags & O_TRUNC) | ||
|  |             mode |= FA_CREATE_ALWAYS; | ||
|  |         /* Creates a new file. The function fails if the file is already existing. */ | ||
|  |         if (file->flags & O_EXCL) | ||
|  |             mode |= FA_CREATE_NEW; | ||
|  | 
 | ||
|  |         /* allocate a fd */ | ||
|  |         fd = (FIL *)rt_malloc(sizeof(FIL)); | ||
|  |         if (fd == RT_NULL) | ||
|  |         { | ||
|  | #if _VOLUMES > 1
 | ||
|  |             rt_free(drivers_fn); | ||
|  | #endif
 | ||
|  |             return -ENOMEM; | ||
|  |         } | ||
|  | 
 | ||
|  |         result = f_open(fd, drivers_fn, mode); | ||
|  | #if _VOLUMES > 1
 | ||
|  |         rt_free(drivers_fn); | ||
|  | #endif
 | ||
|  |         if (result == FR_OK) | ||
|  |         { | ||
|  |             file->pos  = fd->fptr; | ||
|  |             file->size = f_size(fd); | ||
|  |             file->data = fd; | ||
|  | 
 | ||
|  |             if (file->flags & O_APPEND) | ||
|  |             { | ||
|  |                 /* seek to the end of file */ | ||
|  |                 f_lseek(fd, f_size(fd)); | ||
|  |                 file->pos = fd->fptr; | ||
|  |             } | ||
|  |         } | ||
|  |         else | ||
|  |         { | ||
|  |             /* open failed, return */ | ||
|  |             rt_free(fd); | ||
|  |             return elm_result_to_dfs(result); | ||
|  |         } | ||
|  |     } | ||
|  | 
 | ||
|  |     return RT_EOK; | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_close(struct dfs_fd *file) | ||
|  | { | ||
|  |     FRESULT result; | ||
|  | 
 | ||
|  |     result = FR_OK; | ||
|  |     if (file->type == FT_DIRECTORY) | ||
|  |     { | ||
|  |         DIR *dir; | ||
|  | 
 | ||
|  |         dir = (DIR *)(file->data); | ||
|  |         RT_ASSERT(dir != RT_NULL); | ||
|  | 
 | ||
|  |         /* release memory */ | ||
|  |         rt_free(dir); | ||
|  |     } | ||
|  |     else if (file->type == FT_REGULAR) | ||
|  |     { | ||
|  |         FIL *fd; | ||
|  |         fd = (FIL *)(file->data); | ||
|  |         RT_ASSERT(fd != RT_NULL); | ||
|  | 
 | ||
|  |         result = f_close(fd); | ||
|  |         if (result == FR_OK) | ||
|  |         { | ||
|  |             /* release memory */ | ||
|  |             rt_free(fd); | ||
|  |         } | ||
|  |     } | ||
|  | 
 | ||
|  |     return elm_result_to_dfs(result); | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_ioctl(struct dfs_fd *file, int cmd, void *args) | ||
|  | { | ||
|  |     return -ENOSYS; | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_read(struct dfs_fd *file, void *buf, size_t len) | ||
|  | { | ||
|  |     FIL *fd; | ||
|  |     FRESULT result; | ||
|  |     UINT byte_read; | ||
|  | 
 | ||
|  |     if (file->type == FT_DIRECTORY) | ||
|  |     { | ||
|  |         return -EISDIR; | ||
|  |     } | ||
|  | 
 | ||
|  |     fd = (FIL *)(file->data); | ||
|  |     RT_ASSERT(fd != RT_NULL); | ||
|  | 
 | ||
|  |     result = f_read(fd, buf, len, &byte_read); | ||
|  |     /* update position */ | ||
|  |     file->pos  = fd->fptr; | ||
|  |     if (result == FR_OK) | ||
|  |         return byte_read; | ||
|  | 
 | ||
|  |     return elm_result_to_dfs(result); | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_write(struct dfs_fd *file, const void *buf, size_t len) | ||
|  | { | ||
|  |     FIL *fd; | ||
|  |     FRESULT result; | ||
|  |     UINT byte_write; | ||
|  | 
 | ||
|  |     if (file->type == FT_DIRECTORY) | ||
|  |     { | ||
|  |         return -EISDIR; | ||
|  |     } | ||
|  | 
 | ||
|  |     fd = (FIL *)(file->data); | ||
|  |     RT_ASSERT(fd != RT_NULL); | ||
|  | 
 | ||
|  |     result = f_write(fd, buf, len, &byte_write); | ||
|  |     /* update position and file size */ | ||
|  |     file->pos  = fd->fptr; | ||
|  |     file->size = f_size(fd); | ||
|  |     if (result == FR_OK) | ||
|  |         return byte_write; | ||
|  | 
 | ||
|  |     return elm_result_to_dfs(result); | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_flush(struct dfs_fd *file) | ||
|  | { | ||
|  |     FIL *fd; | ||
|  |     FRESULT result; | ||
|  | 
 | ||
|  |     fd = (FIL *)(file->data); | ||
|  |     RT_ASSERT(fd != RT_NULL); | ||
|  | 
 | ||
|  |     result = f_sync(fd); | ||
|  |     return elm_result_to_dfs(result); | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_lseek(struct dfs_fd *file, rt_off_t offset) | ||
|  | { | ||
|  |     FRESULT result = FR_OK; | ||
|  |     if (file->type == FT_REGULAR) | ||
|  |     { | ||
|  |         FIL *fd; | ||
|  | 
 | ||
|  |         /* regular file type */ | ||
|  |         fd = (FIL *)(file->data); | ||
|  |         RT_ASSERT(fd != RT_NULL); | ||
|  | 
 | ||
|  |         result = f_lseek(fd, offset); | ||
|  |         if (result == FR_OK) | ||
|  |         { | ||
|  |             /* return current position */ | ||
|  |             file->pos = fd->fptr; | ||
|  |             return fd->fptr; | ||
|  |         } | ||
|  |     } | ||
|  |     else if (file->type == FT_DIRECTORY) | ||
|  |     { | ||
|  |         /* which is a directory */ | ||
|  |         DIR *dir; | ||
|  | 
 | ||
|  |         dir = (DIR *)(file->data); | ||
|  |         RT_ASSERT(dir != RT_NULL); | ||
|  | 
 | ||
|  |         result = f_seekdir(dir, offset / sizeof(struct dirent)); | ||
|  |         if (result == FR_OK) | ||
|  |         { | ||
|  |             /* update file position */ | ||
|  |             file->pos = offset; | ||
|  |             return file->pos; | ||
|  |         } | ||
|  |     } | ||
|  | 
 | ||
|  |     return elm_result_to_dfs(result); | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_getdents(struct dfs_fd *file, struct dirent *dirp, uint32_t count) | ||
|  | { | ||
|  |     DIR *dir; | ||
|  |     FILINFO fno; | ||
|  |     FRESULT result; | ||
|  |     rt_uint32_t index; | ||
|  |     struct dirent *d; | ||
|  | 
 | ||
|  |     dir = (DIR *)(file->data); | ||
|  |     RT_ASSERT(dir != RT_NULL); | ||
|  | 
 | ||
|  |     /* make integer count */ | ||
|  |     count = (count / sizeof(struct dirent)) * sizeof(struct dirent); | ||
|  |     if (count == 0) | ||
|  |         return -EINVAL; | ||
|  | 
 | ||
|  |     index = 0; | ||
|  |     while (1) | ||
|  |     { | ||
|  |         char *fn; | ||
|  | 
 | ||
|  |         d = dirp + index; | ||
|  | 
 | ||
|  |         result = f_readdir(dir, &fno); | ||
|  |         if (result != FR_OK || fno.fname[0] == 0) | ||
|  |             break; | ||
|  | 
 | ||
|  | #if _USE_LFN
 | ||
|  |         fn = *fno.fname ? fno.fname : fno.altname; | ||
|  | #else
 | ||
|  |         fn = fno.fname; | ||
|  | #endif
 | ||
|  | 
 | ||
|  |         d->d_type = DT_UNKNOWN; | ||
|  |         if (fno.fattrib & AM_DIR) | ||
|  |             d->d_type = DT_DIR; | ||
|  |         else | ||
|  |             d->d_type = DT_REG; | ||
|  | 
 | ||
|  |         d->d_namlen = (rt_uint8_t)rt_strlen(fn); | ||
|  |         d->d_reclen = (rt_uint16_t)sizeof(struct dirent); | ||
|  |         rt_strncpy(d->d_name, fn, rt_strlen(fn) + 1); | ||
|  | 
 | ||
|  |         index ++; | ||
|  |         if (index * sizeof(struct dirent) >= count) | ||
|  |             break; | ||
|  |     } | ||
|  | 
 | ||
|  |     if (index == 0) | ||
|  |         return elm_result_to_dfs(result); | ||
|  | 
 | ||
|  |     file->pos += index * sizeof(struct dirent); | ||
|  | 
 | ||
|  |     return index * sizeof(struct dirent); | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_unlink(struct dfs_filesystem *fs, const char *path) | ||
|  | { | ||
|  |     FRESULT result; | ||
|  | 
 | ||
|  | #if _VOLUMES > 1
 | ||
|  |     int vol; | ||
|  |     char *drivers_fn; | ||
|  |     extern int elm_get_vol(FATFS * fat); | ||
|  | 
 | ||
|  |     /* add path for ELM FatFS driver support */ | ||
|  |     vol = elm_get_vol((FATFS *)fs->data); | ||
|  |     if (vol < 0) | ||
|  |         return -ENOENT; | ||
|  |     drivers_fn = rt_malloc(256); | ||
|  |     if (drivers_fn == RT_NULL) | ||
|  |         return -ENOMEM; | ||
|  | 
 | ||
|  |     rt_snprintf(drivers_fn, 256, "%d:%s", vol, path); | ||
|  | #else
 | ||
|  |     const char *drivers_fn; | ||
|  |     drivers_fn = path; | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     result = f_unlink(drivers_fn); | ||
|  | #if _VOLUMES > 1
 | ||
|  |     rt_free(drivers_fn); | ||
|  | #endif
 | ||
|  |     return elm_result_to_dfs(result); | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_rename(struct dfs_filesystem *fs, const char *oldpath, const char *newpath) | ||
|  | { | ||
|  |     FRESULT result; | ||
|  | 
 | ||
|  | #if _VOLUMES > 1
 | ||
|  |     char *drivers_oldfn; | ||
|  |     const char *drivers_newfn; | ||
|  |     int vol; | ||
|  |     extern int elm_get_vol(FATFS * fat); | ||
|  | 
 | ||
|  |     /* add path for ELM FatFS driver support */ | ||
|  |     vol = elm_get_vol((FATFS *)fs->data); | ||
|  |     if (vol < 0) | ||
|  |         return -ENOENT; | ||
|  | 
 | ||
|  |     drivers_oldfn = rt_malloc(256); | ||
|  |     if (drivers_oldfn == RT_NULL) | ||
|  |         return -ENOMEM; | ||
|  |     drivers_newfn = newpath; | ||
|  | 
 | ||
|  |     rt_snprintf(drivers_oldfn, 256, "%d:%s", vol, oldpath); | ||
|  | #else
 | ||
|  |     const char *drivers_oldfn, *drivers_newfn; | ||
|  | 
 | ||
|  |     drivers_oldfn = oldpath; | ||
|  |     drivers_newfn = newpath; | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     result = f_rename(drivers_oldfn, drivers_newfn); | ||
|  | #if _VOLUMES > 1
 | ||
|  |     rt_free(drivers_oldfn); | ||
|  | #endif
 | ||
|  |     return elm_result_to_dfs(result); | ||
|  | } | ||
|  | 
 | ||
|  | int dfs_elm_stat(struct dfs_filesystem *fs, const char *path, struct stat *st) | ||
|  | { | ||
|  |     FILINFO file_info; | ||
|  |     FRESULT result; | ||
|  | 
 | ||
|  | #if _VOLUMES > 1
 | ||
|  |     int vol; | ||
|  |     char *drivers_fn; | ||
|  |     extern int elm_get_vol(FATFS * fat); | ||
|  | 
 | ||
|  |     /* add path for ELM FatFS driver support */ | ||
|  |     vol = elm_get_vol((FATFS *)fs->data); | ||
|  |     if (vol < 0) | ||
|  |         return -ENOENT; | ||
|  |     drivers_fn = rt_malloc(256); | ||
|  |     if (drivers_fn == RT_NULL) | ||
|  |         return -ENOMEM; | ||
|  | 
 | ||
|  |     rt_snprintf(drivers_fn, 256, "%d:%s", vol, path); | ||
|  | #else
 | ||
|  |     const char *drivers_fn; | ||
|  |     drivers_fn = path; | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     result = f_stat(drivers_fn, &file_info); | ||
|  | #if _VOLUMES > 1
 | ||
|  |     rt_free(drivers_fn); | ||
|  | #endif
 | ||
|  |     if (result == FR_OK) | ||
|  |     { | ||
|  |         /* convert to dfs stat structure */ | ||
|  |         st->st_dev = 0; | ||
|  | 
 | ||
|  |         st->st_mode = S_IFREG | S_IRUSR | S_IRGRP | S_IROTH | | ||
|  |                       S_IWUSR | S_IWGRP | S_IWOTH; | ||
|  |         if (file_info.fattrib & AM_DIR) | ||
|  |         { | ||
|  |             st->st_mode &= ~S_IFREG; | ||
|  |             st->st_mode |= S_IFDIR | S_IXUSR | S_IXGRP | S_IXOTH; | ||
|  |         } | ||
|  |         if (file_info.fattrib & AM_RDO) | ||
|  |             st->st_mode &= ~(S_IWUSR | S_IWGRP | S_IWOTH); | ||
|  | 
 | ||
|  |         st->st_size  = file_info.fsize; | ||
|  | 
 | ||
|  |         /* get st_mtime. */ | ||
|  |         { | ||
|  |             struct tm tm_file; | ||
|  |             int year, mon, day, hour, min, sec; | ||
|  |             WORD tmp; | ||
|  | 
 | ||
|  |             tmp = file_info.fdate; | ||
|  |             day = tmp & 0x1F;           /* bit[4:0] Day(1..31) */ | ||
|  |             tmp >>= 5; | ||
|  |             mon = tmp & 0x0F;           /* bit[8:5] Month(1..12) */ | ||
|  |             tmp >>= 4; | ||
|  |             year = (tmp & 0x7F) + 1980; /* bit[15:9] Year origin from 1980(0..127) */ | ||
|  | 
 | ||
|  |             tmp = file_info.ftime; | ||
|  |             sec = (tmp & 0x1F) * 2;     /* bit[4:0] Second/2(0..29) */ | ||
|  |             tmp >>= 5; | ||
|  |             min = tmp & 0x3F;           /* bit[10:5] Minute(0..59) */ | ||
|  |             tmp >>= 6; | ||
|  |             hour = tmp & 0x1F;          /* bit[15:11] Hour(0..23) */ | ||
|  | 
 | ||
|  |             memset(&tm_file, 0, sizeof(tm_file)); | ||
|  |             tm_file.tm_year = year - 1900; /* Years since 1900 */ | ||
|  |             tm_file.tm_mon  = mon - 1;     /* Months *since* january: 0-11 */ | ||
|  |             tm_file.tm_mday = day;         /* Day of the month: 1-31 */ | ||
|  |             tm_file.tm_hour = hour;        /* Hours since midnight: 0-23 */ | ||
|  |             tm_file.tm_min  = min;         /* Minutes: 0-59 */ | ||
|  |             tm_file.tm_sec  = sec;         /* Seconds: 0-59 */ | ||
|  | 
 | ||
|  |             st->st_mtime = mktime(&tm_file); | ||
|  |         } /* get st_mtime. */ | ||
|  |     } | ||
|  | 
 | ||
|  |     return elm_result_to_dfs(result); | ||
|  | } | ||
|  | 
 | ||
|  | static const struct dfs_file_ops dfs_elm_fops =  | ||
|  | { | ||
|  |     dfs_elm_open, | ||
|  |     dfs_elm_close, | ||
|  |     dfs_elm_ioctl, | ||
|  |     dfs_elm_read, | ||
|  |     dfs_elm_write, | ||
|  |     dfs_elm_flush, | ||
|  |     dfs_elm_lseek, | ||
|  |     dfs_elm_getdents, | ||
|  |     RT_NULL, /* poll interface */ | ||
|  | }; | ||
|  | 
 | ||
|  | static const struct dfs_filesystem_ops dfs_elm = | ||
|  | { | ||
|  |     "elm", | ||
|  |     DFS_FS_FLAG_DEFAULT, | ||
|  |     &dfs_elm_fops, | ||
|  | 
 | ||
|  |     dfs_elm_mount, | ||
|  |     dfs_elm_unmount, | ||
|  |     dfs_elm_mkfs, | ||
|  |     dfs_elm_statfs, | ||
|  | 
 | ||
|  |     dfs_elm_unlink, | ||
|  |     dfs_elm_stat, | ||
|  |     dfs_elm_rename, | ||
|  | }; | ||
|  | 
 | ||
|  | int elm_init(void) | ||
|  | { | ||
|  |     /* register fatfs file system */ | ||
|  |     dfs_register(&dfs_elm); | ||
|  | 
 | ||
|  |     return 0; | ||
|  | } | ||
|  | INIT_COMPONENT_EXPORT(elm_init); | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * RT-Thread Device Interface for ELM FatFs | ||
|  |  */ | ||
|  | #include "diskio.h"
 | ||
|  | 
 | ||
|  | /* Initialize a Drive */ | ||
|  | DSTATUS disk_initialize(BYTE drv) | ||
|  | { | ||
|  |     return 0; | ||
|  | } | ||
|  | 
 | ||
|  | /* Return Disk Status */ | ||
|  | DSTATUS disk_status(BYTE drv) | ||
|  | { | ||
|  |     return 0; | ||
|  | } | ||
|  | 
 | ||
|  | /* Read Sector(s) */ | ||
|  | DRESULT disk_read (BYTE drv, BYTE* buff, DWORD sector, UINT count) | ||
|  | { | ||
|  |     rt_size_t result; | ||
|  |     rt_device_t device = disk[drv]; | ||
|  | 
 | ||
|  |     result = rt_device_read(device, sector, buff, count); | ||
|  |     if (result == count) | ||
|  |     { | ||
|  |         return RES_OK; | ||
|  |     } | ||
|  | 
 | ||
|  |     return RES_ERROR; | ||
|  | } | ||
|  | 
 | ||
|  | /* Write Sector(s) */ | ||
|  | DRESULT disk_write (BYTE drv, const BYTE* buff, DWORD sector, UINT count) | ||
|  | { | ||
|  |     rt_size_t result; | ||
|  |     rt_device_t device = disk[drv]; | ||
|  | 
 | ||
|  |     result = rt_device_write(device, sector, buff, count); | ||
|  |     if (result == count) | ||
|  |     { | ||
|  |         return RES_OK; | ||
|  |     } | ||
|  | 
 | ||
|  |     return RES_ERROR; | ||
|  | } | ||
|  | 
 | ||
|  | /* Miscellaneous Functions */ | ||
|  | DRESULT disk_ioctl(BYTE drv, BYTE ctrl, void *buff) | ||
|  | { | ||
|  |     rt_device_t device = disk[drv]; | ||
|  | 
 | ||
|  |     if (device == RT_NULL) | ||
|  |         return RES_ERROR; | ||
|  | 
 | ||
|  |     if (ctrl == GET_SECTOR_COUNT) | ||
|  |     { | ||
|  |         struct rt_device_blk_geometry geometry; | ||
|  | 
 | ||
|  |         rt_memset(&geometry, 0, sizeof(geometry)); | ||
|  |         rt_device_control(device, RT_DEVICE_CTRL_BLK_GETGEOME, &geometry); | ||
|  | 
 | ||
|  |         *(DWORD *)buff = geometry.sector_count; | ||
|  |         if (geometry.sector_count == 0) | ||
|  |             return RES_ERROR; | ||
|  |     } | ||
|  |     else if (ctrl == GET_SECTOR_SIZE) | ||
|  |     { | ||
|  |         struct rt_device_blk_geometry geometry; | ||
|  | 
 | ||
|  |         rt_memset(&geometry, 0, sizeof(geometry)); | ||
|  |         rt_device_control(device, RT_DEVICE_CTRL_BLK_GETGEOME, &geometry); | ||
|  | 
 | ||
|  |         *(WORD *)buff = (WORD)(geometry.bytes_per_sector); | ||
|  |     } | ||
|  |     else if (ctrl == GET_BLOCK_SIZE) /* Get erase block size in unit of sectors (DWORD) */ | ||
|  |     { | ||
|  |         struct rt_device_blk_geometry geometry; | ||
|  | 
 | ||
|  |         rt_memset(&geometry, 0, sizeof(geometry)); | ||
|  |         rt_device_control(device, RT_DEVICE_CTRL_BLK_GETGEOME, &geometry); | ||
|  | 
 | ||
|  |         *(DWORD *)buff = geometry.block_size / geometry.bytes_per_sector; | ||
|  |     } | ||
|  |     else if (ctrl == CTRL_SYNC) | ||
|  |     { | ||
|  |         rt_device_control(device, RT_DEVICE_CTRL_BLK_SYNC, RT_NULL); | ||
|  |     } | ||
|  |     else if (ctrl == CTRL_TRIM) | ||
|  |     { | ||
|  |         rt_device_control(device, RT_DEVICE_CTRL_BLK_ERASE, buff); | ||
|  |     } | ||
|  | 
 | ||
|  |     return RES_OK; | ||
|  | } | ||
|  | 
 | ||
|  | DWORD get_fattime(void) | ||
|  | { | ||
|  |     DWORD fat_time = 0; | ||
|  | 
 | ||
|  | #ifdef RT_USING_LIBC 
 | ||
|  |     time_t now; | ||
|  |     struct tm *p_tm; | ||
|  |     struct tm tm_now; | ||
|  | 
 | ||
|  |     /* get current time */ | ||
|  |     now = time(RT_NULL); | ||
|  | 
 | ||
|  |     /* lock scheduler. */ | ||
|  |     rt_enter_critical(); | ||
|  |     /* converts calendar time time into local time. */ | ||
|  |     p_tm = localtime(&now); | ||
|  |     /* copy the statically located variable */ | ||
|  |     memcpy(&tm_now, p_tm, sizeof(struct tm)); | ||
|  |     /* unlock scheduler. */ | ||
|  |     rt_exit_critical(); | ||
|  | 
 | ||
|  |     fat_time =  (DWORD)(tm_now.tm_year - 80) << 25 | | ||
|  |                 (DWORD)(tm_now.tm_mon + 1)   << 21 | | ||
|  |                 (DWORD)tm_now.tm_mday        << 16 | | ||
|  |                 (DWORD)tm_now.tm_hour        << 11 | | ||
|  |                 (DWORD)tm_now.tm_min         <<  5 | | ||
|  |                 (DWORD)tm_now.tm_sec / 2 ; | ||
|  | #endif /* RT_USING_LIBC  */
 | ||
|  | 
 | ||
|  |     return fat_time; | ||
|  | } | ||
|  | 
 | ||
|  | #if _FS_REENTRANT
 | ||
|  | int ff_cre_syncobj(BYTE drv, _SYNC_t *m) | ||
|  | { | ||
|  |     char name[8]; | ||
|  |     rt_mutex_t mutex; | ||
|  | 
 | ||
|  |     rt_snprintf(name, sizeof(name), "fat%d", drv); | ||
|  |     mutex = rt_mutex_create(name, RT_IPC_FLAG_FIFO); | ||
|  |     if (mutex != RT_NULL) | ||
|  |     { | ||
|  |         *m = mutex; | ||
|  |         return RT_TRUE; | ||
|  |     } | ||
|  | 
 | ||
|  |     return RT_FALSE; | ||
|  | } | ||
|  | 
 | ||
|  | int ff_del_syncobj(_SYNC_t m) | ||
|  | { | ||
|  |     if (m != RT_NULL) | ||
|  |         rt_mutex_delete(m); | ||
|  | 
 | ||
|  |     return RT_TRUE; | ||
|  | } | ||
|  | 
 | ||
|  | int ff_req_grant(_SYNC_t m) | ||
|  | { | ||
|  |     if (rt_mutex_take(m, _FS_TIMEOUT) == RT_EOK) | ||
|  |         return RT_TRUE; | ||
|  | 
 | ||
|  |     return RT_FALSE; | ||
|  | } | ||
|  | 
 | ||
|  | void ff_rel_grant(_SYNC_t m) | ||
|  | { | ||
|  |     rt_mutex_release(m); | ||
|  | } | ||
|  | 
 | ||
|  | #endif
 | ||
|  | 
 | ||
|  | /* Memory functions */ | ||
|  | #if _USE_LFN == 3
 | ||
|  | /* Allocate memory block */ | ||
|  | void *ff_memalloc(UINT size) | ||
|  | { | ||
|  |     return rt_malloc(size); | ||
|  | } | ||
|  | 
 | ||
|  | /* Free memory block */ | ||
|  | void ff_memfree(void *mem) | ||
|  | { | ||
|  |     rt_free(mem); | ||
|  | } | ||
|  | #endif /* _USE_LFN == 3 */
 | ||
|  | 
 |