diff packages/devs/disk/ide/current/src/ide_disk.c @ 1814:728b82c53914

Support for generic IDE using PIO.
author asl
date Mon, 18 Oct 2004 09:03:44 +0000
parents
children a06d718514f8
line wrap: on
line diff
new file mode 100644
--- /dev/null
+++ b/packages/devs/disk/ide/current/src/ide_disk.c
@@ -0,0 +1,425 @@
+//==========================================================================
+//
+//      ide_disk.c
+//
+//      IDE polled mode disk driver 
+//
+//==========================================================================
+//####ECOSGPLCOPYRIGHTBEGIN####
+// -------------------------------------------
+// This file is part of eCos, the Embedded Configurable Operating System.
+// Copyright (C) 1998, 1999, 2000, 2001, 2002, 2004 Red Hat, Inc.
+// Copyright (C) 2004 eCosCentric, Ltd.
+//
+// eCos is free software; you can redistribute it and/or modify it under
+// the terms of the GNU General Public License as published by the Free
+// Software Foundation; either version 2 or (at your option) any later version.
+//
+// eCos is distributed in the hope that it will be useful, but WITHOUT ANY
+// WARRANTY; without even the implied warranty of MERCHANTABILITY or
+// FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
+// for more details.
+//
+// You should have received a copy of the GNU General Public License along
+// with eCos; if not, write to the Free Software Foundation, Inc.,
+// 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
+//
+// As a special exception, if other files instantiate templates or use macros
+// or inline functions from this file, or you compile this file and link it
+// with other works to produce a work based on this file, this file does not
+// by itself cause the resulting work to be covered by the GNU General Public
+// License. However the source code for this file must still be made available
+// in accordance with section (3) of the GNU General Public License.
+//
+// This exception does not invalidate any other reasons why a work based on
+// this file might be covered by the GNU General Public License.
+//
+// -------------------------------------------
+//####ECOSGPLCOPYRIGHTEND####
+//==========================================================================
+//#####DESCRIPTIONBEGIN####
+//
+// Author(s):    iz
+// Contributors: 
+// Date:         2004-10-16
+//
+//####DESCRIPTIONEND####
+//
+//==========================================================================
+
+#include <pkgconf/devs_disk_ide.h>
+
+#include <cyg/infra/cyg_type.h>
+#include <cyg/infra/cyg_ass.h>
+#include <cyg/infra/diag.h>
+#include <cyg/hal/hal_arch.h>
+#include <cyg/hal/hal_io.h>
+#include <cyg/hal/hal_if.h>             // delays
+#include <cyg/hal/drv_api.h>
+#include <cyg/io/io.h>
+#include <cyg/io/devtab.h>
+#include <cyg/io/disk.h>
+
+#include "ide_disk.h"
+
+// ----------------------------------------------------------------------------
+
+//#define DEBUG 1
+
+#ifdef DEBUG
+# define D(fmt,args...) diag_printf(fmt, ## args)
+#else
+# define D(fmt,args...)
+#endif
+
+// ----------------------------------------------------------------------------
+
+#ifdef CYGVAR_DEVS_DISK_IDE_DISK0
+IDE_DISK_INSTANCE(0, 0, 0, true, CYGDAT_IO_DISK_IDE_DISK0_NAME);
+#endif
+
+#ifdef CYGVAR_DEVS_DISK_IDE_DISK1
+IDE_DISK_INSTANCE(1, 0, 1, true, CYGDAT_IO_DISK_IDE_DISK1_NAME);
+#endif
+
+#ifdef CYGVAR_DEVS_DISK_IDE_DISK2
+IDE_DISK_INSTANCE(2, 1, 0, true, CYGDAT_IO_DISK_IDE_DISK2_NAME);
+#endif
+
+#ifdef CYGVAR_DEVS_DISK_IDE_DISK3
+IDE_DISK_INSTANCE(3, 1, 1, true, CYGDAT_IO_DISK_IDE_DISK3_NAME);
+#endif
+
+// ----------------------------------------------------------------------------
+
+static void
+id_strcpy(char *dest, cyg_uint16 *src, cyg_uint16 size)
+{
+    int i;
+
+    for (i = 0; i < size; i+=2)
+    {
+        *dest++ = (char)(*src >> 8);
+        *dest++ = (char)(*src & 0x00FF);
+        src++;
+    }
+    *dest = '\0';
+}
+
+// ----------------------------------------------------------------------------
+
+static inline void
+__wait_for_ready(int ctlr)
+{
+    cyg_uint8 status;
+    do {
+         HAL_IDE_READ_UINT8(ctlr, IDE_REG_STATUS, status);
+    } while (status & (IDE_STAT_BSY | IDE_STAT_DRQ));
+}
+
+static inline int
+__wait_for_drq(int ctlr)
+{
+    cyg_uint8 status;
+    cyg_ucount32 tries;
+
+    CYGACC_CALL_IF_DELAY_US(10);
+    for (tries=0; tries<1000000; tries++) {
+        HAL_IDE_READ_UINT8(ctlr, IDE_REG_STATUS, status);
+        if (!(status & IDE_STAT_BSY)) {
+            if (status & IDE_STAT_DRQ)
+                return 1;
+            else
+                return 0;
+        }
+    }
+}
+
+// Return true if any devices attached to controller
+static int
+ide_presence_detect(int ctlr)
+{
+    cyg_uint8 sel, val;
+    int i;
+
+    for (i = 0; i < 2; i++) {
+        sel = (i << 4) | 0xA0;
+        CYGACC_CALL_IF_DELAY_US((cyg_uint32)50000);
+        HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE, sel);
+        CYGACC_CALL_IF_DELAY_US((cyg_uint32)50000);
+        HAL_IDE_READ_UINT8(ctlr, IDE_REG_DEVICE, val);
+        if (val == sel) {
+#ifndef CYGSEM_DEVS_DISK_IDE_VMWARE
+            if (i)
+                HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE, 0);
+#endif
+            return 1;
+        }
+    }
+    return 0;
+}
+
+static int
+ide_reset(int ctlr)
+{
+    cyg_uint8 status;
+    int delay;
+//
+// VMware note:
+// VMware virtual IDE device handler obviously expects that
+// the reset and setup functions were already done
+// by it's bios and complains if one uses reset here...
+//
+#ifndef CYGSEM_DEVS_DISK_IDE_VMWARE
+    HAL_IDE_WRITE_CONTROL(ctlr, 6);    // polled mode, reset asserted
+    CYGACC_CALL_IF_DELAY_US(5000);
+    HAL_IDE_WRITE_CONTROL(ctlr, 2);   // polled mode, reset cleared
+    CYGACC_CALL_IF_DELAY_US((cyg_uint32)50000);
+#endif
+
+    // wait 30 seconds max for not busy and drive ready
+    for (delay = 0; delay < 300; ++delay) {
+        CYGACC_CALL_IF_DELAY_US((cyg_uint32)100000);
+        HAL_IDE_READ_UINT8(ctlr, IDE_REG_STATUS, status);
+            if (!(status & IDE_STAT_BSY)) {
+                if (status & IDE_STAT_DRDY) {
+                    return 1;
+                }
+            }
+    }
+    return 0;
+}
+
+static int
+ide_ident(int ctlr, int dev, cyg_uint16 *buf)
+{
+    int i;
+
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE, dev << 4);
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COMMAND, 0xEC);
+    CYGACC_CALL_IF_DELAY_US((cyg_uint32)50000);
+
+    if (!__wait_for_drq(ctlr))
+        return 0;
+
+    for (i = 0; i < (CYGDAT_DEVS_DISK_IDE_SECTOR_SIZE / sizeof(cyg_uint16));
+         i++, buf++)
+        HAL_IDE_READ_UINT16(ctlr, IDE_REG_DATA, *buf);
+
+    return 1;
+}
+
+static int
+ide_read_sector(int ctlr, int dev, cyg_uint32 start, 
+                cyg_uint8 *buf, cyg_uint32 len)
+{
+    int j, c;
+    cyg_uint16 p;
+    cyg_uint8 * b=buf;
+
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COUNT, 1);    // count =1
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBALOW, start & 0xff);
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBAMID, (start >>  8) & 0xff);
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBAHI,  (start >> 16) & 0xff);
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE,
+          ((start >> 24) & 0xf) | (dev << 4) | 0x40);
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COMMAND, 0x20);
+
+    if (!__wait_for_drq(ctlr))
+        return 0;
+    // 
+    // It would be fine if all buffers were word aligned,
+    // but who knows
+    //
+    for (j = 0, c=0 ; j < (CYGDAT_DEVS_DISK_IDE_SECTOR_SIZE / sizeof(cyg_uint16));
+         j++) {
+        HAL_IDE_READ_UINT16(ctlr, IDE_REG_DATA, p);
+        if (c++<len) *b++=p&0xff;
+        if (c++<len) *b++=(p>>8)&0xff;
+    }
+    return 1;
+}
+
+static int
+ide_write_sector(int ctlr, int dev, cyg_uint32 start, 
+                cyg_uint8 *buf, cyg_uint32 len)
+{
+    int j, c;
+    cyg_uint16 p;
+    cyg_uint8 * b=buf;
+
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COUNT, 1);    // count =1
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBALOW, start & 0xff);
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBAMID, (start >>  8) & 0xff);
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_LBAHI,  (start >> 16) & 0xff);
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_DEVICE,
+          ((start >> 24) & 0xf) | (dev << 4) | 0x40);
+    HAL_IDE_WRITE_UINT8(ctlr, IDE_REG_COMMAND, 0x30);
+
+    if (!__wait_for_drq(ctlr))
+        return 0;
+    // 
+    // It would be fine if all buffers were word aligned,
+    // but who knows
+    //
+    for (j = 0, c=0 ; j < (CYGDAT_DEVS_DISK_IDE_SECTOR_SIZE / sizeof(cyg_uint16));
+         j++) {
+        p = (c++<len) ? *b++ : 0;
+        p |= (c++<len) ? (*b++<<8) : 0; 
+        HAL_IDE_WRITE_UINT16(ctlr, IDE_REG_DATA, p);
+    }
+    return 1;
+}
+
+// ----------------------------------------------------------------------------
+
+static cyg_bool 
+ide_disk_init(struct cyg_devtab_entry *tab)
+{
+    disk_channel *chan = (disk_channel *) tab->priv;
+    ide_disk_info_t *info = (ide_disk_info_t *) chan->dev_priv;
+    cyg_uint32 id_buf[CYGDAT_DEVS_DISK_IDE_SECTOR_SIZE/sizeof(cyg_uint32)];
+    static int num_controllers;
+    static int ide_present[4], ide_reset_done[4];
+    cyg_disk_identify_t ident;
+    ide_identify_data_t *ide_idData=(ide_identify_data_t*)id_buf;
+    
+    if (chan->init) 
+        return true;
+
+    D("IDE(%d:%d) hw init\n", info->port, info->chan);
+    
+    if (!num_controllers) num_controllers=HAL_IDE_INIT();
+    if (info->chan>=num_controllers) {
+        D("No IDE controller for channel %d:%d\n", info->port, info->chan);
+        return false;
+    }
+    if (!ide_present[info->port]) {
+        ide_present[info->port]=ide_presence_detect(info->port);
+        if (!ide_present[info->port]) {
+            diag_printf("No devices on IDE controller #%d\n",info->port);
+            return false;
+        }
+    }
+    if (!ide_reset_done[info->port]) {
+        ide_reset_done[info->port]=ide_reset(info->port);
+        if (!ide_reset_done[info->port]) {
+            D("Controller #%d reset failure\n",info->port);
+            return false;
+        }
+    }
+    
+    D("IDE %d:%d identify drive\n", info->port, info->chan);
+    
+    if (!ide_ident(info->port, info->chan, (cyg_uint16 *)id_buf)) {
+        diag_printf("IDE %d:%d ident DRQ error\n", info->port, info->chan);
+        return false;
+    }
+
+    id_strcpy(ident.serial, ide_idData->serial,       20);
+    id_strcpy(ident.firmware_rev, ide_idData->firmware_rev, 8);
+    id_strcpy(ident.model_num, ide_idData->model_num,    40);
+    
+    ident.cylinders_num  = ide_idData->num_cylinders;
+    ident.heads_num = ide_idData->num_heads;
+    ident.sectors_num = ide_idData->num_sectors;
+    ident.lba_sectors_num = ide_idData->lba_total_sectors[1] << 16 | 
+                            ide_idData->lba_total_sectors[0];
+    
+    D("\tSerial : %s\n", ident.serial);
+    D("\tFirmware rev. : %s\n", ident.firmware_rev);
+    D("\tModel : %s\n", ident.model_num);
+    D("\tC/H/S : %d/%d/%d\n", ident.cylinders_num, 
+                              ident.heads_num, ident.sectors_num);
+    D("\tKind : %x\n", (ide_idData->general_conf>>8)&0x1f);
+    
+    if (((ide_idData->general_conf>>8)&0x1f)!=2) {
+        diag_printf("IDE device %d:%d is not a hard disk!\n",
+                    info->port, info->chan);
+        return false;
+    }
+    if (!(chan->callbacks->disk_init)(tab))
+        return false;
+
+    if (ENOERR != (chan->callbacks->disk_connected)(tab, &ident))
+        return false;
+
+    return true;
+}
+
+// ----------------------------------------------------------------------------
+
+static Cyg_ErrNo 
+ide_disk_lookup(struct cyg_devtab_entry **tab, 
+                struct cyg_devtab_entry  *sub_tab,
+                const char *name)
+{
+    disk_channel *chan = (disk_channel *) (*tab)->priv;
+    return (chan->callbacks->disk_lookup)(tab, sub_tab, name);
+}
+
+// ----------------------------------------------------------------------------
+
+static Cyg_ErrNo 
+ide_disk_read(disk_channel *chan, 
+              void         *buf,
+              cyg_uint32    len, 
+              cyg_uint32    block_num)
+{
+    ide_disk_info_t *info = (ide_disk_info_t *)chan->dev_priv;
+
+    D("IDE %d:%d read block %d\n", info->port, info->chan, block_num);
+
+    if (!ide_read_sector(info->port, info->chan, block_num, 
+                         (cyg_uint8 *)buf, len)) {
+        diag_printf("IDE %d:%d read DRQ error\n", info->port, info->chan);
+        return -EIO; 
+    }
+
+    return ENOERR;
+}
+
+// ----------------------------------------------------------------------------
+
+static Cyg_ErrNo 
+ide_disk_write(disk_channel *chan, 
+               const void   *buf,
+               cyg_uint32    len, 
+               cyg_uint32    block_num)
+{
+    ide_disk_info_t *info = (ide_disk_info_t *)chan->dev_priv;
+
+    D("IDE %d:%d write block %d\n", info->port, info->chan, block_num);
+
+    if (!ide_write_sector(info->port, info->chan, block_num, 
+                         (cyg_uint8 *)buf, len)) {
+        diag_printf("IDE %d:%d read DRQ error\n", info->port, info->chan);
+        return -EIO; 
+    }
+        
+    return ENOERR;
+}
+
+// ----------------------------------------------------------------------------
+
+static Cyg_ErrNo
+ide_disk_get_config(disk_channel *chan, 
+                    cyg_uint32    key,
+                    const void   *xbuf, 
+                    cyg_uint32   *len)
+{
+    return -EINVAL;
+}
+
+// ----------------------------------------------------------------------------
+
+static Cyg_ErrNo
+ide_disk_set_config(disk_channel *chan, 
+                    cyg_uint32    key,
+                    const void   *xbuf, 
+                    cyg_uint32   *len)
+{
+    return -EINVAL;
+}
+
+//EOF ide_disk.c