#include "partition.h"#include "fat16.h"#include "fat16_config.h"#include <stdlib.h>#include <string.h>/** * \addtogroup fat16 FAT16 support * * This module implements FAT16 read and write access. *  * The following features are supported: * - File names up to 31 characters long. * - Unlimited depth of subdirectories. * - Short 8.3 and long filenames. * - Creating and deleting files. * - Reading and writing from and to files. * - File resizing. * - File sizes of up to 4 gigabytes. *  * @{ *//** * \file * FAT16 implementation. * * \author Roland Riegel *//** * \addtogroup fat16_config FAT16 configuration * Preprocessor defines to configure the FAT16 implementation. *//** * \addtogroup fat16_fs FAT16 access * Basic functions for handling a FAT16 filesystem. *//** * \addtogroup fat16_file FAT16 file functions * Functions for managing files. *//** * \addtogroup fat16_dir FAT16 directory functions * Functions for managing directories. *//** * @} */#define FAT16_CLUSTER_FREE 0x0000#define FAT16_CLUSTER_RESERVED_MIN 0xfff0#define FAT16_CLUSTER_RESERVED_MAX 0xfff6#define FAT16_CLUSTER_BAD 0xfff7#define FAT16_CLUSTER_LAST_MIN 0xfff8#define FAT16_CLUSTER_LAST_MAX 0xffff#define FAT16_DIRENTRY_DELETED 0xe5#define FAT16_DIRENTRY_LFNLAST (1 << 6)#define FAT16_DIRENTRY_LFNSEQMASK ((1 << 6) - 1)/* Each entry within the directory table has a size of 32 bytes * and either contains a 8.3 DOS-style file name or a part of a * long file name, which may consist of several directory table * entries at once. * * multi-byte integer values are stored little-endian! * * 8.3 file name entry: * ==================== * offset  length  description *      0       8  name (space padded) *      8       3  extension (space padded) *     11       1  attributes (FAT16_ATTRIB_*) * * long file name (lfn) entry ordering for a single file name: * =========================================================== * LFN entry n *     ... * LFN entry 2 * LFN entry 1 * 8.3 entry (see above) *  * lfn entry: * ========== * offset  length  description *      0       1  ordinal field *      1       2  unicode character 1 *      3       3  unicode character 2 *      5       3  unicode character 3 *      7       3  unicode character 4 *      9       3  unicode character 5 *     11       1  attribute (always 0x0f) *     12       1  type (reserved, always 0) *     13       1  checksum *     14       2  unicode character 6 *     16       2  unicode character 7 *     18       2  unicode character 8 *     20       2  unicode character 9 *     22       2  unicode character 10 *     24       2  unicode character 11 *     26       2  cluster (unused, always 0) *     28       2  unicode character 12 *     30       2  unicode character 13 *  * The ordinal field contains a descending number, from n to 1. * For the n'th lfn entry the ordinal field is or'ed with 0x40. * For deleted lfn entries, the ordinal field is set to 0xe5. */struct fat16_header_struct{    uint32_t size;    uint32_t fat_offset;    uint32_t fat_size;    uint16_t sector_size;    uint16_t cluster_size;    uint32_t root_dir_offset;    uint32_t cluster_zero_offset;};struct fat16_fs_struct{    struct partition_struct* partition;    struct fat16_header_struct header;};struct fat16_file_struct{    struct fat16_fs_struct* fs;    struct fat16_dir_entry_struct dir_entry;    uint32_t pos;};struct fat16_dir_struct{    struct fat16_fs_struct* fs;    struct fat16_dir_entry_struct dir_entry;    uint16_t entry_next;};struct fat16_read_callback_arg{    uint16_t entry_cur;    uint16_t entry_num;    uint32_t entry_offset;    uint8_t byte_count;};static uint8_t fat16_read_header(struct fat16_fs_struct* fs);static uint8_t fat16_read_root_dir_entry(const struct fat16_fs_struct* fs, uint16_t entry_num, struct fat16_dir_entry_struct* dir_entry);static uint8_t fat16_read_sub_dir_entry(const struct fat16_fs_struct* fs, uint16_t entry_num, const struct fat16_dir_entry_struct* parent, struct fat16_dir_entry_struct* dir_entry);static uint8_t fat16_dir_entry_seek_callback(uint8_t* buffer, uint32_t offset, void* p);static uint8_t fat16_dir_entry_read_callback(uint8_t* buffer, uint32_t offset, void* p);static uint8_t fat16_interpret_dir_entry(struct fat16_dir_entry_struct* dir_entry, const uint8_t* raw_entry);static uint16_t fat16_get_next_cluster(const struct fat16_fs_struct* fs, uint16_t cluster_num);static uint16_t fat16_append_cluster(const struct fat16_fs_struct* fs, uint16_t cluster_num);static uint8_t fat16_free_cluster(struct fat16_fs_struct* fs, uint16_t cluster_num);static uint8_t fat16_write_dir_entry(struct fat16_fs_struct* fs, const struct fat16_dir_entry_struct* dir_entry);/** * \ingroup fat16_fs * Opens a FAT16 filesystem. * * \param[in] partition Discriptor of partition on which the filesystem resides. * \returns 0 on error, a FAT16 filesystem descriptor on success. * \see fat16_open */struct fat16_fs_struct* fat16_open(struct partition_struct* partition){    if(!partition ||#if FAT16_WRITE_SUPPORT       !partition->device_write#else       0#endif      )        return 0;    struct fat16_fs_struct* fs = malloc(sizeof(*fs));    if(!fs)        return 0;    memset(fs, 0, sizeof(*fs));    fs->partition = partition;    if(!fat16_read_header(fs))    {        free(fs);        return 0;    }        return fs;}/** * \ingroup fat16_fs * Closes a FAT16 filesystem. * * When this function returns, the given filesystem descriptor * will be invalid. * * \param[in] fs The filesystem to close. * \see fat16_open */void fat16_close(struct fat16_fs_struct* fs){    if(!fs)        return;    free(fs);}/** * \ingroup fat16_fs * Reads and parses the header of a FAT16 filesystem. * * \param[inout] fs The filesystem for which to parse the header. * \returns 0 on failure, 1 on success. */uint8_t fat16_read_header(struct fat16_fs_struct* fs){    uint8_t buffer[25];    struct partition_struct* partition;    struct fat16_header_struct* header;        if(!fs || !fs->partition)        return 0;    partition = fs->partition;    header = &fs->header;        if(partition->type != PARTITION_TYPE_FAT16 &&       partition->type != PARTITION_TYPE_FAT16_LBA)        return 0;    uint32_t partition_offset = partition->offset * 512;    if(!partition->device_read(partition_offset + 0x0b, buffer, sizeof(buffer)))        return 0;    memset(header, 0, sizeof(*header));        uint16_t bytes_per_sector = ((uint16_t) buffer[0x00]) |                                ((uint16_t) buffer[0x01] << 8);    uint8_t sectors_per_cluster = buffer[0x02];    uint16_t reserved_sectors = ((uint16_t) buffer[0x03]) |                                ((uint16_t) buffer[0x04] << 8);    uint8_t fat_copies = buffer[0x05];    uint16_t max_root_entries = ((uint16_t) buffer[0x06]) |                                ((uint16_t) buffer[0x07] << 8);    uint16_t sectors_per_fat = ((uint16_t) buffer[0x0b]) |                               ((uint16_t) buffer[0x0c] << 8);    uint32_t sector_count = ((uint32_t) buffer[0x15]) |                            ((uint32_t) buffer[0x16] << 8) |                            ((uint32_t) buffer[0x17] << 16) |                            ((uint32_t) buffer[0x18] << 24);        header->size = sector_count * bytes_per_sector;    header->fat_offset = /* jump to partition */                         partition_offset +                         /* jump to fat */                         (uint32_t) reserved_sectors * bytes_per_sector;    header->fat_size = (uint32_t) sectors_per_fat * bytes_per_sector;    header->sector_size = bytes_per_sector;    header->cluster_size = (uint32_t) bytes_per_sector * sectors_per_cluster;    header->root_dir_offset = /* jump to fats */                              header->fat_offset +                              /* jump to root directory entries */                              (uint32_t) fat_copies * sectors_per_fat * bytes_per_sector;    header->cluster_zero_offset = /* jump to root directory entries */                                  header->root_dir_offset +                                  /* skip root directory entries */                                  (uint32_t) max_root_entries * 32;    return 1;}/** * \ingroup fat16_fs * Reads a directory entry of the root directory. * * \param[in] fs Descriptor of file system to use. * \param[in] entry_num The index of the directory entry to read. * \param[out] dir_entry Directory entry descriptor which will get filled. * \returns 0 on failure, 1 on success * \see fat16_read_sub_dir_entry, fat16_read_dir_entry_by_path */uint8_t fat16_read_root_dir_entry(const struct fat16_fs_struct* fs, uint16_t entry_num, struct fat16_dir_entry_struct* dir_entry){    if(!fs || !dir_entry)        return 0;    /* we read from the root directory entry */    const struct fat16_header_struct* header = &fs->header;    device_read_interval_t device_read_interval = fs->partition->device_read_interval;    uint8_t buffer[32];    /* seek to the n-th entry */    struct fat16_read_callback_arg arg;    memset(&arg, 0, sizeof(arg));    arg.entry_num = entry_num;    if(!device_read_interval(header->root_dir_offset,                             buffer,                             sizeof(buffer),                             header->cluster_zero_offset - header->root_dir_offset,                             fat16_dir_entry_seek_callback,                             &arg) ||       arg.entry_offset == 0      )        return 0;    /* read entry */    memset(dir_entry, 0, sizeof(*dir_entry));    if(!device_read_interval(arg.entry_offset,                             buffer,                             sizeof(buffer),                             arg.byte_count,                             fat16_dir_entry_read_callback,                             dir_entry))        return 0;    return dir_entry->long_name[0] != '\0' ? 1 : 0;}/** * \ingroup fat16_fs * Reads a directory entry of a given parent directory. * * \param[in] fs Descriptor of file system to use. * \param[in] entry_num The index of the directory entry to read. * \param[in] parent Directory entry descriptor in which to read directory entry. * \param[out] dir_entry Directory entry descriptor which will get filled. * \returns 0 on failure, 1 on success * \see fat16_read_root_dir_entry, fat16_read_dir_entry_by_path */uint8_t fat16_read_sub_dir_entry(const struct fat16_fs_struct* fs, uint16_t entry_num, const struct fat16_dir_entry_struct* parent, struct fat16_dir_entry_struct* dir_entry){    if(!fs || !parent || !dir_entry)        return 0;    /* we are in a parent directory and want to search within its directory entry table */    if(!(parent->attributes & FAT16_ATTRIB_DIR))        return 0;    /* loop through all clusters of the directory */    uint8_t buffer[32];    uint32_t cluster_offset;    uint16_t cluster_size = fs->header.cluster_size;    uint16_t cluster_num = parent->cluster;    struct fat16_read_callback_arg arg;    while(1)    {        /* calculate new cluster offset */        cluster_offset = fs->header.cluster_zero_offset + (uint32_t) (cluster_num - 2) * cluster_size;        /* seek to the n-th entry */        memset(&arg, 0, sizeof(arg));        arg.entry_num = entry_num;        if(!fs->partition->device_read_interval(cluster_offset,                                                buffer,                                                sizeof(buffer),                                                cluster_size,                                                fat16_dir_entry_seek_callback,                                                &arg)          )            return 0;        /* check if we found the entry */        if(arg.entry_offset)            break;        /* get number of next cluster */        if(!(cluster_num = fat16_get_next_cluster(fs, cluster_num)))            return 0; /* directory entry not found */    }    memset(dir_entry, 0, sizeof(*dir_entry));    /* read entry */    if(!fs->partition->device_read_interval(arg.entry_offset,                                            buffer,                                            sizeof(buffer),                                            arg.byte_count,                                            fat16_dir_entry_read_callback,                                            dir_entry))        return 0;    return dir_entry->long_name[0] != '\0' ? 1 : 0;