root/drivers/ata/pata_parport/epat.c
// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * (c) 1997-1998  Grant R. Guenther <grant@torque.net>
 *
 * This is the low level protocol driver for the EPAT parallel
 * to IDE adapter from Shuttle Technologies.  This adapter is
 * used in many popular parallel port disk products such as the
 * SyQuest EZ drives, the Avatar Shark and the Imation SuperDisk.
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/wait.h>
#include <asm/io.h>
#include "pata_parport.h"

#define j44(a, b)       (((a >> 4) & 0x0f) + (b & 0xf0))
#define j53(a, b)       (((a >> 3) & 0x1f) + ((b << 4) & 0xe0))

static int epatc8;

module_param(epatc8, int, 0);
MODULE_PARM_DESC(epatc8,
                 "support for the Shuttle EP1284 chip, "
                 "used in any recent Imation SuperDisk (LS-120) drive.");

/*
 * cont =  0   IDE register file
 * cont =  1   IDE control registers
 * cont =  2   internal EPAT registers
 */
static int cont_map[3] = { 0x18, 0x10, 0 };

static void epat_write_regr(struct pi_adapter *pi, int cont, int regr, int val)
{
        int r = regr + cont_map[cont];

        switch (pi->mode) {
        case 0:
        case 1:
        case 2:
                w0(0x60+r); w2(1); w0(val); w2(4);
                break;
        case 3:
        case 4:
        case 5:
                w3(0x40+r); w4(val);
                break;
        }
}

static int epat_read_regr(struct pi_adapter *pi, int cont, int regr)
{
        int  a, b, r;

        r = regr + cont_map[cont];

        switch (pi->mode) {

        case 0:
                w0(r); w2(1); w2(3);
                a = r1(); w2(4); b = r1();
                return j44(a, b);
        case 1:
                w0(0x40+r); w2(1); w2(4);
                a = r1(); b = r2(); w0(0xff);
                return j53(a, b);
        case 2:
                w0(0x20+r); w2(1); w2(0x25);
                a = r0(); w2(4);
                return a;
        case 3:
        case 4:
        case 5:
                w3(r); w2(0x24); a = r4(); w2(4);
                return a;
        }

        return -1;      /* never gets here */
}

static void epat_read_block(struct pi_adapter *pi, char *buf, int count)
{
        int  k, ph, a, b;

        switch (pi->mode) {

        case 0:
                w0(7); w2(1); w2(3); w0(0xff);
                ph = 0;
                for (k = 0; k < count; k++) {
                        if (k == count-1)
                                w0(0xfd);
                        w2(6 + ph); a = r1();
                        if (a & 8) {
                                b = a;
                        } else {
                                w2(4+ph); b = r1();
                        }
                        buf[k] = j44(a, b);
                        ph =  1 - ph;
                }
                w0(0); w2(4);
                break;

        case 1:
                w0(0x47); w2(1); w2(5); w0(0xff);
                ph = 0;
                for (k = 0; k < count; k++) {
                        if (k == count - 1)
                                w0(0xfd);
                        w2(4 + ph);
                        a = r1(); b = r2();
                        buf[k] = j53(a, b);
                        ph = 1 - ph;
                }
                w0(0); w2(4);
                break;

        case 2:
                w0(0x27); w2(1); w2(0x25); w0(0);
                ph = 0;
                for (k = 0; k < count - 1; k++) {
                        w2(0x24 + ph);
                        buf[k] = r0();
                        ph = 1 - ph;
                }
                w2(0x26); w2(0x27);
                buf[count - 1] = r0();
                w2(0x25); w2(4);
                break;

        case 3:
                w3(0x80); w2(0x24);
                for (k = 0; k < count - 1; k++)
                        buf[k] = r4();
                w2(4); w3(0xa0); w2(0x24);
                buf[count - 1] = r4();
                w2(4);
                break;

        case 4:
                w3(0x80); w2(0x24);
                for (k = 0; k < count / 2 - 1; k++)
                        ((u16 *)buf)[k] = r4w();
                buf[count - 2] = r4();
                w2(4); w3(0xa0); w2(0x24);
                buf[count - 1] = r4();
                w2(4);
                break;

        case 5:
                w3(0x80); w2(0x24);
                for (k = 0; k < count / 4 - 1; k++)
                        ((u32 *)buf)[k] = r4l();
                for (k = count - 4; k < count - 1; k++)
                        buf[k] = r4();
                w2(4); w3(0xa0); w2(0x24);
                buf[count - 1] = r4();
                w2(4);
                break;
        }
}

static void epat_write_block(struct pi_adapter *pi, char *buf, int count)
{
        int ph, k;

        switch (pi->mode) {
        case 0:
        case 1:
        case 2:
                w0(0x67); w2(1); w2(5);
                ph = 0;
                for (k = 0; k < count; k++) {
                        w0(buf[k]);
                        w2(4 + ph);
                        ph = 1 - ph;
                }
                w2(7); w2(4);
                break;
        case 3:
                w3(0xc0);
                for (k = 0; k < count; k++)
                        w4(buf[k]);
                w2(4);
                break;
        case 4:
                w3(0xc0);
                for (k = 0; k < count / 2; k++)
                        w4w(((u16 *)buf)[k]);
                w2(4);
                break;
        case 5:
                w3(0xc0);
                for (k = 0; k < count / 4; k++)
                        w4l(((u32 *)buf)[k]);
                w2(4);
                break;
        }
}

/* these macros access the EPAT registers in native addressing */

#define WR(r, v)        epat_write_regr(pi, 2, r, v)
#define RR(r)           epat_read_regr(pi, 2, r)

/* and these access the IDE task file */

#define WRi(r, v)       epat_write_regr(pi, 0, r, v)
#define RRi(r)          epat_read_regr(pi, 0, r)

/* FIXME:  the CPP stuff should be fixed to handle multiple EPATs on a chain */

#define CPP(x)                                  \
        do {                                    \
                w2(4); w0(0x22); w0(0xaa);      \
                w0(0x55); w0(0); w0(0xff);      \
                w0(0x87); w0(0x78); w0(x);      \
                w2(4); w2(5); w2(4); w0(0xff);  \
        } while (0)

static void epat_connect(struct pi_adapter *pi)
{
        pi->saved_r0 = r0();
        pi->saved_r2 = r2();

        /* Initialize the chip */
        CPP(0);

        if (epatc8) {
                CPP(0x40); CPP(0xe0);
                w0(0); w2(1); w2(4);
                WR(0x8, 0x12);
                WR(0xc, 0x14);
                WR(0x12, 0x10);
                WR(0xe, 0xf);
                WR(0xf, 4);
                /* WR(0xe,0xa);WR(0xf,4); */
                WR(0xe, 0xd);
                WR(0xf, 0);
                /* CPP(0x30); */
        }

        /* Connect to the chip */
        CPP(0xe0);
        w0(0); w2(1); w2(4); /* Idle into SPP */
        if (pi->mode >= 3) {
                w0(0); w2(1); w2(4); w2(0xc);
                /* Request EPP */
                w0(0x40); w2(6); w2(7); w2(4); w2(0xc); w2(4);
        }

        if (!epatc8) {
                WR(8, 0x10);
                WR(0xc, 0x14);
                WR(0xa, 0x38);
                WR(0x12, 0x10);
        }
}

static void epat_disconnect(struct pi_adapter *pi)
{
        CPP(0x30);
        w0(pi->saved_r0);
        w2(pi->saved_r2);
}

static int epat_test_proto(struct pi_adapter *pi)
{
        int k, j, f, cc;
        int e[2] = { 0, 0 };
        char scratch[512];

        epat_connect(pi);
        cc = RR(0xd);
        epat_disconnect(pi);

        epat_connect(pi);
        for (j=0;j<2;j++) {
                WRi(6, 0xa0 + j * 0x10);
                for (k = 0; k < 256; k++) {
                        WRi(2, k ^ 0xaa);
                        WRi(3, k ^ 0x55);
                        if (RRi(2) != (k ^ 0xaa))
                                e[j]++;
                }
        }
        epat_disconnect(pi);

        f = 0;
        epat_connect(pi);
        WR(0x13, 1); WR(0x13, 0); WR(0xa, 0x11);
        epat_read_block(pi, scratch, 512);

        for (k = 0; k < 256; k++) {
                if ((scratch[2 * k] & 0xff) != k)
                        f++;
                if ((scratch[2 * k + 1] & 0xff) != 0xff - k)
                        f++;
        }
        epat_disconnect(pi);

        dev_dbg(&pi->dev,
                "epat: port 0x%x, mode %d, ccr %x, test=(%d,%d,%d)\n",
                pi->port, pi->mode, cc, e[0], e[1], f);

        return (e[0] && e[1]) || f;
}

static void epat_log_adapter(struct pi_adapter *pi)
{
        int ver;
        char *mode_string[6] =
                { "4-bit", "5/3", "8-bit", "EPP-8", "EPP-16", "EPP-32" };

        epat_connect(pi);
        WR(0xa, 0x38);          /* read the version code */
        ver = RR(0xb);
        epat_disconnect(pi);

        dev_info(&pi->dev,
                 "Shuttle EPAT chip %x at 0x%x, mode %d (%s), delay %d\n",
                 ver, pi->port, pi->mode, mode_string[pi->mode], pi->delay);
}

static struct pi_protocol epat = {
        .owner          = THIS_MODULE,
        .name           = "epat",
        .max_mode       = 6,
        .epp_first      = 3,
        .default_delay  = 1,
        .max_units      = 1,
        .write_regr     = epat_write_regr,
        .read_regr      = epat_read_regr,
        .write_block    = epat_write_block,
        .read_block     = epat_read_block,
        .connect        = epat_connect,
        .disconnect     = epat_disconnect,
        .test_proto     = epat_test_proto,
        .log_adapter    = epat_log_adapter,
};

static int __init epat_init(void)
{
#ifdef CONFIG_PATA_PARPORT_EPATC8
        epatc8 = 1;
#endif
        return pata_parport_register_driver(&epat);
}

static void __exit epat_exit(void)
{
        pata_parport_unregister_driver(&epat);
}

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Grant R. Guenther <grant@torque.net>");
MODULE_DESCRIPTION("Shuttle Technologies EPAT parallel port IDE adapter "
                   "protocol driver");
module_init(epat_init)
module_exit(epat_exit)