linux-imx

// SPDX-License-Identifier: GPL-2.0

​

/*

 * Amiga Gayle PATA controller driver

 *

 * Copyright (c) 2018 Samsung Electronics Co., Ltd.

 *      http://www.samsung.com

 *

 * Based on gayle.c:

 *

 *     Created 12 Jul 1997 by Geert Uytterhoeven

 */

​

#include <linux/ata.h>

#include <linux/blkdev.h>

#include <linux/delay.h>

#include <linux/interrupt.h>

#include <linux/kernel.h>

#include <linux/libata.h>

#include <linux/mm.h>

#include <linux/module.h>

#include <linux/platform_device.h>

#include <linux/zorro.h>

#include <scsi/scsi_cmnd.h>

#include <scsi/scsi_host.h>

​

#include <asm/amigahw.h>

#include <asm/amigaints.h>

#include <asm/amigayle.h>

#include <asm/ide.h>

#include <asm/setup.h>

​

#define DRV_NAME "pata_gayle"

#define DRV_VERSION "0.1.0"

​

#define GAYLE_CONTROL   0x101a

​

static struct scsi_host_template pata_gayle_sht = {

    ATA_PIO_SHT(DRV_NAME),

};

​

/* FIXME: is this needed? */

static unsigned int pata_gayle_data_xfer(struct ata_queued_cmd *qc,

                     unsigned char *buf,

                     unsigned int buflen, int rw)

{

    struct ata_device *dev = qc->dev;

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

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

    unsigned int words = buflen >> 1;

​

    /* Transfer multiple of 2 bytes */

    if (rw == READ)

        raw_insw((u16 *)data_addr, (u16 *)buf, words);

    else

        raw_outsw((u16 *)data_addr, (u16 *)buf, words);

​

    /* Transfer trailing byte, if any. */

    if (unlikely(buflen & 0x01)) {

        unsigned char pad[2] = { };

​

        /* Point buf to the tail of buffer */

        buf += buflen - 1;

​

        if (rw == READ) {

            raw_insw((u16 *)data_addr, (u16 *)pad, 1);

            *buf = pad[0];

        } else {

            pad[0] = *buf;

            raw_outsw((u16 *)data_addr, (u16 *)pad, 1);

        }

        words++;

    }

​

    return words << 1;

}

​

/*

 * Provide our own set_mode() as we don't want to change anything that has

 * already been configured..

 */

static int pata_gayle_set_mode(struct ata_link *link,

                   struct ata_device **unused)

{

    struct ata_device *dev;

​

    ata_for_each_dev(dev, link, ENABLED) {

        /* We don't really care */

        dev->pio_mode = dev->xfer_mode = XFER_PIO_0;

        dev->xfer_shift = ATA_SHIFT_PIO;

        dev->flags |= ATA_DFLAG_PIO;

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