Marco Mayer / Mbed OS Queue

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

mbed-os/features/filesystem/fat/FATFileSystem.cpp@2:c7897a3f5f11, 2020-04-22 (annotated)

Committer:
demayer
Date:
Wed Apr 22 11:50:00 2020 +0000
Revision:
2:c7897a3f5f11
Parent:
0:6bf0743ece18 
test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
demayer 0:6bf0743ece18 1 /* mbed Microcontroller Library
demayer 0:6bf0743ece18 2 * Copyright (c) 2006-2012 ARM Limited
demayer 0:6bf0743ece18 3 *
demayer 0:6bf0743ece18 4 * Permission is hereby granted, free of charge, to any person obtaining a copy
demayer 0:6bf0743ece18 5 * of this software and associated documentation files (the "Software"), to deal
demayer 0:6bf0743ece18 6 * in the Software without restriction, including without limitation the rights
demayer 0:6bf0743ece18 7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
demayer 0:6bf0743ece18 8 * copies of the Software, and to permit persons to whom the Software is
demayer 0:6bf0743ece18 9 * furnished to do so, subject to the following conditions:
demayer 0:6bf0743ece18 10 *
demayer 0:6bf0743ece18 11 * The above copyright notice and this permission notice shall be included in
demayer 0:6bf0743ece18 12 * all copies or substantial portions of the Software.
demayer 0:6bf0743ece18 13 *
demayer 0:6bf0743ece18 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
demayer 0:6bf0743ece18 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
demayer 0:6bf0743ece18 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
demayer 0:6bf0743ece18 17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
demayer 0:6bf0743ece18 18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
demayer 0:6bf0743ece18 19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
demayer 0:6bf0743ece18 20 * SOFTWARE.
demayer 0:6bf0743ece18 21 */
demayer 0:6bf0743ece18 22 #include "mbed.h"
demayer 0:6bf0743ece18 23
demayer 0:6bf0743ece18 24 #include "diskio.h"
demayer 0:6bf0743ece18 25 #include "ffconf.h"
demayer 0:6bf0743ece18 26 #include "mbed_debug.h"
demayer 0:6bf0743ece18 27 #include "mbed_critical.h"
demayer 0:6bf0743ece18 28 #include <errno.h>
demayer 0:6bf0743ece18 29
demayer 0:6bf0743ece18 30 #include "FATFileSystem.h"
demayer 0:6bf0743ece18 31
demayer 0:6bf0743ece18 32
demayer 0:6bf0743ece18 33 ////// Error handling /////
demayer 0:6bf0743ece18 34
demayer 0:6bf0743ece18 35 static int fat_error_remap(FRESULT res)
demayer 0:6bf0743ece18 36 {
demayer 0:6bf0743ece18 37 switch(res) {
demayer 0:6bf0743ece18 38 case FR_OK: /* (0) Succeeded */
demayer 0:6bf0743ece18 39 return 0; /* no error */
demayer 0:6bf0743ece18 40 case FR_DISK_ERR: /* (1) A hard error occurred in the low level disk I/O layer */
demayer 0:6bf0743ece18 41 case FR_NOT_READY: /* (3) The physical drive cannot work */
demayer 0:6bf0743ece18 42 return -EIO; /* I/O error */
demayer 0:6bf0743ece18 43 case FR_NO_FILE: /* (4) Could not find the file */
demayer 0:6bf0743ece18 44 case FR_NO_PATH: /* (5) Could not find the path */
demayer 0:6bf0743ece18 45 case FR_INVALID_NAME: /* (6) The path name format is invalid */
demayer 0:6bf0743ece18 46 case FR_INVALID_DRIVE: /* (11) The logical drive number is invalid */
demayer 0:6bf0743ece18 47 case FR_NO_FILESYSTEM: /* (13) There is no valid FAT volume */
demayer 0:6bf0743ece18 48 return -ENOENT; /* No such file or directory */
demayer 0:6bf0743ece18 49 case FR_DENIED: /* (7) Access denied due to prohibited access or directory full */
demayer 0:6bf0743ece18 50 return -EACCES; /* Permission denied */
demayer 0:6bf0743ece18 51 case FR_EXIST: /* (8) Access denied due to prohibited access */
demayer 0:6bf0743ece18 52 return -EEXIST; /* File exists */
demayer 0:6bf0743ece18 53 case FR_WRITE_PROTECTED: /* (10) The physical drive is write protected */
demayer 0:6bf0743ece18 54 case FR_LOCKED: /* (16) The operation is rejected according to the file sharing policy */
demayer 0:6bf0743ece18 55 return -EACCES; /* Permission denied */
demayer 0:6bf0743ece18 56 case FR_INVALID_OBJECT: /* (9) The file/directory object is invalid */
demayer 0:6bf0743ece18 57 return -EFAULT; /* Bad address */
demayer 0:6bf0743ece18 58 case FR_NOT_ENABLED: /* (12) The volume has no work area */
demayer 0:6bf0743ece18 59 return -ENXIO; /* No such device or address */
demayer 0:6bf0743ece18 60 case FR_NOT_ENOUGH_CORE: /* (17) LFN working buffer could not be allocated */
demayer 0:6bf0743ece18 61 return -ENOMEM; /* Not enough space */
demayer 0:6bf0743ece18 62 case FR_TOO_MANY_OPEN_FILES: /* (18) Number of open files > _FS_LOCK */
demayer 0:6bf0743ece18 63 return -ENFILE; /* Too many open files in system */
demayer 0:6bf0743ece18 64 case FR_INVALID_PARAMETER: /* (19) Given parameter is invalid */
demayer 0:6bf0743ece18 65 return -ENOEXEC; /* Exec format error */
demayer 0:6bf0743ece18 66 case FR_INT_ERR: /* (2) Assertion failed */
demayer 0:6bf0743ece18 67 case FR_MKFS_ABORTED: /* (14) The f_mkfs() aborted due to any parameter error */
demayer 0:6bf0743ece18 68 case FR_TIMEOUT: /* (15) Could not get a grant to access the volume within defined period */
demayer 0:6bf0743ece18 69 default: /* Bad file number */
demayer 0:6bf0743ece18 70 return -EBADF;
demayer 0:6bf0743ece18 71 }
demayer 0:6bf0743ece18 72 }
demayer 0:6bf0743ece18 73
demayer 0:6bf0743ece18 74 // Helper class for deferring operations when variable falls out of scope
demayer 0:6bf0743ece18 75 template <typename T>
demayer 0:6bf0743ece18 76 class Deferred {
demayer 0:6bf0743ece18 77 public:
demayer 0:6bf0743ece18 78 T _t;
demayer 0:6bf0743ece18 79 Callback<void(T)> _ondefer;
demayer 0:6bf0743ece18 80
demayer 0:6bf0743ece18 81 Deferred(const Deferred&);
demayer 0:6bf0743ece18 82 Deferred &operator=(const Deferred&);
demayer 0:6bf0743ece18 83
demayer 0:6bf0743ece18 84 public:
demayer 0:6bf0743ece18 85 Deferred(T t, Callback<void(T)> ondefer = NULL)
demayer 0:6bf0743ece18 86 : _t(t), _ondefer(ondefer)
demayer 0:6bf0743ece18 87 {
demayer 0:6bf0743ece18 88 }
demayer 0:6bf0743ece18 89
demayer 0:6bf0743ece18 90 operator T()
demayer 0:6bf0743ece18 91 {
demayer 0:6bf0743ece18 92 return _t;
demayer 0:6bf0743ece18 93 }
demayer 0:6bf0743ece18 94
demayer 0:6bf0743ece18 95 ~Deferred()
demayer 0:6bf0743ece18 96 {
demayer 0:6bf0743ece18 97 if (_ondefer) {
demayer 0:6bf0743ece18 98 _ondefer(_t);
demayer 0:6bf0743ece18 99 }
demayer 0:6bf0743ece18 100 }
demayer 0:6bf0743ece18 101 };
demayer 0:6bf0743ece18 102
demayer 0:6bf0743ece18 103 static void dodelete(const char *data)
demayer 0:6bf0743ece18 104 {
demayer 0:6bf0743ece18 105 delete[] data;
demayer 0:6bf0743ece18 106 }
demayer 0:6bf0743ece18 107
demayer 0:6bf0743ece18 108 // Adds prefix needed internally by fatfs, this can be avoided for the first fatfs
demayer 0:6bf0743ece18 109 // (id 0) otherwise a prefix of "id:/" is inserted in front of the string.
demayer 0:6bf0743ece18 110 static Deferred<const char*> fat_path_prefix(int id, const char *path)
demayer 0:6bf0743ece18 111 {
demayer 0:6bf0743ece18 112 // We can avoid dynamic allocation when only on fatfs is in use
demayer 0:6bf0743ece18 113 if (id == 0) {
demayer 0:6bf0743ece18 114 return path;
demayer 0:6bf0743ece18 115 }
demayer 0:6bf0743ece18 116
demayer 0:6bf0743ece18 117 // Prefix path with id, will look something like 2:/hi/hello/filehere.txt
demayer 0:6bf0743ece18 118 char *buffer = new char[strlen("0:/") + strlen(path) + 1];
demayer 0:6bf0743ece18 119 if (!buffer) {
demayer 0:6bf0743ece18 120 return NULL;
demayer 0:6bf0743ece18 121 }
demayer 0:6bf0743ece18 122
demayer 0:6bf0743ece18 123 buffer[0] = '0' + id;
demayer 0:6bf0743ece18 124 buffer[1] = ':';
demayer 0:6bf0743ece18 125 buffer[2] = '/';
demayer 0:6bf0743ece18 126 strcpy(buffer + strlen("0:/"), path);
demayer 0:6bf0743ece18 127 return Deferred<const char*>(buffer, dodelete);
demayer 0:6bf0743ece18 128 }
demayer 0:6bf0743ece18 129
demayer 0:6bf0743ece18 130
demayer 0:6bf0743ece18 131 ////// Disk operations //////
demayer 0:6bf0743ece18 132
demayer 0:6bf0743ece18 133 // Global access to block device from FAT driver
demayer 0:6bf0743ece18 134 static BlockDevice *_ffs[_VOLUMES] = {0};
demayer 0:6bf0743ece18 135 static SingletonPtr<PlatformMutex> _ffs_mutex;
demayer 0:6bf0743ece18 136
demayer 0:6bf0743ece18 137
demayer 0:6bf0743ece18 138 // FAT driver functions
demayer 0:6bf0743ece18 139 DWORD get_fattime(void)
demayer 0:6bf0743ece18 140 {
demayer 0:6bf0743ece18 141 time_t rawtime;
demayer 0:6bf0743ece18 142 time(&rawtime);
demayer 0:6bf0743ece18 143 struct tm *ptm = localtime(&rawtime);
demayer 0:6bf0743ece18 144 return (DWORD)(ptm->tm_year - 80) << 25
demayer 0:6bf0743ece18 145 | (DWORD)(ptm->tm_mon + 1 ) << 21
demayer 0:6bf0743ece18 146 | (DWORD)(ptm->tm_mday ) << 16
demayer 0:6bf0743ece18 147 | (DWORD)(ptm->tm_hour ) << 11
demayer 0:6bf0743ece18 148 | (DWORD)(ptm->tm_min ) << 5
demayer 0:6bf0743ece18 149 | (DWORD)(ptm->tm_sec/2 );
demayer 0:6bf0743ece18 150 }
demayer 0:6bf0743ece18 151
demayer 0:6bf0743ece18 152 void *ff_memalloc(UINT size)
demayer 0:6bf0743ece18 153 {
demayer 0:6bf0743ece18 154 return malloc(size);
demayer 0:6bf0743ece18 155 }
demayer 0:6bf0743ece18 156
demayer 0:6bf0743ece18 157 void ff_memfree(void *p)
demayer 0:6bf0743ece18 158 {
demayer 0:6bf0743ece18 159 free(p);
demayer 0:6bf0743ece18 160 }
demayer 0:6bf0743ece18 161
demayer 0:6bf0743ece18 162 // Implementation of diskio functions (see ChaN/diskio.h)
demayer 0:6bf0743ece18 163 static WORD disk_get_sector_size(BYTE pdrv)
demayer 0:6bf0743ece18 164 {
demayer 0:6bf0743ece18 165 WORD ssize = _ffs[pdrv]->get_erase_size();
demayer 0:6bf0743ece18 166 if (ssize < 512) {
demayer 0:6bf0743ece18 167 ssize = 512;
demayer 0:6bf0743ece18 168 }
demayer 0:6bf0743ece18 169
demayer 0:6bf0743ece18 170 MBED_ASSERT(ssize >= _MIN_SS && ssize <= _MAX_SS);
demayer 0:6bf0743ece18 171 MBED_ASSERT(_ffs[pdrv]->get_read_size() <= _ffs[pdrv]->get_erase_size());
demayer 0:6bf0743ece18 172 MBED_ASSERT(_ffs[pdrv]->get_program_size() <= _ffs[pdrv]->get_erase_size());
demayer 0:6bf0743ece18 173 return ssize;
demayer 0:6bf0743ece18 174 }
demayer 0:6bf0743ece18 175
demayer 0:6bf0743ece18 176 static DWORD disk_get_sector_count(BYTE pdrv)
demayer 0:6bf0743ece18 177 {
demayer 0:6bf0743ece18 178 DWORD scount = _ffs[pdrv]->size() / disk_get_sector_size(pdrv);
demayer 0:6bf0743ece18 179 MBED_ASSERT(scount >= 64);
demayer 0:6bf0743ece18 180 return scount;
demayer 0:6bf0743ece18 181 }
demayer 0:6bf0743ece18 182
demayer 0:6bf0743ece18 183 DSTATUS disk_status(BYTE pdrv)
demayer 0:6bf0743ece18 184 {
demayer 0:6bf0743ece18 185 debug_if(FFS_DBG, "disk_status on pdrv [%d]\n", pdrv);
demayer 0:6bf0743ece18 186 return RES_OK;
demayer 0:6bf0743ece18 187 }
demayer 0:6bf0743ece18 188
demayer 0:6bf0743ece18 189 DSTATUS disk_initialize(BYTE pdrv)
demayer 0:6bf0743ece18 190 {
demayer 0:6bf0743ece18 191 debug_if(FFS_DBG, "disk_initialize on pdrv [%d]\n", pdrv);
demayer 0:6bf0743ece18 192 return (DSTATUS)_ffs[pdrv]->init();
demayer 0:6bf0743ece18 193 }
demayer 0:6bf0743ece18 194
demayer 0:6bf0743ece18 195 DRESULT disk_read(BYTE pdrv, BYTE *buff, DWORD sector, UINT count)
demayer 0:6bf0743ece18 196 {
demayer 0:6bf0743ece18 197 debug_if(FFS_DBG, "disk_read(sector %d, count %d) on pdrv [%d]\n", sector, count, pdrv);
demayer 0:6bf0743ece18 198 DWORD ssize = disk_get_sector_size(pdrv);
demayer 0:6bf0743ece18 199 int err = _ffs[pdrv]->read(buff, sector*ssize, count*ssize);
demayer 0:6bf0743ece18 200 return err ? RES_PARERR : RES_OK;
demayer 0:6bf0743ece18 201 }
demayer 0:6bf0743ece18 202
demayer 0:6bf0743ece18 203 DRESULT disk_write(BYTE pdrv, const BYTE *buff, DWORD sector, UINT count)
demayer 0:6bf0743ece18 204 {
demayer 0:6bf0743ece18 205 debug_if(FFS_DBG, "disk_write(sector %d, count %d) on pdrv [%d]\n", sector, count, pdrv);
demayer 0:6bf0743ece18 206 DWORD ssize = disk_get_sector_size(pdrv);
demayer 0:6bf0743ece18 207 int err = _ffs[pdrv]->erase(sector*ssize, count*ssize);
demayer 0:6bf0743ece18 208 if (err) {
demayer 0:6bf0743ece18 209 return RES_PARERR;
demayer 0:6bf0743ece18 210 }
demayer 0:6bf0743ece18 211
demayer 0:6bf0743ece18 212 err = _ffs[pdrv]->program(buff, sector*ssize, count*ssize);
demayer 0:6bf0743ece18 213 if (err) {
demayer 0:6bf0743ece18 214 return RES_PARERR;
demayer 0:6bf0743ece18 215 }
demayer 0:6bf0743ece18 216
demayer 0:6bf0743ece18 217 return RES_OK;
demayer 0:6bf0743ece18 218 }
demayer 0:6bf0743ece18 219
demayer 0:6bf0743ece18 220 DRESULT disk_ioctl(BYTE pdrv, BYTE cmd, void *buff)
demayer 0:6bf0743ece18 221 {
demayer 0:6bf0743ece18 222 debug_if(FFS_DBG, "disk_ioctl(%d)\n", cmd);
demayer 0:6bf0743ece18 223 switch (cmd) {
demayer 0:6bf0743ece18 224 case CTRL_SYNC:
demayer 0:6bf0743ece18 225 if (_ffs[pdrv] == NULL) {
demayer 0:6bf0743ece18 226 return RES_NOTRDY;
demayer 0:6bf0743ece18 227 } else {
demayer 0:6bf0743ece18 228 return RES_OK;
demayer 0:6bf0743ece18 229 }
demayer 0:6bf0743ece18 230 case GET_SECTOR_COUNT:
demayer 0:6bf0743ece18 231 if (_ffs[pdrv] == NULL) {
demayer 0:6bf0743ece18 232 return RES_NOTRDY;
demayer 0:6bf0743ece18 233 } else {
demayer 0:6bf0743ece18 234 *((DWORD*)buff) = disk_get_sector_count(pdrv);
demayer 0:6bf0743ece18 235 return RES_OK;
demayer 0:6bf0743ece18 236 }
demayer 0:6bf0743ece18 237 case GET_SECTOR_SIZE:
demayer 0:6bf0743ece18 238 if (_ffs[pdrv] == NULL) {
demayer 0:6bf0743ece18 239 return RES_NOTRDY;
demayer 0:6bf0743ece18 240 } else {
demayer 0:6bf0743ece18 241 *((WORD*)buff) = disk_get_sector_size(pdrv);
demayer 0:6bf0743ece18 242 return RES_OK;
demayer 0:6bf0743ece18 243 }
demayer 0:6bf0743ece18 244 case GET_BLOCK_SIZE:
demayer 0:6bf0743ece18 245 *((DWORD*)buff) = 1; // default when not known
demayer 0:6bf0743ece18 246 return RES_OK;
demayer 0:6bf0743ece18 247 case CTRL_TRIM:
demayer 0:6bf0743ece18 248 if (_ffs[pdrv] == NULL) {
demayer 0:6bf0743ece18 249 return RES_NOTRDY;
demayer 0:6bf0743ece18 250 } else {
demayer 0:6bf0743ece18 251 DWORD *sectors = (DWORD*)buff;
demayer 0:6bf0743ece18 252 DWORD ssize = disk_get_sector_size(pdrv);
demayer 0:6bf0743ece18 253 int err = _ffs[pdrv]->trim(sectors[0]*ssize, (sectors[1]-sectors[0]+1)*ssize);
demayer 0:6bf0743ece18 254 return err ? RES_PARERR : RES_OK;
demayer 0:6bf0743ece18 255 }
demayer 0:6bf0743ece18 256 }
demayer 0:6bf0743ece18 257
demayer 0:6bf0743ece18 258 return RES_PARERR;
demayer 0:6bf0743ece18 259 }
demayer 0:6bf0743ece18 260
demayer 0:6bf0743ece18 261
demayer 0:6bf0743ece18 262 ////// Generic filesystem operations //////
demayer 0:6bf0743ece18 263
demayer 0:6bf0743ece18 264 // Filesystem implementation (See FATFilySystem.h)
demayer 0:6bf0743ece18 265 FATFileSystem::FATFileSystem(const char *name, BlockDevice *bd)
demayer 0:6bf0743ece18 266 : FileSystem(name), _id(-1) {
demayer 0:6bf0743ece18 267 if (bd) {
demayer 0:6bf0743ece18 268 mount(bd);
demayer 0:6bf0743ece18 269 }
demayer 0:6bf0743ece18 270 }
demayer 0:6bf0743ece18 271
demayer 0:6bf0743ece18 272 FATFileSystem::~FATFileSystem()
demayer 0:6bf0743ece18 273 {
demayer 0:6bf0743ece18 274 // nop if unmounted
demayer 0:6bf0743ece18 275 unmount();
demayer 0:6bf0743ece18 276 }
demayer 0:6bf0743ece18 277
demayer 0:6bf0743ece18 278 int FATFileSystem::mount(BlockDevice *bd) {
demayer 0:6bf0743ece18 279 // requires duplicate definition to allow virtual overload to work
demayer 0:6bf0743ece18 280 return mount(bd, true);
demayer 0:6bf0743ece18 281 }
demayer 0:6bf0743ece18 282
demayer 0:6bf0743ece18 283 int FATFileSystem::mount(BlockDevice *bd, bool mount) {
demayer 0:6bf0743ece18 284 lock();
demayer 0:6bf0743ece18 285 if (_id != -1) {
demayer 0:6bf0743ece18 286 unlock();
demayer 0:6bf0743ece18 287 return -EINVAL;
demayer 0:6bf0743ece18 288 }
demayer 0:6bf0743ece18 289
demayer 0:6bf0743ece18 290 for (int i = 0; i < _VOLUMES; i++) {
demayer 0:6bf0743ece18 291 if (!_ffs[i]) {
demayer 0:6bf0743ece18 292 _id = i;
demayer 0:6bf0743ece18 293 _ffs[_id] = bd;
demayer 0:6bf0743ece18 294 _fsid[0] = '0' + _id;
demayer 0:6bf0743ece18 295 _fsid[1] = ':';
demayer 0:6bf0743ece18 296 _fsid[2] = '\0';
demayer 0:6bf0743ece18 297 debug_if(FFS_DBG, "Mounting [%s] on ffs drive [%s]\n", getName(), _fsid);
demayer 0:6bf0743ece18 298 FRESULT res = f_mount(&_fs, _fsid, mount);
demayer 0:6bf0743ece18 299 unlock();
demayer 0:6bf0743ece18 300 return fat_error_remap(res);
demayer 0:6bf0743ece18 301 }
demayer 0:6bf0743ece18 302 }
demayer 0:6bf0743ece18 303
demayer 0:6bf0743ece18 304 unlock();
demayer 0:6bf0743ece18 305 return -ENOMEM;
demayer 0:6bf0743ece18 306 }
demayer 0:6bf0743ece18 307
demayer 0:6bf0743ece18 308 int FATFileSystem::unmount()
demayer 0:6bf0743ece18 309 {
demayer 0:6bf0743ece18 310 lock();
demayer 0:6bf0743ece18 311 if (_id == -1) {
demayer 0:6bf0743ece18 312 unlock();
demayer 0:6bf0743ece18 313 return -EINVAL;
demayer 0:6bf0743ece18 314 }
demayer 0:6bf0743ece18 315
demayer 0:6bf0743ece18 316 FRESULT res = f_mount(NULL, _fsid, 0);
demayer 0:6bf0743ece18 317 _ffs[_id] = NULL;
demayer 0:6bf0743ece18 318 _id = -1;
demayer 0:6bf0743ece18 319 unlock();
demayer 0:6bf0743ece18 320 return fat_error_remap(res);
demayer 0:6bf0743ece18 321 }
demayer 0:6bf0743ece18 322
demayer 0:6bf0743ece18 323 /* See http://elm-chan.org/fsw/ff/en/mkfs.html for details of f_mkfs() and
demayer 0:6bf0743ece18 324 * associated arguments. */
demayer 0:6bf0743ece18 325 int FATFileSystem::format(BlockDevice *bd, bd_size_t cluster_size) {
demayer 0:6bf0743ece18 326 FATFileSystem fs;
demayer 0:6bf0743ece18 327 int err = fs.mount(bd, false);
demayer 0:6bf0743ece18 328 if (err) {
demayer 0:6bf0743ece18 329 return err;
demayer 0:6bf0743ece18 330 }
demayer 0:6bf0743ece18 331
demayer 0:6bf0743ece18 332 // Logical drive number, Partitioning rule, Allocation unit size (bytes per cluster)
demayer 0:6bf0743ece18 333 fs.lock();
demayer 0:6bf0743ece18 334 FRESULT res = f_mkfs(fs._fsid, 1, cluster_size);
demayer 0:6bf0743ece18 335 fs.unlock();
demayer 0:6bf0743ece18 336 if (res != FR_OK) {
demayer 0:6bf0743ece18 337 return fat_error_remap(res);
demayer 0:6bf0743ece18 338 }
demayer 0:6bf0743ece18 339
demayer 0:6bf0743ece18 340 err = fs.unmount();
demayer 0:6bf0743ece18 341 if (err) {
demayer 0:6bf0743ece18 342 return err;
demayer 0:6bf0743ece18 343 }
demayer 0:6bf0743ece18 344
demayer 0:6bf0743ece18 345 return 0;
demayer 0:6bf0743ece18 346 }
demayer 0:6bf0743ece18 347
demayer 0:6bf0743ece18 348 int FATFileSystem::reformat(BlockDevice *bd, int allocation_unit) {
demayer 0:6bf0743ece18 349 lock();
demayer 0:6bf0743ece18 350 if (_id != -1) {
demayer 0:6bf0743ece18 351 if (!bd) {
demayer 0:6bf0743ece18 352 bd = _ffs[_id];
demayer 0:6bf0743ece18 353 }
demayer 0:6bf0743ece18 354
demayer 0:6bf0743ece18 355 int err = unmount();
demayer 0:6bf0743ece18 356 if (err) {
demayer 0:6bf0743ece18 357 unlock();
demayer 0:6bf0743ece18 358 return err;
demayer 0:6bf0743ece18 359 }
demayer 0:6bf0743ece18 360 }
demayer 0:6bf0743ece18 361
demayer 0:6bf0743ece18 362 if (!bd) {
demayer 0:6bf0743ece18 363 unlock();
demayer 0:6bf0743ece18 364 return -ENODEV;
demayer 0:6bf0743ece18 365 }
demayer 0:6bf0743ece18 366
demayer 0:6bf0743ece18 367 int err = FATFileSystem::format(bd, allocation_unit);
demayer 0:6bf0743ece18 368 if (err) {
demayer 0:6bf0743ece18 369 unlock();
demayer 0:6bf0743ece18 370 return err;
demayer 0:6bf0743ece18 371 }
demayer 0:6bf0743ece18 372
demayer 0:6bf0743ece18 373 err = mount(bd);
demayer 0:6bf0743ece18 374 unlock();
demayer 0:6bf0743ece18 375 return err;
demayer 0:6bf0743ece18 376 }
demayer 0:6bf0743ece18 377
demayer 0:6bf0743ece18 378 int FATFileSystem::remove(const char *path) {
demayer 0:6bf0743ece18 379 Deferred<const char*> fpath = fat_path_prefix(_id, path);
demayer 0:6bf0743ece18 380
demayer 0:6bf0743ece18 381 lock();
demayer 0:6bf0743ece18 382 FRESULT res = f_unlink(fpath);
demayer 0:6bf0743ece18 383 unlock();
demayer 0:6bf0743ece18 384
demayer 0:6bf0743ece18 385 if (res != FR_OK) {
demayer 0:6bf0743ece18 386 debug_if(FFS_DBG, "f_unlink() failed: %d\n", res);
demayer 0:6bf0743ece18 387 }
demayer 0:6bf0743ece18 388 return fat_error_remap(res);
demayer 0:6bf0743ece18 389 }
demayer 0:6bf0743ece18 390
demayer 0:6bf0743ece18 391 int FATFileSystem::rename(const char *oldpath, const char *newpath) {
demayer 0:6bf0743ece18 392 Deferred<const char*> oldfpath = fat_path_prefix(_id, oldpath);
demayer 0:6bf0743ece18 393 Deferred<const char*> newfpath = fat_path_prefix(_id, newpath);
demayer 0:6bf0743ece18 394
demayer 0:6bf0743ece18 395 lock();
demayer 0:6bf0743ece18 396 FRESULT res = f_rename(oldfpath, newfpath);
demayer 0:6bf0743ece18 397 unlock();
demayer 0:6bf0743ece18 398
demayer 0:6bf0743ece18 399 if (res != FR_OK) {
demayer 0:6bf0743ece18 400 debug_if(FFS_DBG, "f_rename() failed: %d\n", res);
demayer 0:6bf0743ece18 401 }
demayer 0:6bf0743ece18 402 return fat_error_remap(res);
demayer 0:6bf0743ece18 403 }
demayer 0:6bf0743ece18 404
demayer 0:6bf0743ece18 405 int FATFileSystem::mkdir(const char *path, mode_t mode) {
demayer 0:6bf0743ece18 406 Deferred<const char*> fpath = fat_path_prefix(_id, path);
demayer 0:6bf0743ece18 407
demayer 0:6bf0743ece18 408 lock();
demayer 0:6bf0743ece18 409 FRESULT res = f_mkdir(fpath);
demayer 0:6bf0743ece18 410 unlock();
demayer 0:6bf0743ece18 411
demayer 0:6bf0743ece18 412 if (res != FR_OK) {
demayer 0:6bf0743ece18 413 debug_if(FFS_DBG, "f_mkdir() failed: %d\n", res);
demayer 0:6bf0743ece18 414 }
demayer 0:6bf0743ece18 415 return fat_error_remap(res);
demayer 0:6bf0743ece18 416 }
demayer 0:6bf0743ece18 417
demayer 0:6bf0743ece18 418 int FATFileSystem::stat(const char *path, struct stat *st) {
demayer 0:6bf0743ece18 419 Deferred<const char*> fpath = fat_path_prefix(_id, path);
demayer 0:6bf0743ece18 420
demayer 0:6bf0743ece18 421 lock();
demayer 0:6bf0743ece18 422 FILINFO f;
demayer 0:6bf0743ece18 423 memset(&f, 0, sizeof(f));
demayer 0:6bf0743ece18 424
demayer 0:6bf0743ece18 425 FRESULT res = f_stat(fpath, &f);
demayer 0:6bf0743ece18 426 if (res != FR_OK) {
demayer 0:6bf0743ece18 427 unlock();
demayer 0:6bf0743ece18 428 return fat_error_remap(res);
demayer 0:6bf0743ece18 429 }
demayer 0:6bf0743ece18 430
demayer 0:6bf0743ece18 431 /* ARMCC doesnt support stat(), and these symbols are not defined by the toolchain. */
demayer 0:6bf0743ece18 432 #ifdef TOOLCHAIN_GCC
demayer 0:6bf0743ece18 433 st->st_size = f.fsize;
demayer 0:6bf0743ece18 434 st->st_mode = 0;
demayer 0:6bf0743ece18 435 st->st_mode |= (f.fattrib & AM_DIR) ? S_IFDIR : S_IFREG;
demayer 0:6bf0743ece18 436 st->st_mode |= (f.fattrib & AM_RDO) ?
demayer 0:6bf0743ece18 437 (S_IRUSR | S_IXUSR | S_IRGRP | S_IXGRP | S_IROTH | S_IXOTH) :
demayer 0:6bf0743ece18 438 (S_IRWXU | S_IRWXG | S_IRWXO);
demayer 0:6bf0743ece18 439 #endif /* TOOLCHAIN_GCC */
demayer 0:6bf0743ece18 440 unlock();
demayer 0:6bf0743ece18 441
demayer 0:6bf0743ece18 442 return 0;
demayer 0:6bf0743ece18 443 }
demayer 0:6bf0743ece18 444
demayer 0:6bf0743ece18 445 void FATFileSystem::lock() {
demayer 0:6bf0743ece18 446 _ffs_mutex->lock();
demayer 0:6bf0743ece18 447 }
demayer 0:6bf0743ece18 448
demayer 0:6bf0743ece18 449 void FATFileSystem::unlock() {
demayer 0:6bf0743ece18 450 _ffs_mutex->unlock();
demayer 0:6bf0743ece18 451 }
demayer 0:6bf0743ece18 452
demayer 0:6bf0743ece18 453
demayer 0:6bf0743ece18 454 ////// File operations //////
demayer 0:6bf0743ece18 455 int FATFileSystem::file_open(fs_file_t *file, const char *path, int flags) {
demayer 0:6bf0743ece18 456 debug_if(FFS_DBG, "open(%s) on filesystem [%s], drv [%s]\n", path, getName(), _id);
demayer 0:6bf0743ece18 457
demayer 0:6bf0743ece18 458 FIL *fh = new FIL;
demayer 0:6bf0743ece18 459 Deferred<const char*> fpath = fat_path_prefix(_id, path);
demayer 0:6bf0743ece18 460
demayer 0:6bf0743ece18 461 /* POSIX flags -> FatFS open mode */
demayer 0:6bf0743ece18 462 BYTE openmode;
demayer 0:6bf0743ece18 463 if (flags & O_RDWR) {
demayer 0:6bf0743ece18 464 openmode = FA_READ | FA_WRITE;
demayer 0:6bf0743ece18 465 } else if (flags & O_WRONLY) {
demayer 0:6bf0743ece18 466 openmode = FA_WRITE;
demayer 0:6bf0743ece18 467 } else {
demayer 0:6bf0743ece18 468 openmode = FA_READ;
demayer 0:6bf0743ece18 469 }
demayer 0:6bf0743ece18 470 if (flags & O_CREAT) {
demayer 0:6bf0743ece18 471 if (flags & O_TRUNC) {
demayer 0:6bf0743ece18 472 openmode |= FA_CREATE_ALWAYS;
demayer 0:6bf0743ece18 473 } else {
demayer 0:6bf0743ece18 474 openmode |= FA_OPEN_ALWAYS;
demayer 0:6bf0743ece18 475 }
demayer 0:6bf0743ece18 476 }
demayer 0:6bf0743ece18 477
demayer 0:6bf0743ece18 478 lock();
demayer 0:6bf0743ece18 479 FRESULT res = f_open(fh, fpath, openmode);
demayer 0:6bf0743ece18 480
demayer 0:6bf0743ece18 481 if (res != FR_OK) {
demayer 0:6bf0743ece18 482 unlock();
demayer 0:6bf0743ece18 483 debug_if(FFS_DBG, "f_open('w') failed: %d\n", res);
demayer 0:6bf0743ece18 484 delete fh;
demayer 0:6bf0743ece18 485 return fat_error_remap(res);
demayer 0:6bf0743ece18 486 }
demayer 0:6bf0743ece18 487
demayer 0:6bf0743ece18 488 if (flags & O_APPEND) {
demayer 0:6bf0743ece18 489 f_lseek(fh, fh->fsize);
demayer 0:6bf0743ece18 490 }
demayer 0:6bf0743ece18 491 unlock();
demayer 0:6bf0743ece18 492
demayer 0:6bf0743ece18 493 *file = fh;
demayer 0:6bf0743ece18 494 return 0;
demayer 0:6bf0743ece18 495 }
demayer 0:6bf0743ece18 496
demayer 0:6bf0743ece18 497 int FATFileSystem::file_close(fs_file_t file) {
demayer 0:6bf0743ece18 498 FIL *fh = static_cast<FIL*>(file);
demayer 0:6bf0743ece18 499
demayer 0:6bf0743ece18 500 lock();
demayer 0:6bf0743ece18 501 FRESULT res = f_close(fh);
demayer 0:6bf0743ece18 502 unlock();
demayer 0:6bf0743ece18 503
demayer 0:6bf0743ece18 504 delete fh;
demayer 0:6bf0743ece18 505 return fat_error_remap(res);
demayer 0:6bf0743ece18 506 }
demayer 0:6bf0743ece18 507
demayer 0:6bf0743ece18 508 ssize_t FATFileSystem::file_read(fs_file_t file, void *buffer, size_t len) {
demayer 0:6bf0743ece18 509 FIL *fh = static_cast<FIL*>(file);
demayer 0:6bf0743ece18 510
demayer 0:6bf0743ece18 511 lock();
demayer 0:6bf0743ece18 512 UINT n;
demayer 0:6bf0743ece18 513 FRESULT res = f_read(fh, buffer, len, &n);
demayer 0:6bf0743ece18 514 unlock();
demayer 0:6bf0743ece18 515
demayer 0:6bf0743ece18 516 if (res != FR_OK) {
demayer 0:6bf0743ece18 517 debug_if(FFS_DBG, "f_read() failed: %d\n", res);
demayer 0:6bf0743ece18 518 return fat_error_remap(res);
demayer 0:6bf0743ece18 519 } else {
demayer 0:6bf0743ece18 520 return n;
demayer 0:6bf0743ece18 521 }
demayer 0:6bf0743ece18 522 }
demayer 0:6bf0743ece18 523
demayer 0:6bf0743ece18 524 ssize_t FATFileSystem::file_write(fs_file_t file, const void *buffer, size_t len) {
demayer 0:6bf0743ece18 525 FIL *fh = static_cast<FIL*>(file);
demayer 0:6bf0743ece18 526
demayer 0:6bf0743ece18 527 lock();
demayer 0:6bf0743ece18 528 UINT n;
demayer 0:6bf0743ece18 529 FRESULT res = f_write(fh, buffer, len, &n);
demayer 0:6bf0743ece18 530 unlock();
demayer 0:6bf0743ece18 531
demayer 0:6bf0743ece18 532 if (res != FR_OK) {
demayer 0:6bf0743ece18 533 debug_if(FFS_DBG, "f_write() failed: %d", res);
demayer 0:6bf0743ece18 534 return fat_error_remap(res);
demayer 0:6bf0743ece18 535 } else {
demayer 0:6bf0743ece18 536 return n;
demayer 0:6bf0743ece18 537 }
demayer 0:6bf0743ece18 538 }
demayer 0:6bf0743ece18 539
demayer 0:6bf0743ece18 540 int FATFileSystem::file_sync(fs_file_t file) {
demayer 0:6bf0743ece18 541 FIL *fh = static_cast<FIL*>(file);
demayer 0:6bf0743ece18 542
demayer 0:6bf0743ece18 543 lock();
demayer 0:6bf0743ece18 544 FRESULT res = f_sync(fh);
demayer 0:6bf0743ece18 545 unlock();
demayer 0:6bf0743ece18 546
demayer 0:6bf0743ece18 547 if (res != FR_OK) {
demayer 0:6bf0743ece18 548 debug_if(FFS_DBG, "f_sync() failed: %d\n", res);
demayer 0:6bf0743ece18 549 }
demayer 0:6bf0743ece18 550 return fat_error_remap(res);
demayer 0:6bf0743ece18 551 }
demayer 0:6bf0743ece18 552
demayer 0:6bf0743ece18 553 off_t FATFileSystem::file_seek(fs_file_t file, off_t offset, int whence) {
demayer 0:6bf0743ece18 554 FIL *fh = static_cast<FIL*>(file);
demayer 0:6bf0743ece18 555
demayer 0:6bf0743ece18 556 lock();
demayer 0:6bf0743ece18 557 if (whence == SEEK_END) {
demayer 0:6bf0743ece18 558 offset += fh->fsize;
demayer 0:6bf0743ece18 559 } else if(whence==SEEK_CUR) {
demayer 0:6bf0743ece18 560 offset += fh->fptr;
demayer 0:6bf0743ece18 561 }
demayer 0:6bf0743ece18 562
demayer 0:6bf0743ece18 563 FRESULT res = f_lseek(fh, offset);
demayer 0:6bf0743ece18 564 off_t noffset = fh->fptr;
demayer 0:6bf0743ece18 565 unlock();
demayer 0:6bf0743ece18 566
demayer 0:6bf0743ece18 567 if (res != FR_OK) {
demayer 0:6bf0743ece18 568 debug_if(FFS_DBG, "lseek failed: %d\n", res);
demayer 0:6bf0743ece18 569 return fat_error_remap(res);
demayer 0:6bf0743ece18 570 } else {
demayer 0:6bf0743ece18 571 return noffset;
demayer 0:6bf0743ece18 572 }
demayer 0:6bf0743ece18 573 }
demayer 0:6bf0743ece18 574
demayer 0:6bf0743ece18 575 off_t FATFileSystem::file_tell(fs_file_t file) {
demayer 0:6bf0743ece18 576 FIL *fh = static_cast<FIL*>(file);
demayer 0:6bf0743ece18 577
demayer 0:6bf0743ece18 578 lock();
demayer 0:6bf0743ece18 579 off_t res = fh->fptr;
demayer 0:6bf0743ece18 580 unlock();
demayer 0:6bf0743ece18 581
demayer 0:6bf0743ece18 582 return res;
demayer 0:6bf0743ece18 583 }
demayer 0:6bf0743ece18 584
demayer 0:6bf0743ece18 585 off_t FATFileSystem::file_size(fs_file_t file) {
demayer 0:6bf0743ece18 586 FIL *fh = static_cast<FIL*>(file);
demayer 0:6bf0743ece18 587
demayer 0:6bf0743ece18 588 lock();
demayer 0:6bf0743ece18 589 off_t res = fh->fsize;
demayer 0:6bf0743ece18 590 unlock();
demayer 0:6bf0743ece18 591
demayer 0:6bf0743ece18 592 return res;
demayer 0:6bf0743ece18 593 }
demayer 0:6bf0743ece18 594
demayer 0:6bf0743ece18 595
demayer 0:6bf0743ece18 596 ////// Dir operations //////
demayer 0:6bf0743ece18 597 int FATFileSystem::dir_open(fs_dir_t *dir, const char *path) {
demayer 0:6bf0743ece18 598 FATFS_DIR *dh = new FATFS_DIR;
demayer 0:6bf0743ece18 599 Deferred<const char*> fpath = fat_path_prefix(_id, path);
demayer 0:6bf0743ece18 600
demayer 0:6bf0743ece18 601 lock();
demayer 0:6bf0743ece18 602 FRESULT res = f_opendir(dh, fpath);
demayer 0:6bf0743ece18 603 unlock();
demayer 0:6bf0743ece18 604
demayer 0:6bf0743ece18 605 if (res != FR_OK) {
demayer 0:6bf0743ece18 606 debug_if(FFS_DBG, "f_opendir() failed: %d\n", res);
demayer 0:6bf0743ece18 607 delete dh;
demayer 0:6bf0743ece18 608 return fat_error_remap(res);
demayer 0:6bf0743ece18 609 }
demayer 0:6bf0743ece18 610
demayer 0:6bf0743ece18 611 *dir = dh;
demayer 0:6bf0743ece18 612 return 0;
demayer 0:6bf0743ece18 613 }
demayer 0:6bf0743ece18 614
demayer 0:6bf0743ece18 615 int FATFileSystem::dir_close(fs_dir_t dir) {
demayer 0:6bf0743ece18 616 FATFS_DIR *dh = static_cast<FATFS_DIR*>(dir);
demayer 0:6bf0743ece18 617
demayer 0:6bf0743ece18 618 lock();
demayer 0:6bf0743ece18 619 FRESULT res = f_closedir(dh);
demayer 0:6bf0743ece18 620 unlock();
demayer 0:6bf0743ece18 621
demayer 0:6bf0743ece18 622 delete dh;
demayer 0:6bf0743ece18 623 return fat_error_remap(res);
demayer 0:6bf0743ece18 624 }
demayer 0:6bf0743ece18 625
demayer 0:6bf0743ece18 626 ssize_t FATFileSystem::dir_read(fs_dir_t dir, struct dirent *ent) {
demayer 0:6bf0743ece18 627 FATFS_DIR *dh = static_cast<FATFS_DIR*>(dir);
demayer 0:6bf0743ece18 628 FILINFO finfo;
demayer 0:6bf0743ece18 629
demayer 0:6bf0743ece18 630 #if _USE_LFN
demayer 0:6bf0743ece18 631 finfo.lfname = ent->d_name;
demayer 0:6bf0743ece18 632 finfo.lfsize = NAME_MAX;
demayer 0:6bf0743ece18 633 #endif // _USE_LFN
demayer 0:6bf0743ece18 634
demayer 0:6bf0743ece18 635 lock();
demayer 0:6bf0743ece18 636 FRESULT res = f_readdir(dh, &finfo);
demayer 0:6bf0743ece18 637 unlock();
demayer 0:6bf0743ece18 638
demayer 0:6bf0743ece18 639 if (res != FR_OK) {
demayer 0:6bf0743ece18 640 return fat_error_remap(res);
demayer 0:6bf0743ece18 641 } else if (finfo.fname[0] == 0) {
demayer 0:6bf0743ece18 642 return 0;
demayer 0:6bf0743ece18 643 }
demayer 0:6bf0743ece18 644
demayer 0:6bf0743ece18 645 ent->d_type = (finfo.fattrib & AM_DIR) ? DT_DIR : DT_REG;
demayer 0:6bf0743ece18 646
demayer 0:6bf0743ece18 647 #if _USE_LFN
demayer 0:6bf0743ece18 648 if (ent->d_name[0] == 0) {
demayer 0:6bf0743ece18 649 // No long filename so use short filename.
demayer 0:6bf0743ece18 650 strncpy(ent->d_name, finfo.fname, NAME_MAX);
demayer 0:6bf0743ece18 651 }
demayer 0:6bf0743ece18 652 #else
demayer 0:6bf0743ece18 653 strncpy(end->d_name, finfo.fname, len);
demayer 0:6bf0743ece18 654 #endif
demayer 0:6bf0743ece18 655
demayer 0:6bf0743ece18 656 return 1;
demayer 0:6bf0743ece18 657 }
demayer 0:6bf0743ece18 658
demayer 0:6bf0743ece18 659 void FATFileSystem::dir_seek(fs_dir_t dir, off_t offset) {
demayer 0:6bf0743ece18 660 FATFS_DIR *dh = static_cast<FATFS_DIR*>(dir);
demayer 0:6bf0743ece18 661
demayer 0:6bf0743ece18 662 lock();
demayer 0:6bf0743ece18 663 if (offset < dh->index) {
demayer 0:6bf0743ece18 664 f_rewinddir(dh);
demayer 0:6bf0743ece18 665 }
demayer 0:6bf0743ece18 666 while (dh->index < offset) {
demayer 0:6bf0743ece18 667 FILINFO finfo;
demayer 0:6bf0743ece18 668 FRESULT res;
demayer 0:6bf0743ece18 669 #if _USE_LFN
demayer 0:6bf0743ece18 670 char lfname[NAME_MAX];
demayer 0:6bf0743ece18 671 finfo.lfname = lfname;
demayer 0:6bf0743ece18 672 finfo.lfsize = NAME_MAX;
demayer 0:6bf0743ece18 673 #endif // _USE_LFN
demayer 0:6bf0743ece18 674 res = f_readdir(dh, &finfo);
demayer 0:6bf0743ece18 675 if (res != FR_OK) {
demayer 0:6bf0743ece18 676 break;
demayer 0:6bf0743ece18 677 } else if (finfo.fname[0] == 0) {
demayer 0:6bf0743ece18 678 break;
demayer 0:6bf0743ece18 679 }
demayer 0:6bf0743ece18 680 }
demayer 0:6bf0743ece18 681 unlock();
demayer 0:6bf0743ece18 682 }
demayer 0:6bf0743ece18 683
demayer 0:6bf0743ece18 684 off_t FATFileSystem::dir_tell(fs_dir_t dir) {
demayer 0:6bf0743ece18 685 FATFS_DIR *dh = static_cast<FATFS_DIR*>(dir);
demayer 0:6bf0743ece18 686
demayer 0:6bf0743ece18 687 lock();
demayer 0:6bf0743ece18 688 off_t offset = dh->index;
demayer 0:6bf0743ece18 689 unlock();
demayer 0:6bf0743ece18 690
demayer 0:6bf0743ece18 691 return offset;
demayer 0:6bf0743ece18 692 }
demayer 0:6bf0743ece18 693
demayer 0:6bf0743ece18 694 void FATFileSystem::dir_rewind(fs_dir_t dir) {
demayer 0:6bf0743ece18 695 FATFS_DIR *dh = static_cast<FATFS_DIR*>(dir);
demayer 0:6bf0743ece18 696
demayer 0:6bf0743ece18 697 lock();
demayer 0:6bf0743ece18 698 f_rewinddir(dh);
demayer 0:6bf0743ece18 699 unlock();
demayer 0:6bf0743ece18 700 }
demayer 0:6bf0743ece18 701