Make RNDISHost demo validate the set Packet Filter to ensure that it is being sent...
[pub/lufa.git] / Projects / Incomplete / StandaloneProgrammer / Lib / PetiteFATFs / pff.c
diff --git a/Projects/Incomplete/StandaloneProgrammer/Lib/PetiteFATFs/pff.c b/Projects/Incomplete/StandaloneProgrammer/Lib/PetiteFATFs/pff.c
new file mode 100644 (file)
index 0000000..126d45f
--- /dev/null
@@ -0,0 +1,777 @@
+/*----------------------------------------------------------------------------/\r
+/  Petit FatFs - FAT file system module  R0.01a                (C)ChaN, 2009\r
+/-----------------------------------------------------------------------------/\r
+/ Petit FatFs module is an open source software to implement FAT file system to\r
+/ small embedded systems. This is a free software and is opened for education,\r
+/ research and commercial developments under license policy of following trems.\r
+/\r
+/  Copyright (C) 2009, ChaN, all right reserved.\r
+/\r
+/ * The Petit FatFs module is a free software and there is NO WARRANTY.\r
+/ * No restriction on use. You can use, modify and redistribute it for\r
+/   personal, non-profit or commercial use UNDER YOUR RESPONSIBILITY.\r
+/ * Redistributions of source code must retain the above copyright notice.\r
+/\r
+/-----------------------------------------------------------------------------/\r
+/ Jun 15,'09 R0.01a  Branched from FatFs R0.07b\r
+/----------------------------------------------------------------------------*/\r
+\r
+#include "pff.h"               /* Petit FatFs configurations and declarations */\r
+#include "diskio.h"            /* Declarations of low level disk I/O functions */\r
+\r
+\r
+/*--------------------------------------------------------------------------\r
+\r
+   Private Work Area\r
+\r
+---------------------------------------------------------------------------*/\r
+\r
+static\r
+FATFS *FatFs;  /* Pointer to the file system object (logical drive) */\r
+\r
+\r
+/*--------------------------------------------------------------------------\r
+\r
+   Private Functions\r
+\r
+---------------------------------------------------------------------------*/\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* String functions                                                      */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+/* Fill memory */\r
+static\r
+void mem_set (void* dst, int val, int cnt) {\r
+       char *d = (char*)dst;\r
+       while (cnt--) *d++ = (char)val;\r
+}\r
+\r
+/* Compare memory to memory */\r
+static\r
+int mem_cmp (const void* dst, const void* src, int cnt) {\r
+       const char *d = (const char *)dst, *s = (const char *)src;\r
+       int r = 0;\r
+       while (cnt-- && (r = *d++ - *s++) == 0) ;\r
+       return r;\r
+}\r
+\r
+/* Check if chr is contained in the string */\r
+static\r
+int chk_chr (const char* str, int chr) {\r
+       while (*str && *str != chr) str++;\r
+       return *str;\r
+}\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* FAT access - Read value of a FAT entry                                */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+static\r
+CLUST get_fat (        /* 1:IO error, Else:Cluster status */\r
+       CLUST clst      /* Cluster# to get the link information */\r
+)\r
+{\r
+       WORD wc, bc, ofs;\r
+       BYTE buf[4];\r
+       FATFS *fs = FatFs;\r
+\r
+\r
+       if (clst < 2 || clst >= fs->max_clust)  /* Range check */\r
+               return 1;\r
+\r
+       switch (fs->fs_type) {\r
+       case FS_FAT12 :\r
+               bc = (WORD)clst; bc += bc / 2;\r
+               ofs = bc % 512; bc /= 512;\r
+               if (ofs != 511) {\r
+                       if (disk_readp(buf, fs->fatbase + bc, ofs, 2)) break;\r
+               } else {\r
+                       if (disk_readp(buf, fs->fatbase + bc, 511, 1)) break;\r
+                       if (disk_readp(buf+1, fs->fatbase + bc + 1, 0, 1)) break;\r
+               }\r
+               wc = LD_WORD(buf);\r
+               return (clst & 1) ? (wc >> 4) : (wc & 0xFFF);\r
+\r
+       case FS_FAT16 :\r
+               if (disk_readp(buf, fs->fatbase + clst / 256, (WORD)(((WORD)clst % 256) * 2), 2)) break;\r
+               return LD_WORD(buf);\r
+#if _FS_FAT32\r
+       case FS_FAT32 :\r
+               if (disk_readp(buf, fs->fatbase + clst / 128, (WORD)(((WORD)clst % 128) * 4), 4)) break;\r
+               return LD_DWORD(buf) & 0x0FFFFFFF;\r
+#endif\r
+       }\r
+\r
+       return 1;       /* An error occured at the disk I/O layer */\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Get sector# from cluster#                                             */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+static\r
+DWORD clust2sect (     /* !=0: Sector number, 0: Failed - invalid cluster# */\r
+       CLUST clst              /* Cluster# to be converted */\r
+)\r
+{\r
+       FATFS *fs = FatFs;\r
+\r
+\r
+       clst -= 2;\r
+       if (clst >= (fs->max_clust - 2)) return 0;              /* Invalid cluster# */\r
+       return (DWORD)clst * fs->csize + fs->database;\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Directory handling - Rewind directory index                           */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+static\r
+FRESULT dir_rewind (\r
+       DIR *dj                 /* Pointer to directory object */\r
+)\r
+{\r
+       CLUST clst;\r
+       FATFS *fs = FatFs;\r
+\r
+\r
+       dj->index = 0;\r
+       clst = dj->sclust;\r
+       if (clst == 1 || clst >= fs->max_clust) /* Check start cluster range */\r
+               return FR_DISK_ERR;\r
+#if _FS_FAT32\r
+       if (!clst && fs->fs_type == FS_FAT32)   /* Replace cluster# 0 with root cluster# if in FAT32 */\r
+               clst = fs->dirbase;\r
+#endif\r
+       dj->clust = clst;                                               /* Current cluster */\r
+       dj->sect = clst ? clust2sect(clst) : fs->dirbase;       /* Current sector */\r
+\r
+       return FR_OK;   /* Seek succeeded */\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Directory handling - Move directory index next                        */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+static\r
+FRESULT dir_next (     /* FR_OK:Succeeded, FR_NO_FILE:End of table, FR_DENIED:EOT and could not streach */\r
+       DIR *dj                 /* Pointer to directory object */\r
+)\r
+{\r
+       CLUST clst;\r
+       WORD i;\r
+       FATFS *fs = FatFs;\r
+\r
+\r
+       i = dj->index + 1;\r
+       if (!i || !dj->sect)    /* Report EOT when index has reached 65535 */\r
+               return FR_NO_FILE;\r
+\r
+       if (!(i & (16-1))) {    /* Sector changed? */\r
+               dj->sect++;                     /* Next sector */\r
+\r
+               if (dj->clust == 0) {   /* Static table */\r
+                       if (i >= fs->n_rootdir) /* Report EOT when end of table */\r
+                               return FR_NO_FILE;\r
+               }\r
+               else {                                  /* Dynamic table */\r
+                       if (((i / 16) & (fs->csize-1)) == 0) {  /* Cluster changed? */\r
+                               clst = get_fat(dj->clust);              /* Get next cluster */\r
+                               if (clst <= 1) return FR_DISK_ERR;\r
+                               if (clst >= fs->max_clust)              /* When it reached end of dynamic table */\r
+                                       return FR_NO_FILE;                      /* Report EOT */\r
+                               dj->clust = clst;                               /* Initialize data for new cluster */\r
+                               dj->sect = clust2sect(clst);\r
+                       }\r
+               }\r
+       }\r
+\r
+       dj->index = i;\r
+\r
+       return FR_OK;\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Directory handling - Find an object in the directory                  */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+static\r
+FRESULT dir_find (\r
+       DIR *dj                 /* Pointer to the directory object linked to the file name */\r
+)\r
+{\r
+       FRESULT res;\r
+       BYTE c, *dir;\r
+\r
+\r
+       res = dir_rewind(dj);                   /* Rewind directory object */\r
+       if (res != FR_OK) return res;\r
+\r
+       dir = FatFs->buf;\r
+       do {\r
+               res = disk_readp(dir, dj->sect, (WORD)((dj->index % 16) * 32), 32)      /* Read an entry */\r
+                       ? FR_DISK_ERR : FR_OK;\r
+               if (res != FR_OK) break;\r
+               c = dir[DIR_Name];      /* First character */\r
+               if (c == 0) { res = FR_NO_FILE; break; }        /* Reached to end of table */\r
+               if (!(dir[DIR_Attr] & AM_VOL) && !mem_cmp(dir, dj->fn, 11)) /* Is it a valid entry? */\r
+                       break;\r
+               res = dir_next(dj);                                                     /* Next entry */\r
+       } while (res == FR_OK);\r
+\r
+       return res;\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Read an object from the directory                                     */\r
+/*-----------------------------------------------------------------------*/\r
+#if _USE_DIR\r
+static\r
+FRESULT dir_read (\r
+       DIR *dj                 /* Pointer to the directory object to store read object name */\r
+)\r
+{\r
+       FRESULT res;\r
+       BYTE a, c, *dir;\r
+\r
+\r
+       res = FR_NO_FILE;\r
+       while (dj->sect) {\r
+               dir = FatFs->buf;\r
+               res = disk_readp(dir, dj->sect, (WORD)((dj->index % 16) * 32), 32)      /* Read an entry */\r
+                       ? FR_DISK_ERR : FR_OK;\r
+               if (res != FR_OK) break;\r
+               c = dir[DIR_Name];\r
+               if (c == 0) { res = FR_NO_FILE; break; }        /* Reached to end of table */\r
+               a = dir[DIR_Attr] & AM_MASK;\r
+               if (c != 0xE5 && c != '.' && !(a & AM_VOL))     /* Is it a valid entry? */\r
+                       break;\r
+               res = dir_next(dj);                             /* Next entry */\r
+               if (res != FR_OK) break;\r
+       }\r
+\r
+       if (res != FR_OK) dj->sect = 0;\r
+\r
+       return res;\r
+}\r
+#endif\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Pick a segment and create the object name in directory form           */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+\r
+static\r
+FRESULT create_name (\r
+       DIR *dj,                        /* Pointer to the directory object */\r
+       const char **path       /* Pointer to pointer to the segment in the path string */\r
+)\r
+{\r
+       BYTE c, ni, si, i, *sfn;\r
+       const char *p;\r
+\r
+       /* Create file name in directory form */\r
+       sfn = dj->fn;\r
+       mem_set(sfn, ' ', 11);\r
+       si = i = 0; ni = 8;\r
+       p = *path;\r
+       for (;;) {\r
+               c = p[si++];\r
+               if (c < ' ' || c == '/') break; /* Break on end of segment */\r
+               if (c == '.' || i >= ni) {\r
+                       if (ni != 8 || c != '.') return FR_INVALID_NAME;\r
+                       i = 8; ni = 11;\r
+                       continue;\r
+               }\r
+               if (c >= 0x7F || chk_chr(" +,;[=\\]\"*:<>\?|", c))      /* Reject unallowable chrs for SFN */\r
+                       return FR_INVALID_NAME;\r
+               if (c >='a' && c <= 'z') c -= 0x20;\r
+               sfn[i++] = c;\r
+       }\r
+       if (!i) return FR_INVALID_NAME;         /* Reject null string */\r
+       *path = &p[si];                                         /* Rerurn pointer to the next segment */\r
+\r
+       sfn[11] = (c < ' ') ? 1 : 0;            /* Set last segment flag if end of path */\r
+\r
+       return FR_OK;\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Get file information from directory entry                             */\r
+/*-----------------------------------------------------------------------*/\r
+#if _USE_DIR\r
+static\r
+void get_fileinfo (            /* No return code */\r
+       DIR *dj,                        /* Pointer to the directory object */\r
+       FILINFO *fno            /* Pointer to store the file information */\r
+)\r
+{\r
+       BYTE i, c, *dir;\r
+       char *p;\r
+\r
+\r
+       p = fno->fname;\r
+       if (dj->sect) {\r
+               dir = FatFs->buf;\r
+               for (i = 0; i < 8; i++) {       /* Copy file name body */\r
+                       c = dir[i];\r
+                       if (c == ' ') break;\r
+                       if (c == 0x05) c = 0xE5;\r
+                       *p++ = c;\r
+               }\r
+               if (dir[8] != ' ') {            /* Copy file name extension */\r
+                       *p++ = '.';\r
+                       for (i = 8; i < 11; i++) {\r
+                               c = dir[i];\r
+                               if (c == ' ') break;\r
+                               *p++ = c;\r
+                       }\r
+               }\r
+               fno->fattrib = dir[DIR_Attr];                           /* Attribute */\r
+               fno->fsize = LD_DWORD(dir+DIR_FileSize);        /* Size */\r
+               fno->fdate = LD_WORD(dir+DIR_WrtDate);          /* Date */\r
+               fno->ftime = LD_WORD(dir+DIR_WrtTime);          /* Time */\r
+       }\r
+       *p = 0;\r
+}\r
+#endif /* _USE_DIR */\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Follow a file path                                                    */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+static\r
+FRESULT follow_path (  /* FR_OK(0): successful, !=0: error code */\r
+       DIR *dj,                        /* Directory object to return last directory and found object */\r
+       const char *path        /* Full-path string to find a file or directory */\r
+)\r
+{\r
+       FRESULT res;\r
+       BYTE *dir;\r
+\r
+\r
+       if (*path == '/') path++;                       /* Strip heading separator */\r
+       dj->sclust = 0;                                         /* Set start directory (always root dir) */\r
+\r
+       if ((BYTE)*path < ' ') {                        /* Null path means the root directory */\r
+               res = dir_rewind(dj);\r
+               FatFs->buf[0] = 0;\r
+\r
+       } else {                                                        /* Follow path */\r
+               for (;;) {\r
+                       res = create_name(dj, &path);   /* Get a segment */\r
+                       if (res != FR_OK) break;\r
+                       res = dir_find(dj);                             /* Find it */\r
+                       if (res != FR_OK) {                             /* Could not find the object */\r
+                               if (res == FR_NO_FILE && !*(dj->fn+11))\r
+                                       res = FR_NO_PATH;\r
+                               break;\r
+                       }\r
+                       if (*(dj->fn+11)) break;                /* Last segment match. Function completed. */\r
+                       dir = FatFs->buf;                               /* There is next segment. Follow the sub directory */\r
+                       if (!(dir[DIR_Attr] & AM_DIR)) { /* Cannot follow because it is a file */\r
+                               res = FR_NO_PATH; break;\r
+                       }\r
+                       dj->sclust =\r
+#if _FS_FAT32\r
+                               ((DWORD)LD_WORD(dir+DIR_FstClusHI) << 16) | \r
+#endif\r
+                               LD_WORD(dir+DIR_FstClusLO);\r
+               }\r
+       }\r
+\r
+       return res;\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Check a sector if it is an FAT boot record                            */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+static\r
+BYTE check_fs (        /* 0:The FAT boot record, 1:Valid boot record but not an FAT, 2:Not a boot record, 3:Error */\r
+       BYTE *buf,      /* Working buffer */\r
+       DWORD sect      /* Sector# (lba) to check if it is an FAT boot record or not */\r
+)\r
+{\r
+       if (disk_readp(buf, sect, 510, 2))              /* Read the boot sector */\r
+               return 3;\r
+       if (LD_WORD(buf) != 0xAA55)                             /* Check record signature */\r
+               return 2;\r
+\r
+       if (!disk_readp(buf, sect, BS_FilSysType, 2) && LD_WORD(buf) == 0x4146) /* Check FAT12/16 */\r
+               return 0;\r
+#if _FS_FAT32\r
+       if (!disk_readp(buf, sect, BS_FilSysType32, 2) && LD_WORD(buf) == 0x4146)       /* Check FAT32 */\r
+               return 0;\r
+#endif\r
+       return 1;\r
+}\r
+\r
+\r
+\r
+\r
+/*--------------------------------------------------------------------------\r
+\r
+   Public Functions\r
+\r
+--------------------------------------------------------------------------*/\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Mount/Unmount a Locical Drive                                         */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+FRESULT pf_mount (\r
+       FATFS *fs               /* Pointer to new file system object (NULL: Unmount) */\r
+)\r
+{\r
+       BYTE fmt, buf[36];\r
+       DWORD bsect, fsize, tsect, mclst;\r
+\r
+\r
+       FatFs = 0;\r
+       if (!fs) return FR_OK;                          /* Unregister fs object */\r
+\r
+       if (disk_initialize() & STA_NOINIT)     /* Check if the drive is ready or not */\r
+               return FR_NOT_READY;\r
+\r
+       /* Search FAT partition on the drive */\r
+       bsect = 0;\r
+       fmt = check_fs(buf, bsect);                     /* Check sector 0 as an SFD format */\r
+       if (fmt == 1) {                                         /* Not an FAT boot record, it may be FDISK format */\r
+               /* Check a partition listed in top of the partition table */\r
+               if (disk_readp(buf, bsect, MBR_Table, 16)) {    /* 1st partition entry */\r
+                       fmt = 3;\r
+               } else {\r
+                       if (buf[4]) {                                   /* Is the partition existing? */\r
+                               bsect = LD_DWORD(&buf[8]);      /* Partition offset in LBA */\r
+                               fmt = check_fs(buf, bsect);     /* Check the partition */\r
+                       }\r
+               }\r
+       }\r
+       if (fmt == 3) return FR_DISK_ERR;\r
+       if (fmt) return FR_NO_FILESYSTEM;       /* No valid FAT patition is found */\r
+\r
+       /* Initialize the file system object */\r
+       if (disk_readp(buf, bsect, 13, sizeof(buf))) return FR_DISK_ERR;\r
+\r
+       fsize = LD_WORD(buf+BPB_FATSz16-13);                            /* Number of sectors per FAT */\r
+       if (!fsize) fsize = LD_DWORD(buf+BPB_FATSz32-13);\r
+\r
+       fsize *= buf[BPB_NumFATs-13];                                           /* Number of sectors in FAT area */\r
+       fs->fatbase = bsect + LD_WORD(buf+BPB_RsvdSecCnt-13); /* FAT start sector (lba) */\r
+       fs->csize = buf[BPB_SecPerClus-13];                                     /* Number of sectors per cluster */\r
+       fs->n_rootdir = LD_WORD(buf+BPB_RootEntCnt-13);         /* Nmuber of root directory entries */\r
+       tsect = LD_WORD(buf+BPB_TotSec16-13);                           /* Number of sectors on the file system */\r
+       if (!tsect) tsect = LD_DWORD(buf+BPB_TotSec32-13);\r
+       mclst = (tsect                                          /* Last cluster# + 1 */\r
+               - LD_WORD(buf+BPB_RsvdSecCnt-13) - fsize - fs->n_rootdir / 16\r
+               ) / fs->csize + 2;\r
+       fs->max_clust = (CLUST)mclst;\r
+\r
+       fmt = FS_FAT12;                                                 /* Determine the FAT sub type */\r
+       if (mclst >= 0xFF7) fmt = FS_FAT16;             /* Number of clusters >= 0xFF5 */\r
+       if (mclst >= 0xFFF7)                                    /* Number of clusters >= 0xFFF5 */\r
+#if _FS_FAT32\r
+               fmt = FS_FAT32;\r
+#else\r
+               return FR_NO_FILESYSTEM;\r
+#endif\r
+\r
+       fs->fs_type = fmt;              /* FAT sub-type */\r
+#if _FS_FAT32\r
+       if (fmt == FS_FAT32)\r
+               fs->dirbase = LD_DWORD(buf+(BPB_RootClus-13));  /* Root directory start cluster */\r
+       else\r
+#endif\r
+               fs->dirbase = fs->fatbase + fsize;                              /* Root directory start sector (lba) */\r
+       fs->database = fs->fatbase + fsize + fs->n_rootdir / 16;        /* Data start sector (lba) */\r
+\r
+       fs->flag = 0;\r
+       FatFs = fs;\r
+\r
+       return FR_OK;\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Open or Create a File                                                 */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+FRESULT pf_open (\r
+       const char *path        /* Pointer to the file name */\r
+)\r
+{\r
+       FRESULT res;\r
+       DIR dj;\r
+       BYTE sp[12], dir[32];\r
+       FATFS *fs = FatFs;\r
+\r
+\r
+       if (!fs)                                                /* Check file system */\r
+               return FR_NOT_ENABLED;\r
+\r
+       fs->flag = 0;\r
+       fs->buf = dir;\r
+       dj.fn = sp;\r
+       res = follow_path(&dj, path);   /* Follow the file path */\r
+       if (res != FR_OK) return res;   /* Follow failed */\r
+       if (!dir[0] || (dir[DIR_Attr] & AM_DIR))        /* It is a directory */\r
+               return FR_NO_FILE;\r
+\r
+       fs->org_clust =                                         /* File start cluster */\r
+#if _FS_FAT32\r
+               ((DWORD)LD_WORD(dir+DIR_FstClusHI) << 16) |\r
+#endif\r
+               LD_WORD(dir+DIR_FstClusLO);\r
+       fs->fsize = LD_DWORD(dir+DIR_FileSize); /* File size */\r
+       fs->fptr = 0;                                           /* File pointer */\r
+       fs->flag = FA_READ;\r
+\r
+       return FR_OK;\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Read File                                                             */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+FRESULT pf_read (\r
+       void* dest,             /* Pointer to the destination object */\r
+       WORD btr,               /* Number of bytes to read (bit15:destination) */\r
+       WORD* br                /* Pointer to number of bytes read */\r
+)\r
+{\r
+       DRESULT dr;\r
+       CLUST clst;\r
+       DWORD sect, remain;\r
+       WORD rcnt;\r
+       BYTE *rbuff = dest;\r
+       FATFS *fs = FatFs;\r
+\r
+\r
+       *br = 0;\r
+       if (!fs) return FR_NOT_ENABLED;         /* Check file system */\r
+       if (!(fs->flag & FA_READ))\r
+                       return FR_INVALID_OBJECT;\r
+\r
+       remain = fs->fsize - fs->fptr;\r
+       if (btr > remain) btr = (UINT)remain;                   /* Truncate btr by remaining bytes */\r
+\r
+       for ( ;  btr;                                                                   /* Repeat until all data transferred */\r
+               rbuff += rcnt, fs->fptr += rcnt, *br += rcnt, btr -= rcnt) {\r
+               if ((fs->fptr % 512) == 0) {                            /* On the sector boundary? */\r
+                       if ((fs->fptr / 512 % fs->csize) == 0) {        /* On the cluster boundary? */\r
+                               clst = (fs->fptr == 0) ?                        /* On the top of the file? */\r
+                                       fs->org_clust : get_fat(fs->curr_clust);\r
+                               if (clst <= 1) {\r
+                                       fs->flag = 0; return FR_DISK_ERR;\r
+                               }\r
+                               fs->curr_clust = clst;                          /* Update current cluster */\r
+                               fs->csect = 0;                                          /* Reset sector offset in the cluster */\r
+                       }\r
+                       sect = clust2sect(fs->curr_clust);              /* Get current sector */\r
+                       if (!sect) {\r
+                               fs->flag = 0; return FR_DISK_ERR;\r
+                       }\r
+                       sect += fs->csect;\r
+                       fs->dsect = sect;\r
+                       fs->csect++;                                                    /* Next sector address in the cluster */\r
+               }\r
+               rcnt = 512 - ((WORD)fs->fptr % 512);            /* Get partial sector data from sector buffer */\r
+               if (rcnt > btr) rcnt = btr;\r
+               if (fs->flag & FA_STREAM) {\r
+                       dr = disk_readp(dest, fs->dsect, (WORD)(fs->fptr % 512), (WORD)(rcnt | 0x8000));\r
+               } else {\r
+                       dr = disk_readp(rbuff, fs->dsect, (WORD)(fs->fptr % 512), rcnt);\r
+               }\r
+               if (dr) {\r
+                       fs->flag = 0;\r
+                       return (dr == RES_STRERR) ? FR_STREAM_ERR : FR_DISK_ERR;\r
+               }\r
+       }\r
+\r
+       return FR_OK;\r
+}\r
+\r
+\r
+\r
+\r
+#if _USE_LSEEK\r
+/*-----------------------------------------------------------------------*/\r
+/* Seek File R/W Pointer                                                 */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+FRESULT pf_lseek (\r
+       DWORD ofs               /* File pointer from top of file */\r
+)\r
+{\r
+       CLUST clst;\r
+       DWORD bcs, nsect, ifptr;\r
+       FATFS *fs = FatFs;\r
+\r
+\r
+       if (!fs) return FR_NOT_ENABLED;         /* Check file system */\r
+       if (!(fs->flag & FA_READ))\r
+                       return FR_INVALID_OBJECT;\r
+\r
+       if (ofs > fs->fsize) ofs = fs->fsize;   /* Clip offset with the file size */\r
+       ifptr = fs->fptr;\r
+       fs->fptr = 0;\r
+       if (ofs > 0) {\r
+               bcs = (DWORD)fs->csize * 512;   /* Cluster size (byte) */\r
+               if (ifptr > 0 &&\r
+                       (ofs - 1) / bcs >= (ifptr - 1) / bcs) { /* When seek to same or following cluster, */\r
+                       fs->fptr = (ifptr - 1) & ~(bcs - 1);    /* start from the current cluster */\r
+                       ofs -= fs->fptr;\r
+                       clst = fs->curr_clust;\r
+               } else {                                                        /* When seek to back cluster, */\r
+                       clst = fs->org_clust;                   /* start from the first cluster */\r
+                       fs->curr_clust = clst;\r
+               }\r
+               while (ofs > bcs) {                             /* Cluster following loop */\r
+                               clst = get_fat(clst);   /* Follow cluster chain if not in write mode */\r
+                       if (clst <= 1 || clst >= fs->max_clust) {\r
+                               fs->flag = 0; return FR_DISK_ERR;\r
+                       }\r
+                       fs->curr_clust = clst;\r
+                       fs->fptr += bcs;\r
+                       ofs -= bcs;\r
+               }\r
+               fs->fptr += ofs;\r
+               fs->csect = (BYTE)(ofs / 512) + 1;      /* Sector offset in the cluster */\r
+               nsect = clust2sect(clst);       /* Current sector */\r
+               if (!nsect) {\r
+                       fs->flag = 0; return FR_DISK_ERR;\r
+               }\r
+               fs->dsect = nsect + fs->csect - 1;\r
+       }\r
+\r
+       return FR_OK;\r
+}\r
+#endif\r
+\r
+\r
+#if _USE_DIR\r
+/*-----------------------------------------------------------------------*/\r
+/* Create a Directroy Object                                             */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+FRESULT pf_opendir (\r
+       DIR *dj,                        /* Pointer to directory object to create */\r
+       const char *path        /* Pointer to the directory path */\r
+)\r
+{\r
+       FRESULT res;\r
+       BYTE sp[12], dir[32];\r
+       FATFS *fs = FatFs;\r
+\r
+\r
+       if (!fs) {                              /* Check file system */\r
+               res = FR_NOT_ENABLED;\r
+       } else {\r
+               fs->buf = dir;\r
+               dj->fn = sp;\r
+               res = follow_path(dj, path);                    /* Follow the path to the directory */\r
+               if (res == FR_OK) {                                             /* Follow completed */\r
+                       if (dir[0]) {                                           /* It is not the root dir */\r
+                               if (dir[DIR_Attr] & AM_DIR) {   /* The object is a directory */\r
+                                       dj->sclust =\r
+#if _FS_FAT32\r
+                                       ((DWORD)LD_WORD(dir+DIR_FstClusHI) << 16) |\r
+#endif\r
+                                       LD_WORD(dir+DIR_FstClusLO);\r
+                               } else {                                                /* The object is not a directory */\r
+                                       res = FR_NO_PATH;\r
+                               }\r
+                       }\r
+                       if (res == FR_OK) {\r
+                               res = dir_rewind(dj);                   /* Rewind dir */\r
+                       }\r
+               }\r
+               if (res == FR_NO_FILE) res = FR_NO_PATH;\r
+       }\r
+\r
+       return res;\r
+}\r
+\r
+\r
+\r
+\r
+/*-----------------------------------------------------------------------*/\r
+/* Read Directory Entry in Sequense                                      */\r
+/*-----------------------------------------------------------------------*/\r
+\r
+FRESULT pf_readdir (\r
+       DIR *dj,                        /* Pointer to the open directory object */\r
+       FILINFO *fno            /* Pointer to file information to return */\r
+)\r
+{\r
+       FRESULT res;\r
+       BYTE sp[12], dir[32];\r
+       FATFS *fs = FatFs;\r
+\r
+\r
+       if (!fs) {                              /* Check file system */\r
+               res = FR_NOT_ENABLED;\r
+       } else {\r
+               fs->buf = dir;\r
+               dj->fn = sp;\r
+               if (!fno) {\r
+                       res = dir_rewind(dj);\r
+               } else {\r
+                       res = dir_read(dj);\r
+                       if (res == FR_NO_FILE) {\r
+                               dj->sect = 0;\r
+                               res = FR_OK;\r
+                       }\r
+                       if (res == FR_OK) {                             /* A valid entry is found */\r
+                               get_fileinfo(dj, fno);          /* Get the object information */\r
+                               res = dir_next(dj);                     /* Increment index for next */\r
+                               if (res == FR_NO_FILE) {\r
+                                       dj->sect = 0;\r
+                                       res = FR_OK;\r
+                               }\r
+                       }\r
+               }\r
+       }\r
+\r
+       return res;\r
+}\r
+\r
+#endif /* _FS_DIR */\r
+\r