linux-imx

/*

 *  Q40 I/O port IDE Driver

 *

 *     (c) Richard Zidlicky

 *

 *  This file is subject to the terms and conditions of the GNU General Public

 *  License.  See the file COPYING in the main directory of this archive for

 *  more details.

 *

 *

 */

​

#include <linux/types.h>

#include <linux/mm.h>

#include <linux/interrupt.h>

#include <linux/blkdev.h>

#include <linux/ide.h>

#include <linux/module.h>

​

#include <asm/ide.h>

​

    /*

     *  Bases of the IDE interfaces

     */

​

#define Q40IDE_NUM_HWIFS    2

​

#define PCIDE_BASE1 0x1f0

#define PCIDE_BASE2 0x170

#define PCIDE_BASE3 0x1e8

#define PCIDE_BASE4 0x168

#define PCIDE_BASE5 0x1e0

#define PCIDE_BASE6 0x160

​

static const unsigned long pcide_bases[Q40IDE_NUM_HWIFS] = {

    PCIDE_BASE1, PCIDE_BASE2, /* PCIDE_BASE3, PCIDE_BASE4  , PCIDE_BASE5,

    PCIDE_BASE6 */

};

​

static int q40ide_default_irq(unsigned long base)

{

           switch (base) {

                case 0x1f0: return 14;

            case 0x170: return 15;

            case 0x1e8: return 11;

            default:

            return 0;

       }

}

​

​

/*

 * Addresses are pretranslated for Q40 ISA access.

 */

static void q40_ide_setup_ports(struct ide_hw *hw, unsigned long base, int irq)

{

    memset(hw, 0, sizeof(*hw));

    /* BIG FAT WARNING: 

       assumption: only DATA port is ever used in 16 bit mode */

    hw->io_ports.data_addr = Q40_ISA_IO_W(base);

    hw->io_ports.error_addr = Q40_ISA_IO_B(base + 1);

    hw->io_ports.nsect_addr = Q40_ISA_IO_B(base + 2);

    hw->io_ports.lbal_addr = Q40_ISA_IO_B(base + 3);

    hw->io_ports.lbam_addr = Q40_ISA_IO_B(base + 4);

    hw->io_ports.lbah_addr = Q40_ISA_IO_B(base + 5);

    hw->io_ports.device_addr = Q40_ISA_IO_B(base + 6);

    hw->io_ports.status_addr = Q40_ISA_IO_B(base + 7);

    hw->io_ports.ctl_addr = Q40_ISA_IO_B(base + 0x206);

​

    hw->irq = irq;

}

​

static void q40ide_input_data(ide_drive_t *drive, struct ide_cmd *cmd,

                  void *buf, unsigned int len)

{

    unsigned long data_addr = drive->hwif->io_ports.data_addr;

​

    if (drive->media == ide_disk && cmd && (cmd->tf_flags & IDE_TFLAG_FS)) {

        __ide_mm_insw(data_addr, buf, (len + 1) / 2);

        return;

    }

​

    raw_insw_swapw((u16 *)data_addr, buf, (len + 1) / 2);

}

​

static void q40ide_output_data(ide_drive_t *drive, struct ide_cmd *cmd,

                   void *buf, unsigned int len)

{

    unsigned long data_addr = drive->hwif->io_ports.data_addr;

​

    if (drive->media == ide_disk && cmd && (cmd->tf_flags & IDE_TFLAG_FS)) {

        __ide_mm_outsw(data_addr, buf, (len + 1) / 2);