ecos: packages/devs/disk/ide/current/src/ide

annotate packages/devs/disk/ide/current/src/ide_disk.c @ 2535:6ffeb2616b4b

* cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y so that all disk drivers have unique device names. * cdl/ide_disk.cdl: * src/ide_diskc: Add a configurable startup delay to allow slow disks to initialize. Add support for 8-bit data path. Remove the identity check which are retired in the ATA standard. Optimize the read/write functions.

author	asl
date	Sun, 24 Aug 2008 12:55:41 +0000
parents	6d4c075d2939
children	74dbf4c3f2e1

rev	line source
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	1 //==========================================================================
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	2 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	3 // ide_disk.c
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	4 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	5 // IDE polled mode disk driver
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	6 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	7 //==========================================================================
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	8 //####ECOSGPLCOPYRIGHTBEGIN####
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	9 // -------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	10 // This file is part of eCos, the Embedded Configurable Operating System.
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	11 // Copyright (C) 1998, 1999, 2000, 2001, 2002, 2004 Red Hat, Inc.
2318 6d4c075d2939 * src/ide_disk.c (ide_read_sector, ide_write_sector): Length jlarmour parents: 2299 diff changeset	12 // Copyright (C) 2004, 2006 eCosCentric, Ltd.
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	13 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	14 // eCos is free software; you can redistribute it and/or modify it under
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	15 // the terms of the GNU General Public License as published by the Free
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	16 // Software Foundation; either version 2 or (at your option) any later version.
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	17 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	18 // eCos is distributed in the hope that it will be useful, but WITHOUT ANY
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	19 // WARRANTY; without even the implied warranty of MERCHANTABILITY or
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	20 // FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	21 // for more details.
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	22 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	23 // You should have received a copy of the GNU General Public License along
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	24 // with eCos; if not, write to the Free Software Foundation, Inc.,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	25 // 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	26 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	27 // As a special exception, if other files instantiate templates or use macros
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	28 // or inline functions from this file, or you compile this file and link it
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	29 // with other works to produce a work based on this file, this file does not
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	30 // by itself cause the resulting work to be covered by the GNU General Public
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	31 // License. However the source code for this file must still be made available
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	32 // in accordance with section (3) of the GNU General Public License.
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	33 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	34 // This exception does not invalidate any other reasons why a work based on
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	35 // this file might be covered by the GNU General Public License.
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	36 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	37 // -------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	38 //####ECOSGPLCOPYRIGHTEND####
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	39 //==========================================================================
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	40 //#####DESCRIPTIONBEGIN####
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	41 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	42 // Author(s): iz
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	43 // Contributors:
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	44 // Date: 2004-10-16
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	45 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	46 //####DESCRIPTIONEND####
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	47 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	48 //==========================================================================
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	49
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	50 #include <pkgconf/devs_disk_ide.h>
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	51 #include <pkgconf/io_disk.h>
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	52
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	53 #include <cyg/infra/cyg_type.h>
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	54 #include <cyg/infra/cyg_ass.h>
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	55 #include <cyg/infra/diag.h>
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	56 #include <cyg/hal/hal_arch.h>
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	57 #include <cyg/hal/hal_io.h>
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	58 #include <cyg/hal/hal_if.h> // delays
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	59 #include <cyg/hal/drv_api.h>
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	60 #include <cyg/io/io.h>
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	61 #include <cyg/io/devtab.h>
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	62 #include <cyg/io/disk.h>
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	63
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	64 #include "ide_disk.h"
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	65
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	66 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	67
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	68 #ifdef CYGDBG_IO_DISK_DEBUG
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	69 # define DEBUG 1
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	70 #endif
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	71
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	72 #ifdef DEBUG
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	73 # define D(fmt,args...) diag_printf(fmt, ## args)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	74 #else
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	75 # define D(fmt,args...)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	76 #endif
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	77
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	78 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	79
2299 04006a2b020d * src/ide_disk.h: DISK_FUNS is now implicitly static. jlarmour parents: 1889 diff changeset	80 // No h/w controller structure is needed in this driver, but the address of the
04006a2b020d * src/ide_disk.h: DISK_FUNS is now implicitly static. jlarmour parents: 1889 diff changeset	81 // second argument is taken anyway.
04006a2b020d * src/ide_disk.h: DISK_FUNS is now implicitly static. jlarmour parents: 1889 diff changeset	82 DISK_CONTROLLER(ide_disk_controller, ide_disk_controller);
04006a2b020d * src/ide_disk.h: DISK_FUNS is now implicitly static. jlarmour parents: 1889 diff changeset	83
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	84 #ifdef CYGVAR_DEVS_DISK_IDE_DISK0
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	85 IDE_DISK_INSTANCE(0, 0, 0, true, CYGDAT_IO_DISK_IDE_DISK0_NAME);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	86 #endif
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	87
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	88 #ifdef CYGVAR_DEVS_DISK_IDE_DISK1
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	89 IDE_DISK_INSTANCE(1, 0, 1, true, CYGDAT_IO_DISK_IDE_DISK1_NAME);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	90 #endif
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	91
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	92 #ifdef CYGVAR_DEVS_DISK_IDE_DISK2
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	93 IDE_DISK_INSTANCE(2, 1, 0, true, CYGDAT_IO_DISK_IDE_DISK2_NAME);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	94 #endif
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	95
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	96 #ifdef CYGVAR_DEVS_DISK_IDE_DISK3
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	97 IDE_DISK_INSTANCE(3, 1, 1, true, CYGDAT_IO_DISK_IDE_DISK3_NAME);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	98 #endif
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	99
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	100 #define MIN(a,b) (((a) < (b)) ? (a) : (b))
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	101
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	102 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	103
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	104 static void
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	105 id_strcpy(char dest, cyg_uint16 src, cyg_uint16 size)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	106 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	107 int i;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	108
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	109 for (i=0; i<size; i+=2) {
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	110 dest++ = (char)(src >> 8);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	111 dest++ = (char)(src & 0x00FF);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	112 src++;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	113 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	114 *dest = '\0';
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	115 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	116
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	117 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	118
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	119 static inline void
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	120 __wait_for_ready(int ctlr)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	121 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	122 cyg_uint8 status;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	123 do {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	124 HAL_IDE_READ_UINT8(ctlr, IDE_REG_STATUS, status);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	125 } while (status & (IDE_STAT_BSY \| IDE_STAT_DRQ));
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	126 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	127
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	128 // ----------------------------------------------------------------------------
1889 a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	129 // Wait while the device is busy with the last command
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	130
1889 a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	131 static inline int
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	132 __wait_busy(int ctlr)
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	133 {
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	134 cyg_uint8 status;
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	135 cyg_ucount32 tries;
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	136
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	137 for (tries=0; tries < 1000000; tries++) {
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	138 CYGACC_CALL_IF_DELAY_US(10);
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	139 HAL_IDE_READ_UINT8(ctlr, IDE_REG_STATUS, status);
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	140 if ((status & IDE_STAT_BSY) == 0)
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	141 return 1;
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	142 }
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	143 return 0;
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	144 }
a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	145
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	146 // ----------------------------------------------------------------------------
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	147
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	148 static inline int
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	149 __wait_for_drq(int ctlr)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	150 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	151 cyg_uint8 status;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	152 cyg_ucount32 tries;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	153
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	154 for (tries=0; tries<1000000; tries++) {
1889 a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	155 CYGACC_CALL_IF_DELAY_US(10);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	156 HAL_IDE_READ_UINT8(ctlr, IDE_REG_STATUS, status);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	157 if (!(status & IDE_STAT_BSY)) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	158 if (status & IDE_STAT_DRQ)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	159 return 1;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	160 else
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	161 return 0;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	162 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	163 }
1889 a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	164 return 0;
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	165 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	166
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	167 // ----------------------------------------------------------------------------
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	168 // Return true if any devices attached to controller
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	169
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	170 static int
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	171 ide_presence_detect(int ctlr)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	172 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	173 cyg_uint8 sel, val;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	174 int i;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	175
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	176 for (i = 0; i < HAL_IDE_NUM_CONTROLLERS; i++) {
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	177 sel = (i << 4) \| 0xA0;
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	178 CYGACC_CALL_IF_DELAY_US(50000U);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	179 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE, sel);
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	180 CYGACC_CALL_IF_DELAY_US(50000U);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	181 HAL_IDE_READ_UINT8(ctlr, IDE_REG_DEVICE, val);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	182 if (val == sel) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	183 #ifndef CYGSEM_DEVS_DISK_IDE_VMWARE
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	184 if (i)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	185 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE, 0);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	186 #endif
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	187 return 1;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	188 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	189 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	190 return 0;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	191 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	192
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	193 // ----------------------------------------------------------------------------
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	194
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	195 static int
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	196 ide_reset(int ctlr)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	197 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	198 cyg_uint8 status;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	199 int delay;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	200 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	201 // VMware note:
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	202 // VMware virtual IDE device handler obviously expects that
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	203 // the reset and setup functions were already done
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	204 // by it's bios and complains if one uses reset here...
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	205 //
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	206 #ifndef CYGSEM_DEVS_DISK_IDE_VMWARE
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	207 HAL_IDE_WRITE_CONTROL(ctlr, 6); // polled mode, reset asserted
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	208 CYGACC_CALL_IF_DELAY_US(5000U);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	209 HAL_IDE_WRITE_CONTROL(ctlr, 2); // polled mode, reset cleared
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	210 CYGACC_CALL_IF_DELAY_US(50000U);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	211 #endif
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	212
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	213 // wait 30 seconds max for not busy and drive ready
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	214 for (delay=0; delay<300; ++delay) {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	215 CYGACC_CALL_IF_DELAY_US(100000U);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	216 HAL_IDE_READ_UINT8(ctlr, IDE_REG_STATUS, status);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	217 if (!(status & IDE_STAT_BSY)) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	218 if (status & IDE_STAT_DRDY) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	219 return 1;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	220 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	221 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	222 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	223 return 0;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	224 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	225
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	226 // ----------------------------------------------------------------------------
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	227
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	228 static int
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	229 ide_ident(int ctlr, int dev, cyg_uint16 *buf)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	230 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	231 int i;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	232
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	233 if (!__wait_busy(ctlr))
1889 a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	234 return 0;
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	235
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	236 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE, dev << 4);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	237 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COMMAND, 0xEC);
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	238 CYGACC_CALL_IF_DELAY_US(50000U);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	239
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	240 if (!__wait_for_drq(ctlr))
1889 a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	241 return 0;
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	242
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	243 for (i=0; i<(CYGDAT_DEVS_DISK_IDE_SECTOR_SIZE/sizeof(cyg_uint16));
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	244 i++, buf++) {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	245 HAL_IDE_READ_UINT16(ctlr, IDE_REG_DATA, *buf);
1889 a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	246 }
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	247 return 1;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	248 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	249
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	250 // ----------------------------------------------------------------------------
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	251 // Requests the disk to use an 8-bit data path. This is probably ignored by
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	252 // most modern drives, but is supported by compact flash devices.
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	253
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	254 #ifdef CYGDAT_DEVS_DISK_IDE_8_BIT_DATA_PATH
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	255 static int
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	256 ide_8bit_mode(int ctlr, int dev, cyg_bool on)
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	257 {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	258 cyg_uint8 stat;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	259
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	260 if (!__wait_busy(ctlr))
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	261 return 0;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	262
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	263 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE, dev << 4);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	264 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_FEATURES, 0x01);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	265 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COMMAND, 0xEF);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	266
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	267 if (!__wait_busy(ctlr))
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	268 return 0;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	269
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	270 HAL_IDE_READ_UINT8(ctlr, IDE_REG_STATUS, stat);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	271 return (stat & 1) ? 0 : 1;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	272 }
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	273 #endif
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	274
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	275 // ----------------------------------------------------------------------------
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	276 // Reads a group of contiguous sectors from the drive.
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	277 // It can read up to 256 sectors.
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	278
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	279 static int
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	280 ide_read_sector(int ctlr, int dev, cyg_uint32 start,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	281 cyg_uint8 *buf, cyg_uint32 len)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	282 {
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	283 int i, nword;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	284 cyg_uint8 lenb;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	285 cyg_uint16 w;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	286
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	287 if (len==0 \|\| !__wait_busy(ctlr))
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	288 return 0;
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	289
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	290 len = MIN(len, 256);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	291 lenb = (len == 256) ? 0 : ((cyg_uint8) len);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	292
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	293 nword = len * CYGDAT_DEVS_DISK_IDE_SECTOR_SIZE / sizeof(cyg_uint16);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	294
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	295 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COUNT, lenb);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	296 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBALOW, start & 0xff);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	297 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBAMID, (start >> 8) & 0xff);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	298 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBAHI, (start >> 16) & 0xff);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	299 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	300 ((start >> 24) & 0xf) \| (dev << 4) \| 0x40);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	301 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COMMAND, 0x20);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	302
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	303 if (!__wait_for_drq(ctlr))
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	304 return 0;
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	305
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	306 if ((int) buf & 1) {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	307 // Unaligned buffer, so split each word manually
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	308 for (i=0; i<nword; i++) {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	309 HAL_IDE_READ_UINT16(ctlr, IDE_REG_DATA, w);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	310 *buf++ = w & 0xff;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	311 *buf++ = (w>>8) & 0xff;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	312 }
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	313 }
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	314 else {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	315 cyg_uint16* wbuf = (cyg_uint16*) buf;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	316 for (i=0; i<nword; i++, wbuf++)
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	317 HAL_IDE_READ_UINT16(ctlr, IDE_REG_DATA, *wbuf);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	318 }
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	319 return (int) len;
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	320 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	321
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	322 // ----------------------------------------------------------------------------
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	323 // Writes a group of contiguous sectors to the drive.
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	324 // It can write up to 256 sectors.
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	325
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	326 static int
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	327 ide_write_sector(int ctlr, int dev, cyg_uint32 start,
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	328 cyg_uint8 *buf, cyg_uint32 len)
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	329 {
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	330 int i, nword;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	331 cyg_uint8 lenb;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	332 cyg_uint16 w;
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	333
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	334 if (len==0 \|\| !__wait_busy(ctlr))
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	335 return 0;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	336
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	337 len = MIN(len, 256);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	338 lenb = (len == 256) ? 0 : ((cyg_uint8) len);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	339
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	340 nword = len * CYGDAT_DEVS_DISK_IDE_SECTOR_SIZE / sizeof(cyg_uint16);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	341
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	342 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COUNT, lenb);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	343 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBALOW, start & 0xff);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	344 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBAMID, (start >> 8) & 0xff);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	345 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBAHI, (start >> 16) & 0xff);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	346 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE,
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	347 ((start >> 24) & 0xf) \| (dev << 4) \| 0x40);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	348 HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COMMAND, 0x30);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	349
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	350 if (!__wait_for_drq(ctlr))
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	351 return 0;
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	352
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	353 if ((int) buf & 1) {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	354 // Unaligned buffer, so assemble each word manually
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	355 for (i=0; i<nword; ++i) {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	356 w = *buf++;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	357 w \|= (cyg_uint16) (*buf++) << 8;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	358 HAL_IDE_WRITE_UINT16(ctlr, IDE_REG_DATA, w);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	359 }
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	360 }
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	361 else {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	362 cyg_uint16* wbuf = (cyg_uint16*) buf;
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	363 for (i=0; i<nword; ++i)
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	364 HAL_IDE_WRITE_UINT16(ctlr, IDE_REG_DATA, *wbuf++);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	365 }
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	366 return (int) len;
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	367 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	368
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	369 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	370
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	371 static cyg_bool
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	372 ide_disk_init(struct cyg_devtab_entry *tab)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	373 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	374 disk_channel chan = (disk_channel ) tab->priv;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	375 ide_disk_info_t info = (ide_disk_info_t ) chan->dev_priv;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	376 cyg_uint32 id_buf[CYGDAT_DEVS_DISK_IDE_SECTOR_SIZE/sizeof(cyg_uint32)];
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	377 static int num_controllers;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	378 static int ide_present[4], ide_reset_done[4];
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	379 cyg_disk_identify_t ident;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	380 ide_identify_data_t ide_idData=(ide_identify_data_t)id_buf;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	381
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	382 if (chan->init)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	383 return true;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	384
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	385 D("IDE(%d:%d) hw init\n", info->port, info->chan);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	386
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	387 if (!num_controllers) num_controllers=HAL_IDE_INIT();
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	388 if (info->chan>=num_controllers) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	389 D("No IDE controller for channel %d:%d\n", info->port, info->chan);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	390 return false;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	391 }
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	392
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	393 #if CYGDAT_DEVS_DISK_IDE_STARTUP_DELAY
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	394 CYGACC_CALL_IF_DELAY_US(CYGDAT_DEVS_DISK_IDE_STARTUP_DELAY*1000U);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	395 #endif
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	396
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	397 if (!ide_present[info->port]) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	398 ide_present[info->port]=ide_presence_detect(info->port);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	399 if (!ide_present[info->port]) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	400 diag_printf("No devices on IDE controller #%d\n",info->port);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	401 return false;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	402 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	403 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	404 if (!ide_reset_done[info->port]) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	405 ide_reset_done[info->port]=ide_reset(info->port);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	406 if (!ide_reset_done[info->port]) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	407 D("Controller #%d reset failure\n",info->port);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	408 return false;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	409 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	410 }
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	411
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	412 #ifdef CYGDAT_DEVS_DISK_IDE_8_BIT_DATA_PATH
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	413 if (!ide_8bit_mode(info->port, info->chan, true)) {
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	414 D("IDE disk %d:%d failed to enter 8-bit mode\n",
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	415 info->port, info->chan);
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	416 }
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	417 #endif
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	418
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	419 D("IDE %d:%d identify drive\n", info->port, info->chan);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	420
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	421 if (!ide_ident(info->port, info->chan, (cyg_uint16 *)id_buf)) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	422 diag_printf("IDE %d:%d ident DRQ error\n", info->port, info->chan);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	423 return false;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	424 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	425
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	426 id_strcpy(ident.serial, ide_idData->serial, 20);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	427 id_strcpy(ident.firmware_rev, ide_idData->firmware_rev, 8);
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	428 id_strcpy(ident.model_num, ide_idData->model_num, 40);
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	429
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	430 ident.cylinders_num = ide_idData->num_cylinders;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	431 ident.heads_num = ide_idData->num_heads;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	432 ident.sectors_num = ide_idData->num_sectors;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	433 ident.lba_sectors_num = ide_idData->lba_total_sectors[1] << 16 \|
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	434 ide_idData->lba_total_sectors[0];
2299 04006a2b020d * src/ide_disk.h: DISK_FUNS is now implicitly static. jlarmour parents: 1889 diff changeset	435 ident.phys_block_size = 1;
2535 6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	436
6ffeb2616b4b * cdl/ide_disk.cdl: Rename of the devices to be /dev/idediskX/Y asl parents: 2318 diff changeset	437 // TODO: Should this be CYGDAT_DEVS_DISK_IDE_SECTOR_SIZE?
2299 04006a2b020d * src/ide_disk.h: DISK_FUNS is now implicitly static. jlarmour parents: 1889 diff changeset	438 ident.max_transfer = 512;
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	439
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	440 D("\tSerial : %s\n", ident.serial);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	441 D("\tFirmware rev. : %s\n", ident.firmware_rev);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	442 D("\tModel : %s\n", ident.model_num);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	443 D("\tC/H/S : %d/%d/%d\n", ident.cylinders_num,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	444 ident.heads_num, ident.sectors_num);
1889 a06d718514f8 * src/ide_disk.c: Check the device is not busy before sending a asl parents: 1814 diff changeset	445
1814 728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	446 if (!(chan->callbacks->disk_init)(tab))
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	447 return false;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	448
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	449 if (ENOERR != (chan->callbacks->disk_connected)(tab, &ident))
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	450 return false;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	451
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	452 return true;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	453 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	454
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	455 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	456
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	457 static Cyg_ErrNo
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	458 ide_disk_lookup(struct cyg_devtab_entry **tab,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	459 struct cyg_devtab_entry *sub_tab,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	460 const char *name)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	461 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	462 disk_channel chan = (disk_channel ) (*tab)->priv;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	463 return (chan->callbacks->disk_lookup)(tab, sub_tab, name);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	464 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	465
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	466 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	467
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	468 static Cyg_ErrNo
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	469 ide_disk_read(disk_channel *chan,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	470 void *buf,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	471 cyg_uint32 len,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	472 cyg_uint32 block_num)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	473 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	474 ide_disk_info_t info = (ide_disk_info_t )chan->dev_priv;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	475
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	476 D("IDE %d:%d read block %d\n", info->port, info->chan, block_num);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	477
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	478 if (!ide_read_sector(info->port, info->chan, block_num,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	479 (cyg_uint8 *)buf, len)) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	480 diag_printf("IDE %d:%d read DRQ error\n", info->port, info->chan);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	481 return -EIO;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	482 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	483
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	484 return ENOERR;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	485 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	486
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	487 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	488
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	489 static Cyg_ErrNo
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	490 ide_disk_write(disk_channel *chan,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	491 const void *buf,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	492 cyg_uint32 len,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	493 cyg_uint32 block_num)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	494 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	495 ide_disk_info_t info = (ide_disk_info_t )chan->dev_priv;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	496
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	497 D("IDE %d:%d write block %d\n", info->port, info->chan, block_num);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	498
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	499 if (!ide_write_sector(info->port, info->chan, block_num,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	500 (cyg_uint8 *)buf, len)) {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	501 diag_printf("IDE %d:%d read DRQ error\n", info->port, info->chan);
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	502 return -EIO;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	503 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	504
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	505 return ENOERR;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	506 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	507
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	508 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	509
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	510 static Cyg_ErrNo
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	511 ide_disk_get_config(disk_channel *chan,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	512 cyg_uint32 key,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	513 const void *xbuf,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	514 cyg_uint32 *len)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	515 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	516 return -EINVAL;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	517 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	518
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	519 // ----------------------------------------------------------------------------
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	520
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	521 static Cyg_ErrNo
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	522 ide_disk_set_config(disk_channel *chan,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	523 cyg_uint32 key,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	524 const void *xbuf,
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	525 cyg_uint32 *len)
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	526 {
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	527 return -EINVAL;
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	528 }
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	529
728b82c53914 Support for generic IDE using PIO. asl parents: diff changeset	530 //EOF ide_disk.c

Mercurial > ecos

annotate packages/devs/disk/ide/current/src/ide_disk.c @ 2535:6ffeb2616b4b