| /* |
| * fat.c |
| * |
| * R/O (V)FAT 12/16/32 filesystem implementation by Marcus Sundberg |
| * |
| * 2002-07-28 - rjones@nexus-tech.net - ported to ppcboot v1.1.6 |
| * 2003-03-10 - kharris@nexus-tech.net - ported to uboot |
| * |
| * See file CREDITS for list of people who contributed to this |
| * project. |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License as |
| * published by the Free Software Foundation; either version 2 of |
| * the License, or (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| * MA 02111-1307 USA |
| */ |
| |
| #include <common.h> |
| #include <config.h> |
| #include <exports.h> |
| #include <fat.h> |
| #include <asm/byteorder.h> |
| #include <part.h> |
| |
| /* |
| * Convert a string to lowercase. |
| */ |
| static void downcase (char *str) |
| { |
| while (*str != '\0') { |
| TOLOWER(*str); |
| str++; |
| } |
| } |
| |
| static block_dev_desc_t *cur_dev = NULL; |
| |
| static unsigned long part_offset = 0; |
| |
| static int cur_part = 1; |
| |
| #define DOS_PART_TBL_OFFSET 0x1be |
| #define DOS_PART_MAGIC_OFFSET 0x1fe |
| #define DOS_FS_TYPE_OFFSET 0x36 |
| #define DOS_FS32_TYPE_OFFSET 0x52 |
| |
| static int disk_read (__u32 startblock, __u32 getsize, __u8 * bufptr) |
| { |
| if (cur_dev == NULL) |
| return -1; |
| |
| startblock += part_offset; |
| |
| if (cur_dev->block_read) { |
| return cur_dev->block_read(cur_dev->dev, startblock, getsize, |
| (unsigned long *) bufptr); |
| } |
| return -1; |
| } |
| |
| int fat_register_device (block_dev_desc_t * dev_desc, int part_no) |
| { |
| unsigned char buffer[dev_desc->blksz]; |
| |
| if (!dev_desc->block_read) |
| return -1; |
| |
| cur_dev = dev_desc; |
| /* check if we have a MBR (on floppies we have only a PBR) */ |
| if (dev_desc->block_read(dev_desc->dev, 0, 1, (ulong *)buffer) != 1) { |
| printf("** Can't read from device %d **\n", |
| dev_desc->dev); |
| return -1; |
| } |
| if (buffer[DOS_PART_MAGIC_OFFSET] != 0x55 || |
| buffer[DOS_PART_MAGIC_OFFSET + 1] != 0xaa) { |
| /* no signature found */ |
| return -1; |
| } |
| #if (defined(CONFIG_CMD_IDE) || \ |
| defined(CONFIG_CMD_MG_DISK) || \ |
| defined(CONFIG_CMD_SATA) || \ |
| defined(CONFIG_CMD_SCSI) || \ |
| defined(CONFIG_CMD_USB) || \ |
| defined(CONFIG_MMC) || \ |
| defined(CONFIG_SYSTEMACE) ) |
| { |
| disk_partition_t info; |
| |
| /* First we assume there is a MBR */ |
| if (!get_partition_info(dev_desc, part_no, &info)) { |
| part_offset = info.start; |
| cur_part = part_no; |
| } else if ((strncmp((char *)&buffer[DOS_FS_TYPE_OFFSET], |
| "FAT", 3) == 0) || |
| (strncmp((char *)&buffer[DOS_FS32_TYPE_OFFSET], |
| "FAT32", 5) == 0)) { |
| /* ok, we assume we are on a PBR only */ |
| cur_part = 1; |
| part_offset = 0; |
| } else { |
| printf("** Partition %d not valid on device %d **\n", |
| part_no, dev_desc->dev); |
| return -1; |
| } |
| } |
| #else |
| if ((strncmp((char *)&buffer[DOS_FS_TYPE_OFFSET], "FAT", 3) == 0) || |
| (strncmp((char *)&buffer[DOS_FS32_TYPE_OFFSET], "FAT32", 5) == 0)) { |
| /* ok, we assume we are on a PBR only */ |
| cur_part = 1; |
| part_offset = 0; |
| } else { |
| /* FIXME we need to determine the start block of the |
| * partition where the DOS FS resides. This can be done |
| * by using the get_partition_info routine. For this |
| * purpose the libpart must be included. |
| */ |
| part_offset = 32; |
| cur_part = 1; |
| } |
| #endif |
| return 0; |
| } |
| |
| /* |
| * Get the first occurence of a directory delimiter ('/' or '\') in a string. |
| * Return index into string if found, -1 otherwise. |
| */ |
| static int dirdelim (char *str) |
| { |
| char *start = str; |
| |
| while (*str != '\0') { |
| if (ISDIRDELIM(*str)) |
| return str - start; |
| str++; |
| } |
| return -1; |
| } |
| |
| /* |
| * Extract zero terminated short name from a directory entry. |
| */ |
| static void get_name (dir_entry *dirent, char *s_name) |
| { |
| char *ptr; |
| |
| memcpy(s_name, dirent->name, 8); |
| s_name[8] = '\0'; |
| ptr = s_name; |
| while (*ptr && *ptr != ' ') |
| ptr++; |
| if (dirent->ext[0] && dirent->ext[0] != ' ') { |
| *ptr = '.'; |
| ptr++; |
| memcpy(ptr, dirent->ext, 3); |
| ptr[3] = '\0'; |
| while (*ptr && *ptr != ' ') |
| ptr++; |
| } |
| *ptr = '\0'; |
| if (*s_name == DELETED_FLAG) |
| *s_name = '\0'; |
| else if (*s_name == aRING) |
| *s_name = DELETED_FLAG; |
| downcase(s_name); |
| } |
| |
| /* |
| * Get the entry at index 'entry' in a FAT (12/16/32) table. |
| * On failure 0x00 is returned. |
| */ |
| static __u32 get_fatent (fsdata *mydata, __u32 entry) |
| { |
| __u32 bufnum; |
| __u32 off16, offset; |
| __u32 ret = 0x00; |
| __u16 val1, val2; |
| |
| switch (mydata->fatsize) { |
| case 32: |
| bufnum = entry / FAT32BUFSIZE; |
| offset = entry - bufnum * FAT32BUFSIZE; |
| break; |
| case 16: |
| bufnum = entry / FAT16BUFSIZE; |
| offset = entry - bufnum * FAT16BUFSIZE; |
| break; |
| case 12: |
| bufnum = entry / FAT12BUFSIZE; |
| offset = entry - bufnum * FAT12BUFSIZE; |
| break; |
| |
| default: |
| /* Unsupported FAT size */ |
| return ret; |
| } |
| |
| debug("FAT%d: entry: 0x%04x = %d, offset: 0x%04x = %d\n", |
| mydata->fatsize, entry, entry, offset, offset); |
| |
| /* Read a new block of FAT entries into the cache. */ |
| if (bufnum != mydata->fatbufnum) { |
| __u32 getsize = FATBUFBLOCKS; |
| __u8 *bufptr = mydata->fatbuf; |
| __u32 fatlength = mydata->fatlength; |
| __u32 startblock = bufnum * FATBUFBLOCKS; |
| |
| if (getsize > fatlength) |
| getsize = fatlength; |
| |
| fatlength *= mydata->sect_size; /* We want it in bytes now */ |
| startblock += mydata->fat_sect; /* Offset from start of disk */ |
| |
| if (disk_read(startblock, getsize, bufptr) < 0) { |
| debug("Error reading FAT blocks\n"); |
| return ret; |
| } |
| mydata->fatbufnum = bufnum; |
| } |
| |
| /* Get the actual entry from the table */ |
| switch (mydata->fatsize) { |
| case 32: |
| ret = FAT2CPU32(((__u32 *) mydata->fatbuf)[offset]); |
| break; |
| case 16: |
| ret = FAT2CPU16(((__u16 *) mydata->fatbuf)[offset]); |
| break; |
| case 12: |
| off16 = (offset * 3) / 4; |
| |
| switch (offset & 0x3) { |
| case 0: |
| ret = FAT2CPU16(((__u16 *) mydata->fatbuf)[off16]); |
| ret &= 0xfff; |
| break; |
| case 1: |
| val1 = FAT2CPU16(((__u16 *)mydata->fatbuf)[off16]); |
| val1 &= 0xf000; |
| val2 = FAT2CPU16(((__u16 *)mydata->fatbuf)[off16 + 1]); |
| val2 &= 0x00ff; |
| ret = (val2 << 4) | (val1 >> 12); |
| break; |
| case 2: |
| val1 = FAT2CPU16(((__u16 *)mydata->fatbuf)[off16]); |
| val1 &= 0xff00; |
| val2 = FAT2CPU16(((__u16 *)mydata->fatbuf)[off16 + 1]); |
| val2 &= 0x000f; |
| ret = (val2 << 8) | (val1 >> 8); |
| break; |
| case 3: |
| ret = FAT2CPU16(((__u16 *)mydata->fatbuf)[off16]); |
| ret = (ret & 0xfff0) >> 4; |
| break; |
| default: |
| break; |
| } |
| break; |
| } |
| debug("FAT%d: ret: %08x, offset: %04x\n", |
| mydata->fatsize, ret, offset); |
| |
| return ret; |
| } |
| |
| /* |
| * Read at most 'size' bytes from the specified cluster into 'buffer'. |
| * Return 0 on success, -1 otherwise. |
| */ |
| static int |
| get_cluster (fsdata *mydata, __u32 clustnum, __u8 *buffer, |
| unsigned long size) |
| { |
| __u32 idx = 0; |
| __u32 startsect; |
| |
| if (clustnum > 0) { |
| startsect = mydata->data_begin + |
| clustnum * mydata->clust_size; |
| } else { |
| startsect = mydata->rootdir_sect; |
| } |
| |
| debug("gc - clustnum: %d, startsect: %d\n", clustnum, startsect); |
| |
| if (disk_read(startsect, size / mydata->sect_size, buffer) < 0) { |
| debug("Error reading data\n"); |
| return -1; |
| } |
| if (size % mydata->sect_size) { |
| __u8 tmpbuf[mydata->sect_size]; |
| |
| idx = size / mydata->sect_size; |
| if (disk_read(startsect + idx, 1, tmpbuf) < 0) { |
| debug("Error reading data\n"); |
| return -1; |
| } |
| buffer += idx * mydata->sect_size; |
| |
| memcpy(buffer, tmpbuf, size % mydata->sect_size); |
| return 0; |
| } |
| |
| return 0; |
| } |
| |
| /* |
| * Read at most 'maxsize' bytes from the file associated with 'dentptr' |
| * into 'buffer'. |
| * Return the number of bytes read or -1 on fatal errors. |
| */ |
| static long |
| get_contents (fsdata *mydata, dir_entry *dentptr, __u8 *buffer, |
| unsigned long maxsize) |
| { |
| unsigned long filesize = FAT2CPU32(dentptr->size), gotsize = 0; |
| unsigned int bytesperclust = mydata->clust_size * mydata->sect_size; |
| __u32 curclust = START(dentptr); |
| __u32 endclust, newclust; |
| unsigned long actsize; |
| |
| debug("Filesize: %ld bytes\n", filesize); |
| |
| if (maxsize > 0 && filesize > maxsize) |
| filesize = maxsize; |
| |
| debug("%ld bytes\n", filesize); |
| |
| actsize = bytesperclust; |
| endclust = curclust; |
| |
| do { |
| /* search for consecutive clusters */ |
| while (actsize < filesize) { |
| newclust = get_fatent(mydata, endclust); |
| if ((newclust - 1) != endclust) |
| goto getit; |
| if (CHECK_CLUST(newclust, mydata->fatsize)) { |
| debug("curclust: 0x%x\n", newclust); |
| debug("Invalid FAT entry\n"); |
| return gotsize; |
| } |
| endclust = newclust; |
| actsize += bytesperclust; |
| } |
| |
| /* actsize >= file size */ |
| actsize -= bytesperclust; |
| |
| /* get remaining clusters */ |
| if (get_cluster(mydata, curclust, buffer, (int)actsize) != 0) { |
| printf("Error reading cluster\n"); |
| return -1; |
| } |
| |
| /* get remaining bytes */ |
| gotsize += (int)actsize; |
| filesize -= actsize; |
| buffer += actsize; |
| actsize = filesize; |
| if (get_cluster(mydata, endclust, buffer, (int)actsize) != 0) { |
| printf("Error reading cluster\n"); |
| return -1; |
| } |
| gotsize += actsize; |
| return gotsize; |
| getit: |
| if (get_cluster(mydata, curclust, buffer, (int)actsize) != 0) { |
| printf("Error reading cluster\n"); |
| return -1; |
| } |
| gotsize += (int)actsize; |
| filesize -= actsize; |
| buffer += actsize; |
| |
| curclust = get_fatent(mydata, endclust); |
| if (CHECK_CLUST(curclust, mydata->fatsize)) { |
| debug("curclust: 0x%x\n", curclust); |
| printf("Invalid FAT entry\n"); |
| return gotsize; |
| } |
| actsize = bytesperclust; |
| endclust = curclust; |
| } while (1); |
| } |
| |
| #ifdef CONFIG_SUPPORT_VFAT |
| /* |
| * Extract the file name information from 'slotptr' into 'l_name', |
| * starting at l_name[*idx]. |
| * Return 1 if terminator (zero byte) is found, 0 otherwise. |
| */ |
| static int slot2str (dir_slot *slotptr, char *l_name, int *idx) |
| { |
| int j; |
| |
| for (j = 0; j <= 8; j += 2) { |
| l_name[*idx] = slotptr->name0_4[j]; |
| if (l_name[*idx] == 0x00) |
| return 1; |
| (*idx)++; |
| } |
| for (j = 0; j <= 10; j += 2) { |
| l_name[*idx] = slotptr->name5_10[j]; |
| if (l_name[*idx] == 0x00) |
| return 1; |
| (*idx)++; |
| } |
| for (j = 0; j <= 2; j += 2) { |
| l_name[*idx] = slotptr->name11_12[j]; |
| if (l_name[*idx] == 0x00) |
| return 1; |
| (*idx)++; |
| } |
| |
| return 0; |
| } |
| |
| /* |
| * Extract the full long filename starting at 'retdent' (which is really |
| * a slot) into 'l_name'. If successful also copy the real directory entry |
| * into 'retdent' |
| * Return 0 on success, -1 otherwise. |
| */ |
| __attribute__ ((__aligned__ (__alignof__ (dir_entry)))) |
| __u8 get_vfatname_block[MAX_CLUSTSIZE]; |
| |
| static int |
| get_vfatname (fsdata *mydata, int curclust, __u8 *cluster, |
| dir_entry *retdent, char *l_name) |
| { |
| dir_entry *realdent; |
| dir_slot *slotptr = (dir_slot *)retdent; |
| __u8 *buflimit = cluster + mydata->sect_size * ((curclust == 0) ? |
| PREFETCH_BLOCKS : |
| mydata->clust_size); |
| __u8 counter = (slotptr->id & ~LAST_LONG_ENTRY_MASK) & 0xff; |
| int idx = 0; |
| |
| if (counter > VFAT_MAXSEQ) { |
| debug("Error: VFAT name is too long\n"); |
| return -1; |
| } |
| |
| while ((__u8 *)slotptr < buflimit) { |
| if (counter == 0) |
| break; |
| if (((slotptr->id & ~LAST_LONG_ENTRY_MASK) & 0xff) != counter) |
| return -1; |
| slotptr++; |
| counter--; |
| } |
| |
| if ((__u8 *)slotptr >= buflimit) { |
| dir_slot *slotptr2; |
| |
| if (curclust == 0) |
| return -1; |
| curclust = get_fatent(mydata, curclust); |
| if (CHECK_CLUST(curclust, mydata->fatsize)) { |
| debug("curclust: 0x%x\n", curclust); |
| printf("Invalid FAT entry\n"); |
| return -1; |
| } |
| |
| if (get_cluster(mydata, curclust, get_vfatname_block, |
| mydata->clust_size * mydata->sect_size) != 0) { |
| debug("Error: reading directory block\n"); |
| return -1; |
| } |
| |
| slotptr2 = (dir_slot *)get_vfatname_block; |
| while (counter > 0) { |
| if (((slotptr2->id & ~LAST_LONG_ENTRY_MASK) |
| & 0xff) != counter) |
| return -1; |
| slotptr2++; |
| counter--; |
| } |
| |
| /* Save the real directory entry */ |
| realdent = (dir_entry *)slotptr2; |
| while ((__u8 *)slotptr2 > get_vfatname_block) { |
| slotptr2--; |
| slot2str(slotptr2, l_name, &idx); |
| } |
| } else { |
| /* Save the real directory entry */ |
| realdent = (dir_entry *)slotptr; |
| } |
| |
| do { |
| slotptr--; |
| if (slot2str(slotptr, l_name, &idx)) |
| break; |
| } while (!(slotptr->id & LAST_LONG_ENTRY_MASK)); |
| |
| l_name[idx] = '\0'; |
| if (*l_name == DELETED_FLAG) |
| *l_name = '\0'; |
| else if (*l_name == aRING) |
| *l_name = DELETED_FLAG; |
| downcase(l_name); |
| |
| /* Return the real directory entry */ |
| memcpy(retdent, realdent, sizeof(dir_entry)); |
| |
| return 0; |
| } |
| |
| /* Calculate short name checksum */ |
| static __u8 mkcksum (const char *str) |
| { |
| int i; |
| |
| __u8 ret = 0; |
| |
| for (i = 0; i < 11; i++) { |
| ret = (((ret & 1) << 7) | ((ret & 0xfe) >> 1)) + str[i]; |
| } |
| |
| return ret; |
| } |
| #endif /* CONFIG_SUPPORT_VFAT */ |
| |
| /* |
| * Get the directory entry associated with 'filename' from the directory |
| * starting at 'startsect' |
| */ |
| __attribute__ ((__aligned__ (__alignof__ (dir_entry)))) |
| __u8 get_dentfromdir_block[MAX_CLUSTSIZE]; |
| |
| static dir_entry *get_dentfromdir (fsdata *mydata, int startsect, |
| char *filename, dir_entry *retdent, |
| int dols) |
| { |
| __u16 prevcksum = 0xffff; |
| __u32 curclust = START(retdent); |
| int files = 0, dirs = 0; |
| |
| debug("get_dentfromdir: %s\n", filename); |
| |
| while (1) { |
| dir_entry *dentptr; |
| |
| int i; |
| |
| if (get_cluster(mydata, curclust, get_dentfromdir_block, |
| mydata->clust_size * mydata->sect_size) != 0) { |
| debug("Error: reading directory block\n"); |
| return NULL; |
| } |
| |
| dentptr = (dir_entry *)get_dentfromdir_block; |
| |
| for (i = 0; i < DIRENTSPERCLUST; i++) { |
| char s_name[14], l_name[VFAT_MAXLEN_BYTES]; |
| |
| l_name[0] = '\0'; |
| if (dentptr->name[0] == DELETED_FLAG) { |
| dentptr++; |
| continue; |
| } |
| if ((dentptr->attr & ATTR_VOLUME)) { |
| #ifdef CONFIG_SUPPORT_VFAT |
| if ((dentptr->attr & ATTR_VFAT) == ATTR_VFAT && |
| (dentptr->name[0] & LAST_LONG_ENTRY_MASK)) { |
| prevcksum = ((dir_slot *)dentptr)->alias_checksum; |
| get_vfatname(mydata, curclust, |
| get_dentfromdir_block, |
| dentptr, l_name); |
| if (dols) { |
| int isdir; |
| char dirc; |
| int doit = 0; |
| |
| isdir = (dentptr->attr & ATTR_DIR); |
| |
| if (isdir) { |
| dirs++; |
| dirc = '/'; |
| doit = 1; |
| } else { |
| dirc = ' '; |
| if (l_name[0] != 0) { |
| files++; |
| doit = 1; |
| } |
| } |
| if (doit) { |
| if (dirc == ' ') { |
| printf(" %8ld %s%c\n", |
| (long)FAT2CPU32(dentptr->size), |
| l_name, |
| dirc); |
| } else { |
| printf(" %s%c\n", |
| l_name, |
| dirc); |
| } |
| } |
| dentptr++; |
| continue; |
| } |
| debug("vfatname: |%s|\n", l_name); |
| } else |
| #endif |
| { |
| /* Volume label or VFAT entry */ |
| dentptr++; |
| continue; |
| } |
| } |
| if (dentptr->name[0] == 0) { |
| if (dols) { |
| printf("\n%d file(s), %d dir(s)\n\n", |
| files, dirs); |
| } |
| debug("Dentname == NULL - %d\n", i); |
| return NULL; |
| } |
| #ifdef CONFIG_SUPPORT_VFAT |
| if (dols && mkcksum(dentptr->name) == prevcksum) { |
| dentptr++; |
| continue; |
| } |
| #endif |
| get_name(dentptr, s_name); |
| if (dols) { |
| int isdir = (dentptr->attr & ATTR_DIR); |
| char dirc; |
| int doit = 0; |
| |
| if (isdir) { |
| dirs++; |
| dirc = '/'; |
| doit = 1; |
| } else { |
| dirc = ' '; |
| if (s_name[0] != 0) { |
| files++; |
| doit = 1; |
| } |
| } |
| |
| if (doit) { |
| if (dirc == ' ') { |
| printf(" %8ld %s%c\n", |
| (long)FAT2CPU32(dentptr->size), |
| s_name, dirc); |
| } else { |
| printf(" %s%c\n", |
| s_name, dirc); |
| } |
| } |
| |
| dentptr++; |
| continue; |
| } |
| |
| if (strcmp(filename, s_name) |
| && strcmp(filename, l_name)) { |
| debug("Mismatch: |%s|%s|\n", s_name, l_name); |
| dentptr++; |
| continue; |
| } |
| |
| memcpy(retdent, dentptr, sizeof(dir_entry)); |
| |
| debug("DentName: %s", s_name); |
| debug(", start: 0x%x", START(dentptr)); |
| debug(", size: 0x%x %s\n", |
| FAT2CPU32(dentptr->size), |
| (dentptr->attr & ATTR_DIR) ? "(DIR)" : ""); |
| |
| return retdent; |
| } |
| |
| curclust = get_fatent(mydata, curclust); |
| if (CHECK_CLUST(curclust, mydata->fatsize)) { |
| debug("curclust: 0x%x\n", curclust); |
| printf("Invalid FAT entry\n"); |
| return NULL; |
| } |
| } |
| |
| return NULL; |
| } |
| |
| /* |
| * Read boot sector and volume info from a FAT filesystem |
| */ |
| static int |
| read_bootsectandvi (boot_sector *bs, volume_info *volinfo, int *fatsize) |
| { |
| __u8 *block; |
| volume_info *vistart; |
| int ret = 0; |
| |
| if (cur_dev == NULL) { |
| debug("Error: no device selected\n"); |
| return -1; |
| } |
| |
| block = malloc(cur_dev->blksz); |
| if (block == NULL) { |
| debug("Error: allocating block\n"); |
| return -1; |
| } |
| |
| if (disk_read (0, 1, block) < 0) { |
| debug("Error: reading block\n"); |
| goto fail; |
| } |
| |
| memcpy(bs, block, sizeof(boot_sector)); |
| bs->reserved = FAT2CPU16(bs->reserved); |
| bs->fat_length = FAT2CPU16(bs->fat_length); |
| bs->secs_track = FAT2CPU16(bs->secs_track); |
| bs->heads = FAT2CPU16(bs->heads); |
| bs->total_sect = FAT2CPU32(bs->total_sect); |
| |
| /* FAT32 entries */ |
| if (bs->fat_length == 0) { |
| /* Assume FAT32 */ |
| bs->fat32_length = FAT2CPU32(bs->fat32_length); |
| bs->flags = FAT2CPU16(bs->flags); |
| bs->root_cluster = FAT2CPU32(bs->root_cluster); |
| bs->info_sector = FAT2CPU16(bs->info_sector); |
| bs->backup_boot = FAT2CPU16(bs->backup_boot); |
| vistart = (volume_info *)(block + sizeof(boot_sector)); |
| *fatsize = 32; |
| } else { |
| vistart = (volume_info *)&(bs->fat32_length); |
| *fatsize = 0; |
| } |
| memcpy(volinfo, vistart, sizeof(volume_info)); |
| |
| if (*fatsize == 32) { |
| if (strncmp(FAT32_SIGN, vistart->fs_type, SIGNLEN) == 0) |
| goto exit; |
| } else { |
| if (strncmp(FAT12_SIGN, vistart->fs_type, SIGNLEN) == 0) { |
| *fatsize = 12; |
| goto exit; |
| } |
| if (strncmp(FAT16_SIGN, vistart->fs_type, SIGNLEN) == 0) { |
| *fatsize = 16; |
| goto exit; |
| } |
| } |
| |
| debug("Error: broken fs_type sign\n"); |
| fail: |
| ret = -1; |
| exit: |
| free(block); |
| return ret; |
| } |
| |
| __attribute__ ((__aligned__ (__alignof__ (dir_entry)))) |
| __u8 do_fat_read_block[MAX_CLUSTSIZE]; |
| |
| long |
| do_fat_read (const char *filename, void *buffer, unsigned long maxsize, |
| int dols) |
| { |
| char fnamecopy[2048]; |
| boot_sector bs; |
| volume_info volinfo; |
| fsdata datablock; |
| fsdata *mydata = &datablock; |
| dir_entry *dentptr; |
| __u16 prevcksum = 0xffff; |
| char *subname = ""; |
| __u32 cursect; |
| int idx, isdir = 0; |
| int files = 0, dirs = 0; |
| long ret = -1; |
| int firsttime; |
| __u32 root_cluster = 0; |
| int rootdir_size = 0; |
| int j; |
| |
| if (read_bootsectandvi(&bs, &volinfo, &mydata->fatsize)) { |
| debug("Error: reading boot sector\n"); |
| return -1; |
| } |
| |
| if (mydata->fatsize == 32) { |
| root_cluster = bs.root_cluster; |
| mydata->fatlength = bs.fat32_length; |
| } else { |
| mydata->fatlength = bs.fat_length; |
| } |
| |
| mydata->fat_sect = bs.reserved; |
| |
| cursect = mydata->rootdir_sect |
| = mydata->fat_sect + mydata->fatlength * bs.fats; |
| |
| mydata->sect_size = (bs.sector_size[1] << 8) + bs.sector_size[0]; |
| mydata->clust_size = bs.cluster_size; |
| |
| if (mydata->fatsize == 32) { |
| mydata->data_begin = mydata->rootdir_sect - |
| (mydata->clust_size * 2); |
| } else { |
| rootdir_size = ((bs.dir_entries[1] * (int)256 + |
| bs.dir_entries[0]) * |
| sizeof(dir_entry)) / |
| mydata->sect_size; |
| mydata->data_begin = mydata->rootdir_sect + |
| rootdir_size - |
| (mydata->clust_size * 2); |
| } |
| |
| mydata->fatbufnum = -1; |
| mydata->fatbuf = malloc(FATBUFSIZE); |
| if (mydata->fatbuf == NULL) { |
| debug("Error: allocating memory\n"); |
| return -1; |
| } |
| |
| #ifdef CONFIG_SUPPORT_VFAT |
| debug("VFAT Support enabled\n"); |
| #endif |
| debug("FAT%d, fat_sect: %d, fatlength: %d\n", |
| mydata->fatsize, mydata->fat_sect, mydata->fatlength); |
| debug("Rootdir begins at cluster: %d, sector: %d, offset: %x\n" |
| "Data begins at: %d\n", |
| root_cluster, |
| mydata->rootdir_sect, |
| mydata->rootdir_sect * mydata->sect_size, mydata->data_begin); |
| debug("Sector size: %d, cluster size: %d\n", mydata->sect_size, |
| mydata->clust_size); |
| |
| /* "cwd" is always the root... */ |
| while (ISDIRDELIM(*filename)) |
| filename++; |
| |
| /* Make a copy of the filename and convert it to lowercase */ |
| strcpy(fnamecopy, filename); |
| downcase(fnamecopy); |
| |
| if (*fnamecopy == '\0') { |
| if (!dols) |
| goto exit; |
| |
| dols = LS_ROOT; |
| } else if ((idx = dirdelim(fnamecopy)) >= 0) { |
| isdir = 1; |
| fnamecopy[idx] = '\0'; |
| subname = fnamecopy + idx + 1; |
| |
| /* Handle multiple delimiters */ |
| while (ISDIRDELIM(*subname)) |
| subname++; |
| } else if (dols) { |
| isdir = 1; |
| } |
| |
| j = 0; |
| while (1) { |
| int i; |
| |
| debug("FAT read sect=%d, clust_size=%d, DIRENTSPERBLOCK=%zd\n", |
| cursect, mydata->clust_size, DIRENTSPERBLOCK); |
| |
| if (disk_read(cursect, |
| (mydata->fatsize == 32) ? |
| (mydata->clust_size) : |
| PREFETCH_BLOCKS, |
| do_fat_read_block) < 0) { |
| debug("Error: reading rootdir block\n"); |
| goto exit; |
| } |
| |
| dentptr = (dir_entry *) do_fat_read_block; |
| |
| for (i = 0; i < DIRENTSPERBLOCK; i++) { |
| char s_name[14], l_name[VFAT_MAXLEN_BYTES]; |
| |
| l_name[0] = '\0'; |
| if (dentptr->name[0] == DELETED_FLAG) { |
| dentptr++; |
| continue; |
| } |
| if ((dentptr->attr & ATTR_VOLUME)) { |
| #ifdef CONFIG_SUPPORT_VFAT |
| if ((dentptr->attr & ATTR_VFAT) == ATTR_VFAT && |
| (dentptr->name[0] & LAST_LONG_ENTRY_MASK)) { |
| prevcksum = |
| ((dir_slot *)dentptr)->alias_checksum; |
| |
| get_vfatname(mydata, |
| root_cluster, |
| do_fat_read_block, |
| dentptr, l_name); |
| |
| if (dols == LS_ROOT) { |
| char dirc; |
| int doit = 0; |
| int isdir = |
| (dentptr->attr & ATTR_DIR); |
| |
| if (isdir) { |
| dirs++; |
| dirc = '/'; |
| doit = 1; |
| } else { |
| dirc = ' '; |
| if (l_name[0] != 0) { |
| files++; |
| doit = 1; |
| } |
| } |
| if (doit) { |
| if (dirc == ' ') { |
| printf(" %8ld %s%c\n", |
| (long)FAT2CPU32(dentptr->size), |
| l_name, |
| dirc); |
| } else { |
| printf(" %s%c\n", |
| l_name, |
| dirc); |
| } |
| } |
| dentptr++; |
| continue; |
| } |
| debug("Rootvfatname: |%s|\n", |
| l_name); |
| } else |
| #endif |
| { |
| /* Volume label or VFAT entry */ |
| dentptr++; |
| continue; |
| } |
| } else if (dentptr->name[0] == 0) { |
| debug("RootDentname == NULL - %d\n", i); |
| if (dols == LS_ROOT) { |
| printf("\n%d file(s), %d dir(s)\n\n", |
| files, dirs); |
| ret = 0; |
| } |
| goto exit; |
| } |
| #ifdef CONFIG_SUPPORT_VFAT |
| else if (dols == LS_ROOT && |
| mkcksum(dentptr->name) == prevcksum) { |
| dentptr++; |
| continue; |
| } |
| #endif |
| get_name(dentptr, s_name); |
| |
| if (dols == LS_ROOT) { |
| int isdir = (dentptr->attr & ATTR_DIR); |
| char dirc; |
| int doit = 0; |
| |
| if (isdir) { |
| dirc = '/'; |
| if (s_name[0] != 0) { |
| dirs++; |
| doit = 1; |
| } |
| } else { |
| dirc = ' '; |
| if (s_name[0] != 0) { |
| files++; |
| doit = 1; |
| } |
| } |
| if (doit) { |
| if (dirc == ' ') { |
| printf(" %8ld %s%c\n", |
| (long)FAT2CPU32(dentptr->size), |
| s_name, dirc); |
| } else { |
| printf(" %s%c\n", |
| s_name, dirc); |
| } |
| } |
| dentptr++; |
| continue; |
| } |
| |
| if (strcmp(fnamecopy, s_name) |
| && strcmp(fnamecopy, l_name)) { |
| debug("RootMismatch: |%s|%s|\n", s_name, |
| l_name); |
| dentptr++; |
| continue; |
| } |
| |
| if (isdir && !(dentptr->attr & ATTR_DIR)) |
| goto exit; |
| |
| debug("RootName: %s", s_name); |
| debug(", start: 0x%x", START(dentptr)); |
| debug(", size: 0x%x %s\n", |
| FAT2CPU32(dentptr->size), |
| isdir ? "(DIR)" : ""); |
| |
| goto rootdir_done; /* We got a match */ |
| } |
| debug("END LOOP: j=%d clust_size=%d\n", j, |
| mydata->clust_size); |
| |
| /* |
| * On FAT32 we must fetch the FAT entries for the next |
| * root directory clusters when a cluster has been |
| * completely processed. |
| */ |
| ++j; |
| int fat32_end = 0; |
| if ((mydata->fatsize == 32) && (j == mydata->clust_size)) { |
| int nxtsect = 0; |
| int nxt_clust = 0; |
| |
| nxt_clust = get_fatent(mydata, root_cluster); |
| fat32_end = CHECK_CLUST(nxt_clust, 32); |
| |
| nxtsect = mydata->data_begin + |
| (nxt_clust * mydata->clust_size); |
| |
| root_cluster = nxt_clust; |
| |
| cursect = nxtsect; |
| j = 0; |
| } else { |
| cursect++; |
| } |
| |
| /* If end of rootdir reached */ |
| if ((mydata->fatsize == 32 && fat32_end) || |
| (mydata->fatsize != 32 && j == rootdir_size)) { |
| if (dols == LS_ROOT) { |
| printf("\n%d file(s), %d dir(s)\n\n", |
| files, dirs); |
| ret = 0; |
| } |
| goto exit; |
| } |
| } |
| rootdir_done: |
| |
| firsttime = 1; |
| |
| while (isdir) { |
| int startsect = mydata->data_begin |
| + START(dentptr) * mydata->clust_size; |
| dir_entry dent; |
| char *nextname = NULL; |
| |
| dent = *dentptr; |
| dentptr = &dent; |
| |
| idx = dirdelim(subname); |
| |
| if (idx >= 0) { |
| subname[idx] = '\0'; |
| nextname = subname + idx + 1; |
| /* Handle multiple delimiters */ |
| while (ISDIRDELIM(*nextname)) |
| nextname++; |
| if (dols && *nextname == '\0') |
| firsttime = 0; |
| } else { |
| if (dols && firsttime) { |
| firsttime = 0; |
| } else { |
| isdir = 0; |
| } |
| } |
| |
| if (get_dentfromdir(mydata, startsect, subname, dentptr, |
| isdir ? 0 : dols) == NULL) { |
| if (dols && !isdir) |
| ret = 0; |
| goto exit; |
| } |
| |
| if (idx >= 0) { |
| if (!(dentptr->attr & ATTR_DIR)) |
| goto exit; |
| subname = nextname; |
| } |
| } |
| |
| ret = get_contents(mydata, dentptr, buffer, maxsize); |
| debug("Size: %d, got: %ld\n", FAT2CPU32(dentptr->size), ret); |
| |
| exit: |
| free(mydata->fatbuf); |
| return ret; |
| } |
| |
| int file_fat_detectfs (void) |
| { |
| boot_sector bs; |
| volume_info volinfo; |
| int fatsize; |
| char vol_label[12]; |
| |
| if (cur_dev == NULL) { |
| printf("No current device\n"); |
| return 1; |
| } |
| |
| #if defined(CONFIG_CMD_IDE) || \ |
| defined(CONFIG_CMD_MG_DISK) || \ |
| defined(CONFIG_CMD_SATA) || \ |
| defined(CONFIG_CMD_SCSI) || \ |
| defined(CONFIG_CMD_USB) || \ |
| defined(CONFIG_MMC) |
| printf("Interface: "); |
| switch (cur_dev->if_type) { |
| case IF_TYPE_IDE: |
| printf("IDE"); |
| break; |
| case IF_TYPE_SATA: |
| printf("SATA"); |
| break; |
| case IF_TYPE_SCSI: |
| printf("SCSI"); |
| break; |
| case IF_TYPE_ATAPI: |
| printf("ATAPI"); |
| break; |
| case IF_TYPE_USB: |
| printf("USB"); |
| break; |
| case IF_TYPE_DOC: |
| printf("DOC"); |
| break; |
| case IF_TYPE_MMC: |
| printf("MMC"); |
| break; |
| default: |
| printf("Unknown"); |
| } |
| |
| printf("\n Device %d: ", cur_dev->dev); |
| dev_print(cur_dev); |
| #endif |
| |
| if (read_bootsectandvi(&bs, &volinfo, &fatsize)) { |
| printf("\nNo valid FAT fs found\n"); |
| return 1; |
| } |
| |
| memcpy(vol_label, volinfo.volume_label, 11); |
| vol_label[11] = '\0'; |
| volinfo.fs_type[5] = '\0'; |
| |
| printf("Partition %d: Filesystem: %s \"%s\"\n", cur_part, |
| volinfo.fs_type, vol_label); |
| |
| return 0; |
| } |
| |
| int file_fat_ls (const char *dir) |
| { |
| return do_fat_read(dir, NULL, 0, LS_YES); |
| } |
| |
| long file_fat_read (const char *filename, void *buffer, unsigned long maxsize) |
| { |
| printf("reading %s\n", filename); |
| return do_fat_read(filename, buffer, maxsize, LS_NO); |
| } |