]>
Commit | Line | Data |
---|---|---|
83d290c5 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
71f95118 WD |
2 | /* |
3 | * fat.c | |
4 | * | |
5 | * R/O (V)FAT 12/16/32 filesystem implementation by Marcus Sundberg | |
6 | * | |
7 | * 2002-07-28 - rjones@nexus-tech.net - ported to ppcboot v1.1.6 | |
8 | * 2003-03-10 - kharris@nexus-tech.net - ported to uboot | |
71f95118 WD |
9 | */ |
10 | ||
11 | #include <common.h> | |
2a981dc2 | 12 | #include <blk.h> |
71f95118 | 13 | #include <config.h> |
ac497771 | 14 | #include <exports.h> |
71f95118 | 15 | #include <fat.h> |
1f40366b | 16 | #include <fs.h> |
71f95118 | 17 | #include <asm/byteorder.h> |
7205e407 | 18 | #include <part.h> |
9a800ac7 | 19 | #include <malloc.h> |
cf92e05c | 20 | #include <memalign.h> |
9a800ac7 | 21 | #include <linux/compiler.h> |
fb7e16cc | 22 | #include <linux/ctype.h> |
71f95118 | 23 | |
71f95118 | 24 | /* |
21a24c3b RC |
25 | * Convert a string to lowercase. Converts at most 'len' characters, |
26 | * 'len' may be larger than the length of 'str' if 'str' is NULL | |
27 | * terminated. | |
71f95118 | 28 | */ |
21a24c3b | 29 | static void downcase(char *str, size_t len) |
71f95118 | 30 | { |
21a24c3b | 31 | while (*str != '\0' && len--) { |
fb7e16cc | 32 | *str = tolower(*str); |
71f95118 WD |
33 | str++; |
34 | } | |
35 | } | |
36 | ||
4101f687 | 37 | static struct blk_desc *cur_dev; |
9813b750 | 38 | static disk_partition_t cur_part_info; |
7385c28e | 39 | |
9813b750 | 40 | #define DOS_BOOT_MAGIC_OFFSET 0x1fe |
7205e407 | 41 | #define DOS_FS_TYPE_OFFSET 0x36 |
66c2d73c | 42 | #define DOS_FS32_TYPE_OFFSET 0x52 |
71f95118 | 43 | |
9813b750 | 44 | static int disk_read(__u32 block, __u32 nr_blocks, void *buf) |
71f95118 | 45 | { |
0a04ed86 ŁM |
46 | ulong ret; |
47 | ||
2a981dc2 | 48 | if (!cur_dev) |
7205e407 | 49 | return -1; |
7385c28e | 50 | |
2a981dc2 | 51 | ret = blk_dread(cur_dev, cur_part_info.start + block, nr_blocks, buf); |
0a04ed86 | 52 | |
42a9f147 | 53 | if (ret != nr_blocks) |
0a04ed86 ŁM |
54 | return -1; |
55 | ||
56 | return ret; | |
71f95118 WD |
57 | } |
58 | ||
4101f687 | 59 | int fat_set_blk_dev(struct blk_desc *dev_desc, disk_partition_t *info) |
71f95118 | 60 | { |
9a800ac7 | 61 | ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, dev_desc->blksz); |
7205e407 | 62 | |
5e8f9831 SW |
63 | cur_dev = dev_desc; |
64 | cur_part_info = *info; | |
9813b750 KM |
65 | |
66 | /* Make sure it has a valid FAT header */ | |
67 | if (disk_read(0, 1, buffer) != 1) { | |
68 | cur_dev = NULL; | |
69 | return -1; | |
bf1060ea | 70 | } |
9813b750 KM |
71 | |
72 | /* Check if it's actually a DOS volume */ | |
73 | if (memcmp(buffer + DOS_BOOT_MAGIC_OFFSET, "\x55\xAA", 2)) { | |
74 | cur_dev = NULL; | |
75 | return -1; | |
76 | } | |
77 | ||
78 | /* Check for FAT12/FAT16/FAT32 filesystem */ | |
79 | if (!memcmp(buffer + DOS_FS_TYPE_OFFSET, "FAT", 3)) | |
80 | return 0; | |
81 | if (!memcmp(buffer + DOS_FS32_TYPE_OFFSET, "FAT32", 5)) | |
82 | return 0; | |
83 | ||
84 | cur_dev = NULL; | |
85 | return -1; | |
71f95118 WD |
86 | } |
87 | ||
4101f687 | 88 | int fat_register_device(struct blk_desc *dev_desc, int part_no) |
5e8f9831 SW |
89 | { |
90 | disk_partition_t info; | |
91 | ||
92 | /* First close any currently found FAT filesystem */ | |
93 | cur_dev = NULL; | |
94 | ||
95 | /* Read the partition table, if present */ | |
3e8bd469 | 96 | if (part_get_info(dev_desc, part_no, &info)) { |
5e8f9831 SW |
97 | if (part_no != 0) { |
98 | printf("** Partition %d not valid on device %d **\n", | |
bcce53d0 | 99 | part_no, dev_desc->devnum); |
5e8f9831 SW |
100 | return -1; |
101 | } | |
102 | ||
103 | info.start = 0; | |
104 | info.size = dev_desc->lba; | |
105 | info.blksz = dev_desc->blksz; | |
106 | info.name[0] = 0; | |
107 | info.type[0] = 0; | |
108 | info.bootable = 0; | |
b331cd62 | 109 | #if CONFIG_IS_ENABLED(PARTITION_UUIDS) |
5e8f9831 SW |
110 | info.uuid[0] = 0; |
111 | #endif | |
112 | } | |
113 | ||
114 | return fat_set_blk_dev(dev_desc, &info); | |
115 | } | |
9813b750 | 116 | |
71f95118 WD |
117 | /* |
118 | * Extract zero terminated short name from a directory entry. | |
119 | */ | |
9795e07b | 120 | static void get_name(dir_entry *dirent, char *s_name) |
71f95118 WD |
121 | { |
122 | char *ptr; | |
123 | ||
7385c28e | 124 | memcpy(s_name, dirent->name, 8); |
71f95118 WD |
125 | s_name[8] = '\0'; |
126 | ptr = s_name; | |
127 | while (*ptr && *ptr != ' ') | |
128 | ptr++; | |
21a24c3b RC |
129 | if (dirent->lcase & CASE_LOWER_BASE) |
130 | downcase(s_name, (unsigned)(ptr - s_name)); | |
71f95118 | 131 | if (dirent->ext[0] && dirent->ext[0] != ' ') { |
21a24c3b | 132 | *ptr++ = '.'; |
7385c28e | 133 | memcpy(ptr, dirent->ext, 3); |
21a24c3b RC |
134 | if (dirent->lcase & CASE_LOWER_EXT) |
135 | downcase(ptr, 3); | |
71f95118 WD |
136 | ptr[3] = '\0'; |
137 | while (*ptr && *ptr != ' ') | |
138 | ptr++; | |
139 | } | |
140 | *ptr = '\0'; | |
141 | if (*s_name == DELETED_FLAG) | |
142 | *s_name = '\0'; | |
143 | else if (*s_name == aRING) | |
3c2c2f42 | 144 | *s_name = DELETED_FLAG; |
71f95118 WD |
145 | } |
146 | ||
b8948d2a SB |
147 | static int flush_dirty_fat_buffer(fsdata *mydata); |
148 | #if !defined(CONFIG_FAT_WRITE) | |
149 | /* Stub for read only operation */ | |
150 | int flush_dirty_fat_buffer(fsdata *mydata) | |
151 | { | |
152 | (void)(mydata); | |
153 | return 0; | |
154 | } | |
155 | #endif | |
156 | ||
71f95118 WD |
157 | /* |
158 | * Get the entry at index 'entry' in a FAT (12/16/32) table. | |
159 | * On failure 0x00 is returned. | |
160 | */ | |
9795e07b | 161 | static __u32 get_fatent(fsdata *mydata, __u32 entry) |
71f95118 WD |
162 | { |
163 | __u32 bufnum; | |
b352caea | 164 | __u32 offset, off8; |
71f95118 WD |
165 | __u32 ret = 0x00; |
166 | ||
b8948d2a SB |
167 | if (CHECK_CLUST(entry, mydata->fatsize)) { |
168 | printf("Error: Invalid FAT entry: 0x%08x\n", entry); | |
169 | return ret; | |
170 | } | |
171 | ||
71f95118 WD |
172 | switch (mydata->fatsize) { |
173 | case 32: | |
174 | bufnum = entry / FAT32BUFSIZE; | |
175 | offset = entry - bufnum * FAT32BUFSIZE; | |
176 | break; | |
177 | case 16: | |
178 | bufnum = entry / FAT16BUFSIZE; | |
179 | offset = entry - bufnum * FAT16BUFSIZE; | |
180 | break; | |
181 | case 12: | |
182 | bufnum = entry / FAT12BUFSIZE; | |
183 | offset = entry - bufnum * FAT12BUFSIZE; | |
184 | break; | |
185 | ||
186 | default: | |
187 | /* Unsupported FAT size */ | |
188 | return ret; | |
189 | } | |
190 | ||
b8948d2a | 191 | debug("FAT%d: entry: 0x%08x = %d, offset: 0x%04x = %d\n", |
7385c28e | 192 | mydata->fatsize, entry, entry, offset, offset); |
2aa98c66 | 193 | |
71f95118 WD |
194 | /* Read a new block of FAT entries into the cache. */ |
195 | if (bufnum != mydata->fatbufnum) { | |
60b36f0f | 196 | __u32 getsize = FATBUFBLOCKS; |
71f95118 WD |
197 | __u8 *bufptr = mydata->fatbuf; |
198 | __u32 fatlength = mydata->fatlength; | |
199 | __u32 startblock = bufnum * FATBUFBLOCKS; | |
200 | ||
6c1a8080 | 201 | /* Cap length if fatlength is not a multiple of FATBUFBLOCKS */ |
8006dd2e BT |
202 | if (startblock + getsize > fatlength) |
203 | getsize = fatlength - startblock; | |
60b36f0f | 204 | |
71f95118 WD |
205 | startblock += mydata->fat_sect; /* Offset from start of disk */ |
206 | ||
b8948d2a SB |
207 | /* Write back the fatbuf to the disk */ |
208 | if (flush_dirty_fat_buffer(mydata) < 0) | |
209 | return -1; | |
210 | ||
71f95118 | 211 | if (disk_read(startblock, getsize, bufptr) < 0) { |
7385c28e | 212 | debug("Error reading FAT blocks\n"); |
71f95118 WD |
213 | return ret; |
214 | } | |
215 | mydata->fatbufnum = bufnum; | |
216 | } | |
217 | ||
218 | /* Get the actual entry from the table */ | |
219 | switch (mydata->fatsize) { | |
220 | case 32: | |
7385c28e | 221 | ret = FAT2CPU32(((__u32 *) mydata->fatbuf)[offset]); |
71f95118 WD |
222 | break; |
223 | case 16: | |
7385c28e | 224 | ret = FAT2CPU16(((__u16 *) mydata->fatbuf)[offset]); |
71f95118 | 225 | break; |
7385c28e | 226 | case 12: |
b352caea SB |
227 | off8 = (offset * 3) / 2; |
228 | /* fatbut + off8 may be unaligned, read in byte granularity */ | |
229 | ret = mydata->fatbuf[off8] + (mydata->fatbuf[off8 + 1] << 8); | |
8d48c92b SB |
230 | |
231 | if (offset & 0x1) | |
232 | ret >>= 4; | |
233 | ret &= 0xfff; | |
71f95118 | 234 | } |
b8948d2a SB |
235 | debug("FAT%d: ret: 0x%08x, entry: 0x%08x, offset: 0x%04x\n", |
236 | mydata->fatsize, ret, entry, offset); | |
71f95118 WD |
237 | |
238 | return ret; | |
239 | } | |
240 | ||
71f95118 WD |
241 | /* |
242 | * Read at most 'size' bytes from the specified cluster into 'buffer'. | |
243 | * Return 0 on success, -1 otherwise. | |
244 | */ | |
245 | static int | |
9795e07b | 246 | get_cluster(fsdata *mydata, __u32 clustnum, __u8 *buffer, unsigned long size) |
71f95118 | 247 | { |
3f270f42 | 248 | __u32 idx = 0; |
71f95118 | 249 | __u32 startsect; |
46236b14 | 250 | int ret; |
71f95118 WD |
251 | |
252 | if (clustnum > 0) { | |
265edc03 | 253 | startsect = clust_to_sect(mydata, clustnum); |
71f95118 WD |
254 | } else { |
255 | startsect = mydata->rootdir_sect; | |
256 | } | |
257 | ||
7385c28e WD |
258 | debug("gc - clustnum: %d, startsect: %d\n", clustnum, startsect); |
259 | ||
cc63b25e | 260 | if ((unsigned long)buffer & (ARCH_DMA_MINALIGN - 1)) { |
9a800ac7 | 261 | ALLOC_CACHE_ALIGN_BUFFER(__u8, tmpbuf, mydata->sect_size); |
7385c28e | 262 | |
cc63b25e BT |
263 | printf("FAT: Misaligned buffer address (%p)\n", buffer); |
264 | ||
265 | while (size >= mydata->sect_size) { | |
266 | ret = disk_read(startsect++, 1, tmpbuf); | |
267 | if (ret != 1) { | |
268 | debug("Error reading data (got %d)\n", ret); | |
269 | return -1; | |
270 | } | |
271 | ||
272 | memcpy(buffer, tmpbuf, mydata->sect_size); | |
273 | buffer += mydata->sect_size; | |
274 | size -= mydata->sect_size; | |
275 | } | |
276 | } else { | |
ac497771 | 277 | idx = size / mydata->sect_size; |
cc63b25e BT |
278 | ret = disk_read(startsect, idx, buffer); |
279 | if (ret != idx) { | |
280 | debug("Error reading data (got %d)\n", ret); | |
281 | return -1; | |
282 | } | |
283 | startsect += idx; | |
284 | idx *= mydata->sect_size; | |
285 | buffer += idx; | |
286 | size -= idx; | |
287 | } | |
288 | if (size) { | |
289 | ALLOC_CACHE_ALIGN_BUFFER(__u8, tmpbuf, mydata->sect_size); | |
290 | ||
291 | ret = disk_read(startsect, 1, tmpbuf); | |
46236b14 KM |
292 | if (ret != 1) { |
293 | debug("Error reading data (got %d)\n", ret); | |
7205e407 | 294 | return -1; |
71f95118 | 295 | } |
7205e407 | 296 | |
cc63b25e | 297 | memcpy(buffer, tmpbuf, size); |
71f95118 WD |
298 | } |
299 | ||
300 | return 0; | |
301 | } | |
302 | ||
71f95118 | 303 | /* |
1170e634 | 304 | * Read at most 'maxsize' bytes from 'pos' in the file associated with 'dentptr' |
71f95118 | 305 | * into 'buffer'. |
1ad0b98a | 306 | * Update the number of bytes read in *gotsize or return -1 on fatal errors. |
71f95118 | 307 | */ |
1170e634 BT |
308 | __u8 get_contents_vfatname_block[MAX_CLUSTSIZE] |
309 | __aligned(ARCH_DMA_MINALIGN); | |
310 | ||
1ad0b98a SR |
311 | static int get_contents(fsdata *mydata, dir_entry *dentptr, loff_t pos, |
312 | __u8 *buffer, loff_t maxsize, loff_t *gotsize) | |
71f95118 | 313 | { |
1ad0b98a | 314 | loff_t filesize = FAT2CPU32(dentptr->size); |
ac497771 | 315 | unsigned int bytesperclust = mydata->clust_size * mydata->sect_size; |
71f95118 | 316 | __u32 curclust = START(dentptr); |
7205e407 | 317 | __u32 endclust, newclust; |
1ad0b98a | 318 | loff_t actsize; |
71f95118 | 319 | |
1ad0b98a SR |
320 | *gotsize = 0; |
321 | debug("Filesize: %llu bytes\n", filesize); | |
71f95118 | 322 | |
1170e634 | 323 | if (pos >= filesize) { |
1ad0b98a SR |
324 | debug("Read position past EOF: %llu\n", pos); |
325 | return 0; | |
1170e634 BT |
326 | } |
327 | ||
328 | if (maxsize > 0 && filesize > pos + maxsize) | |
329 | filesize = pos + maxsize; | |
71f95118 | 330 | |
1ad0b98a | 331 | debug("%llu bytes\n", filesize); |
7385c28e | 332 | |
1170e634 BT |
333 | actsize = bytesperclust; |
334 | ||
335 | /* go to cluster at pos */ | |
336 | while (actsize <= pos) { | |
337 | curclust = get_fatent(mydata, curclust); | |
338 | if (CHECK_CLUST(curclust, mydata->fatsize)) { | |
339 | debug("curclust: 0x%x\n", curclust); | |
340 | debug("Invalid FAT entry\n"); | |
1ad0b98a | 341 | return 0; |
1170e634 BT |
342 | } |
343 | actsize += bytesperclust; | |
344 | } | |
345 | ||
346 | /* actsize > pos */ | |
347 | actsize -= bytesperclust; | |
348 | filesize -= actsize; | |
349 | pos -= actsize; | |
350 | ||
351 | /* align to beginning of next cluster if any */ | |
352 | if (pos) { | |
1ad0b98a | 353 | actsize = min(filesize, (loff_t)bytesperclust); |
1170e634 BT |
354 | if (get_cluster(mydata, curclust, get_contents_vfatname_block, |
355 | (int)actsize) != 0) { | |
356 | printf("Error reading cluster\n"); | |
357 | return -1; | |
358 | } | |
359 | filesize -= actsize; | |
360 | actsize -= pos; | |
361 | memcpy(buffer, get_contents_vfatname_block + pos, actsize); | |
1ad0b98a | 362 | *gotsize += actsize; |
1170e634 | 363 | if (!filesize) |
1ad0b98a | 364 | return 0; |
1170e634 BT |
365 | buffer += actsize; |
366 | ||
367 | curclust = get_fatent(mydata, curclust); | |
368 | if (CHECK_CLUST(curclust, mydata->fatsize)) { | |
369 | debug("curclust: 0x%x\n", curclust); | |
370 | debug("Invalid FAT entry\n"); | |
1ad0b98a | 371 | return 0; |
1170e634 BT |
372 | } |
373 | } | |
374 | ||
7385c28e WD |
375 | actsize = bytesperclust; |
376 | endclust = curclust; | |
71f95118 WD |
377 | |
378 | do { | |
7205e407 | 379 | /* search for consecutive clusters */ |
7385c28e | 380 | while (actsize < filesize) { |
7205e407 | 381 | newclust = get_fatent(mydata, endclust); |
7385c28e | 382 | if ((newclust - 1) != endclust) |
7205e407 | 383 | goto getit; |
8ce4e5c2 | 384 | if (CHECK_CLUST(newclust, mydata->fatsize)) { |
7385c28e WD |
385 | debug("curclust: 0x%x\n", newclust); |
386 | debug("Invalid FAT entry\n"); | |
1ad0b98a | 387 | return 0; |
7205e407 | 388 | } |
7385c28e WD |
389 | endclust = newclust; |
390 | actsize += bytesperclust; | |
7205e407 | 391 | } |
7385c28e | 392 | |
7205e407 | 393 | /* get remaining bytes */ |
7385c28e | 394 | actsize = filesize; |
0880e5bb | 395 | if (get_cluster(mydata, curclust, buffer, (int)actsize) != 0) { |
7385c28e | 396 | printf("Error reading cluster\n"); |
7205e407 WD |
397 | return -1; |
398 | } | |
1ad0b98a SR |
399 | *gotsize += actsize; |
400 | return 0; | |
7205e407 WD |
401 | getit: |
402 | if (get_cluster(mydata, curclust, buffer, (int)actsize) != 0) { | |
7385c28e | 403 | printf("Error reading cluster\n"); |
7205e407 WD |
404 | return -1; |
405 | } | |
1ad0b98a | 406 | *gotsize += (int)actsize; |
7205e407 WD |
407 | filesize -= actsize; |
408 | buffer += actsize; | |
7385c28e | 409 | |
7205e407 | 410 | curclust = get_fatent(mydata, endclust); |
8ce4e5c2 | 411 | if (CHECK_CLUST(curclust, mydata->fatsize)) { |
7385c28e WD |
412 | debug("curclust: 0x%x\n", curclust); |
413 | printf("Invalid FAT entry\n"); | |
1ad0b98a | 414 | return 0; |
71f95118 | 415 | } |
7385c28e WD |
416 | actsize = bytesperclust; |
417 | endclust = curclust; | |
71f95118 WD |
418 | } while (1); |
419 | } | |
420 | ||
71f95118 WD |
421 | /* |
422 | * Extract the file name information from 'slotptr' into 'l_name', | |
423 | * starting at l_name[*idx]. | |
424 | * Return 1 if terminator (zero byte) is found, 0 otherwise. | |
425 | */ | |
9795e07b | 426 | static int slot2str(dir_slot *slotptr, char *l_name, int *idx) |
71f95118 WD |
427 | { |
428 | int j; | |
429 | ||
430 | for (j = 0; j <= 8; j += 2) { | |
431 | l_name[*idx] = slotptr->name0_4[j]; | |
7385c28e WD |
432 | if (l_name[*idx] == 0x00) |
433 | return 1; | |
71f95118 WD |
434 | (*idx)++; |
435 | } | |
436 | for (j = 0; j <= 10; j += 2) { | |
437 | l_name[*idx] = slotptr->name5_10[j]; | |
7385c28e WD |
438 | if (l_name[*idx] == 0x00) |
439 | return 1; | |
71f95118 WD |
440 | (*idx)++; |
441 | } | |
442 | for (j = 0; j <= 2; j += 2) { | |
443 | l_name[*idx] = slotptr->name11_12[j]; | |
7385c28e WD |
444 | if (l_name[*idx] == 0x00) |
445 | return 1; | |
71f95118 WD |
446 | (*idx)++; |
447 | } | |
448 | ||
449 | return 0; | |
450 | } | |
451 | ||
71f95118 | 452 | /* Calculate short name checksum */ |
ff04f6d1 | 453 | static __u8 mkcksum(const char name[8], const char ext[3]) |
71f95118 WD |
454 | { |
455 | int i; | |
7385c28e | 456 | |
71f95118 WD |
457 | __u8 ret = 0; |
458 | ||
6ad77d88 | 459 | for (i = 0; i < 8; i++) |
ff04f6d1 | 460 | ret = (((ret & 1) << 7) | ((ret & 0xfe) >> 1)) + name[i]; |
6ad77d88 | 461 | for (i = 0; i < 3; i++) |
ff04f6d1 | 462 | ret = (((ret & 1) << 7) | ((ret & 0xfe) >> 1)) + ext[i]; |
71f95118 WD |
463 | |
464 | return ret; | |
465 | } | |
71f95118 WD |
466 | |
467 | /* | |
8eafae20 RC |
468 | * TODO these should go away once fat_write is reworked to use the |
469 | * directory iterator | |
71f95118 | 470 | */ |
9a800ac7 EN |
471 | __u8 get_dentfromdir_block[MAX_CLUSTSIZE] |
472 | __aligned(ARCH_DMA_MINALIGN); | |
8eafae20 RC |
473 | __u8 do_fat_read_at_block[MAX_CLUSTSIZE] |
474 | __aligned(ARCH_DMA_MINALIGN); | |
71f95118 | 475 | |
71f95118 WD |
476 | /* |
477 | * Read boot sector and volume info from a FAT filesystem | |
478 | */ | |
479 | static int | |
9795e07b | 480 | read_bootsectandvi(boot_sector *bs, volume_info *volinfo, int *fatsize) |
71f95118 | 481 | { |
ac497771 | 482 | __u8 *block; |
71f95118 | 483 | volume_info *vistart; |
ac497771 SS |
484 | int ret = 0; |
485 | ||
486 | if (cur_dev == NULL) { | |
487 | debug("Error: no device selected\n"); | |
488 | return -1; | |
489 | } | |
490 | ||
09fa964b | 491 | block = malloc_cache_aligned(cur_dev->blksz); |
ac497771 SS |
492 | if (block == NULL) { |
493 | debug("Error: allocating block\n"); | |
494 | return -1; | |
495 | } | |
71f95118 | 496 | |
9795e07b | 497 | if (disk_read(0, 1, block) < 0) { |
7385c28e | 498 | debug("Error: reading block\n"); |
ac497771 | 499 | goto fail; |
71f95118 WD |
500 | } |
501 | ||
502 | memcpy(bs, block, sizeof(boot_sector)); | |
7385c28e WD |
503 | bs->reserved = FAT2CPU16(bs->reserved); |
504 | bs->fat_length = FAT2CPU16(bs->fat_length); | |
505 | bs->secs_track = FAT2CPU16(bs->secs_track); | |
506 | bs->heads = FAT2CPU16(bs->heads); | |
507 | bs->total_sect = FAT2CPU32(bs->total_sect); | |
71f95118 WD |
508 | |
509 | /* FAT32 entries */ | |
510 | if (bs->fat_length == 0) { | |
511 | /* Assume FAT32 */ | |
512 | bs->fat32_length = FAT2CPU32(bs->fat32_length); | |
7385c28e | 513 | bs->flags = FAT2CPU16(bs->flags); |
71f95118 | 514 | bs->root_cluster = FAT2CPU32(bs->root_cluster); |
7385c28e WD |
515 | bs->info_sector = FAT2CPU16(bs->info_sector); |
516 | bs->backup_boot = FAT2CPU16(bs->backup_boot); | |
517 | vistart = (volume_info *)(block + sizeof(boot_sector)); | |
71f95118 WD |
518 | *fatsize = 32; |
519 | } else { | |
7385c28e | 520 | vistart = (volume_info *)&(bs->fat32_length); |
71f95118 WD |
521 | *fatsize = 0; |
522 | } | |
523 | memcpy(volinfo, vistart, sizeof(volume_info)); | |
524 | ||
71f95118 | 525 | if (*fatsize == 32) { |
7385c28e | 526 | if (strncmp(FAT32_SIGN, vistart->fs_type, SIGNLEN) == 0) |
ac497771 | 527 | goto exit; |
71f95118 | 528 | } else { |
651351fe | 529 | if (strncmp(FAT12_SIGN, vistart->fs_type, SIGNLEN) == 0) { |
71f95118 | 530 | *fatsize = 12; |
ac497771 | 531 | goto exit; |
71f95118 | 532 | } |
651351fe | 533 | if (strncmp(FAT16_SIGN, vistart->fs_type, SIGNLEN) == 0) { |
71f95118 | 534 | *fatsize = 16; |
ac497771 | 535 | goto exit; |
71f95118 WD |
536 | } |
537 | } | |
538 | ||
7385c28e | 539 | debug("Error: broken fs_type sign\n"); |
ac497771 SS |
540 | fail: |
541 | ret = -1; | |
542 | exit: | |
543 | free(block); | |
544 | return ret; | |
71f95118 WD |
545 | } |
546 | ||
45449980 | 547 | static int get_fs_info(fsdata *mydata) |
71f95118 | 548 | { |
7385c28e WD |
549 | boot_sector bs; |
550 | volume_info volinfo; | |
45449980 | 551 | int ret; |
7385c28e | 552 | |
45449980 RC |
553 | ret = read_bootsectandvi(&bs, &volinfo, &mydata->fatsize); |
554 | if (ret) { | |
7385c28e | 555 | debug("Error: reading boot sector\n"); |
45449980 | 556 | return ret; |
7385c28e WD |
557 | } |
558 | ||
40e21916 | 559 | if (mydata->fatsize == 32) { |
7385c28e | 560 | mydata->fatlength = bs.fat32_length; |
f23101f9 | 561 | mydata->total_sect = bs.total_sect; |
40e21916 | 562 | } else { |
7385c28e | 563 | mydata->fatlength = bs.fat_length; |
f23101f9 AT |
564 | mydata->total_sect = (bs.sectors[1] << 8) + bs.sectors[0]; |
565 | if (!mydata->total_sect) | |
566 | mydata->total_sect = bs.total_sect; | |
40e21916 | 567 | } |
f23101f9 AT |
568 | if (!mydata->total_sect) /* unlikely */ |
569 | mydata->total_sect = (u32)cur_part_info.size; | |
7385c28e | 570 | |
f23101f9 | 571 | mydata->fats = bs.fats; |
7385c28e WD |
572 | mydata->fat_sect = bs.reserved; |
573 | ||
45449980 | 574 | mydata->rootdir_sect = mydata->fat_sect + mydata->fatlength * bs.fats; |
7385c28e | 575 | |
ac497771 | 576 | mydata->sect_size = (bs.sector_size[1] << 8) + bs.sector_size[0]; |
7385c28e | 577 | mydata->clust_size = bs.cluster_size; |
46236b14 KM |
578 | if (mydata->sect_size != cur_part_info.blksz) { |
579 | printf("Error: FAT sector size mismatch (fs=%hu, dev=%lu)\n", | |
580 | mydata->sect_size, cur_part_info.blksz); | |
581 | return -1; | |
582 | } | |
7385c28e WD |
583 | |
584 | if (mydata->fatsize == 32) { | |
585 | mydata->data_begin = mydata->rootdir_sect - | |
586 | (mydata->clust_size * 2); | |
c6e3baa5 | 587 | mydata->root_cluster = bs.root_cluster; |
7385c28e | 588 | } else { |
45449980 RC |
589 | mydata->rootdir_size = ((bs.dir_entries[1] * (int)256 + |
590 | bs.dir_entries[0]) * | |
591 | sizeof(dir_entry)) / | |
592 | mydata->sect_size; | |
7385c28e | 593 | mydata->data_begin = mydata->rootdir_sect + |
45449980 | 594 | mydata->rootdir_size - |
7385c28e | 595 | (mydata->clust_size * 2); |
265edc03 RC |
596 | mydata->root_cluster = |
597 | sect_to_clust(mydata, mydata->rootdir_sect); | |
7385c28e WD |
598 | } |
599 | ||
600 | mydata->fatbufnum = -1; | |
3c0ed9c3 | 601 | mydata->fat_dirty = 0; |
09fa964b | 602 | mydata->fatbuf = malloc_cache_aligned(FATBUFSIZE); |
ac497771 SS |
603 | if (mydata->fatbuf == NULL) { |
604 | debug("Error: allocating memory\n"); | |
605 | return -1; | |
606 | } | |
71f95118 | 607 | |
7385c28e WD |
608 | debug("FAT%d, fat_sect: %d, fatlength: %d\n", |
609 | mydata->fatsize, mydata->fat_sect, mydata->fatlength); | |
610 | debug("Rootdir begins at cluster: %d, sector: %d, offset: %x\n" | |
611 | "Data begins at: %d\n", | |
c6e3baa5 | 612 | mydata->root_cluster, |
7385c28e | 613 | mydata->rootdir_sect, |
ac497771 SS |
614 | mydata->rootdir_sect * mydata->sect_size, mydata->data_begin); |
615 | debug("Sector size: %d, cluster size: %d\n", mydata->sect_size, | |
616 | mydata->clust_size); | |
7385c28e | 617 | |
45449980 RC |
618 | return 0; |
619 | } | |
620 | ||
c6e3baa5 RC |
621 | |
622 | /* | |
623 | * Directory iterator, to simplify filesystem traversal | |
624 | * | |
625 | * Implements an iterator pattern to traverse directory tables, | |
626 | * transparently handling directory tables split across multiple | |
627 | * clusters, and the difference between FAT12/FAT16 root directory | |
628 | * (contiguous) and subdirectories + FAT32 root (chained). | |
629 | * | |
630 | * Rough usage: | |
631 | * | |
632 | * for (fat_itr_root(&itr, fsdata); fat_itr_next(&itr); ) { | |
633 | * // to traverse down to a subdirectory pointed to by | |
634 | * // current iterator position: | |
635 | * fat_itr_child(&itr, &itr); | |
636 | * } | |
637 | * | |
638 | * For more complete example, see fat_itr_resolve() | |
639 | */ | |
640 | ||
641 | typedef struct { | |
642 | fsdata *fsdata; /* filesystem parameters */ | |
643 | unsigned clust; /* current cluster */ | |
644 | int last_cluster; /* set once we've read last cluster */ | |
645 | int is_root; /* is iterator at root directory */ | |
646 | int remaining; /* remaining dent's in current cluster */ | |
647 | ||
648 | /* current iterator position values: */ | |
649 | dir_entry *dent; /* current directory entry */ | |
650 | char l_name[VFAT_MAXLEN_BYTES]; /* long (vfat) name */ | |
651 | char s_name[14]; /* short 8.3 name */ | |
652 | char *name; /* l_name if there is one, else s_name */ | |
653 | ||
654 | /* storage for current cluster in memory: */ | |
655 | u8 block[MAX_CLUSTSIZE] __aligned(ARCH_DMA_MINALIGN); | |
656 | } fat_itr; | |
657 | ||
658 | static int fat_itr_isdir(fat_itr *itr); | |
659 | ||
660 | /** | |
661 | * fat_itr_root() - initialize an iterator to start at the root | |
662 | * directory | |
663 | * | |
664 | * @itr: iterator to initialize | |
665 | * @fsdata: filesystem data for the partition | |
666 | * @return 0 on success, else -errno | |
667 | */ | |
668 | static int fat_itr_root(fat_itr *itr, fsdata *fsdata) | |
669 | { | |
670 | if (get_fs_info(fsdata)) | |
671 | return -ENXIO; | |
672 | ||
673 | itr->fsdata = fsdata; | |
674 | itr->clust = fsdata->root_cluster; | |
675 | itr->dent = NULL; | |
676 | itr->remaining = 0; | |
677 | itr->last_cluster = 0; | |
678 | itr->is_root = 1; | |
679 | ||
680 | return 0; | |
681 | } | |
682 | ||
683 | /** | |
684 | * fat_itr_child() - initialize an iterator to descend into a sub- | |
685 | * directory | |
686 | * | |
687 | * Initializes 'itr' to iterate the contents of the directory at | |
688 | * the current cursor position of 'parent'. It is an error to | |
689 | * call this if the current cursor of 'parent' is pointing at a | |
690 | * regular file. | |
691 | * | |
692 | * Note that 'itr' and 'parent' can be the same pointer if you do | |
693 | * not need to preserve 'parent' after this call, which is useful | |
694 | * for traversing directory structure to resolve a file/directory. | |
695 | * | |
696 | * @itr: iterator to initialize | |
697 | * @parent: the iterator pointing at a directory entry in the | |
698 | * parent directory of the directory to iterate | |
699 | */ | |
700 | static void fat_itr_child(fat_itr *itr, fat_itr *parent) | |
701 | { | |
702 | fsdata *mydata = parent->fsdata; /* for silly macros */ | |
703 | unsigned clustnum = START(parent->dent); | |
704 | ||
705 | assert(fat_itr_isdir(parent)); | |
706 | ||
707 | itr->fsdata = parent->fsdata; | |
708 | if (clustnum > 0) { | |
709 | itr->clust = clustnum; | |
8df87314 | 710 | itr->is_root = 0; |
c6e3baa5 RC |
711 | } else { |
712 | itr->clust = parent->fsdata->root_cluster; | |
8df87314 | 713 | itr->is_root = 1; |
c6e3baa5 RC |
714 | } |
715 | itr->dent = NULL; | |
716 | itr->remaining = 0; | |
717 | itr->last_cluster = 0; | |
c6e3baa5 RC |
718 | } |
719 | ||
720 | static void *next_cluster(fat_itr *itr) | |
721 | { | |
722 | fsdata *mydata = itr->fsdata; /* for silly macros */ | |
723 | int ret; | |
724 | u32 sect; | |
725 | ||
726 | /* have we reached the end? */ | |
727 | if (itr->last_cluster) | |
728 | return NULL; | |
729 | ||
730 | sect = clust_to_sect(itr->fsdata, itr->clust); | |
731 | ||
732 | debug("FAT read(sect=%d), clust_size=%d, DIRENTSPERBLOCK=%zd\n", | |
733 | sect, itr->fsdata->clust_size, DIRENTSPERBLOCK); | |
734 | ||
735 | /* | |
736 | * NOTE: do_fat_read_at() had complicated logic to deal w/ | |
737 | * vfat names that span multiple clusters in the fat16 case, | |
738 | * which get_dentfromdir() probably also needed (and was | |
739 | * missing). And not entirely sure what fat32 didn't have | |
740 | * the same issue.. We solve that by only caring about one | |
741 | * dent at a time and iteratively constructing the vfat long | |
742 | * name. | |
743 | */ | |
744 | ret = disk_read(sect, itr->fsdata->clust_size, | |
745 | itr->block); | |
746 | if (ret < 0) { | |
747 | debug("Error: reading block\n"); | |
748 | return NULL; | |
749 | } | |
750 | ||
751 | if (itr->is_root && itr->fsdata->fatsize != 32) { | |
752 | itr->clust++; | |
753 | sect = clust_to_sect(itr->fsdata, itr->clust); | |
754 | if (sect - itr->fsdata->rootdir_sect >= | |
755 | itr->fsdata->rootdir_size) { | |
756 | debug("cursect: 0x%x\n", itr->clust); | |
757 | itr->last_cluster = 1; | |
758 | } | |
759 | } else { | |
760 | itr->clust = get_fatent(itr->fsdata, itr->clust); | |
761 | if (CHECK_CLUST(itr->clust, itr->fsdata->fatsize)) { | |
762 | debug("cursect: 0x%x\n", itr->clust); | |
763 | itr->last_cluster = 1; | |
764 | } | |
765 | } | |
766 | ||
767 | return itr->block; | |
768 | } | |
769 | ||
770 | static dir_entry *next_dent(fat_itr *itr) | |
771 | { | |
772 | if (itr->remaining == 0) { | |
773 | struct dir_entry *dent = next_cluster(itr); | |
774 | unsigned nbytes = itr->fsdata->sect_size * | |
775 | itr->fsdata->clust_size; | |
776 | ||
777 | /* have we reached the last cluster? */ | |
778 | if (!dent) | |
779 | return NULL; | |
780 | ||
781 | itr->remaining = nbytes / sizeof(dir_entry) - 1; | |
782 | itr->dent = dent; | |
783 | } else { | |
784 | itr->remaining--; | |
785 | itr->dent++; | |
786 | } | |
787 | ||
788 | /* have we reached the last valid entry? */ | |
789 | if (itr->dent->name[0] == 0) | |
790 | return NULL; | |
791 | ||
792 | return itr->dent; | |
793 | } | |
794 | ||
795 | static dir_entry *extract_vfat_name(fat_itr *itr) | |
796 | { | |
797 | struct dir_entry *dent = itr->dent; | |
798 | int seqn = itr->dent->name[0] & ~LAST_LONG_ENTRY_MASK; | |
799 | u8 chksum, alias_checksum = ((dir_slot *)dent)->alias_checksum; | |
800 | int n = 0; | |
801 | ||
802 | while (seqn--) { | |
803 | char buf[13]; | |
804 | int idx = 0; | |
805 | ||
806 | slot2str((dir_slot *)dent, buf, &idx); | |
807 | ||
808 | /* shift accumulated long-name up and copy new part in: */ | |
809 | memmove(itr->l_name + idx, itr->l_name, n); | |
810 | memcpy(itr->l_name, buf, idx); | |
811 | n += idx; | |
812 | ||
813 | dent = next_dent(itr); | |
814 | if (!dent) | |
815 | return NULL; | |
816 | } | |
817 | ||
818 | itr->l_name[n] = '\0'; | |
819 | ||
820 | chksum = mkcksum(dent->name, dent->ext); | |
821 | ||
822 | /* checksum mismatch could mean deleted file, etc.. skip it: */ | |
823 | if (chksum != alias_checksum) { | |
824 | debug("** chksum=%x, alias_checksum=%x, l_name=%s, s_name=%8s.%3s\n", | |
825 | chksum, alias_checksum, itr->l_name, dent->name, dent->ext); | |
826 | return NULL; | |
827 | } | |
828 | ||
829 | return dent; | |
830 | } | |
831 | ||
832 | /** | |
833 | * fat_itr_next() - step to the next entry in a directory | |
834 | * | |
835 | * Must be called once on a new iterator before the cursor is valid. | |
836 | * | |
837 | * @itr: the iterator to iterate | |
838 | * @return boolean, 1 if success or 0 if no more entries in the | |
839 | * current directory | |
840 | */ | |
841 | static int fat_itr_next(fat_itr *itr) | |
842 | { | |
843 | dir_entry *dent; | |
844 | ||
845 | itr->name = NULL; | |
846 | ||
847 | while (1) { | |
848 | dent = next_dent(itr); | |
849 | if (!dent) | |
850 | return 0; | |
851 | ||
852 | if (dent->name[0] == DELETED_FLAG || | |
853 | dent->name[0] == aRING) | |
854 | continue; | |
855 | ||
856 | if (dent->attr & ATTR_VOLUME) { | |
8bad6cb1 | 857 | if ((dent->attr & ATTR_VFAT) == ATTR_VFAT && |
c6e3baa5 RC |
858 | (dent->name[0] & LAST_LONG_ENTRY_MASK)) { |
859 | dent = extract_vfat_name(itr); | |
860 | if (!dent) | |
861 | continue; | |
862 | itr->name = itr->l_name; | |
863 | break; | |
864 | } else { | |
865 | /* Volume label or VFAT entry, skip */ | |
866 | continue; | |
867 | } | |
868 | } | |
869 | ||
870 | break; | |
871 | } | |
872 | ||
873 | get_name(dent, itr->s_name); | |
874 | if (!itr->name) | |
875 | itr->name = itr->s_name; | |
876 | ||
877 | return 1; | |
878 | } | |
879 | ||
880 | /** | |
881 | * fat_itr_isdir() - is current cursor position pointing to a directory | |
882 | * | |
883 | * @itr: the iterator | |
884 | * @return true if cursor is at a directory | |
885 | */ | |
886 | static int fat_itr_isdir(fat_itr *itr) | |
887 | { | |
888 | return !!(itr->dent->attr & ATTR_DIR); | |
889 | } | |
890 | ||
891 | /* | |
892 | * Helpers: | |
893 | */ | |
894 | ||
895 | #define TYPE_FILE 0x1 | |
896 | #define TYPE_DIR 0x2 | |
897 | #define TYPE_ANY (TYPE_FILE | TYPE_DIR) | |
898 | ||
899 | /** | |
900 | * fat_itr_resolve() - traverse directory structure to resolve the | |
901 | * requested path. | |
902 | * | |
903 | * Traverse directory structure to the requested path. If the specified | |
904 | * path is to a directory, this will descend into the directory and | |
905 | * leave it iterator at the start of the directory. If the path is to a | |
906 | * file, it will leave the iterator in the parent directory with current | |
907 | * cursor at file's entry in the directory. | |
908 | * | |
909 | * @itr: iterator initialized to root | |
910 | * @path: the requested path | |
911 | * @type: bitmask of allowable file types | |
912 | * @return 0 on success or -errno | |
913 | */ | |
914 | static int fat_itr_resolve(fat_itr *itr, const char *path, unsigned type) | |
915 | { | |
916 | const char *next; | |
917 | ||
918 | /* chomp any extra leading slashes: */ | |
919 | while (path[0] && ISDIRDELIM(path[0])) | |
920 | path++; | |
921 | ||
922 | /* are we at the end? */ | |
923 | if (strlen(path) == 0) { | |
924 | if (!(type & TYPE_DIR)) | |
925 | return -ENOENT; | |
926 | return 0; | |
927 | } | |
928 | ||
929 | /* find length of next path entry: */ | |
930 | next = path; | |
931 | while (next[0] && !ISDIRDELIM(next[0])) | |
932 | next++; | |
933 | ||
b94b6be5 AT |
934 | if (itr->is_root) { |
935 | /* root dir doesn't have "." nor ".." */ | |
936 | if ((((next - path) == 1) && !strncmp(path, ".", 1)) || | |
937 | (((next - path) == 2) && !strncmp(path, "..", 2))) { | |
938 | /* point back to itself */ | |
939 | itr->clust = itr->fsdata->root_cluster; | |
940 | itr->dent = NULL; | |
941 | itr->remaining = 0; | |
942 | itr->last_cluster = 0; | |
943 | ||
944 | if (next[0] == 0) { | |
945 | if (type & TYPE_DIR) | |
946 | return 0; | |
947 | else | |
948 | return -ENOENT; | |
949 | } | |
950 | ||
951 | return fat_itr_resolve(itr, next, type); | |
952 | } | |
953 | } | |
954 | ||
c6e3baa5 RC |
955 | while (fat_itr_next(itr)) { |
956 | int match = 0; | |
957 | unsigned n = max(strlen(itr->name), (size_t)(next - path)); | |
958 | ||
959 | /* check both long and short name: */ | |
960 | if (!strncasecmp(path, itr->name, n)) | |
961 | match = 1; | |
962 | else if (itr->name != itr->s_name && | |
963 | !strncasecmp(path, itr->s_name, n)) | |
964 | match = 1; | |
965 | ||
966 | if (!match) | |
967 | continue; | |
968 | ||
969 | if (fat_itr_isdir(itr)) { | |
970 | /* recurse into directory: */ | |
971 | fat_itr_child(itr, itr); | |
972 | return fat_itr_resolve(itr, next, type); | |
973 | } else if (next[0]) { | |
974 | /* | |
975 | * If next is not empty then we have a case | |
976 | * like: /path/to/realfile/nonsense | |
977 | */ | |
978 | debug("bad trailing path: %s\n", next); | |
979 | return -ENOENT; | |
980 | } else if (!(type & TYPE_FILE)) { | |
981 | return -ENOTDIR; | |
982 | } else { | |
983 | return 0; | |
984 | } | |
985 | } | |
986 | ||
987 | return -ENOENT; | |
988 | } | |
989 | ||
9795e07b | 990 | int file_fat_detectfs(void) |
71f95118 | 991 | { |
7385c28e WD |
992 | boot_sector bs; |
993 | volume_info volinfo; | |
994 | int fatsize; | |
995 | char vol_label[12]; | |
71f95118 | 996 | |
7385c28e | 997 | if (cur_dev == NULL) { |
7205e407 WD |
998 | printf("No current device\n"); |
999 | return 1; | |
1000 | } | |
7385c28e | 1001 | |
fc843a02 | 1002 | #if defined(CONFIG_IDE) || \ |
10e40d54 | 1003 | defined(CONFIG_SATA) || \ |
c649e3c9 | 1004 | defined(CONFIG_SCSI) || \ |
dd60d122 | 1005 | defined(CONFIG_CMD_USB) || \ |
21f6f963 | 1006 | defined(CONFIG_MMC) |
7205e407 | 1007 | printf("Interface: "); |
7385c28e WD |
1008 | switch (cur_dev->if_type) { |
1009 | case IF_TYPE_IDE: | |
1010 | printf("IDE"); | |
1011 | break; | |
1012 | case IF_TYPE_SATA: | |
1013 | printf("SATA"); | |
1014 | break; | |
1015 | case IF_TYPE_SCSI: | |
1016 | printf("SCSI"); | |
1017 | break; | |
1018 | case IF_TYPE_ATAPI: | |
1019 | printf("ATAPI"); | |
1020 | break; | |
1021 | case IF_TYPE_USB: | |
1022 | printf("USB"); | |
1023 | break; | |
1024 | case IF_TYPE_DOC: | |
1025 | printf("DOC"); | |
1026 | break; | |
1027 | case IF_TYPE_MMC: | |
1028 | printf("MMC"); | |
1029 | break; | |
1030 | default: | |
1031 | printf("Unknown"); | |
7205e407 | 1032 | } |
7385c28e | 1033 | |
bcce53d0 | 1034 | printf("\n Device %d: ", cur_dev->devnum); |
7205e407 WD |
1035 | dev_print(cur_dev); |
1036 | #endif | |
7385c28e WD |
1037 | |
1038 | if (read_bootsectandvi(&bs, &volinfo, &fatsize)) { | |
7205e407 WD |
1039 | printf("\nNo valid FAT fs found\n"); |
1040 | return 1; | |
1041 | } | |
7385c28e WD |
1042 | |
1043 | memcpy(vol_label, volinfo.volume_label, 11); | |
7205e407 | 1044 | vol_label[11] = '\0'; |
7385c28e WD |
1045 | volinfo.fs_type[5] = '\0'; |
1046 | ||
461f86e6 | 1047 | printf("Filesystem: %s \"%s\"\n", volinfo.fs_type, vol_label); |
7385c28e | 1048 | |
7205e407 | 1049 | return 0; |
71f95118 WD |
1050 | } |
1051 | ||
b7b5f319 SW |
1052 | int fat_exists(const char *filename) |
1053 | { | |
8eafae20 | 1054 | fsdata fsdata; |
2460098c | 1055 | fat_itr *itr; |
1ad0b98a | 1056 | int ret; |
1ad0b98a | 1057 | |
09fa964b | 1058 | itr = malloc_cache_aligned(sizeof(fat_itr)); |
af609e37 TT |
1059 | if (!itr) |
1060 | return 0; | |
8eafae20 RC |
1061 | ret = fat_itr_root(itr, &fsdata); |
1062 | if (ret) | |
af609e37 | 1063 | goto out; |
8eafae20 RC |
1064 | |
1065 | ret = fat_itr_resolve(itr, filename, TYPE_ANY); | |
725ffdb5 | 1066 | free(fsdata.fatbuf); |
af609e37 | 1067 | out: |
2460098c | 1068 | free(itr); |
1ad0b98a | 1069 | return ret == 0; |
b7b5f319 SW |
1070 | } |
1071 | ||
d455d878 | 1072 | int fat_size(const char *filename, loff_t *size) |
cf659819 | 1073 | { |
8eafae20 | 1074 | fsdata fsdata; |
2460098c | 1075 | fat_itr *itr; |
8eafae20 RC |
1076 | int ret; |
1077 | ||
09fa964b | 1078 | itr = malloc_cache_aligned(sizeof(fat_itr)); |
af609e37 TT |
1079 | if (!itr) |
1080 | return -ENOMEM; | |
8eafae20 RC |
1081 | ret = fat_itr_root(itr, &fsdata); |
1082 | if (ret) | |
af609e37 | 1083 | goto out_free_itr; |
8eafae20 RC |
1084 | |
1085 | ret = fat_itr_resolve(itr, filename, TYPE_FILE); | |
1086 | if (ret) { | |
1087 | /* | |
1088 | * Directories don't have size, but fs_size() is not | |
1089 | * expected to fail if passed a directory path: | |
1090 | */ | |
725ffdb5 | 1091 | free(fsdata.fatbuf); |
8eafae20 RC |
1092 | fat_itr_root(itr, &fsdata); |
1093 | if (!fat_itr_resolve(itr, filename, TYPE_DIR)) { | |
1094 | *size = 0; | |
725ffdb5 | 1095 | ret = 0; |
8eafae20 | 1096 | } |
af609e37 | 1097 | goto out_free_both; |
8eafae20 RC |
1098 | } |
1099 | ||
1100 | *size = FAT2CPU32(itr->dent->size); | |
af609e37 | 1101 | out_free_both: |
725ffdb5 | 1102 | free(fsdata.fatbuf); |
af609e37 | 1103 | out_free_itr: |
2460098c | 1104 | free(itr); |
725ffdb5 | 1105 | return ret; |
cf659819 SW |
1106 | } |
1107 | ||
1ad0b98a SR |
1108 | int file_fat_read_at(const char *filename, loff_t pos, void *buffer, |
1109 | loff_t maxsize, loff_t *actread) | |
71f95118 | 1110 | { |
8eafae20 | 1111 | fsdata fsdata; |
2460098c | 1112 | fat_itr *itr; |
8eafae20 RC |
1113 | int ret; |
1114 | ||
09fa964b | 1115 | itr = malloc_cache_aligned(sizeof(fat_itr)); |
af609e37 TT |
1116 | if (!itr) |
1117 | return -ENOMEM; | |
8eafae20 RC |
1118 | ret = fat_itr_root(itr, &fsdata); |
1119 | if (ret) | |
af609e37 | 1120 | goto out_free_itr; |
8eafae20 RC |
1121 | |
1122 | ret = fat_itr_resolve(itr, filename, TYPE_FILE); | |
1123 | if (ret) | |
af609e37 | 1124 | goto out_free_both; |
8eafae20 | 1125 | |
287c04e1 | 1126 | debug("reading %s at pos %llu\n", filename, pos); |
725ffdb5 RC |
1127 | ret = get_contents(&fsdata, itr->dent, pos, buffer, maxsize, actread); |
1128 | ||
af609e37 | 1129 | out_free_both: |
725ffdb5 | 1130 | free(fsdata.fatbuf); |
af609e37 | 1131 | out_free_itr: |
2460098c | 1132 | free(itr); |
725ffdb5 | 1133 | return ret; |
1170e634 BT |
1134 | } |
1135 | ||
1ad0b98a | 1136 | int file_fat_read(const char *filename, void *buffer, int maxsize) |
1170e634 | 1137 | { |
1ad0b98a SR |
1138 | loff_t actread; |
1139 | int ret; | |
1140 | ||
1141 | ret = file_fat_read_at(filename, 0, buffer, maxsize, &actread); | |
1142 | if (ret) | |
1143 | return ret; | |
1144 | else | |
1145 | return actread; | |
71f95118 | 1146 | } |
e6d52415 | 1147 | |
d455d878 SR |
1148 | int fat_read_file(const char *filename, void *buf, loff_t offset, loff_t len, |
1149 | loff_t *actread) | |
e6d52415 | 1150 | { |
1ad0b98a | 1151 | int ret; |
e6d52415 | 1152 | |
d455d878 SR |
1153 | ret = file_fat_read_at(filename, offset, buf, len, actread); |
1154 | if (ret) | |
e6d52415 | 1155 | printf("** Unable to read file %s **\n", filename); |
e6d52415 | 1156 | |
d455d878 | 1157 | return ret; |
e6d52415 SG |
1158 | } |
1159 | ||
1f40366b RC |
1160 | typedef struct { |
1161 | struct fs_dir_stream parent; | |
1162 | struct fs_dirent dirent; | |
1163 | fsdata fsdata; | |
1164 | fat_itr itr; | |
1165 | } fat_dir; | |
1166 | ||
1167 | int fat_opendir(const char *filename, struct fs_dir_stream **dirsp) | |
1168 | { | |
34dd853c | 1169 | fat_dir *dir; |
1f40366b RC |
1170 | int ret; |
1171 | ||
34dd853c | 1172 | dir = malloc_cache_aligned(sizeof(*dir)); |
1f40366b RC |
1173 | if (!dir) |
1174 | return -ENOMEM; | |
34dd853c | 1175 | memset(dir, 0, sizeof(*dir)); |
1f40366b RC |
1176 | |
1177 | ret = fat_itr_root(&dir->itr, &dir->fsdata); | |
1178 | if (ret) | |
af609e37 | 1179 | goto fail_free_dir; |
1f40366b RC |
1180 | |
1181 | ret = fat_itr_resolve(&dir->itr, filename, TYPE_DIR); | |
1182 | if (ret) | |
af609e37 | 1183 | goto fail_free_both; |
1f40366b RC |
1184 | |
1185 | *dirsp = (struct fs_dir_stream *)dir; | |
1186 | return 0; | |
1187 | ||
af609e37 | 1188 | fail_free_both: |
725ffdb5 | 1189 | free(dir->fsdata.fatbuf); |
af609e37 | 1190 | fail_free_dir: |
1f40366b RC |
1191 | free(dir); |
1192 | return ret; | |
1193 | } | |
1194 | ||
1195 | int fat_readdir(struct fs_dir_stream *dirs, struct fs_dirent **dentp) | |
1196 | { | |
1197 | fat_dir *dir = (fat_dir *)dirs; | |
1198 | struct fs_dirent *dent = &dir->dirent; | |
1199 | ||
1200 | if (!fat_itr_next(&dir->itr)) | |
1201 | return -ENOENT; | |
1202 | ||
1203 | memset(dent, 0, sizeof(*dent)); | |
1204 | strcpy(dent->name, dir->itr.name); | |
1205 | ||
1206 | if (fat_itr_isdir(&dir->itr)) { | |
1207 | dent->type = FS_DT_DIR; | |
1208 | } else { | |
1209 | dent->type = FS_DT_REG; | |
1210 | dent->size = FAT2CPU32(dir->itr.dent->size); | |
1211 | } | |
1212 | ||
1213 | *dentp = dent; | |
1214 | ||
1215 | return 0; | |
1216 | } | |
1217 | ||
1218 | void fat_closedir(struct fs_dir_stream *dirs) | |
1219 | { | |
1220 | fat_dir *dir = (fat_dir *)dirs; | |
725ffdb5 | 1221 | free(dir->fsdata.fatbuf); |
1f40366b RC |
1222 | free(dir); |
1223 | } | |
1224 | ||
e6d52415 SG |
1225 | void fat_close(void) |
1226 | { | |
1227 | } |