| /*----------------------------------------------------------------------------/ |
| / FatFs - Generic FAT Filesystem Module R0.15 w/patch1 / |
| /-----------------------------------------------------------------------------/ |
| / |
| / Copyright (C) 2022, ChaN, all right reserved. |
| / |
| / FatFs module is an open source software. Redistribution and use of FatFs in |
| / source and binary forms, with or without modification, are permitted provided |
| / that the following condition is met: |
| / |
| / 1. Redistributions of source code must retain the above copyright notice, |
| / this condition and the following disclaimer. |
| / |
| / This software is provided by the copyright holder and contributors "AS IS" |
| / and any warranties related to this software are DISCLAIMED. |
| / The copyright owner or contributors be NOT LIABLE for any damages caused |
| / by use of this software. |
| / |
| /----------------------------------------------------------------------------*/ |
| |
| |
| #include <string.h> |
| #include "ff.h" /* Declarations of FatFs API */ |
| #include "diskio.h" /* Declarations of device I/O functions */ |
| |
| |
| /*-------------------------------------------------------------------------- |
| |
| Module Private Definitions |
| |
| ---------------------------------------------------------------------------*/ |
| |
| #if FF_DEFINED != 80286 /* Revision ID */ |
| #error Wrong include file (ff.h). |
| #endif |
| |
| |
| /* Limits and boundaries */ |
| #define MAX_DIR 0x200000 /* Max size of FAT directory */ |
| #define MAX_DIR_EX 0x10000000 /* Max size of exFAT directory */ |
| #define MAX_FAT12 0xFF5 /* Max FAT12 clusters (differs from specs, but right for real DOS/Windows behavior) */ |
| #define MAX_FAT16 0xFFF5 /* Max FAT16 clusters (differs from specs, but right for real DOS/Windows behavior) */ |
| #define MAX_FAT32 0x0FFFFFF5 /* Max FAT32 clusters (not specified, practical limit) */ |
| #define MAX_EXFAT 0x7FFFFFFD /* Max exFAT clusters (differs from specs, implementation limit) */ |
| |
| |
| /* Character code support macros */ |
| #define IsUpper(c) ((c) >= 'A' && (c) <= 'Z') |
| #define IsLower(c) ((c) >= 'a' && (c) <= 'z') |
| #define IsDigit(c) ((c) >= '0' && (c) <= '9') |
| #define IsSeparator(c) ((c) == '/' || (c) == '\\') |
| #define IsTerminator(c) ((UINT)(c) < (FF_USE_LFN ? ' ' : '!')) |
| #define IsSurrogate(c) ((c) >= 0xD800 && (c) <= 0xDFFF) |
| #define IsSurrogateH(c) ((c) >= 0xD800 && (c) <= 0xDBFF) |
| #define IsSurrogateL(c) ((c) >= 0xDC00 && (c) <= 0xDFFF) |
| |
| |
| /* Additional file access control and file status flags for internal use */ |
| #define FA_SEEKEND 0x20 /* Seek to end of the file on file open */ |
| #define FA_MODIFIED 0x40 /* File has been modified */ |
| #define FA_DIRTY 0x80 /* FIL.buf[] needs to be written-back */ |
| |
| |
| /* Additional file attribute bits for internal use */ |
| #define AM_VOL 0x08 /* Volume label */ |
| #define AM_LFN 0x0F /* LFN entry */ |
| #define AM_MASK 0x3F /* Mask of defined bits in FAT */ |
| #define AM_MASKX 0x37 /* Mask of defined bits in exFAT */ |
| |
| |
| /* Name status flags in fn[11] */ |
| #define NSFLAG 11 /* Index of the name status byte */ |
| #define NS_LOSS 0x01 /* Out of 8.3 format */ |
| #define NS_LFN 0x02 /* Force to create LFN entry */ |
| #define NS_LAST 0x04 /* Last segment */ |
| #define NS_BODY 0x08 /* Lower case flag (body) */ |
| #define NS_EXT 0x10 /* Lower case flag (ext) */ |
| #define NS_DOT 0x20 /* Dot entry */ |
| #define NS_NOLFN 0x40 /* Do not find LFN */ |
| #define NS_NONAME 0x80 /* Not followed */ |
| |
| |
| /* exFAT directory entry types */ |
| #define ET_BITMAP 0x81 /* Allocation bitmap */ |
| #define ET_UPCASE 0x82 /* Up-case table */ |
| #define ET_VLABEL 0x83 /* Volume label */ |
| #define ET_FILEDIR 0x85 /* File and directory */ |
| #define ET_STREAM 0xC0 /* Stream extension */ |
| #define ET_FILENAME 0xC1 /* Name extension */ |
| |
| |
| /* FatFs refers the FAT structure as simple byte array instead of structure member |
| / because the C structure is not binary compatible between different platforms */ |
| |
| #define BS_JmpBoot 0 /* x86 jump instruction (3-byte) */ |
| #define BS_OEMName 3 /* OEM name (8-byte) */ |
| #define BPB_BytsPerSec 11 /* Sector size [byte] (WORD) */ |
| #define BPB_SecPerClus 13 /* Cluster size [sector] (BYTE) */ |
| #define BPB_RsvdSecCnt 14 /* Size of reserved area [sector] (WORD) */ |
| #define BPB_NumFATs 16 /* Number of FATs (BYTE) */ |
| #define BPB_RootEntCnt 17 /* Size of root directory area for FAT [entry] (WORD) */ |
| #define BPB_TotSec16 19 /* Volume size (16-bit) [sector] (WORD) */ |
| #define BPB_Media 21 /* Media descriptor byte (BYTE) */ |
| #define BPB_FATSz16 22 /* FAT size (16-bit) [sector] (WORD) */ |
| #define BPB_SecPerTrk 24 /* Number of sectors per track for int13h [sector] (WORD) */ |
| #define BPB_NumHeads 26 /* Number of heads for int13h (WORD) */ |
| #define BPB_HiddSec 28 /* Volume offset from top of the drive (DWORD) */ |
| #define BPB_TotSec32 32 /* Volume size (32-bit) [sector] (DWORD) */ |
| #define BS_DrvNum 36 /* Physical drive number for int13h (BYTE) */ |
| #define BS_NTres 37 /* WindowsNT error flag (BYTE) */ |
| #define BS_BootSig 38 /* Extended boot signature (BYTE) */ |
| #define BS_VolID 39 /* Volume serial number (DWORD) */ |
| #define BS_VolLab 43 /* Volume label string (8-byte) */ |
| #define BS_FilSysType 54 /* Filesystem type string (8-byte) */ |
| #define BS_BootCode 62 /* Boot code (448-byte) */ |
| #define BS_55AA 510 /* Signature word (WORD) */ |
| |
| #define BPB_FATSz32 36 /* FAT32: FAT size [sector] (DWORD) */ |
| #define BPB_ExtFlags32 40 /* FAT32: Extended flags (WORD) */ |
| #define BPB_FSVer32 42 /* FAT32: Filesystem version (WORD) */ |
| #define BPB_RootClus32 44 /* FAT32: Root directory cluster (DWORD) */ |
| #define BPB_FSInfo32 48 /* FAT32: Offset of FSINFO sector (WORD) */ |
| #define BPB_BkBootSec32 50 /* FAT32: Offset of backup boot sector (WORD) */ |
| #define BS_DrvNum32 64 /* FAT32: Physical drive number for int13h (BYTE) */ |
| #define BS_NTres32 65 /* FAT32: Error flag (BYTE) */ |
| #define BS_BootSig32 66 /* FAT32: Extended boot signature (BYTE) */ |
| #define BS_VolID32 67 /* FAT32: Volume serial number (DWORD) */ |
| #define BS_VolLab32 71 /* FAT32: Volume label string (8-byte) */ |
| #define BS_FilSysType32 82 /* FAT32: Filesystem type string (8-byte) */ |
| #define BS_BootCode32 90 /* FAT32: Boot code (420-byte) */ |
| |
| #define BPB_ZeroedEx 11 /* exFAT: MBZ field (53-byte) */ |
| #define BPB_VolOfsEx 64 /* exFAT: Volume offset from top of the drive [sector] (QWORD) */ |
| #define BPB_TotSecEx 72 /* exFAT: Volume size [sector] (QWORD) */ |
| #define BPB_FatOfsEx 80 /* exFAT: FAT offset from top of the volume [sector] (DWORD) */ |
| #define BPB_FatSzEx 84 /* exFAT: FAT size [sector] (DWORD) */ |
| #define BPB_DataOfsEx 88 /* exFAT: Data offset from top of the volume [sector] (DWORD) */ |
| #define BPB_NumClusEx 92 /* exFAT: Number of clusters (DWORD) */ |
| #define BPB_RootClusEx 96 /* exFAT: Root directory start cluster (DWORD) */ |
| #define BPB_VolIDEx 100 /* exFAT: Volume serial number (DWORD) */ |
| #define BPB_FSVerEx 104 /* exFAT: Filesystem version (WORD) */ |
| #define BPB_VolFlagEx 106 /* exFAT: Volume flags (WORD) */ |
| #define BPB_BytsPerSecEx 108 /* exFAT: Log2 of sector size in unit of byte (BYTE) */ |
| #define BPB_SecPerClusEx 109 /* exFAT: Log2 of cluster size in unit of sector (BYTE) */ |
| #define BPB_NumFATsEx 110 /* exFAT: Number of FATs (BYTE) */ |
| #define BPB_DrvNumEx 111 /* exFAT: Physical drive number for int13h (BYTE) */ |
| #define BPB_PercInUseEx 112 /* exFAT: Percent in use (BYTE) */ |
| #define BPB_RsvdEx 113 /* exFAT: Reserved (7-byte) */ |
| #define BS_BootCodeEx 120 /* exFAT: Boot code (390-byte) */ |
| |
| #define DIR_Name 0 /* Short file name (11-byte) */ |
| #define DIR_Attr 11 /* Attribute (BYTE) */ |
| #define DIR_NTres 12 /* Lower case flag (BYTE) */ |
| #define DIR_CrtTime10 13 /* Created time sub-second (BYTE) */ |
| #define DIR_CrtTime 14 /* Created time (DWORD) */ |
| #define DIR_LstAccDate 18 /* Last accessed date (WORD) */ |
| #define DIR_FstClusHI 20 /* Higher 16-bit of first cluster (WORD) */ |
| #define DIR_ModTime 22 /* Modified time (DWORD) */ |
| #define DIR_FstClusLO 26 /* Lower 16-bit of first cluster (WORD) */ |
| #define DIR_FileSize 28 /* File size (DWORD) */ |
| #define LDIR_Ord 0 /* LFN: LFN order and LLE flag (BYTE) */ |
| #define LDIR_Attr 11 /* LFN: LFN attribute (BYTE) */ |
| #define LDIR_Type 12 /* LFN: Entry type (BYTE) */ |
| #define LDIR_Chksum 13 /* LFN: Checksum of the SFN (BYTE) */ |
| #define LDIR_FstClusLO 26 /* LFN: MBZ field (WORD) */ |
| #define XDIR_Type 0 /* exFAT: Type of exFAT directory entry (BYTE) */ |
| #define XDIR_NumLabel 1 /* exFAT: Number of volume label characters (BYTE) */ |
| #define XDIR_Label 2 /* exFAT: Volume label (11-WORD) */ |
| #define XDIR_CaseSum 4 /* exFAT: Sum of case conversion table (DWORD) */ |
| #define XDIR_NumSec 1 /* exFAT: Number of secondary entries (BYTE) */ |
| #define XDIR_SetSum 2 /* exFAT: Sum of the set of directory entries (WORD) */ |
| #define XDIR_Attr 4 /* exFAT: File attribute (WORD) */ |
| #define XDIR_CrtTime 8 /* exFAT: Created time (DWORD) */ |
| #define XDIR_ModTime 12 /* exFAT: Modified time (DWORD) */ |
| #define XDIR_AccTime 16 /* exFAT: Last accessed time (DWORD) */ |
| #define XDIR_CrtTime10 20 /* exFAT: Created time subsecond (BYTE) */ |
| #define XDIR_ModTime10 21 /* exFAT: Modified time subsecond (BYTE) */ |
| #define XDIR_CrtTZ 22 /* exFAT: Created timezone (BYTE) */ |
| #define XDIR_ModTZ 23 /* exFAT: Modified timezone (BYTE) */ |
| #define XDIR_AccTZ 24 /* exFAT: Last accessed timezone (BYTE) */ |
| #define XDIR_GenFlags 33 /* exFAT: General secondary flags (BYTE) */ |
| #define XDIR_NumName 35 /* exFAT: Number of file name characters (BYTE) */ |
| #define XDIR_NameHash 36 /* exFAT: Hash of file name (WORD) */ |
| #define XDIR_ValidFileSize 40 /* exFAT: Valid file size (QWORD) */ |
| #define XDIR_FstClus 52 /* exFAT: First cluster of the file data (DWORD) */ |
| #define XDIR_FileSize 56 /* exFAT: File/Directory size (QWORD) */ |
| |
| #define SZDIRE 32 /* Size of a directory entry */ |
| #define DDEM 0xE5 /* Deleted directory entry mark set to DIR_Name[0] */ |
| #define RDDEM 0x05 /* Replacement of the character collides with DDEM */ |
| #define LLEF 0x40 /* Last long entry flag in LDIR_Ord */ |
| |
| #define FSI_LeadSig 0 /* FAT32 FSI: Leading signature (DWORD) */ |
| #define FSI_StrucSig 484 /* FAT32 FSI: Structure signature (DWORD) */ |
| #define FSI_Free_Count 488 /* FAT32 FSI: Number of free clusters (DWORD) */ |
| #define FSI_Nxt_Free 492 /* FAT32 FSI: Last allocated cluster (DWORD) */ |
| |
| #define MBR_Table 446 /* MBR: Offset of partition table in the MBR */ |
| #define SZ_PTE 16 /* MBR: Size of a partition table entry */ |
| #define PTE_Boot 0 /* MBR PTE: Boot indicator */ |
| #define PTE_StHead 1 /* MBR PTE: Start head */ |
| #define PTE_StSec 2 /* MBR PTE: Start sector */ |
| #define PTE_StCyl 3 /* MBR PTE: Start cylinder */ |
| #define PTE_System 4 /* MBR PTE: System ID */ |
| #define PTE_EdHead 5 /* MBR PTE: End head */ |
| #define PTE_EdSec 6 /* MBR PTE: End sector */ |
| #define PTE_EdCyl 7 /* MBR PTE: End cylinder */ |
| #define PTE_StLba 8 /* MBR PTE: Start in LBA */ |
| #define PTE_SizLba 12 /* MBR PTE: Size in LBA */ |
| |
| #define GPTH_Sign 0 /* GPT HDR: Signature (8-byte) */ |
| #define GPTH_Rev 8 /* GPT HDR: Revision (DWORD) */ |
| #define GPTH_Size 12 /* GPT HDR: Header size (DWORD) */ |
| #define GPTH_Bcc 16 /* GPT HDR: Header BCC (DWORD) */ |
| #define GPTH_CurLba 24 /* GPT HDR: This header LBA (QWORD) */ |
| #define GPTH_BakLba 32 /* GPT HDR: Another header LBA (QWORD) */ |
| #define GPTH_FstLba 40 /* GPT HDR: First LBA for partition data (QWORD) */ |
| #define GPTH_LstLba 48 /* GPT HDR: Last LBA for partition data (QWORD) */ |
| #define GPTH_DskGuid 56 /* GPT HDR: Disk GUID (16-byte) */ |
| #define GPTH_PtOfs 72 /* GPT HDR: Partition table LBA (QWORD) */ |
| #define GPTH_PtNum 80 /* GPT HDR: Number of table entries (DWORD) */ |
| #define GPTH_PteSize 84 /* GPT HDR: Size of table entry (DWORD) */ |
| #define GPTH_PtBcc 88 /* GPT HDR: Partition table BCC (DWORD) */ |
| #define SZ_GPTE 128 /* GPT PTE: Size of partition table entry */ |
| #define GPTE_PtGuid 0 /* GPT PTE: Partition type GUID (16-byte) */ |
| #define GPTE_UpGuid 16 /* GPT PTE: Partition unique GUID (16-byte) */ |
| #define GPTE_FstLba 32 /* GPT PTE: First LBA of partition (QWORD) */ |
| #define GPTE_LstLba 40 /* GPT PTE: Last LBA of partition (QWORD) */ |
| #define GPTE_Flags 48 /* GPT PTE: Partition flags (QWORD) */ |
| #define GPTE_Name 56 /* GPT PTE: Partition name */ |
| |
| |
| /* Post process on fatal error in the file operations */ |
| #define ABORT(fs, res) { fp->err = (BYTE)(res); LEAVE_FF(fs, res); } |
| |
| |
| /* Re-entrancy related */ |
| #if FF_FS_REENTRANT |
| #if FF_USE_LFN == 1 |
| #error Static LFN work area cannot be used in thread-safe configuration |
| #endif |
| #define LEAVE_FF(fs, res) { unlock_volume(fs, res); return res; } |
| #else |
| #define LEAVE_FF(fs, res) return res |
| #endif |
| |
| |
| /* Definitions of logical drive - physical location conversion */ |
| #if FF_MULTI_PARTITION |
| #define LD2PD(vol) VolToPart[vol].pd /* Get physical drive number */ |
| #define LD2PT(vol) VolToPart[vol].pt /* Get partition number (0:auto search, 1..:forced partition number) */ |
| #else |
| #define LD2PD(vol) (BYTE)(vol) /* Each logical drive is associated with the same physical drive number */ |
| #define LD2PT(vol) 0 /* Auto partition search */ |
| #endif |
| |
| |
| /* Definitions of sector size */ |
| #if (FF_MAX_SS < FF_MIN_SS) || (FF_MAX_SS != 512 && FF_MAX_SS != 1024 && FF_MAX_SS != 2048 && FF_MAX_SS != 4096) || (FF_MIN_SS != 512 && FF_MIN_SS != 1024 && FF_MIN_SS != 2048 && FF_MIN_SS != 4096) |
| #error Wrong sector size configuration |
| #endif |
| #if FF_MAX_SS == FF_MIN_SS |
| #define SS(fs) ((UINT)FF_MAX_SS) /* Fixed sector size */ |
| #else |
| #define SS(fs) ((fs)->ssize) /* Variable sector size */ |
| #endif |
| |
| |
| /* Timestamp */ |
| #if FF_FS_NORTC == 1 |
| #if FF_NORTC_YEAR < 1980 || FF_NORTC_YEAR > 2107 || FF_NORTC_MON < 1 || FF_NORTC_MON > 12 || FF_NORTC_MDAY < 1 || FF_NORTC_MDAY > 31 |
| #error Invalid FF_FS_NORTC settings |
| #endif |
| #define GET_FATTIME() ((DWORD)(FF_NORTC_YEAR - 1980) << 25 | (DWORD)FF_NORTC_MON << 21 | (DWORD)FF_NORTC_MDAY << 16) |
| #else |
| #define GET_FATTIME() get_fattime() |
| #endif |
| |
| |
| /* File lock controls */ |
| #if FF_FS_LOCK |
| #if FF_FS_READONLY |
| #error FF_FS_LOCK must be 0 at read-only configuration |
| #endif |
| typedef struct { |
| FATFS* fs; /* Object ID 1, volume (NULL:blank entry) */ |
| DWORD clu; /* Object ID 2, containing directory (0:root) */ |
| DWORD ofs; /* Object ID 3, offset in the directory */ |
| UINT ctr; /* Object open counter, 0:none, 0x01..0xFF:read mode open count, 0x100:write mode */ |
| } FILESEM; |
| #endif |
| |
| |
| /* SBCS up-case tables (\x80-\xFF) */ |
| #define TBL_CT437 {0x80,0x9A,0x45,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x49,0x49,0x49,0x8E,0x8F, \ |
| 0x90,0x92,0x92,0x4F,0x99,0x4F,0x55,0x55,0x59,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT720 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \ |
| 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0xA0,0xA1,0xA2,0xA3,0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT737 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \ |
| 0x90,0x92,0x92,0x93,0x94,0x95,0x96,0x97,0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87, \ |
| 0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F,0x90,0x91,0xAA,0x92,0x93,0x94,0x95,0x96, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0x97,0xEA,0xEB,0xEC,0xE4,0xED,0xEE,0xEF,0xF5,0xF0,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT771 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \ |
| 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDC,0xDE,0xDE, \ |
| 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0xF0,0xF0,0xF2,0xF2,0xF4,0xF4,0xF6,0xF6,0xF8,0xF8,0xFA,0xFA,0xFC,0xFC,0xFE,0xFF} |
| #define TBL_CT775 {0x80,0x9A,0x91,0xA0,0x8E,0x95,0x8F,0x80,0xAD,0xED,0x8A,0x8A,0xA1,0x8D,0x8E,0x8F, \ |
| 0x90,0x92,0x92,0xE2,0x99,0x95,0x96,0x97,0x97,0x99,0x9A,0x9D,0x9C,0x9D,0x9E,0x9F, \ |
| 0xA0,0xA1,0xE0,0xA3,0xA3,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xB5,0xB6,0xB7,0xB8,0xBD,0xBE,0xC6,0xC7,0xA5,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE5,0xE5,0xE6,0xE3,0xE8,0xE8,0xEA,0xEA,0xEE,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT850 {0x43,0x55,0x45,0x41,0x41,0x41,0x41,0x43,0x45,0x45,0x45,0x49,0x49,0x49,0x41,0x41, \ |
| 0x45,0x92,0x92,0x4F,0x4F,0x4F,0x55,0x55,0x59,0x4F,0x55,0x4F,0x9C,0x4F,0x9E,0x9F, \ |
| 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0x41,0x41,0x41,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0x41,0x41,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD1,0xD1,0x45,0x45,0x45,0x49,0x49,0x49,0x49,0xD9,0xDA,0xDB,0xDC,0xDD,0x49,0xDF, \ |
| 0x4F,0xE1,0x4F,0x4F,0x4F,0x4F,0xE6,0xE8,0xE8,0x55,0x55,0x55,0x59,0x59,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT852 {0x80,0x9A,0x90,0xB6,0x8E,0xDE,0x8F,0x80,0x9D,0xD3,0x8A,0x8A,0xD7,0x8D,0x8E,0x8F, \ |
| 0x90,0x91,0x91,0xE2,0x99,0x95,0x95,0x97,0x97,0x99,0x9A,0x9B,0x9B,0x9D,0x9E,0xAC, \ |
| 0xB5,0xD6,0xE0,0xE9,0xA4,0xA4,0xA6,0xA6,0xA8,0xA8,0xAA,0x8D,0xAC,0xB8,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBD,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC6,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD1,0xD1,0xD2,0xD3,0xD2,0xD5,0xD6,0xD7,0xB7,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE3,0xD5,0xE6,0xE6,0xE8,0xE9,0xE8,0xEB,0xED,0xED,0xDD,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xEB,0xFC,0xFC,0xFE,0xFF} |
| #define TBL_CT855 {0x81,0x81,0x83,0x83,0x85,0x85,0x87,0x87,0x89,0x89,0x8B,0x8B,0x8D,0x8D,0x8F,0x8F, \ |
| 0x91,0x91,0x93,0x93,0x95,0x95,0x97,0x97,0x99,0x99,0x9B,0x9B,0x9D,0x9D,0x9F,0x9F, \ |
| 0xA1,0xA1,0xA3,0xA3,0xA5,0xA5,0xA7,0xA7,0xA9,0xA9,0xAB,0xAB,0xAD,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB6,0xB6,0xB8,0xB8,0xB9,0xBA,0xBB,0xBC,0xBE,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC7,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD1,0xD1,0xD3,0xD3,0xD5,0xD5,0xD7,0xD7,0xDD,0xD9,0xDA,0xDB,0xDC,0xDD,0xE0,0xDF, \ |
| 0xE0,0xE2,0xE2,0xE4,0xE4,0xE6,0xE6,0xE8,0xE8,0xEA,0xEA,0xEC,0xEC,0xEE,0xEE,0xEF, \ |
| 0xF0,0xF2,0xF2,0xF4,0xF4,0xF6,0xF6,0xF8,0xF8,0xFA,0xFA,0xFC,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT857 {0x80,0x9A,0x90,0xB6,0x8E,0xB7,0x8F,0x80,0xD2,0xD3,0xD4,0xD8,0xD7,0x49,0x8E,0x8F, \ |
| 0x90,0x92,0x92,0xE2,0x99,0xE3,0xEA,0xEB,0x98,0x99,0x9A,0x9D,0x9C,0x9D,0x9E,0x9E, \ |
| 0xB5,0xD6,0xE0,0xE9,0xA5,0xA5,0xA6,0xA6,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC7,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0x49,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE5,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xDE,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT860 {0x80,0x9A,0x90,0x8F,0x8E,0x91,0x86,0x80,0x89,0x89,0x92,0x8B,0x8C,0x98,0x8E,0x8F, \ |
| 0x90,0x91,0x92,0x8C,0x99,0xA9,0x96,0x9D,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0x86,0x8B,0x9F,0x96,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT861 {0x80,0x9A,0x90,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x8B,0x8B,0x8D,0x8E,0x8F, \ |
| 0x90,0x92,0x92,0x4F,0x99,0x8D,0x55,0x97,0x97,0x99,0x9A,0x9D,0x9C,0x9D,0x9E,0x9F, \ |
| 0xA4,0xA5,0xA6,0xA7,0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT862 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \ |
| 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT863 {0x43,0x55,0x45,0x41,0x41,0x41,0x86,0x43,0x45,0x45,0x45,0x49,0x49,0x8D,0x41,0x8F, \ |
| 0x45,0x45,0x45,0x4F,0x45,0x49,0x55,0x55,0x98,0x4F,0x55,0x9B,0x9C,0x55,0x55,0x9F, \ |
| 0xA0,0xA1,0x4F,0x55,0xA4,0xA5,0xA6,0xA7,0x49,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT864 {0x80,0x9A,0x45,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x49,0x49,0x49,0x8E,0x8F, \ |
| 0x90,0x92,0x92,0x4F,0x99,0x4F,0x55,0x55,0x59,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT865 {0x80,0x9A,0x90,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x49,0x49,0x49,0x8E,0x8F, \ |
| 0x90,0x92,0x92,0x4F,0x99,0x4F,0x55,0x55,0x59,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \ |
| 0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT866 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \ |
| 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \ |
| 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \ |
| 0xF0,0xF0,0xF2,0xF2,0xF4,0xF4,0xF6,0xF6,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF} |
| #define TBL_CT869 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \ |
| 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x86,0x9C,0x8D,0x8F,0x90, \ |
| 0x91,0x90,0x92,0x95,0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \ |
| 0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \ |
| 0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \ |
| 0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xA4,0xA5,0xA6,0xD9,0xDA,0xDB,0xDC,0xA7,0xA8,0xDF, \ |
| 0xA9,0xAA,0xAC,0xAD,0xB5,0xB6,0xB7,0xB8,0xBD,0xBE,0xC6,0xC7,0xCF,0xCF,0xD0,0xEF, \ |
| 0xF0,0xF1,0xD1,0xD2,0xD3,0xF5,0xD4,0xF7,0xF8,0xF9,0xD5,0x96,0x95,0x98,0xFE,0xFF} |
| |
| |
| /* DBCS code range |----- 1st byte -----| |----------- 2nd byte -----------| */ |
| /* <------> <------> <------> <------> <------> */ |
| #define TBL_DC932 {0x81, 0x9F, 0xE0, 0xFC, 0x40, 0x7E, 0x80, 0xFC, 0x00, 0x00} |
| #define TBL_DC936 {0x81, 0xFE, 0x00, 0x00, 0x40, 0x7E, 0x80, 0xFE, 0x00, 0x00} |
| #define TBL_DC949 {0x81, 0xFE, 0x00, 0x00, 0x41, 0x5A, 0x61, 0x7A, 0x81, 0xFE} |
| #define TBL_DC950 {0x81, 0xFE, 0x00, 0x00, 0x40, 0x7E, 0xA1, 0xFE, 0x00, 0x00} |
| |
| |
| /* Macros for table definitions */ |
| #define MERGE_2STR(a, b) a ## b |
| #define MKCVTBL(hd, cp) MERGE_2STR(hd, cp) |
| |
| |
| |
| |
| /*-------------------------------------------------------------------------- |
| |
| Module Private Work Area |
| |
| ---------------------------------------------------------------------------*/ |
| /* Remark: Variables defined here without initial value shall be guaranteed |
| / zero/null at start-up. If not, the linker option or start-up routine is |
| / not compliance with C standard. */ |
| |
| /*--------------------------------*/ |
| /* File/Volume controls */ |
| /*--------------------------------*/ |
| |
| #if FF_VOLUMES < 1 || FF_VOLUMES > 10 |
| #error Wrong FF_VOLUMES setting |
| #endif |
| static FATFS *FatFs[FF_VOLUMES]; /* Pointer to the filesystem objects (logical drives) */ |
| static WORD Fsid; /* Filesystem mount ID */ |
| |
| #if FF_FS_RPATH != 0 |
| static BYTE CurrVol; /* Current drive set by f_chdrive() */ |
| #endif |
| |
| #if FF_FS_LOCK != 0 |
| static FILESEM Files[FF_FS_LOCK]; /* Open object lock semaphores */ |
| #if FF_FS_REENTRANT |
| static BYTE SysLock; /* System lock flag (0:no mutex, 1:unlocked, 2:locked) */ |
| #endif |
| #endif |
| |
| #if FF_STR_VOLUME_ID |
| #ifdef FF_VOLUME_STRS |
| static const char *const VolumeStr[FF_VOLUMES] = {FF_VOLUME_STRS}; /* Pre-defined volume ID */ |
| #endif |
| #endif |
| |
| #if FF_LBA64 |
| #if FF_MIN_GPT > 0x100000000 |
| #error Wrong FF_MIN_GPT setting |
| #endif |
| static const BYTE GUID_MS_Basic[16] = {0xA2,0xA0,0xD0,0xEB,0xE5,0xB9,0x33,0x44,0x87,0xC0,0x68,0xB6,0xB7,0x26,0x99,0xC7}; |
| #endif |
| |
| |
| |
| /*--------------------------------*/ |
| /* LFN/Directory working buffer */ |
| /*--------------------------------*/ |
| |
| #if FF_USE_LFN == 0 /* Non-LFN configuration */ |
| #if FF_FS_EXFAT |
| #error LFN must be enabled when enable exFAT |
| #endif |
| #define DEF_NAMBUF |
| #define INIT_NAMBUF(fs) |
| #define FREE_NAMBUF() |
| #define LEAVE_MKFS(res) return res |
| |
| #else /* LFN configurations */ |
| #if FF_MAX_LFN < 12 || FF_MAX_LFN > 255 |
| #error Wrong setting of FF_MAX_LFN |
| #endif |
| #if FF_LFN_BUF < FF_SFN_BUF || FF_SFN_BUF < 12 |
| #error Wrong setting of FF_LFN_BUF or FF_SFN_BUF |
| #endif |
| #if FF_LFN_UNICODE < 0 || FF_LFN_UNICODE > 3 |
| #error Wrong setting of FF_LFN_UNICODE |
| #endif |
| static const BYTE LfnOfs[] = {1,3,5,7,9,14,16,18,20,22,24,28,30}; /* FAT: Offset of LFN characters in the directory entry */ |
| #define MAXDIRB(nc) ((nc + 44U) / 15 * SZDIRE) /* exFAT: Size of directory entry block scratchpad buffer needed for the name length */ |
| |
| #if FF_USE_LFN == 1 /* LFN enabled with static working buffer */ |
| #if FF_FS_EXFAT |
| static BYTE DirBuf[MAXDIRB(FF_MAX_LFN)]; /* Directory entry block scratchpad buffer */ |
| #endif |
| static WCHAR LfnBuf[FF_MAX_LFN + 1]; /* LFN working buffer */ |
| #define DEF_NAMBUF |
| #define INIT_NAMBUF(fs) |
| #define FREE_NAMBUF() |
| #define LEAVE_MKFS(res) return res |
| |
| #elif FF_USE_LFN == 2 /* LFN enabled with dynamic working buffer on the stack */ |
| #if FF_FS_EXFAT |
| #define DEF_NAMBUF WCHAR lbuf[FF_MAX_LFN+1]; BYTE dbuf[MAXDIRB(FF_MAX_LFN)]; /* LFN working buffer and directory entry block scratchpad buffer */ |
| #define INIT_NAMBUF(fs) { (fs)->lfnbuf = lbuf; (fs)->dirbuf = dbuf; } |
| #define FREE_NAMBUF() |
| #else |
| #define DEF_NAMBUF WCHAR lbuf[FF_MAX_LFN+1]; /* LFN working buffer */ |
| #define INIT_NAMBUF(fs) { (fs)->lfnbuf = lbuf; } |
| #define FREE_NAMBUF() |
| #endif |
| #define LEAVE_MKFS(res) return res |
| |
| #elif FF_USE_LFN == 3 /* LFN enabled with dynamic working buffer on the heap */ |
| #if FF_FS_EXFAT |
| #define DEF_NAMBUF WCHAR *lfn; /* Pointer to LFN working buffer and directory entry block scratchpad buffer */ |
| #define INIT_NAMBUF(fs) { lfn = ff_memalloc((FF_MAX_LFN+1)*2 + MAXDIRB(FF_MAX_LFN)); if (!lfn) LEAVE_FF(fs, FR_NOT_ENOUGH_CORE); (fs)->lfnbuf = lfn; (fs)->dirbuf = (BYTE*)(lfn+FF_MAX_LFN+1); } |
| #define FREE_NAMBUF() ff_memfree(lfn) |
| #else |
| #define DEF_NAMBUF WCHAR *lfn; /* Pointer to LFN working buffer */ |
| #define INIT_NAMBUF(fs) { lfn = ff_memalloc((FF_MAX_LFN+1)*2); if (!lfn) LEAVE_FF(fs, FR_NOT_ENOUGH_CORE); (fs)->lfnbuf = lfn; } |
| #define FREE_NAMBUF() ff_memfree(lfn) |
| #endif |
| #define LEAVE_MKFS(res) { if (!work) ff_memfree(buf); return res; } |
| #define MAX_MALLOC 0x8000 /* Must be >=FF_MAX_SS */ |
| |
| #else |
| #error Wrong setting of FF_USE_LFN |
| |
| #endif /* FF_USE_LFN == 1 */ |
| #endif /* FF_USE_LFN == 0 */ |
| |
| |
| |
| /*--------------------------------*/ |
| /* Code conversion tables */ |
| /*--------------------------------*/ |
| |
| #if FF_CODE_PAGE == 0 /* Run-time code page configuration */ |
| #define CODEPAGE CodePage |
| static WORD CodePage; /* Current code page */ |
| static const BYTE* ExCvt; /* Ptr to SBCS up-case table Ct???[] (null:not used) */ |
| static const BYTE* DbcTbl; /* Ptr to DBCS code range table Dc???[] (null:not used) */ |
| |
| static const BYTE Ct437[] = TBL_CT437; |
| static const BYTE Ct720[] = TBL_CT720; |
| static const BYTE Ct737[] = TBL_CT737; |
| static const BYTE Ct771[] = TBL_CT771; |
| static const BYTE Ct775[] = TBL_CT775; |
| static const BYTE Ct850[] = TBL_CT850; |
| static const BYTE Ct852[] = TBL_CT852; |
| static const BYTE Ct855[] = TBL_CT855; |
| static const BYTE Ct857[] = TBL_CT857; |
| static const BYTE Ct860[] = TBL_CT860; |
| static const BYTE Ct861[] = TBL_CT861; |
| static const BYTE Ct862[] = TBL_CT862; |
| static const BYTE Ct863[] = TBL_CT863; |
| static const BYTE Ct864[] = TBL_CT864; |
| static const BYTE Ct865[] = TBL_CT865; |
| static const BYTE Ct866[] = TBL_CT866; |
| static const BYTE Ct869[] = TBL_CT869; |
| static const BYTE Dc932[] = TBL_DC932; |
| static const BYTE Dc936[] = TBL_DC936; |
| static const BYTE Dc949[] = TBL_DC949; |
| static const BYTE Dc950[] = TBL_DC950; |
| |
| #elif FF_CODE_PAGE < 900 /* Static code page configuration (SBCS) */ |
| #define CODEPAGE FF_CODE_PAGE |
| static const BYTE ExCvt[] = MKCVTBL(TBL_CT, FF_CODE_PAGE); |
| |
| #else /* Static code page configuration (DBCS) */ |
| #define CODEPAGE FF_CODE_PAGE |
| static const BYTE DbcTbl[] = MKCVTBL(TBL_DC, FF_CODE_PAGE); |
| |
| #endif |
| |
| |
| |
| |
| /*-------------------------------------------------------------------------- |
| |
| Module Private Functions |
| |
| ---------------------------------------------------------------------------*/ |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Load/Store multi-byte word in the FAT structure */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static WORD ld_word (const BYTE* ptr) /* Load a 2-byte little-endian word */ |
| { |
| WORD rv; |
| |
| rv = ptr[1]; |
| rv = rv << 8 | ptr[0]; |
| return rv; |
| } |
| |
| static DWORD ld_dword (const BYTE* ptr) /* Load a 4-byte little-endian word */ |
| { |
| DWORD rv; |
| |
| rv = ptr[3]; |
| rv = rv << 8 | ptr[2]; |
| rv = rv << 8 | ptr[1]; |
| rv = rv << 8 | ptr[0]; |
| return rv; |
| } |
| |
| #if FF_FS_EXFAT |
| static QWORD ld_qword (const BYTE* ptr) /* Load an 8-byte little-endian word */ |
| { |
| QWORD rv; |
| |
| rv = ptr[7]; |
| rv = rv << 8 | ptr[6]; |
| rv = rv << 8 | ptr[5]; |
| rv = rv << 8 | ptr[4]; |
| rv = rv << 8 | ptr[3]; |
| rv = rv << 8 | ptr[2]; |
| rv = rv << 8 | ptr[1]; |
| rv = rv << 8 | ptr[0]; |
| return rv; |
| } |
| #endif |
| |
| #if !FF_FS_READONLY |
| static void st_word (BYTE* ptr, WORD val) /* Store a 2-byte word in little-endian */ |
| { |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; |
| } |
| |
| static void st_dword (BYTE* ptr, DWORD val) /* Store a 4-byte word in little-endian */ |
| { |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; |
| } |
| |
| #if FF_FS_EXFAT |
| static void st_qword (BYTE* ptr, QWORD val) /* Store an 8-byte word in little-endian */ |
| { |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; val >>= 8; |
| *ptr++ = (BYTE)val; |
| } |
| #endif |
| #endif /* !FF_FS_READONLY */ |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* String functions */ |
| /*-----------------------------------------------------------------------*/ |
| |
| /* Test if the byte is DBC 1st byte */ |
| static int dbc_1st (BYTE c) |
| { |
| #if FF_CODE_PAGE == 0 /* Variable code page */ |
| if (DbcTbl && c >= DbcTbl[0]) { |
| if (c <= DbcTbl[1]) return 1; /* 1st byte range 1 */ |
| if (c >= DbcTbl[2] && c <= DbcTbl[3]) return 1; /* 1st byte range 2 */ |
| } |
| #elif FF_CODE_PAGE >= 900 /* DBCS fixed code page */ |
| if (c >= DbcTbl[0]) { |
| if (c <= DbcTbl[1]) return 1; |
| if (c >= DbcTbl[2] && c <= DbcTbl[3]) return 1; |
| } |
| #else /* SBCS fixed code page */ |
| if (c != 0) return 0; /* Always false */ |
| #endif |
| return 0; |
| } |
| |
| |
| /* Test if the byte is DBC 2nd byte */ |
| static int dbc_2nd (BYTE c) |
| { |
| #if FF_CODE_PAGE == 0 /* Variable code page */ |
| if (DbcTbl && c >= DbcTbl[4]) { |
| if (c <= DbcTbl[5]) return 1; /* 2nd byte range 1 */ |
| if (c >= DbcTbl[6] && c <= DbcTbl[7]) return 1; /* 2nd byte range 2 */ |
| if (c >= DbcTbl[8] && c <= DbcTbl[9]) return 1; /* 2nd byte range 3 */ |
| } |
| #elif FF_CODE_PAGE >= 900 /* DBCS fixed code page */ |
| if (c >= DbcTbl[4]) { |
| if (c <= DbcTbl[5]) return 1; |
| if (c >= DbcTbl[6] && c <= DbcTbl[7]) return 1; |
| if (c >= DbcTbl[8] && c <= DbcTbl[9]) return 1; |
| } |
| #else /* SBCS fixed code page */ |
| if (c != 0) return 0; /* Always false */ |
| #endif |
| return 0; |
| } |
| |
| |
| #if FF_USE_LFN |
| |
| /* Get a Unicode code point from the TCHAR string in defined API encodeing */ |
| static DWORD tchar2uni ( /* Returns a character in UTF-16 encoding (>=0x10000 on surrogate pair, 0xFFFFFFFF on decode error) */ |
| const TCHAR** str /* Pointer to pointer to TCHAR string in configured encoding */ |
| ) |
| { |
| DWORD uc; |
| const TCHAR *p = *str; |
| |
| #if FF_LFN_UNICODE == 1 /* UTF-16 input */ |
| WCHAR wc; |
| |
| uc = *p++; /* Get a unit */ |
| if (IsSurrogate(uc)) { /* Surrogate? */ |
| wc = *p++; /* Get low surrogate */ |
| if (!IsSurrogateH(uc) || !IsSurrogateL(wc)) return 0xFFFFFFFF; /* Wrong surrogate? */ |
| uc = uc << 16 | wc; |
| } |
| |
| #elif FF_LFN_UNICODE == 2 /* UTF-8 input */ |
| BYTE b; |
| int nf; |
| |
| uc = (BYTE)*p++; /* Get an encoding unit */ |
| if (uc & 0x80) { /* Multiple byte code? */ |
| if ((uc & 0xE0) == 0xC0) { /* 2-byte sequence? */ |
| uc &= 0x1F; nf = 1; |
| } else if ((uc & 0xF0) == 0xE0) { /* 3-byte sequence? */ |
| uc &= 0x0F; nf = 2; |
| } else if ((uc & 0xF8) == 0xF0) { /* 4-byte sequence? */ |
| uc &= 0x07; nf = 3; |
| } else { /* Wrong sequence */ |
| return 0xFFFFFFFF; |
| } |
| do { /* Get trailing bytes */ |
| b = (BYTE)*p++; |
| if ((b & 0xC0) != 0x80) return 0xFFFFFFFF; /* Wrong sequence? */ |
| uc = uc << 6 | (b & 0x3F); |
| } while (--nf != 0); |
| if (uc < 0x80 || IsSurrogate(uc) || uc >= 0x110000) return 0xFFFFFFFF; /* Wrong code? */ |
| if (uc >= 0x010000) uc = 0xD800DC00 | ((uc - 0x10000) << 6 & 0x3FF0000) | (uc & 0x3FF); /* Make a surrogate pair if needed */ |
| } |
| |
| #elif FF_LFN_UNICODE == 3 /* UTF-32 input */ |
| uc = (TCHAR)*p++; /* Get a unit */ |
| if (uc >= 0x110000 || IsSurrogate(uc)) return 0xFFFFFFFF; /* Wrong code? */ |
| if (uc >= 0x010000) uc = 0xD800DC00 | ((uc - 0x10000) << 6 & 0x3FF0000) | (uc & 0x3FF); /* Make a surrogate pair if needed */ |
| |
| #else /* ANSI/OEM input */ |
| BYTE b; |
| WCHAR wc; |
| |
| wc = (BYTE)*p++; /* Get a byte */ |
| if (dbc_1st((BYTE)wc)) { /* Is it a DBC 1st byte? */ |
| b = (BYTE)*p++; /* Get 2nd byte */ |
| if (!dbc_2nd(b)) return 0xFFFFFFFF; /* Invalid code? */ |
| wc = (wc << 8) + b; /* Make a DBC */ |
| } |
| if (wc != 0) { |
| wc = ff_oem2uni(wc, CODEPAGE); /* ANSI/OEM ==> Unicode */ |
| if (wc == 0) return 0xFFFFFFFF; /* Invalid code? */ |
| } |
| uc = wc; |
| |
| #endif |
| *str = p; /* Next read pointer */ |
| return uc; |
| } |
| |
| |
| /* Store a Unicode char in defined API encoding */ |
| static UINT put_utf ( /* Returns number of encoding units written (0:buffer overflow or wrong encoding) */ |
| DWORD chr, /* UTF-16 encoded character (Surrogate pair if >=0x10000) */ |
| TCHAR* buf, /* Output buffer */ |
| UINT szb /* Size of the buffer */ |
| ) |
| { |
| #if FF_LFN_UNICODE == 1 /* UTF-16 output */ |
| WCHAR hs, wc; |
| |
| hs = (WCHAR)(chr >> 16); |
| wc = (WCHAR)chr; |
| if (hs == 0) { /* Single encoding unit? */ |
| if (szb < 1 || IsSurrogate(wc)) return 0; /* Buffer overflow or wrong code? */ |
| *buf = wc; |
| return 1; |
| } |
| if (szb < 2 || !IsSurrogateH(hs) || !IsSurrogateL(wc)) return 0; /* Buffer overflow or wrong surrogate? */ |
| *buf++ = hs; |
| *buf++ = wc; |
| return 2; |
| |
| #elif FF_LFN_UNICODE == 2 /* UTF-8 output */ |
| DWORD hc; |
| |
| if (chr < 0x80) { /* Single byte code? */ |
| if (szb < 1) return 0; /* Buffer overflow? */ |
| *buf = (TCHAR)chr; |
| return 1; |
| } |
| if (chr < 0x800) { /* 2-byte sequence? */ |
| if (szb < 2) return 0; /* Buffer overflow? */ |
| *buf++ = (TCHAR)(0xC0 | (chr >> 6 & 0x1F)); |
| *buf++ = (TCHAR)(0x80 | (chr >> 0 & 0x3F)); |
| return 2; |
| } |
| if (chr < 0x10000) { /* 3-byte sequence? */ |
| if (szb < 3 || IsSurrogate(chr)) return 0; /* Buffer overflow or wrong code? */ |
| *buf++ = (TCHAR)(0xE0 | (chr >> 12 & 0x0F)); |
| *buf++ = (TCHAR)(0x80 | (chr >> 6 & 0x3F)); |
| *buf++ = (TCHAR)(0x80 | (chr >> 0 & 0x3F)); |
| return 3; |
| } |
| /* 4-byte sequence */ |
| if (szb < 4) return 0; /* Buffer overflow? */ |
| hc = ((chr & 0xFFFF0000) - 0xD8000000) >> 6; /* Get high 10 bits */ |
| chr = (chr & 0xFFFF) - 0xDC00; /* Get low 10 bits */ |
| if (hc >= 0x100000 || chr >= 0x400) return 0; /* Wrong surrogate? */ |
| chr = (hc | chr) + 0x10000; |
| *buf++ = (TCHAR)(0xF0 | (chr >> 18 & 0x07)); |
| *buf++ = (TCHAR)(0x80 | (chr >> 12 & 0x3F)); |
| *buf++ = (TCHAR)(0x80 | (chr >> 6 & 0x3F)); |
| *buf++ = (TCHAR)(0x80 | (chr >> 0 & 0x3F)); |
| return 4; |
| |
| #elif FF_LFN_UNICODE == 3 /* UTF-32 output */ |
| DWORD hc; |
| |
| if (szb < 1) return 0; /* Buffer overflow? */ |
| if (chr >= 0x10000) { /* Out of BMP? */ |
| hc = ((chr & 0xFFFF0000) - 0xD8000000) >> 6; /* Get high 10 bits */ |
| chr = (chr & 0xFFFF) - 0xDC00; /* Get low 10 bits */ |
| if (hc >= 0x100000 || chr >= 0x400) return 0; /* Wrong surrogate? */ |
| chr = (hc | chr) + 0x10000; |
| } |
| *buf++ = (TCHAR)chr; |
| return 1; |
| |
| #else /* ANSI/OEM output */ |
| WCHAR wc; |
| |
| wc = ff_uni2oem(chr, CODEPAGE); |
| if (wc >= 0x100) { /* Is this a DBC? */ |
| if (szb < 2) return 0; |
| *buf++ = (char)(wc >> 8); /* Store DBC 1st byte */ |
| *buf++ = (TCHAR)wc; /* Store DBC 2nd byte */ |
| return 2; |
| } |
| if (wc == 0 || szb < 1) return 0; /* Invalid char or buffer overflow? */ |
| *buf++ = (TCHAR)wc; /* Store the character */ |
| return 1; |
| #endif |
| } |
| #endif /* FF_USE_LFN */ |
| |
| |
| #if FF_FS_REENTRANT |
| /*-----------------------------------------------------------------------*/ |
| /* Request/Release grant to access the volume */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static int lock_volume ( /* 1:Ok, 0:timeout */ |
| FATFS* fs, /* Filesystem object to lock */ |
| int syslock /* System lock required */ |
| ) |
| { |
| int rv; |
| |
| |
| #if FF_FS_LOCK |
| rv = ff_mutex_take(fs->ldrv); /* Lock the volume */ |
| if (rv && syslock) { /* System lock reqiered? */ |
| rv = ff_mutex_take(FF_VOLUMES); /* Lock the system */ |
| if (rv) { |
| SysLock = 2; /* System lock succeeded */ |
| } else { |
| ff_mutex_give(fs->ldrv); /* Failed system lock */ |
| } |
| } |
| #else |
| rv = syslock ? ff_mutex_take(fs->ldrv) : ff_mutex_take(fs->ldrv); /* Lock the volume (this is to prevent compiler warning) */ |
| #endif |
| return rv; |
| } |
| |
| |
| static void unlock_volume ( |
| FATFS* fs, /* Filesystem object */ |
| FRESULT res /* Result code to be returned */ |
| ) |
| { |
| if (fs && res != FR_NOT_ENABLED && res != FR_INVALID_DRIVE && res != FR_TIMEOUT) { |
| #if FF_FS_LOCK |
| if (SysLock == 2) { /* Is the system locked? */ |
| SysLock = 1; |
| ff_mutex_give(FF_VOLUMES); |
| } |
| #endif |
| ff_mutex_give(fs->ldrv); /* Unlock the volume */ |
| } |
| } |
| |
| #endif |
| |
| |
| |
| #if FF_FS_LOCK |
| /*-----------------------------------------------------------------------*/ |
| /* File shareing control functions */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT chk_share ( /* Check if the file can be accessed */ |
| DIR* dp, /* Directory object pointing the file to be checked */ |
| int acc /* Desired access type (0:Read mode open, 1:Write mode open, 2:Delete or rename) */ |
| ) |
| { |
| UINT i, be; |
| |
| /* Search open object table for the object */ |
| be = 0; |
| for (i = 0; i < FF_FS_LOCK; i++) { |
| if (Files[i].fs) { /* Existing entry */ |
| if (Files[i].fs == dp->obj.fs && /* Check if the object matches with an open object */ |
| Files[i].clu == dp->obj.sclust && |
| Files[i].ofs == dp->dptr) break; |
| } else { /* Blank entry */ |
| be = 1; |
| } |
| } |
| if (i == FF_FS_LOCK) { /* The object has not been opened */ |
| return (!be && acc != 2) ? FR_TOO_MANY_OPEN_FILES : FR_OK; /* Is there a blank entry for new object? */ |
| } |
| |
| /* The object was opened. Reject any open against writing file and all write mode open */ |
| return (acc != 0 || Files[i].ctr == 0x100) ? FR_LOCKED : FR_OK; |
| } |
| |
| |
| static int enq_share (void) /* Check if an entry is available for a new object */ |
| { |
| UINT i; |
| |
| for (i = 0; i < FF_FS_LOCK && Files[i].fs; i++) ; /* Find a free entry */ |
| return (i == FF_FS_LOCK) ? 0 : 1; |
| } |
| |
| |
| static UINT inc_share ( /* Increment object open counter and returns its index (0:Internal error) */ |
| DIR* dp, /* Directory object pointing the file to register or increment */ |
| int acc /* Desired access (0:Read, 1:Write, 2:Delete/Rename) */ |
| ) |
| { |
| UINT i; |
| |
| |
| for (i = 0; i < FF_FS_LOCK; i++) { /* Find the object */ |
| if (Files[i].fs == dp->obj.fs |
| && Files[i].clu == dp->obj.sclust |
| && Files[i].ofs == dp->dptr) break; |
| } |
| |
| if (i == FF_FS_LOCK) { /* Not opened. Register it as new. */ |
| for (i = 0; i < FF_FS_LOCK && Files[i].fs; i++) ; /* Find a free entry */ |
| if (i == FF_FS_LOCK) return 0; /* No free entry to register (int err) */ |
| Files[i].fs = dp->obj.fs; |
| Files[i].clu = dp->obj.sclust; |
| Files[i].ofs = dp->dptr; |
| Files[i].ctr = 0; |
| } |
| |
| if (acc >= 1 && Files[i].ctr) return 0; /* Access violation (int err) */ |
| |
| Files[i].ctr = acc ? 0x100 : Files[i].ctr + 1; /* Set semaphore value */ |
| |
| return i + 1; /* Index number origin from 1 */ |
| } |
| |
| |
| static FRESULT dec_share ( /* Decrement object open counter */ |
| UINT i /* Semaphore index (1..) */ |
| ) |
| { |
| UINT n; |
| FRESULT res; |
| |
| |
| if (--i < FF_FS_LOCK) { /* Index number origin from 0 */ |
| n = Files[i].ctr; |
| if (n == 0x100) n = 0; /* If write mode open, delete the object semaphore */ |
| if (n > 0) n--; /* Decrement read mode open count */ |
| Files[i].ctr = n; |
| if (n == 0) { /* Delete the object semaphore if open count becomes zero */ |
| Files[i].fs = 0; /* Free the entry <<<If this memory write operation is not in atomic, FF_FS_REENTRANT == 1 and FF_VOLUMES > 1, there is a potential error in this process >>> */ |
| } |
| res = FR_OK; |
| } else { |
| res = FR_INT_ERR; /* Invalid index number */ |
| } |
| return res; |
| } |
| |
| |
| static void clear_share ( /* Clear all lock entries of the volume */ |
| FATFS* fs |
| ) |
| { |
| UINT i; |
| |
| for (i = 0; i < FF_FS_LOCK; i++) { |
| if (Files[i].fs == fs) Files[i].fs = 0; |
| } |
| } |
| |
| #endif /* FF_FS_LOCK */ |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Move/Flush disk access window in the filesystem object */ |
| /*-----------------------------------------------------------------------*/ |
| #if !FF_FS_READONLY |
| static FRESULT sync_window ( /* Returns FR_OK or FR_DISK_ERR */ |
| FATFS* fs /* Filesystem object */ |
| ) |
| { |
| FRESULT res = FR_OK; |
| |
| |
| if (fs->wflag) { /* Is the disk access window dirty? */ |
| if (disk_write(fs->pdrv, fs->win, fs->winsect, 1) == RES_OK) { /* Write it back into the volume */ |
| fs->wflag = 0; /* Clear window dirty flag */ |
| if (fs->winsect - fs->fatbase < fs->fsize) { /* Is it in the 1st FAT? */ |
| if (fs->n_fats == 2) disk_write(fs->pdrv, fs->win, fs->winsect + fs->fsize, 1); /* Reflect it to 2nd FAT if needed */ |
| } |
| } else { |
| res = FR_DISK_ERR; |
| } |
| } |
| return res; |
| } |
| #endif |
| |
| |
| static FRESULT move_window ( /* Returns FR_OK or FR_DISK_ERR */ |
| FATFS* fs, /* Filesystem object */ |
| LBA_t sect /* Sector LBA to make appearance in the fs->win[] */ |
| ) |
| { |
| FRESULT res = FR_OK; |
| |
| |
| if (sect != fs->winsect) { /* Window offset changed? */ |
| #if !FF_FS_READONLY |
| res = sync_window(fs); /* Flush the window */ |
| #endif |
| if (res == FR_OK) { /* Fill sector window with new data */ |
| if (disk_read(fs->pdrv, fs->win, sect, 1) != RES_OK) { |
| sect = (LBA_t)0 - 1; /* Invalidate window if read data is not valid */ |
| res = FR_DISK_ERR; |
| } |
| fs->winsect = sect; |
| } |
| } |
| return res; |
| } |
| |
| |
| |
| |
| #if !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* Synchronize filesystem and data on the storage */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT sync_fs ( /* Returns FR_OK or FR_DISK_ERR */ |
| FATFS* fs /* Filesystem object */ |
| ) |
| { |
| FRESULT res; |
| |
| |
| res = sync_window(fs); |
| if (res == FR_OK) { |
| if (fs->fs_type == FS_FAT32 && fs->fsi_flag == 1) { /* FAT32: Update FSInfo sector if needed */ |
| /* Create FSInfo structure */ |
| memset(fs->win, 0, sizeof fs->win); |
| st_word(fs->win + BS_55AA, 0xAA55); /* Boot signature */ |
| st_dword(fs->win + FSI_LeadSig, 0x41615252); /* Leading signature */ |
| st_dword(fs->win + FSI_StrucSig, 0x61417272); /* Structure signature */ |
| st_dword(fs->win + FSI_Free_Count, fs->free_clst); /* Number of free clusters */ |
| st_dword(fs->win + FSI_Nxt_Free, fs->last_clst); /* Last allocated culuster */ |
| fs->winsect = fs->volbase + 1; /* Write it into the FSInfo sector (Next to VBR) */ |
| disk_write(fs->pdrv, fs->win, fs->winsect, 1); |
| fs->fsi_flag = 0; |
| } |
| /* Make sure that no pending write process in the lower layer */ |
| if (disk_ioctl(fs->pdrv, CTRL_SYNC, 0) != RES_OK) res = FR_DISK_ERR; |
| } |
| |
| return res; |
| } |
| |
| #endif |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Get physical sector number from cluster number */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static LBA_t clst2sect ( /* !=0:Sector number, 0:Failed (invalid cluster#) */ |
| FATFS* fs, /* Filesystem object */ |
| DWORD clst /* Cluster# to be converted */ |
| ) |
| { |
| clst -= 2; /* Cluster number is origin from 2 */ |
| if (clst >= fs->n_fatent - 2) return 0; /* Is it invalid cluster number? */ |
| return fs->database + (LBA_t)fs->csize * clst; /* Start sector number of the cluster */ |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* FAT access - Read value of an FAT entry */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static DWORD get_fat ( /* 0xFFFFFFFF:Disk error, 1:Internal error, 2..0x7FFFFFFF:Cluster status */ |
| FFOBJID* obj, /* Corresponding object */ |
| DWORD clst /* Cluster number to get the value */ |
| ) |
| { |
| UINT wc, bc; |
| DWORD val; |
| FATFS *fs = obj->fs; |
| |
| |
| if (clst < 2 || clst >= fs->n_fatent) { /* Check if in valid range */ |
| val = 1; /* Internal error */ |
| |
| } else { |
| val = 0xFFFFFFFF; /* Default value falls on disk error */ |
| |
| switch (fs->fs_type) { |
| case FS_FAT12 : |
| bc = (UINT)clst; bc += bc / 2; |
| if (move_window(fs, fs->fatbase + (bc / SS(fs))) != FR_OK) break; |
| wc = fs->win[bc++ % SS(fs)]; /* Get 1st byte of the entry */ |
| if (move_window(fs, fs->fatbase + (bc / SS(fs))) != FR_OK) break; |
| wc |= fs->win[bc % SS(fs)] << 8; /* Merge 2nd byte of the entry */ |
| val = (clst & 1) ? (wc >> 4) : (wc & 0xFFF); /* Adjust bit position */ |
| break; |
| |
| case FS_FAT16 : |
| if (move_window(fs, fs->fatbase + (clst / (SS(fs) / 2))) != FR_OK) break; |
| val = ld_word(fs->win + clst * 2 % SS(fs)); /* Simple WORD array */ |
| break; |
| |
| case FS_FAT32 : |
| if (move_window(fs, fs->fatbase + (clst / (SS(fs) / 4))) != FR_OK) break; |
| val = ld_dword(fs->win + clst * 4 % SS(fs)) & 0x0FFFFFFF; /* Simple DWORD array but mask out upper 4 bits */ |
| break; |
| #if FF_FS_EXFAT |
| case FS_EXFAT : |
| if ((obj->objsize != 0 && obj->sclust != 0) || obj->stat == 0) { /* Object except root dir must have valid data length */ |
| DWORD cofs = clst - obj->sclust; /* Offset from start cluster */ |
| DWORD clen = (DWORD)((LBA_t)((obj->objsize - 1) / SS(fs)) / fs->csize); /* Number of clusters - 1 */ |
| |
| if (obj->stat == 2 && cofs <= clen) { /* Is it a contiguous chain? */ |
| val = (cofs == clen) ? 0x7FFFFFFF : clst + 1; /* No data on the FAT, generate the value */ |
| break; |
| } |
| if (obj->stat == 3 && cofs < obj->n_cont) { /* Is it in the 1st fragment? */ |
| val = clst + 1; /* Generate the value */ |
| break; |
| } |
| if (obj->stat != 2) { /* Get value from FAT if FAT chain is valid */ |
| if (obj->n_frag != 0) { /* Is it on the growing edge? */ |
| val = 0x7FFFFFFF; /* Generate EOC */ |
| } else { |
| if (move_window(fs, fs->fatbase + (clst / (SS(fs) / 4))) != FR_OK) break; |
| val = ld_dword(fs->win + clst * 4 % SS(fs)) & 0x7FFFFFFF; |
| } |
| break; |
| } |
| } |
| val = 1; /* Internal error */ |
| break; |
| #endif |
| default: |
| val = 1; /* Internal error */ |
| } |
| } |
| |
| return val; |
| } |
| |
| |
| |
| |
| #if !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* FAT access - Change value of an FAT entry */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT put_fat ( /* FR_OK(0):succeeded, !=0:error */ |
| FATFS* fs, /* Corresponding filesystem object */ |
| DWORD clst, /* FAT index number (cluster number) to be changed */ |
| DWORD val /* New value to be set to the entry */ |
| ) |
| { |
| UINT bc; |
| BYTE *p; |
| FRESULT res = FR_INT_ERR; |
| |
| |
| if (clst >= 2 && clst < fs->n_fatent) { /* Check if in valid range */ |
| switch (fs->fs_type) { |
| case FS_FAT12: |
| bc = (UINT)clst; bc += bc / 2; /* bc: byte offset of the entry */ |
| res = move_window(fs, fs->fatbase + (bc / SS(fs))); |
| if (res != FR_OK) break; |
| p = fs->win + bc++ % SS(fs); |
| *p = (clst & 1) ? ((*p & 0x0F) | ((BYTE)val << 4)) : (BYTE)val; /* Update 1st byte */ |
| fs->wflag = 1; |
| res = move_window(fs, fs->fatbase + (bc / SS(fs))); |
| if (res != FR_OK) break; |
| p = fs->win + bc % SS(fs); |
| *p = (clst & 1) ? (BYTE)(val >> 4) : ((*p & 0xF0) | ((BYTE)(val >> 8) & 0x0F)); /* Update 2nd byte */ |
| fs->wflag = 1; |
| break; |
| |
| case FS_FAT16: |
| res = move_window(fs, fs->fatbase + (clst / (SS(fs) / 2))); |
| if (res != FR_OK) break; |
| st_word(fs->win + clst * 2 % SS(fs), (WORD)val); /* Simple WORD array */ |
| fs->wflag = 1; |
| break; |
| |
| case FS_FAT32: |
| #if FF_FS_EXFAT |
| case FS_EXFAT: |
| #endif |
| res = move_window(fs, fs->fatbase + (clst / (SS(fs) / 4))); |
| if (res != FR_OK) break; |
| if (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT) { |
| val = (val & 0x0FFFFFFF) | (ld_dword(fs->win + clst * 4 % SS(fs)) & 0xF0000000); |
| } |
| st_dword(fs->win + clst * 4 % SS(fs), val); |
| fs->wflag = 1; |
| break; |
| } |
| } |
| return res; |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| |
| |
| |
| |
| #if FF_FS_EXFAT && !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* exFAT: Accessing FAT and Allocation Bitmap */ |
| /*-----------------------------------------------------------------------*/ |
| |
| /*--------------------------------------*/ |
| /* Find a contiguous free cluster block */ |
| /*--------------------------------------*/ |
| |
| static DWORD find_bitmap ( /* 0:Not found, 2..:Cluster block found, 0xFFFFFFFF:Disk error */ |
| FATFS* fs, /* Filesystem object */ |
| DWORD clst, /* Cluster number to scan from */ |
| DWORD ncl /* Number of contiguous clusters to find (1..) */ |
| ) |
| { |
| BYTE bm, bv; |
| UINT i; |
| DWORD val, scl, ctr; |
| |
| |
| clst -= 2; /* The first bit in the bitmap corresponds to cluster #2 */ |
| if (clst >= fs->n_fatent - 2) clst = 0; |
| scl = val = clst; ctr = 0; |
| for (;;) { |
| if (move_window(fs, fs->bitbase + val / 8 / SS(fs)) != FR_OK) return 0xFFFFFFFF; |
| i = val / 8 % SS(fs); bm = 1 << (val % 8); |
| do { |
| do { |
| bv = fs->win[i] & bm; bm <<= 1; /* Get bit value */ |
| if (++val >= fs->n_fatent - 2) { /* Next cluster (with wrap-around) */ |
| val = 0; bm = 0; i = SS(fs); |
| } |
| if (bv == 0) { /* Is it a free cluster? */ |
| if (++ctr == ncl) return scl + 2; /* Check if run length is sufficient for required */ |
| } else { |
| scl = val; ctr = 0; /* Encountered a cluster in-use, restart to scan */ |
| } |
| if (val == clst) return 0; /* All cluster scanned? */ |
| } while (bm != 0); |
| bm = 1; |
| } while (++i < SS(fs)); |
| } |
| } |
| |
| |
| /*----------------------------------------*/ |
| /* Set/Clear a block of allocation bitmap */ |
| /*----------------------------------------*/ |
| |
| static FRESULT change_bitmap ( |
| FATFS* fs, /* Filesystem object */ |
| DWORD clst, /* Cluster number to change from */ |
| DWORD ncl, /* Number of clusters to be changed */ |
| int bv /* bit value to be set (0 or 1) */ |
| ) |
| { |
| BYTE bm; |
| UINT i; |
| LBA_t sect; |
| |
| |
| clst -= 2; /* The first bit corresponds to cluster #2 */ |
| sect = fs->bitbase + clst / 8 / SS(fs); /* Sector address */ |
| i = clst / 8 % SS(fs); /* Byte offset in the sector */ |
| bm = 1 << (clst % 8); /* Bit mask in the byte */ |
| for (;;) { |
| if (move_window(fs, sect++) != FR_OK) return FR_DISK_ERR; |
| do { |
| do { |
| if (bv == (int)((fs->win[i] & bm) != 0)) return FR_INT_ERR; /* Is the bit expected value? */ |
| fs->win[i] ^= bm; /* Flip the bit */ |
| fs->wflag = 1; |
| if (--ncl == 0) return FR_OK; /* All bits processed? */ |
| } while (bm <<= 1); /* Next bit */ |
| bm = 1; |
| } while (++i < SS(fs)); /* Next byte */ |
| i = 0; |
| } |
| } |
| |
| |
| /*---------------------------------------------*/ |
| /* Fill the first fragment of the FAT chain */ |
| /*---------------------------------------------*/ |
| |
| static FRESULT fill_first_frag ( |
| FFOBJID* obj /* Pointer to the corresponding object */ |
| ) |
| { |
| FRESULT res; |
| DWORD cl, n; |
| |
| |
| if (obj->stat == 3) { /* Has the object been changed 'fragmented' in this session? */ |
| for (cl = obj->sclust, n = obj->n_cont; n; cl++, n--) { /* Create cluster chain on the FAT */ |
| res = put_fat(obj->fs, cl, cl + 1); |
| if (res != FR_OK) return res; |
| } |
| obj->stat = 0; /* Change status 'FAT chain is valid' */ |
| } |
| return FR_OK; |
| } |
| |
| |
| /*---------------------------------------------*/ |
| /* Fill the last fragment of the FAT chain */ |
| /*---------------------------------------------*/ |
| |
| static FRESULT fill_last_frag ( |
| FFOBJID* obj, /* Pointer to the corresponding object */ |
| DWORD lcl, /* Last cluster of the fragment */ |
| DWORD term /* Value to set the last FAT entry */ |
| ) |
| { |
| FRESULT res; |
| |
| |
| while (obj->n_frag > 0) { /* Create the chain of last fragment */ |
| res = put_fat(obj->fs, lcl - obj->n_frag + 1, (obj->n_frag > 1) ? lcl - obj->n_frag + 2 : term); |
| if (res != FR_OK) return res; |
| obj->n_frag--; |
| } |
| return FR_OK; |
| } |
| |
| #endif /* FF_FS_EXFAT && !FF_FS_READONLY */ |
| |
| |
| |
| #if !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* FAT handling - Remove a cluster chain */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT remove_chain ( /* FR_OK(0):succeeded, !=0:error */ |
| FFOBJID* obj, /* Corresponding object */ |
| DWORD clst, /* Cluster to remove a chain from */ |
| DWORD pclst /* Previous cluster of clst (0 if entire chain) */ |
| ) |
| { |
| FRESULT res = FR_OK; |
| DWORD nxt; |
| FATFS *fs = obj->fs; |
| #if FF_FS_EXFAT || FF_USE_TRIM |
| DWORD scl = clst, ecl = clst; |
| #endif |
| #if FF_USE_TRIM |
| LBA_t rt[2]; |
| #endif |
| |
| if (clst < 2 || clst >= fs->n_fatent) return FR_INT_ERR; /* Check if in valid range */ |
| |
| /* Mark the previous cluster 'EOC' on the FAT if it exists */ |
| if (pclst != 0 && (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT || obj->stat != 2)) { |
| res = put_fat(fs, pclst, 0xFFFFFFFF); |
| if (res != FR_OK) return res; |
| } |
| |
| /* Remove the chain */ |
| do { |
| nxt = get_fat(obj, clst); /* Get cluster status */ |
| if (nxt == 0) break; /* Empty cluster? */ |
| if (nxt == 1) return FR_INT_ERR; /* Internal error? */ |
| if (nxt == 0xFFFFFFFF) return FR_DISK_ERR; /* Disk error? */ |
| if (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT) { |
| res = put_fat(fs, clst, 0); /* Mark the cluster 'free' on the FAT */ |
| if (res != FR_OK) return res; |
| } |
| if (fs->free_clst < fs->n_fatent - 2) { /* Update FSINFO */ |
| fs->free_clst++; |
| fs->fsi_flag |= 1; |
| } |
| #if FF_FS_EXFAT || FF_USE_TRIM |
| if (ecl + 1 == nxt) { /* Is next cluster contiguous? */ |
| ecl = nxt; |
| } else { /* End of contiguous cluster block */ |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| res = change_bitmap(fs, scl, ecl - scl + 1, 0); /* Mark the cluster block 'free' on the bitmap */ |
| if (res != FR_OK) return res; |
| } |
| #endif |
| #if FF_USE_TRIM |
| rt[0] = clst2sect(fs, scl); /* Start of data area to be freed */ |
| rt[1] = clst2sect(fs, ecl) + fs->csize - 1; /* End of data area to be freed */ |
| disk_ioctl(fs->pdrv, CTRL_TRIM, rt); /* Inform storage device that the data in the block may be erased */ |
| #endif |
| scl = ecl = nxt; |
| } |
| #endif |
| clst = nxt; /* Next cluster */ |
| } while (clst < fs->n_fatent); /* Repeat while not the last link */ |
| |
| #if FF_FS_EXFAT |
| /* Some post processes for chain status */ |
| if (fs->fs_type == FS_EXFAT) { |
| if (pclst == 0) { /* Has the entire chain been removed? */ |
| obj->stat = 0; /* Change the chain status 'initial' */ |
| } else { |
| if (obj->stat == 0) { /* Is it a fragmented chain from the beginning of this session? */ |
| clst = obj->sclust; /* Follow the chain to check if it gets contiguous */ |
| while (clst != pclst) { |
| nxt = get_fat(obj, clst); |
| if (nxt < 2) return FR_INT_ERR; |
| if (nxt == 0xFFFFFFFF) return FR_DISK_ERR; |
| if (nxt != clst + 1) break; /* Not contiguous? */ |
| clst++; |
| } |
| if (clst == pclst) { /* Has the chain got contiguous again? */ |
| obj->stat = 2; /* Change the chain status 'contiguous' */ |
| } |
| } else { |
| if (obj->stat == 3 && pclst >= obj->sclust && pclst <= obj->sclust + obj->n_cont) { /* Was the chain fragmented in this session and got contiguous again? */ |
| obj->stat = 2; /* Change the chain status 'contiguous' */ |
| } |
| } |
| } |
| } |
| #endif |
| return FR_OK; |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* FAT handling - Stretch a chain or Create a new chain */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static DWORD create_chain ( /* 0:No free cluster, 1:Internal error, 0xFFFFFFFF:Disk error, >=2:New cluster# */ |
| FFOBJID* obj, /* Corresponding object */ |
| DWORD clst /* Cluster# to stretch, 0:Create a new chain */ |
| ) |
| { |
| DWORD cs, ncl, scl; |
| FRESULT res; |
| FATFS *fs = obj->fs; |
| |
| |
| if (clst == 0) { /* Create a new chain */ |
| scl = fs->last_clst; /* Suggested cluster to start to find */ |
| if (scl == 0 || scl >= fs->n_fatent) scl = 1; |
| } |
| else { /* Stretch a chain */ |
| cs = get_fat(obj, clst); /* Check the cluster status */ |
| if (cs < 2) return 1; /* Test for insanity */ |
| if (cs == 0xFFFFFFFF) return cs; /* Test for disk error */ |
| if (cs < fs->n_fatent) return cs; /* It is already followed by next cluster */ |
| scl = clst; /* Cluster to start to find */ |
| } |
| if (fs->free_clst == 0) return 0; /* No free cluster */ |
| |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */ |
| ncl = find_bitmap(fs, scl, 1); /* Find a free cluster */ |
| if (ncl == 0 || ncl == 0xFFFFFFFF) return ncl; /* No free cluster or hard error? */ |
| res = change_bitmap(fs, ncl, 1, 1); /* Mark the cluster 'in use' */ |
| if (res == FR_INT_ERR) return 1; |
| if (res == FR_DISK_ERR) return 0xFFFFFFFF; |
| if (clst == 0) { /* Is it a new chain? */ |
| obj->stat = 2; /* Set status 'contiguous' */ |
| } else { /* It is a stretched chain */ |
| if (obj->stat == 2 && ncl != scl + 1) { /* Is the chain got fragmented? */ |
| obj->n_cont = scl - obj->sclust; /* Set size of the contiguous part */ |
| obj->stat = 3; /* Change status 'just fragmented' */ |
| } |
| } |
| if (obj->stat != 2) { /* Is the file non-contiguous? */ |
| if (ncl == clst + 1) { /* Is the cluster next to previous one? */ |
| obj->n_frag = obj->n_frag ? obj->n_frag + 1 : 2; /* Increment size of last framgent */ |
| } else { /* New fragment */ |
| if (obj->n_frag == 0) obj->n_frag = 1; |
| res = fill_last_frag(obj, clst, ncl); /* Fill last fragment on the FAT and link it to new one */ |
| if (res == FR_OK) obj->n_frag = 1; |
| } |
| } |
| } else |
| #endif |
| { /* On the FAT/FAT32 volume */ |
| ncl = 0; |
| if (scl == clst) { /* Stretching an existing chain? */ |
| ncl = scl + 1; /* Test if next cluster is free */ |
| if (ncl >= fs->n_fatent) ncl = 2; |
| cs = get_fat(obj, ncl); /* Get next cluster status */ |
| if (cs == 1 || cs == 0xFFFFFFFF) return cs; /* Test for error */ |
| if (cs != 0) { /* Not free? */ |
| cs = fs->last_clst; /* Start at suggested cluster if it is valid */ |
| if (cs >= 2 && cs < fs->n_fatent) scl = cs; |
| ncl = 0; |
| } |
| } |
| if (ncl == 0) { /* The new cluster cannot be contiguous and find another fragment */ |
| ncl = scl; /* Start cluster */ |
| for (;;) { |
| ncl++; /* Next cluster */ |
| if (ncl >= fs->n_fatent) { /* Check wrap-around */ |
| ncl = 2; |
| if (ncl > scl) return 0; /* No free cluster found? */ |
| } |
| cs = get_fat(obj, ncl); /* Get the cluster status */ |
| if (cs == 0) break; /* Found a free cluster? */ |
| if (cs == 1 || cs == 0xFFFFFFFF) return cs; /* Test for error */ |
| if (ncl == scl) return 0; /* No free cluster found? */ |
| } |
| } |
| res = put_fat(fs, ncl, 0xFFFFFFFF); /* Mark the new cluster 'EOC' */ |
| if (res == FR_OK && clst != 0) { |
| res = put_fat(fs, clst, ncl); /* Link it from the previous one if needed */ |
| } |
| } |
| |
| if (res == FR_OK) { /* Update FSINFO if function succeeded. */ |
| fs->last_clst = ncl; |
| if (fs->free_clst <= fs->n_fatent - 2) fs->free_clst--; |
| fs->fsi_flag |= 1; |
| } else { |
| ncl = (res == FR_DISK_ERR) ? 0xFFFFFFFF : 1; /* Failed. Generate error status */ |
| } |
| |
| return ncl; /* Return new cluster number or error status */ |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| |
| |
| |
| |
| #if FF_USE_FASTSEEK |
| /*-----------------------------------------------------------------------*/ |
| /* FAT handling - Convert offset into cluster with link map table */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static DWORD clmt_clust ( /* <2:Error, >=2:Cluster number */ |
| FIL* fp, /* Pointer to the file object */ |
| FSIZE_t ofs /* File offset to be converted to cluster# */ |
| ) |
| { |
| DWORD cl, ncl; |
| DWORD *tbl; |
| FATFS *fs = fp->obj.fs; |
| |
| |
| tbl = fp->cltbl + 1; /* Top of CLMT */ |
| cl = (DWORD)(ofs / SS(fs) / fs->csize); /* Cluster order from top of the file */ |
| for (;;) { |
| ncl = *tbl++; /* Number of cluters in the fragment */ |
| if (ncl == 0) return 0; /* End of table? (error) */ |
| if (cl < ncl) break; /* In this fragment? */ |
| cl -= ncl; tbl++; /* Next fragment */ |
| } |
| return cl + *tbl; /* Return the cluster number */ |
| } |
| |
| #endif /* FF_USE_FASTSEEK */ |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Directory handling - Fill a cluster with zeros */ |
| /*-----------------------------------------------------------------------*/ |
| |
| #if !FF_FS_READONLY |
| static FRESULT dir_clear ( /* Returns FR_OK or FR_DISK_ERR */ |
| FATFS *fs, /* Filesystem object */ |
| DWORD clst /* Directory table to clear */ |
| ) |
| { |
| LBA_t sect; |
| UINT n, szb; |
| BYTE *ibuf; |
| |
| |
| if (sync_window(fs) != FR_OK) return FR_DISK_ERR; /* Flush disk access window */ |
| sect = clst2sect(fs, clst); /* Top of the cluster */ |
| fs->winsect = sect; /* Set window to top of the cluster */ |
| memset(fs->win, 0, sizeof fs->win); /* Clear window buffer */ |
| #if FF_USE_LFN == 3 /* Quick table clear by using multi-secter write */ |
| /* Allocate a temporary buffer */ |
| for (szb = ((DWORD)fs->csize * SS(fs) >= MAX_MALLOC) ? MAX_MALLOC : fs->csize * SS(fs), ibuf = 0; szb > SS(fs) && (ibuf = ff_memalloc(szb)) == 0; szb /= 2) ; |
| if (szb > SS(fs)) { /* Buffer allocated? */ |
| memset(ibuf, 0, szb); |
| szb /= SS(fs); /* Bytes -> Sectors */ |
| for (n = 0; n < fs->csize && disk_write(fs->pdrv, ibuf, sect + n, szb) == RES_OK; n += szb) ; /* Fill the cluster with 0 */ |
| ff_memfree(ibuf); |
| } else |
| #endif |
| { |
| ibuf = fs->win; szb = 1; /* Use window buffer (many single-sector writes may take a time) */ |
| for (n = 0; n < fs->csize && disk_write(fs->pdrv, ibuf, sect + n, szb) == RES_OK; n += szb) ; /* Fill the cluster with 0 */ |
| } |
| return (n == fs->csize) ? FR_OK : FR_DISK_ERR; |
| } |
| #endif /* !FF_FS_READONLY */ |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Directory handling - Set directory index */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT dir_sdi ( /* FR_OK(0):succeeded, !=0:error */ |
| DIR* dp, /* Pointer to directory object */ |
| DWORD ofs /* Offset of directory table */ |
| ) |
| { |
| DWORD csz, clst; |
| FATFS *fs = dp->obj.fs; |
| |
| |
| if (ofs >= (DWORD)((FF_FS_EXFAT && fs->fs_type == FS_EXFAT) ? MAX_DIR_EX : MAX_DIR) || ofs % SZDIRE) { /* Check range of offset and alignment */ |
| return FR_INT_ERR; |
| } |
| dp->dptr = ofs; /* Set current offset */ |
| clst = dp->obj.sclust; /* Table start cluster (0:root) */ |
| if (clst == 0 && fs->fs_type >= FS_FAT32) { /* Replace cluster# 0 with root cluster# */ |
| clst = (DWORD)fs->dirbase; |
| if (FF_FS_EXFAT) dp->obj.stat = 0; /* exFAT: Root dir has an FAT chain */ |
| } |
| |
| if (clst == 0) { /* Static table (root-directory on the FAT volume) */ |
| if (ofs / SZDIRE >= fs->n_rootdir) return FR_INT_ERR; /* Is index out of range? */ |
| dp->sect = fs->dirbase; |
| |
| } else { /* Dynamic table (sub-directory or root-directory on the FAT32/exFAT volume) */ |
| csz = (DWORD)fs->csize * SS(fs); /* Bytes per cluster */ |
| while (ofs >= csz) { /* Follow cluster chain */ |
| clst = get_fat(&dp->obj, clst); /* Get next cluster */ |
| if (clst == 0xFFFFFFFF) return FR_DISK_ERR; /* Disk error */ |
| if (clst < 2 || clst >= fs->n_fatent) return FR_INT_ERR; /* Reached to end of table or internal error */ |
| ofs -= csz; |
| } |
| dp->sect = clst2sect(fs, clst); |
| } |
| dp->clust = clst; /* Current cluster# */ |
| if (dp->sect == 0) return FR_INT_ERR; |
| dp->sect += ofs / SS(fs); /* Sector# of the directory entry */ |
| dp->dir = fs->win + (ofs % SS(fs)); /* Pointer to the entry in the win[] */ |
| |
| return FR_OK; |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Directory handling - Move directory table index next */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT dir_next ( /* FR_OK(0):succeeded, FR_NO_FILE:End of table, FR_DENIED:Could not stretch */ |
| DIR* dp, /* Pointer to the directory object */ |
| int stretch /* 0: Do not stretch table, 1: Stretch table if needed */ |
| ) |
| { |
| DWORD ofs, clst; |
| FATFS *fs = dp->obj.fs; |
| |
| |
| ofs = dp->dptr + SZDIRE; /* Next entry */ |
| if (ofs >= (DWORD)((FF_FS_EXFAT && fs->fs_type == FS_EXFAT) ? MAX_DIR_EX : MAX_DIR)) dp->sect = 0; /* Disable it if the offset reached the max value */ |
| if (dp->sect == 0) return FR_NO_FILE; /* Report EOT if it has been disabled */ |
| |
| if (ofs % SS(fs) == 0) { /* Sector changed? */ |
| dp->sect++; /* Next sector */ |
| |
| if (dp->clust == 0) { /* Static table */ |
| if (ofs / SZDIRE >= fs->n_rootdir) { /* Report EOT if it reached end of static table */ |
| dp->sect = 0; return FR_NO_FILE; |
| } |
| } |
| else { /* Dynamic table */ |
| if ((ofs / SS(fs) & (fs->csize - 1)) == 0) { /* Cluster changed? */ |
| clst = get_fat(&dp->obj, dp->clust); /* Get next cluster */ |
| if (clst <= 1) return FR_INT_ERR; /* Internal error */ |
| if (clst == 0xFFFFFFFF) return FR_DISK_ERR; /* Disk error */ |
| if (clst >= fs->n_fatent) { /* It reached end of dynamic table */ |
| #if !FF_FS_READONLY |
| if (!stretch) { /* If no stretch, report EOT */ |
| dp->sect = 0; return FR_NO_FILE; |
| } |
| clst = create_chain(&dp->obj, dp->clust); /* Allocate a cluster */ |
| if (clst == 0) return FR_DENIED; /* No free cluster */ |
| if (clst == 1) return FR_INT_ERR; /* Internal error */ |
| if (clst == 0xFFFFFFFF) return FR_DISK_ERR; /* Disk error */ |
| if (dir_clear(fs, clst) != FR_OK) return FR_DISK_ERR; /* Clean up the stretched table */ |
| if (FF_FS_EXFAT) dp->obj.stat |= 4; /* exFAT: The directory has been stretched */ |
| #else |
| if (!stretch) dp->sect = 0; /* (this line is to suppress compiler warning) */ |
| dp->sect = 0; return FR_NO_FILE; /* Report EOT */ |
| #endif |
| } |
| dp->clust = clst; /* Initialize data for new cluster */ |
| dp->sect = clst2sect(fs, clst); |
| } |
| } |
| } |
| dp->dptr = ofs; /* Current entry */ |
| dp->dir = fs->win + ofs % SS(fs); /* Pointer to the entry in the win[] */ |
| |
| return FR_OK; |
| } |
| |
| |
| |
| |
| #if !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* Directory handling - Reserve a block of directory entries */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT dir_alloc ( /* FR_OK(0):succeeded, !=0:error */ |
| DIR* dp, /* Pointer to the directory object */ |
| UINT n_ent /* Number of contiguous entries to allocate */ |
| ) |
| { |
| FRESULT res; |
| UINT n; |
| FATFS *fs = dp->obj.fs; |
| |
| |
| res = dir_sdi(dp, 0); |
| if (res == FR_OK) { |
| n = 0; |
| do { |
| res = move_window(fs, dp->sect); |
| if (res != FR_OK) break; |
| #if FF_FS_EXFAT |
| if ((fs->fs_type == FS_EXFAT) ? (int)((dp->dir[XDIR_Type] & 0x80) == 0) : (int)(dp->dir[DIR_Name] == DDEM || dp->dir[DIR_Name] == 0)) { /* Is the entry free? */ |
| #else |
| if (dp->dir[DIR_Name] == DDEM || dp->dir[DIR_Name] == 0) { /* Is the entry free? */ |
| #endif |
| if (++n == n_ent) break; /* Is a block of contiguous free entries found? */ |
| } else { |
| n = 0; /* Not a free entry, restart to search */ |
| } |
| res = dir_next(dp, 1); /* Next entry with table stretch enabled */ |
| } while (res == FR_OK); |
| } |
| |
| if (res == FR_NO_FILE) res = FR_DENIED; /* No directory entry to allocate */ |
| return res; |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* FAT: Directory handling - Load/Store start cluster number */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static DWORD ld_clust ( /* Returns the top cluster value of the SFN entry */ |
| FATFS* fs, /* Pointer to the fs object */ |
| const BYTE* dir /* Pointer to the key entry */ |
| ) |
| { |
| DWORD cl; |
| |
| cl = ld_word(dir + DIR_FstClusLO); |
| if (fs->fs_type == FS_FAT32) { |
| cl |= (DWORD)ld_word(dir + DIR_FstClusHI) << 16; |
| } |
| |
| return cl; |
| } |
| |
| |
| #if !FF_FS_READONLY |
| static void st_clust ( |
| FATFS* fs, /* Pointer to the fs object */ |
| BYTE* dir, /* Pointer to the key entry */ |
| DWORD cl /* Value to be set */ |
| ) |
| { |
| st_word(dir + DIR_FstClusLO, (WORD)cl); |
| if (fs->fs_type == FS_FAT32) { |
| st_word(dir + DIR_FstClusHI, (WORD)(cl >> 16)); |
| } |
| } |
| #endif |
| |
| |
| |
| #if FF_USE_LFN |
| /*--------------------------------------------------------*/ |
| /* FAT-LFN: Compare a part of file name with an LFN entry */ |
| /*--------------------------------------------------------*/ |
| |
| static int cmp_lfn ( /* 1:matched, 0:not matched */ |
| const WCHAR* lfnbuf, /* Pointer to the LFN working buffer to be compared */ |
| BYTE* dir /* Pointer to the directory entry containing the part of LFN */ |
| ) |
| { |
| UINT i, s; |
| WCHAR wc, uc; |
| |
| |
| if (ld_word(dir + LDIR_FstClusLO) != 0) return 0; /* Check LDIR_FstClusLO */ |
| |
| i = ((dir[LDIR_Ord] & 0x3F) - 1) * 13; /* Offset in the LFN buffer */ |
| |
| for (wc = 1, s = 0; s < 13; s++) { /* Process all characters in the entry */ |
| uc = ld_word(dir + LfnOfs[s]); /* Pick an LFN character */ |
| if (wc != 0) { |
| if (i >= FF_MAX_LFN + 1 || ff_wtoupper(uc) != ff_wtoupper(lfnbuf[i++])) { /* Compare it */ |
| return 0; /* Not matched */ |
| } |
| wc = uc; |
| } else { |
| if (uc != 0xFFFF) return 0; /* Check filler */ |
| } |
| } |
| |
| if ((dir[LDIR_Ord] & LLEF) && wc && lfnbuf[i]) return 0; /* Last segment matched but different length */ |
| |
| return 1; /* The part of LFN matched */ |
| } |
| |
| |
| #if FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2 || FF_USE_LABEL || FF_FS_EXFAT |
| /*-----------------------------------------------------*/ |
| /* FAT-LFN: Pick a part of file name from an LFN entry */ |
| /*-----------------------------------------------------*/ |
| |
| static int pick_lfn ( /* 1:succeeded, 0:buffer overflow or invalid LFN entry */ |
| WCHAR* lfnbuf, /* Pointer to the LFN working buffer */ |
| BYTE* dir /* Pointer to the LFN entry */ |
| ) |
| { |
| UINT i, s; |
| WCHAR wc, uc; |
| |
| |
| if (ld_word(dir + LDIR_FstClusLO) != 0) return 0; /* Check LDIR_FstClusLO is 0 */ |
| |
| i = ((dir[LDIR_Ord] & ~LLEF) - 1) * 13; /* Offset in the LFN buffer */ |
| |
| for (wc = 1, s = 0; s < 13; s++) { /* Process all characters in the entry */ |
| uc = ld_word(dir + LfnOfs[s]); /* Pick an LFN character */ |
| if (wc != 0) { |
| if (i >= FF_MAX_LFN + 1) return 0; /* Buffer overflow? */ |
| lfnbuf[i++] = wc = uc; /* Store it */ |
| } else { |
| if (uc != 0xFFFF) return 0; /* Check filler */ |
| } |
| } |
| |
| if (dir[LDIR_Ord] & LLEF && wc != 0) { /* Put terminator if it is the last LFN part and not terminated */ |
| if (i >= FF_MAX_LFN + 1) return 0; /* Buffer overflow? */ |
| lfnbuf[i] = 0; |
| } |
| |
| return 1; /* The part of LFN is valid */ |
| } |
| #endif |
| |
| |
| #if !FF_FS_READONLY |
| /*-----------------------------------------*/ |
| /* FAT-LFN: Create an entry of LFN entries */ |
| /*-----------------------------------------*/ |
| |
| static void put_lfn ( |
| const WCHAR* lfn, /* Pointer to the LFN */ |
| BYTE* dir, /* Pointer to the LFN entry to be created */ |
| BYTE ord, /* LFN order (1-20) */ |
| BYTE sum /* Checksum of the corresponding SFN */ |
| ) |
| { |
| UINT i, s; |
| WCHAR wc; |
| |
| |
| dir[LDIR_Chksum] = sum; /* Set checksum */ |
| dir[LDIR_Attr] = AM_LFN; /* Set attribute. LFN entry */ |
| dir[LDIR_Type] = 0; |
| st_word(dir + LDIR_FstClusLO, 0); |
| |
| i = (ord - 1) * 13; /* Get offset in the LFN working buffer */ |
| s = wc = 0; |
| do { |
| if (wc != 0xFFFF) wc = lfn[i++]; /* Get an effective character */ |
| st_word(dir + LfnOfs[s], wc); /* Put it */ |
| if (wc == 0) wc = 0xFFFF; /* Padding characters for following items */ |
| } while (++s < 13); |
| if (wc == 0xFFFF || !lfn[i]) ord |= LLEF; /* Last LFN part is the start of LFN sequence */ |
| dir[LDIR_Ord] = ord; /* Set the LFN order */ |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| #endif /* FF_USE_LFN */ |
| |
| |
| |
| #if FF_USE_LFN && !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* FAT-LFN: Create a Numbered SFN */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static void gen_numname ( |
| BYTE* dst, /* Pointer to the buffer to store numbered SFN */ |
| const BYTE* src, /* Pointer to SFN in directory form */ |
| const WCHAR* lfn, /* Pointer to LFN */ |
| UINT seq /* Sequence number */ |
| ) |
| { |
| BYTE ns[8], c; |
| UINT i, j; |
| WCHAR wc; |
| DWORD sreg; |
| |
| |
| memcpy(dst, src, 11); /* Prepare the SFN to be modified */ |
| |
| if (seq > 5) { /* In case of many collisions, generate a hash number instead of sequential number */ |
| sreg = seq; |
| while (*lfn) { /* Create a CRC as hash value */ |
| wc = *lfn++; |
| for (i = 0; i < 16; i++) { |
| sreg = (sreg << 1) + (wc & 1); |
| wc >>= 1; |
| if (sreg & 0x10000) sreg ^= 0x11021; |
| } |
| } |
| seq = (UINT)sreg; |
| } |
| |
| /* Make suffix (~ + hexadecimal) */ |
| i = 7; |
| do { |
| c = (BYTE)((seq % 16) + '0'); seq /= 16; |
| if (c > '9') c += 7; |
| ns[i--] = c; |
| } while (i && seq); |
| ns[i] = '~'; |
| |
| /* Append the suffix to the SFN body */ |
| for (j = 0; j < i && dst[j] != ' '; j++) { /* Find the offset to append */ |
| if (dbc_1st(dst[j])) { /* To avoid DBC break up */ |
| if (j == i - 1) break; |
| j++; |
| } |
| } |
| do { /* Append the suffix */ |
| dst[j++] = (i < 8) ? ns[i++] : ' '; |
| } while (j < 8); |
| } |
| #endif /* FF_USE_LFN && !FF_FS_READONLY */ |
| |
| |
| |
| #if FF_USE_LFN |
| /*-----------------------------------------------------------------------*/ |
| /* FAT-LFN: Calculate checksum of an SFN entry */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static BYTE sum_sfn ( |
| const BYTE* dir /* Pointer to the SFN entry */ |
| ) |
| { |
| BYTE sum = 0; |
| UINT n = 11; |
| |
| do { |
| sum = (sum >> 1) + (sum << 7) + *dir++; |
| } while (--n); |
| return sum; |
| } |
| |
| #endif /* FF_USE_LFN */ |
| |
| |
| |
| #if FF_FS_EXFAT |
| /*-----------------------------------------------------------------------*/ |
| /* exFAT: Checksum */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static WORD xdir_sum ( /* Get checksum of the directoly entry block */ |
| const BYTE* dir /* Directory entry block to be calculated */ |
| ) |
| { |
| UINT i, szblk; |
| WORD sum; |
| |
| |
| szblk = (dir[XDIR_NumSec] + 1) * SZDIRE; /* Number of bytes of the entry block */ |
| for (i = sum = 0; i < szblk; i++) { |
| if (i == XDIR_SetSum) { /* Skip 2-byte sum field */ |
| i++; |
| } else { |
| sum = ((sum & 1) ? 0x8000 : 0) + (sum >> 1) + dir[i]; |
| } |
| } |
| return sum; |
| } |
| |
| |
| |
| static WORD xname_sum ( /* Get check sum (to be used as hash) of the file name */ |
| const WCHAR* name /* File name to be calculated */ |
| ) |
| { |
| WCHAR chr; |
| WORD sum = 0; |
| |
| |
| while ((chr = *name++) != 0) { |
| chr = (WCHAR)ff_wtoupper(chr); /* File name needs to be up-case converted */ |
| sum = ((sum & 1) ? 0x8000 : 0) + (sum >> 1) + (chr & 0xFF); |
| sum = ((sum & 1) ? 0x8000 : 0) + (sum >> 1) + (chr >> 8); |
| } |
| return sum; |
| } |
| |
| |
| #if !FF_FS_READONLY && FF_USE_MKFS |
| static DWORD xsum32 ( /* Returns 32-bit checksum */ |
| BYTE dat, /* Byte to be calculated (byte-by-byte processing) */ |
| DWORD sum /* Previous sum value */ |
| ) |
| { |
| sum = ((sum & 1) ? 0x80000000 : 0) + (sum >> 1) + dat; |
| return sum; |
| } |
| #endif |
| |
| |
| |
| /*------------------------------------*/ |
| /* exFAT: Get a directory entry block */ |
| /*------------------------------------*/ |
| |
| static FRESULT load_xdir ( /* FR_INT_ERR: invalid entry block */ |
| DIR* dp /* Reading directory object pointing top of the entry block to load */ |
| ) |
| { |
| FRESULT res; |
| UINT i, sz_ent; |
| BYTE *dirb = dp->obj.fs->dirbuf; /* Pointer to the on-memory directory entry block 85+C0+C1s */ |
| |
| |
| /* Load file directory entry */ |
| res = move_window(dp->obj.fs, dp->sect); |
| if (res != FR_OK) return res; |
| if (dp->dir[XDIR_Type] != ET_FILEDIR) return FR_INT_ERR; /* Invalid order */ |
| memcpy(dirb + 0 * SZDIRE, dp->dir, SZDIRE); |
| sz_ent = (dirb[XDIR_NumSec] + 1) * SZDIRE; |
| if (sz_ent < 3 * SZDIRE || sz_ent > 19 * SZDIRE) return FR_INT_ERR; |
| |
| /* Load stream extension entry */ |
| res = dir_next(dp, 0); |
| if (res == FR_NO_FILE) res = FR_INT_ERR; /* It cannot be */ |
| if (res != FR_OK) return res; |
| res = move_window(dp->obj.fs, dp->sect); |
| if (res != FR_OK) return res; |
| if (dp->dir[XDIR_Type] != ET_STREAM) return FR_INT_ERR; /* Invalid order */ |
| memcpy(dirb + 1 * SZDIRE, dp->dir, SZDIRE); |
| if (MAXDIRB(dirb[XDIR_NumName]) > sz_ent) return FR_INT_ERR; |
| |
| /* Load file name entries */ |
| i = 2 * SZDIRE; /* Name offset to load */ |
| do { |
| res = dir_next(dp, 0); |
| if (res == FR_NO_FILE) res = FR_INT_ERR; /* It cannot be */ |
| if (res != FR_OK) return res; |
| res = move_window(dp->obj.fs, dp->sect); |
| if (res != FR_OK) return res; |
| if (dp->dir[XDIR_Type] != ET_FILENAME) return FR_INT_ERR; /* Invalid order */ |
| if (i < MAXDIRB(FF_MAX_LFN)) memcpy(dirb + i, dp->dir, SZDIRE); |
| } while ((i += SZDIRE) < sz_ent); |
| |
| /* Sanity check (do it for only accessible object) */ |
| if (i <= MAXDIRB(FF_MAX_LFN)) { |
| if (xdir_sum(dirb) != ld_word(dirb + XDIR_SetSum)) return FR_INT_ERR; |
| } |
| return FR_OK; |
| } |
| |
| |
| /*------------------------------------------------------------------*/ |
| /* exFAT: Initialize object allocation info with loaded entry block */ |
| /*------------------------------------------------------------------*/ |
| |
| static void init_alloc_info ( |
| FATFS* fs, /* Filesystem object */ |
| FFOBJID* obj /* Object allocation information to be initialized */ |
| ) |
| { |
| obj->sclust = ld_dword(fs->dirbuf + XDIR_FstClus); /* Start cluster */ |
| obj->objsize = ld_qword(fs->dirbuf + XDIR_FileSize); /* Size */ |
| obj->stat = fs->dirbuf[XDIR_GenFlags] & 2; /* Allocation status */ |
| obj->n_frag = 0; /* No last fragment info */ |
| } |
| |
| |
| |
| #if !FF_FS_READONLY || FF_FS_RPATH != 0 |
| /*------------------------------------------------*/ |
| /* exFAT: Load the object's directory entry block */ |
| /*------------------------------------------------*/ |
| |
| static FRESULT load_obj_xdir ( |
| DIR* dp, /* Blank directory object to be used to access containing directory */ |
| const FFOBJID* obj /* Object with its containing directory information */ |
| ) |
| { |
| FRESULT res; |
| |
| /* Open object containing directory */ |
| dp->obj.fs = obj->fs; |
| dp->obj.sclust = obj->c_scl; |
| dp->obj.stat = (BYTE)obj->c_size; |
| dp->obj.objsize = obj->c_size & 0xFFFFFF00; |
| dp->obj.n_frag = 0; |
| dp->blk_ofs = obj->c_ofs; |
| |
| res = dir_sdi(dp, dp->blk_ofs); /* Goto object's entry block */ |
| if (res == FR_OK) { |
| res = load_xdir(dp); /* Load the object's entry block */ |
| } |
| return res; |
| } |
| #endif |
| |
| |
| #if !FF_FS_READONLY |
| /*----------------------------------------*/ |
| /* exFAT: Store the directory entry block */ |
| /*----------------------------------------*/ |
| |
| static FRESULT store_xdir ( |
| DIR* dp /* Pointer to the directory object */ |
| ) |
| { |
| FRESULT res; |
| UINT nent; |
| BYTE *dirb = dp->obj.fs->dirbuf; /* Pointer to the directory entry block 85+C0+C1s */ |
| |
| /* Create set sum */ |
| st_word(dirb + XDIR_SetSum, xdir_sum(dirb)); |
| nent = dirb[XDIR_NumSec] + 1; |
| |
| /* Store the directory entry block to the directory */ |
| res = dir_sdi(dp, dp->blk_ofs); |
| while (res == FR_OK) { |
| res = move_window(dp->obj.fs, dp->sect); |
| if (res != FR_OK) break; |
| memcpy(dp->dir, dirb, SZDIRE); |
| dp->obj.fs->wflag = 1; |
| if (--nent == 0) break; |
| dirb += SZDIRE; |
| res = dir_next(dp, 0); |
| } |
| return (res == FR_OK || res == FR_DISK_ERR) ? res : FR_INT_ERR; |
| } |
| |
| |
| |
| /*-------------------------------------------*/ |
| /* exFAT: Create a new directory entry block */ |
| /*-------------------------------------------*/ |
| |
| static void create_xdir ( |
| BYTE* dirb, /* Pointer to the directory entry block buffer */ |
| const WCHAR* lfn /* Pointer to the object name */ |
| ) |
| { |
| UINT i; |
| BYTE nc1, nlen; |
| WCHAR wc; |
| |
| |
| /* Create file-directory and stream-extension entry */ |
| memset(dirb, 0, 2 * SZDIRE); |
| dirb[0 * SZDIRE + XDIR_Type] = ET_FILEDIR; |
| dirb[1 * SZDIRE + XDIR_Type] = ET_STREAM; |
| |
| /* Create file-name entries */ |
| i = SZDIRE * 2; /* Top of file_name entries */ |
| nlen = nc1 = 0; wc = 1; |
| do { |
| dirb[i++] = ET_FILENAME; dirb[i++] = 0; |
| do { /* Fill name field */ |
| if (wc != 0 && (wc = lfn[nlen]) != 0) nlen++; /* Get a character if exist */ |
| st_word(dirb + i, wc); /* Store it */ |
| i += 2; |
| } while (i % SZDIRE != 0); |
| nc1++; |
| } while (lfn[nlen]); /* Fill next entry if any char follows */ |
| |
| dirb[XDIR_NumName] = nlen; /* Set name length */ |
| dirb[XDIR_NumSec] = 1 + nc1; /* Set secondary count (C0 + C1s) */ |
| st_word(dirb + XDIR_NameHash, xname_sum(lfn)); /* Set name hash */ |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| #endif /* FF_FS_EXFAT */ |
| |
| |
| |
| #if FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2 || FF_USE_LABEL || FF_FS_EXFAT |
| /*-----------------------------------------------------------------------*/ |
| /* Read an object from the directory */ |
| /*-----------------------------------------------------------------------*/ |
| |
| #define DIR_READ_FILE(dp) dir_read(dp, 0) |
| #define DIR_READ_LABEL(dp) dir_read(dp, 1) |
| |
| static FRESULT dir_read ( |
| DIR* dp, /* Pointer to the directory object */ |
| int vol /* Filtered by 0:file/directory or 1:volume label */ |
| ) |
| { |
| FRESULT res = FR_NO_FILE; |
| FATFS *fs = dp->obj.fs; |
| BYTE attr, b; |
| #if FF_USE_LFN |
| BYTE ord = 0xFF, sum = 0xFF; |
| #endif |
| |
| while (dp->sect) { |
| res = move_window(fs, dp->sect); |
| if (res != FR_OK) break; |
| b = dp->dir[DIR_Name]; /* Test for the entry type */ |
| if (b == 0) { |
| res = FR_NO_FILE; break; /* Reached to end of the directory */ |
| } |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */ |
| if (FF_USE_LABEL && vol) { |
| if (b == ET_VLABEL) break; /* Volume label entry? */ |
| } else { |
| if (b == ET_FILEDIR) { /* Start of the file entry block? */ |
| dp->blk_ofs = dp->dptr; /* Get location of the block */ |
| res = load_xdir(dp); /* Load the entry block */ |
| if (res == FR_OK) { |
| dp->obj.attr = fs->dirbuf[XDIR_Attr] & AM_MASK; /* Get attribute */ |
| } |
| break; |
| } |
| } |
| } else |
| #endif |
| { /* On the FAT/FAT32 volume */ |
| dp->obj.attr = attr = dp->dir[DIR_Attr] & AM_MASK; /* Get attribute */ |
| #if FF_USE_LFN /* LFN configuration */ |
| if (b == DDEM || b == '.' || (int)((attr & ~AM_ARC) == AM_VOL) != vol) { /* An entry without valid data */ |
| ord = 0xFF; |
| } else { |
| if (attr == AM_LFN) { /* An LFN entry is found */ |
| if (b & LLEF) { /* Is it start of an LFN sequence? */ |
| sum = dp->dir[LDIR_Chksum]; |
| b &= (BYTE)~LLEF; ord = b; |
| dp->blk_ofs = dp->dptr; |
| } |
| /* Check LFN validity and capture it */ |
| ord = (b == ord && sum == dp->dir[LDIR_Chksum] && pick_lfn(fs->lfnbuf, dp->dir)) ? ord - 1 : 0xFF; |
| } else { /* An SFN entry is found */ |
| if (ord != 0 || sum != sum_sfn(dp->dir)) { /* Is there a valid LFN? */ |
| dp->blk_ofs = 0xFFFFFFFF; /* It has no LFN. */ |
| } |
| break; |
| } |
| } |
| #else /* Non LFN configuration */ |
| if (b != DDEM && b != '.' && attr != AM_LFN && (int)((attr & ~AM_ARC) == AM_VOL) == vol) { /* Is it a valid entry? */ |
| break; |
| } |
| #endif |
| } |
| res = dir_next(dp, 0); /* Next entry */ |
| if (res != FR_OK) break; |
| } |
| |
| if (res != FR_OK) dp->sect = 0; /* Terminate the read operation on error or EOT */ |
| return res; |
| } |
| |
| #endif /* FF_FS_MINIMIZE <= 1 || FF_USE_LABEL || FF_FS_RPATH >= 2 */ |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Directory handling - Find an object in the directory */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT dir_find ( /* FR_OK(0):succeeded, !=0:error */ |
| DIR* dp /* Pointer to the directory object with the file name */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs = dp->obj.fs; |
| BYTE c; |
| #if FF_USE_LFN |
| BYTE a, ord, sum; |
| #endif |
| |
| res = dir_sdi(dp, 0); /* Rewind directory object */ |
| if (res != FR_OK) return res; |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */ |
| BYTE nc; |
| UINT di, ni; |
| WORD hash = xname_sum(fs->lfnbuf); /* Hash value of the name to find */ |
| |
| while ((res = DIR_READ_FILE(dp)) == FR_OK) { /* Read an item */ |
| #if FF_MAX_LFN < 255 |
| if (fs->dirbuf[XDIR_NumName] > FF_MAX_LFN) continue; /* Skip comparison if inaccessible object name */ |
| #endif |
| if (ld_word(fs->dirbuf + XDIR_NameHash) != hash) continue; /* Skip comparison if hash mismatched */ |
| for (nc = fs->dirbuf[XDIR_NumName], di = SZDIRE * 2, ni = 0; nc; nc--, di += 2, ni++) { /* Compare the name */ |
| if ((di % SZDIRE) == 0) di += 2; |
| if (ff_wtoupper(ld_word(fs->dirbuf + di)) != ff_wtoupper(fs->lfnbuf[ni])) break; |
| } |
| if (nc == 0 && !fs->lfnbuf[ni]) break; /* Name matched? */ |
| } |
| return res; |
| } |
| #endif |
| /* On the FAT/FAT32 volume */ |
| #if FF_USE_LFN |
| ord = sum = 0xFF; dp->blk_ofs = 0xFFFFFFFF; /* Reset LFN sequence */ |
| #endif |
| do { |
| res = move_window(fs, dp->sect); |
| if (res != FR_OK) break; |
| c = dp->dir[DIR_Name]; |
| if (c == 0) { res = FR_NO_FILE; break; } /* Reached to end of table */ |
| #if FF_USE_LFN /* LFN configuration */ |
| dp->obj.attr = a = dp->dir[DIR_Attr] & AM_MASK; |
| if (c == DDEM || ((a & AM_VOL) && a != AM_LFN)) { /* An entry without valid data */ |
| ord = 0xFF; dp->blk_ofs = 0xFFFFFFFF; /* Reset LFN sequence */ |
| } else { |
| if (a == AM_LFN) { /* An LFN entry is found */ |
| if (!(dp->fn[NSFLAG] & NS_NOLFN)) { |
| if (c & LLEF) { /* Is it start of LFN sequence? */ |
| sum = dp->dir[LDIR_Chksum]; |
| c &= (BYTE)~LLEF; ord = c; /* LFN start order */ |
| dp->blk_ofs = dp->dptr; /* Start offset of LFN */ |
| } |
| /* Check validity of the LFN entry and compare it with given name */ |
| ord = (c == ord && sum == dp->dir[LDIR_Chksum] && cmp_lfn(fs->lfnbuf, dp->dir)) ? ord - 1 : 0xFF; |
| } |
| } else { /* An SFN entry is found */ |
| if (ord == 0 && sum == sum_sfn(dp->dir)) break; /* LFN matched? */ |
| if (!(dp->fn[NSFLAG] & NS_LOSS) && !memcmp(dp->dir, dp->fn, 11)) break; /* SFN matched? */ |
| ord = 0xFF; dp->blk_ofs = 0xFFFFFFFF; /* Reset LFN sequence */ |
| } |
| } |
| #else /* Non LFN configuration */ |
| dp->obj.attr = dp->dir[DIR_Attr] & AM_MASK; |
| if (!(dp->dir[DIR_Attr] & AM_VOL) && !memcmp(dp->dir, dp->fn, 11)) break; /* Is it a valid entry? */ |
| #endif |
| res = dir_next(dp, 0); /* Next entry */ |
| } while (res == FR_OK); |
| |
| return res; |
| } |
| |
| |
| |
| |
| #if !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* Register an object to the directory */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT dir_register ( /* FR_OK:succeeded, FR_DENIED:no free entry or too many SFN collision, FR_DISK_ERR:disk error */ |
| DIR* dp /* Target directory with object name to be created */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs = dp->obj.fs; |
| #if FF_USE_LFN /* LFN configuration */ |
| UINT n, len, n_ent; |
| BYTE sn[12], sum; |
| |
| |
| if (dp->fn[NSFLAG] & (NS_DOT | NS_NONAME)) return FR_INVALID_NAME; /* Check name validity */ |
| for (len = 0; fs->lfnbuf[len]; len++) ; /* Get lfn length */ |
| |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */ |
| n_ent = (len + 14) / 15 + 2; /* Number of entries to allocate (85+C0+C1s) */ |
| res = dir_alloc(dp, n_ent); /* Allocate directory entries */ |
| if (res != FR_OK) return res; |
| dp->blk_ofs = dp->dptr - SZDIRE * (n_ent - 1); /* Set the allocated entry block offset */ |
| |
| if (dp->obj.stat & 4) { /* Has the directory been stretched by new allocation? */ |
| dp->obj.stat &= ~4; |
| res = fill_first_frag(&dp->obj); /* Fill the first fragment on the FAT if needed */ |
| if (res != FR_OK) return res; |
| res = fill_last_frag(&dp->obj, dp->clust, 0xFFFFFFFF); /* Fill the last fragment on the FAT if needed */ |
| if (res != FR_OK) return res; |
| if (dp->obj.sclust != 0) { /* Is it a sub-directory? */ |
| DIR dj; |
| |
| res = load_obj_xdir(&dj, &dp->obj); /* Load the object status */ |
| if (res != FR_OK) return res; |
| dp->obj.objsize += (DWORD)fs->csize * SS(fs); /* Increase the directory size by cluster size */ |
| st_qword(fs->dirbuf + XDIR_FileSize, dp->obj.objsize); |
| st_qword(fs->dirbuf + XDIR_ValidFileSize, dp->obj.objsize); |
| fs->dirbuf[XDIR_GenFlags] = dp->obj.stat | 1; /* Update the allocation status */ |
| res = store_xdir(&dj); /* Store the object status */ |
| if (res != FR_OK) return res; |
| } |
| } |
| |
| create_xdir(fs->dirbuf, fs->lfnbuf); /* Create on-memory directory block to be written later */ |
| return FR_OK; |
| } |
| #endif |
| /* On the FAT/FAT32 volume */ |
| memcpy(sn, dp->fn, 12); |
| if (sn[NSFLAG] & NS_LOSS) { /* When LFN is out of 8.3 format, generate a numbered name */ |
| dp->fn[NSFLAG] = NS_NOLFN; /* Find only SFN */ |
| for (n = 1; n < 100; n++) { |
| gen_numname(dp->fn, sn, fs->lfnbuf, n); /* Generate a numbered name */ |
| res = dir_find(dp); /* Check if the name collides with existing SFN */ |
| if (res != FR_OK) break; |
| } |
| if (n == 100) return FR_DENIED; /* Abort if too many collisions */ |
| if (res != FR_NO_FILE) return res; /* Abort if the result is other than 'not collided' */ |
| dp->fn[NSFLAG] = sn[NSFLAG]; |
| } |
| |
| /* Create an SFN with/without LFNs. */ |
| n_ent = (sn[NSFLAG] & NS_LFN) ? (len + 12) / 13 + 1 : 1; /* Number of entries to allocate */ |
| res = dir_alloc(dp, n_ent); /* Allocate entries */ |
| if (res == FR_OK && --n_ent) { /* Set LFN entry if needed */ |
| res = dir_sdi(dp, dp->dptr - n_ent * SZDIRE); |
| if (res == FR_OK) { |
| sum = sum_sfn(dp->fn); /* Checksum value of the SFN tied to the LFN */ |
| do { /* Store LFN entries in bottom first */ |
| res = move_window(fs, dp->sect); |
| if (res != FR_OK) break; |
| put_lfn(fs->lfnbuf, dp->dir, (BYTE)n_ent, sum); |
| fs->wflag = 1; |
| res = dir_next(dp, 0); /* Next entry */ |
| } while (res == FR_OK && --n_ent); |
| } |
| } |
| |
| #else /* Non LFN configuration */ |
| res = dir_alloc(dp, 1); /* Allocate an entry for SFN */ |
| |
| #endif |
| |
| /* Set SFN entry */ |
| if (res == FR_OK) { |
| res = move_window(fs, dp->sect); |
| if (res == FR_OK) { |
| memset(dp->dir, 0, SZDIRE); /* Clean the entry */ |
| memcpy(dp->dir + DIR_Name, dp->fn, 11); /* Put SFN */ |
| #if FF_USE_LFN |
| dp->dir[DIR_NTres] = dp->fn[NSFLAG] & (NS_BODY | NS_EXT); /* Put NT flag */ |
| #endif |
| fs->wflag = 1; |
| } |
| } |
| |
| return res; |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| |
| |
| |
| #if !FF_FS_READONLY && FF_FS_MINIMIZE == 0 |
| /*-----------------------------------------------------------------------*/ |
| /* Remove an object from the directory */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT dir_remove ( /* FR_OK:Succeeded, FR_DISK_ERR:A disk error */ |
| DIR* dp /* Directory object pointing the entry to be removed */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs = dp->obj.fs; |
| #if FF_USE_LFN /* LFN configuration */ |
| DWORD last = dp->dptr; |
| |
| res = (dp->blk_ofs == 0xFFFFFFFF) ? FR_OK : dir_sdi(dp, dp->blk_ofs); /* Goto top of the entry block if LFN is exist */ |
| if (res == FR_OK) { |
| do { |
| res = move_window(fs, dp->sect); |
| if (res != FR_OK) break; |
| if (FF_FS_EXFAT && fs->fs_type == FS_EXFAT) { /* On the exFAT volume */ |
| dp->dir[XDIR_Type] &= 0x7F; /* Clear the entry InUse flag. */ |
| } else { /* On the FAT/FAT32 volume */ |
| dp->dir[DIR_Name] = DDEM; /* Mark the entry 'deleted'. */ |
| } |
| fs->wflag = 1; |
| if (dp->dptr >= last) break; /* If reached last entry then all entries of the object has been deleted. */ |
| res = dir_next(dp, 0); /* Next entry */ |
| } while (res == FR_OK); |
| if (res == FR_NO_FILE) res = FR_INT_ERR; |
| } |
| #else /* Non LFN configuration */ |
| |
| res = move_window(fs, dp->sect); |
| if (res == FR_OK) { |
| dp->dir[DIR_Name] = DDEM; /* Mark the entry 'deleted'.*/ |
| fs->wflag = 1; |
| } |
| #endif |
| |
| return res; |
| } |
| |
| #endif /* !FF_FS_READONLY && FF_FS_MINIMIZE == 0 */ |
| |
| |
| |
| #if FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2 |
| /*-----------------------------------------------------------------------*/ |
| /* Get file information from directory entry */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static void get_fileinfo ( |
| DIR* dp, /* Pointer to the directory object */ |
| FILINFO* fno /* Pointer to the file information to be filled */ |
| ) |
| { |
| UINT si, di; |
| #if FF_USE_LFN |
| BYTE lcf; |
| WCHAR wc, hs; |
| FATFS *fs = dp->obj.fs; |
| UINT nw; |
| #else |
| TCHAR c; |
| #endif |
| |
| |
| fno->fname[0] = 0; /* Invaidate file info */ |
| if (dp->sect == 0) return; /* Exit if read pointer has reached end of directory */ |
| |
| #if FF_USE_LFN /* LFN configuration */ |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* exFAT volume */ |
| UINT nc = 0; |
| |
| si = SZDIRE * 2; di = 0; /* 1st C1 entry in the entry block */ |
| hs = 0; |
| while (nc < fs->dirbuf[XDIR_NumName]) { |
| if (si >= MAXDIRB(FF_MAX_LFN)) { /* Truncated directory block? */ |
| di = 0; break; |
| } |
| if ((si % SZDIRE) == 0) si += 2; /* Skip entry type field */ |
| wc = ld_word(fs->dirbuf + si); si += 2; nc++; /* Get a character */ |
| if (hs == 0 && IsSurrogate(wc)) { /* Is it a surrogate? */ |
| hs = wc; continue; /* Get low surrogate */ |
| } |
| nw = put_utf((DWORD)hs << 16 | wc, &fno->fname[di], FF_LFN_BUF - di); /* Store it in API encoding */ |
| if (nw == 0) { /* Buffer overflow or wrong char? */ |
| di = 0; break; |
| } |
| di += nw; |
| hs = 0; |
| } |
| if (hs != 0) di = 0; /* Broken surrogate pair? */ |
| if (di == 0) fno->fname[di++] = '\?'; /* Inaccessible object name? */ |
| fno->fname[di] = 0; /* Terminate the name */ |
| fno->altname[0] = 0; /* exFAT does not support SFN */ |
| |
| fno->fattrib = fs->dirbuf[XDIR_Attr] & AM_MASKX; /* Attribute */ |
| fno->fsize = (fno->fattrib & AM_DIR) ? 0 : ld_qword(fs->dirbuf + XDIR_FileSize); /* Size */ |
| fno->ftime = ld_word(fs->dirbuf + XDIR_ModTime + 0); /* Time */ |
| fno->fdate = ld_word(fs->dirbuf + XDIR_ModTime + 2); /* Date */ |
| return; |
| } else |
| #endif |
| { /* FAT/FAT32 volume */ |
| if (dp->blk_ofs != 0xFFFFFFFF) { /* Get LFN if available */ |
| si = di = 0; |
| hs = 0; |
| while (fs->lfnbuf[si] != 0) { |
| wc = fs->lfnbuf[si++]; /* Get an LFN character (UTF-16) */ |
| if (hs == 0 && IsSurrogate(wc)) { /* Is it a surrogate? */ |
| hs = wc; continue; /* Get low surrogate */ |
| } |
| nw = put_utf((DWORD)hs << 16 | wc, &fno->fname[di], FF_LFN_BUF - di); /* Store it in API encoding */ |
| if (nw == 0) { /* Buffer overflow or wrong char? */ |
| di = 0; break; |
| } |
| di += nw; |
| hs = 0; |
| } |
| if (hs != 0) di = 0; /* Broken surrogate pair? */ |
| fno->fname[di] = 0; /* Terminate the LFN (null string means LFN is invalid) */ |
| } |
| } |
| |
| si = di = 0; |
| while (si < 11) { /* Get SFN from SFN entry */ |
| wc = dp->dir[si++]; /* Get a char */ |
| if (wc == ' ') continue; /* Skip padding spaces */ |
| if (wc == RDDEM) wc = DDEM; /* Restore replaced DDEM character */ |
| if (si == 9 && di < FF_SFN_BUF) fno->altname[di++] = '.'; /* Insert a . if extension is exist */ |
| #if FF_LFN_UNICODE >= 1 /* Unicode output */ |
| if (dbc_1st((BYTE)wc) && si != 8 && si != 11 && dbc_2nd(dp->dir[si])) { /* Make a DBC if needed */ |
| wc = wc << 8 | dp->dir[si++]; |
| } |
| wc = ff_oem2uni(wc, CODEPAGE); /* ANSI/OEM -> Unicode */ |
| if (wc == 0) { /* Wrong char in the current code page? */ |
| di = 0; break; |
| } |
| nw = put_utf(wc, &fno->altname[di], FF_SFN_BUF - di); /* Store it in API encoding */ |
| if (nw == 0) { /* Buffer overflow? */ |
| di = 0; break; |
| } |
| di += nw; |
| #else /* ANSI/OEM output */ |
| fno->altname[di++] = (TCHAR)wc; /* Store it without any conversion */ |
| #endif |
| } |
| fno->altname[di] = 0; /* Terminate the SFN (null string means SFN is invalid) */ |
| |
| if (fno->fname[0] == 0) { /* If LFN is invalid, altname[] needs to be copied to fname[] */ |
| if (di == 0) { /* If LFN and SFN both are invalid, this object is inaccessible */ |
| fno->fname[di++] = '\?'; |
| } else { |
| for (si = di = 0, lcf = NS_BODY; fno->altname[si]; si++, di++) { /* Copy altname[] to fname[] with case information */ |
| wc = (WCHAR)fno->altname[si]; |
| if (wc == '.') lcf = NS_EXT; |
| if (IsUpper(wc) && (dp->dir[DIR_NTres] & lcf)) wc += 0x20; |
| fno->fname[di] = (TCHAR)wc; |
| } |
| } |
| fno->fname[di] = 0; /* Terminate the LFN */ |
| if (!dp->dir[DIR_NTres]) fno->altname[0] = 0; /* Altname is not needed if neither LFN nor case info is exist. */ |
| } |
| |
| #else /* Non-LFN configuration */ |
| si = di = 0; |
| while (si < 11) { /* Copy name body and extension */ |
| c = (TCHAR)dp->dir[si++]; |
| if (c == ' ') continue; /* Skip padding spaces */ |
| if (c == RDDEM) c = DDEM; /* Restore replaced DDEM character */ |
| if (si == 9) fno->fname[di++] = '.';/* Insert a . if extension is exist */ |
| fno->fname[di++] = c; |
| } |
| fno->fname[di] = 0; /* Terminate the SFN */ |
| #endif |
| |
| fno->fattrib = dp->dir[DIR_Attr] & AM_MASK; /* Attribute */ |
| fno->fsize = ld_dword(dp->dir + DIR_FileSize); /* Size */ |
| fno->ftime = ld_word(dp->dir + DIR_ModTime + 0); /* Time */ |
| fno->fdate = ld_word(dp->dir + DIR_ModTime + 2); /* Date */ |
| } |
| |
| #endif /* FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2 */ |
| |
| |
| |
| #if FF_USE_FIND && FF_FS_MINIMIZE <= 1 |
| /*-----------------------------------------------------------------------*/ |
| /* Pattern matching */ |
| /*-----------------------------------------------------------------------*/ |
| |
| #define FIND_RECURS 4 /* Maximum number of wildcard terms in the pattern to limit recursion */ |
| |
| |
| static DWORD get_achar ( /* Get a character and advance ptr */ |
| const TCHAR** ptr /* Pointer to pointer to the ANSI/OEM or Unicode string */ |
| ) |
| { |
| DWORD chr; |
| |
| |
| #if FF_USE_LFN && FF_LFN_UNICODE >= 1 /* Unicode input */ |
| chr = tchar2uni(ptr); |
| if (chr == 0xFFFFFFFF) chr = 0; /* Wrong UTF encoding is recognized as end of the string */ |
| chr = ff_wtoupper(chr); |
| |
| #else /* ANSI/OEM input */ |
| chr = (BYTE)*(*ptr)++; /* Get a byte */ |
| if (IsLower(chr)) chr -= 0x20; /* To upper ASCII char */ |
| #if FF_CODE_PAGE == 0 |
| if (ExCvt && chr >= 0x80) chr = ExCvt[chr - 0x80]; /* To upper SBCS extended char */ |
| #elif FF_CODE_PAGE < 900 |
| if (chr >= 0x80) chr = ExCvt[chr - 0x80]; /* To upper SBCS extended char */ |
| #endif |
| #if FF_CODE_PAGE == 0 || FF_CODE_PAGE >= 900 |
| if (dbc_1st((BYTE)chr)) { /* Get DBC 2nd byte if needed */ |
| chr = dbc_2nd((BYTE)**ptr) ? chr << 8 | (BYTE)*(*ptr)++ : 0; |
| } |
| #endif |
| |
| #endif |
| return chr; |
| } |
| |
| |
| static int pattern_match ( /* 0:mismatched, 1:matched */ |
| const TCHAR* pat, /* Matching pattern */ |
| const TCHAR* nam, /* String to be tested */ |
| UINT skip, /* Number of pre-skip chars (number of ?s, b8:infinite (* specified)) */ |
| UINT recur /* Recursion count */ |
| ) |
| { |
| const TCHAR *pptr; |
| const TCHAR *nptr; |
| DWORD pchr, nchr; |
| UINT sk; |
| |
| |
| while ((skip & 0xFF) != 0) { /* Pre-skip name chars */ |
| if (!get_achar(&nam)) return 0; /* Branch mismatched if less name chars */ |
| skip--; |
| } |
| if (*pat == 0 && skip) return 1; /* Matched? (short circuit) */ |
| |
| do { |
| pptr = pat; nptr = nam; /* Top of pattern and name to match */ |
| for (;;) { |
| if (*pptr == '\?' || *pptr == '*') { /* Wildcard term? */ |
| if (recur == 0) return 0; /* Too many wildcard terms? */ |
| sk = 0; |
| do { /* Analyze the wildcard term */ |
| if (*pptr++ == '\?') { |
| sk++; |
| } else { |
| sk |= 0x100; |
| } |
| } while (*pptr == '\?' || *pptr == '*'); |
| if (pattern_match(pptr, nptr, sk, recur - 1)) return 1; /* Test new branch (recursive call) */ |
| nchr = *nptr; break; /* Branch mismatched */ |
| } |
| pchr = get_achar(&pptr); /* Get a pattern char */ |
| nchr = get_achar(&nptr); /* Get a name char */ |
| if (pchr != nchr) break; /* Branch mismatched? */ |
| if (pchr == 0) return 1; /* Branch matched? (matched at end of both strings) */ |
| } |
| get_achar(&nam); /* nam++ */ |
| } while (skip && nchr); /* Retry until end of name if infinite search is specified */ |
| |
| return 0; |
| } |
| |
| #endif /* FF_USE_FIND && FF_FS_MINIMIZE <= 1 */ |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Pick a top segment and create the object name in directory form */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT create_name ( /* FR_OK: successful, FR_INVALID_NAME: could not create */ |
| DIR* dp, /* Pointer to the directory object */ |
| const TCHAR** path /* Pointer to pointer to the segment in the path string */ |
| ) |
| { |
| #if FF_USE_LFN /* LFN configuration */ |
| BYTE b, cf; |
| WCHAR wc; |
| WCHAR *lfn; |
| const TCHAR* p; |
| DWORD uc; |
| UINT i, ni, si, di; |
| |
| |
| /* Create LFN into LFN working buffer */ |
| p = *path; lfn = dp->obj.fs->lfnbuf; di = 0; |
| for (;;) { |
| uc = tchar2uni(&p); /* Get a character */ |
| if (uc == 0xFFFFFFFF) return FR_INVALID_NAME; /* Invalid code or UTF decode error */ |
| if (uc >= 0x10000) lfn[di++] = (WCHAR)(uc >> 16); /* Store high surrogate if needed */ |
| wc = (WCHAR)uc; |
| if (wc < ' ' || IsSeparator(wc)) break; /* Break if end of the path or a separator is found */ |
| if (wc < 0x80 && strchr("*:<>|\"\?\x7F", (int)wc)) return FR_INVALID_NAME; /* Reject illegal characters for LFN */ |
| if (di >= FF_MAX_LFN) return FR_INVALID_NAME; /* Reject too long name */ |
| lfn[di++] = wc; /* Store the Unicode character */ |
| } |
| if (wc < ' ') { /* Stopped at end of the path? */ |
| cf = NS_LAST; /* Last segment */ |
| } else { /* Stopped at a separator */ |
| while (IsSeparator(*p)) p++; /* Skip duplicated separators if exist */ |
| cf = 0; /* Next segment may follow */ |
| if (IsTerminator(*p)) cf = NS_LAST; /* Ignore terminating separator */ |
| } |
| *path = p; /* Return pointer to the next segment */ |
| |
| #if FF_FS_RPATH != 0 |
| if ((di == 1 && lfn[di - 1] == '.') || |
| (di == 2 && lfn[di - 1] == '.' && lfn[di - 2] == '.')) { /* Is this segment a dot name? */ |
| lfn[di] = 0; |
| for (i = 0; i < 11; i++) { /* Create dot name for SFN entry */ |
| dp->fn[i] = (i < di) ? '.' : ' '; |
| } |
| dp->fn[i] = cf | NS_DOT; /* This is a dot entry */ |
| return FR_OK; |
| } |
| #endif |
| while (di) { /* Snip off trailing spaces and dots if exist */ |
| wc = lfn[di - 1]; |
| if (wc != ' ' && wc != '.') break; |
| di--; |
| } |
| lfn[di] = 0; /* LFN is created into the working buffer */ |
| if (di == 0) return FR_INVALID_NAME; /* Reject null name */ |
| |
| /* Create SFN in directory form */ |
| for (si = 0; lfn[si] == ' '; si++) ; /* Remove leading spaces */ |
| if (si > 0 || lfn[si] == '.') cf |= NS_LOSS | NS_LFN; /* Is there any leading space or dot? */ |
| while (di > 0 && lfn[di - 1] != '.') di--; /* Find last dot (di<=si: no extension) */ |
| |
| memset(dp->fn, ' ', 11); |
| i = b = 0; ni = 8; |
| for (;;) { |
| wc = lfn[si++]; /* Get an LFN character */ |
| if (wc == 0) break; /* Break on end of the LFN */ |
| if (wc == ' ' || (wc == '.' && si != di)) { /* Remove embedded spaces and dots */ |
| cf |= NS_LOSS | NS_LFN; |
| continue; |
| } |
| |
| if (i >= ni || si == di) { /* End of field? */ |
| if (ni == 11) { /* Name extension overflow? */ |
| cf |= NS_LOSS | NS_LFN; |
| break; |
| } |
| if (si != di) cf |= NS_LOSS | NS_LFN; /* Name body overflow? */ |
| if (si > di) break; /* No name extension? */ |
| si = di; i = 8; ni = 11; b <<= 2; /* Enter name extension */ |
| continue; |
| } |
| |
| if (wc >= 0x80) { /* Is this an extended character? */ |
| cf |= NS_LFN; /* LFN entry needs to be created */ |
| #if FF_CODE_PAGE == 0 |
| if (ExCvt) { /* In SBCS cfg */ |
| wc = ff_uni2oem(wc, CODEPAGE); /* Unicode ==> ANSI/OEM code */ |
| if (wc & 0x80) wc = ExCvt[wc & 0x7F]; /* Convert extended character to upper (SBCS) */ |
| } else { /* In DBCS cfg */ |
| wc = ff_uni2oem(ff_wtoupper(wc), CODEPAGE); /* Unicode ==> Up-convert ==> ANSI/OEM code */ |
| } |
| #elif FF_CODE_PAGE < 900 /* In SBCS cfg */ |
| wc = ff_uni2oem(wc, CODEPAGE); /* Unicode ==> ANSI/OEM code */ |
| if (wc & 0x80) wc = ExCvt[wc & 0x7F]; /* Convert extended character to upper (SBCS) */ |
| #else /* In DBCS cfg */ |
| wc = ff_uni2oem(ff_wtoupper(wc), CODEPAGE); /* Unicode ==> Up-convert ==> ANSI/OEM code */ |
| #endif |
| } |
| |
| if (wc >= 0x100) { /* Is this a DBC? */ |
| if (i >= ni - 1) { /* Field overflow? */ |
| cf |= NS_LOSS | NS_LFN; |
| i = ni; continue; /* Next field */ |
| } |
| dp->fn[i++] = (BYTE)(wc >> 8); /* Put 1st byte */ |
| } else { /* SBC */ |
| if (wc == 0 || strchr("+,;=[]", (int)wc)) { /* Replace illegal characters for SFN */ |
| wc = '_'; cf |= NS_LOSS | NS_LFN;/* Lossy conversion */ |
| } else { |
| if (IsUpper(wc)) { /* ASCII upper case? */ |
| b |= 2; |
| } |
| if (IsLower(wc)) { /* ASCII lower case? */ |
| b |= 1; wc -= 0x20; |
| } |
| } |
| } |
| dp->fn[i++] = (BYTE)wc; |
| } |
| |
| if (dp->fn[0] == DDEM) dp->fn[0] = RDDEM; /* If the first character collides with DDEM, replace it with RDDEM */ |
| |
| if (ni == 8) b <<= 2; /* Shift capital flags if no extension */ |
| if ((b & 0x0C) == 0x0C || (b & 0x03) == 0x03) cf |= NS_LFN; /* LFN entry needs to be created if composite capitals */ |
| if (!(cf & NS_LFN)) { /* When LFN is in 8.3 format without extended character, NT flags are created */ |
| if (b & 0x01) cf |= NS_EXT; /* NT flag (Extension has small capital letters only) */ |
| if (b & 0x04) cf |= NS_BODY; /* NT flag (Body has small capital letters only) */ |
| } |
| |
| dp->fn[NSFLAG] = cf; /* SFN is created into dp->fn[] */ |
| |
| return FR_OK; |
| |
| |
| #else /* FF_USE_LFN : Non-LFN configuration */ |
| BYTE c, d; |
| BYTE *sfn; |
| UINT ni, si, i; |
| const char *p; |
| |
| /* Create file name in directory form */ |
| p = *path; sfn = dp->fn; |
| memset(sfn, ' ', 11); |
| si = i = 0; ni = 8; |
| #if FF_FS_RPATH != 0 |
| if (p[si] == '.') { /* Is this a dot entry? */ |
| for (;;) { |
| c = (BYTE)p[si++]; |
| if (c != '.' || si >= 3) break; |
| sfn[i++] = c; |
| } |
| if (!IsSeparator(c) && c > ' ') return FR_INVALID_NAME; |
| *path = p + si; /* Return pointer to the next segment */ |
| sfn[NSFLAG] = (c <= ' ') ? NS_LAST | NS_DOT : NS_DOT; /* Set last segment flag if end of the path */ |
| return FR_OK; |
| } |
| #endif |
| for (;;) { |
| c = (BYTE)p[si++]; /* Get a byte */ |
| if (c <= ' ') break; /* Break if end of the path name */ |
| if (IsSeparator(c)) { /* Break if a separator is found */ |
| while (IsSeparator(p[si])) si++; /* Skip duplicated separator if exist */ |
| break; |
| } |
| if (c == '.' || i >= ni) { /* End of body or field overflow? */ |
| if (ni == 11 || c != '.') return FR_INVALID_NAME; /* Field overflow or invalid dot? */ |
| i = 8; ni = 11; /* Enter file extension field */ |
| continue; |
| } |
| #if FF_CODE_PAGE == 0 |
| if (ExCvt && c >= 0x80) { /* Is SBC extended character? */ |
| c = ExCvt[c & 0x7F]; /* To upper SBC extended character */ |
| } |
| #elif FF_CODE_PAGE < 900 |
| if (c >= 0x80) { /* Is SBC extended character? */ |
| c = ExCvt[c & 0x7F]; /* To upper SBC extended character */ |
| } |
| #endif |
| if (dbc_1st(c)) { /* Check if it is a DBC 1st byte */ |
| d = (BYTE)p[si++]; /* Get 2nd byte */ |
| if (!dbc_2nd(d) || i >= ni - 1) return FR_INVALID_NAME; /* Reject invalid DBC */ |
| sfn[i++] = c; |
| sfn[i++] = d; |
| } else { /* SBC */ |
| if (strchr("*+,:;<=>[]|\"\?\x7F", (int)c)) return FR_INVALID_NAME; /* Reject illegal chrs for SFN */ |
| if (IsLower(c)) c -= 0x20; /* To upper */ |
| sfn[i++] = c; |
| } |
| } |
| *path = &p[si]; /* Return pointer to the next segment */ |
| if (i == 0) return FR_INVALID_NAME; /* Reject nul string */ |
| |
| if (sfn[0] == DDEM) sfn[0] = RDDEM; /* If the first character collides with DDEM, replace it with RDDEM */ |
| sfn[NSFLAG] = (c <= ' ' || p[si] <= ' ') ? NS_LAST : 0; /* Set last segment flag if end of the path */ |
| |
| return FR_OK; |
| #endif /* FF_USE_LFN */ |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Follow a file path */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT follow_path ( /* FR_OK(0): successful, !=0: error code */ |
| DIR* dp, /* Directory object to return last directory and found object */ |
| const TCHAR* path /* Full-path string to find a file or directory */ |
| ) |
| { |
| FRESULT res; |
| BYTE ns; |
| FATFS *fs = dp->obj.fs; |
| |
| |
| #if FF_FS_RPATH != 0 |
| if (!IsSeparator(*path) && (FF_STR_VOLUME_ID != 2 || !IsTerminator(*path))) { /* Without heading separator */ |
| dp->obj.sclust = fs->cdir; /* Start at the current directory */ |
| } else |
| #endif |
| { /* With heading separator */ |
| while (IsSeparator(*path)) path++; /* Strip separators */ |
| dp->obj.sclust = 0; /* Start from the root directory */ |
| } |
| #if FF_FS_EXFAT |
| dp->obj.n_frag = 0; /* Invalidate last fragment counter of the object */ |
| #if FF_FS_RPATH != 0 |
| if (fs->fs_type == FS_EXFAT && dp->obj.sclust) { /* exFAT: Retrieve the sub-directory's status */ |
| DIR dj; |
| |
| dp->obj.c_scl = fs->cdc_scl; |
| dp->obj.c_size = fs->cdc_size; |
| dp->obj.c_ofs = fs->cdc_ofs; |
| res = load_obj_xdir(&dj, &dp->obj); |
| if (res != FR_OK) return res; |
| dp->obj.objsize = ld_dword(fs->dirbuf + XDIR_FileSize); |
| dp->obj.stat = fs->dirbuf[XDIR_GenFlags] & 2; |
| } |
| #endif |
| #endif |
| |
| if ((UINT)*path < ' ') { /* Null path name is the origin directory itself */ |
| dp->fn[NSFLAG] = NS_NONAME; |
| res = dir_sdi(dp, 0); |
| |
| } else { /* Follow path */ |
| for (;;) { |
| res = create_name(dp, &path); /* Get a segment name of the path */ |
| if (res != FR_OK) break; |
| res = dir_find(dp); /* Find an object with the segment name */ |
| ns = dp->fn[NSFLAG]; |
| if (res != FR_OK) { /* Failed to find the object */ |
| if (res == FR_NO_FILE) { /* Object is not found */ |
| if (FF_FS_RPATH && (ns & NS_DOT)) { /* If dot entry is not exist, stay there */ |
| if (!(ns & NS_LAST)) continue; /* Continue to follow if not last segment */ |
| dp->fn[NSFLAG] = NS_NONAME; |
| res = FR_OK; |
| } else { /* Could not find the object */ |
| if (!(ns & NS_LAST)) res = FR_NO_PATH; /* Adjust error code if not last segment */ |
| } |
| } |
| break; |
| } |
| if (ns & NS_LAST) break; /* Last segment matched. Function completed. */ |
| /* Get into the sub-directory */ |
| if (!(dp->obj.attr & AM_DIR)) { /* It is not a sub-directory and cannot follow */ |
| res = FR_NO_PATH; break; |
| } |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* Save containing directory information for next dir */ |
| dp->obj.c_scl = dp->obj.sclust; |
| dp->obj.c_size = ((DWORD)dp->obj.objsize & 0xFFFFFF00) | dp->obj.stat; |
| dp->obj.c_ofs = dp->blk_ofs; |
| init_alloc_info(fs, &dp->obj); /* Open next directory */ |
| } else |
| #endif |
| { |
| dp->obj.sclust = ld_clust(fs, fs->win + dp->dptr % SS(fs)); /* Open next directory */ |
| } |
| } |
| } |
| |
| return res; |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Get logical drive number from path name */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static int get_ldnumber ( /* Returns logical drive number (-1:invalid drive number or null pointer) */ |
| const TCHAR** path /* Pointer to pointer to the path name */ |
| ) |
| { |
| const TCHAR *tp; |
| const TCHAR *tt; |
| TCHAR tc; |
| int i; |
| int vol = -1; |
| #if FF_STR_VOLUME_ID /* Find string volume ID */ |
| const char *sp; |
| char c; |
| #endif |
| |
| tt = tp = *path; |
| if (!tp) return vol; /* Invalid path name? */ |
| do { /* Find a colon in the path */ |
| tc = *tt++; |
| } while (!IsTerminator(tc) && tc != ':'); |
| |
| if (tc == ':') { /* DOS/Windows style volume ID? */ |
| i = FF_VOLUMES; |
| if (IsDigit(*tp) && tp + 2 == tt) { /* Is there a numeric volume ID + colon? */ |
| i = (int)*tp - '0'; /* Get the LD number */ |
| } |
| #if FF_STR_VOLUME_ID == 1 /* Arbitrary string is enabled */ |
| else { |
| i = 0; |
| do { |
| sp = VolumeStr[i]; tp = *path; /* This string volume ID and path name */ |
| do { /* Compare the volume ID with path name */ |
| c = *sp++; tc = *tp++; |
| if (IsLower(c)) c -= 0x20; |
| if (IsLower(tc)) tc -= 0x20; |
| } while (c && (TCHAR)c == tc); |
| } while ((c || tp != tt) && ++i < FF_VOLUMES); /* Repeat for each id until pattern match */ |
| } |
| #endif |
| if (i < FF_VOLUMES) { /* If a volume ID is found, get the drive number and strip it */ |
| vol = i; /* Drive number */ |
| *path = tt; /* Snip the drive prefix off */ |
| } |
| return vol; |
| } |
| #if FF_STR_VOLUME_ID == 2 /* Unix style volume ID is enabled */ |
| if (*tp == '/') { /* Is there a volume ID? */ |
| while (*(tp + 1) == '/') tp++; /* Skip duplicated separator */ |
| i = 0; |
| do { |
| tt = tp; sp = VolumeStr[i]; /* Path name and this string volume ID */ |
| do { /* Compare the volume ID with path name */ |
| c = *sp++; tc = *(++tt); |
| if (IsLower(c)) c -= 0x20; |
| if (IsLower(tc)) tc -= 0x20; |
| } while (c && (TCHAR)c == tc); |
| } while ((c || (tc != '/' && !IsTerminator(tc))) && ++i < FF_VOLUMES); /* Repeat for each ID until pattern match */ |
| if (i < FF_VOLUMES) { /* If a volume ID is found, get the drive number and strip it */ |
| vol = i; /* Drive number */ |
| *path = tt; /* Snip the drive prefix off */ |
| } |
| return vol; |
| } |
| #endif |
| /* No drive prefix is found */ |
| #if FF_FS_RPATH != 0 |
| vol = CurrVol; /* Default drive is current drive */ |
| #else |
| vol = 0; /* Default drive is 0 */ |
| #endif |
| return vol; /* Return the default drive */ |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* GPT support functions */ |
| /*-----------------------------------------------------------------------*/ |
| |
| #if FF_LBA64 |
| |
| /* Calculate CRC32 in byte-by-byte */ |
| |
| static DWORD crc32 ( /* Returns next CRC value */ |
| DWORD crc, /* Current CRC value */ |
| BYTE d /* A byte to be processed */ |
| ) |
| { |
| BYTE b; |
| |
| |
| for (b = 1; b; b <<= 1) { |
| crc ^= (d & b) ? 1 : 0; |
| crc = (crc & 1) ? crc >> 1 ^ 0xEDB88320 : crc >> 1; |
| } |
| return crc; |
| } |
| |
| |
| /* Check validity of GPT header */ |
| |
| static int test_gpt_header ( /* 0:Invalid, 1:Valid */ |
| const BYTE* gpth /* Pointer to the GPT header */ |
| ) |
| { |
| UINT i; |
| DWORD bcc, hlen; |
| |
| |
| if (memcmp(gpth + GPTH_Sign, "EFI PART" "\0\0\1", 12)) return 0; /* Check signature and version (1.0) */ |
| hlen = ld_dword(gpth + GPTH_Size); /* Check header size */ |
| if (hlen < 92 || hlen > FF_MIN_SS) return 0; |
| for (i = 0, bcc = 0xFFFFFFFF; i < hlen; i++) { /* Check header BCC */ |
| bcc = crc32(bcc, i - GPTH_Bcc < 4 ? 0 : gpth[i]); |
| } |
| if (~bcc != ld_dword(gpth + GPTH_Bcc)) return 0; |
| if (ld_dword(gpth + GPTH_PteSize) != SZ_GPTE) return 0; /* Table entry size (must be SZ_GPTE bytes) */ |
| if (ld_dword(gpth + GPTH_PtNum) > 128) return 0; /* Table size (must be 128 entries or less) */ |
| |
| return 1; |
| } |
| |
| #if !FF_FS_READONLY && FF_USE_MKFS |
| |
| /* Generate random value */ |
| static DWORD make_rand ( |
| DWORD seed, /* Seed value */ |
| BYTE *buff, /* Output buffer */ |
| UINT n /* Data length */ |
| ) |
| { |
| UINT r; |
| |
| |
| if (seed == 0) seed = 1; |
| do { |
| for (r = 0; r < 8; r++) seed = seed & 1 ? seed >> 1 ^ 0xA3000000 : seed >> 1; /* Shift 8 bits the 32-bit LFSR */ |
| *buff++ = (BYTE)seed; |
| } while (--n); |
| return seed; |
| } |
| |
| #endif |
| #endif |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Load a sector and check if it is an FAT VBR */ |
| /*-----------------------------------------------------------------------*/ |
| |
| /* Check what the sector is */ |
| |
| static UINT check_fs ( /* 0:FAT/FAT32 VBR, 1:exFAT VBR, 2:Not FAT and valid BS, 3:Not FAT and invalid BS, 4:Disk error */ |
| FATFS* fs, /* Filesystem object */ |
| LBA_t sect /* Sector to load and check if it is an FAT-VBR or not */ |
| ) |
| { |
| WORD w, sign; |
| BYTE b; |
| |
| |
| fs->wflag = 0; fs->winsect = (LBA_t)0 - 1; /* Invaidate window */ |
| if (move_window(fs, sect) != FR_OK) return 4; /* Load the boot sector */ |
| sign = ld_word(fs->win + BS_55AA); |
| #if FF_FS_EXFAT |
| if (sign == 0xAA55 && !memcmp(fs->win + BS_JmpBoot, "\xEB\x76\x90" "EXFAT ", 11)) return 1; /* It is an exFAT VBR */ |
| #endif |
| b = fs->win[BS_JmpBoot]; |
| if (b == 0xEB || b == 0xE9 || b == 0xE8) { /* Valid JumpBoot code? (short jump, near jump or near call) */ |
| if (sign == 0xAA55 && !memcmp(fs->win + BS_FilSysType32, "FAT32 ", 8)) { |
| return 0; /* It is an FAT32 VBR */ |
| } |
| /* FAT volumes formatted with early MS-DOS lack BS_55AA and BS_FilSysType, so FAT VBR needs to be identified without them. */ |
| w = ld_word(fs->win + BPB_BytsPerSec); |
| b = fs->win[BPB_SecPerClus]; |
| if ((w & (w - 1)) == 0 && w >= FF_MIN_SS && w <= FF_MAX_SS /* Properness of sector size (512-4096 and 2^n) */ |
| && b != 0 && (b & (b - 1)) == 0 /* Properness of cluster size (2^n) */ |
| && ld_word(fs->win + BPB_RsvdSecCnt) != 0 /* Properness of reserved sectors (MNBZ) */ |
| && (UINT)fs->win[BPB_NumFATs] - 1 <= 1 /* Properness of FATs (1 or 2) */ |
| && ld_word(fs->win + BPB_RootEntCnt) != 0 /* Properness of root dir entries (MNBZ) */ |
| && (ld_word(fs->win + BPB_TotSec16) >= 128 || ld_dword(fs->win + BPB_TotSec32) >= 0x10000) /* Properness of volume sectors (>=128) */ |
| && ld_word(fs->win + BPB_FATSz16) != 0) { /* Properness of FAT size (MNBZ) */ |
| return 0; /* It can be presumed an FAT VBR */ |
| } |
| } |
| return sign == 0xAA55 ? 2 : 3; /* Not an FAT VBR (valid or invalid BS) */ |
| } |
| |
| |
| /* Find an FAT volume */ |
| /* (It supports only generic partitioning rules, MBR, GPT and SFD) */ |
| |
| static UINT find_volume ( /* Returns BS status found in the hosting drive */ |
| FATFS* fs, /* Filesystem object */ |
| UINT part /* Partition to fined = 0:find as SFD and partitions, >0:forced partition number */ |
| ) |
| { |
| UINT fmt, i; |
| DWORD mbr_pt[4]; |
| |
| |
| fmt = check_fs(fs, 0); /* Load sector 0 and check if it is an FAT VBR as SFD format */ |
| if (fmt != 2 && (fmt >= 3 || part == 0)) return fmt; /* Returns if it is an FAT VBR as auto scan, not a BS or disk error */ |
| |
| /* Sector 0 is not an FAT VBR or forced partition number wants a partition */ |
| |
| #if FF_LBA64 |
| if (fs->win[MBR_Table + PTE_System] == 0xEE) { /* GPT protective MBR? */ |
| DWORD n_ent, v_ent, ofs; |
| QWORD pt_lba; |
| |
| if (move_window(fs, 1) != FR_OK) return 4; /* Load GPT header sector (next to MBR) */ |
| if (!test_gpt_header(fs->win)) return 3; /* Check if GPT header is valid */ |
| n_ent = ld_dword(fs->win + GPTH_PtNum); /* Number of entries */ |
| pt_lba = ld_qword(fs->win + GPTH_PtOfs); /* Table location */ |
| for (v_ent = i = 0; i < n_ent; i++) { /* Find FAT partition */ |
| if (move_window(fs, pt_lba + i * SZ_GPTE / SS(fs)) != FR_OK) return 4; /* PT sector */ |
| ofs = i * SZ_GPTE % SS(fs); /* Offset in the sector */ |
| if (!memcmp(fs->win + ofs + GPTE_PtGuid, GUID_MS_Basic, 16)) { /* MS basic data partition? */ |
| v_ent++; |
| fmt = check_fs(fs, ld_qword(fs->win + ofs + GPTE_FstLba)); /* Load VBR and check status */ |
| if (part == 0 && fmt <= 1) return fmt; /* Auto search (valid FAT volume found first) */ |
| if (part != 0 && v_ent == part) return fmt; /* Forced partition order (regardless of it is valid or not) */ |
| } |
| } |
| return 3; /* Not found */ |
| } |
| #endif |
| if (FF_MULTI_PARTITION && part > 4) return 3; /* MBR has 4 partitions max */ |
| for (i = 0; i < 4; i++) { /* Load partition offset in the MBR */ |
| mbr_pt[i] = ld_dword(fs->win + MBR_Table + i * SZ_PTE + PTE_StLba); |
| } |
| i = part ? part - 1 : 0; /* Table index to find first */ |
| do { /* Find an FAT volume */ |
| fmt = mbr_pt[i] ? check_fs(fs, mbr_pt[i]) : 3; /* Check if the partition is FAT */ |
| } while (part == 0 && fmt >= 2 && ++i < 4); |
| return fmt; |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Determine logical drive number and mount the volume if needed */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT mount_volume ( /* FR_OK(0): successful, !=0: an error occurred */ |
| const TCHAR** path, /* Pointer to pointer to the path name (drive number) */ |
| FATFS** rfs, /* Pointer to pointer to the found filesystem object */ |
| BYTE mode /* Desiered access mode to check write protection */ |
| ) |
| { |
| int vol; |
| FATFS *fs; |
| DSTATUS stat; |
| LBA_t bsect; |
| DWORD tsect, sysect, fasize, nclst, szbfat; |
| WORD nrsv; |
| UINT fmt; |
| |
| |
| /* Get logical drive number */ |
| *rfs = 0; |
| vol = get_ldnumber(path); |
| if (vol < 0) return FR_INVALID_DRIVE; |
| |
| /* Check if the filesystem object is valid or not */ |
| fs = FatFs[vol]; /* Get pointer to the filesystem object */ |
| if (!fs) return FR_NOT_ENABLED; /* Is the filesystem object available? */ |
| #if FF_FS_REENTRANT |
| if (!lock_volume(fs, 1)) return FR_TIMEOUT; /* Lock the volume, and system if needed */ |
| #endif |
| *rfs = fs; /* Return pointer to the filesystem object */ |
| |
| mode &= (BYTE)~FA_READ; /* Desired access mode, write access or not */ |
| if (fs->fs_type != 0) { /* If the volume has been mounted */ |
| stat = disk_status(fs->pdrv); |
| if (!(stat & STA_NOINIT)) { /* and the physical drive is kept initialized */ |
| if (!FF_FS_READONLY && mode && (stat & STA_PROTECT)) { /* Check write protection if needed */ |
| return FR_WRITE_PROTECTED; |
| } |
| return FR_OK; /* The filesystem object is already valid */ |
| } |
| } |
| |
| /* The filesystem object is not valid. */ |
| /* Following code attempts to mount the volume. (find an FAT volume, analyze the BPB and initialize the filesystem object) */ |
| |
| fs->fs_type = 0; /* Invalidate the filesystem object */ |
| stat = disk_initialize(fs->pdrv); /* Initialize the volume hosting physical drive */ |
| if (stat & STA_NOINIT) { /* Check if the initialization succeeded */ |
| return FR_NOT_READY; /* Failed to initialize due to no medium or hard error */ |
| } |
| if (!FF_FS_READONLY && mode && (stat & STA_PROTECT)) { /* Check disk write protection if needed */ |
| return FR_WRITE_PROTECTED; |
| } |
| #if FF_MAX_SS != FF_MIN_SS /* Get sector size (multiple sector size cfg only) */ |
| if (disk_ioctl(fs->pdrv, GET_SECTOR_SIZE, &SS(fs)) != RES_OK) return FR_DISK_ERR; |
| if (SS(fs) > FF_MAX_SS || SS(fs) < FF_MIN_SS || (SS(fs) & (SS(fs) - 1))) return FR_DISK_ERR; |
| #endif |
| |
| /* Find an FAT volume on the hosting drive */ |
| fmt = find_volume(fs, LD2PT(vol)); |
| if (fmt == 4) return FR_DISK_ERR; /* An error occurred in the disk I/O layer */ |
| if (fmt >= 2) return FR_NO_FILESYSTEM; /* No FAT volume is found */ |
| bsect = fs->winsect; /* Volume offset in the hosting physical drive */ |
| |
| /* An FAT volume is found (bsect). Following code initializes the filesystem object */ |
| |
| #if FF_FS_EXFAT |
| if (fmt == 1) { |
| QWORD maxlba; |
| DWORD so, cv, bcl, i; |
| |
| for (i = BPB_ZeroedEx; i < BPB_ZeroedEx + 53 && fs->win[i] == 0; i++) ; /* Check zero filler */ |
| if (i < BPB_ZeroedEx + 53) return FR_NO_FILESYSTEM; |
| |
| if (ld_word(fs->win + BPB_FSVerEx) != 0x100) return FR_NO_FILESYSTEM; /* Check exFAT version (must be version 1.0) */ |
| |
| if (1 << fs->win[BPB_BytsPerSecEx] != SS(fs)) { /* (BPB_BytsPerSecEx must be equal to the physical sector size) */ |
| return FR_NO_FILESYSTEM; |
| } |
| |
| maxlba = ld_qword(fs->win + BPB_TotSecEx) + bsect; /* Last LBA of the volume + 1 */ |
| if (!FF_LBA64 && maxlba >= 0x100000000) return FR_NO_FILESYSTEM; /* (It cannot be accessed in 32-bit LBA) */ |
| |
| fs->fsize = ld_dword(fs->win + BPB_FatSzEx); /* Number of sectors per FAT */ |
| |
| fs->n_fats = fs->win[BPB_NumFATsEx]; /* Number of FATs */ |
| if (fs->n_fats != 1) return FR_NO_FILESYSTEM; /* (Supports only 1 FAT) */ |
| |
| fs->csize = 1 << fs->win[BPB_SecPerClusEx]; /* Cluster size */ |
| if (fs->csize == 0) return FR_NO_FILESYSTEM; /* (Must be 1..32768 sectors) */ |
| |
| nclst = ld_dword(fs->win + BPB_NumClusEx); /* Number of clusters */ |
| if (nclst > MAX_EXFAT) return FR_NO_FILESYSTEM; /* (Too many clusters) */ |
| fs->n_fatent = nclst + 2; |
| |
| /* Boundaries and Limits */ |
| fs->volbase = bsect; |
| fs->database = bsect + ld_dword(fs->win + BPB_DataOfsEx); |
| fs->fatbase = bsect + ld_dword(fs->win + BPB_FatOfsEx); |
| if (maxlba < (QWORD)fs->database + nclst * fs->csize) return FR_NO_FILESYSTEM; /* (Volume size must not be smaller than the size required) */ |
| fs->dirbase = ld_dword(fs->win + BPB_RootClusEx); |
| |
| /* Get bitmap location and check if it is contiguous (implementation assumption) */ |
| so = i = 0; |
| for (;;) { /* Find the bitmap entry in the root directory (in only first cluster) */ |
| if (i == 0) { |
| if (so >= fs->csize) return FR_NO_FILESYSTEM; /* Not found? */ |
| if (move_window(fs, clst2sect(fs, (DWORD)fs->dirbase) + so) != FR_OK) return FR_DISK_ERR; |
| so++; |
| } |
| if (fs->win[i] == ET_BITMAP) break; /* Is it a bitmap entry? */ |
| i = (i + SZDIRE) % SS(fs); /* Next entry */ |
| } |
| bcl = ld_dword(fs->win + i + 20); /* Bitmap cluster */ |
| if (bcl < 2 || bcl >= fs->n_fatent) return FR_NO_FILESYSTEM; /* (Wrong cluster#) */ |
| fs->bitbase = fs->database + fs->csize * (bcl - 2); /* Bitmap sector */ |
| for (;;) { /* Check if bitmap is contiguous */ |
| if (move_window(fs, fs->fatbase + bcl / (SS(fs) / 4)) != FR_OK) return FR_DISK_ERR; |
| cv = ld_dword(fs->win + bcl % (SS(fs) / 4) * 4); |
| if (cv == 0xFFFFFFFF) break; /* Last link? */ |
| if (cv != ++bcl) return FR_NO_FILESYSTEM; /* Fragmented bitmap? */ |
| } |
| |
| #if !FF_FS_READONLY |
| fs->last_clst = fs->free_clst = 0xFFFFFFFF; /* Initialize cluster allocation information */ |
| #endif |
| fmt = FS_EXFAT; /* FAT sub-type */ |
| } else |
| #endif /* FF_FS_EXFAT */ |
| { |
| if (ld_word(fs->win + BPB_BytsPerSec) != SS(fs)) return FR_NO_FILESYSTEM; /* (BPB_BytsPerSec must be equal to the physical sector size) */ |
| |
| fasize = ld_word(fs->win + BPB_FATSz16); /* Number of sectors per FAT */ |
| if (fasize == 0) fasize = ld_dword(fs->win + BPB_FATSz32); |
| fs->fsize = fasize; |
| |
| fs->n_fats = fs->win[BPB_NumFATs]; /* Number of FATs */ |
| if (fs->n_fats != 1 && fs->n_fats != 2) return FR_NO_FILESYSTEM; /* (Must be 1 or 2) */ |
| fasize *= fs->n_fats; /* Number of sectors for FAT area */ |
| |
| fs->csize = fs->win[BPB_SecPerClus]; /* Cluster size */ |
| if (fs->csize == 0 || (fs->csize & (fs->csize - 1))) return FR_NO_FILESYSTEM; /* (Must be power of 2) */ |
| |
| fs->n_rootdir = ld_word(fs->win + BPB_RootEntCnt); /* Number of root directory entries */ |
| if (fs->n_rootdir % (SS(fs) / SZDIRE)) return FR_NO_FILESYSTEM; /* (Must be sector aligned) */ |
| |
| tsect = ld_word(fs->win + BPB_TotSec16); /* Number of sectors on the volume */ |
| if (tsect == 0) tsect = ld_dword(fs->win + BPB_TotSec32); |
| |
| nrsv = ld_word(fs->win + BPB_RsvdSecCnt); /* Number of reserved sectors */ |
| if (nrsv == 0) return FR_NO_FILESYSTEM; /* (Must not be 0) */ |
| |
| /* Determine the FAT sub type */ |
| sysect = nrsv + fasize + fs->n_rootdir / (SS(fs) / SZDIRE); /* RSV + FAT + DIR */ |
| if (tsect < sysect) return FR_NO_FILESYSTEM; /* (Invalid volume size) */ |
| nclst = (tsect - sysect) / fs->csize; /* Number of clusters */ |
| if (nclst == 0) return FR_NO_FILESYSTEM; /* (Invalid volume size) */ |
| fmt = 0; |
| if (nclst <= MAX_FAT32) fmt = FS_FAT32; |
| if (nclst <= MAX_FAT16) fmt = FS_FAT16; |
| if (nclst <= MAX_FAT12) fmt = FS_FAT12; |
| if (fmt == 0) return FR_NO_FILESYSTEM; |
| |
| /* Boundaries and Limits */ |
| fs->n_fatent = nclst + 2; /* Number of FAT entries */ |
| fs->volbase = bsect; /* Volume start sector */ |
| fs->fatbase = bsect + nrsv; /* FAT start sector */ |
| fs->database = bsect + sysect; /* Data start sector */ |
| if (fmt == FS_FAT32) { |
| if (ld_word(fs->win + BPB_FSVer32) != 0) return FR_NO_FILESYSTEM; /* (Must be FAT32 revision 0.0) */ |
| if (fs->n_rootdir != 0) return FR_NO_FILESYSTEM; /* (BPB_RootEntCnt must be 0) */ |
| fs->dirbase = ld_dword(fs->win + BPB_RootClus32); /* Root directory start cluster */ |
| szbfat = fs->n_fatent * 4; /* (Needed FAT size) */ |
| } else { |
| if (fs->n_rootdir == 0) return FR_NO_FILESYSTEM; /* (BPB_RootEntCnt must not be 0) */ |
| fs->dirbase = fs->fatbase + fasize; /* Root directory start sector */ |
| szbfat = (fmt == FS_FAT16) ? /* (Needed FAT size) */ |
| fs->n_fatent * 2 : fs->n_fatent * 3 / 2 + (fs->n_fatent & 1); |
| } |
| if (fs->fsize < (szbfat + (SS(fs) - 1)) / SS(fs)) return FR_NO_FILESYSTEM; /* (BPB_FATSz must not be less than the size needed) */ |
| |
| #if !FF_FS_READONLY |
| /* Get FSInfo if available */ |
| fs->last_clst = fs->free_clst = 0xFFFFFFFF; /* Initialize cluster allocation information */ |
| fs->fsi_flag = 0x80; |
| #if (FF_FS_NOFSINFO & 3) != 3 |
| if (fmt == FS_FAT32 /* Allow to update FSInfo only if BPB_FSInfo32 == 1 */ |
| && ld_word(fs->win + BPB_FSInfo32) == 1 |
| && move_window(fs, bsect + 1) == FR_OK) |
| { |
| fs->fsi_flag = 0; |
| if (ld_word(fs->win + BS_55AA) == 0xAA55 /* Load FSInfo data if available */ |
| && ld_dword(fs->win + FSI_LeadSig) == 0x41615252 |
| && ld_dword(fs->win + FSI_StrucSig) == 0x61417272) |
| { |
| #if (FF_FS_NOFSINFO & 1) == 0 |
| fs->free_clst = ld_dword(fs->win + FSI_Free_Count); |
| #endif |
| #if (FF_FS_NOFSINFO & 2) == 0 |
| fs->last_clst = ld_dword(fs->win + FSI_Nxt_Free); |
| #endif |
| } |
| } |
| #endif /* (FF_FS_NOFSINFO & 3) != 3 */ |
| #endif /* !FF_FS_READONLY */ |
| } |
| |
| fs->fs_type = (BYTE)fmt;/* FAT sub-type (the filesystem object gets valid) */ |
| fs->id = ++Fsid; /* Volume mount ID */ |
| #if FF_USE_LFN == 1 |
| fs->lfnbuf = LfnBuf; /* Static LFN working buffer */ |
| #if FF_FS_EXFAT |
| fs->dirbuf = DirBuf; /* Static directory block scratchpad buuffer */ |
| #endif |
| #endif |
| #if FF_FS_RPATH != 0 |
| fs->cdir = 0; /* Initialize current directory */ |
| #endif |
| #if FF_FS_LOCK /* Clear file lock semaphores */ |
| clear_share(fs); |
| #endif |
| return FR_OK; |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Check if the file/directory object is valid or not */ |
| /*-----------------------------------------------------------------------*/ |
| |
| static FRESULT validate ( /* Returns FR_OK or FR_INVALID_OBJECT */ |
| FFOBJID* obj, /* Pointer to the FFOBJID, the 1st member in the FIL/DIR structure, to check validity */ |
| FATFS** rfs /* Pointer to pointer to the owner filesystem object to return */ |
| ) |
| { |
| FRESULT res = FR_INVALID_OBJECT; |
| |
| |
| if (obj && obj->fs && obj->fs->fs_type && obj->id == obj->fs->id) { /* Test if the object is valid */ |
| #if FF_FS_REENTRANT |
| if (lock_volume(obj->fs, 0)) { /* Take a grant to access the volume */ |
| if (!(disk_status(obj->fs->pdrv) & STA_NOINIT)) { /* Test if the hosting phsical drive is kept initialized */ |
| res = FR_OK; |
| } else { |
| unlock_volume(obj->fs, FR_OK); /* Invalidated volume, abort to access */ |
| } |
| } else { /* Could not take */ |
| res = FR_TIMEOUT; |
| } |
| #else |
| if (!(disk_status(obj->fs->pdrv) & STA_NOINIT)) { /* Test if the hosting phsical drive is kept initialized */ |
| res = FR_OK; |
| } |
| #endif |
| } |
| *rfs = (res == FR_OK) ? obj->fs : 0; /* Return corresponding filesystem object if it is valid */ |
| return res; |
| } |
| |
| |
| |
| |
| /*--------------------------------------------------------------------------- |
| |
| Public Functions (FatFs API) |
| |
| ----------------------------------------------------------------------------*/ |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Mount/Unmount a Logical Drive */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_mount ( |
| FATFS* fs, /* Pointer to the filesystem object to be registered (NULL:unmount)*/ |
| const TCHAR* path, /* Logical drive number to be mounted/unmounted */ |
| BYTE opt /* Mount option: 0=Do not mount (delayed mount), 1=Mount immediately */ |
| ) |
| { |
| FATFS *cfs; |
| int vol; |
| FRESULT res; |
| const TCHAR *rp = path; |
| |
| |
| /* Get volume ID (logical drive number) */ |
| vol = get_ldnumber(&rp); |
| if (vol < 0) return FR_INVALID_DRIVE; |
| cfs = FatFs[vol]; /* Pointer to the filesystem object of the volume */ |
| |
| if (cfs) { /* Unregister current filesystem object if regsitered */ |
| FatFs[vol] = 0; |
| #if FF_FS_LOCK |
| clear_share(cfs); |
| #endif |
| #if FF_FS_REENTRANT /* Discard mutex of the current volume */ |
| ff_mutex_delete(vol); |
| #endif |
| cfs->fs_type = 0; /* Invalidate the filesystem object to be unregistered */ |
| } |
| |
| if (fs) { /* Register new filesystem object */ |
| fs->pdrv = LD2PD(vol); /* Volume hosting physical drive */ |
| #if FF_FS_REENTRANT /* Create a volume mutex */ |
| fs->ldrv = (BYTE)vol; /* Owner volume ID */ |
| if (!ff_mutex_create(vol)) return FR_INT_ERR; |
| #if FF_FS_LOCK |
| if (SysLock == 0) { /* Create a system mutex if needed */ |
| if (!ff_mutex_create(FF_VOLUMES)) { |
| ff_mutex_delete(vol); |
| return FR_INT_ERR; |
| } |
| SysLock = 1; /* System mutex is ready */ |
| } |
| #endif |
| #endif |
| fs->fs_type = 0; /* Invalidate the new filesystem object */ |
| FatFs[vol] = fs; /* Register new fs object */ |
| } |
| |
| if (opt == 0) return FR_OK; /* Do not mount now, it will be mounted in subsequent file functions */ |
| |
| res = mount_volume(&path, &fs, 0); /* Force mounted the volume */ |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Open or Create a File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_open ( |
| FIL* fp, /* Pointer to the blank file object */ |
| const TCHAR* path, /* Pointer to the file name */ |
| BYTE mode /* Access mode and open mode flags */ |
| ) |
| { |
| FRESULT res; |
| DIR dj; |
| FATFS *fs; |
| #if !FF_FS_READONLY |
| DWORD cl, bcs, clst, tm; |
| LBA_t sc; |
| FSIZE_t ofs; |
| #endif |
| DEF_NAMBUF |
| |
| |
| if (!fp) return FR_INVALID_OBJECT; |
| |
| /* Get logical drive number */ |
| mode &= FF_FS_READONLY ? FA_READ : FA_READ | FA_WRITE | FA_CREATE_ALWAYS | FA_CREATE_NEW | FA_OPEN_ALWAYS | FA_OPEN_APPEND; |
| res = mount_volume(&path, &fs, mode); |
| if (res == FR_OK) { |
| dj.obj.fs = fs; |
| INIT_NAMBUF(fs); |
| res = follow_path(&dj, path); /* Follow the file path */ |
| #if !FF_FS_READONLY /* Read/Write configuration */ |
| if (res == FR_OK) { |
| if (dj.fn[NSFLAG] & NS_NONAME) { /* Origin directory itself? */ |
| res = FR_INVALID_NAME; |
| } |
| #if FF_FS_LOCK |
| else { |
| res = chk_share(&dj, (mode & ~FA_READ) ? 1 : 0); /* Check if the file can be used */ |
| } |
| #endif |
| } |
| /* Create or Open a file */ |
| if (mode & (FA_CREATE_ALWAYS | FA_OPEN_ALWAYS | FA_CREATE_NEW)) { |
| if (res != FR_OK) { /* No file, create new */ |
| if (res == FR_NO_FILE) { /* There is no file to open, create a new entry */ |
| #if FF_FS_LOCK |
| res = enq_share() ? dir_register(&dj) : FR_TOO_MANY_OPEN_FILES; |
| #else |
| res = dir_register(&dj); |
| #endif |
| } |
| mode |= FA_CREATE_ALWAYS; /* File is created */ |
| } |
| else { /* Any object with the same name is already existing */ |
| if (dj.obj.attr & (AM_RDO | AM_DIR)) { /* Cannot overwrite it (R/O or DIR) */ |
| res = FR_DENIED; |
| } else { |
| if (mode & FA_CREATE_NEW) res = FR_EXIST; /* Cannot create as new file */ |
| } |
| } |
| if (res == FR_OK && (mode & FA_CREATE_ALWAYS)) { /* Truncate the file if overwrite mode */ |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| /* Get current allocation info */ |
| fp->obj.fs = fs; |
| init_alloc_info(fs, &fp->obj); |
| /* Set directory entry block initial state */ |
| memset(fs->dirbuf + 2, 0, 30); /* Clear 85 entry except for NumSec */ |
| memset(fs->dirbuf + 38, 0, 26); /* Clear C0 entry except for NumName and NameHash */ |
| fs->dirbuf[XDIR_Attr] = AM_ARC; |
| st_dword(fs->dirbuf + XDIR_CrtTime, GET_FATTIME()); |
| fs->dirbuf[XDIR_GenFlags] = 1; |
| res = store_xdir(&dj); |
| if (res == FR_OK && fp->obj.sclust != 0) { /* Remove the cluster chain if exist */ |
| res = remove_chain(&fp->obj, fp->obj.sclust, 0); |
| fs->last_clst = fp->obj.sclust - 1; /* Reuse the cluster hole */ |
| } |
| } else |
| #endif |
| { |
| /* Set directory entry initial state */ |
| tm = GET_FATTIME(); /* Set created time */ |
| st_dword(dj.dir + DIR_CrtTime, tm); |
| st_dword(dj.dir + DIR_ModTime, tm); |
| cl = ld_clust(fs, dj.dir); /* Get current cluster chain */ |
| dj.dir[DIR_Attr] = AM_ARC; /* Reset attribute */ |
| st_clust(fs, dj.dir, 0); /* Reset file allocation info */ |
| st_dword(dj.dir + DIR_FileSize, 0); |
| fs->wflag = 1; |
| if (cl != 0) { /* Remove the cluster chain if exist */ |
| sc = fs->winsect; |
| res = remove_chain(&dj.obj, cl, 0); |
| if (res == FR_OK) { |
| res = move_window(fs, sc); |
| fs->last_clst = cl - 1; /* Reuse the cluster hole */ |
| } |
| } |
| } |
| } |
| } |
| else { /* Open an existing file */ |
| if (res == FR_OK) { /* Is the object exsiting? */ |
| if (dj.obj.attr & AM_DIR) { /* File open against a directory */ |
| res = FR_NO_FILE; |
| } else { |
| if ((mode & FA_WRITE) && (dj.obj.attr & AM_RDO)) { /* Write mode open against R/O file */ |
| res = FR_DENIED; |
| } |
| } |
| } |
| } |
| if (res == FR_OK) { |
| if (mode & FA_CREATE_ALWAYS) mode |= FA_MODIFIED; /* Set file change flag if created or overwritten */ |
| fp->dir_sect = fs->winsect; /* Pointer to the directory entry */ |
| fp->dir_ptr = dj.dir; |
| #if FF_FS_LOCK |
| fp->obj.lockid = inc_share(&dj, (mode & ~FA_READ) ? 1 : 0); /* Lock the file for this session */ |
| if (fp->obj.lockid == 0) res = FR_INT_ERR; |
| #endif |
| } |
| #else /* R/O configuration */ |
| if (res == FR_OK) { |
| if (dj.fn[NSFLAG] & NS_NONAME) { /* Is it origin directory itself? */ |
| res = FR_INVALID_NAME; |
| } else { |
| if (dj.obj.attr & AM_DIR) { /* Is it a directory? */ |
| res = FR_NO_FILE; |
| } |
| } |
| } |
| #endif |
| |
| if (res == FR_OK) { |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| fp->obj.c_scl = dj.obj.sclust; /* Get containing directory info */ |
| fp->obj.c_size = ((DWORD)dj.obj.objsize & 0xFFFFFF00) | dj.obj.stat; |
| fp->obj.c_ofs = dj.blk_ofs; |
| init_alloc_info(fs, &fp->obj); |
| } else |
| #endif |
| { |
| fp->obj.sclust = ld_clust(fs, dj.dir); /* Get object allocation info */ |
| fp->obj.objsize = ld_dword(dj.dir + DIR_FileSize); |
| } |
| #if FF_USE_FASTSEEK |
| fp->cltbl = 0; /* Disable fast seek mode */ |
| #endif |
| fp->obj.fs = fs; /* Validate the file object */ |
| fp->obj.id = fs->id; |
| fp->flag = mode; /* Set file access mode */ |
| fp->err = 0; /* Clear error flag */ |
| fp->sect = 0; /* Invalidate current data sector */ |
| fp->fptr = 0; /* Set file pointer top of the file */ |
| #if !FF_FS_READONLY |
| #if !FF_FS_TINY |
| memset(fp->buf, 0, sizeof fp->buf); /* Clear sector buffer */ |
| #endif |
| if ((mode & FA_SEEKEND) && fp->obj.objsize > 0) { /* Seek to end of file if FA_OPEN_APPEND is specified */ |
| fp->fptr = fp->obj.objsize; /* Offset to seek */ |
| bcs = (DWORD)fs->csize * SS(fs); /* Cluster size in byte */ |
| clst = fp->obj.sclust; /* Follow the cluster chain */ |
| for (ofs = fp->obj.objsize; res == FR_OK && ofs > bcs; ofs -= bcs) { |
| clst = get_fat(&fp->obj, clst); |
| if (clst <= 1) res = FR_INT_ERR; |
| if (clst == 0xFFFFFFFF) res = FR_DISK_ERR; |
| } |
| fp->clust = clst; |
| if (res == FR_OK && ofs % SS(fs)) { /* Fill sector buffer if not on the sector boundary */ |
| sc = clst2sect(fs, clst); |
| if (sc == 0) { |
| res = FR_INT_ERR; |
| } else { |
| fp->sect = sc + (DWORD)(ofs / SS(fs)); |
| #if !FF_FS_TINY |
| if (disk_read(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) res = FR_DISK_ERR; |
| #endif |
| } |
| } |
| #if FF_FS_LOCK |
| if (res != FR_OK) dec_share(fp->obj.lockid); /* Decrement file open counter if seek failed */ |
| #endif |
| } |
| #endif |
| } |
| |
| FREE_NAMBUF(); |
| } |
| |
| if (res != FR_OK) fp->obj.fs = 0; /* Invalidate file object on error */ |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Read File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_read ( |
| FIL* fp, /* Open file to be read */ |
| void* buff, /* Data buffer to store the read data */ |
| UINT btr, /* Number of bytes to read */ |
| UINT* br /* Number of bytes read */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DWORD clst; |
| LBA_t sect; |
| FSIZE_t remain; |
| UINT rcnt, cc, csect; |
| BYTE *rbuff = (BYTE*)buff; |
| |
| |
| *br = 0; /* Clear read byte counter */ |
| res = validate(&fp->obj, &fs); /* Check validity of the file object */ |
| if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res); /* Check validity */ |
| if (!(fp->flag & FA_READ)) LEAVE_FF(fs, FR_DENIED); /* Check access mode */ |
| remain = fp->obj.objsize - fp->fptr; |
| if (btr > remain) btr = (UINT)remain; /* Truncate btr by remaining bytes */ |
| |
| for ( ; btr > 0; btr -= rcnt, *br += rcnt, rbuff += rcnt, fp->fptr += rcnt) { /* Repeat until btr bytes read */ |
| if (fp->fptr % SS(fs) == 0) { /* On the sector boundary? */ |
| csect = (UINT)(fp->fptr / SS(fs) & (fs->csize - 1)); /* Sector offset in the cluster */ |
| if (csect == 0) { /* On the cluster boundary? */ |
| if (fp->fptr == 0) { /* On the top of the file? */ |
| clst = fp->obj.sclust; /* Follow cluster chain from the origin */ |
| } else { /* Middle or end of the file */ |
| #if FF_USE_FASTSEEK |
| if (fp->cltbl) { |
| clst = clmt_clust(fp, fp->fptr); /* Get cluster# from the CLMT */ |
| } else |
| #endif |
| { |
| clst = get_fat(&fp->obj, fp->clust); /* Follow cluster chain on the FAT */ |
| } |
| } |
| if (clst < 2) ABORT(fs, FR_INT_ERR); |
| if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR); |
| fp->clust = clst; /* Update current cluster */ |
| } |
| sect = clst2sect(fs, fp->clust); /* Get current sector */ |
| if (sect == 0) ABORT(fs, FR_INT_ERR); |
| sect += csect; |
| cc = btr / SS(fs); /* When remaining bytes >= sector size, */ |
| if (cc > 0) { /* Read maximum contiguous sectors directly */ |
| if (csect + cc > fs->csize) { /* Clip at cluster boundary */ |
| cc = fs->csize - csect; |
| } |
| if (disk_read(fs->pdrv, rbuff, sect, cc) != RES_OK) ABORT(fs, FR_DISK_ERR); |
| #if !FF_FS_READONLY && FF_FS_MINIMIZE <= 2 /* Replace one of the read sectors with cached data if it contains a dirty sector */ |
| #if FF_FS_TINY |
| if (fs->wflag && fs->winsect - sect < cc) { |
| memcpy(rbuff + ((fs->winsect - sect) * SS(fs)), fs->win, SS(fs)); |
| } |
| #else |
| if ((fp->flag & FA_DIRTY) && fp->sect - sect < cc) { |
| memcpy(rbuff + ((fp->sect - sect) * SS(fs)), fp->buf, SS(fs)); |
| } |
| #endif |
| #endif |
| rcnt = SS(fs) * cc; /* Number of bytes transferred */ |
| continue; |
| } |
| #if !FF_FS_TINY |
| if (fp->sect != sect) { /* Load data sector if not in cache */ |
| #if !FF_FS_READONLY |
| if (fp->flag & FA_DIRTY) { /* Write-back dirty sector cache */ |
| if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); |
| fp->flag &= (BYTE)~FA_DIRTY; |
| } |
| #endif |
| if (disk_read(fs->pdrv, fp->buf, sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); /* Fill sector cache */ |
| } |
| #endif |
| fp->sect = sect; |
| } |
| rcnt = SS(fs) - (UINT)fp->fptr % SS(fs); /* Number of bytes remains in the sector */ |
| if (rcnt > btr) rcnt = btr; /* Clip it by btr if needed */ |
| #if FF_FS_TINY |
| if (move_window(fs, fp->sect) != FR_OK) ABORT(fs, FR_DISK_ERR); /* Move sector window */ |
| memcpy(rbuff, fs->win + fp->fptr % SS(fs), rcnt); /* Extract partial sector */ |
| #else |
| memcpy(rbuff, fp->buf + fp->fptr % SS(fs), rcnt); /* Extract partial sector */ |
| #endif |
| } |
| |
| LEAVE_FF(fs, FR_OK); |
| } |
| |
| |
| |
| |
| #if !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* Write File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_write ( |
| FIL* fp, /* Open file to be written */ |
| const void* buff, /* Data to be written */ |
| UINT btw, /* Number of bytes to write */ |
| UINT* bw /* Number of bytes written */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DWORD clst; |
| LBA_t sect; |
| UINT wcnt, cc, csect; |
| const BYTE *wbuff = (const BYTE*)buff; |
| |
| |
| *bw = 0; /* Clear write byte counter */ |
| res = validate(&fp->obj, &fs); /* Check validity of the file object */ |
| if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res); /* Check validity */ |
| if (!(fp->flag & FA_WRITE)) LEAVE_FF(fs, FR_DENIED); /* Check access mode */ |
| |
| /* Check fptr wrap-around (file size cannot reach 4 GiB at FAT volume) */ |
| if ((!FF_FS_EXFAT || fs->fs_type != FS_EXFAT) && (DWORD)(fp->fptr + btw) < (DWORD)fp->fptr) { |
| btw = (UINT)(0xFFFFFFFF - (DWORD)fp->fptr); |
| } |
| |
| for ( ; btw > 0; btw -= wcnt, *bw += wcnt, wbuff += wcnt, fp->fptr += wcnt, fp->obj.objsize = (fp->fptr > fp->obj.objsize) ? fp->fptr : fp->obj.objsize) { /* Repeat until all data written */ |
| if (fp->fptr % SS(fs) == 0) { /* On the sector boundary? */ |
| csect = (UINT)(fp->fptr / SS(fs)) & (fs->csize - 1); /* Sector offset in the cluster */ |
| if (csect == 0) { /* On the cluster boundary? */ |
| if (fp->fptr == 0) { /* On the top of the file? */ |
| clst = fp->obj.sclust; /* Follow from the origin */ |
| if (clst == 0) { /* If no cluster is allocated, */ |
| clst = create_chain(&fp->obj, 0); /* create a new cluster chain */ |
| } |
| } else { /* On the middle or end of the file */ |
| #if FF_USE_FASTSEEK |
| if (fp->cltbl) { |
| clst = clmt_clust(fp, fp->fptr); /* Get cluster# from the CLMT */ |
| } else |
| #endif |
| { |
| clst = create_chain(&fp->obj, fp->clust); /* Follow or stretch cluster chain on the FAT */ |
| } |
| } |
| if (clst == 0) break; /* Could not allocate a new cluster (disk full) */ |
| if (clst == 1) ABORT(fs, FR_INT_ERR); |
| if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR); |
| fp->clust = clst; /* Update current cluster */ |
| if (fp->obj.sclust == 0) fp->obj.sclust = clst; /* Set start cluster if the first write */ |
| } |
| #if FF_FS_TINY |
| if (fs->winsect == fp->sect && sync_window(fs) != FR_OK) ABORT(fs, FR_DISK_ERR); /* Write-back sector cache */ |
| #else |
| if (fp->flag & FA_DIRTY) { /* Write-back sector cache */ |
| if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); |
| fp->flag &= (BYTE)~FA_DIRTY; |
| } |
| #endif |
| sect = clst2sect(fs, fp->clust); /* Get current sector */ |
| if (sect == 0) ABORT(fs, FR_INT_ERR); |
| sect += csect; |
| cc = btw / SS(fs); /* When remaining bytes >= sector size, */ |
| if (cc > 0) { /* Write maximum contiguous sectors directly */ |
| if (csect + cc > fs->csize) { /* Clip at cluster boundary */ |
| cc = fs->csize - csect; |
| } |
| if (disk_write(fs->pdrv, wbuff, sect, cc) != RES_OK) ABORT(fs, FR_DISK_ERR); |
| #if FF_FS_MINIMIZE <= 2 |
| #if FF_FS_TINY |
| if (fs->winsect - sect < cc) { /* Refill sector cache if it gets invalidated by the direct write */ |
| memcpy(fs->win, wbuff + ((fs->winsect - sect) * SS(fs)), SS(fs)); |
| fs->wflag = 0; |
| } |
| #else |
| if (fp->sect - sect < cc) { /* Refill sector cache if it gets invalidated by the direct write */ |
| memcpy(fp->buf, wbuff + ((fp->sect - sect) * SS(fs)), SS(fs)); |
| fp->flag &= (BYTE)~FA_DIRTY; |
| } |
| #endif |
| #endif |
| wcnt = SS(fs) * cc; /* Number of bytes transferred */ |
| continue; |
| } |
| #if FF_FS_TINY |
| if (fp->fptr >= fp->obj.objsize) { /* Avoid silly cache filling on the growing edge */ |
| if (sync_window(fs) != FR_OK) ABORT(fs, FR_DISK_ERR); |
| fs->winsect = sect; |
| } |
| #else |
| if (fp->sect != sect && /* Fill sector cache with file data */ |
| fp->fptr < fp->obj.objsize && |
| disk_read(fs->pdrv, fp->buf, sect, 1) != RES_OK) { |
| ABORT(fs, FR_DISK_ERR); |
| } |
| #endif |
| fp->sect = sect; |
| } |
| wcnt = SS(fs) - (UINT)fp->fptr % SS(fs); /* Number of bytes remains in the sector */ |
| if (wcnt > btw) wcnt = btw; /* Clip it by btw if needed */ |
| #if FF_FS_TINY |
| if (move_window(fs, fp->sect) != FR_OK) ABORT(fs, FR_DISK_ERR); /* Move sector window */ |
| memcpy(fs->win + fp->fptr % SS(fs), wbuff, wcnt); /* Fit data to the sector */ |
| fs->wflag = 1; |
| #else |
| memcpy(fp->buf + fp->fptr % SS(fs), wbuff, wcnt); /* Fit data to the sector */ |
| fp->flag |= FA_DIRTY; |
| #endif |
| } |
| |
| fp->flag |= FA_MODIFIED; /* Set file change flag */ |
| |
| LEAVE_FF(fs, FR_OK); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Synchronize the File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_sync ( |
| FIL* fp /* Open file to be synced */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DWORD tm; |
| BYTE *dir; |
| |
| |
| res = validate(&fp->obj, &fs); /* Check validity of the file object */ |
| if (res == FR_OK) { |
| if (fp->flag & FA_MODIFIED) { /* Is there any change to the file? */ |
| #if !FF_FS_TINY |
| if (fp->flag & FA_DIRTY) { /* Write-back cached data if needed */ |
| if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) LEAVE_FF(fs, FR_DISK_ERR); |
| fp->flag &= (BYTE)~FA_DIRTY; |
| } |
| #endif |
| /* Update the directory entry */ |
| tm = GET_FATTIME(); /* Modified time */ |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| res = fill_first_frag(&fp->obj); /* Fill first fragment on the FAT if needed */ |
| if (res == FR_OK) { |
| res = fill_last_frag(&fp->obj, fp->clust, 0xFFFFFFFF); /* Fill last fragment on the FAT if needed */ |
| } |
| if (res == FR_OK) { |
| DIR dj; |
| DEF_NAMBUF |
| |
| INIT_NAMBUF(fs); |
| res = load_obj_xdir(&dj, &fp->obj); /* Load directory entry block */ |
| if (res == FR_OK) { |
| fs->dirbuf[XDIR_Attr] |= AM_ARC; /* Set archive attribute to indicate that the file has been changed */ |
| fs->dirbuf[XDIR_GenFlags] = fp->obj.stat | 1; /* Update file allocation information */ |
| st_dword(fs->dirbuf + XDIR_FstClus, fp->obj.sclust); /* Update start cluster */ |
| st_qword(fs->dirbuf + XDIR_FileSize, fp->obj.objsize); /* Update file size */ |
| st_qword(fs->dirbuf + XDIR_ValidFileSize, fp->obj.objsize); /* (FatFs does not support Valid File Size feature) */ |
| st_dword(fs->dirbuf + XDIR_ModTime, tm); /* Update modified time */ |
| fs->dirbuf[XDIR_ModTime10] = 0; |
| st_dword(fs->dirbuf + XDIR_AccTime, 0); |
| res = store_xdir(&dj); /* Restore it to the directory */ |
| if (res == FR_OK) { |
| res = sync_fs(fs); |
| fp->flag &= (BYTE)~FA_MODIFIED; |
| } |
| } |
| FREE_NAMBUF(); |
| } |
| } else |
| #endif |
| { |
| res = move_window(fs, fp->dir_sect); |
| if (res == FR_OK) { |
| dir = fp->dir_ptr; |
| dir[DIR_Attr] |= AM_ARC; /* Set archive attribute to indicate that the file has been changed */ |
| st_clust(fp->obj.fs, dir, fp->obj.sclust); /* Update file allocation information */ |
| st_dword(dir + DIR_FileSize, (DWORD)fp->obj.objsize); /* Update file size */ |
| st_dword(dir + DIR_ModTime, tm); /* Update modified time */ |
| st_word(dir + DIR_LstAccDate, 0); |
| fs->wflag = 1; |
| res = sync_fs(fs); /* Restore it to the directory */ |
| fp->flag &= (BYTE)~FA_MODIFIED; |
| } |
| } |
| } |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Close File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_close ( |
| FIL* fp /* Open file to be closed */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| |
| #if !FF_FS_READONLY |
| res = f_sync(fp); /* Flush cached data */ |
| if (res == FR_OK) |
| #endif |
| { |
| res = validate(&fp->obj, &fs); /* Lock volume */ |
| if (res == FR_OK) { |
| #if FF_FS_LOCK |
| res = dec_share(fp->obj.lockid); /* Decrement file open counter */ |
| if (res == FR_OK) fp->obj.fs = 0; /* Invalidate file object */ |
| #else |
| fp->obj.fs = 0; /* Invalidate file object */ |
| #endif |
| #if FF_FS_REENTRANT |
| unlock_volume(fs, FR_OK); /* Unlock volume */ |
| #endif |
| } |
| } |
| return res; |
| } |
| |
| |
| |
| |
| #if FF_FS_RPATH >= 1 |
| /*-----------------------------------------------------------------------*/ |
| /* Change Current Directory or Current Drive, Get Current Directory */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_chdrive ( |
| const TCHAR* path /* Drive number to set */ |
| ) |
| { |
| int vol; |
| |
| |
| /* Get logical drive number */ |
| vol = get_ldnumber(&path); |
| if (vol < 0) return FR_INVALID_DRIVE; |
| CurrVol = (BYTE)vol; /* Set it as current volume */ |
| |
| return FR_OK; |
| } |
| |
| |
| |
| FRESULT f_chdir ( |
| const TCHAR* path /* Pointer to the directory path */ |
| ) |
| { |
| #if FF_STR_VOLUME_ID == 2 |
| UINT i; |
| #endif |
| FRESULT res; |
| DIR dj; |
| FATFS *fs; |
| DEF_NAMBUF |
| |
| |
| /* Get logical drive */ |
| res = mount_volume(&path, &fs, 0); |
| if (res == FR_OK) { |
| dj.obj.fs = fs; |
| INIT_NAMBUF(fs); |
| res = follow_path(&dj, path); /* Follow the path */ |
| if (res == FR_OK) { /* Follow completed */ |
| if (dj.fn[NSFLAG] & NS_NONAME) { /* Is it the start directory itself? */ |
| fs->cdir = dj.obj.sclust; |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| fs->cdc_scl = dj.obj.c_scl; |
| fs->cdc_size = dj.obj.c_size; |
| fs->cdc_ofs = dj.obj.c_ofs; |
| } |
| #endif |
| } else { |
| if (dj.obj.attr & AM_DIR) { /* It is a sub-directory */ |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| fs->cdir = ld_dword(fs->dirbuf + XDIR_FstClus); /* Sub-directory cluster */ |
| fs->cdc_scl = dj.obj.sclust; /* Save containing directory information */ |
| fs->cdc_size = ((DWORD)dj.obj.objsize & 0xFFFFFF00) | dj.obj.stat; |
| fs->cdc_ofs = dj.blk_ofs; |
| } else |
| #endif |
| { |
| fs->cdir = ld_clust(fs, dj.dir); /* Sub-directory cluster */ |
| } |
| } else { |
| res = FR_NO_PATH; /* Reached but a file */ |
| } |
| } |
| } |
| FREE_NAMBUF(); |
| if (res == FR_NO_FILE) res = FR_NO_PATH; |
| #if FF_STR_VOLUME_ID == 2 /* Also current drive is changed if in Unix style volume ID */ |
| if (res == FR_OK) { |
| for (i = FF_VOLUMES - 1; i && fs != FatFs[i]; i--) ; /* Set current drive */ |
| CurrVol = (BYTE)i; |
| } |
| #endif |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| #if FF_FS_RPATH >= 2 |
| FRESULT f_getcwd ( |
| TCHAR* buff, /* Pointer to the directory path */ |
| UINT len /* Size of buff in unit of TCHAR */ |
| ) |
| { |
| FRESULT res; |
| DIR dj; |
| FATFS *fs; |
| UINT i, n; |
| DWORD ccl; |
| TCHAR *tp = buff; |
| #if FF_VOLUMES >= 2 |
| UINT vl; |
| #if FF_STR_VOLUME_ID |
| const char *vp; |
| #endif |
| #endif |
| FILINFO fno; |
| DEF_NAMBUF |
| |
| |
| /* Get logical drive */ |
| buff[0] = 0; /* Set null string to get current volume */ |
| res = mount_volume((const TCHAR**)&buff, &fs, 0); /* Get current volume */ |
| if (res == FR_OK) { |
| dj.obj.fs = fs; |
| INIT_NAMBUF(fs); |
| |
| /* Follow parent directories and create the path */ |
| i = len; /* Bottom of buffer (directory stack base) */ |
| if (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT) { /* (Cannot do getcwd on exFAT and returns root path) */ |
| dj.obj.sclust = fs->cdir; /* Start to follow upper directory from current directory */ |
| while ((ccl = dj.obj.sclust) != 0) { /* Repeat while current directory is a sub-directory */ |
| res = dir_sdi(&dj, 1 * SZDIRE); /* Get parent directory */ |
| if (res != FR_OK) break; |
| res = move_window(fs, dj.sect); |
| if (res != FR_OK) break; |
| dj.obj.sclust = ld_clust(fs, dj.dir); /* Goto parent directory */ |
| res = dir_sdi(&dj, 0); |
| if (res != FR_OK) break; |
| do { /* Find the entry links to the child directory */ |
| res = DIR_READ_FILE(&dj); |
| if (res != FR_OK) break; |
| if (ccl == ld_clust(fs, dj.dir)) break; /* Found the entry */ |
| res = dir_next(&dj, 0); |
| } while (res == FR_OK); |
| if (res == FR_NO_FILE) res = FR_INT_ERR;/* It cannot be 'not found'. */ |
| if (res != FR_OK) break; |
| get_fileinfo(&dj, &fno); /* Get the directory name and push it to the buffer */ |
| for (n = 0; fno.fname[n]; n++) ; /* Name length */ |
| if (i < n + 1) { /* Insufficient space to store the path name? */ |
| res = FR_NOT_ENOUGH_CORE; break; |
| } |
| while (n) buff[--i] = fno.fname[--n]; /* Stack the name */ |
| buff[--i] = '/'; |
| } |
| } |
| if (res == FR_OK) { |
| if (i == len) buff[--i] = '/'; /* Is it the root-directory? */ |
| #if FF_VOLUMES >= 2 /* Put drive prefix */ |
| vl = 0; |
| #if FF_STR_VOLUME_ID >= 1 /* String volume ID */ |
| for (n = 0, vp = (const char*)VolumeStr[CurrVol]; vp[n]; n++) ; |
| if (i >= n + 2) { |
| if (FF_STR_VOLUME_ID == 2) *tp++ = (TCHAR)'/'; |
| for (vl = 0; vl < n; *tp++ = (TCHAR)vp[vl], vl++) ; |
| if (FF_STR_VOLUME_ID == 1) *tp++ = (TCHAR)':'; |
| vl++; |
| } |
| #else /* Numeric volume ID */ |
| if (i >= 3) { |
| *tp++ = (TCHAR)'0' + CurrVol; |
| *tp++ = (TCHAR)':'; |
| vl = 2; |
| } |
| #endif |
| if (vl == 0) res = FR_NOT_ENOUGH_CORE; |
| #endif |
| /* Add current directory path */ |
| if (res == FR_OK) { |
| do { /* Copy stacked path string */ |
| *tp++ = buff[i++]; |
| } while (i < len); |
| } |
| } |
| FREE_NAMBUF(); |
| } |
| |
| *tp = 0; |
| LEAVE_FF(fs, res); |
| } |
| |
| #endif /* FF_FS_RPATH >= 2 */ |
| #endif /* FF_FS_RPATH >= 1 */ |
| |
| |
| |
| #if FF_FS_MINIMIZE <= 2 |
| /*-----------------------------------------------------------------------*/ |
| /* Seek File Read/Write Pointer */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_lseek ( |
| FIL* fp, /* Pointer to the file object */ |
| FSIZE_t ofs /* File pointer from top of file */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DWORD clst, bcs; |
| LBA_t nsect; |
| FSIZE_t ifptr; |
| #if FF_USE_FASTSEEK |
| DWORD cl, pcl, ncl, tcl, tlen, ulen; |
| DWORD *tbl; |
| LBA_t dsc; |
| #endif |
| |
| res = validate(&fp->obj, &fs); /* Check validity of the file object */ |
| if (res == FR_OK) res = (FRESULT)fp->err; |
| #if FF_FS_EXFAT && !FF_FS_READONLY |
| if (res == FR_OK && fs->fs_type == FS_EXFAT) { |
| res = fill_last_frag(&fp->obj, fp->clust, 0xFFFFFFFF); /* Fill last fragment on the FAT if needed */ |
| } |
| #endif |
| if (res != FR_OK) LEAVE_FF(fs, res); |
| |
| #if FF_USE_FASTSEEK |
| if (fp->cltbl) { /* Fast seek */ |
| if (ofs == CREATE_LINKMAP) { /* Create CLMT */ |
| tbl = fp->cltbl; |
| tlen = *tbl++; ulen = 2; /* Given table size and required table size */ |
| cl = fp->obj.sclust; /* Origin of the chain */ |
| if (cl != 0) { |
| do { |
| /* Get a fragment */ |
| tcl = cl; ncl = 0; ulen += 2; /* Top, length and used items */ |
| do { |
| pcl = cl; ncl++; |
| cl = get_fat(&fp->obj, cl); |
| if (cl <= 1) ABORT(fs, FR_INT_ERR); |
| if (cl == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR); |
| } while (cl == pcl + 1); |
| if (ulen <= tlen) { /* Store the length and top of the fragment */ |
| *tbl++ = ncl; *tbl++ = tcl; |
| } |
| } while (cl < fs->n_fatent); /* Repeat until end of chain */ |
| } |
| *fp->cltbl = ulen; /* Number of items used */ |
| if (ulen <= tlen) { |
| *tbl = 0; /* Terminate table */ |
| } else { |
| res = FR_NOT_ENOUGH_CORE; /* Given table size is smaller than required */ |
| } |
| } else { /* Fast seek */ |
| if (ofs > fp->obj.objsize) ofs = fp->obj.objsize; /* Clip offset at the file size */ |
| fp->fptr = ofs; /* Set file pointer */ |
| if (ofs > 0) { |
| fp->clust = clmt_clust(fp, ofs - 1); |
| dsc = clst2sect(fs, fp->clust); |
| if (dsc == 0) ABORT(fs, FR_INT_ERR); |
| dsc += (DWORD)((ofs - 1) / SS(fs)) & (fs->csize - 1); |
| if (fp->fptr % SS(fs) && dsc != fp->sect) { /* Refill sector cache if needed */ |
| #if !FF_FS_TINY |
| #if !FF_FS_READONLY |
| if (fp->flag & FA_DIRTY) { /* Write-back dirty sector cache */ |
| if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); |
| fp->flag &= (BYTE)~FA_DIRTY; |
| } |
| #endif |
| if (disk_read(fs->pdrv, fp->buf, dsc, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); /* Load current sector */ |
| #endif |
| fp->sect = dsc; |
| } |
| } |
| } |
| } else |
| #endif |
| |
| /* Normal Seek */ |
| { |
| #if FF_FS_EXFAT |
| if (fs->fs_type != FS_EXFAT && ofs >= 0x100000000) ofs = 0xFFFFFFFF; /* Clip at 4 GiB - 1 if at FATxx */ |
| #endif |
| if (ofs > fp->obj.objsize && (FF_FS_READONLY || !(fp->flag & FA_WRITE))) { /* In read-only mode, clip offset with the file size */ |
| ofs = fp->obj.objsize; |
| } |
| ifptr = fp->fptr; |
| fp->fptr = nsect = 0; |
| if (ofs > 0) { |
| bcs = (DWORD)fs->csize * SS(fs); /* Cluster size (byte) */ |
| if (ifptr > 0 && |
| (ofs - 1) / bcs >= (ifptr - 1) / bcs) { /* When seek to same or following cluster, */ |
| fp->fptr = (ifptr - 1) & ~(FSIZE_t)(bcs - 1); /* start from the current cluster */ |
| ofs -= fp->fptr; |
| clst = fp->clust; |
| } else { /* When seek to back cluster, */ |
| clst = fp->obj.sclust; /* start from the first cluster */ |
| #if !FF_FS_READONLY |
| if (clst == 0) { /* If no cluster chain, create a new chain */ |
| clst = create_chain(&fp->obj, 0); |
| if (clst == 1) ABORT(fs, FR_INT_ERR); |
| if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR); |
| fp->obj.sclust = clst; |
| } |
| #endif |
| fp->clust = clst; |
| } |
| if (clst != 0) { |
| while (ofs > bcs) { /* Cluster following loop */ |
| ofs -= bcs; fp->fptr += bcs; |
| #if !FF_FS_READONLY |
| if (fp->flag & FA_WRITE) { /* Check if in write mode or not */ |
| if (FF_FS_EXFAT && fp->fptr > fp->obj.objsize) { /* No FAT chain object needs correct objsize to generate FAT value */ |
| fp->obj.objsize = fp->fptr; |
| fp->flag |= FA_MODIFIED; |
| } |
| clst = create_chain(&fp->obj, clst); /* Follow chain with forceed stretch */ |
| if (clst == 0) { /* Clip file size in case of disk full */ |
| ofs = 0; break; |
| } |
| } else |
| #endif |
| { |
| clst = get_fat(&fp->obj, clst); /* Follow cluster chain if not in write mode */ |
| } |
| if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR); |
| if (clst <= 1 || clst >= fs->n_fatent) ABORT(fs, FR_INT_ERR); |
| fp->clust = clst; |
| } |
| fp->fptr += ofs; |
| if (ofs % SS(fs)) { |
| nsect = clst2sect(fs, clst); /* Current sector */ |
| if (nsect == 0) ABORT(fs, FR_INT_ERR); |
| nsect += (DWORD)(ofs / SS(fs)); |
| } |
| } |
| } |
| if (!FF_FS_READONLY && fp->fptr > fp->obj.objsize) { /* Set file change flag if the file size is extended */ |
| fp->obj.objsize = fp->fptr; |
| fp->flag |= FA_MODIFIED; |
| } |
| if (fp->fptr % SS(fs) && nsect != fp->sect) { /* Fill sector cache if needed */ |
| #if !FF_FS_TINY |
| #if !FF_FS_READONLY |
| if (fp->flag & FA_DIRTY) { /* Write-back dirty sector cache */ |
| if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); |
| fp->flag &= (BYTE)~FA_DIRTY; |
| } |
| #endif |
| if (disk_read(fs->pdrv, fp->buf, nsect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); /* Fill sector cache */ |
| #endif |
| fp->sect = nsect; |
| } |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| #if FF_FS_MINIMIZE <= 1 |
| /*-----------------------------------------------------------------------*/ |
| /* Create a Directory Object */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_opendir ( |
| DIR* dp, /* Pointer to directory object to create */ |
| const TCHAR* path /* Pointer to the directory path */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DEF_NAMBUF |
| |
| |
| if (!dp) return FR_INVALID_OBJECT; |
| |
| /* Get logical drive */ |
| res = mount_volume(&path, &fs, 0); |
| if (res == FR_OK) { |
| dp->obj.fs = fs; |
| INIT_NAMBUF(fs); |
| res = follow_path(dp, path); /* Follow the path to the directory */ |
| if (res == FR_OK) { /* Follow completed */ |
| if (!(dp->fn[NSFLAG] & NS_NONAME)) { /* It is not the origin directory itself */ |
| if (dp->obj.attr & AM_DIR) { /* This object is a sub-directory */ |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| dp->obj.c_scl = dp->obj.sclust; /* Get containing directory inforamation */ |
| dp->obj.c_size = ((DWORD)dp->obj.objsize & 0xFFFFFF00) | dp->obj.stat; |
| dp->obj.c_ofs = dp->blk_ofs; |
| init_alloc_info(fs, &dp->obj); /* Get object allocation info */ |
| } else |
| #endif |
| { |
| dp->obj.sclust = ld_clust(fs, dp->dir); /* Get object allocation info */ |
| } |
| } else { /* This object is a file */ |
| res = FR_NO_PATH; |
| } |
| } |
| if (res == FR_OK) { |
| dp->obj.id = fs->id; |
| res = dir_sdi(dp, 0); /* Rewind directory */ |
| #if FF_FS_LOCK |
| if (res == FR_OK) { |
| if (dp->obj.sclust != 0) { |
| dp->obj.lockid = inc_share(dp, 0); /* Lock the sub directory */ |
| if (!dp->obj.lockid) res = FR_TOO_MANY_OPEN_FILES; |
| } else { |
| dp->obj.lockid = 0; /* Root directory need not to be locked */ |
| } |
| } |
| #endif |
| } |
| } |
| FREE_NAMBUF(); |
| if (res == FR_NO_FILE) res = FR_NO_PATH; |
| } |
| if (res != FR_OK) dp->obj.fs = 0; /* Invalidate the directory object if function failed */ |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Close Directory */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_closedir ( |
| DIR *dp /* Pointer to the directory object to be closed */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| |
| |
| res = validate(&dp->obj, &fs); /* Check validity of the file object */ |
| if (res == FR_OK) { |
| #if FF_FS_LOCK |
| if (dp->obj.lockid) res = dec_share(dp->obj.lockid); /* Decrement sub-directory open counter */ |
| if (res == FR_OK) dp->obj.fs = 0; /* Invalidate directory object */ |
| #else |
| dp->obj.fs = 0; /* Invalidate directory object */ |
| #endif |
| #if FF_FS_REENTRANT |
| unlock_volume(fs, FR_OK); /* Unlock volume */ |
| #endif |
| } |
| return res; |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Read Directory Entries in Sequence */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_readdir ( |
| DIR* dp, /* Pointer to the open directory object */ |
| FILINFO* fno /* Pointer to file information to return */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DEF_NAMBUF |
| |
| |
| res = validate(&dp->obj, &fs); /* Check validity of the directory object */ |
| if (res == FR_OK) { |
| if (!fno) { |
| res = dir_sdi(dp, 0); /* Rewind the directory object */ |
| } else { |
| INIT_NAMBUF(fs); |
| res = DIR_READ_FILE(dp); /* Read an item */ |
| if (res == FR_NO_FILE) res = FR_OK; /* Ignore end of directory */ |
| if (res == FR_OK) { /* A valid entry is found */ |
| get_fileinfo(dp, fno); /* Get the object information */ |
| res = dir_next(dp, 0); /* Increment index for next */ |
| if (res == FR_NO_FILE) res = FR_OK; /* Ignore end of directory now */ |
| } |
| FREE_NAMBUF(); |
| } |
| } |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| #if FF_USE_FIND |
| /*-----------------------------------------------------------------------*/ |
| /* Find Next File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_findnext ( |
| DIR* dp, /* Pointer to the open directory object */ |
| FILINFO* fno /* Pointer to the file information structure */ |
| ) |
| { |
| FRESULT res; |
| |
| |
| for (;;) { |
| res = f_readdir(dp, fno); /* Get a directory item */ |
| if (res != FR_OK || !fno || !fno->fname[0]) break; /* Terminate if any error or end of directory */ |
| if (pattern_match(dp->pat, fno->fname, 0, FIND_RECURS)) break; /* Test for the file name */ |
| #if FF_USE_LFN && FF_USE_FIND == 2 |
| if (pattern_match(dp->pat, fno->altname, 0, FIND_RECURS)) break; /* Test for alternative name if exist */ |
| #endif |
| } |
| return res; |
| } |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Find First File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_findfirst ( |
| DIR* dp, /* Pointer to the blank directory object */ |
| FILINFO* fno, /* Pointer to the file information structure */ |
| const TCHAR* path, /* Pointer to the directory to open */ |
| const TCHAR* pattern /* Pointer to the matching pattern */ |
| ) |
| { |
| FRESULT res; |
| |
| |
| dp->pat = pattern; /* Save pointer to pattern string */ |
| res = f_opendir(dp, path); /* Open the target directory */ |
| if (res == FR_OK) { |
| res = f_findnext(dp, fno); /* Find the first item */ |
| } |
| return res; |
| } |
| |
| #endif /* FF_USE_FIND */ |
| |
| |
| |
| #if FF_FS_MINIMIZE == 0 |
| /*-----------------------------------------------------------------------*/ |
| /* Get File Status */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_stat ( |
| const TCHAR* path, /* Pointer to the file path */ |
| FILINFO* fno /* Pointer to file information to return */ |
| ) |
| { |
| FRESULT res; |
| DIR dj; |
| DEF_NAMBUF |
| |
| |
| /* Get logical drive */ |
| res = mount_volume(&path, &dj.obj.fs, 0); |
| if (res == FR_OK) { |
| INIT_NAMBUF(dj.obj.fs); |
| res = follow_path(&dj, path); /* Follow the file path */ |
| if (res == FR_OK) { /* Follow completed */ |
| if (dj.fn[NSFLAG] & NS_NONAME) { /* It is origin directory */ |
| res = FR_INVALID_NAME; |
| } else { /* Found an object */ |
| if (fno) get_fileinfo(&dj, fno); |
| } |
| } |
| FREE_NAMBUF(); |
| } |
| |
| LEAVE_FF(dj.obj.fs, res); |
| } |
| |
| |
| |
| #if !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* Get Number of Free Clusters */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_getfree ( |
| const TCHAR* path, /* Logical drive number */ |
| DWORD* nclst, /* Pointer to a variable to return number of free clusters */ |
| FATFS** fatfs /* Pointer to return pointer to corresponding filesystem object */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DWORD nfree, clst, stat; |
| LBA_t sect; |
| UINT i; |
| FFOBJID obj; |
| |
| |
| /* Get logical drive */ |
| res = mount_volume(&path, &fs, 0); |
| if (res == FR_OK) { |
| *fatfs = fs; /* Return ptr to the fs object */ |
| /* If free_clst is valid, return it without full FAT scan */ |
| if (fs->free_clst <= fs->n_fatent - 2) { |
| *nclst = fs->free_clst; |
| } else { |
| /* Scan FAT to obtain number of free clusters */ |
| nfree = 0; |
| if (fs->fs_type == FS_FAT12) { /* FAT12: Scan bit field FAT entries */ |
| clst = 2; obj.fs = fs; |
| do { |
| stat = get_fat(&obj, clst); |
| if (stat == 0xFFFFFFFF) { |
| res = FR_DISK_ERR; break; |
| } |
| if (stat == 1) { |
| res = FR_INT_ERR; break; |
| } |
| if (stat == 0) nfree++; |
| } while (++clst < fs->n_fatent); |
| } else { |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* exFAT: Scan allocation bitmap */ |
| BYTE bm; |
| UINT b; |
| |
| clst = fs->n_fatent - 2; /* Number of clusters */ |
| sect = fs->bitbase; /* Bitmap sector */ |
| i = 0; /* Offset in the sector */ |
| do { /* Counts numbuer of bits with zero in the bitmap */ |
| if (i == 0) { /* New sector? */ |
| res = move_window(fs, sect++); |
| if (res != FR_OK) break; |
| } |
| for (b = 8, bm = ~fs->win[i]; b && clst; b--, clst--) { |
| nfree += bm & 1; |
| bm >>= 1; |
| } |
| i = (i + 1) % SS(fs); |
| } while (clst); |
| } else |
| #endif |
| { /* FAT16/32: Scan WORD/DWORD FAT entries */ |
| clst = fs->n_fatent; /* Number of entries */ |
| sect = fs->fatbase; /* Top of the FAT */ |
| i = 0; /* Offset in the sector */ |
| do { /* Counts numbuer of entries with zero in the FAT */ |
| if (i == 0) { /* New sector? */ |
| res = move_window(fs, sect++); |
| if (res != FR_OK) break; |
| } |
| if (fs->fs_type == FS_FAT16) { |
| if (ld_word(fs->win + i) == 0) nfree++; |
| i += 2; |
| } else { |
| if ((ld_dword(fs->win + i) & 0x0FFFFFFF) == 0) nfree++; |
| i += 4; |
| } |
| i %= SS(fs); |
| } while (--clst); |
| } |
| } |
| if (res == FR_OK) { /* Update parameters if succeeded */ |
| *nclst = nfree; /* Return the free clusters */ |
| fs->free_clst = nfree; /* Now free_clst is valid */ |
| fs->fsi_flag |= 1; /* FAT32: FSInfo is to be updated */ |
| } |
| } |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Truncate File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_truncate ( |
| FIL* fp /* Pointer to the file object */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DWORD ncl; |
| |
| |
| res = validate(&fp->obj, &fs); /* Check validity of the file object */ |
| if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res); |
| if (!(fp->flag & FA_WRITE)) LEAVE_FF(fs, FR_DENIED); /* Check access mode */ |
| |
| if (fp->fptr < fp->obj.objsize) { /* Process when fptr is not on the eof */ |
| if (fp->fptr == 0) { /* When set file size to zero, remove entire cluster chain */ |
| res = remove_chain(&fp->obj, fp->obj.sclust, 0); |
| fp->obj.sclust = 0; |
| } else { /* When truncate a part of the file, remove remaining clusters */ |
| ncl = get_fat(&fp->obj, fp->clust); |
| res = FR_OK; |
| if (ncl == 0xFFFFFFFF) res = FR_DISK_ERR; |
| if (ncl == 1) res = FR_INT_ERR; |
| if (res == FR_OK && ncl < fs->n_fatent) { |
| res = remove_chain(&fp->obj, ncl, fp->clust); |
| } |
| } |
| fp->obj.objsize = fp->fptr; /* Set file size to current read/write point */ |
| fp->flag |= FA_MODIFIED; |
| #if !FF_FS_TINY |
| if (res == FR_OK && (fp->flag & FA_DIRTY)) { |
| if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) { |
| res = FR_DISK_ERR; |
| } else { |
| fp->flag &= (BYTE)~FA_DIRTY; |
| } |
| } |
| #endif |
| if (res != FR_OK) ABORT(fs, res); |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Delete a File/Directory */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_unlink ( |
| const TCHAR* path /* Pointer to the file or directory path */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DIR dj, sdj; |
| DWORD dclst = 0; |
| #if FF_FS_EXFAT |
| FFOBJID obj; |
| #endif |
| DEF_NAMBUF |
| |
| |
| /* Get logical drive */ |
| res = mount_volume(&path, &fs, FA_WRITE); |
| if (res == FR_OK) { |
| dj.obj.fs = fs; |
| INIT_NAMBUF(fs); |
| res = follow_path(&dj, path); /* Follow the file path */ |
| if (FF_FS_RPATH && res == FR_OK && (dj.fn[NSFLAG] & NS_DOT)) { |
| res = FR_INVALID_NAME; /* Cannot remove dot entry */ |
| } |
| #if FF_FS_LOCK |
| if (res == FR_OK) res = chk_share(&dj, 2); /* Check if it is an open object */ |
| #endif |
| if (res == FR_OK) { /* The object is accessible */ |
| if (dj.fn[NSFLAG] & NS_NONAME) { |
| res = FR_INVALID_NAME; /* Cannot remove the origin directory */ |
| } else { |
| if (dj.obj.attr & AM_RDO) { |
| res = FR_DENIED; /* Cannot remove R/O object */ |
| } |
| } |
| if (res == FR_OK) { |
| #if FF_FS_EXFAT |
| obj.fs = fs; |
| if (fs->fs_type == FS_EXFAT) { |
| init_alloc_info(fs, &obj); |
| dclst = obj.sclust; |
| } else |
| #endif |
| { |
| dclst = ld_clust(fs, dj.dir); |
| } |
| if (dj.obj.attr & AM_DIR) { /* Is it a sub-directory? */ |
| #if FF_FS_RPATH != 0 |
| if (dclst == fs->cdir) { /* Is it the current directory? */ |
| res = FR_DENIED; |
| } else |
| #endif |
| { |
| sdj.obj.fs = fs; /* Open the sub-directory */ |
| sdj.obj.sclust = dclst; |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| sdj.obj.objsize = obj.objsize; |
| sdj.obj.stat = obj.stat; |
| } |
| #endif |
| res = dir_sdi(&sdj, 0); |
| if (res == FR_OK) { |
| res = DIR_READ_FILE(&sdj); /* Test if the directory is empty */ |
| if (res == FR_OK) res = FR_DENIED; /* Not empty? */ |
| if (res == FR_NO_FILE) res = FR_OK; /* Empty? */ |
| } |
| } |
| } |
| } |
| if (res == FR_OK) { |
| res = dir_remove(&dj); /* Remove the directory entry */ |
| if (res == FR_OK && dclst != 0) { /* Remove the cluster chain if exist */ |
| #if FF_FS_EXFAT |
| res = remove_chain(&obj, dclst, 0); |
| #else |
| res = remove_chain(&dj.obj, dclst, 0); |
| #endif |
| } |
| if (res == FR_OK) res = sync_fs(fs); |
| } |
| } |
| FREE_NAMBUF(); |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Create a Directory */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_mkdir ( |
| const TCHAR* path /* Pointer to the directory path */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DIR dj; |
| FFOBJID sobj; |
| DWORD dcl, pcl, tm; |
| DEF_NAMBUF |
| |
| |
| res = mount_volume(&path, &fs, FA_WRITE); /* Get logical drive */ |
| if (res == FR_OK) { |
| dj.obj.fs = fs; |
| INIT_NAMBUF(fs); |
| res = follow_path(&dj, path); /* Follow the file path */ |
| if (res == FR_OK) res = FR_EXIST; /* Name collision? */ |
| if (FF_FS_RPATH && res == FR_NO_FILE && (dj.fn[NSFLAG] & NS_DOT)) { /* Invalid name? */ |
| res = FR_INVALID_NAME; |
| } |
| if (res == FR_NO_FILE) { /* It is clear to create a new directory */ |
| sobj.fs = fs; /* New object id to create a new chain */ |
| dcl = create_chain(&sobj, 0); /* Allocate a cluster for the new directory */ |
| res = FR_OK; |
| if (dcl == 0) res = FR_DENIED; /* No space to allocate a new cluster? */ |
| if (dcl == 1) res = FR_INT_ERR; /* Any insanity? */ |
| if (dcl == 0xFFFFFFFF) res = FR_DISK_ERR; /* Disk error? */ |
| tm = GET_FATTIME(); |
| if (res == FR_OK) { |
| res = dir_clear(fs, dcl); /* Clean up the new table */ |
| if (res == FR_OK) { |
| if (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT) { /* Create dot entries (FAT only) */ |
| memset(fs->win + DIR_Name, ' ', 11); /* Create "." entry */ |
| fs->win[DIR_Name] = '.'; |
| fs->win[DIR_Attr] = AM_DIR; |
| st_dword(fs->win + DIR_ModTime, tm); |
| st_clust(fs, fs->win, dcl); |
| memcpy(fs->win + SZDIRE, fs->win, SZDIRE); /* Create ".." entry */ |
| fs->win[SZDIRE + 1] = '.'; pcl = dj.obj.sclust; |
| st_clust(fs, fs->win + SZDIRE, pcl); |
| fs->wflag = 1; |
| } |
| res = dir_register(&dj); /* Register the object to the parent directoy */ |
| } |
| } |
| if (res == FR_OK) { |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* Initialize directory entry block */ |
| st_dword(fs->dirbuf + XDIR_ModTime, tm); /* Created time */ |
| st_dword(fs->dirbuf + XDIR_FstClus, dcl); /* Table start cluster */ |
| st_dword(fs->dirbuf + XDIR_FileSize, (DWORD)fs->csize * SS(fs)); /* Directory size needs to be valid */ |
| st_dword(fs->dirbuf + XDIR_ValidFileSize, (DWORD)fs->csize * SS(fs)); |
| fs->dirbuf[XDIR_GenFlags] = 3; /* Initialize the object flag */ |
| fs->dirbuf[XDIR_Attr] = AM_DIR; /* Attribute */ |
| res = store_xdir(&dj); |
| } else |
| #endif |
| { |
| st_dword(dj.dir + DIR_ModTime, tm); /* Created time */ |
| st_clust(fs, dj.dir, dcl); /* Table start cluster */ |
| dj.dir[DIR_Attr] = AM_DIR; /* Attribute */ |
| fs->wflag = 1; |
| } |
| if (res == FR_OK) { |
| res = sync_fs(fs); |
| } |
| } else { |
| remove_chain(&sobj, dcl, 0); /* Could not register, remove the allocated cluster */ |
| } |
| } |
| FREE_NAMBUF(); |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Rename a File/Directory */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_rename ( |
| const TCHAR* path_old, /* Pointer to the object name to be renamed */ |
| const TCHAR* path_new /* Pointer to the new name */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DIR djo, djn; |
| BYTE buf[FF_FS_EXFAT ? SZDIRE * 2 : SZDIRE], *dir; |
| LBA_t sect; |
| DEF_NAMBUF |
| |
| |
| get_ldnumber(&path_new); /* Snip the drive number of new name off */ |
| res = mount_volume(&path_old, &fs, FA_WRITE); /* Get logical drive of the old object */ |
| if (res == FR_OK) { |
| djo.obj.fs = fs; |
| INIT_NAMBUF(fs); |
| res = follow_path(&djo, path_old); /* Check old object */ |
| if (res == FR_OK && (djo.fn[NSFLAG] & (NS_DOT | NS_NONAME))) res = FR_INVALID_NAME; /* Check validity of name */ |
| #if FF_FS_LOCK |
| if (res == FR_OK) { |
| res = chk_share(&djo, 2); |
| } |
| #endif |
| if (res == FR_OK) { /* Object to be renamed is found */ |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* At exFAT volume */ |
| BYTE nf, nn; |
| WORD nh; |
| |
| memcpy(buf, fs->dirbuf, SZDIRE * 2); /* Save 85+C0 entry of old object */ |
| memcpy(&djn, &djo, sizeof djo); |
| res = follow_path(&djn, path_new); /* Make sure if new object name is not in use */ |
| if (res == FR_OK) { /* Is new name already in use by any other object? */ |
| res = (djn.obj.sclust == djo.obj.sclust && djn.dptr == djo.dptr) ? FR_NO_FILE : FR_EXIST; |
| } |
| if (res == FR_NO_FILE) { /* It is a valid path and no name collision */ |
| res = dir_register(&djn); /* Register the new entry */ |
| if (res == FR_OK) { |
| nf = fs->dirbuf[XDIR_NumSec]; nn = fs->dirbuf[XDIR_NumName]; |
| nh = ld_word(fs->dirbuf + XDIR_NameHash); |
| memcpy(fs->dirbuf, buf, SZDIRE * 2); /* Restore 85+C0 entry */ |
| fs->dirbuf[XDIR_NumSec] = nf; fs->dirbuf[XDIR_NumName] = nn; |
| st_word(fs->dirbuf + XDIR_NameHash, nh); |
| if (!(fs->dirbuf[XDIR_Attr] & AM_DIR)) fs->dirbuf[XDIR_Attr] |= AM_ARC; /* Set archive attribute if it is a file */ |
| /* Start of critical section where an interruption can cause a cross-link */ |
| res = store_xdir(&djn); |
| } |
| } |
| } else |
| #endif |
| { /* At FAT/FAT32 volume */ |
| memcpy(buf, djo.dir, SZDIRE); /* Save directory entry of the object */ |
| memcpy(&djn, &djo, sizeof (DIR)); /* Duplicate the directory object */ |
| res = follow_path(&djn, path_new); /* Make sure if new object name is not in use */ |
| if (res == FR_OK) { /* Is new name already in use by any other object? */ |
| res = (djn.obj.sclust == djo.obj.sclust && djn.dptr == djo.dptr) ? FR_NO_FILE : FR_EXIST; |
| } |
| if (res == FR_NO_FILE) { /* It is a valid path and no name collision */ |
| res = dir_register(&djn); /* Register the new entry */ |
| if (res == FR_OK) { |
| dir = djn.dir; /* Copy directory entry of the object except name */ |
| memcpy(dir + 13, buf + 13, SZDIRE - 13); |
| dir[DIR_Attr] = buf[DIR_Attr]; |
| if (!(dir[DIR_Attr] & AM_DIR)) dir[DIR_Attr] |= AM_ARC; /* Set archive attribute if it is a file */ |
| fs->wflag = 1; |
| if ((dir[DIR_Attr] & AM_DIR) && djo.obj.sclust != djn.obj.sclust) { /* Update .. entry in the sub-directory if needed */ |
| sect = clst2sect(fs, ld_clust(fs, dir)); |
| if (sect == 0) { |
| res = FR_INT_ERR; |
| } else { |
| /* Start of critical section where an interruption can cause a cross-link */ |
| res = move_window(fs, sect); |
| dir = fs->win + SZDIRE * 1; /* Ptr to .. entry */ |
| if (res == FR_OK && dir[1] == '.') { |
| st_clust(fs, dir, djn.obj.sclust); |
| fs->wflag = 1; |
| } |
| } |
| } |
| } |
| } |
| } |
| if (res == FR_OK) { |
| res = dir_remove(&djo); /* Remove old entry */ |
| if (res == FR_OK) { |
| res = sync_fs(fs); |
| } |
| } |
| /* End of the critical section */ |
| } |
| FREE_NAMBUF(); |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| #endif /* FF_FS_MINIMIZE == 0 */ |
| #endif /* FF_FS_MINIMIZE <= 1 */ |
| #endif /* FF_FS_MINIMIZE <= 2 */ |
| |
| |
| |
| #if FF_USE_CHMOD && !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* Change Attribute */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_chmod ( |
| const TCHAR* path, /* Pointer to the file path */ |
| BYTE attr, /* Attribute bits */ |
| BYTE mask /* Attribute mask to change */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DIR dj; |
| DEF_NAMBUF |
| |
| |
| res = mount_volume(&path, &fs, FA_WRITE); /* Get logical drive */ |
| if (res == FR_OK) { |
| dj.obj.fs = fs; |
| INIT_NAMBUF(fs); |
| res = follow_path(&dj, path); /* Follow the file path */ |
| if (res == FR_OK && (dj.fn[NSFLAG] & (NS_DOT | NS_NONAME))) res = FR_INVALID_NAME; /* Check object validity */ |
| if (res == FR_OK) { |
| mask &= AM_RDO|AM_HID|AM_SYS|AM_ARC; /* Valid attribute mask */ |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| fs->dirbuf[XDIR_Attr] = (attr & mask) | (fs->dirbuf[XDIR_Attr] & (BYTE)~mask); /* Apply attribute change */ |
| res = store_xdir(&dj); |
| } else |
| #endif |
| { |
| dj.dir[DIR_Attr] = (attr & mask) | (dj.dir[DIR_Attr] & (BYTE)~mask); /* Apply attribute change */ |
| fs->wflag = 1; |
| } |
| if (res == FR_OK) { |
| res = sync_fs(fs); |
| } |
| } |
| FREE_NAMBUF(); |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Change Timestamp */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_utime ( |
| const TCHAR* path, /* Pointer to the file/directory name */ |
| const FILINFO* fno /* Pointer to the timestamp to be set */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DIR dj; |
| DEF_NAMBUF |
| |
| |
| res = mount_volume(&path, &fs, FA_WRITE); /* Get logical drive */ |
| if (res == FR_OK) { |
| dj.obj.fs = fs; |
| INIT_NAMBUF(fs); |
| res = follow_path(&dj, path); /* Follow the file path */ |
| if (res == FR_OK && (dj.fn[NSFLAG] & (NS_DOT | NS_NONAME))) res = FR_INVALID_NAME; /* Check object validity */ |
| if (res == FR_OK) { |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| st_dword(fs->dirbuf + XDIR_ModTime, (DWORD)fno->fdate << 16 | fno->ftime); |
| res = store_xdir(&dj); |
| } else |
| #endif |
| { |
| st_dword(dj.dir + DIR_ModTime, (DWORD)fno->fdate << 16 | fno->ftime); |
| fs->wflag = 1; |
| } |
| if (res == FR_OK) { |
| res = sync_fs(fs); |
| } |
| } |
| FREE_NAMBUF(); |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| #endif /* FF_USE_CHMOD && !FF_FS_READONLY */ |
| |
| |
| |
| #if FF_USE_LABEL |
| /*-----------------------------------------------------------------------*/ |
| /* Get Volume Label */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_getlabel ( |
| const TCHAR* path, /* Logical drive number */ |
| TCHAR* label, /* Buffer to store the volume label */ |
| DWORD* vsn /* Variable to store the volume serial number */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DIR dj; |
| UINT si, di; |
| WCHAR wc; |
| |
| /* Get logical drive */ |
| res = mount_volume(&path, &fs, 0); |
| |
| /* Get volume label */ |
| if (res == FR_OK && label) { |
| dj.obj.fs = fs; dj.obj.sclust = 0; /* Open root directory */ |
| res = dir_sdi(&dj, 0); |
| if (res == FR_OK) { |
| res = DIR_READ_LABEL(&dj); /* Find a volume label entry */ |
| if (res == FR_OK) { |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| WCHAR hs; |
| UINT nw; |
| |
| for (si = di = hs = 0; si < dj.dir[XDIR_NumLabel]; si++) { /* Extract volume label from 83 entry */ |
| wc = ld_word(dj.dir + XDIR_Label + si * 2); |
| if (hs == 0 && IsSurrogate(wc)) { /* Is the code a surrogate? */ |
| hs = wc; continue; |
| } |
| nw = put_utf((DWORD)hs << 16 | wc, &label[di], 4); /* Store it in API encoding */ |
| if (nw == 0) { /* Encode error? */ |
| di = 0; break; |
| } |
| di += nw; |
| hs = 0; |
| } |
| if (hs != 0) di = 0; /* Broken surrogate pair? */ |
| label[di] = 0; |
| } else |
| #endif |
| { |
| si = di = 0; /* Extract volume label from AM_VOL entry */ |
| while (si < 11) { |
| wc = dj.dir[si++]; |
| #if FF_USE_LFN && FF_LFN_UNICODE >= 1 /* Unicode output */ |
| if (dbc_1st((BYTE)wc) && si < 11) wc = wc << 8 | dj.dir[si++]; /* Is it a DBC? */ |
| wc = ff_oem2uni(wc, CODEPAGE); /* Convert it into Unicode */ |
| if (wc == 0) { /* Invalid char in current code page? */ |
| di = 0; break; |
| } |
| di += put_utf(wc, &label[di], 4); /* Store it in Unicode */ |
| #else /* ANSI/OEM output */ |
| label[di++] = (TCHAR)wc; |
| #endif |
| } |
| do { /* Truncate trailing spaces */ |
| label[di] = 0; |
| if (di == 0) break; |
| } while (label[--di] == ' '); |
| } |
| } |
| } |
| if (res == FR_NO_FILE) { /* No label entry and return nul string */ |
| label[0] = 0; |
| res = FR_OK; |
| } |
| } |
| |
| /* Get volume serial number */ |
| if (res == FR_OK && vsn) { |
| res = move_window(fs, fs->volbase); |
| if (res == FR_OK) { |
| switch (fs->fs_type) { |
| case FS_EXFAT: |
| di = BPB_VolIDEx; |
| break; |
| |
| case FS_FAT32: |
| di = BS_VolID32; |
| break; |
| |
| default: |
| di = BS_VolID; |
| } |
| *vsn = ld_dword(fs->win + di); |
| } |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| |
| |
| #if !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* Set Volume Label */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_setlabel ( |
| const TCHAR* label /* Volume label to set with heading logical drive number */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DIR dj; |
| BYTE dirvn[22]; |
| UINT di; |
| WCHAR wc; |
| static const char badchr[18] = "+.,;=[]" "/*:<>|\\\"\?\x7F"; /* [0..16] for FAT, [7..16] for exFAT */ |
| #if FF_USE_LFN |
| DWORD dc; |
| #endif |
| |
| /* Get logical drive */ |
| res = mount_volume(&label, &fs, FA_WRITE); |
| if (res != FR_OK) LEAVE_FF(fs, res); |
| |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */ |
| memset(dirvn, 0, 22); |
| di = 0; |
| while ((UINT)*label >= ' ') { /* Create volume label */ |
| dc = tchar2uni(&label); /* Get a Unicode character */ |
| if (dc >= 0x10000) { |
| if (dc == 0xFFFFFFFF || di >= 10) { /* Wrong surrogate or buffer overflow */ |
| dc = 0; |
| } else { |
| st_word(dirvn + di * 2, (WCHAR)(dc >> 16)); di++; |
| } |
| } |
| if (dc == 0 || strchr(&badchr[7], (int)dc) || di >= 11) { /* Check validity of the volume label */ |
| LEAVE_FF(fs, FR_INVALID_NAME); |
| } |
| st_word(dirvn + di * 2, (WCHAR)dc); di++; |
| } |
| } else |
| #endif |
| { /* On the FAT/FAT32 volume */ |
| memset(dirvn, ' ', 11); |
| di = 0; |
| while ((UINT)*label >= ' ') { /* Create volume label */ |
| #if FF_USE_LFN |
| dc = tchar2uni(&label); |
| wc = (dc < 0x10000) ? ff_uni2oem(ff_wtoupper(dc), CODEPAGE) : 0; |
| #else /* ANSI/OEM input */ |
| wc = (BYTE)*label++; |
| if (dbc_1st((BYTE)wc)) wc = dbc_2nd((BYTE)*label) ? wc << 8 | (BYTE)*label++ : 0; |
| if (IsLower(wc)) wc -= 0x20; /* To upper ASCII characters */ |
| #if FF_CODE_PAGE == 0 |
| if (ExCvt && wc >= 0x80) wc = ExCvt[wc - 0x80]; /* To upper extended characters (SBCS cfg) */ |
| #elif FF_CODE_PAGE < 900 |
| if (wc >= 0x80) wc = ExCvt[wc - 0x80]; /* To upper extended characters (SBCS cfg) */ |
| #endif |
| #endif |
| if (wc == 0 || strchr(&badchr[0], (int)wc) || di >= (UINT)((wc >= 0x100) ? 10 : 11)) { /* Reject invalid characters for volume label */ |
| LEAVE_FF(fs, FR_INVALID_NAME); |
| } |
| if (wc >= 0x100) dirvn[di++] = (BYTE)(wc >> 8); |
| dirvn[di++] = (BYTE)wc; |
| } |
| if (dirvn[0] == DDEM) LEAVE_FF(fs, FR_INVALID_NAME); /* Reject illegal name (heading DDEM) */ |
| while (di && dirvn[di - 1] == ' ') di--; /* Snip trailing spaces */ |
| } |
| |
| /* Set volume label */ |
| dj.obj.fs = fs; dj.obj.sclust = 0; /* Open root directory */ |
| res = dir_sdi(&dj, 0); |
| if (res == FR_OK) { |
| res = DIR_READ_LABEL(&dj); /* Get volume label entry */ |
| if (res == FR_OK) { |
| if (FF_FS_EXFAT && fs->fs_type == FS_EXFAT) { |
| dj.dir[XDIR_NumLabel] = (BYTE)di; /* Change the volume label */ |
| memcpy(dj.dir + XDIR_Label, dirvn, 22); |
| } else { |
| if (di != 0) { |
| memcpy(dj.dir, dirvn, 11); /* Change the volume label */ |
| } else { |
| dj.dir[DIR_Name] = DDEM; /* Remove the volume label */ |
| } |
| } |
| fs->wflag = 1; |
| res = sync_fs(fs); |
| } else { /* No volume label entry or an error */ |
| if (res == FR_NO_FILE) { |
| res = FR_OK; |
| if (di != 0) { /* Create a volume label entry */ |
| res = dir_alloc(&dj, 1); /* Allocate an entry */ |
| if (res == FR_OK) { |
| memset(dj.dir, 0, SZDIRE); /* Clean the entry */ |
| if (FF_FS_EXFAT && fs->fs_type == FS_EXFAT) { |
| dj.dir[XDIR_Type] = ET_VLABEL; /* Create volume label entry */ |
| dj.dir[XDIR_NumLabel] = (BYTE)di; |
| memcpy(dj.dir + XDIR_Label, dirvn, 22); |
| } else { |
| dj.dir[DIR_Attr] = AM_VOL; /* Create volume label entry */ |
| memcpy(dj.dir, dirvn, 11); |
| } |
| fs->wflag = 1; |
| res = sync_fs(fs); |
| } |
| } |
| } |
| } |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| #endif /* FF_USE_LABEL */ |
| |
| |
| |
| #if FF_USE_EXPAND && !FF_FS_READONLY |
| /*-----------------------------------------------------------------------*/ |
| /* Allocate a Contiguous Blocks to the File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_expand ( |
| FIL* fp, /* Pointer to the file object */ |
| FSIZE_t fsz, /* File size to be expanded to */ |
| BYTE opt /* Operation mode 0:Find and prepare or 1:Find and allocate */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DWORD n, clst, stcl, scl, ncl, tcl, lclst; |
| |
| |
| res = validate(&fp->obj, &fs); /* Check validity of the file object */ |
| if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res); |
| if (fsz == 0 || fp->obj.objsize != 0 || !(fp->flag & FA_WRITE)) LEAVE_FF(fs, FR_DENIED); |
| #if FF_FS_EXFAT |
| if (fs->fs_type != FS_EXFAT && fsz >= 0x100000000) LEAVE_FF(fs, FR_DENIED); /* Check if in size limit */ |
| #endif |
| n = (DWORD)fs->csize * SS(fs); /* Cluster size */ |
| tcl = (DWORD)(fsz / n) + ((fsz & (n - 1)) ? 1 : 0); /* Number of clusters required */ |
| stcl = fs->last_clst; lclst = 0; |
| if (stcl < 2 || stcl >= fs->n_fatent) stcl = 2; |
| |
| #if FF_FS_EXFAT |
| if (fs->fs_type == FS_EXFAT) { |
| scl = find_bitmap(fs, stcl, tcl); /* Find a contiguous cluster block */ |
| if (scl == 0) res = FR_DENIED; /* No contiguous cluster block was found */ |
| if (scl == 0xFFFFFFFF) res = FR_DISK_ERR; |
| if (res == FR_OK) { /* A contiguous free area is found */ |
| if (opt) { /* Allocate it now */ |
| res = change_bitmap(fs, scl, tcl, 1); /* Mark the cluster block 'in use' */ |
| lclst = scl + tcl - 1; |
| } else { /* Set it as suggested point for next allocation */ |
| lclst = scl - 1; |
| } |
| } |
| } else |
| #endif |
| { |
| scl = clst = stcl; ncl = 0; |
| for (;;) { /* Find a contiguous cluster block */ |
| n = get_fat(&fp->obj, clst); |
| if (++clst >= fs->n_fatent) clst = 2; |
| if (n == 1) { |
| res = FR_INT_ERR; break; |
| } |
| if (n == 0xFFFFFFFF) { |
| res = FR_DISK_ERR; break; |
| } |
| if (n == 0) { /* Is it a free cluster? */ |
| if (++ncl == tcl) break; /* Break if a contiguous cluster block is found */ |
| } else { |
| scl = clst; ncl = 0; /* Not a free cluster */ |
| } |
| if (clst == stcl) { /* No contiguous cluster? */ |
| res = FR_DENIED; break; |
| } |
| } |
| if (res == FR_OK) { /* A contiguous free area is found */ |
| if (opt) { /* Allocate it now */ |
| for (clst = scl, n = tcl; n; clst++, n--) { /* Create a cluster chain on the FAT */ |
| res = put_fat(fs, clst, (n == 1) ? 0xFFFFFFFF : clst + 1); |
| if (res != FR_OK) break; |
| lclst = clst; |
| } |
| } else { /* Set it as suggested point for next allocation */ |
| lclst = scl - 1; |
| } |
| } |
| } |
| |
| if (res == FR_OK) { |
| fs->last_clst = lclst; /* Set suggested start cluster to start next */ |
| if (opt) { /* Is it allocated now? */ |
| fp->obj.sclust = scl; /* Update object allocation information */ |
| fp->obj.objsize = fsz; |
| if (FF_FS_EXFAT) fp->obj.stat = 2; /* Set status 'contiguous chain' */ |
| fp->flag |= FA_MODIFIED; |
| if (fs->free_clst <= fs->n_fatent - 2) { /* Update FSINFO */ |
| fs->free_clst -= tcl; |
| fs->fsi_flag |= 1; |
| } |
| } |
| } |
| |
| LEAVE_FF(fs, res); |
| } |
| |
| #endif /* FF_USE_EXPAND && !FF_FS_READONLY */ |
| |
| |
| |
| #if FF_USE_FORWARD |
| /*-----------------------------------------------------------------------*/ |
| /* Forward Data to the Stream Directly */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_forward ( |
| FIL* fp, /* Pointer to the file object */ |
| UINT (*func)(const BYTE*,UINT), /* Pointer to the streaming function */ |
| UINT btf, /* Number of bytes to forward */ |
| UINT* bf /* Pointer to number of bytes forwarded */ |
| ) |
| { |
| FRESULT res; |
| FATFS *fs; |
| DWORD clst; |
| LBA_t sect; |
| FSIZE_t remain; |
| UINT rcnt, csect; |
| BYTE *dbuf; |
| |
| |
| *bf = 0; /* Clear transfer byte counter */ |
| res = validate(&fp->obj, &fs); /* Check validity of the file object */ |
| if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res); |
| if (!(fp->flag & FA_READ)) LEAVE_FF(fs, FR_DENIED); /* Check access mode */ |
| |
| remain = fp->obj.objsize - fp->fptr; |
| if (btf > remain) btf = (UINT)remain; /* Truncate btf by remaining bytes */ |
| |
| for ( ; btf > 0 && (*func)(0, 0); fp->fptr += rcnt, *bf += rcnt, btf -= rcnt) { /* Repeat until all data transferred or stream goes busy */ |
| csect = (UINT)(fp->fptr / SS(fs) & (fs->csize - 1)); /* Sector offset in the cluster */ |
| if (fp->fptr % SS(fs) == 0) { /* On the sector boundary? */ |
| if (csect == 0) { /* On the cluster boundary? */ |
| clst = (fp->fptr == 0) ? /* On the top of the file? */ |
| fp->obj.sclust : get_fat(&fp->obj, fp->clust); |
| if (clst <= 1) ABORT(fs, FR_INT_ERR); |
| if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR); |
| fp->clust = clst; /* Update current cluster */ |
| } |
| } |
| sect = clst2sect(fs, fp->clust); /* Get current data sector */ |
| if (sect == 0) ABORT(fs, FR_INT_ERR); |
| sect += csect; |
| #if FF_FS_TINY |
| if (move_window(fs, sect) != FR_OK) ABORT(fs, FR_DISK_ERR); /* Move sector window to the file data */ |
| dbuf = fs->win; |
| #else |
| if (fp->sect != sect) { /* Fill sector cache with file data */ |
| #if !FF_FS_READONLY |
| if (fp->flag & FA_DIRTY) { /* Write-back dirty sector cache */ |
| if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); |
| fp->flag &= (BYTE)~FA_DIRTY; |
| } |
| #endif |
| if (disk_read(fs->pdrv, fp->buf, sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); |
| } |
| dbuf = fp->buf; |
| #endif |
| fp->sect = sect; |
| rcnt = SS(fs) - (UINT)fp->fptr % SS(fs); /* Number of bytes remains in the sector */ |
| if (rcnt > btf) rcnt = btf; /* Clip it by btr if needed */ |
| rcnt = (*func)(dbuf + ((UINT)fp->fptr % SS(fs)), rcnt); /* Forward the file data */ |
| if (rcnt == 0) ABORT(fs, FR_INT_ERR); |
| } |
| |
| LEAVE_FF(fs, FR_OK); |
| } |
| #endif /* FF_USE_FORWARD */ |
| |
| |
| |
| #if !FF_FS_READONLY && FF_USE_MKFS |
| /*-----------------------------------------------------------------------*/ |
| /* Create FAT/exFAT volume (with sub-functions) */ |
| /*-----------------------------------------------------------------------*/ |
| |
| #define N_SEC_TRACK 63 /* Sectors per track for determination of drive CHS */ |
| #define GPT_ALIGN 0x100000 /* Alignment of partitions in GPT [byte] (>=128KB) */ |
| #define GPT_ITEMS 128 /* Number of GPT table size (>=128, sector aligned) */ |
| |
| |
| /* Create partitions on the physical drive in format of MBR or GPT */ |
| |
| static FRESULT create_partition ( |
| BYTE drv, /* Physical drive number */ |
| const LBA_t plst[], /* Partition list */ |
| BYTE sys, /* System ID for each partition (for only MBR) */ |
| BYTE *buf /* Working buffer for a sector */ |
| ) |
| { |
| UINT i, cy; |
| LBA_t sz_drv; |
| DWORD sz_drv32, nxt_alloc32, sz_part32; |
| BYTE *pte; |
| BYTE hd, n_hd, sc, n_sc; |
| |
| /* Get physical drive size */ |
| if (disk_ioctl(drv, GET_SECTOR_COUNT, &sz_drv) != RES_OK) return FR_DISK_ERR; |
| |
| #if FF_LBA64 |
| if (sz_drv >= FF_MIN_GPT) { /* Create partitions in GPT format */ |
| WORD ss; |
| UINT sz_ptbl, pi, si, ofs; |
| DWORD bcc, rnd, align; |
| QWORD nxt_alloc, sz_part, sz_pool, top_bpt; |
| static const BYTE gpt_mbr[16] = {0x00, 0x00, 0x02, 0x00, 0xEE, 0xFE, 0xFF, 0x00, 0x01, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF}; |
| |
| #if FF_MAX_SS != FF_MIN_SS |
| if (disk_ioctl(drv, GET_SECTOR_SIZE, &ss) != RES_OK) return FR_DISK_ERR; /* Get sector size */ |
| if (ss > FF_MAX_SS || ss < FF_MIN_SS || (ss & (ss - 1))) return FR_DISK_ERR; |
| #else |
| ss = FF_MAX_SS; |
| #endif |
| rnd = (DWORD)sz_drv + GET_FATTIME(); /* Random seed */ |
| align = GPT_ALIGN / ss; /* Partition alignment for GPT [sector] */ |
| sz_ptbl = GPT_ITEMS * SZ_GPTE / ss; /* Size of partition table [sector] */ |
| top_bpt = sz_drv - sz_ptbl - 1; /* Backup partition table start sector */ |
| nxt_alloc = 2 + sz_ptbl; /* First allocatable sector */ |
| sz_pool = top_bpt - nxt_alloc; /* Size of allocatable area */ |
| bcc = 0xFFFFFFFF; sz_part = 1; |
| pi = si = 0; /* partition table index, size table index */ |
| do { |
| if (pi * SZ_GPTE % ss == 0) memset(buf, 0, ss); /* Clean the buffer if needed */ |
| if (sz_part != 0) { /* Is the size table not termintated? */ |
| nxt_alloc = (nxt_alloc + align - 1) & ((QWORD)0 - align); /* Align partition start */ |
| sz_part = plst[si++]; /* Get a partition size */ |
| if (sz_part <= 100) { /* Is the size in percentage? */ |
| sz_part = sz_pool * sz_part / 100; |
| sz_part = (sz_part + align - 1) & ((QWORD)0 - align); /* Align partition end (only if in percentage) */ |
| } |
| if (nxt_alloc + sz_part > top_bpt) { /* Clip the size at end of the pool */ |
| sz_part = (nxt_alloc < top_bpt) ? top_bpt - nxt_alloc : 0; |
| } |
| } |
| if (sz_part != 0) { /* Add a partition? */ |
| ofs = pi * SZ_GPTE % ss; |
| memcpy(buf + ofs + GPTE_PtGuid, GUID_MS_Basic, 16); /* Set partition GUID (Microsoft Basic Data) */ |
| rnd = make_rand(rnd, buf + ofs + GPTE_UpGuid, 16); /* Set unique partition GUID */ |
| st_qword(buf + ofs + GPTE_FstLba, nxt_alloc); /* Set partition start sector */ |
| st_qword(buf + ofs + GPTE_LstLba, nxt_alloc + sz_part - 1); /* Set partition end sector */ |
| nxt_alloc += sz_part; /* Next allocatable sector */ |
| } |
| if ((pi + 1) * SZ_GPTE % ss == 0) { /* Write the buffer if it is filled up */ |
| for (i = 0; i < ss; bcc = crc32(bcc, buf[i++])) ; /* Calculate table check sum */ |
| if (disk_write(drv, buf, 2 + pi * SZ_GPTE / ss, 1) != RES_OK) return FR_DISK_ERR; /* Write to primary table */ |
| if (disk_write(drv, buf, top_bpt + pi * SZ_GPTE / ss, 1) != RES_OK) return FR_DISK_ERR; /* Write to secondary table */ |
| } |
| } while (++pi < GPT_ITEMS); |
| |
| /* Create primary GPT header */ |
| memset(buf, 0, ss); |
| memcpy(buf + GPTH_Sign, "EFI PART" "\0\0\1\0" "\x5C\0\0", 16); /* Signature, version (1.0) and size (92) */ |
| st_dword(buf + GPTH_PtBcc, ~bcc); /* Table check sum */ |
| st_qword(buf + GPTH_CurLba, 1); /* LBA of this header */ |
| st_qword(buf + GPTH_BakLba, sz_drv - 1); /* LBA of secondary header */ |
| st_qword(buf + GPTH_FstLba, 2 + sz_ptbl); /* LBA of first allocatable sector */ |
| st_qword(buf + GPTH_LstLba, top_bpt - 1); /* LBA of last allocatable sector */ |
| st_dword(buf + GPTH_PteSize, SZ_GPTE); /* Size of a table entry */ |
| st_dword(buf + GPTH_PtNum, GPT_ITEMS); /* Number of table entries */ |
| st_dword(buf + GPTH_PtOfs, 2); /* LBA of this table */ |
| rnd = make_rand(rnd, buf + GPTH_DskGuid, 16); /* Disk GUID */ |
| for (i = 0, bcc= 0xFFFFFFFF; i < 92; bcc = crc32(bcc, buf[i++])) ; /* Calculate header check sum */ |
| st_dword(buf + GPTH_Bcc, ~bcc); /* Header check sum */ |
| if (disk_write(drv, buf, 1, 1) != RES_OK) return FR_DISK_ERR; |
| |
| /* Create secondary GPT header */ |
| st_qword(buf + GPTH_CurLba, sz_drv - 1); /* LBA of this header */ |
| st_qword(buf + GPTH_BakLba, 1); /* LBA of primary header */ |
| st_qword(buf + GPTH_PtOfs, top_bpt); /* LBA of this table */ |
| st_dword(buf + GPTH_Bcc, 0); |
| for (i = 0, bcc= 0xFFFFFFFF; i < 92; bcc = crc32(bcc, buf[i++])) ; /* Calculate header check sum */ |
| st_dword(buf + GPTH_Bcc, ~bcc); /* Header check sum */ |
| if (disk_write(drv, buf, sz_drv - 1, 1) != RES_OK) return FR_DISK_ERR; |
| |
| /* Create protective MBR */ |
| memset(buf, 0, ss); |
| memcpy(buf + MBR_Table, gpt_mbr, 16); /* Create a GPT partition */ |
| st_word(buf + BS_55AA, 0xAA55); |
| if (disk_write(drv, buf, 0, 1) != RES_OK) return FR_DISK_ERR; |
| |
| } else |
| #endif |
| { /* Create partitions in MBR format */ |
| sz_drv32 = (DWORD)sz_drv; |
| n_sc = N_SEC_TRACK; /* Determine drive CHS without any consideration of the drive geometry */ |
| for (n_hd = 8; n_hd != 0 && sz_drv32 / n_hd / n_sc > 1024; n_hd *= 2) ; |
| if (n_hd == 0) n_hd = 255; /* Number of heads needs to be <256 */ |
| |
| memset(buf, 0, FF_MAX_SS); /* Clear MBR */ |
| pte = buf + MBR_Table; /* Partition table in the MBR */ |
| for (i = 0, nxt_alloc32 = n_sc; i < 4 && nxt_alloc32 != 0 && nxt_alloc32 < sz_drv32; i++, nxt_alloc32 += sz_part32) { |
| sz_part32 = (DWORD)plst[i]; /* Get partition size */ |
| if (sz_part32 <= 100) sz_part32 = (sz_part32 == 100) ? sz_drv32 : sz_drv32 / 100 * sz_part32; /* Size in percentage? */ |
| if (nxt_alloc32 + sz_part32 > sz_drv32 || nxt_alloc32 + sz_part32 < nxt_alloc32) sz_part32 = sz_drv32 - nxt_alloc32; /* Clip at drive size */ |
| if (sz_part32 == 0) break; /* End of table or no sector to allocate? */ |
| |
| st_dword(pte + PTE_StLba, nxt_alloc32); /* Start LBA */ |
| st_dword(pte + PTE_SizLba, sz_part32); /* Number of sectors */ |
| pte[PTE_System] = sys; /* System type */ |
| |
| cy = (UINT)(nxt_alloc32 / n_sc / n_hd); /* Start cylinder */ |
| hd = (BYTE)(nxt_alloc32 / n_sc % n_hd); /* Start head */ |
| sc = (BYTE)(nxt_alloc32 % n_sc + 1); /* Start sector */ |
| pte[PTE_StHead] = hd; |
| pte[PTE_StSec] = (BYTE)((cy >> 2 & 0xC0) | sc); |
| pte[PTE_StCyl] = (BYTE)cy; |
| |
| cy = (UINT)((nxt_alloc32 + sz_part32 - 1) / n_sc / n_hd); /* End cylinder */ |
| hd = (BYTE)((nxt_alloc32 + sz_part32 - 1) / n_sc % n_hd); /* End head */ |
| sc = (BYTE)((nxt_alloc32 + sz_part32 - 1) % n_sc + 1); /* End sector */ |
| pte[PTE_EdHead] = hd; |
| pte[PTE_EdSec] = (BYTE)((cy >> 2 & 0xC0) | sc); |
| pte[PTE_EdCyl] = (BYTE)cy; |
| |
| pte += SZ_PTE; /* Next entry */ |
| } |
| |
| st_word(buf + BS_55AA, 0xAA55); /* MBR signature */ |
| if (disk_write(drv, buf, 0, 1) != RES_OK) return FR_DISK_ERR; /* Write it to the MBR */ |
| } |
| |
| return FR_OK; |
| } |
| |
| |
| |
| FRESULT f_mkfs ( |
| const TCHAR* path, /* Logical drive number */ |
| const MKFS_PARM* opt, /* Format options */ |
| void* work, /* Pointer to working buffer (null: use len bytes of heap memory) */ |
| UINT len /* Size of working buffer [byte] */ |
| ) |
| { |
| static const WORD cst[] = {1, 4, 16, 64, 256, 512, 0}; /* Cluster size boundary for FAT volume (4Ks unit) */ |
| static const WORD cst32[] = {1, 2, 4, 8, 16, 32, 0}; /* Cluster size boundary for FAT32 volume (128Ks unit) */ |
| static const MKFS_PARM defopt = {FM_ANY, 0, 0, 0, 0}; /* Default parameter */ |
| BYTE fsopt, fsty, sys, pdrv, ipart; |
| BYTE *buf; |
| BYTE *pte; |
| WORD ss; /* Sector size */ |
| DWORD sz_buf, sz_blk, n_clst, pau, nsect, n, vsn; |
| LBA_t sz_vol, b_vol, b_fat, b_data; /* Size of volume, Base LBA of volume, fat, data */ |
| LBA_t sect, lba[2]; |
| DWORD sz_rsv, sz_fat, sz_dir, sz_au; /* Size of reserved, fat, dir, data, cluster */ |
| UINT n_fat, n_root, i; /* Index, Number of FATs and Number of roor dir entries */ |
| int vol; |
| DSTATUS ds; |
| FRESULT res; |
| |
| |
| /* Check mounted drive and clear work area */ |
| vol = get_ldnumber(&path); /* Get target logical drive */ |
| if (vol < 0) return FR_INVALID_DRIVE; |
| if (FatFs[vol]) FatFs[vol]->fs_type = 0; /* Clear the fs object if mounted */ |
| pdrv = LD2PD(vol); /* Hosting physical drive */ |
| ipart = LD2PT(vol); /* Hosting partition (0:create as new, 1..:existing partition) */ |
| |
| /* Initialize the hosting physical drive */ |
| ds = disk_initialize(pdrv); |
| if (ds & STA_NOINIT) return FR_NOT_READY; |
| if (ds & STA_PROTECT) return FR_WRITE_PROTECTED; |
| |
| /* Get physical drive parameters (sz_drv, sz_blk and ss) */ |
| if (!opt) opt = &defopt; /* Use default parameter if it is not given */ |
| sz_blk = opt->align; |
| if (sz_blk == 0) disk_ioctl(pdrv, GET_BLOCK_SIZE, &sz_blk); /* Block size from the paramter or lower layer */ |
| if (sz_blk == 0 || sz_blk > 0x8000 || (sz_blk & (sz_blk - 1))) sz_blk = 1; /* Use default if the block size is invalid */ |
| #if FF_MAX_SS != FF_MIN_SS |
| if (disk_ioctl(pdrv, GET_SECTOR_SIZE, &ss) != RES_OK) return FR_DISK_ERR; |
| if (ss > FF_MAX_SS || ss < FF_MIN_SS || (ss & (ss - 1))) return FR_DISK_ERR; |
| #else |
| ss = FF_MAX_SS; |
| #endif |
| |
| /* Options for FAT sub-type and FAT parameters */ |
| fsopt = opt->fmt & (FM_ANY | FM_SFD); |
| n_fat = (opt->n_fat >= 1 && opt->n_fat <= 2) ? opt->n_fat : 1; |
| n_root = (opt->n_root >= 1 && opt->n_root <= 32768 && (opt->n_root % (ss / SZDIRE)) == 0) ? opt->n_root : 512; |
| sz_au = (opt->au_size <= 0x1000000 && (opt->au_size & (opt->au_size - 1)) == 0) ? opt->au_size : 0; |
| sz_au /= ss; /* Byte --> Sector */ |
| |
| /* Get working buffer */ |
| sz_buf = len / ss; /* Size of working buffer [sector] */ |
| if (sz_buf == 0) return FR_NOT_ENOUGH_CORE; |
| buf = (BYTE*)work; /* Working buffer */ |
| #if FF_USE_LFN == 3 |
| if (!buf) buf = ff_memalloc(sz_buf * ss); /* Use heap memory for working buffer */ |
| #endif |
| if (!buf) return FR_NOT_ENOUGH_CORE; |
| |
| /* Determine where the volume to be located (b_vol, sz_vol) */ |
| b_vol = sz_vol = 0; |
| if (FF_MULTI_PARTITION && ipart != 0) { /* Is the volume associated with any specific partition? */ |
| /* Get partition location from the existing partition table */ |
| if (disk_read(pdrv, buf, 0, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); /* Load MBR */ |
| if (ld_word(buf + BS_55AA) != 0xAA55) LEAVE_MKFS(FR_MKFS_ABORTED); /* Check if MBR is valid */ |
| #if FF_LBA64 |
| if (buf[MBR_Table + PTE_System] == 0xEE) { /* GPT protective MBR? */ |
| DWORD n_ent, ofs; |
| QWORD pt_lba; |
| |
| /* Get the partition location from GPT */ |
| if (disk_read(pdrv, buf, 1, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); /* Load GPT header sector (next to MBR) */ |
| if (!test_gpt_header(buf)) LEAVE_MKFS(FR_MKFS_ABORTED); /* Check if GPT header is valid */ |
| n_ent = ld_dword(buf + GPTH_PtNum); /* Number of entries */ |
| pt_lba = ld_qword(buf + GPTH_PtOfs); /* Table start sector */ |
| ofs = i = 0; |
| while (n_ent) { /* Find MS Basic partition with order of ipart */ |
| if (ofs == 0 && disk_read(pdrv, buf, pt_lba++, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); /* Get PT sector */ |
| if (!memcmp(buf + ofs + GPTE_PtGuid, GUID_MS_Basic, 16) && ++i == ipart) { /* MS basic data partition? */ |
| b_vol = ld_qword(buf + ofs + GPTE_FstLba); |
| sz_vol = ld_qword(buf + ofs + GPTE_LstLba) - b_vol + 1; |
| break; |
| } |
| n_ent--; ofs = (ofs + SZ_GPTE) % ss; /* Next entry */ |
| } |
| if (n_ent == 0) LEAVE_MKFS(FR_MKFS_ABORTED); /* Partition not found */ |
| fsopt |= 0x80; /* Partitioning is in GPT */ |
| } else |
| #endif |
| { /* Get the partition location from MBR partition table */ |
| pte = buf + (MBR_Table + (ipart - 1) * SZ_PTE); |
| if (ipart > 4 || pte[PTE_System] == 0) LEAVE_MKFS(FR_MKFS_ABORTED); /* No partition? */ |
| b_vol = ld_dword(pte + PTE_StLba); /* Get volume start sector */ |
| sz_vol = ld_dword(pte + PTE_SizLba); /* Get volume size */ |
| } |
| } else { /* The volume is associated with a physical drive */ |
| if (disk_ioctl(pdrv, GET_SECTOR_COUNT, &sz_vol) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| if (!(fsopt & FM_SFD)) { /* To be partitioned? */ |
| /* Create a single-partition on the drive in this function */ |
| #if FF_LBA64 |
| if (sz_vol >= FF_MIN_GPT) { /* Which partition type to create, MBR or GPT? */ |
| fsopt |= 0x80; /* Partitioning is in GPT */ |
| b_vol = GPT_ALIGN / ss; sz_vol -= b_vol + GPT_ITEMS * SZ_GPTE / ss + 1; /* Estimated partition offset and size */ |
| } else |
| #endif |
| { /* Partitioning is in MBR */ |
| if (sz_vol > N_SEC_TRACK) { |
| b_vol = N_SEC_TRACK; sz_vol -= b_vol; /* Estimated partition offset and size */ |
| } |
| } |
| } |
| } |
| if (sz_vol < 128) LEAVE_MKFS(FR_MKFS_ABORTED); /* Check if volume size is >=128s */ |
| |
| /* Now start to create an FAT volume at b_vol and sz_vol */ |
| |
| do { /* Pre-determine the FAT type */ |
| if (FF_FS_EXFAT && (fsopt & FM_EXFAT)) { /* exFAT possible? */ |
| if ((fsopt & FM_ANY) == FM_EXFAT || sz_vol >= 0x4000000 || sz_au > 128) { /* exFAT only, vol >= 64MS or sz_au > 128S ? */ |
| fsty = FS_EXFAT; break; |
| } |
| } |
| #if FF_LBA64 |
| if (sz_vol >= 0x100000000) LEAVE_MKFS(FR_MKFS_ABORTED); /* Too large volume for FAT/FAT32 */ |
| #endif |
| if (sz_au > 128) sz_au = 128; /* Invalid AU for FAT/FAT32? */ |
| if (fsopt & FM_FAT32) { /* FAT32 possible? */ |
| if (!(fsopt & FM_FAT)) { /* no-FAT? */ |
| fsty = FS_FAT32; break; |
| } |
| } |
| if (!(fsopt & FM_FAT)) LEAVE_MKFS(FR_INVALID_PARAMETER); /* no-FAT? */ |
| fsty = FS_FAT16; |
| } while (0); |
| |
| vsn = (DWORD)sz_vol + GET_FATTIME(); /* VSN generated from current time and partitiion size */ |
| |
| #if FF_FS_EXFAT |
| if (fsty == FS_EXFAT) { /* Create an exFAT volume */ |
| DWORD szb_bit, szb_case, sum, nbit, clu, clen[3]; |
| WCHAR ch, si; |
| UINT j, st; |
| |
| if (sz_vol < 0x1000) LEAVE_MKFS(FR_MKFS_ABORTED); /* Too small volume for exFAT? */ |
| #if FF_USE_TRIM |
| lba[0] = b_vol; lba[1] = b_vol + sz_vol - 1; /* Inform storage device that the volume area may be erased */ |
| disk_ioctl(pdrv, CTRL_TRIM, lba); |
| #endif |
| /* Determine FAT location, data location and number of clusters */ |
| if (sz_au == 0) { /* AU auto-selection */ |
| sz_au = 8; |
| if (sz_vol >= 0x80000) sz_au = 64; /* >= 512Ks */ |
| if (sz_vol >= 0x4000000) sz_au = 256; /* >= 64Ms */ |
| } |
| b_fat = b_vol + 32; /* FAT start at offset 32 */ |
| sz_fat = (DWORD)((sz_vol / sz_au + 2) * 4 + ss - 1) / ss; /* Number of FAT sectors */ |
| b_data = (b_fat + sz_fat + sz_blk - 1) & ~((LBA_t)sz_blk - 1); /* Align data area to the erase block boundary */ |
| if (b_data - b_vol >= sz_vol / 2) LEAVE_MKFS(FR_MKFS_ABORTED); /* Too small volume? */ |
| n_clst = (DWORD)((sz_vol - (b_data - b_vol)) / sz_au); /* Number of clusters */ |
| if (n_clst <16) LEAVE_MKFS(FR_MKFS_ABORTED); /* Too few clusters? */ |
| if (n_clst > MAX_EXFAT) LEAVE_MKFS(FR_MKFS_ABORTED); /* Too many clusters? */ |
| |
| szb_bit = (n_clst + 7) / 8; /* Size of allocation bitmap */ |
| clen[0] = (szb_bit + sz_au * ss - 1) / (sz_au * ss); /* Number of allocation bitmap clusters */ |
| |
| /* Create a compressed up-case table */ |
| sect = b_data + sz_au * clen[0]; /* Table start sector */ |
| sum = 0; /* Table checksum to be stored in the 82 entry */ |
| st = 0; si = 0; i = 0; j = 0; szb_case = 0; |
| do { |
| switch (st) { |
| case 0: |
| ch = (WCHAR)ff_wtoupper(si); /* Get an up-case char */ |
| if (ch != si) { |
| si++; break; /* Store the up-case char if exist */ |
| } |
| for (j = 1; (WCHAR)(si + j) && (WCHAR)(si + j) == ff_wtoupper((WCHAR)(si + j)); j++) ; /* Get run length of no-case block */ |
| if (j >= 128) { |
| ch = 0xFFFF; st = 2; break; /* Compress the no-case block if run is >= 128 chars */ |
| } |
| st = 1; /* Do not compress short run */ |
| /* FALLTHROUGH */ |
| case 1: |
| ch = si++; /* Fill the short run */ |
| if (--j == 0) st = 0; |
| break; |
| |
| default: |
| ch = (WCHAR)j; si += (WCHAR)j; /* Number of chars to skip */ |
| st = 0; |
| } |
| sum = xsum32(buf[i + 0] = (BYTE)ch, sum); /* Put it into the write buffer */ |
| sum = xsum32(buf[i + 1] = (BYTE)(ch >> 8), sum); |
| i += 2; szb_case += 2; |
| if (si == 0 || i == sz_buf * ss) { /* Write buffered data when buffer full or end of process */ |
| n = (i + ss - 1) / ss; |
| if (disk_write(pdrv, buf, sect, n) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| sect += n; i = 0; |
| } |
| } while (si); |
| clen[1] = (szb_case + sz_au * ss - 1) / (sz_au * ss); /* Number of up-case table clusters */ |
| clen[2] = 1; /* Number of root dir clusters */ |
| |
| /* Initialize the allocation bitmap */ |
| sect = b_data; nsect = (szb_bit + ss - 1) / ss; /* Start of bitmap and number of bitmap sectors */ |
| nbit = clen[0] + clen[1] + clen[2]; /* Number of clusters in-use by system (bitmap, up-case and root-dir) */ |
| do { |
| memset(buf, 0, sz_buf * ss); /* Initialize bitmap buffer */ |
| for (i = 0; nbit != 0 && i / 8 < sz_buf * ss; buf[i / 8] |= 1 << (i % 8), i++, nbit--) ; /* Mark used clusters */ |
| n = (nsect > sz_buf) ? sz_buf : nsect; /* Write the buffered data */ |
| if (disk_write(pdrv, buf, sect, n) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| sect += n; nsect -= n; |
| } while (nsect); |
| |
| /* Initialize the FAT */ |
| sect = b_fat; nsect = sz_fat; /* Start of FAT and number of FAT sectors */ |
| j = nbit = clu = 0; |
| do { |
| memset(buf, 0, sz_buf * ss); i = 0; /* Clear work area and reset write offset */ |
| if (clu == 0) { /* Initialize FAT [0] and FAT[1] */ |
| st_dword(buf + i, 0xFFFFFFF8); i += 4; clu++; |
| st_dword(buf + i, 0xFFFFFFFF); i += 4; clu++; |
| } |
| do { /* Create chains of bitmap, up-case and root dir */ |
| while (nbit != 0 && i < sz_buf * ss) { /* Create a chain */ |
| st_dword(buf + i, (nbit > 1) ? clu + 1 : 0xFFFFFFFF); |
| i += 4; clu++; nbit--; |
| } |
| if (nbit == 0 && j < 3) nbit = clen[j++]; /* Get next chain length */ |
| } while (nbit != 0 && i < sz_buf * ss); |
| n = (nsect > sz_buf) ? sz_buf : nsect; /* Write the buffered data */ |
| if (disk_write(pdrv, buf, sect, n) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| sect += n; nsect -= n; |
| } while (nsect); |
| |
| /* Initialize the root directory */ |
| memset(buf, 0, sz_buf * ss); |
| buf[SZDIRE * 0 + 0] = ET_VLABEL; /* Volume label entry (no label) */ |
| buf[SZDIRE * 1 + 0] = ET_BITMAP; /* Bitmap entry */ |
| st_dword(buf + SZDIRE * 1 + 20, 2); /* cluster */ |
| st_dword(buf + SZDIRE * 1 + 24, szb_bit); /* size */ |
| buf[SZDIRE * 2 + 0] = ET_UPCASE; /* Up-case table entry */ |
| st_dword(buf + SZDIRE * 2 + 4, sum); /* sum */ |
| st_dword(buf + SZDIRE * 2 + 20, 2 + clen[0]); /* cluster */ |
| st_dword(buf + SZDIRE * 2 + 24, szb_case); /* size */ |
| sect = b_data + sz_au * (clen[0] + clen[1]); nsect = sz_au; /* Start of the root directory and number of sectors */ |
| do { /* Fill root directory sectors */ |
| n = (nsect > sz_buf) ? sz_buf : nsect; |
| if (disk_write(pdrv, buf, sect, n) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| memset(buf, 0, ss); /* Rest of entries are filled with zero */ |
| sect += n; nsect -= n; |
| } while (nsect); |
| |
| /* Create two set of the exFAT VBR blocks */ |
| sect = b_vol; |
| for (n = 0; n < 2; n++) { |
| /* Main record (+0) */ |
| memset(buf, 0, ss); |
| memcpy(buf + BS_JmpBoot, "\xEB\x76\x90" "EXFAT ", 11); /* Boot jump code (x86), OEM name */ |
| st_qword(buf + BPB_VolOfsEx, b_vol); /* Volume offset in the physical drive [sector] */ |
| st_qword(buf + BPB_TotSecEx, sz_vol); /* Volume size [sector] */ |
| st_dword(buf + BPB_FatOfsEx, (DWORD)(b_fat - b_vol)); /* FAT offset [sector] */ |
| st_dword(buf + BPB_FatSzEx, sz_fat); /* FAT size [sector] */ |
| st_dword(buf + BPB_DataOfsEx, (DWORD)(b_data - b_vol)); /* Data offset [sector] */ |
| st_dword(buf + BPB_NumClusEx, n_clst); /* Number of clusters */ |
| st_dword(buf + BPB_RootClusEx, 2 + clen[0] + clen[1]); /* Root dir cluster # */ |
| st_dword(buf + BPB_VolIDEx, vsn); /* VSN */ |
| st_word(buf + BPB_FSVerEx, 0x100); /* Filesystem version (1.00) */ |
| for (buf[BPB_BytsPerSecEx] = 0, i = ss; i >>= 1; buf[BPB_BytsPerSecEx]++) ; /* Log2 of sector size [byte] */ |
| for (buf[BPB_SecPerClusEx] = 0, i = sz_au; i >>= 1; buf[BPB_SecPerClusEx]++) ; /* Log2 of cluster size [sector] */ |
| buf[BPB_NumFATsEx] = 1; /* Number of FATs */ |
| buf[BPB_DrvNumEx] = 0x80; /* Drive number (for int13) */ |
| st_word(buf + BS_BootCodeEx, 0xFEEB); /* Boot code (x86) */ |
| st_word(buf + BS_55AA, 0xAA55); /* Signature (placed here regardless of sector size) */ |
| for (i = sum = 0; i < ss; i++) { /* VBR checksum */ |
| if (i != BPB_VolFlagEx && i != BPB_VolFlagEx + 1 && i != BPB_PercInUseEx) sum = xsum32(buf[i], sum); |
| } |
| if (disk_write(pdrv, buf, sect++, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| /* Extended bootstrap record (+1..+8) */ |
| memset(buf, 0, ss); |
| st_word(buf + ss - 2, 0xAA55); /* Signature (placed at end of sector) */ |
| for (j = 1; j < 9; j++) { |
| for (i = 0; i < ss; sum = xsum32(buf[i++], sum)) ; /* VBR checksum */ |
| if (disk_write(pdrv, buf, sect++, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| } |
| /* OEM/Reserved record (+9..+10) */ |
| memset(buf, 0, ss); |
| for ( ; j < 11; j++) { |
| for (i = 0; i < ss; sum = xsum32(buf[i++], sum)) ; /* VBR checksum */ |
| if (disk_write(pdrv, buf, sect++, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| } |
| /* Sum record (+11) */ |
| for (i = 0; i < ss; i += 4) st_dword(buf + i, sum); /* Fill with checksum value */ |
| if (disk_write(pdrv, buf, sect++, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| } |
| |
| } else |
| #endif /* FF_FS_EXFAT */ |
| { /* Create an FAT/FAT32 volume */ |
| do { |
| pau = sz_au; |
| /* Pre-determine number of clusters and FAT sub-type */ |
| if (fsty == FS_FAT32) { /* FAT32 volume */ |
| if (pau == 0) { /* AU auto-selection */ |
| n = (DWORD)sz_vol / 0x20000; /* Volume size in unit of 128KS */ |
| for (i = 0, pau = 1; cst32[i] && cst32[i] <= n; i++, pau <<= 1) ; /* Get from table */ |
| } |
| n_clst = (DWORD)sz_vol / pau; /* Number of clusters */ |
| sz_fat = (n_clst * 4 + 8 + ss - 1) / ss; /* FAT size [sector] */ |
| sz_rsv = 32; /* Number of reserved sectors */ |
| sz_dir = 0; /* No static directory */ |
| if (n_clst <= MAX_FAT16 || n_clst > MAX_FAT32) LEAVE_MKFS(FR_MKFS_ABORTED); |
| } else { /* FAT volume */ |
| if (pau == 0) { /* au auto-selection */ |
| n = (DWORD)sz_vol / 0x1000; /* Volume size in unit of 4KS */ |
| for (i = 0, pau = 1; cst[i] && cst[i] <= n; i++, pau <<= 1) ; /* Get from table */ |
| } |
| n_clst = (DWORD)sz_vol / pau; |
| if (n_clst > MAX_FAT12) { |
| n = n_clst * 2 + 4; /* FAT size [byte] */ |
| } else { |
| fsty = FS_FAT12; |
| n = (n_clst * 3 + 1) / 2 + 3; /* FAT size [byte] */ |
| } |
| sz_fat = (n + ss - 1) / ss; /* FAT size [sector] */ |
| sz_rsv = 1; /* Number of reserved sectors */ |
| sz_dir = (DWORD)n_root * SZDIRE / ss; /* Root dir size [sector] */ |
| } |
| b_fat = b_vol + sz_rsv; /* FAT base */ |
| b_data = b_fat + sz_fat * n_fat + sz_dir; /* Data base */ |
| |
| /* Align data area to erase block boundary (for flash memory media) */ |
| n = (DWORD)(((b_data + sz_blk - 1) & ~(sz_blk - 1)) - b_data); /* Sectors to next nearest from current data base */ |
| if (fsty == FS_FAT32) { /* FAT32: Move FAT */ |
| sz_rsv += n; b_fat += n; |
| } else { /* FAT: Expand FAT */ |
| if (n % n_fat) { /* Adjust fractional error if needed */ |
| n--; sz_rsv++; b_fat++; |
| } |
| sz_fat += n / n_fat; |
| } |
| |
| /* Determine number of clusters and final check of validity of the FAT sub-type */ |
| if (sz_vol < b_data + pau * 16 - b_vol) LEAVE_MKFS(FR_MKFS_ABORTED); /* Too small volume? */ |
| n_clst = ((DWORD)sz_vol - sz_rsv - sz_fat * n_fat - sz_dir) / pau; |
| if (fsty == FS_FAT32) { |
| if (n_clst <= MAX_FAT16) { /* Too few clusters for FAT32? */ |
| if (sz_au == 0 && (sz_au = pau / 2) != 0) continue; /* Adjust cluster size and retry */ |
| LEAVE_MKFS(FR_MKFS_ABORTED); |
| } |
| } |
| if (fsty == FS_FAT16) { |
| if (n_clst > MAX_FAT16) { /* Too many clusters for FAT16 */ |
| if (sz_au == 0 && (pau * 2) <= 64) { |
| sz_au = pau * 2; continue; /* Adjust cluster size and retry */ |
| } |
| if ((fsopt & FM_FAT32)) { |
| fsty = FS_FAT32; continue; /* Switch type to FAT32 and retry */ |
| } |
| if (sz_au == 0 && (sz_au = pau * 2) <= 128) continue; /* Adjust cluster size and retry */ |
| LEAVE_MKFS(FR_MKFS_ABORTED); |
| } |
| if (n_clst <= MAX_FAT12) { /* Too few clusters for FAT16 */ |
| if (sz_au == 0 && (sz_au = pau * 2) <= 128) continue; /* Adjust cluster size and retry */ |
| LEAVE_MKFS(FR_MKFS_ABORTED); |
| } |
| } |
| if (fsty == FS_FAT12 && n_clst > MAX_FAT12) LEAVE_MKFS(FR_MKFS_ABORTED); /* Too many clusters for FAT12 */ |
| |
| /* Ok, it is the valid cluster configuration */ |
| break; |
| } while (1); |
| |
| #if FF_USE_TRIM |
| lba[0] = b_vol; lba[1] = b_vol + sz_vol - 1; /* Inform storage device that the volume area may be erased */ |
| disk_ioctl(pdrv, CTRL_TRIM, lba); |
| #endif |
| /* Create FAT VBR */ |
| memset(buf, 0, ss); |
| memcpy(buf + BS_JmpBoot, "\xEB\xFE\x90" "MSDOS5.0", 11); /* Boot jump code (x86), OEM name */ |
| st_word(buf + BPB_BytsPerSec, ss); /* Sector size [byte] */ |
| buf[BPB_SecPerClus] = (BYTE)pau; /* Cluster size [sector] */ |
| st_word(buf + BPB_RsvdSecCnt, (WORD)sz_rsv); /* Size of reserved area */ |
| buf[BPB_NumFATs] = (BYTE)n_fat; /* Number of FATs */ |
| st_word(buf + BPB_RootEntCnt, (WORD)((fsty == FS_FAT32) ? 0 : n_root)); /* Number of root directory entries */ |
| if (sz_vol < 0x10000) { |
| st_word(buf + BPB_TotSec16, (WORD)sz_vol); /* Volume size in 16-bit LBA */ |
| } else { |
| st_dword(buf + BPB_TotSec32, (DWORD)sz_vol); /* Volume size in 32-bit LBA */ |
| } |
| buf[BPB_Media] = 0xF8; /* Media descriptor byte */ |
| st_word(buf + BPB_SecPerTrk, 63); /* Number of sectors per track (for int13) */ |
| st_word(buf + BPB_NumHeads, 255); /* Number of heads (for int13) */ |
| st_dword(buf + BPB_HiddSec, (DWORD)b_vol); /* Volume offset in the physical drive [sector] */ |
| if (fsty == FS_FAT32) { |
| st_dword(buf + BS_VolID32, vsn); /* VSN */ |
| st_dword(buf + BPB_FATSz32, sz_fat); /* FAT size [sector] */ |
| st_dword(buf + BPB_RootClus32, 2); /* Root directory cluster # (2) */ |
| st_word(buf + BPB_FSInfo32, 1); /* Offset of FSINFO sector (VBR + 1) */ |
| st_word(buf + BPB_BkBootSec32, 6); /* Offset of backup VBR (VBR + 6) */ |
| buf[BS_DrvNum32] = 0x80; /* Drive number (for int13) */ |
| buf[BS_BootSig32] = 0x29; /* Extended boot signature */ |
| memcpy(buf + BS_VolLab32, "NO NAME " "FAT32 ", 19); /* Volume label, FAT signature */ |
| } else { |
| st_dword(buf + BS_VolID, vsn); /* VSN */ |
| st_word(buf + BPB_FATSz16, (WORD)sz_fat); /* FAT size [sector] */ |
| buf[BS_DrvNum] = 0x80; /* Drive number (for int13) */ |
| buf[BS_BootSig] = 0x29; /* Extended boot signature */ |
| memcpy(buf + BS_VolLab, "NO NAME " "FAT ", 19); /* Volume label, FAT signature */ |
| } |
| st_word(buf + BS_55AA, 0xAA55); /* Signature (offset is fixed here regardless of sector size) */ |
| if (disk_write(pdrv, buf, b_vol, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); /* Write it to the VBR sector */ |
| |
| /* Create FSINFO record if needed */ |
| if (fsty == FS_FAT32) { |
| disk_write(pdrv, buf, b_vol + 6, 1); /* Write backup VBR (VBR + 6) */ |
| memset(buf, 0, ss); |
| st_dword(buf + FSI_LeadSig, 0x41615252); |
| st_dword(buf + FSI_StrucSig, 0x61417272); |
| st_dword(buf + FSI_Free_Count, n_clst - 1); /* Number of free clusters */ |
| st_dword(buf + FSI_Nxt_Free, 2); /* Last allocated cluster# */ |
| st_word(buf + BS_55AA, 0xAA55); |
| disk_write(pdrv, buf, b_vol + 7, 1); /* Write backup FSINFO (VBR + 7) */ |
| disk_write(pdrv, buf, b_vol + 1, 1); /* Write original FSINFO (VBR + 1) */ |
| } |
| |
| /* Initialize FAT area */ |
| memset(buf, 0, sz_buf * ss); |
| sect = b_fat; /* FAT start sector */ |
| for (i = 0; i < n_fat; i++) { /* Initialize FATs each */ |
| if (fsty == FS_FAT32) { |
| st_dword(buf + 0, 0xFFFFFFF8); /* FAT[0] */ |
| st_dword(buf + 4, 0xFFFFFFFF); /* FAT[1] */ |
| st_dword(buf + 8, 0x0FFFFFFF); /* FAT[2] (root directory) */ |
| } else { |
| st_dword(buf + 0, (fsty == FS_FAT12) ? 0xFFFFF8 : 0xFFFFFFF8); /* FAT[0] and FAT[1] */ |
| } |
| nsect = sz_fat; /* Number of FAT sectors */ |
| do { /* Fill FAT sectors */ |
| n = (nsect > sz_buf) ? sz_buf : nsect; |
| if (disk_write(pdrv, buf, sect, (UINT)n) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| memset(buf, 0, ss); /* Rest of FAT all are cleared */ |
| sect += n; nsect -= n; |
| } while (nsect); |
| } |
| |
| /* Initialize root directory (fill with zero) */ |
| nsect = (fsty == FS_FAT32) ? pau : sz_dir; /* Number of root directory sectors */ |
| do { |
| n = (nsect > sz_buf) ? sz_buf : nsect; |
| if (disk_write(pdrv, buf, sect, (UINT)n) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| sect += n; nsect -= n; |
| } while (nsect); |
| } |
| |
| /* A FAT volume has been created here */ |
| |
| /* Determine system ID in the MBR partition table */ |
| if (FF_FS_EXFAT && fsty == FS_EXFAT) { |
| sys = 0x07; /* exFAT */ |
| } else if (fsty == FS_FAT32) { |
| sys = 0x0C; /* FAT32X */ |
| } else if (sz_vol >= 0x10000) { |
| sys = 0x06; /* FAT12/16 (large) */ |
| } else if (fsty == FS_FAT16) { |
| sys = 0x04; /* FAT16 */ |
| } else { |
| sys = 0x01; /* FAT12 */ |
| } |
| |
| /* Update partition information */ |
| if (FF_MULTI_PARTITION && ipart != 0) { /* Volume is in the existing partition */ |
| if (!FF_LBA64 || !(fsopt & 0x80)) { /* Is the partition in MBR? */ |
| /* Update system ID in the partition table */ |
| if (disk_read(pdrv, buf, 0, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); /* Read the MBR */ |
| buf[MBR_Table + (ipart - 1) * SZ_PTE + PTE_System] = sys; /* Set system ID */ |
| if (disk_write(pdrv, buf, 0, 1) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); /* Write it back to the MBR */ |
| } |
| } else { /* Volume as a new single partition */ |
| if (!(fsopt & FM_SFD)) { /* Create partition table if not in SFD format */ |
| lba[0] = sz_vol; lba[1] = 0; |
| res = create_partition(pdrv, lba, sys, buf); |
| if (res != FR_OK) LEAVE_MKFS(res); |
| } |
| } |
| |
| if (disk_ioctl(pdrv, CTRL_SYNC, 0) != RES_OK) LEAVE_MKFS(FR_DISK_ERR); |
| |
| LEAVE_MKFS(FR_OK); |
| } |
| |
| |
| |
| |
| #if FF_MULTI_PARTITION |
| /*-----------------------------------------------------------------------*/ |
| /* Create Partition Table on the Physical Drive */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_fdisk ( |
| BYTE pdrv, /* Physical drive number */ |
| const LBA_t ptbl[], /* Pointer to the size table for each partitions */ |
| void* work /* Pointer to the working buffer (null: use heap memory) */ |
| ) |
| { |
| BYTE *buf = (BYTE*)work; |
| DSTATUS stat; |
| FRESULT res; |
| |
| |
| /* Initialize the physical drive */ |
| stat = disk_initialize(pdrv); |
| if (stat & STA_NOINIT) return FR_NOT_READY; |
| if (stat & STA_PROTECT) return FR_WRITE_PROTECTED; |
| |
| #if FF_USE_LFN == 3 |
| if (!buf) buf = ff_memalloc(FF_MAX_SS); /* Use heap memory for working buffer */ |
| #endif |
| if (!buf) return FR_NOT_ENOUGH_CORE; |
| |
| res = create_partition(pdrv, ptbl, 0x07, buf); /* Create partitions (system ID is temporary setting and determined by f_mkfs) */ |
| |
| LEAVE_MKFS(res); |
| } |
| |
| #endif /* FF_MULTI_PARTITION */ |
| #endif /* !FF_FS_READONLY && FF_USE_MKFS */ |
| |
| |
| |
| |
| #if FF_USE_STRFUNC |
| #if FF_USE_LFN && FF_LFN_UNICODE && (FF_STRF_ENCODE < 0 || FF_STRF_ENCODE > 3) |
| #error Wrong FF_STRF_ENCODE setting |
| #endif |
| /*-----------------------------------------------------------------------*/ |
| /* Get a String from the File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| TCHAR* f_gets ( |
| TCHAR* buff, /* Pointer to the buffer to store read string */ |
| int len, /* Size of string buffer (items) */ |
| FIL* fp /* Pointer to the file object */ |
| ) |
| { |
| int nc = 0; |
| TCHAR *p = buff; |
| BYTE s[4]; |
| UINT rc; |
| DWORD dc; |
| #if FF_USE_LFN && FF_LFN_UNICODE && FF_STRF_ENCODE <= 2 |
| WCHAR wc; |
| #endif |
| #if FF_USE_LFN && FF_LFN_UNICODE && FF_STRF_ENCODE == 3 |
| UINT ct; |
| #endif |
| |
| #if FF_USE_LFN && FF_LFN_UNICODE /* With code conversion (Unicode API) */ |
| /* Make a room for the character and terminator */ |
| if (FF_LFN_UNICODE == 1) len -= (FF_STRF_ENCODE == 0) ? 1 : 2; |
| if (FF_LFN_UNICODE == 2) len -= (FF_STRF_ENCODE == 0) ? 3 : 4; |
| if (FF_LFN_UNICODE == 3) len -= 1; |
| while (nc < len) { |
| #if FF_STRF_ENCODE == 0 /* Read a character in ANSI/OEM */ |
| f_read(fp, s, 1, &rc); /* Get a code unit */ |
| if (rc != 1) break; /* EOF? */ |
| wc = s[0]; |
| if (dbc_1st((BYTE)wc)) { /* DBC 1st byte? */ |
| f_read(fp, s, 1, &rc); /* Get 2nd byte */ |
| if (rc != 1 || !dbc_2nd(s[0])) continue; /* Wrong code? */ |
| wc = wc << 8 | s[0]; |
| } |
| dc = ff_oem2uni(wc, CODEPAGE); /* Convert ANSI/OEM into Unicode */ |
| if (dc == 0) continue; /* Conversion error? */ |
| #elif FF_STRF_ENCODE == 1 || FF_STRF_ENCODE == 2 /* Read a character in UTF-16LE/BE */ |
| f_read(fp, s, 2, &rc); /* Get a code unit */ |
| if (rc != 2) break; /* EOF? */ |
| dc = (FF_STRF_ENCODE == 1) ? ld_word(s) : s[0] << 8 | s[1]; |
| if (IsSurrogateL(dc)) continue; /* Broken surrogate pair? */ |
| if (IsSurrogateH(dc)) { /* High surrogate? */ |
| f_read(fp, s, 2, &rc); /* Get low surrogate */ |
| if (rc != 2) break; /* EOF? */ |
| wc = (FF_STRF_ENCODE == 1) ? ld_word(s) : s[0] << 8 | s[1]; |
| if (!IsSurrogateL(wc)) continue; /* Broken surrogate pair? */ |
| dc = ((dc & 0x3FF) + 0x40) << 10 | (wc & 0x3FF); /* Merge surrogate pair */ |
| } |
| #else /* Read a character in UTF-8 */ |
| f_read(fp, s, 1, &rc); /* Get a code unit */ |
| if (rc != 1) break; /* EOF? */ |
| dc = s[0]; |
| if (dc >= 0x80) { /* Multi-byte sequence? */ |
| ct = 0; |
| if ((dc & 0xE0) == 0xC0) { /* 2-byte sequence? */ |
| dc &= 0x1F; ct = 1; |
| } |
| if ((dc & 0xF0) == 0xE0) { /* 3-byte sequence? */ |
| dc &= 0x0F; ct = 2; |
| } |
| if ((dc & 0xF8) == 0xF0) { /* 4-byte sequence? */ |
| dc &= 0x07; ct = 3; |
| } |
| if (ct == 0) continue; |
| f_read(fp, s, ct, &rc); /* Get trailing bytes */ |
| if (rc != ct) break; |
| rc = 0; |
| do { /* Merge the byte sequence */ |
| if ((s[rc] & 0xC0) != 0x80) break; |
| dc = dc << 6 | (s[rc] & 0x3F); |
| } while (++rc < ct); |
| if (rc != ct || dc < 0x80 || IsSurrogate(dc) || dc >= 0x110000) continue; /* Wrong encoding? */ |
| } |
| #endif |
| /* A code point is avaialble in dc to be output */ |
| |
| if (FF_USE_STRFUNC == 2 && dc == '\r') continue; /* Strip \r off if needed */ |
| #if FF_LFN_UNICODE == 1 || FF_LFN_UNICODE == 3 /* Output it in UTF-16/32 encoding */ |
| if (FF_LFN_UNICODE == 1 && dc >= 0x10000) { /* Out of BMP at UTF-16? */ |
| *p++ = (TCHAR)(0xD800 | ((dc >> 10) - 0x40)); nc++; /* Make and output high surrogate */ |
| dc = 0xDC00 | (dc & 0x3FF); /* Make low surrogate */ |
| } |
| *p++ = (TCHAR)dc; nc++; |
| if (dc == '\n') break; /* End of line? */ |
| #elif FF_LFN_UNICODE == 2 /* Output it in UTF-8 encoding */ |
| if (dc < 0x80) { /* Single byte? */ |
| *p++ = (TCHAR)dc; |
| nc++; |
| if (dc == '\n') break; /* End of line? */ |
| } else if (dc < 0x800) { /* 2-byte sequence? */ |
| *p++ = (TCHAR)(0xC0 | (dc >> 6 & 0x1F)); |
| *p++ = (TCHAR)(0x80 | (dc >> 0 & 0x3F)); |
| nc += 2; |
| } else if (dc < 0x10000) { /* 3-byte sequence? */ |
| *p++ = (TCHAR)(0xE0 | (dc >> 12 & 0x0F)); |
| *p++ = (TCHAR)(0x80 | (dc >> 6 & 0x3F)); |
| *p++ = (TCHAR)(0x80 | (dc >> 0 & 0x3F)); |
| nc += 3; |
| } else { /* 4-byte sequence */ |
| *p++ = (TCHAR)(0xF0 | (dc >> 18 & 0x07)); |
| *p++ = (TCHAR)(0x80 | (dc >> 12 & 0x3F)); |
| *p++ = (TCHAR)(0x80 | (dc >> 6 & 0x3F)); |
| *p++ = (TCHAR)(0x80 | (dc >> 0 & 0x3F)); |
| nc += 4; |
| } |
| #endif |
| } |
| |
| #else /* Byte-by-byte read without any conversion (ANSI/OEM API) */ |
| len -= 1; /* Make a room for the terminator */ |
| while (nc < len) { |
| f_read(fp, s, 1, &rc); /* Get a byte */ |
| if (rc != 1) break; /* EOF? */ |
| dc = s[0]; |
| if (FF_USE_STRFUNC == 2 && dc == '\r') continue; |
| *p++ = (TCHAR)dc; nc++; |
| if (dc == '\n') break; |
| } |
| #endif |
| |
| *p = 0; /* Terminate the string */ |
| return nc ? buff : 0; /* When no data read due to EOF or error, return with error. */ |
| } |
| |
| |
| |
| |
| #if !FF_FS_READONLY |
| #include <stdarg.h> |
| #define SZ_PUTC_BUF 64 |
| #define SZ_NUM_BUF 32 |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Put a Character to the File (with sub-functions) */ |
| /*-----------------------------------------------------------------------*/ |
| |
| /* Output buffer and work area */ |
| |
| typedef struct { |
| FIL *fp; /* Ptr to the writing file */ |
| int idx, nchr; /* Write index of buf[] (-1:error), number of encoding units written */ |
| #if FF_USE_LFN && FF_LFN_UNICODE == 1 |
| WCHAR hs; |
| #elif FF_USE_LFN && FF_LFN_UNICODE == 2 |
| BYTE bs[4]; |
| UINT wi, ct; |
| #endif |
| BYTE buf[SZ_PUTC_BUF]; /* Write buffer */ |
| } putbuff; |
| |
| |
| /* Buffered file write with code conversion */ |
| |
| static void putc_bfd (putbuff* pb, TCHAR c) |
| { |
| UINT n; |
| int i, nc; |
| #if FF_USE_LFN && FF_LFN_UNICODE |
| WCHAR hs, wc; |
| #if FF_LFN_UNICODE == 2 |
| DWORD dc; |
| const TCHAR* tp; |
| #endif |
| #endif |
| |
| if (FF_USE_STRFUNC == 2 && c == '\n') { /* LF -> CRLF conversion */ |
| putc_bfd(pb, '\r'); |
| } |
| |
| i = pb->idx; /* Write index of pb->buf[] */ |
| if (i < 0) return; /* In write error? */ |
| nc = pb->nchr; /* Write unit counter */ |
| |
| #if FF_USE_LFN && FF_LFN_UNICODE |
| #if FF_LFN_UNICODE == 1 /* UTF-16 input */ |
| if (IsSurrogateH(c)) { /* Is this a high-surrogate? */ |
| pb->hs = c; return; /* Save it for next */ |
| } |
| hs = pb->hs; pb->hs = 0; |
| if (hs != 0) { /* Is there a leading high-surrogate? */ |
| if (!IsSurrogateL(c)) hs = 0; /* Discard high-surrogate if not a surrogate pair */ |
| } else { |
| if (IsSurrogateL(c)) return; /* Discard stray low-surrogate */ |
| } |
| wc = c; |
| #elif FF_LFN_UNICODE == 2 /* UTF-8 input */ |
| for (;;) { |
| if (pb->ct == 0) { /* Out of multi-byte sequence? */ |
| pb->bs[pb->wi = 0] = (BYTE)c; /* Save 1st byte */ |
| if ((BYTE)c < 0x80) break; /* Single byte code? */ |
| if (((BYTE)c & 0xE0) == 0xC0) pb->ct = 1; /* 2-byte sequence? */ |
| if (((BYTE)c & 0xF0) == 0xE0) pb->ct = 2; /* 3-byte sequence? */ |
| if (((BYTE)c & 0xF8) == 0xF0) pb->ct = 3; /* 4-byte sequence? */ |
| return; /* Wrong leading byte (discard it) */ |
| } else { /* In the multi-byte sequence */ |
| if (((BYTE)c & 0xC0) != 0x80) { /* Broken sequence? */ |
| pb->ct = 0; continue; /* Discard the sequense */ |
| } |
| pb->bs[++pb->wi] = (BYTE)c; /* Save the trailing byte */ |
| if (--pb->ct == 0) break; /* End of the sequence? */ |
| return; |
| } |
| } |
| tp = (const TCHAR*)pb->bs; |
| dc = tchar2uni(&tp); /* UTF-8 ==> UTF-16 */ |
| if (dc == 0xFFFFFFFF) return; /* Wrong code? */ |
| hs = (WCHAR)(dc >> 16); |
| wc = (WCHAR)dc; |
| #elif FF_LFN_UNICODE == 3 /* UTF-32 input */ |
| if (IsSurrogate(c) || c >= 0x110000) return; /* Discard invalid code */ |
| if (c >= 0x10000) { /* Out of BMP? */ |
| hs = (WCHAR)(0xD800 | ((c >> 10) - 0x40)); /* Make high surrogate */ |
| wc = 0xDC00 | (c & 0x3FF); /* Make low surrogate */ |
| } else { |
| hs = 0; |
| wc = (WCHAR)c; |
| } |
| #endif |
| /* A code point in UTF-16 is available in hs and wc */ |
| |
| #if FF_STRF_ENCODE == 1 /* Write a code point in UTF-16LE */ |
| if (hs != 0) { /* Surrogate pair? */ |
| st_word(&pb->buf[i], hs); |
| i += 2; |
| nc++; |
| } |
| st_word(&pb->buf[i], wc); |
| i += 2; |
| #elif FF_STRF_ENCODE == 2 /* Write a code point in UTF-16BE */ |
| if (hs != 0) { /* Surrogate pair? */ |
| pb->buf[i++] = (BYTE)(hs >> 8); |
| pb->buf[i++] = (BYTE)hs; |
| nc++; |
| } |
| pb->buf[i++] = (BYTE)(wc >> 8); |
| pb->buf[i++] = (BYTE)wc; |
| #elif FF_STRF_ENCODE == 3 /* Write a code point in UTF-8 */ |
| if (hs != 0) { /* 4-byte sequence? */ |
| nc += 3; |
| hs = (hs & 0x3FF) + 0x40; |
| pb->buf[i++] = (BYTE)(0xF0 | hs >> 8); |
| pb->buf[i++] = (BYTE)(0x80 | (hs >> 2 & 0x3F)); |
| pb->buf[i++] = (BYTE)(0x80 | (hs & 3) << 4 | (wc >> 6 & 0x0F)); |
| pb->buf[i++] = (BYTE)(0x80 | (wc & 0x3F)); |
| } else { |
| if (wc < 0x80) { /* Single byte? */ |
| pb->buf[i++] = (BYTE)wc; |
| } else { |
| if (wc < 0x800) { /* 2-byte sequence? */ |
| nc += 1; |
| pb->buf[i++] = (BYTE)(0xC0 | wc >> 6); |
| } else { /* 3-byte sequence */ |
| nc += 2; |
| pb->buf[i++] = (BYTE)(0xE0 | wc >> 12); |
| pb->buf[i++] = (BYTE)(0x80 | (wc >> 6 & 0x3F)); |
| } |
| pb->buf[i++] = (BYTE)(0x80 | (wc & 0x3F)); |
| } |
| } |
| #else /* Write a code point in ANSI/OEM */ |
| if (hs != 0) return; |
| wc = ff_uni2oem(wc, CODEPAGE); /* UTF-16 ==> ANSI/OEM */ |
| if (wc == 0) return; |
| if (wc >= 0x100) { |
| pb->buf[i++] = (BYTE)(wc >> 8); nc++; |
| } |
| pb->buf[i++] = (BYTE)wc; |
| #endif |
| |
| #else /* ANSI/OEM input (without re-encoding) */ |
| pb->buf[i++] = (BYTE)c; |
| #endif |
| |
| if (i >= (int)(sizeof pb->buf) - 4) { /* Write buffered characters to the file */ |
| f_write(pb->fp, pb->buf, (UINT)i, &n); |
| i = (n == (UINT)i) ? 0 : -1; |
| } |
| pb->idx = i; |
| pb->nchr = nc + 1; |
| } |
| |
| |
| /* Flush remaining characters in the buffer */ |
| |
| static int putc_flush (putbuff* pb) |
| { |
| UINT nw; |
| |
| if ( pb->idx >= 0 /* Flush buffered characters to the file */ |
| && f_write(pb->fp, pb->buf, (UINT)pb->idx, &nw) == FR_OK |
| && (UINT)pb->idx == nw) return pb->nchr; |
| return -1; |
| } |
| |
| |
| /* Initialize write buffer */ |
| |
| static void putc_init (putbuff* pb, FIL* fp) |
| { |
| memset(pb, 0, sizeof (putbuff)); |
| pb->fp = fp; |
| } |
| |
| |
| |
| int f_putc ( |
| TCHAR c, /* A character to be output */ |
| FIL* fp /* Pointer to the file object */ |
| ) |
| { |
| putbuff pb; |
| |
| |
| putc_init(&pb, fp); |
| putc_bfd(&pb, c); /* Put the character */ |
| return putc_flush(&pb); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Put a String to the File */ |
| /*-----------------------------------------------------------------------*/ |
| |
| int f_puts ( |
| const TCHAR* str, /* Pointer to the string to be output */ |
| FIL* fp /* Pointer to the file object */ |
| ) |
| { |
| putbuff pb; |
| |
| |
| putc_init(&pb, fp); |
| while (*str) putc_bfd(&pb, *str++); /* Put the string */ |
| return putc_flush(&pb); |
| } |
| |
| |
| |
| |
| /*-----------------------------------------------------------------------*/ |
| /* Put a Formatted String to the File (with sub-functions) */ |
| /*-----------------------------------------------------------------------*/ |
| #if FF_PRINT_FLOAT && FF_INTDEF == 2 |
| #include <math.h> |
| |
| static int ilog10 (double n) /* Calculate log10(n) in integer output */ |
| { |
| int rv = 0; |
| |
| while (n >= 10) { /* Decimate digit in right shift */ |
| if (n >= 100000) { |
| n /= 100000; rv += 5; |
| } else { |
| n /= 10; rv++; |
| } |
| } |
| while (n < 1) { /* Decimate digit in left shift */ |
| if (n < 0.00001) { |
| n *= 100000; rv -= 5; |
| } else { |
| n *= 10; rv--; |
| } |
| } |
| return rv; |
| } |
| |
| |
| static double i10x (int n) /* Calculate 10^n in integer input */ |
| { |
| double rv = 1; |
| |
| while (n > 0) { /* Left shift */ |
| if (n >= 5) { |
| rv *= 100000; n -= 5; |
| } else { |
| rv *= 10; n--; |
| } |
| } |
| while (n < 0) { /* Right shift */ |
| if (n <= -5) { |
| rv /= 100000; n += 5; |
| } else { |
| rv /= 10; n++; |
| } |
| } |
| return rv; |
| } |
| |
| |
| static void ftoa ( |
| char* buf, /* Buffer to output the floating point string */ |
| double val, /* Value to output */ |
| int prec, /* Number of fractional digits */ |
| TCHAR fmt /* Notation */ |
| ) |
| { |
| int d; |
| int e = 0, m = 0; |
| char sign = 0; |
| double w; |
| const char *er = 0; |
| const char ds = FF_PRINT_FLOAT == 2 ? ',' : '.'; |
| |
| |
| if (isnan(val)) { /* Not a number? */ |
| er = "NaN"; |
| } else { |
| if (prec < 0) prec = 6; /* Default precision? (6 fractional digits) */ |
| if (val < 0) { /* Negative? */ |
| val = 0 - val; sign = '-'; |
| } else { |
| sign = '+'; |
| } |
| if (isinf(val)) { /* Infinite? */ |
| er = "INF"; |
| } else { |
| if (fmt == 'f') { /* Decimal notation? */ |
| val += i10x(0 - prec) / 2; /* Round (nearest) */ |
| m = ilog10(val); |
| if (m < 0) m = 0; |
| if (m + prec + 3 >= SZ_NUM_BUF) er = "OV"; /* Buffer overflow? */ |
| } else { /* E notation */ |
| if (val != 0) { /* Not a true zero? */ |
| val += i10x(ilog10(val) - prec) / 2; /* Round (nearest) */ |
| e = ilog10(val); |
| if (e > 99 || prec + 7 >= SZ_NUM_BUF) { /* Buffer overflow or E > +99? */ |
| er = "OV"; |
| } else { |
| if (e < -99) e = -99; |
| val /= i10x(e); /* Normalize */ |
| } |
| } |
| } |
| } |
| if (!er) { /* Not error condition */ |
| if (sign == '-') *buf++ = sign; /* Add a - if negative value */ |
| do { /* Put decimal number */ |
| if (m == -1) *buf++ = ds; /* Insert a decimal separator when get into fractional part */ |
| w = i10x(m); /* Snip the highest digit d */ |
| d = (int)(val / w); val -= d * w; |
| *buf++ = (char)('0' + d); /* Put the digit */ |
| } while (--m >= -prec); /* Output all digits specified by prec */ |
| if (fmt != 'f') { /* Put exponent if needed */ |
| *buf++ = (char)fmt; |
| if (e < 0) { |
| e = 0 - e; *buf++ = '-'; |
| } else { |
| *buf++ = '+'; |
| } |
| *buf++ = (char)('0' + e / 10); |
| *buf++ = (char)('0' + e % 10); |
| } |
| } |
| } |
| if (er) { /* Error condition */ |
| if (sign) *buf++ = sign; /* Add sign if needed */ |
| do { /* Put error symbol */ |
| *buf++ = *er++; |
| } while (*er); |
| } |
| *buf = 0; /* Term */ |
| } |
| #endif /* FF_PRINT_FLOAT && FF_INTDEF == 2 */ |
| |
| |
| |
| int f_printf ( |
| FIL* fp, /* Pointer to the file object */ |
| const TCHAR* fmt, /* Pointer to the format string */ |
| ... /* Optional arguments... */ |
| ) |
| { |
| va_list arp; |
| putbuff pb; |
| UINT i, j, w, f, r; |
| int prec; |
| #if FF_PRINT_LLI && FF_INTDEF == 2 |
| QWORD v; |
| #else |
| DWORD v; |
| #endif |
| TCHAR *tp; |
| TCHAR tc, pad; |
| TCHAR nul = 0; |
| char d, str[SZ_NUM_BUF]; |
| |
| |
| putc_init(&pb, fp); |
| |
| va_start(arp, fmt); |
| |
| for (;;) { |
| tc = *fmt++; |
| if (tc == 0) break; /* End of format string */ |
| if (tc != '%') { /* Not an escape character (pass-through) */ |
| putc_bfd(&pb, tc); |
| continue; |
| } |
| f = w = 0; pad = ' '; prec = -1; /* Initialize parms */ |
| tc = *fmt++; |
| if (tc == '0') { /* Flag: '0' padded */ |
| pad = '0'; tc = *fmt++; |
| } else if (tc == '-') { /* Flag: Left aligned */ |
| f = 2; tc = *fmt++; |
| } |
| if (tc == '*') { /* Minimum width from an argument */ |
| w = va_arg(arp, int); |
| tc = *fmt++; |
| } else { |
| while (IsDigit(tc)) { /* Minimum width */ |
| w = w * 10 + tc - '0'; |
| tc = *fmt++; |
| } |
| } |
| if (tc == '.') { /* Precision */ |
| tc = *fmt++; |
| if (tc == '*') { /* Precision from an argument */ |
| prec = va_arg(arp, int); |
| tc = *fmt++; |
| } else { |
| prec = 0; |
| while (IsDigit(tc)) { /* Precision */ |
| prec = prec * 10 + tc - '0'; |
| tc = *fmt++; |
| } |
| } |
| } |
| if (tc == 'l') { /* Size: long int */ |
| f |= 4; tc = *fmt++; |
| #if FF_PRINT_LLI && FF_INTDEF == 2 |
| if (tc == 'l') { /* Size: long long int */ |
| f |= 8; tc = *fmt++; |
| } |
| #endif |
| } |
| if (tc == 0) break; /* End of format string */ |
| switch (tc) { /* Atgument type is... */ |
| case 'b': /* Unsigned binary */ |
| r = 2; break; |
| |
| case 'o': /* Unsigned octal */ |
| r = 8; break; |
| |
| case 'd': /* Signed decimal */ |
| case 'u': /* Unsigned decimal */ |
| r = 10; break; |
| |
| case 'x': /* Unsigned hexadecimal (lower case) */ |
| case 'X': /* Unsigned hexadecimal (upper case) */ |
| r = 16; break; |
| |
| case 'c': /* Character */ |
| putc_bfd(&pb, (TCHAR)va_arg(arp, int)); |
| continue; |
| |
| case 's': /* String */ |
| tp = va_arg(arp, TCHAR*); /* Get a pointer argument */ |
| if (!tp) tp = &nul; /* Null ptr generates a null string */ |
| for (j = 0; tp[j]; j++) ; /* j = tcslen(tp) */ |
| if (prec >= 0 && j > (UINT)prec) j = prec; /* Limited length of string body */ |
| for ( ; !(f & 2) && j < w; j++) putc_bfd(&pb, pad); /* Left pads */ |
| while (*tp && prec--) putc_bfd(&pb, *tp++); /* Body */ |
| while (j++ < w) putc_bfd(&pb, ' '); /* Right pads */ |
| continue; |
| #if FF_PRINT_FLOAT && FF_INTDEF == 2 |
| case 'f': /* Floating point (decimal) */ |
| case 'e': /* Floating point (e) */ |
| case 'E': /* Floating point (E) */ |
| ftoa(str, va_arg(arp, double), prec, tc); /* Make a floating point string */ |
| for (j = strlen(str); !(f & 2) && j < w; j++) putc_bfd(&pb, pad); /* Left pads */ |
| for (i = 0; str[i]; putc_bfd(&pb, str[i++])) ; /* Body */ |
| while (j++ < w) putc_bfd(&pb, ' '); /* Right pads */ |
| continue; |
| #endif |
| default: /* Unknown type (pass-through) */ |
| putc_bfd(&pb, tc); continue; |
| } |
| |
| /* Get an integer argument and put it in numeral */ |
| #if FF_PRINT_LLI && FF_INTDEF == 2 |
| if (f & 8) { /* long long argument? */ |
| v = (QWORD)va_arg(arp, long long); |
| } else if (f & 4) { /* long argument? */ |
| v = (tc == 'd') ? (QWORD)(long long)va_arg(arp, long) : (QWORD)va_arg(arp, unsigned long); |
| } else { /* int/short/char argument */ |
| v = (tc == 'd') ? (QWORD)(long long)va_arg(arp, int) : (QWORD)va_arg(arp, unsigned int); |
| } |
| if (tc == 'd' && (v & 0x8000000000000000)) { /* Negative value? */ |
| v = 0 - v; f |= 1; |
| } |
| #else |
| if (f & 4) { /* long argument? */ |
| v = (DWORD)va_arg(arp, long); |
| } else { /* int/short/char argument */ |
| v = (tc == 'd') ? (DWORD)(long)va_arg(arp, int) : (DWORD)va_arg(arp, unsigned int); |
| } |
| if (tc == 'd' && (v & 0x80000000)) { /* Negative value? */ |
| v = 0 - v; f |= 1; |
| } |
| #endif |
| i = 0; |
| do { /* Make an integer number string */ |
| d = (char)(v % r); v /= r; |
| if (d > 9) d += (tc == 'x') ? 0x27 : 0x07; |
| str[i++] = d + '0'; |
| } while (v && i < SZ_NUM_BUF); |
| if (f & 1) str[i++] = '-'; /* Sign */ |
| /* Write it */ |
| for (j = i; !(f & 2) && j < w; j++) { /* Left pads */ |
| putc_bfd(&pb, pad); |
| } |
| do { /* Body */ |
| putc_bfd(&pb, (TCHAR)str[--i]); |
| } while (i); |
| while (j++ < w) { /* Right pads */ |
| putc_bfd(&pb, ' '); |
| } |
| } |
| |
| va_end(arp); |
| |
| return putc_flush(&pb); |
| } |
| |
| #endif /* !FF_FS_READONLY */ |
| #endif /* FF_USE_STRFUNC */ |
| |
| |
| |
| #if FF_CODE_PAGE == 0 |
| /*-----------------------------------------------------------------------*/ |
| /* Set Active Codepage for the Path Name */ |
| /*-----------------------------------------------------------------------*/ |
| |
| FRESULT f_setcp ( |
| WORD cp /* Value to be set as active code page */ |
| ) |
| { |
| static const WORD validcp[22] = { 437, 720, 737, 771, 775, 850, 852, 855, 857, 860, 861, 862, 863, 864, 865, 866, 869, 932, 936, 949, 950, 0}; |
| static const BYTE *const tables[22] = {Ct437, Ct720, Ct737, Ct771, Ct775, Ct850, Ct852, Ct855, Ct857, Ct860, Ct861, Ct862, Ct863, Ct864, Ct865, Ct866, Ct869, Dc932, Dc936, Dc949, Dc950, 0}; |
| UINT i; |
| |
| |
| for (i = 0; validcp[i] != 0 && validcp[i] != cp; i++) ; /* Find the code page */ |
| if (validcp[i] != cp) return FR_INVALID_PARAMETER; /* Not found? */ |
| |
| CodePage = cp; |
| if (cp >= 900) { /* DBCS */ |
| ExCvt = 0; |
| DbcTbl = tables[i]; |
| } else { /* SBCS */ |
| ExCvt = tables[i]; |
| DbcTbl = 0; |
| } |
| return FR_OK; |
| } |
| #endif /* FF_CODE_PAGE == 0 */ |