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