U-Boot

/*
 * (C) Copyright 2002
 * Stäubli Faverges - <www.staubli.com>
 * Pierre AUBERT  p.aubert@staubli.com
 *
 * 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 <malloc.h>

#if (CONFIG_COMMANDS & CFG_CMD_FDOS)

#include "dos.h"
#include "fdos.h"

static int cache_sect;
static unsigned char cache [SZ_STD_SECTOR];


#define min(x,y) ((x)<(y)?(x):(y))

static int descend (Slot_t *parent,
             Fs_t *fs,
                    char *path);

/*-----------------------------------------------------------------------------
 * init_subdir -- 
 *-----------------------------------------------------------------------------
 */
void init_subdir (void)
{
    cache_sect = -1;
}
/*-----------------------------------------------------------------------------
 * basename -- 
 *-----------------------------------------------------------------------------
 */
char *basename (char *name)
{
    register char *cptr;

    if (!name || !*name) {
        return ("");
    }
    
    for (cptr= name; *cptr++; );
    while (--cptr >= name) {
	if (*cptr == '/')    {
            return (cptr + 1);
	}
    }
    return(name);
}
/*-----------------------------------------------------------------------------
 * root_map -- 
 *-----------------------------------------------------------------------------
 */
static int root_map (Fs_t *fs, Slot_t *file, int where, int *len)
{
    *len = min (*len, fs -> dir_len * SZ_STD_SECTOR - where);
    if (*len < 0 ) {
        *len = 0;
        return (-1);
    }
    return fs -> dir_start * SZ_STD_SECTOR + where;
}
/*-----------------------------------------------------------------------------
 * normal_map -- 
 *-----------------------------------------------------------------------------
 */
static int normal_map (Fs_t *fs, Slot_t *file, int where, int *len)
{
    int offset;
    int NrClu;
    unsigned short RelCluNr;
    unsigned short CurCluNr;
    unsigned short NewCluNr;
    unsigned short AbsCluNr;
    int clus_size;

    clus_size = fs -> cluster_size * SZ_STD_SECTOR;
    offset = where % clus_size;

    *len = min (*len, file -> FileSize - where);

    if (*len < 0 ) {
        *len = 0;
        return (0);
    }

    if (file -> FirstAbsCluNr < 2){
        *len = 0;
        return (0);
    }

    RelCluNr = where / clus_size;
	
    if (RelCluNr >= file -> PreviousRelCluNr){
        CurCluNr = file -> PreviousRelCluNr;
        AbsCluNr = file -> PreviousAbsCluNr;
    } else {
        CurCluNr = 0;
        AbsCluNr = file -> FirstAbsCluNr;
    }


    NrClu = (offset + *len - 1) / clus_size;
    while (CurCluNr <= RelCluNr + NrClu) {
        if (CurCluNr == RelCluNr){
            /* we have reached the beginning of our zone. Save
             * coordinates */
            file -> PreviousRelCluNr = RelCluNr;
            file -> PreviousAbsCluNr = AbsCluNr;
        }
        NewCluNr = fat_decode (fs, AbsCluNr);
        if (NewCluNr == 1 || NewCluNr == 0) {
            PRINTF("Fat problem while decoding %d %x\n", 
                    AbsCluNr, NewCluNr);
            return (-1);
        }
        if (CurCluNr == RelCluNr + NrClu) {
            break;
        }

        if (CurCluNr < RelCluNr && NewCluNr == FAT12_END) {
            *len = 0;
            return 0;
        }

        if (CurCluNr >= RelCluNr && NewCluNr != AbsCluNr + 1)
            break;
        CurCluNr++;
        AbsCluNr = NewCluNr;
    }

    *len = min (*len, (1 + CurCluNr - RelCluNr) * clus_size - offset);

    return (((file -> PreviousAbsCluNr - 2) * fs -> cluster_size +
             fs -> dir_start + fs -> dir_len) *
            SZ_STD_SECTOR + offset);
}
/*-----------------------------------------------------------------------------
 * open_subdir -- open the subdir containing the file
 *-----------------------------------------------------------------------------
 */
int open_subdir (File_t *desc)
{
    char *pathname;
    char *tmp, *s, *path;
    char terminator;
    
    if ((pathname = (char *)malloc (MAX_PATH)) == NULL) {
        return (-1);
    }
    
    strcpy (pathname, desc -> name);
    
    /* Suppress file name                                                    */
    tmp = basename (pathname);
    *tmp = '\0';

    /* root directory  init                                                  */
    desc -> subdir.FirstAbsCluNr = 0;
    desc -> subdir.FileSize = -1;
    desc -> subdir.map = root_map;
    desc -> subdir.dir.attr = ATTR_DIRECTORY;
    
    tmp = pathname;
    for (s = tmp; ; ++s) {
        if (*s == '/' || *s == '\0') {
            path = tmp;
            terminator = *s;
            *s = '\0';
            if (s != tmp && strcmp (path,".")) {
                if (descend (&desc -> subdir, desc -> fs, path) < 0) {
                    free (pathname);
                    return (-1);
                }
            }
            if (terminator == 0) {
                break;
            }
            tmp = s + 1;
        }
    }
    free (pathname);
    return (0);
}
/*-----------------------------------------------------------------------------
 * descend -- 
 *-----------------------------------------------------------------------------
 */
static int descend (Slot_t *parent,
             Fs_t *fs,
             char *path)
{
    int entry;
    Slot_t SubDir;

    if(path[0] == '\0' || strcmp (path, ".") == 0) {
        return (0);
    }
    

    entry = 0;
    if (vfat_lookup (parent,
                     fs,
                     &(SubDir.dir),
                     &entry,
                     0,
                     path,
                     ACCEPT_DIR | SINGLE | DO_OPEN,
                     0,
                     &SubDir) == 0) {
        *parent = SubDir;
        return (0);
    }

    if (strcmp(path, "..") == 0) {
        parent -> FileSize = -1;
        parent -> FirstAbsCluNr = 0;
        parent -> map = root_map;
        return (0);
    }
    return (-1);
}
/*-----------------------------------------------------------------------------
 * open_file -- 
 *-----------------------------------------------------------------------------
 */
int open_file (Slot_t *file, Directory_t *dir)
{
    int first;
    unsigned long size;

    first = __le16_to_cpu (dir -> start);

    if(first == 0 &&
       (dir -> attr & ATTR_DIRECTORY) != 0) {
        file -> FirstAbsCluNr = 0;
        file -> FileSize = -1;
        file -> map = root_map;
        return (0);
    }
	
    if ((dir -> attr & ATTR_DIRECTORY) != 0) {
        size = (1UL << 31) - 1;
    }
    else {
        size = __le32_to_cpu (dir -> size);
    }

    file -> map = normal_map;
    file -> FirstAbsCluNr = first;
    file -> PreviousRelCluNr = 0xffff;
    file -> FileSize = size;
    return (0);
}
/*-----------------------------------------------------------------------------
 * read_file -- 
 *-----------------------------------------------------------------------------
 */
int read_file (Fs_t *fs,
               Slot_t *file,
               char *buf,
               int where,
               int len)
{
    int pos;
    int read, nb, sect, offset;
    
    pos = file -> map (fs, file, where, &len);
    if  (pos < 0) {
        return -1;
    }
    if (len == 0) {
        return (0);
    }

    /* Compute sector number                                                 */
    sect = pos / SZ_STD_SECTOR;
    offset = pos % SZ_STD_SECTOR;
    read = 0;
    
    if (offset) {
        /* Read doesn't start at the sector beginning. We need to use our    */
        /* cache                                                             */
        if (sect != cache_sect) {
            if (dev_read (cache, sect, 1) < 0) {
                return (-1);
            }
            cache_sect = sect;
        }
        nb = min (len, SZ_STD_SECTOR - offset);
        
        memcpy (buf, cache + offset, nb);
        read += nb;
        len -= nb;
        sect += 1;
    }

    if (len > SZ_STD_SECTOR) {
        nb = (len - 1) / SZ_STD_SECTOR;
        if (dev_read (buf + read, sect, nb) < 0) {
            return ((read) ? read : -1);
        }
        /* update sector position                                            */
        sect += nb;

        /* Update byte position                                              */
        nb *= SZ_STD_SECTOR;
        read += nb;
        len -= nb;
    }

    if (len) {
        if (sect != cache_sect) {
            if (dev_read (cache, sect, 1) < 0) {
                return ((read) ? read : -1);
                cache_sect = -1;
            }
            cache_sect = sect;
        }
        
        memcpy (buf + read, cache, len);
        read += len;
    }
    return (read);
}
#endif