linux-imx

/*

 * ixp4xx PATA/Compact Flash driver

 * Copyright (C) 2006-07 Tower Technologies

 * Author: Alessandro Zummo <a.zummo@towertech.it>

 *

 * An ATA driver to handle a Compact Flash connected

 * to the ixp4xx expansion bus in TrueIDE mode. The CF

 * must have it chip selects connected to two CS lines

 * on the ixp4xx. In the irq is not available, you might

 * want to modify both this driver and libata to run in

 * polling mode.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 as

 * published by the Free Software Foundation.

 *

 */

​

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/libata.h>

#include <linux/irq.h>

#include <linux/platform_device.h>

#include <scsi/scsi_host.h>

​

#define DRV_NAME    "pata_ixp4xx_cf"

#define DRV_VERSION "0.2"

​

static int ixp4xx_set_mode(struct ata_link *link, struct ata_device **error)

{

    struct ata_device *dev;

​

    ata_for_each_dev(dev, link, ENABLED) {

        ata_dev_info(dev, "configured for PIO0\n");

        dev->pio_mode = XFER_PIO_0;

        dev->xfer_mode = XFER_PIO_0;

        dev->xfer_shift = ATA_SHIFT_PIO;

        dev->flags |= ATA_DFLAG_PIO;

    }

    return 0;

}

​

static unsigned int ixp4xx_mmio_data_xfer(struct ata_queued_cmd *qc,

                unsigned char *buf, unsigned int buflen, int rw)

{

    unsigned int i;

    unsigned int words = buflen >> 1;

    u16 *buf16 = (u16 *) buf;

    struct ata_port *ap = qc->dev->link->ap;

    void __iomem *mmio = ap->ioaddr.data_addr;

    struct ixp4xx_pata_data *data = dev_get_platdata(ap->host->dev);

​

    /* set the expansion bus in 16bit mode and restore

     * 8 bit mode after the transaction.

     */

    *data->cs0_cfg &= ~(0x01);

    udelay(100);

​

    /* Transfer multiple of 2 bytes */

    if (rw == READ)

        for (i = 0; i < words; i++)

            buf16[i] = readw(mmio);

    else

        for (i = 0; i < words; i++)

            writew(buf16[i], mmio);

​

    /* Transfer trailing 1 byte, if any. */

    if (unlikely(buflen & 0x01)) {

        u16 align_buf[1] = { 0 };

        unsigned char *trailing_buf = buf + buflen - 1;

​

        if (rw == READ) {

            align_buf[0] = readw(mmio);

            memcpy(trailing_buf, align_buf, 1);

        } else {

            memcpy(align_buf, trailing_buf, 1);

            writew(align_buf[0], mmio);

        }

        words++;

    }

​

    udelay(100);

    *data->cs0_cfg |= 0x01;

​

    return words << 1;

}

​

static struct scsi_host_template ixp4xx_sht = {

    ATA_PIO_SHT(DRV_NAME),

};

​

static struct ata_port_operations ixp4xx_port_ops = {