fs/fat/fat.c

   1 /*
   2  * fat.c
   3  *
   4  * R/O (V)FAT 12/16/32 filesystem implementation by Marcus Sundberg
   5  *
   6  * 2002-07-28 - rjones@nexus-tech.net - ported to ppcboot v1.1.6
   7  * 2003-03-10 - kharris@nexus-tech.net - ported to uboot
   8  *
   9  * See file CREDITS for list of people who contributed to this
  10  * project.
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License as
  14  * published by the Free Software Foundation; either version 2 of
  15  * the License, or (at your option) any later version.
  16  *
  17  * This program is distributed in the hope that it will be useful,
  18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20  * GNU General Public License for more details.
  21  *
  22  * You should have received a copy of the GNU General Public License
  23  * along with this program; if not, write to the Free Software
  24  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  25  * MA 02111-1307 USA
  26  */
  27
  28 #include <common.h>
  29 #include <config.h>
  30 #include <part.h>
  31 #include <fat.h>
  32 #include <asm/byteorder.h>
  33
  34 #ifdef CFG_CMD_FAT
  35
  36 /*
  37  * Convert a string to lowercase.
  38  */
  39 static void
  40 downcase(char *str)
  41 {
  42         while (*str != '\0') {
  43                 TOLOWER(*str);
  44                 str++;
  45         }
  46 }
  47
  48 static  block_dev_desc_t *cur_dev = NULL;
  49 static unsigned long part_offset = 0;
  50 static int cur_part = 1;
  51
  52 #define DOS_PART_TBL_OFFSET     0x1be
  53 #define DOS_PART_MAGIC_OFFSET   0x1fe
  54 #define DOS_FS_TYPE_OFFSET      0x52
  55
  56 int strncmp(const char * cs,const char * ct,size_t count)
  57 {
  58         register signed char __res = 0;
  59
  60         while (count) {
  61                 if ((__res = *cs - *ct++) != 0 || !*cs++)
  62                         break;
  63                 count--;
  64         }
  65
  66         return __res;
  67 }
  68
  69 char * strcpy(char * dest,const char *src)
  70 {
  71         char *tmp = dest;
  72
  73         while ((*dest++ = *src++) != '\0')
  74                 /* nothing */;
  75         return tmp;
  76 }
  77
  78 int strcmp(const char * cs,const char * ct)
  79 {
  80         register signed char __res;
  81
  82         while (1) {
  83                 if ((__res = *cs - *ct++) != 0 || !*cs++)
  84                         break;
  85         }
  86
  87         return __res;
  88 }
  89 void * memcpy(void * dest,const void *src,size_t count)
  90 {
  91         char *tmp = (char *) dest, *s = (char *) src;
  92
  93         while (count--)
  94                 *tmp++ = *s++;
  95
  96         return dest;
  97 }
  98
  99
 100 int disk_read (__u32 startblock, __u32 getsize, __u8 * bufptr)
 101 {
 102         startblock += part_offset;
 103         if (cur_dev == NULL)
 104                 return -1;
 105         if (cur_dev->block_read) {
 106                 return cur_dev->block_read (cur_dev->dev, startblock, getsize, (unsigned long *)bufptr);
 107         }
 108         return -1;
 109 }
 110
 111
 112 int
 113 fat_register_device(block_dev_desc_t *dev_desc, int part_no)
 114 {
 115         unsigned char buffer[SECTOR_SIZE];
 116
 117         if (!dev_desc->block_read)
 118                 return -1;
 119         cur_dev=dev_desc;
 120         /* check if we have a MBR (on floppies we have only a PBR) */
 121         if (dev_desc->block_read (dev_desc->dev, 0, 1, (ulong *) buffer) != 1) {
 122                 printf ("** Can't read from device %d **\n", dev_desc->dev);
 123                 return -1;
 124         }
 125         if (buffer[DOS_PART_MAGIC_OFFSET] != 0x55 ||
 126                 buffer[DOS_PART_MAGIC_OFFSET + 1] != 0xaa) {
 127                 /* no signature found */
 128                 return -1;
 129         }
 130         if(!strncmp((char *)&buffer[DOS_FS_TYPE_OFFSET],"FAT",3)) {
 131                 /* ok, we assume we are on a PBR only */
 132                 cur_part = 1;
 133                 part_offset=0;
 134         }
 135         else {
 136 #if (CONFIG_COMMANDS & CFG_CMD_IDE) || (CONFIG_COMMANDS & CFG_CMD_SCSI) || \
 137     (CONFIG_COMMANDS & CFG_CMD_USB) || (CONFIG_COMMANDS & CFG_CMD_MMC) || defined(CONFIG_SYSTEMACE)
 138                 disk_partition_t info;
 139                 if(!get_partition_info(dev_desc, part_no, &info)) {
 140                         part_offset = info.start;
 141                         cur_part = part_no;
 142                 }
 143                 else {
 144                         printf ("** Partition %d not valid on device %d **\n",part_no,dev_desc->dev);
 145                         return -1;
 146                 }
 147 #else
 148                 part_offset = buffer[DOS_PART_TBL_OFFSET+8]      |
 149                               buffer[DOS_PART_TBL_OFFSET+9] <<8  |
 150                               buffer[DOS_PART_TBL_OFFSET+10]<<16 |
 151                               buffer[DOS_PART_TBL_OFFSET+11]<<24;
 152
 153                 cur_part = 1;
 154 #endif
 155         }
 156         return 0;
 157 }
 158
 159
 160 /*
 161  * Get the first occurence of a directory delimiter ('/' or '\') in a string.
 162  * Return index into string if found, -1 otherwise.
 163  */
 164 static int
 165 dirdelim(char *str)
 166 {
 167         char *start = str;
 168
 169         while (*str != '\0') {
 170                 if (ISDIRDELIM(*str)) return str - start;
 171                 str++;
 172         }
 173         return -1;
 174 }
 175
 176
 177 /*
 178  * Match volume_info fs_type strings.
 179  * Return 0 on match, -1 otherwise.
 180  */
 181 static int
 182 compare_sign(char *str1, char *str2)
 183 {
 184         char *end = str1+SIGNLEN;
 185
 186         while (str1 != end) {
 187                 if (*str1 != *str2) {
 188                         return -1;
 189                 }
 190                 str1++;
 191                 str2++;
 192         }
 193
 194         return 0;
 195 }
 196
 197
 198 /*
 199  * Extract zero terminated short name from a directory entry.
 200  */
 201 static void get_name (dir_entry *dirent, char *s_name)
 202 {
 203         char *ptr;
 204
 205         memcpy (s_name, dirent->name, 8);
 206         s_name[8] = '\0';
 207         ptr = s_name;
 208         while (*ptr && *ptr != ' ')
 209                 ptr++;
 210         if (dirent->ext[0] && dirent->ext[0] != ' ') {
 211                 *ptr = '.';
 212                 ptr++;
 213                 memcpy (ptr, dirent->ext, 3);
 214                 ptr[3] = '\0';
 215                 while (*ptr && *ptr != ' ')
 216                         ptr++;
 217         }
 218         *ptr = '\0';
 219         if (*s_name == DELETED_FLAG)
 220                 *s_name = '\0';
 221         else if (*s_name == aRING)
 222                 *s_name = 'å';
 223         downcase (s_name);
 224 }
 225
 226 /*
 227  * Get the entry at index 'entry' in a FAT (12/16/32) table.
 228  * On failure 0x00 is returned.
 229  */
 230 static __u32
 231 get_fatent(fsdata *mydata, __u32 entry)
 232 {
 233         __u32 bufnum;
 234         __u32 offset;
 235         __u32 ret = 0x00;
 236
 237         switch (mydata->fatsize) {
 238         case 32:
 239                 bufnum = entry / FAT32BUFSIZE;
 240                 offset = entry - bufnum * FAT32BUFSIZE;
 241                 break;
 242         case 16:
 243                 bufnum = entry / FAT16BUFSIZE;
 244                 offset = entry - bufnum * FAT16BUFSIZE;
 245                 break;
 246         case 12:
 247                 bufnum = entry / FAT12BUFSIZE;
 248                 offset = entry - bufnum * FAT12BUFSIZE;
 249                 break;
 250
 251         default:
 252                 /* Unsupported FAT size */
 253                 return ret;
 254         }
 255         /* Read a new block of FAT entries into the cache. */
 256         if (bufnum != mydata->fatbufnum) {
 257                 int getsize = FATBUFSIZE/FS_BLOCK_SIZE;
 258                 __u8 *bufptr = mydata->fatbuf;
 259                 __u32 fatlength = mydata->fatlength;
 260                 __u32 startblock = bufnum * FATBUFBLOCKS;
 261                 unsigned long i;
 262
 263                 fatlength *= SECTOR_SIZE;       /* We want it in bytes now */
 264                 startblock += mydata->fat_sect; /* Offset from start of disk */
 265
 266                 if (getsize > fatlength) getsize = fatlength;
 267                 if (disk_read(startblock, getsize, bufptr) < 0) {
 268                         FAT_DPRINT("Error reading FAT blocks\n");
 269                         return ret;
 270                 }
 271                 mydata->fatbufnum = bufnum;
 272         }
 273
 274         /* Get the actual entry from the table */
 275         switch (mydata->fatsize) {
 276         case 32:
 277                 ret = FAT2CPU32(((__u32*)mydata->fatbuf)[offset]);
 278                 break;
 279         case 16:
 280                 ret = FAT2CPU16(((__u16*)mydata->fatbuf)[offset]);
 281                 break;
 282         case 12: {
 283                 __u32 off16 = (offset*3)/4;
 284                 __u16 val1, val2;
 285
 286                 switch (offset & 0x3) {
 287                 case 0:
 288                         ret = FAT2CPU16(((__u16*)mydata->fatbuf)[off16]);
 289                         ret &= 0xfff;
 290                         break;
 291                 case 1:
 292                         val1 = FAT2CPU16(((__u16*)mydata->fatbuf)[off16]);
 293                         val1 &= 0xf000;
 294                         val2 = FAT2CPU16(((__u16*)mydata->fatbuf)[off16+1]);
 295                         val2 &= 0x00ff;
 296                         ret = (val2 << 4) | (val1 >> 12);
 297                         break;
 298                 case 2:
 299                         val1 = FAT2CPU16(((__u16*)mydata->fatbuf)[off16]);
 300                         val1 &= 0xff00;
 301                         val2 = FAT2CPU16(((__u16*)mydata->fatbuf)[off16+1]);
 302                         val2 &= 0x000f;
 303                         ret = (val2 << 8) | (val1 >> 8);
 304                         break;
 305                 case 3:
 306                         ret = FAT2CPU16(((__u16*)mydata->fatbuf)[off16]);;
 307                         ret = (ret & 0xfff0) >> 4;
 308                         break;
 309                 default:
 310                         break;
 311                 }
 312         }
 313         break;
 314         }
 315         FAT_DPRINT("ret: %d, offset: %d\n", ret, offset);
 316
 317         return ret;
 318 }
 319
 320
 321 /*
 322  * Read at most 'size' bytes from the specified cluster into 'buffer'.
 323  * Return 0 on success, -1 otherwise.
 324  */
 325 static int
 326 get_cluster(fsdata *mydata, __u32 clustnum, __u8 *buffer, unsigned long size)
 327 {
 328         int idx = 0;
 329         __u32 startsect;
 330
 331         if (clustnum > 0) {
 332                 startsect = mydata->data_begin + clustnum*mydata->clust_size;
 333         } else {
 334                 startsect = mydata->rootdir_sect;
 335         }
 336
 337         if (disk_read(startsect, size/FS_BLOCK_SIZE , buffer) < 0) {
 338                 FAT_DPRINT("Error reading data\n");
 339                 return -1;
 340         }
 341         if(size % FS_BLOCK_SIZE) {
 342                 __u8 tmpbuf[FS_BLOCK_SIZE];
 343                 idx= size/FS_BLOCK_SIZE;
 344                 if (disk_read(startsect + idx, 1, tmpbuf) < 0) {
 345                         FAT_DPRINT("Error reading data\n");
 346                         return -1;
 347                 }
 348                 buffer += idx*FS_BLOCK_SIZE;
 349
 350                 memcpy(buffer, tmpbuf, size % FS_BLOCK_SIZE);
 351                 return 0;
 352         }
 353
 354         return 0;
 355 }
 356
 357
 358 /*
 359  * Read at most 'maxsize' bytes from the file associated with 'dentptr'
 360  * into 'buffer'.
 361  * Return the number of bytes read or -1 on fatal errors.
 362  */
 363 static long
 364 get_contents(fsdata *mydata, dir_entry *dentptr, __u8 *buffer,
 365              unsigned long maxsize)
 366 {
 367         unsigned long filesize = FAT2CPU32(dentptr->size), gotsize = 0;
 368         unsigned int bytesperclust = mydata->clust_size * SECTOR_SIZE;
 369         __u32 curclust = START(dentptr);
 370         __u32 endclust, newclust;
 371         unsigned long actsize;
 372
 373         FAT_DPRINT("Filesize: %ld bytes\n", filesize);
 374
 375         if (maxsize > 0 && filesize > maxsize) filesize = maxsize;
 376
 377         FAT_DPRINT("Reading: %ld bytes\n", filesize);
 378
 379         actsize=bytesperclust;
 380         endclust=curclust;
 381         do {
 382                 /* search for consecutive clusters */
 383                 while(actsize < filesize) {
 384                         newclust = get_fatent(mydata, endclust);
 385                         if((newclust -1)!=endclust)
 386                                 goto getit;
 387                         if (newclust <= 0x0001 || newclust >= 0xfffff0) {
 388                                 FAT_DPRINT("curclust: 0x%x\n", newclust);
 389                                 FAT_DPRINT("Invalid FAT entry\n");
 390                                 return gotsize;
 391                         }
 392                         endclust=newclust;
 393                         actsize+= bytesperclust;
 394                 }
 395                 /* actsize >= file size */
 396                 actsize -= bytesperclust;
 397                 /* get remaining clusters */
 398                 if (get_cluster(mydata, curclust, buffer, (int)actsize) != 0) {
 399                         FAT_ERROR("Error reading cluster\n");
 400                         return -1;
 401                 }
 402                 /* get remaining bytes */
 403                 gotsize += (int)actsize;
 404                 filesize -= actsize;
 405                 buffer += actsize;
 406                 actsize= filesize;
 407                 if (get_cluster(mydata, endclust, buffer, (int)actsize) != 0) {
 408                         FAT_ERROR("Error reading cluster\n");
 409                         return -1;
 410                 }
 411                 gotsize+=actsize;
 412                 return gotsize;
 413 getit:
 414                 if (get_cluster(mydata, curclust, buffer, (int)actsize) != 0) {
 415                         FAT_ERROR("Error reading cluster\n");
 416                         return -1;
 417                 }
 418                 gotsize += (int)actsize;
 419                 filesize -= actsize;
 420                 buffer += actsize;
 421                 curclust = get_fatent(mydata, endclust);
 422                 if (curclust <= 0x0001 || curclust >= 0xfffff0) {
 423                         FAT_DPRINT("curclust: 0x%x\n", curclust);
 424                         FAT_ERROR("Invalid FAT entry\n");
 425                         return gotsize;
 426                 }
 427                 actsize=bytesperclust;
 428                 endclust=curclust;
 429         } while (1);
 430 }
 431
 432
 433 #ifdef CONFIG_SUPPORT_VFAT
 434 /*
 435  * Extract the file name information from 'slotptr' into 'l_name',
 436  * starting at l_name[*idx].
 437  * Return 1 if terminator (zero byte) is found, 0 otherwise.
 438  */
 439 static int
 440 slot2str(dir_slot *slotptr, char *l_name, int *idx)
 441 {
 442         int j;
 443
 444         for (j = 0; j <= 8; j += 2) {
 445                 l_name[*idx] = slotptr->name0_4[j];
 446                 if (l_name[*idx] == 0x00) return 1;
 447                 (*idx)++;
 448         }
 449         for (j = 0; j <= 10; j += 2) {
 450                 l_name[*idx] = slotptr->name5_10[j];
 451                 if (l_name[*idx] == 0x00) return 1;
 452                 (*idx)++;
 453         }
 454         for (j = 0; j <= 2; j += 2) {
 455                 l_name[*idx] = slotptr->name11_12[j];
 456                 if (l_name[*idx] == 0x00) return 1;
 457                 (*idx)++;
 458         }
 459
 460         return 0;
 461 }
 462
 463 /* Calculate short name checksum */
 464 static __u8
 465 mkcksum(const char *str)
 466 {
 467         int i;
 468         __u8 ret = 0;
 469
 470         for (i = 0; i < 11; i++) {
 471                 ret = (((ret&1)<<7)|((ret&0xfe)>>1)) + str[i];
 472         }
 473
 474         return ret;
 475 }
 476 #endif
 477
 478
 479 /*
 480  * Get the directory entry associated with 'filename' from the directory
 481  * starting at 'startsect'
 482  */
 483
 484
 485 static dir_entry *get_dentfromdir (fsdata * mydata, int startsect,
 486                                    char *filename, dir_entry * retdent,
 487                                    int dols)
 488 {
 489
 490 }
 491
 492 #if 0
 493 __u8 get_dentfromdir_block[MAX_CLUSTSIZE];
 494 static dir_entry *get_dentfromdir (fsdata * mydata, int startsect,
 495                                    char *filename, dir_entry * retdent,
 496                                    int dols)
 497 {
 498     __u16 prevcksum = 0xffff;
 499     __u32 curclust = START (retdent);
 500     int files = 0, dirs = 0;
 501
 502     while (1) {
 503         dir_entry *dentptr;
 504         int i;
 505
 506         if (get_cluster (mydata, curclust, get_dentfromdir_block,
 507                  mydata->clust_size * SECTOR_SIZE) != 0) {
 508             FAT_DPRINT ("Error: reading directory block\n");
 509             return NULL;
 510         }
 511         dentptr = (dir_entry *) get_dentfromdir_block;
 512         for (i = 0; i < DIRENTSPERCLUST; i++) {
 513             char s_name[14], l_name[256];
 514
 515             l_name[0] = '\0';
 516             if (dentptr->name[0] == DELETED_FLAG) {
 517                     dentptr++;
 518                     continue;
 519             }
 520             if ((dentptr->attr & ATTR_VOLUME)) {
 521                     /* Volume label or VFAT entry */
 522                     dentptr++;
 523                     continue;
 524             }
 525             if (dentptr->name[0] == 0) {
 526                 if (dols) {
 527                     printf ("\n%d file(s), %d dir(s)\n\n", files, dirs);
 528                 }
 529                 FAT_DPRINT ("Dentname == NULL - %d\n", i);
 530                 return NULL;
 531             }
 532 #ifdef CONFIG_SUPPORT_VFAT
 533             if (dols && mkcksum (dentptr->name) == prevcksum) {
 534                 dentptr++;
 535                 continue;
 536             }
 537 #endif
 538             get_name (dentptr, s_name);
 539             if (dols) {
 540                 int isdir = (dentptr->attr & ATTR_DIR);
 541                 char dirc;
 542                 int doit = 0;
 543
 544                 if (isdir) {
 545                     dirs++;
 546                     dirc = '/';
 547                     doit = 1;
 548                 } else {
 549                     dirc = ' ';
 550                     if (s_name[0] != 0) {
 551                         files++;
 552                         doit = 1;
 553                     }
 554                 }
 555                 if (doit) {
 556                     if (dirc == ' ') {
 557                         printf (" %8ld   %s%c\n",
 558                                 (long) FAT2CPU32 (dentptr->size), s_name,
 559                                 dirc);
 560                     } else {
 561                         printf ("            %s%c\n", s_name, dirc);
 562                     }
 563                 }
 564                 dentptr++;
 565                 continue;
 566             }
 567             if (strcmp (filename, s_name) && strcmp (filename, l_name)) {
 568                 FAT_DPRINT ("Mismatch: |%s|%s|\n", s_name, l_name);
 569                 dentptr++;
 570                 continue;
 571             }
 572             memcpy (retdent, dentptr, sizeof (dir_entry));
 573
 574             FAT_DPRINT ("DentName: %s", s_name);
 575             FAT_DPRINT (", start: 0x%x", START (dentptr));
 576             FAT_DPRINT (", size:  0x%x %s\n",
 577                         FAT2CPU32 (dentptr->size),
 578                         (dentptr->attr & ATTR_DIR) ? "(DIR)" : "");
 579
 580             return retdent;
 581         }
 582         curclust = get_fatent (mydata, curclust);
 583         if (curclust <= 0x0001 || curclust >= 0xfffff0) {
 584             FAT_DPRINT ("curclust: 0x%x\n", curclust);
 585             FAT_ERROR ("Invalid FAT entry\n");
 586             return NULL;
 587         }
 588     }
 589
 590     return NULL;
 591 }
 592 #endif
 593
 594
 595 /*
 596  * Read boot sector and volume info from a FAT filesystem
 597  */
 598 static int
 599 read_bootsectandvi(boot_sector *bs, volume_info *volinfo, int *fatsize)
 600 {
 601         __u8 block[FS_BLOCK_SIZE];
 602         volume_info *vistart;
 603
 604         printf("Reading boot sector\n");
 605
 606         if (disk_read(0, 1, block) < 0) {
 607                 FAT_DPRINT("Error: reading block\n");
 608                 return -1;
 609         }
 610
 611         memcpy(bs, block, sizeof(boot_sector));
 612         bs->reserved    = FAT2CPU16(bs->reserved);
 613         bs->fat_length  = FAT2CPU16(bs->fat_length);
 614         bs->secs_track  = FAT2CPU16(bs->secs_track);
 615         bs->heads       = FAT2CPU16(bs->heads);
 616 #if 0 /* UNUSED */
 617         bs->hidden      = FAT2CPU32(bs->hidden);
 618 #endif
 619         bs->total_sect  = FAT2CPU32(bs->total_sect);
 620
 621         /* FAT32 entries */
 622         if (bs->fat_length == 0) {
 623                 /* Assume FAT32 */
 624                 bs->fat32_length = FAT2CPU32(bs->fat32_length);
 625                 bs->flags        = FAT2CPU16(bs->flags);
 626                 bs->root_cluster = FAT2CPU32(bs->root_cluster);
 627                 bs->info_sector  = FAT2CPU16(bs->info_sector);
 628                 bs->backup_boot  = FAT2CPU16(bs->backup_boot);
 629                 vistart = (volume_info*) (block + sizeof(boot_sector));
 630                 *fatsize = 32;
 631         } else {
 632                 vistart = (volume_info*) &(bs->fat32_length);
 633                 *fatsize = 0;
 634         }
 635         memcpy(volinfo, vistart, sizeof(volume_info));
 636
 637         /* Terminate fs_type string. Writing past the end of vistart
 638            is ok - it's just the buffer. */
 639         vistart->fs_type[8] = '\0';
 640
 641         if (*fatsize == 32) {
 642                 if (compare_sign(FAT32_SIGN, vistart->fs_type) == 0) {
 643                         return 0;
 644                 }
 645         } else {
 646                 if (compare_sign(FAT12_SIGN, vistart->fs_type) == 0) {
 647                         *fatsize = 12;
 648                         return 0;
 649                 }
 650                 if (compare_sign(FAT16_SIGN, vistart->fs_type) == 0) {
 651                         *fatsize = 16;
 652                         return 0;
 653                 }
 654         }
 655
 656         FAT_DPRINT("Error: broken fs_type sign\n");
 657         return -1;
 658 }
 659
 660 #if 0
 661 __u8 do_fat_read_block[MAX_CLUSTSIZE];  /* Block buffer */
 662 #endif
 663
 664 __u8 *fnamecopy = 0x80500000;
 665 __u8 *do_fat_read_block = 0x80500880;
 666
 667 boot_sector bs;
 668 volume_info volinfo;
 669 fsdata datablock;
 670
 671 long
 672 do_fat_read(const char *filename, void *buffer, unsigned long maxsize,
 673              int dols)
 674 {
 675 #if CONFIG_NIOS /* NIOS CPU cannot access big automatic arrays */
 676     static
 677 #endif
 678     fsdata *mydata = &datablock;
 679     dir_entry *dentptr;
 680     __u16 prevcksum = 0xffff;
 681     char *subname = "";
 682     int rootdir_size, cursect, curclus;
 683     int idx, isdir = 0;
 684     int files = 0, dirs = 0;
 685     long ret = 0;
 686     int firsttime;
 687
 688     if (read_bootsectandvi (&bs, &volinfo, &mydata->fatsize)) {
 689         printf ("Error: reading boot sector\n");
 690         return -1;
 691     }
 692     if (mydata->fatsize == 32) {
 693         mydata->fatlength = bs.fat32_length;
 694     } else {
 695         mydata->fatlength = bs.fat_length;
 696     }
 697     mydata->fat_sect = bs.reserved;
 698     cursect = mydata->rootdir_sect
 699             = mydata->fat_sect + mydata->fatlength * bs.fats;
 700     curclus = bs.root_cluster;   // For FAT32 only
 701     mydata->clust_size = bs.cluster_size;
 702     if (mydata->fatsize == 32) {
 703         rootdir_size = mydata->clust_size;
 704         mydata->data_begin = mydata->rootdir_sect   /* + rootdir_size */
 705                 - (mydata->clust_size * 2);
 706     } else {
 707         rootdir_size = ((bs.dir_entries[1] * (int) 256 + bs.dir_entries[0])
 708                         * sizeof (dir_entry)) / SECTOR_SIZE;
 709         mydata->data_begin = mydata->rootdir_sect + rootdir_size
 710                 - (mydata->clust_size * 2);
 711     }
 712     mydata->fatbufnum = -1;
 713
 714     FAT_DPRINT ("FAT%d, fatlength: %d\n", mydata->fatsize,
 715                 mydata->fatlength);
 716     FAT_DPRINT ("Rootdir begins at sector: %d, offset: %x, size: %d\n"
 717                 "Data begins at: %d\n",
 718                 mydata->rootdir_sect, mydata->rootdir_sect * SECTOR_SIZE,
 719                 rootdir_size, mydata->data_begin);
 720     FAT_DPRINT ("Cluster size: %d\n", mydata->clust_size);
 721
 722     /* "cwd" is always the root... */
 723     while (ISDIRDELIM (*filename))
 724         filename++;
 725     /* Make a copy of the filename and convert it to lowercase */
 726     strcpy (fnamecopy, filename);
 727     downcase (fnamecopy);
 728     if (*fnamecopy == '\0') {
 729         if (!dols){
 730                 printf("\n not there\n");
 731             return -1;
 732         }
 733         dols = LS_ROOT;
 734     } else if ((idx = dirdelim (fnamecopy)) >= 0) {
 735         isdir = 1;
 736         fnamecopy[idx] = '\0';
 737         subname = fnamecopy + idx + 1;
 738         /* Handle multiple delimiters */
 739         while (ISDIRDELIM (*subname))
 740             subname++;
 741     } else if (dols) {
 742         isdir = 1;
 743     }
 744
 745     while (1) {
 746         int i;
 747
 748         if (disk_read (cursect, mydata->clust_size, do_fat_read_block) < 0) {
 749             printf ("Error: reading rootdir block\n");
 750             return -1;
 751         }
 752         dentptr = (dir_entry *) do_fat_read_block;
 753         for (i = 0; i < DIRENTSPERBLOCK; i++) {
 754             char s_name[14], l_name[256];
 755
 756             l_name[0] = '\0';
 757             if ((dentptr->attr & ATTR_VOLUME)) {
 758                     /* Volume label or VFAT entry */
 759                     dentptr++;
 760                     continue;
 761             } else if (dentptr->name[0] == 0) {
 762                 FAT_DPRINT ("RootDentname == NULL - %d\n", i);
 763                 if (dols == LS_ROOT) {
 764                     printf ("\n%d file(s), %d dir(s)\n\n", files, dirs);
 765                     return 0;
 766                 }
 767                 return -1;
 768             }
 769 #ifdef CONFIG_SUPPORT_VFAT
 770             else if (dols == LS_ROOT
 771                      && mkcksum (dentptr->name) == prevcksum) {
 772                 dentptr++;
 773                 continue;
 774             }
 775 #endif
 776             get_name (dentptr, s_name);
 777             if (dols == LS_ROOT) {
 778                 int isdir = (dentptr->attr & ATTR_DIR);
 779                 char dirc;
 780                 int doit = 0;
 781
 782                 if (isdir) {
 783                     dirc = '/';
 784                     if (s_name[0] != 0) {
 785                         dirs++;
 786                         doit = 1;
 787                     }
 788                 } else {
 789                     dirc = ' ';
 790                     if (s_name[0] != 0) {
 791                         files++;
 792                         doit = 1;
 793                     }
 794                 }
 795                 if (doit) {
 796                     if (dirc == ' ') {
 797                         printf (" %8ld   %s%c\n",
 798                                 (long) FAT2CPU32 (dentptr->size), s_name,
 799                                 dirc);
 800                     } else {
 801                         printf ("            %s%c\n", s_name, dirc);
 802                     }
 803                 }
 804                 dentptr++;
 805                 continue;
 806             }
 807             if (strcmp (fnamecopy, s_name) && strcmp (fnamecopy, l_name)) {
 808                 FAT_DPRINT ("RootMismatch: |%s|%s|\n", s_name, l_name);
 809                 dentptr++;
 810                 continue;
 811             }
 812             if (isdir && !(dentptr->attr & ATTR_DIR))
 813                 return -1;
 814
 815             FAT_DPRINT ("RootName: %s", s_name);
 816             FAT_DPRINT (", start: 0x%x", START (dentptr));
 817             FAT_DPRINT (", size:  0x%x %s\n",
 818                         FAT2CPU32 (dentptr->size), isdir ? "(DIR)" : "");
 819
 820             goto rootdir_done;  /* We got a match */
 821         }
 822
 823         if (mydata->fatsize != 32)
 824            cursect++;
 825         else {
 826            // FAT32 does not guarantee contiguous root directory
 827            curclus = get_fatent (mydata, curclus);
 828            cursect = (curclus * mydata->clust_size) + mydata->data_begin;
 829
 830            FAT_DPRINT ("root clus %d sector %d\n", curclus, cursect);
 831         }
 832     }
 833   rootdir_done:
 834
 835     firsttime = 1;
 836     while (isdir) {
 837         int startsect = mydata->data_begin
 838                 + START (dentptr) * mydata->clust_size;
 839         dir_entry dent;
 840         char *nextname = NULL;
 841
 842         dent = *dentptr;
 843         dentptr = &dent;
 844         idx = dirdelim (subname);
 845         if (idx >= 0) {
 846             subname[idx] = '\0';
 847             nextname = subname + idx + 1;
 848             /* Handle multiple delimiters */
 849             while (ISDIRDELIM (*nextname))
 850                 nextname++;
 851             if (dols && *nextname == '\0')
 852                 firsttime = 0;
 853         } else {
 854             if (dols && firsttime) {
 855                 firsttime = 0;
 856             } else {
 857                 isdir = 0;
 858             }
 859         }
 860
 861         if (get_dentfromdir (mydata, startsect, subname, dentptr,
 862                              isdir ? 0 : dols) == NULL) {
 863             if (dols && !isdir)
 864                 return 0;
 865             return -1;
 866         }
 867
 868         if (idx >= 0) {
 869             if (!(dentptr->attr & ATTR_DIR))
 870                 return -1;
 871             subname = nextname;
 872         }
 873     }
 874     ret = get_contents (mydata, dentptr, buffer, maxsize);
 875     FAT_DPRINT ("Size: %d, got: %ld\n", FAT2CPU32 (dentptr->size), ret);
 876
 877     return ret;
 878 }
 879
 880
 881 int
 882 file_fat_detectfs(void)
 883 {
 884         boot_sector     bs;
 885         volume_info     volinfo;
 886         int             fatsize;
 887         char    vol_label[12];
 888
 889         if(cur_dev==NULL) {
 890                 printf("No current device\n");
 891                 return 1;
 892         }
 893 #if (CONFIG_COMMANDS & CFG_CMD_IDE) || (CONFIG_COMMANDS & CFG_CMD_SCSI) || \
 894     (CONFIG_COMMANDS & CFG_CMD_USB) || (CONFIG_MMC)
 895         printf("Interface:  ");
 896         switch(cur_dev->if_type) {
 897                 case IF_TYPE_IDE :      printf("IDE"); break;
 898                 case IF_TYPE_SCSI :     printf("SCSI"); break;
 899                 case IF_TYPE_ATAPI :    printf("ATAPI"); break;
 900                 case IF_TYPE_USB :      printf("USB"); break;
 901                 case IF_TYPE_DOC :      printf("DOC"); break;
 902                 case IF_TYPE_MMC :      printf("MMC"); break;
 903                 default :               printf("Unknown");
 904         }
 905         printf("\n  Device %d: ",cur_dev->dev);
 906         dev_print(cur_dev);
 907 #endif
 908         if(read_bootsectandvi(&bs, &volinfo, &fatsize)) {
 909                 printf("\nNo valid FAT fs found\n");
 910                 return 1;
 911         }
 912         memcpy (vol_label, volinfo.volume_label, 11);
 913         vol_label[11] = '\0';
 914         volinfo.fs_type[5]='\0';
 915         printf("Partition %d: Filesystem: %s \"%s\"\n",cur_part,volinfo.fs_type,vol_label);
 916         return 0;
 917 }
 918
 919
 920 int
 921 file_fat_ls(const char *dir)
 922 {
 923         return do_fat_read(dir, NULL, 0, LS_YES);
 924 }
 925
 926
 927 long
 928 file_fat_read(const char *filename, void *buffer, unsigned long maxsize)
 929 {
 930         long ret;
 931         ret = do_fat_read(filename, buffer, maxsize, LS_NO);
 932         return ret;
 933 }
 934
 935 #endif /* #if (CONFIG_COMMANDS & CFG_CMD_FAT) */