ecos: packages/io/disk/current/src/disk.c annotate

annotate packages/io/disk/current/src/disk.c @ 1685:b1d2762b2eec

* src/disk.c: * include/disk.h: * include/diskio.h: Use predefined arrays for partition devices and info radher than malloc. Extended DISK_CHANNEL macro to support defining maximum number of partitions.

author	asl
date	Thu, 01 Jul 2004 13:03:20 +0000
parents	f2453fae08d4
children	0ad51d0b250b

rev	line source
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	1 //==========================================================================
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	2 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	3 // io/disk/disk.c
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	4 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	5 // High level disk driver
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	6 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	7 //==========================================================================
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	8 //####ECOSGPLCOPYRIGHTBEGIN####
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	9 // -------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	10 // This file is part of eCos, the Embedded Configurable Operating System.
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	11 // Copyright (C) 2003 Savin Zlobec
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	12 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	13 // eCos is free software; you can redistribute it and/or modify it under
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	14 // the terms of the GNU General Public License as published by the Free
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	15 // Software Foundation; either version 2 or (at your option) any later version.
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	16 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	17 // eCos is distributed in the hope that it will be useful, but WITHOUT ANY
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	18 // WARRANTY; without even the implied warranty of MERCHANTABILITY or
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	19 // FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	20 // for more details.
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	21 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	22 // You should have received a copy of the GNU General Public License along
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	23 // with eCos; if not, write to the Free Software Foundation, Inc.,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	24 // 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	25 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	26 // As a special exception, if other files instantiate templates or use macros
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	27 // or inline functions from this file, or you compile this file and link it
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	28 // with other works to produce a work based on this file, this file does not
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	29 // by itself cause the resulting work to be covered by the GNU General Public
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	30 // License. However the source code for this file must still be made available
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	31 // in accordance with section (3) of the GNU General Public License.
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	32 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	33 // This exception does not invalidate any other reasons why a work based on
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	34 // this file might be covered by the GNU General Public License.
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	35 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	36 // -------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	37 //####ECOSGPLCOPYRIGHTEND####
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	38 //==========================================================================
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	39 //#####DESCRIPTIONBEGIN####
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	40 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	41 // Author(s): savin
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	42 // Date: 2003-06-10
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	43 // Purpose: Top level disk driver
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	44 // Description:
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	45 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	46 //####DESCRIPTIONEND####
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	47 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	48 //==========================================================================
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	49
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	50 #include <pkgconf/io.h>
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	51 #include <pkgconf/io_disk.h>
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	52
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	53 #include <cyg/io/io.h>
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	54 #include <cyg/io/devtab.h>
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	55 #include <cyg/io/disk.h>
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	56 #include <cyg/infra/cyg_ass.h> // assertion support
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	57 #include <cyg/infra/diag.h> // diagnostic output
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	58
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	59 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	60
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	61 //#define DEBUG 1
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	62
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	63 #ifdef DEBUG
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	64 # define D(_args_) diag_printf _args_
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	65 #else
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	66 # define D(_args_)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	67 #endif
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	68
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	69 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	70
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	71 // Master Boot Record defines
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	72 #define MBR_SIG_ADDR 0x1FE // signature address
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	73 #define MBR_SIG_BYTE0 0x55 // signature first byte value
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	74 #define MBR_SIG_BYTE1 0xAA // signature second byte value
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	75 #define MBR_PART_ADDR 0x1BE // first partition address
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	76 #define MBR_PART_SIZE 0x10 // partition size
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	77 #define MBR_PART_NUM 4 // number of partitions
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	78
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	79 // Get cylinders, heads and sectors from data (MBR partition format)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	80 #define READ_CHS(_data_, _c_, _h_, _s_) \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	81 do { \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	82 _h_ = (((cyg_uint8 )_data_)); \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	83 _s_ = ((((cyg_uint8 )_data_)+1) & 0x3F); \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	84 _c_ = ((((cyg_uint8 )_data_)+1) & ~0x3F) << 2 \| \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	85 ((((cyg_uint8 )_data_)+2)); \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	86 } while (0)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	87
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	88 // Get double word from data (MBR partition format)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	89 #define READ_DWORD(_data_, _val_) \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	90 do { \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	91 _val_ = ((cyg_uint8 )_data_) \| \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	92 (((cyg_uint8 )_data_)+1) << 8 \| \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	93 (((cyg_uint8 )_data_)+2) << 16 \| \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	94 (((cyg_uint8 )_data_)+3) << 24; \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	95 } while (0)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	96
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	97 // Convert cylinders, heads and sectors to LBA sectors
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	98 #define CHS_TO_LBA(_info_, _c_, _h_, _s_, _lba_) \
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	99 (_lba_=(((_c_)(_info_)->heads_num+(_h_))(_info_)->sectors_num)+(_s_)-1)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	100
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	101 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	102
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	103 static Cyg_ErrNo disk_bread(cyg_io_handle_t handle,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	104 void *buf,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	105 cyg_uint32 *len,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	106 cyg_uint32 pos);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	107
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	108 static Cyg_ErrNo disk_bwrite(cyg_io_handle_t handle,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	109 const void *buf,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	110 cyg_uint32 *len,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	111 cyg_uint32 pos);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	112
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	113 static Cyg_ErrNo disk_select(cyg_io_handle_t handle,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	114 cyg_uint32 which,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	115 CYG_ADDRWORD info);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	116
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	117 static Cyg_ErrNo disk_get_config(cyg_io_handle_t handle,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	118 cyg_uint32 key,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	119 void *buf,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	120 cyg_uint32 *len);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	121
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	122 static Cyg_ErrNo disk_set_config(cyg_io_handle_t handle,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	123 cyg_uint32 key,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	124 const void *buf,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	125 cyg_uint32 *len);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	126
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	127 BLOCK_DEVIO_TABLE(cyg_io_disk_devio,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	128 disk_bwrite,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	129 disk_bread,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	130 disk_select,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	131 disk_get_config,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	132 disk_set_config
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	133 );
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	134
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	135 static cyg_bool disk_init(struct cyg_devtab_entry *tab);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	136
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	137 static Cyg_ErrNo disk_connected(struct cyg_devtab_entry *tab,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	138 cyg_disk_identify_t *ident);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	139
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	140 static Cyg_ErrNo disk_disconnected(struct cyg_devtab_entry *tab);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	141
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	142 static Cyg_ErrNo disk_lookup(struct cyg_devtab_entry **tab,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	143 struct cyg_devtab_entry *sub_tab,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	144 const char *name);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	145
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	146 DISK_CALLBACKS(cyg_io_disk_callbacks,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	147 disk_init,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	148 disk_connected,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	149 disk_disconnected,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	150 disk_lookup
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	151 );
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	152
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	153 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	154
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	155 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	156 // Read partition from data
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	157 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	158 static void
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	159 read_partition(cyg_uint8 *data,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	160 cyg_disk_info_t *info,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	161 cyg_disk_partition_t *part)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	162 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	163 cyg_uint16 c, h, s;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	164
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	165 part->type = data[4];
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	166 part->state = data[0];
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	167
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	168 READ_CHS(&data[1], c, h, s);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	169 CHS_TO_LBA(&info->ident, c, h, s, part->start);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	170
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	171 READ_CHS(&data[5], c, h, s);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	172 CHS_TO_LBA(&info->ident, c, h, s, part->end);
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	173
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	174 READ_DWORD(&data[12], part->size);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	175 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	176
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	177 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	178 // Read Master Boot Record (partitions)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	179 //
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	180 static Cyg_ErrNo
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	181 read_mbr(disk_channel *chan)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	182 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	183 cyg_disk_info_t *info = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	184 disk_funs *funs = chan->funs;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	185 cyg_uint8 buf[512];
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	186 Cyg_ErrNo res = ENOERR;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	187 int i;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	188
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	189 for (i = 0; i < info->partitions_num; i++)
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	190 info->partitions[i].type = 0x00;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	191
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	192 res = (funs->read)(chan, (void *)buf, 512, 0);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	193 if (ENOERR != res)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	194 return res;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	195
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	196 if (MBR_SIG_BYTE0 == buf[MBR_SIG_ADDR+0] && MBR_SIG_BYTE1 == buf[MBR_SIG_ADDR+1])
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	197 {
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	198 int npart;
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	199
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	200 D(("disk MBR found\n"));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	201
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	202 npart = info->partitions_num < MBR_PART_NUM ?
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	203 info->partitions_num : MBR_PART_NUM;
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	204
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	205 for (i = 0; i < npart; i++)
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	206 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	207 cyg_disk_partition_t *part = &info->partitions[i];
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	208
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	209 read_partition(&buf[MBR_PART_ADDR+MBR_PART_SIZE*i], info, part);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	210 #ifdef DEBUG
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	211 if (0x00 != part->type)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	212 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	213 D(("\ndisk MBR partition %d:\n", i));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	214 D((" type = %02X\n", part->type));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	215 D((" state = %02X\n", part->state));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	216 D((" start = %d\n", part->start));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	217 D((" end = %d\n", part->end));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	218 D((" size = %d\n\n", part->size));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	219 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	220 #endif
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	221 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	222 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	223 return ENOERR;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	224 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	225
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	226 static cyg_bool
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	227 disk_init(struct cyg_devtab_entry *tab)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	228 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	229 disk_channel chan = (disk_channel ) tab->priv;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	230 cyg_disk_info_t *info = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	231 int i;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	232
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	233 if (!chan->init)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	234 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	235 info->connected = false;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	236
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	237 // clear partition data
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	238 for (i = 0; i < info->partitions_num; i++)
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	239 info->partitions[i].type = 0x00;
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	240
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	241 chan->init = true;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	242 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	243 return true;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	244 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	245
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	246 static Cyg_ErrNo
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	247 disk_connected(struct cyg_devtab_entry *tab,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	248 cyg_disk_identify_t *ident)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	249 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	250 disk_channel chan = (disk_channel ) tab->priv;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	251 cyg_disk_info_t *info = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	252 Cyg_ErrNo res = ENOERR;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	253
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	254 if (!chan->init)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	255 return -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	256
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	257 info->ident = *ident;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	258 info->block_size = 512;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	259 info->blocks_num = ident->lba_sectors_num;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	260
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	261 D(("disk connected\n"));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	262 D((" serial = '%s'\n", ident->serial));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	263 D((" firmware rev = '%s'\n", ident->firmware_rev));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	264 D((" model num = '%s'\n", ident->model_num));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	265 D((" block_size = %d\n", info->block_size));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	266 D((" blocks_num = %d\n", info->blocks_num));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	267
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	268 if (chan->mbr_support)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	269 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	270 // read disk master boot record
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	271 res = read_mbr(chan);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	272 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	273
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	274 if (ENOERR == res)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	275 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	276 // now declare that we are connected
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	277 info->connected = true;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	278 chan->valid = true;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	279 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	280 return res;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	281 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	282
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	283 static Cyg_ErrNo
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	284 disk_disconnected(struct cyg_devtab_entry *tab)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	285 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	286 disk_channel chan = (disk_channel ) tab->priv;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	287 cyg_disk_info_t *info = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	288 int i;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	289
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	290 if (!chan->init)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	291 return -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	292
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	293 info->connected = false;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	294 chan->valid = false;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	295
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	296 // clear partition data and invalidate partition devices
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	297 for (i = 0; i < info->partitions_num; i++)
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	298 {
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	299 info->partitions[i].type = 0x00;
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	300 chan->pdevs_chan[i].valid = false;
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	301 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	302
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	303
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	304 D(("disk disconnected\n"));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	305
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	306 return ENOERR;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	307 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	308
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	309 static Cyg_ErrNo
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	310 disk_lookup(struct cyg_devtab_entry **tab,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	311 struct cyg_devtab_entry *sub_tab,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	312 const char *name)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	313 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	314 disk_channel chan = (disk_channel ) (*tab)->priv;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	315 cyg_disk_info_t *info = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	316 struct cyg_devtab_entry *new_tab;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	317 disk_channel *new_chan;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	318 int dev_num;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	319
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	320 if (!info->connected)
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	321 return -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	322
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	323 dev_num = 0;
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	324
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	325 while ('\0' != *name)
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	326 {
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	327 if (name < '0' \|\| name > '9')
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	328 return -EINVAL;
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	329
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	330 dev_num = 10 * dev_num + (*name - '0');
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	331 name++;
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	332 }
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	333
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	334 if (dev_num > info->partitions_num)
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	335 return -EINVAL;
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	336
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	337 D(("disk lookup dev number = %d\n", dev_num));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	338
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	339 if (0 == dev_num)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	340 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	341 // 0 is the root device number
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	342 return ENOERR;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	343 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	344 if (0x00 == info->partitions[dev_num-1].type)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	345 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	346 D(("disk NO partition for dev\n"));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	347 return -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	348 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	349
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	350 new_tab = &chan->pdevs_dev[dev_num-1];
b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	351 new_chan = &chan->pdevs_chan[dev_num-1];
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	352
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	353 // copy device data from parent
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	354 new_tab = *tab;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	355 new_chan = chan;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	356
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	357 new_tab->priv = (void *)new_chan;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	358
1685 b1d2762b2eec * src/disk.c: asl parents: 1476 diff changeset	359 // set partition ptr
1476 f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	360 new_chan->partition = &info->partitions[dev_num-1];
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	361
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	362 // return device tab
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	363 *tab = new_tab;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	364
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	365 return ENOERR;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	366 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	367
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	368 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	369
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	370 static Cyg_ErrNo
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	371 disk_bread(cyg_io_handle_t handle,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	372 void *buf,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	373 cyg_uint32 *len,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	374 cyg_uint32 pos)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	375 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	376 cyg_devtab_entry_t t = (cyg_devtab_entry_t ) handle;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	377 disk_channel chan = (disk_channel ) t->priv;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	378 disk_funs *funs = chan->funs;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	379 cyg_disk_info_t *info = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	380 cyg_uint32 size = *len;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	381 cyg_uint8 bbuf = (cyg_uint8 )buf;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	382 Cyg_ErrNo res = ENOERR;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	383 cyg_uint32 last;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	384
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	385 if (!info->connected \|\| !chan->valid)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	386 return -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	387
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	388 if (NULL != chan->partition)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	389 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	390 pos += chan->partition->start;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	391 last = chan->partition->end;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	392 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	393 else
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	394 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	395 last = info->blocks_num-1;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	396 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	397
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	398 D(("disk read block=%d len=%d buf=%p\n", pos, *len, buf));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	399
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	400 while (size > 0)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	401 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	402 if (pos > last)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	403 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	404 res = -EIO;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	405 break;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	406 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	407
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	408 res = (funs->read)(chan, (void*)bbuf, info->block_size, pos);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	409 if (ENOERR != res)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	410 break;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	411
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	412 if (!info->connected)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	413 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	414 res = -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	415 break;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	416 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	417
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	418 bbuf += info->block_size;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	419 pos++;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	420 size--;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	421 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	422 *len -= size;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	423 return res;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	424 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	425
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	426 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	427
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	428 static Cyg_ErrNo
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	429 disk_bwrite(cyg_io_handle_t handle,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	430 const void *buf,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	431 cyg_uint32 *len,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	432 cyg_uint32 pos)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	433 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	434 cyg_devtab_entry_t t = (cyg_devtab_entry_t ) handle;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	435 disk_channel chan = (disk_channel ) t->priv;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	436 disk_funs *funs = chan->funs;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	437 cyg_disk_info_t *info = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	438 cyg_uint32 size = *len;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	439 cyg_uint8 bbuf = (cyg_uint8 const) buf;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	440 Cyg_ErrNo res = ENOERR;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	441 cyg_uint32 last;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	442
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	443 if (!info->connected \|\| !chan->valid)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	444 return -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	445
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	446 if (NULL != chan->partition)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	447 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	448 pos += chan->partition->start;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	449 last = chan->partition->end;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	450 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	451 else
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	452 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	453 last = info->blocks_num-1;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	454 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	455
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	456 D(("disk write block=%d len=%d buf=%p\n", pos, *len, buf));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	457
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	458 while (size > 0)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	459 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	460 if (pos > last)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	461 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	462 res = -EIO;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	463 break;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	464 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	465
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	466 res = (funs->write)(chan, (void*)bbuf, info->block_size, pos);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	467 if (ENOERR != res)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	468 break;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	469
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	470 if (!info->connected)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	471 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	472 res = -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	473 break;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	474 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	475
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	476 bbuf += info->block_size;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	477 pos++;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	478 size--;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	479 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	480 *len -= size;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	481 return res;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	482 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	483
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	484 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	485
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	486 static cyg_bool
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	487 disk_select(cyg_io_handle_t handle, cyg_uint32 which, CYG_ADDRWORD info)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	488 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	489 cyg_devtab_entry_t t = (cyg_devtab_entry_t ) handle;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	490 disk_channel chan = (disk_channel ) t->priv;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	491 cyg_disk_info_t *cinfo = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	492
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	493 if (!cinfo->connected \|\| !chan->valid)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	494 return false;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	495 else
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	496 return true;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	497 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	498
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	499 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	500
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	501 static Cyg_ErrNo
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	502 disk_get_config(cyg_io_handle_t handle,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	503 cyg_uint32 key,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	504 void *xbuf,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	505 cyg_uint32 *len)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	506 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	507 cyg_devtab_entry_t t = (cyg_devtab_entry_t ) handle;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	508 disk_channel chan = (disk_channel ) t->priv;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	509 cyg_disk_info_t *info = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	510 cyg_disk_info_t buf = (cyg_disk_info_t ) xbuf;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	511 disk_funs *funs = chan->funs;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	512 Cyg_ErrNo res = ENOERR;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	513
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	514 if (!info->connected \|\| !chan->valid)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	515 return -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	516
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	517 D(("disk get config key=%d\n", key));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	518
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	519 switch (key) {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	520 case CYG_IO_GET_CONFIG_DISK_INFO:
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	521 if (*len < sizeof(cyg_disk_info_t)) {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	522 return -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	523 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	524 buf = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	525 *len = sizeof(cyg_disk_info_t);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	526 break;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	527
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	528 default:
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	529 // pass down to lower layers
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	530 res = (funs->get_config)(chan, key, xbuf, len);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	531 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	532
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	533 return res;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	534 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	535
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	536 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	537
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	538 static Cyg_ErrNo
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	539 disk_set_config(cyg_io_handle_t handle,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	540 cyg_uint32 key,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	541 const void *xbuf,
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	542 cyg_uint32 *len)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	543 {
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	544 cyg_devtab_entry_t t = (cyg_devtab_entry_t ) handle;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	545 disk_channel chan = (disk_channel ) t->priv;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	546 cyg_disk_info_t *info = chan->info;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	547 disk_funs *funs = chan->funs;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	548
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	549 if (!info->connected \|\| !chan->valid)
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	550 return -EINVAL;
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	551
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	552 D(("disk set config key=%d\n", key));
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	553
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	554 // pass down to lower layers
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	555 return (funs->set_config)(chan, key, xbuf, len);
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	556 }
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	557
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	558 // ---------------------------------------------------------------------------
f2453fae08d4 Added support for FAT filesystem. Several packages, see the individual nickg parents: diff changeset	559 // EOF disk.c

Mercurial > ecos

annotate packages/io/disk/current/src/disk.c @ 1685:b1d2762b2eec