Norimasa Okamoto / F32RFileSystem

Important changes to repositories hosted on mbed.com

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

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

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

Fork of F12RFileSystem by Norimasa Okamoto

F32RFileSystem.cpp@10:0f8c8845a40b, 2016-04-09 (annotated)

Committer:
va009039
Date:
Sat Apr 09 05:35:46 2016 +0900
Revision:
10:0f8c8845a40b
Parent:
9:e9843d731180
Child:
11:90747dece5a3
fat32 only.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 7:f9f52d9c0c57 1 /* mbed Microcontroller Library
va009039 9:e9843d731180 2 * Copyright (c) 2006-2017 ARM Limited
va009039 7:f9f52d9c0c57 3 *
va009039 7:f9f52d9c0c57 4 * Permission is hereby granted, free of charge, to any person obtaining a copy
va009039 7:f9f52d9c0c57 5 * of this software and associated documentation files (the "Software"), to deal
va009039 7:f9f52d9c0c57 6 * in the Software without restriction, including without limitation the rights
va009039 7:f9f52d9c0c57 7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
va009039 7:f9f52d9c0c57 8 * copies of the Software, and to permit persons to whom the Software is
va009039 7:f9f52d9c0c57 9 * furnished to do so, subject to the following conditions:
va009039 7:f9f52d9c0c57 10 *
va009039 7:f9f52d9c0c57 11 * The above copyright notice and this permission notice shall be included in
va009039 7:f9f52d9c0c57 12 * all copies or substantial portions of the Software.
va009039 7:f9f52d9c0c57 13 *
va009039 7:f9f52d9c0c57 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
va009039 7:f9f52d9c0c57 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
va009039 7:f9f52d9c0c57 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
va009039 7:f9f52d9c0c57 17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
va009039 7:f9f52d9c0c57 18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
va009039 7:f9f52d9c0c57 19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
va009039 7:f9f52d9c0c57 20 * SOFTWARE.
va009039 7:f9f52d9c0c57 21 */
va009039 8:661b3ce0e9c0 22 #include "F32RFileSystem.h"
va009039 8:661b3ce0e9c0 23 #include "F32RFileHandle.h"
va009039 8:661b3ce0e9c0 24 #include "F32RDirHandle.h"
va009039 7:f9f52d9c0c57 25 #include "fsdebug.h"
va009039 10:0f8c8845a40b 26 #include "mbed_debug.h"
va009039 7:f9f52d9c0c57 27
va009039 8:661b3ce0e9c0 28 F32RFileSystem::F32RFileSystem(StorageInterface* storage_, const char* n)
va009039 7:f9f52d9c0c57 29 : FileSystemLike(n), storage(storage_), mounted(false) {
va009039 7:f9f52d9c0c57 30 }
va009039 7:f9f52d9c0c57 31
va009039 8:661b3ce0e9c0 32 F32RFileSystem::~F32RFileSystem() {
va009039 7:f9f52d9c0c57 33 }
va009039 7:f9f52d9c0c57 34
va009039 7:f9f52d9c0c57 35 static bool to_sfn(const char* name, uint8_t* buf) {
va009039 7:f9f52d9c0c57 36 memset(buf, '\x20', 8+3);
va009039 7:f9f52d9c0c57 37 for(int i = 0; i < 8; i++) {
va009039 7:f9f52d9c0c57 38 char c = *name++;
va009039 7:f9f52d9c0c57 39 if (c == '\0') {
va009039 7:f9f52d9c0c57 40 return true;
va009039 7:f9f52d9c0c57 41 } else if (c == '.') {
va009039 7:f9f52d9c0c57 42 break;
va009039 7:f9f52d9c0c57 43 } else {
va009039 7:f9f52d9c0c57 44 buf[i] = toupper(c);
va009039 7:f9f52d9c0c57 45 }
va009039 7:f9f52d9c0c57 46 }
va009039 9:e9843d731180 47 if (*name == '.') {
va009039 9:e9843d731180 48 name++;
va009039 9:e9843d731180 49 }
va009039 7:f9f52d9c0c57 50 for(int i = 8; i < 11; i++) {
va009039 7:f9f52d9c0c57 51 char c = *name++;
va009039 7:f9f52d9c0c57 52 if (c == '\0') {
va009039 7:f9f52d9c0c57 53 break;
va009039 7:f9f52d9c0c57 54 } else {
va009039 7:f9f52d9c0c57 55 buf[i] = toupper(c);
va009039 7:f9f52d9c0c57 56 }
va009039 7:f9f52d9c0c57 57 }
va009039 7:f9f52d9c0c57 58 return true;
va009039 7:f9f52d9c0c57 59 }
va009039 7:f9f52d9c0c57 60
va009039 8:661b3ce0e9c0 61 FileHandle *F32RFileSystem::open(const char* name, int flags) {
va009039 7:f9f52d9c0c57 62 FS_DBG("name=[%s] flags=%d", name, flags);
va009039 7:f9f52d9c0c57 63 if (mount() != 0) {
va009039 7:f9f52d9c0c57 64 return NULL;
va009039 7:f9f52d9c0c57 65 }
va009039 7:f9f52d9c0c57 66
va009039 7:f9f52d9c0c57 67 #if 1
va009039 9:e9843d731180 68 uint8_t fat[32];
va009039 9:e9843d731180 69 storage->Read(base_fat, fat, sizeof(fat));
va009039 9:e9843d731180 70 FS_DBG_HEX(fat, sizeof(fat));
va009039 7:f9f52d9c0c57 71 #endif
va009039 7:f9f52d9c0c57 72
va009039 7:f9f52d9c0c57 73 uint8_t sfn[8+3];
va009039 7:f9f52d9c0c57 74 to_sfn(name, sfn);
va009039 9:e9843d731180 75 FS_DBG_HEX(sfn, sizeof(sfn));
va009039 9:e9843d731180 76 cluster_t cluster = root_directory_first_cluster;
va009039 9:e9843d731180 77 int pos = 0;
va009039 9:e9843d731180 78 while(cluster < 0x0ffffff8) {
va009039 9:e9843d731180 79 FS_TEST_ASSERT(cluster >= 2);
va009039 9:e9843d731180 80 uint32_t dir_pos = base_data + (cluster-2)*cluster_size + cluster_head(pos);
va009039 9:e9843d731180 81 uint8_t buf[32];
va009039 9:e9843d731180 82 storage->Read(dir_pos, buf, sizeof(buf));
va009039 7:f9f52d9c0c57 83 FS_DBG_HEX(buf, sizeof(buf));
va009039 7:f9f52d9c0c57 84 if (buf[0] == 0x00) {
va009039 7:f9f52d9c0c57 85 return NULL;
va009039 7:f9f52d9c0c57 86 } else if (memcmp(buf, sfn, sizeof(sfn)) == 0) {
va009039 9:e9843d731180 87 return new F32RFileHandle(*this, dir_pos);
va009039 9:e9843d731180 88 }
va009039 9:e9843d731180 89 pos += 32;
va009039 9:e9843d731180 90 if (cluster_head(pos) == 0) {
va009039 9:e9843d731180 91 cluster = fat_read(cluster);
va009039 7:f9f52d9c0c57 92 }
va009039 7:f9f52d9c0c57 93 }
va009039 7:f9f52d9c0c57 94 return NULL;
va009039 7:f9f52d9c0c57 95 }
va009039 7:f9f52d9c0c57 96
va009039 8:661b3ce0e9c0 97 int F32RFileSystem::remove(const char *filename) {
va009039 7:f9f52d9c0c57 98 return -1;
va009039 7:f9f52d9c0c57 99 }
va009039 7:f9f52d9c0c57 100
va009039 8:661b3ce0e9c0 101 int F32RFileSystem::rename(const char *oldname, const char *newname) {
va009039 7:f9f52d9c0c57 102 return -1;
va009039 7:f9f52d9c0c57 103 }
va009039 7:f9f52d9c0c57 104
va009039 8:661b3ce0e9c0 105 int F32RFileSystem::format() {
va009039 7:f9f52d9c0c57 106 return -1;
va009039 7:f9f52d9c0c57 107 }
va009039 7:f9f52d9c0c57 108
va009039 8:661b3ce0e9c0 109 DirHandle *F32RFileSystem::opendir(const char *name) {
va009039 7:f9f52d9c0c57 110 FS_DBG("name=[%s]", name);
va009039 7:f9f52d9c0c57 111
va009039 7:f9f52d9c0c57 112 if (mount() != 0) {
va009039 7:f9f52d9c0c57 113 return NULL;
va009039 7:f9f52d9c0c57 114 }
va009039 9:e9843d731180 115 return new F32RDirHandle(*this, root_directory_first_cluster);
va009039 7:f9f52d9c0c57 116 }
va009039 7:f9f52d9c0c57 117
va009039 8:661b3ce0e9c0 118 int F32RFileSystem::mkdir(const char *name, mode_t mode) {
va009039 7:f9f52d9c0c57 119 return -1;
va009039 7:f9f52d9c0c57 120 }
va009039 7:f9f52d9c0c57 121
va009039 8:661b3ce0e9c0 122 int F32RFileSystem::mount() {
va009039 7:f9f52d9c0c57 123 if (storage_peek(0 * 512 + 510, 2) != 0xaa55) {
va009039 7:f9f52d9c0c57 124 return -1;
va009039 7:f9f52d9c0c57 125 }
va009039 7:f9f52d9c0c57 126 uint32_t lba_offset = 0;
va009039 7:f9f52d9c0c57 127 struct { // +446
va009039 7:f9f52d9c0c57 128 uint8_t flag; // +0
va009039 7:f9f52d9c0c57 129 uint8_t first_sector_chs[3]; // +1
va009039 7:f9f52d9c0c57 130 uint8_t type; // +4
va009039 7:f9f52d9c0c57 131 uint8_t last_sector_chs[3]; // +5
va009039 7:f9f52d9c0c57 132 uint32_t sector_start; // +8
va009039 7:f9f52d9c0c57 133 uint32_t sector_count; // +12
va009039 7:f9f52d9c0c57 134 } partition_entry;
va009039 9:e9843d731180 135 storage->Read(446, (uint8_t*)&partition_entry, sizeof(partition_entry));
va009039 9:e9843d731180 136 fs_type = partition_entry.type;
va009039 9:e9843d731180 137 FS_DBG_HEX((uint8_t*)&partition_entry, sizeof(partition_entry));
va009039 9:e9843d731180 138 FS_DBG("fs_type=%02x", fs_type);
va009039 10:0f8c8845a40b 139 if (!is_fat32()) {
va009039 10:0f8c8845a40b 140 debug("fat32 only.");
va009039 10:0f8c8845a40b 141 return -1;
va009039 10:0f8c8845a40b 142 }
va009039 9:e9843d731180 143 if (is_fat12() || is_fat16() || is_fat32()) {
va009039 9:e9843d731180 144 lba_offset = partition_entry.sector_start * 512;
va009039 9:e9843d731180 145 if (storage_peek(lba_offset + 510, 2) != 0xaa55) {
va009039 7:f9f52d9c0c57 146 return -1;
va009039 7:f9f52d9c0c57 147 }
va009039 7:f9f52d9c0c57 148 }
va009039 7:f9f52d9c0c57 149
va009039 7:f9f52d9c0c57 150 #if 1
va009039 7:f9f52d9c0c57 151 FS_DBG("lba_offset=%d", lba_offset);
va009039 9:e9843d731180 152 uint8_t buf[512];
va009039 9:e9843d731180 153 storage->Read(lba_offset, buf, sizeof(buf));
va009039 7:f9f52d9c0c57 154 FS_DBG_HEX(buf, sizeof(buf));
va009039 7:f9f52d9c0c57 155 #endif
va009039 7:f9f52d9c0c57 156
va009039 9:e9843d731180 157 if (storage_peek(lba_offset + 11, 2) != 512) { // verify sector size
va009039 7:f9f52d9c0c57 158 return -1;
va009039 7:f9f52d9c0c57 159 }
va009039 9:e9843d731180 160 cluster_size = storage_peek(lba_offset + 13, 1) * 512;
va009039 9:e9843d731180 161 sector_t number_of_reserved_sectors = storage_peek(lba_offset + 14, 2);
va009039 9:e9843d731180 162 base_fat = lba_offset + number_of_reserved_sectors * 512;
va009039 9:e9843d731180 163 int number_of_fats = storage_peek(lba_offset + 16, 2);
va009039 9:e9843d731180 164 FS_TEST_ASSERT(number_of_fats == 1 || number_of_fats == 2);
va009039 9:e9843d731180 165 // fat32
va009039 9:e9843d731180 166 sector_t number_of_per_fat = storage_peek(lba_offset + 0x24, 4);
va009039 9:e9843d731180 167 root_directory_first_cluster = storage_peek(lba_offset + 0x2c, 4);
va009039 9:e9843d731180 168 root_directory_size = fat32_count(root_directory_first_cluster) * cluster_size;
va009039 9:e9843d731180 169
va009039 9:e9843d731180 170 base_data = base_fat + number_of_per_fat * number_of_fats * 512;
va009039 7:f9f52d9c0c57 171
va009039 7:f9f52d9c0c57 172 FS_DBG("number_of_reserved_sectors=%d", number_of_reserved_sectors);
va009039 7:f9f52d9c0c57 173 FS_DBG("number_of_fats=%d", number_of_fats);
va009039 9:e9843d731180 174
va009039 9:e9843d731180 175 FS_DBG("fat32: number_of_per_fat=%d", number_of_per_fat);
va009039 9:e9843d731180 176 FS_DBG("fat32: root_directory_first_cluster=%d", root_directory_first_cluster);
va009039 9:e9843d731180 177 FS_DBG("fat32: root_directory_size=%d", root_directory_size);
va009039 7:f9f52d9c0c57 178
va009039 7:f9f52d9c0c57 179 FS_DBG("cluster_size=%d", cluster_size);
va009039 7:f9f52d9c0c57 180 FS_DBG("base_fat=%d", base_fat);
va009039 7:f9f52d9c0c57 181 FS_DBG("base_data=%d", base_data);
va009039 7:f9f52d9c0c57 182
va009039 7:f9f52d9c0c57 183 mounted = true;
va009039 7:f9f52d9c0c57 184 return 0;
va009039 7:f9f52d9c0c57 185 }
va009039 7:f9f52d9c0c57 186
va009039 8:661b3ce0e9c0 187 int F32RFileSystem::unmount() {
va009039 7:f9f52d9c0c57 188 mounted = false;
va009039 7:f9f52d9c0c57 189 return 0;
va009039 7:f9f52d9c0c57 190 }
va009039 7:f9f52d9c0c57 191
va009039 8:661b3ce0e9c0 192 uint32_t F32RFileSystem::storage_peek(uint32_t offset, int n) {
va009039 7:f9f52d9c0c57 193 uint8_t buf[n];
va009039 9:e9843d731180 194 storage->Read(offset, buf, sizeof(buf));
va009039 7:f9f52d9c0c57 195 uint32_t val = 0;
va009039 7:f9f52d9c0c57 196 for(int i = 0; i < n; i++) {
va009039 7:f9f52d9c0c57 197 val |= buf[i]<<(i*8);
va009039 7:f9f52d9c0c57 198 }
va009039 7:f9f52d9c0c57 199 return val;
va009039 7:f9f52d9c0c57 200 }
va009039 7:f9f52d9c0c57 201
va009039 8:661b3ce0e9c0 202 cluster_t F32RFileSystem::fat_read(cluster_t index) {
va009039 9:e9843d731180 203 if (is_fat32()) {
va009039 9:e9843d731180 204 return storage_peek(base_fat + index*4, 4);
va009039 9:e9843d731180 205 } else if (is_fat16()) {
va009039 9:e9843d731180 206 return storage_peek(base_fat + index*2, 2);
va009039 9:e9843d731180 207 }
va009039 9:e9843d731180 208 FS_TEST_ASSERT(is_fat12());
va009039 9:e9843d731180 209 int i = index / 2 * 3 + (index&1);
va009039 9:e9843d731180 210 cluster_t next = storage_peek(base_fat + i, 2);
va009039 9:e9843d731180 211 if (index & 1) {
va009039 9:e9843d731180 212 next >>= 4;
va009039 9:e9843d731180 213 } else {
va009039 9:e9843d731180 214 next &= 0xfff;
va009039 9:e9843d731180 215 }
va009039 7:f9f52d9c0c57 216 return next;
va009039 7:f9f52d9c0c57 217 }
va009039 9:e9843d731180 218
va009039 9:e9843d731180 219 int F32RFileSystem::fat32_count(cluster_t cluster) {
va009039 9:e9843d731180 220 int count = 0;
va009039 9:e9843d731180 221 for(; cluster >= 2 && cluster < 0x0ffffff8; count++) {
va009039 9:e9843d731180 222 cluster = fat_read(cluster);
va009039 9:e9843d731180 223 }
va009039 9:e9843d731180 224 return count;
va009039 9:e9843d731180 225 }
va009039 9:e9843d731180 226