Linux-2.6.12-rc2

[linux-flexiantxendom0-natty.git] / drivers / scsi / arm / fas216.c

/*
 *  linux/drivers/acorn/scsi/fas216.c
 *
 *  Copyright (C) 1997-2003 Russell King
 *
 * 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.
 *
 * Based on information in qlogicfas.c by Tom Zerucha, Michael Griffith, and
 * other sources, including:
 *   the AMD Am53CF94 data sheet
 *   the AMD Am53C94 data sheet
 *
 * This is a generic driver.  To use it, have a look at cumana_2.c.  You
 * should define your own structure that overlays FAS216_Info, eg:
 * struct my_host_data {
 *    FAS216_Info info;
 *    ... my host specific data ...
 * };
 *
 * Changelog:
 *  30-08-1997  RMK     Created
 *  14-09-1997  RMK     Started disconnect support
 *  08-02-1998  RMK     Corrected real DMA support
 *  15-02-1998  RMK     Started sync xfer support
 *  06-04-1998  RMK     Tightened conditions for printing incomplete
 *                      transfers
 *  02-05-1998  RMK     Added extra checks in fas216_reset
 *  24-05-1998  RMK     Fixed synchronous transfers with period >= 200ns
 *  27-06-1998  RMK     Changed asm/delay.h to linux/delay.h
 *  26-08-1998  RMK     Improved message support wrt MESSAGE_REJECT
 *  02-04-2000  RMK     Converted to use the new error handling, and
 *                      automatically request sense data upon check
 *                      condition status from targets.
 */
#include <linux/module.h>
#include <linux/blkdev.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/ioport.h>
#include <linux/sched.h>
#include <linux/proc_fs.h>
#include <linux/delay.h>
#include <linux/bitops.h>
#include <linux/init.h>
#include <linux/interrupt.h>

#include <asm/dma.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/ecard.h>

#include "../scsi.h"
#include <scsi/scsi_host.h>
#include "fas216.h"
#include "scsi.h"

/* NOTE: SCSI2 Synchronous transfers *require* DMA according to
 *  the data sheet.  This restriction is crazy, especially when
 *  you only want to send 16 bytes!  What were the guys who
 *  designed this chip on at that time?  Did they read the SCSI2
 *  spec at all?  The following sections are taken from the SCSI2
 *  standard (s2r10) concerning this:
 *
 * > IMPLEMENTORS NOTES:
 * >   (1)  Re-negotiation at every selection is not recommended, since a
 * >   significant performance impact is likely.
 *
 * >  The implied synchronous agreement shall remain in effect until a BUS DEVICE
 * >  RESET message is received, until a hard reset condition occurs, or until one
 * >  of the two SCSI devices elects to modify the agreement.  The default data
 * >  transfer mode is asynchronous data transfer mode.  The default data transfer
 * >  mode is entered at power on, after a BUS DEVICE RESET message, or after a hard
 * >  reset condition.
 *
 *  In total, this means that once you have elected to use synchronous
 *  transfers, you must always use DMA.
 *
 *  I was thinking that this was a good chip until I found this restriction ;(
 */
#define SCSI2_SYNC
#undef  SCSI2_TAG

#undef DEBUG_CONNECT
#undef DEBUG_MESSAGES

#undef CHECK_STRUCTURE

#define LOG_CONNECT             (1 << 0)
#define LOG_BUSSERVICE          (1 << 1)
#define LOG_FUNCTIONDONE        (1 << 2)
#define LOG_MESSAGES            (1 << 3)
#define LOG_BUFFER              (1 << 4)
#define LOG_ERROR               (1 << 8)

static int level_mask = LOG_ERROR;

module_param(level_mask, int, 0644);

static int __init fas216_log_setup(char *str)
{
        char *s;

        level_mask = 0;

        while ((s = strsep(&str, ",")) != NULL) {
                switch (s[0]) {
                case 'a':
                        if (strcmp(s, "all") == 0)
                                level_mask |= -1;
                        break;
                case 'b':
                        if (strncmp(s, "bus", 3) == 0)
                                level_mask |= LOG_BUSSERVICE;
                        if (strncmp(s, "buf", 3) == 0)
                                level_mask |= LOG_BUFFER;
                        break;
                case 'c':
                        level_mask |= LOG_CONNECT;
                        break;
                case 'e':
                        level_mask |= LOG_ERROR;
                        break;
                case 'm':
                        level_mask |= LOG_MESSAGES;
                        break;
                case 'n':
                        if (strcmp(s, "none") == 0)
                                level_mask = 0;
                        break;
                case 's':
                        level_mask |= LOG_FUNCTIONDONE;
                        break;
                }
        }
        return 1;
}

__setup("fas216_logging=", fas216_log_setup);

static inline unsigned char fas216_readb(FAS216_Info *info, unsigned int reg)
{
        unsigned int off = reg << info->scsi.io_shift;
        return readb(info->scsi.io_base + off);
}

static inline void fas216_writeb(FAS216_Info *info, unsigned int reg, unsigned int val)
{
        unsigned int off = reg << info->scsi.io_shift;
        writeb(val, info->scsi.io_base + off);
}

static void fas216_dumpstate(FAS216_Info *info)
{
        unsigned char is, stat, inst;

        is   = fas216_readb(info, REG_IS);
        stat = fas216_readb(info, REG_STAT);
        inst = fas216_readb(info, REG_INST);
        
        printk("FAS216: CTCL=%02X CTCM=%02X CMD=%02X STAT=%02X"
               " INST=%02X IS=%02X CFIS=%02X",
                fas216_readb(info, REG_CTCL),
                fas216_readb(info, REG_CTCM),
                fas216_readb(info, REG_CMD),  stat, inst, is,
                fas216_readb(info, REG_CFIS));
        printk(" CNTL1=%02X CNTL2=%02X CNTL3=%02X CTCH=%02X\n",
                fas216_readb(info, REG_CNTL1),
                fas216_readb(info, REG_CNTL2),
                fas216_readb(info, REG_CNTL3),
                fas216_readb(info, REG_CTCH));
}

static void print_SCp(Scsi_Pointer *SCp, const char *prefix, const char *suffix)
{
        printk("%sptr %p this_residual 0x%x buffer %p buffers_residual 0x%x%s",
                prefix, SCp->ptr, SCp->this_residual, SCp->buffer,
                SCp->buffers_residual, suffix);
}

static void fas216_dumpinfo(FAS216_Info *info)
{
        static int used = 0;
        int i;

        if (used++)
                return;

        printk("FAS216_Info=\n");
        printk("  { magic_start=%lX host=%p SCpnt=%p origSCpnt=%p\n",
                info->magic_start, info->host, info->SCpnt,
                info->origSCpnt);
        printk("    scsi={ io_shift=%X irq=%X cfg={ %X %X %X %X }\n",
                info->scsi.io_shift, info->scsi.irq,
                info->scsi.cfg[0], info->scsi.cfg[1], info->scsi.cfg[2],
                info->scsi.cfg[3]);
        printk("           type=%p phase=%X\n",
                info->scsi.type, info->scsi.phase);
        print_SCp(&info->scsi.SCp, "           SCp={ ", " }\n");
        printk("      msgs async_stp=%X disconnectable=%d aborting=%d }\n",
                info->scsi.async_stp,
                info->scsi.disconnectable, info->scsi.aborting);
        printk("    stats={ queues=%X removes=%X fins=%X reads=%X writes=%X miscs=%X\n"
               "            disconnects=%X aborts=%X bus_resets=%X host_resets=%X}\n",
                info->stats.queues, info->stats.removes, info->stats.fins,
                info->stats.reads, info->stats.writes, info->stats.miscs,
                info->stats.disconnects, info->stats.aborts, info->stats.bus_resets,
                info->stats.host_resets);
        printk("    ifcfg={ clockrate=%X select_timeout=%X asyncperiod=%X sync_max_depth=%X }\n",
                info->ifcfg.clockrate, info->ifcfg.select_timeout,
                info->ifcfg.asyncperiod, info->ifcfg.sync_max_depth);
        for (i = 0; i < 8; i++) {
                printk("    busyluns[%d]=%08lx dev[%d]={ disconnect_ok=%d stp=%X sof=%X sync_state=%X }\n",
                        i, info->busyluns[i], i,
                        info->device[i].disconnect_ok, info->device[i].stp,
                        info->device[i].sof, info->device[i].sync_state);
        }
        printk("    dma={ transfer_type=%X setup=%p pseudo=%p stop=%p }\n",
                info->dma.transfer_type, info->dma.setup,
                info->dma.pseudo, info->dma.stop);
        printk("    internal_done=%X magic_end=%lX }\n",
                info->internal_done, info->magic_end);
}

#ifdef CHECK_STRUCTURE
static void __fas216_checkmagic(FAS216_Info *info, const char *func)
{
        int corruption = 0;
        if (info->magic_start != MAGIC) {
                printk(KERN_CRIT "FAS216 Error: magic at start corrupted\n");
                corruption++;
        }
        if (info->magic_end != MAGIC) {
                printk(KERN_CRIT "FAS216 Error: magic at end corrupted\n");
                corruption++;
        }
        if (corruption) {
                fas216_dumpinfo(info);
                panic("scsi memory space corrupted in %s", func);
        }
}
#define fas216_checkmagic(info) __fas216_checkmagic((info), __FUNCTION__)
#else
#define fas216_checkmagic(info)
#endif

static const char *fas216_bus_phase(int stat)
{
        static const char *phases[] = {
                "DATA OUT", "DATA IN",
                "COMMAND", "STATUS",
                "MISC OUT", "MISC IN",
                "MESG OUT", "MESG IN"
        };

        return phases[stat & STAT_BUSMASK];
}

static const char *fas216_drv_phase(FAS216_Info *info)
{
        static const char *phases[] = {
                [PHASE_IDLE]            = "idle",
                [PHASE_SELECTION]       = "selection",
                [PHASE_COMMAND]         = "command",
                [PHASE_DATAOUT]         = "data out",
                [PHASE_DATAIN]          = "data in",
                [PHASE_MSGIN]           = "message in",
                [PHASE_MSGIN_DISCONNECT]= "disconnect",
                [PHASE_MSGOUT_EXPECT]   = "expect message out",
                [PHASE_MSGOUT]          = "message out",
                [PHASE_STATUS]          = "status",
                [PHASE_DONE]            = "done",
        };

        if (info->scsi.phase < ARRAY_SIZE(phases) &&
            phases[info->scsi.phase])
                return phases[info->scsi.phase];
        return "???";
}

static char fas216_target(FAS216_Info *info)
{
        if (info->SCpnt)
                return '0' + info->SCpnt->device->id;
        else
                return 'H';
}

static void
fas216_do_log(FAS216_Info *info, char target, char *fmt, va_list ap)
{
        static char buf[1024];

        vsnprintf(buf, sizeof(buf), fmt, ap);
        printk("scsi%d.%c: %s", info->host->host_no, target, buf);
}

static void
fas216_log_command(FAS216_Info *info, int level, Scsi_Cmnd *SCpnt, char *fmt, ...)
{
        va_list args;

        if (level != 0 && !(level & level_mask))
                return;

        va_start(args, fmt);
        fas216_do_log(info, '0' + SCpnt->device->id, fmt, args);
        va_end(args);

        printk(" CDB: ");
        print_command(SCpnt->cmnd);
}

static void
fas216_log_target(FAS216_Info *info, int level, int target, char *fmt, ...)
{
        va_list args;

        if (level != 0 && !(level & level_mask))
                return;

        if (target < 0)
                target = 'H';
        else
                target += '0';

        va_start(args, fmt);
        fas216_do_log(info, target, fmt, args);
        va_end(args);

        printk("\n");
}

static void fas216_log(FAS216_Info *info, int level, char *fmt, ...)
{
        va_list args;

        if (level != 0 && !(level & level_mask))
                return;

        va_start(args, fmt);
        fas216_do_log(info, fas216_target(info), fmt, args);
        va_end(args);

        printk("\n");
}

#define PH_SIZE 32

static struct { int stat, ssr, isr, ph; } ph_list[PH_SIZE];
static int ph_ptr;

static void add_debug_list(int stat, int ssr, int isr, int ph)
{
        ph_list[ph_ptr].stat = stat;
        ph_list[ph_ptr].ssr = ssr;
        ph_list[ph_ptr].isr = isr;
        ph_list[ph_ptr].ph = ph;

        ph_ptr = (ph_ptr + 1) & (PH_SIZE-1);
}

static struct { int command; void *from; } cmd_list[8];
static int cmd_ptr;

static void fas216_cmd(FAS216_Info *info, unsigned int command)
{
        cmd_list[cmd_ptr].command = command;
        cmd_list[cmd_ptr].from = __builtin_return_address(0);

        cmd_ptr = (cmd_ptr + 1) & 7;

        fas216_writeb(info, REG_CMD, command);
}

static void print_debug_list(void)
{
        int i;

        i = ph_ptr;

        printk(KERN_ERR "SCSI IRQ trail\n");
        do {
                printk(" %02x:%02x:%02x:%1x",
                        ph_list[i].stat, ph_list[i].ssr,
                        ph_list[i].isr, ph_list[i].ph);
                i = (i + 1) & (PH_SIZE - 1);
                if (((i ^ ph_ptr) & 7) == 0)
                        printk("\n");
        } while (i != ph_ptr);
        if ((i ^ ph_ptr) & 7)
                printk("\n");

        i = cmd_ptr;
        printk(KERN_ERR "FAS216 commands: ");
        do {
                printk("%02x:%p ", cmd_list[i].command, cmd_list[i].from);
                i = (i + 1) & 7;
        } while (i != cmd_ptr);
        printk("\n");
}

static void fas216_done(FAS216_Info *info, unsigned int result);

/**
 * fas216_get_last_msg - retrive last message from the list
 * @info: interface to search
 * @pos: current fifo position
 *
 * Retrieve a last message from the list, using position in fifo.
 */
static inline unsigned short
fas216_get_last_msg(FAS216_Info *info, int pos)
{
        unsigned short packed_msg = NOP;
        struct message *msg;
        int msgnr = 0;

        while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) {
                if (pos >= msg->fifo)
                        break;
        }

        if (msg) {
                if (msg->msg[0] == EXTENDED_MESSAGE)
                        packed_msg = EXTENDED_MESSAGE | msg->msg[2] << 8;
                else
                        packed_msg = msg->msg[0];
        }

        fas216_log(info, LOG_MESSAGES,
                "Message: %04x found at position %02x\n", packed_msg, pos);

        return packed_msg;
}

/**
 * fas216_syncperiod - calculate STP register value
 * @info: state structure for interface connected to device
 * @ns: period in ns (between subsequent bytes)
 *
 * Calculate value to be loaded into the STP register for a given period
 * in ns. Returns a value suitable for REG_STP.
 */
static int fas216_syncperiod(FAS216_Info *info, int ns)
{
        int value = (info->ifcfg.clockrate * ns) / 1000;

        fas216_checkmagic(info);

        if (value < 4)
                value = 4;
        else if (value > 35)
                value = 35;

        return value & 31;
}

/**
 * fas216_set_sync - setup FAS216 chip for specified transfer period.
 * @info: state structure for interface connected to device
 * @target: target
 *
 * Correctly setup FAS216 chip for specified transfer period.
 * Notes   : we need to switch the chip out of FASTSCSI mode if we have
 *           a transfer period >= 200ns - otherwise the chip will violate
 *           the SCSI timings.
 */
static void fas216_set_sync(FAS216_Info *info, int target)
{
        unsigned int cntl3;

        fas216_writeb(info, REG_SOF, info->device[target].sof);
        fas216_writeb(info, REG_STP, info->device[target].stp);

        cntl3 = info->scsi.cfg[2];
        if (info->device[target].period >= (200 / 4))
                cntl3 = cntl3 & ~CNTL3_FASTSCSI;

        fas216_writeb(info, REG_CNTL3, cntl3);
}

/* Synchronous transfer support
 *
 * Note: The SCSI II r10 spec says (5.6.12):
 *
 *  (2)  Due to historical problems with early host adapters that could
 *  not accept an SDTR message, some targets may not initiate synchronous
 *  negotiation after a power cycle as required by this standard.  Host
 *  adapters that support synchronous mode may avoid the ensuing failure
 *  modes when the target is independently power cycled by initiating a
 *  synchronous negotiation on each REQUEST SENSE and INQUIRY command.
 *  This approach increases the SCSI bus overhead and is not recommended
 *  for new implementations.  The correct method is to respond to an
 *  SDTR message with a MESSAGE REJECT message if the either the
 *  initiator or target devices does not support synchronous transfers
 *  or does not want to negotiate for synchronous transfers at the time.
 *  Using the correct method assures compatibility with wide data
 *  transfers and future enhancements.
 *
 * We will always initiate a synchronous transfer negotiation request on
 * every INQUIRY or REQUEST SENSE message, unless the target itself has
 * at some point performed a synchronous transfer negotiation request, or
 * we have synchronous transfers disabled for this device.
 */

/**
 * fas216_handlesync - Handle a synchronous transfer message
 * @info: state structure for interface
 * @msg: message from target
 *
 * Handle a synchronous transfer message from the target
 */
static void fas216_handlesync(FAS216_Info *info, char *msg)
{
        struct fas216_device *dev = &info->device[info->SCpnt->device->id];
        enum { sync, async, none, reject } res = none;

#ifdef SCSI2_SYNC
        switch (msg[0]) {
        case MESSAGE_REJECT:
                /* Synchronous transfer request failed.
                 * Note: SCSI II r10:
                 *
                 *  SCSI devices that are capable of synchronous
                 *  data transfers shall not respond to an SDTR
                 *  message with a MESSAGE REJECT message.
                 *
                 * Hence, if we get this condition, we disable
                 * negotiation for this device.
                 */
                if (dev->sync_state == neg_inprogress) {
                        dev->sync_state = neg_invalid;
                        res = async;
                }
                break;

        case EXTENDED_MESSAGE:
                switch (dev->sync_state) {
                /* We don't accept synchronous transfer requests.
                 * Respond with a MESSAGE_REJECT to prevent a
                 * synchronous transfer agreement from being reached.
                 */
                case neg_invalid:
                        res = reject;
                        break;

                /* We were not negotiating a synchronous transfer,
                 * but the device sent us a negotiation request.
                 * Honour the request by sending back a SDTR
                 * message containing our capability, limited by
                 * the targets capability.
                 */
                default:
                        fas216_cmd(info, CMD_SETATN);
                        if (msg[4] > info->ifcfg.sync_max_depth)
                                msg[4] = info->ifcfg.sync_max_depth;
                        if (msg[3] < 1000 / info->ifcfg.clockrate)
                                msg[3] = 1000 / info->ifcfg.clockrate;

                        msgqueue_flush(&info->scsi.msgs);
                        msgqueue_addmsg(&info->scsi.msgs, 5,
                                        EXTENDED_MESSAGE, 3, EXTENDED_SDTR,
                                        msg[3], msg[4]);
                        info->scsi.phase = PHASE_MSGOUT_EXPECT;

                        /* This is wrong.  The agreement is not in effect
                         * until this message is accepted by the device
                         */
                        dev->sync_state = neg_targcomplete;
                        res = sync;
                        break;

                /* We initiated the synchronous transfer negotiation,
                 * and have successfully received a response from the
                 * target.  The synchronous transfer agreement has been
                 * reached.  Note: if the values returned are out of our
                 * bounds, we must reject the message.
                 */
                case neg_inprogress:
                        res = reject;
                        if (msg[4] <= info->ifcfg.sync_max_depth &&
                            msg[3] >= 1000 / info->ifcfg.clockrate) {
                                dev->sync_state = neg_complete;
                                res = sync;
                        }
                        break;
                }
        }
#else
        res = reject;
#endif

        switch (res) {
        case sync:
                dev->period = msg[3];
                dev->sof    = msg[4];
                dev->stp    = fas216_syncperiod(info, msg[3] * 4);
                fas216_set_sync(info, info->SCpnt->device->id);
                break;

        case reject:
                fas216_cmd(info, CMD_SETATN);
                msgqueue_flush(&info->scsi.msgs);
                msgqueue_addmsg(&info->scsi.msgs, 1, MESSAGE_REJECT);
                info->scsi.phase = PHASE_MSGOUT_EXPECT;

        case async:
                dev->period = info->ifcfg.asyncperiod / 4;
                dev->sof    = 0;
                dev->stp    = info->scsi.async_stp;
                fas216_set_sync(info, info->SCpnt->device->id);
                break;

        case none:
                break;
        }
}

/**
 * fas216_updateptrs - update data pointers after transfer suspended/paused
 * @info: interface's local pointer to update
 * @bytes_transferred: number of bytes transferred
 *
 * Update data pointers after transfer suspended/paused
 */
static void fas216_updateptrs(FAS216_Info *info, int bytes_transferred)
{
        Scsi_Pointer *SCp = &info->scsi.SCp;

        fas216_checkmagic(info);

        BUG_ON(bytes_transferred < 0);

        info->SCpnt->request_bufflen -= bytes_transferred;

        while (bytes_transferred != 0) {
                if (SCp->this_residual > bytes_transferred)
                        break;
                /*
                 * We have used up this buffer.  Move on to the
                 * next buffer.
                 */
                bytes_transferred -= SCp->this_residual;
                if (!next_SCp(SCp) && bytes_transferred) {
                        printk(KERN_WARNING "scsi%d.%c: out of buffers\n",
                                info->host->host_no, '0' + info->SCpnt->device->id);
                        return;
                }
        }

        SCp->this_residual -= bytes_transferred;
        if (SCp->this_residual)
                SCp->ptr += bytes_transferred;
        else
                SCp->ptr = NULL;
}

/**
 * fas216_pio - transfer data off of/on to card using programmed IO
 * @info: interface to transfer data to/from
 * @direction: direction to transfer data (DMA_OUT/DMA_IN)
 *
 * Transfer data off of/on to card using programmed IO.
 * Notes: this is incredibly slow.
 */
static void fas216_pio(FAS216_Info *info, fasdmadir_t direction)
{
        Scsi_Pointer *SCp = &info->scsi.SCp;

        fas216_checkmagic(info);

        if (direction == DMA_OUT)
                fas216_writeb(info, REG_FF, get_next_SCp_byte(SCp));
        else
                put_next_SCp_byte(SCp, fas216_readb(info, REG_FF));

        if (SCp->this_residual == 0)
                next_SCp(SCp);
}

static void fas216_set_stc(FAS216_Info *info, unsigned int length)
{
        fas216_writeb(info, REG_STCL, length);
        fas216_writeb(info, REG_STCM, length >> 8);
        fas216_writeb(info, REG_STCH, length >> 16);
}

static unsigned int fas216_get_ctc(FAS216_Info *info)
{
        return fas216_readb(info, REG_CTCL) +
               (fas216_readb(info, REG_CTCM) << 8) +
               (fas216_readb(info, REG_CTCH) << 16);
}

/**
 * fas216_cleanuptransfer - clean up after a transfer has completed.
 * @info: interface to clean up
 *
 * Update the data pointers according to the number of bytes transferred
 * on the SCSI bus.
 */
static void fas216_cleanuptransfer(FAS216_Info *info)
{
        unsigned long total, residual, fifo;
        fasdmatype_t dmatype = info->dma.transfer_type;

        info->dma.transfer_type = fasdma_none;

        /*
         * PIO transfers do not need to be cleaned up.
         */
        if (dmatype == fasdma_pio || dmatype == fasdma_none)
                return;

        if (dmatype == fasdma_real_all)
                total = info->SCpnt->request_bufflen;
        else
                total = info->scsi.SCp.this_residual;

        residual = fas216_get_ctc(info);

        fifo = fas216_readb(info, REG_CFIS) & CFIS_CF;

        fas216_log(info, LOG_BUFFER, "cleaning up from previous "
                   "transfer: length 0x%06x, residual 0x%x, fifo %d",
                   total, residual, fifo);

        /*
         * If we were performing Data-Out, the transfer counter
         * counts down each time a byte is transferred by the
         * host to the FIFO.  This means we must include the
         * bytes left in the FIFO from the transfer counter.
         */
        if (info->scsi.phase == PHASE_DATAOUT)
                residual += fifo;

        fas216_updateptrs(info, total - residual);
}

/**
 * fas216_transfer - Perform a DMA/PIO transfer off of/on to card
 * @info: interface from which device disconnected from
 *
 * Start a DMA/PIO transfer off of/on to card
 */
static void fas216_transfer(FAS216_Info *info)
{
        fasdmadir_t direction;
        fasdmatype_t dmatype;

        fas216_log(info, LOG_BUFFER,
                   "starttransfer: buffer %p length 0x%06x reqlen 0x%06x",
                   info->scsi.SCp.ptr, info->scsi.SCp.this_residual,
                   info->SCpnt->request_bufflen);

        if (!info->scsi.SCp.ptr) {
                fas216_log(info, LOG_ERROR, "null buffer passed to "
                           "fas216_starttransfer");
                print_SCp(&info->scsi.SCp, "SCp: ", "\n");
                print_SCp(&info->SCpnt->SCp, "Cmnd SCp: ", "\n");
                return;
        }

        /*
         * If we have a synchronous transfer agreement in effect, we must
         * use DMA mode.  If we are using asynchronous transfers, we may
         * use DMA mode or PIO mode.
         */
        if (info->device[info->SCpnt->device->id].sof)
                dmatype = fasdma_real_all;
        else
                dmatype = fasdma_pio;

        if (info->scsi.phase == PHASE_DATAOUT)
                direction = DMA_OUT;
        else
                direction = DMA_IN;

        if (info->dma.setup)
                dmatype = info->dma.setup(info->host, &info->scsi.SCp,
                                          direction, dmatype);
        info->dma.transfer_type = dmatype;

        if (dmatype == fasdma_real_all)
                fas216_set_stc(info, info->SCpnt->request_bufflen);
        else
                fas216_set_stc(info, info->scsi.SCp.this_residual);

        switch (dmatype) {
        case fasdma_pio:
                fas216_log(info, LOG_BUFFER, "PIO transfer");
                fas216_writeb(info, REG_SOF, 0);
                fas216_writeb(info, REG_STP, info->scsi.async_stp);
                fas216_cmd(info, CMD_TRANSFERINFO);
                fas216_pio(info, direction);
                break;

        case fasdma_pseudo:
                fas216_log(info, LOG_BUFFER, "pseudo transfer");
                fas216_cmd(info, CMD_TRANSFERINFO | CMD_WITHDMA);
                info->dma.pseudo(info->host, &info->scsi.SCp,
                                 direction, info->SCpnt->transfersize);
                break;

        case fasdma_real_block:
                fas216_log(info, LOG_BUFFER, "block dma transfer");
                fas216_cmd(info, CMD_TRANSFERINFO | CMD_WITHDMA);
                break;

        case fasdma_real_all:
                fas216_log(info, LOG_BUFFER, "total dma transfer");
                fas216_cmd(info, CMD_TRANSFERINFO | CMD_WITHDMA);
                break;

        default:
                fas216_log(info, LOG_BUFFER | LOG_ERROR,
                           "invalid FAS216 DMA type");
                break;
        }
}

/**
 * fas216_stoptransfer - Stop a DMA transfer onto / off of the card
 * @info: interface from which device disconnected from
 *
 * Called when we switch away from DATA IN or DATA OUT phases.
 */
static void fas216_stoptransfer(FAS216_Info *info)
{
        fas216_checkmagic(info);

        if (info->dma.transfer_type == fasdma_real_all ||
            info->dma.transfer_type == fasdma_real_block)
                info->dma.stop(info->host, &info->scsi.SCp);

        fas216_cleanuptransfer(info);

        if (info->scsi.phase == PHASE_DATAIN) {
                unsigned int fifo;

                /*
                 * If we were performing Data-In, then the FIFO counter
                 * contains the number of bytes not transferred via DMA
                 * from the on-board FIFO.  Read them manually.
                 */
                fifo = fas216_readb(info, REG_CFIS) & CFIS_CF;
                while (fifo && info->scsi.SCp.ptr) {
                        *info->scsi.SCp.ptr = fas216_readb(info, REG_FF);
                        fas216_updateptrs(info, 1);
                        fifo--;
                }
        } else {
                /*
                 * After a Data-Out phase, there may be unsent
                 * bytes left in the FIFO.  Flush them out.
                 */
                fas216_cmd(info, CMD_FLUSHFIFO);
        }
}

static void fas216_aborttransfer(FAS216_Info *info)
{
        fas216_checkmagic(info);

        if (info->dma.transfer_type == fasdma_real_all ||
            info->dma.transfer_type == fasdma_real_block)
                info->dma.stop(info->host, &info->scsi.SCp);

        info->dma.transfer_type = fasdma_none;
        fas216_cmd(info, CMD_FLUSHFIFO);
}

static void fas216_kick(FAS216_Info *info);

/**
 * fas216_disconnected_intr - handle device disconnection
 * @info: interface from which device disconnected from
 *
 * Handle device disconnection
 */
static void fas216_disconnect_intr(FAS216_Info *info)
{
        unsigned long flags;

        fas216_checkmagic(info);

        fas216_log(info, LOG_CONNECT, "disconnect phase=%02x",
                   info->scsi.phase);

        msgqueue_flush(&info->scsi.msgs);

        switch (info->scsi.phase) {
        case PHASE_SELECTION:                   /* while selecting - no target          */
        case PHASE_SELSTEPS:
                fas216_done(info, DID_NO_CONNECT);
                break;

        case PHASE_MSGIN_DISCONNECT:            /* message in - disconnecting           */
                info->scsi.disconnectable = 1;
                info->scsi.phase = PHASE_IDLE;
                info->stats.disconnects += 1;
                spin_lock_irqsave(&info->host_lock, flags);
                if (info->scsi.phase == PHASE_IDLE)
                        fas216_kick(info);
                spin_unlock_irqrestore(&info->host_lock, flags);
                break;

        case PHASE_DONE:                        /* at end of command - complete         */
                fas216_done(info, DID_OK);
                break;

        case PHASE_MSGOUT:                      /* message out - possible ABORT message */
                if (fas216_get_last_msg(info, info->scsi.msgin_fifo) == ABORT) {
                        info->scsi.aborting = 0;
                        fas216_done(info, DID_ABORT);
                        break;
                }

        default:                                /* huh?                                 */
                printk(KERN_ERR "scsi%d.%c: unexpected disconnect in phase %s\n",
                        info->host->host_no, fas216_target(info), fas216_drv_phase(info));
                print_debug_list();
                fas216_stoptransfer(info);
                fas216_done(info, DID_ERROR);
                break;
        }
}

/**
 * fas216_reselected_intr - start reconnection of a device
 * @info: interface which was reselected
 *
 * Start reconnection of a device
 */
static void
fas216_reselected_intr(FAS216_Info *info)
{
        unsigned int cfis, i;
        unsigned char msg[4];
        unsigned char target, lun, tag;

        fas216_checkmagic(info);

        WARN_ON(info->scsi.phase == PHASE_SELECTION ||
                info->scsi.phase == PHASE_SELSTEPS);

        cfis = fas216_readb(info, REG_CFIS);

        fas216_log(info, LOG_CONNECT, "reconnect phase=%02x cfis=%02x",
                   info->scsi.phase, cfis);

        cfis &= CFIS_CF;

        if (cfis < 2 || cfis > 4) {
                printk(KERN_ERR "scsi%d.H: incorrect number of bytes after reselect\n",
                        info->host->host_no);
                goto bad_message;
        }

        for (i = 0; i < cfis; i++)
                msg[i] = fas216_readb(info, REG_FF);

        if (!(msg[0] & (1 << info->host->this_id)) ||
            !(msg[1] & 0x80))
                goto initiator_error;

        target = msg[0] & ~(1 << info->host->this_id);
        target = ffs(target) - 1;
        lun = msg[1] & 7;
        tag = 0;

        if (cfis >= 3) {
                if (msg[2] != SIMPLE_QUEUE_TAG)
                        goto initiator_error;

                tag = msg[3];
        }

        /* set up for synchronous transfers */
        fas216_writeb(info, REG_SDID, target);
        fas216_set_sync(info, target);
        msgqueue_flush(&info->scsi.msgs);

        fas216_log(info, LOG_CONNECT, "Reconnected: target %1x lun %1x tag %02x",
                   target, lun, tag);

        if (info->scsi.disconnectable && info->SCpnt) {
                info->scsi.disconnectable = 0;
                if (info->SCpnt->device->id  == target &&
                    info->SCpnt->device->lun == lun &&
                    info->SCpnt->tag         == tag) {
                        fas216_log(info, LOG_CONNECT, "reconnected previously executing command");
                } else {
                        queue_add_cmd_tail(&info->queues.disconnected, info->SCpnt);
                        fas216_log(info, LOG_CONNECT, "had to move command to disconnected queue");
                        info->SCpnt = NULL;
                }
        }
        if (!info->SCpnt) {
                info->SCpnt = queue_remove_tgtluntag(&info->queues.disconnected,
                                        target, lun, tag);
                fas216_log(info, LOG_CONNECT, "had to get command");
        }

        if (info->SCpnt) {
                /*
                 * Restore data pointer from SAVED data pointer
                 */
                info->scsi.SCp = info->SCpnt->SCp;

                fas216_log(info, LOG_CONNECT, "data pointers: [%p, %X]",
                        info->scsi.SCp.ptr, info->scsi.SCp.this_residual);
                info->scsi.phase = PHASE_MSGIN;
        } else {
                /*
                 * Our command structure not found - abort the
                 * command on the target.  Since we have no
                 * record of this command, we can't send
                 * an INITIATOR DETECTED ERROR message.
                 */
                fas216_cmd(info, CMD_SETATN);

#if 0
                if (tag)
                        msgqueue_addmsg(&info->scsi.msgs, 2, ABORT_TAG, tag);
                else
#endif
                        msgqueue_addmsg(&info->scsi.msgs, 1, ABORT);
                info->scsi.phase = PHASE_MSGOUT_EXPECT;
                info->scsi.aborting = 1;
        }

        fas216_cmd(info, CMD_MSGACCEPTED);
        return;

 initiator_error:
        printk(KERN_ERR "scsi%d.H: error during reselection: bytes",
                info->host->host_no);
        for (i = 0; i < cfis; i++)
                printk(" %02x", msg[i]);
        printk("\n");
 bad_message:
        fas216_cmd(info, CMD_SETATN);
        msgqueue_flush(&info->scsi.msgs);
        msgqueue_addmsg(&info->scsi.msgs, 1, INITIATOR_ERROR);
        info->scsi.phase = PHASE_MSGOUT_EXPECT;
        fas216_cmd(info, CMD_MSGACCEPTED);
}

static void fas216_parse_message(FAS216_Info *info, unsigned char *message, int msglen)
{
        int i;

        switch (message[0]) {
        case COMMAND_COMPLETE:
                if (msglen != 1)
                        goto unrecognised;

                printk(KERN_ERR "scsi%d.%c: command complete with no "
                        "status in MESSAGE_IN?\n",
                        info->host->host_no, fas216_target(info));
                break;

        case SAVE_POINTERS:
                if (msglen != 1)
                        goto unrecognised;

                /*
                 * Save current data pointer to SAVED data pointer
                 * SCSI II standard says that we must not acknowledge
                 * this until we have really saved pointers.
                 * NOTE: we DO NOT save the command nor status pointers
                 * as required by the SCSI II standard.  These always
                 * point to the start of their respective areas.
                 */
                info->SCpnt->SCp = info->scsi.SCp;
                info->SCpnt->SCp.sent_command = 0;
                fas216_log(info, LOG_CONNECT | LOG_MESSAGES | LOG_BUFFER,
                        "save data pointers: [%p, %X]",
                        info->scsi.SCp.ptr, info->scsi.SCp.this_residual);
                break;

        case RESTORE_POINTERS:
                if (msglen != 1)
                        goto unrecognised;

                /*
                 * Restore current data pointer from SAVED data pointer
                 */
                info->scsi.SCp = info->SCpnt->SCp;
                fas216_log(info, LOG_CONNECT | LOG_MESSAGES | LOG_BUFFER,
                        "restore data pointers: [%p, 0x%x]",
                        info->scsi.SCp.ptr, info->scsi.SCp.this_residual);
                break;

        case DISCONNECT:
                if (msglen != 1)
                        goto unrecognised;

                info->scsi.phase = PHASE_MSGIN_DISCONNECT;
                break;

        case MESSAGE_REJECT:
                if (msglen != 1)
                        goto unrecognised;

                switch (fas216_get_last_msg(info, info->scsi.msgin_fifo)) {
                case EXTENDED_MESSAGE | EXTENDED_SDTR << 8:
                        fas216_handlesync(info, message);
                        break;

                default:
                        fas216_log(info, 0, "reject, last message 0x%04x",
                                fas216_get_last_msg(info, info->scsi.msgin_fifo));
                }
                break;

        case NOP:
                break;

        case EXTENDED_MESSAGE:
                if (msglen < 3)
                        goto unrecognised;

                switch (message[2]) {
                case EXTENDED_SDTR:     /* Sync transfer negotiation request/reply */
                        fas216_handlesync(info, message);
                        break;

                default:
                        goto unrecognised;
                }
                break;

        default:
                goto unrecognised;
        }
        return;

unrecognised:
        fas216_log(info, 0, "unrecognised message, rejecting");
        printk("scsi%d.%c: message was", info->host->host_no, fas216_target(info));
        for (i = 0; i < msglen; i++)
                printk("%s%02X", i & 31 ? " " : "\n  ", message[i]);
        printk("\n");

        /*
         * Something strange seems to be happening here -
         * I can't use SETATN since the chip gives me an
         * invalid command interrupt when I do.  Weird.
         */
fas216_cmd(info, CMD_NOP);
fas216_dumpstate(info);
        fas216_cmd(info, CMD_SETATN);
        msgqueue_flush(&info->scsi.msgs);
        msgqueue_addmsg(&info->scsi.msgs, 1, MESSAGE_REJECT);
        info->scsi.phase = PHASE_MSGOUT_EXPECT;
fas216_dumpstate(info);
}

static int fas216_wait_cmd(FAS216_Info *info, int cmd)
{
        int tout;
        int stat;

        fas216_cmd(info, cmd);

        for (tout = 1000; tout; tout -= 1) {
                stat = fas216_readb(info, REG_STAT);
                if (stat & (STAT_INT|STAT_PARITYERROR))
                        break;
                udelay(1);
        }

        return stat;
}

static int fas216_get_msg_byte(FAS216_Info *info)
{
        unsigned int stat = fas216_wait_cmd(info, CMD_MSGACCEPTED);

        if ((stat & STAT_INT) == 0)
                goto timedout;

        if ((stat & STAT_BUSMASK) != STAT_MESGIN)
                goto unexpected_phase_change;

        fas216_readb(info, REG_INST);

        stat = fas216_wait_cmd(info, CMD_TRANSFERINFO);

        if ((stat & STAT_INT) == 0)
                goto timedout;

        if (stat & STAT_PARITYERROR)
                goto parity_error;

        if ((stat & STAT_BUSMASK) != STAT_MESGIN)
                goto unexpected_phase_change;

        fas216_readb(info, REG_INST);

        return fas216_readb(info, REG_FF);

timedout:
        fas216_log(info, LOG_ERROR, "timed out waiting for message byte");
        return -1;

unexpected_phase_change:
        fas216_log(info, LOG_ERROR, "unexpected phase change: status = %02x", stat);
        return -2;

parity_error:
        fas216_log(info, LOG_ERROR, "parity error during message in phase");
        return -3;
}

/**
 * fas216_message - handle a function done interrupt from FAS216 chip
 * @info: interface which caused function done interrupt
 *
 * Handle a function done interrupt from FAS216 chip
 */
static void fas216_message(FAS216_Info *info)
{
        unsigned char *message = info->scsi.message;
        unsigned int msglen = 1;
        int msgbyte = 0;

        fas216_checkmagic(info);

        message[0] = fas216_readb(info, REG_FF);

        if (message[0] == EXTENDED_MESSAGE) {
                msgbyte = fas216_get_msg_byte(info);

                if (msgbyte >= 0) {
                        message[1] = msgbyte;

                        for (msglen = 2; msglen < message[1] + 2; msglen++) {
                                msgbyte = fas216_get_msg_byte(info);

                                if (msgbyte >= 0)
                                        message[msglen] = msgbyte;
                                else
                                        break;
                        }
                }
        }

        if (msgbyte == -3)
                goto parity_error;

#ifdef DEBUG_MESSAGES
        {
                int i;

                printk("scsi%d.%c: message in: ",
                        info->host->host_no, fas216_target(info));
                for (i = 0; i < msglen; i++)
                        printk("%02X ", message[i]);
                printk("\n");
        }
#endif

        fas216_parse_message(info, message, msglen);
        fas216_cmd(info, CMD_MSGACCEPTED);
        return;

parity_error:
        fas216_cmd(info, CMD_SETATN);
        msgqueue_flush(&info->scsi.msgs);
        msgqueue_addmsg(&info->scsi.msgs, 1, MSG_PARITY_ERROR);
        info->scsi.phase = PHASE_MSGOUT_EXPECT;
        fas216_cmd(info, CMD_MSGACCEPTED);
        return;
}

/**
 * fas216_send_command - send command after all message bytes have been sent
 * @info: interface which caused bus service
 *
 * Send a command to a target after all message bytes have been sent
 */
static void fas216_send_command(FAS216_Info *info)
{
        int i;

        fas216_checkmagic(info);

        fas216_cmd(info, CMD_NOP|CMD_WITHDMA);
        fas216_cmd(info, CMD_FLUSHFIFO);

        /* load command */
        for (i = info->scsi.SCp.sent_command; i < info->SCpnt->cmd_len; i++)
                fas216_writeb(info, REG_FF, info->SCpnt->cmnd[i]);

        fas216_cmd(info, CMD_TRANSFERINFO);

        info->scsi.phase = PHASE_COMMAND;
}

/**
 * fas216_send_messageout - handle bus service to send a message
 * @info: interface which caused bus service
 *
 * Handle bus service to send a message.
 * Note: We do not allow the device to change the data direction!
 */
static void fas216_send_messageout(FAS216_Info *info, int start)
{
        unsigned int tot_msglen = msgqueue_msglength(&info->scsi.msgs);

        fas216_checkmagic(info);

        fas216_cmd(info, CMD_FLUSHFIFO);

        if (tot_msglen) {
                struct message *msg;
                int msgnr = 0;

                while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) {
                        int i;

                        for (i = start; i < msg->length; i++)
                                fas216_writeb(info, REG_FF, msg->msg[i]);

                        msg->fifo = tot_msglen - (fas216_readb(info, REG_CFIS) & CFIS_CF);
                        start = 0;
                }
        } else
                fas216_writeb(info, REG_FF, NOP);

        fas216_cmd(info, CMD_TRANSFERINFO);

        info->scsi.phase = PHASE_MSGOUT;
}

/**
 * fas216_busservice_intr - handle bus service interrupt from FAS216 chip
 * @info: interface which caused bus service interrupt
 * @stat: Status register contents
 * @is: SCSI Status register contents
 *
 * Handle a bus service interrupt from FAS216 chip
 */
static void fas216_busservice_intr(FAS216_Info *info, unsigned int stat, unsigned int is)
{
        fas216_checkmagic(info);

        fas216_log(info, LOG_BUSSERVICE,
                   "bus service: stat=%02x is=%02x phase=%02x",
                   stat, is, info->scsi.phase);

        switch (info->scsi.phase) {
        case PHASE_SELECTION:
                if ((is & IS_BITS) != IS_MSGBYTESENT)
                        goto bad_is;
                break;

        case PHASE_SELSTEPS:
                switch (is & IS_BITS) {
                case IS_SELARB:
                case IS_MSGBYTESENT:
                        goto bad_is;

                case IS_NOTCOMMAND:
                case IS_EARLYPHASE:
                        if ((stat & STAT_BUSMASK) == STAT_MESGIN)
                                break;
                        goto bad_is;

                case IS_COMPLETE:
                        break;
                }

        default:
                break;
        }

        fas216_cmd(info, CMD_NOP);

#define STATE(st,ph) ((ph) << 3 | (st))
        /* This table describes the legal SCSI state transitions,
         * as described by the SCSI II spec.
         */
        switch (STATE(stat & STAT_BUSMASK, info->scsi.phase)) {
        case STATE(STAT_DATAIN, PHASE_SELSTEPS):/* Sel w/ steps -> Data In      */
        case STATE(STAT_DATAIN, PHASE_MSGOUT):  /* Message Out  -> Data In      */
        case STATE(STAT_DATAIN, PHASE_COMMAND): /* Command      -> Data In      */
        case STATE(STAT_DATAIN, PHASE_MSGIN):   /* Message In   -> Data In      */
                info->scsi.phase = PHASE_DATAIN;
                fas216_transfer(info);
                return;

        case STATE(STAT_DATAIN, PHASE_DATAIN):  /* Data In      -> Data In      */
        case STATE(STAT_DATAOUT, PHASE_DATAOUT):/* Data Out     -> Data Out     */
                fas216_cleanuptransfer(info);
                fas216_transfer(info);
                return;

        case STATE(STAT_DATAOUT, PHASE_SELSTEPS):/* Sel w/ steps-> Data Out     */
        case STATE(STAT_DATAOUT, PHASE_MSGOUT): /* Message Out  -> Data Out     */
        case STATE(STAT_DATAOUT, PHASE_COMMAND):/* Command      -> Data Out     */
        case STATE(STAT_DATAOUT, PHASE_MSGIN):  /* Message In   -> Data Out     */
                fas216_cmd(info, CMD_FLUSHFIFO);
                info->scsi.phase = PHASE_DATAOUT;
                fas216_transfer(info);
                return;

        case STATE(STAT_STATUS, PHASE_DATAOUT): /* Data Out     -> Status       */
        case STATE(STAT_STATUS, PHASE_DATAIN):  /* Data In      -> Status       */
                fas216_stoptransfer(info);
        case STATE(STAT_STATUS, PHASE_SELSTEPS):/* Sel w/ steps -> Status       */
        case STATE(STAT_STATUS, PHASE_MSGOUT):  /* Message Out  -> Status       */
        case STATE(STAT_STATUS, PHASE_COMMAND): /* Command      -> Status       */
        case STATE(STAT_STATUS, PHASE_MSGIN):   /* Message In   -> Status       */
                fas216_cmd(info, CMD_INITCMDCOMPLETE);
                info->scsi.phase = PHASE_STATUS;
                return;

        case STATE(STAT_MESGIN, PHASE_DATAOUT): /* Data Out     -> Message In   */
        case STATE(STAT_MESGIN, PHASE_DATAIN):  /* Data In      -> Message In   */
                fas216_stoptransfer(info);
        case STATE(STAT_MESGIN, PHASE_COMMAND): /* Command      -> Message In   */
        case STATE(STAT_MESGIN, PHASE_SELSTEPS):/* Sel w/ steps -> Message In   */
        case STATE(STAT_MESGIN, PHASE_MSGOUT):  /* Message Out  -> Message In   */
                info->scsi.msgin_fifo = fas216_readb(info, REG_CFIS) & CFIS_CF;
                fas216_cmd(info, CMD_FLUSHFIFO);
                fas216_cmd(info, CMD_TRANSFERINFO);
                info->scsi.phase = PHASE_MSGIN;
                return;

        case STATE(STAT_MESGIN, PHASE_MSGIN):
                info->scsi.msgin_fifo = fas216_readb(info, REG_CFIS) & CFIS_CF;
                fas216_cmd(info, CMD_TRANSFERINFO);
                return;

        case STATE(STAT_COMMAND, PHASE_MSGOUT): /* Message Out  -> Command      */
        case STATE(STAT_COMMAND, PHASE_MSGIN):  /* Message In   -> Command      */
                fas216_send_command(info);
                info->scsi.phase = PHASE_COMMAND;
                return;


        /*
         * Selection    -> Message Out
         */
        case STATE(STAT_MESGOUT, PHASE_SELECTION):
                fas216_send_messageout(info, 1);
                return;

        /*
         * Message Out  -> Message Out
         */
        case STATE(STAT_MESGOUT, PHASE_SELSTEPS):
        case STATE(STAT_MESGOUT, PHASE_MSGOUT):
                /*
                 * If we get another message out phase, this usually
                 * means some parity error occurred.  Resend complete
                 * set of messages.  If we have more than one byte to
                 * send, we need to assert ATN again.
                 */
                if (info->device[info->SCpnt->device->id].parity_check) {
                        /*
                         * We were testing... good, the device
                         * supports parity checking.
                         */
                        info->device[info->SCpnt->device->id].parity_check = 0;
                        info->device[info->SCpnt->device->id].parity_enabled = 1;
                        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);
                }

                if (msgqueue_msglength(&info->scsi.msgs) > 1)
                        fas216_cmd(info, CMD_SETATN);
                /*FALLTHROUGH*/

        /*
         * Any          -> Message Out
         */
        case STATE(STAT_MESGOUT, PHASE_MSGOUT_EXPECT):
                fas216_send_messageout(info, 0);
                return;

        /* Error recovery rules.
         *   These either attempt to abort or retry the operation.
         * TODO: we need more of these
         */
        case STATE(STAT_COMMAND, PHASE_COMMAND):/* Command      -> Command      */
                /* error - we've sent out all the command bytes
                 * we have.
                 * NOTE: we need SAVE DATA POINTERS/RESTORE DATA POINTERS
                 * to include the command bytes sent for this to work
                 * correctly.
                 */
                printk(KERN_ERR "scsi%d.%c: "
                        "target trying to receive more command bytes\n",
                        info->host->host_no, fas216_target(info));
                fas216_cmd(info, CMD_SETATN);
                fas216_set_stc(info, 15);
                fas216_cmd(info, CMD_PADBYTES | CMD_WITHDMA);
                msgqueue_flush(&info->scsi.msgs);
                msgqueue_addmsg(&info->scsi.msgs, 1, INITIATOR_ERROR);
                info->scsi.phase = PHASE_MSGOUT_EXPECT;
                return;
        }

        if (info->scsi.phase == PHASE_MSGIN_DISCONNECT) {
                printk(KERN_ERR "scsi%d.%c: disconnect message received, but bus service %s?\n",
                        info->host->host_no, fas216_target(info),
                        fas216_bus_phase(stat));
                msgqueue_flush(&info->scsi.msgs);
                fas216_cmd(info, CMD_SETATN);
                msgqueue_addmsg(&info->scsi.msgs, 1, INITIATOR_ERROR);
                info->scsi.phase = PHASE_MSGOUT_EXPECT;
                info->scsi.aborting = 1;
                fas216_cmd(info, CMD_TRANSFERINFO);
                return;
        }
        printk(KERN_ERR "scsi%d.%c: bus phase %s after %s?\n",
                info->host->host_no, fas216_target(info),
                fas216_bus_phase(stat),
                fas216_drv_phase(info));
        print_debug_list();
        return;

bad_is:
        fas216_log(info, 0, "bus service at step %d?", is & IS_BITS);
        fas216_dumpstate(info);
        print_debug_list();

        fas216_done(info, DID_ERROR);
}

/**
 * fas216_funcdone_intr - handle a function done interrupt from FAS216 chip
 * @info: interface which caused function done interrupt
 * @stat: Status register contents
 * @is: SCSI Status register contents
 *
 * Handle a function done interrupt from FAS216 chip
 */
static void fas216_funcdone_intr(FAS216_Info *info, unsigned int stat, unsigned int is)
{
        unsigned int fifo_len = fas216_readb(info, REG_CFIS) & CFIS_CF;

        fas216_checkmagic(info);

        fas216_log(info, LOG_FUNCTIONDONE,
                   "function done: stat=%02x is=%02x phase=%02x",
                   stat, is, info->scsi.phase);

        switch (info->scsi.phase) {
        case PHASE_STATUS:                      /* status phase - read status and msg   */
                if (fifo_len != 2) {
                        fas216_log(info, 0, "odd number of bytes in FIFO: %d", fifo_len);
                }
                /*
                 * Read status then message byte.
                 */
                info->scsi.SCp.Status = fas216_readb(info, REG_FF);
                info->scsi.SCp.Message = fas216_readb(info, REG_FF);
                info->scsi.phase = PHASE_DONE;
                fas216_cmd(info, CMD_MSGACCEPTED);
                break;

        case PHASE_IDLE:
        case PHASE_SELECTION:
        case PHASE_SELSTEPS:
                break;

        case PHASE_MSGIN:                       /* message in phase                     */
                if ((stat & STAT_BUSMASK) == STAT_MESGIN) {
                        info->scsi.msgin_fifo = fifo_len;
                        fas216_message(info);
                        break;
                }

        default:
                fas216_log(info, 0, "internal phase %s for function done?"
                        "  What do I do with this?",
                        fas216_target(info), fas216_drv_phase(info));
        }
}

static void fas216_bus_reset(FAS216_Info *info)
{
        neg_t sync_state;
        int i;

        msgqueue_flush(&info->scsi.msgs);

        sync_state = neg_invalid;

#ifdef SCSI2_SYNC
        if (info->ifcfg.capabilities & (FASCAP_DMA|FASCAP_PSEUDODMA))
                sync_state = neg_wait;
#endif

        info->scsi.phase = PHASE_IDLE;
        info->SCpnt = NULL; /* bug! */
        memset(&info->scsi.SCp, 0, sizeof(info->scsi.SCp));

        for (i = 0; i < 8; i++) {
                info->device[i].disconnect_ok   = info->ifcfg.disconnect_ok;
                info->device[i].sync_state      = sync_state;
                info->device[i].period          = info->ifcfg.asyncperiod / 4;
                info->device[i].stp             = info->scsi.async_stp;
                info->device[i].sof             = 0;
                info->device[i].wide_xfer       = 0;
        }

        info->rst_bus_status = 1;
        wake_up(&info->eh_wait);
}

/**
 * fas216_intr - handle interrupts to progress a command
 * @info: interface to service
 *
 * Handle interrupts from the interface to progress a command
 */
irqreturn_t fas216_intr(FAS216_Info *info)
{
        unsigned char inst, is, stat;
        int handled = IRQ_NONE;

        fas216_checkmagic(info);

        stat = fas216_readb(info, REG_STAT);
        is = fas216_readb(info, REG_IS);
        inst = fas216_readb(info, REG_INST);

        add_debug_list(stat, is, inst, info->scsi.phase);

        if (stat & STAT_INT) {
                if (inst & INST_BUSRESET) {
                        fas216_log(info, 0, "bus reset detected");
                        fas216_bus_reset(info);
                        scsi_report_bus_reset(info->host, 0);
                } else if (inst & INST_ILLEGALCMD) {
                        fas216_log(info, LOG_ERROR, "illegal command given\n");
                        fas216_dumpstate(info);
                        print_debug_list();
                } else if (inst & INST_DISCONNECT)
                        fas216_disconnect_intr(info);
                else if (inst & INST_RESELECTED)        /* reselected                   */
                        fas216_reselected_intr(info);
                else if (inst & INST_BUSSERVICE)        /* bus service request          */
                        fas216_busservice_intr(info, stat, is);
                else if (inst & INST_FUNCDONE)          /* function done                */
                        fas216_funcdone_intr(info, stat, is);
                else
                        fas216_log(info, 0, "unknown interrupt received:"
                                " phase %s inst %02X is %02X stat %02X",
                                fas216_drv_phase(info), inst, is, stat);
                handled = IRQ_HANDLED;
        }
        return handled;
}

static void __fas216_start_command(FAS216_Info *info, Scsi_Cmnd *SCpnt)
{
        int tot_msglen;

        /* following what the ESP driver says */
        fas216_set_stc(info, 0);
        fas216_cmd(info, CMD_NOP | CMD_WITHDMA);

        /* flush FIFO */
        fas216_cmd(info, CMD_FLUSHFIFO);

        /* load bus-id and timeout */
        fas216_writeb(info, REG_SDID, BUSID(SCpnt->device->id));
        fas216_writeb(info, REG_STIM, info->ifcfg.select_timeout);

        /* synchronous transfers */
        fas216_set_sync(info, SCpnt->device->id);

        tot_msglen = msgqueue_msglength(&info->scsi.msgs);

#ifdef DEBUG_MESSAGES
        {
                struct message *msg;
                int msgnr = 0, i;

                printk("scsi%d.%c: message out: ",
                        info->host->host_no, '0' + SCpnt->device->id);
                while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) {
                        printk("{ ");
                        for (i = 0; i < msg->length; i++)
                                printk("%02x ", msg->msg[i]);
                        printk("} ");
                }
                printk("\n");
        }
#endif

        if (tot_msglen == 1 || tot_msglen == 3) {
                /*
                 * We have an easy message length to send...
                 */
                struct message *msg;
                int msgnr = 0, i;

                info->scsi.phase = PHASE_SELSTEPS;

                /* load message bytes */
                while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) {
                        for (i = 0; i < msg->length; i++)
                                fas216_writeb(info, REG_FF, msg->msg[i]);
                        msg->fifo = tot_msglen - (fas216_readb(info, REG_CFIS) & CFIS_CF);
                }

                /* load command */
                for (i = 0; i < SCpnt->cmd_len; i++)
                        fas216_writeb(info, REG_FF, SCpnt->cmnd[i]);

                if (tot_msglen == 1)
                        fas216_cmd(info, CMD_SELECTATN);
                else
                        fas216_cmd(info, CMD_SELECTATN3);
        } else {
                /*
                 * We have an unusual number of message bytes to send.
                 *  Load first byte into fifo, and issue SELECT with ATN and
                 *  stop steps.
                 */
                struct message *msg = msgqueue_getmsg(&info->scsi.msgs, 0);

                fas216_writeb(info, REG_FF, msg->msg[0]);
                msg->fifo = 1;

                fas216_cmd(info, CMD_SELECTATNSTOP);
        }
}

/*
 * Decide whether we need to perform a parity test on this device.
 * Can also be used to force parity error conditions during initial
 * information transfer phase (message out) for test purposes.
 */
static int parity_test(FAS216_Info *info, int target)
{
#if 0
        if (target == 3) {
                info->device[target].parity_check = 0;
                return 1;
        }
#endif
        return info->device[target].parity_check;
}

static void fas216_start_command(FAS216_Info *info, Scsi_Cmnd *SCpnt)
{
        int disconnect_ok;

        /*
         * claim host busy
         */
        info->scsi.phase = PHASE_SELECTION;
        info->scsi.SCp = SCpnt->SCp;
        info->SCpnt = SCpnt;
        info->dma.transfer_type = fasdma_none;

        if (parity_test(info, SCpnt->device->id))
                fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0] | CNTL1_PTE);
        else
                fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);

        /*
         * Don't allow request sense commands to disconnect.
         */
        disconnect_ok = SCpnt->cmnd[0] != REQUEST_SENSE &&
                        info->device[SCpnt->device->id].disconnect_ok;

        /*
         * build outgoing message bytes
         */
        msgqueue_flush(&info->scsi.msgs);
        msgqueue_addmsg(&info->scsi.msgs, 1, IDENTIFY(disconnect_ok, SCpnt->device->lun));

        /*
         * add tag message if required
         */
        if (SCpnt->tag)
                msgqueue_addmsg(&info->scsi.msgs, 2, SIMPLE_QUEUE_TAG, SCpnt->tag);

        do {
#ifdef SCSI2_SYNC
                if ((info->device[SCpnt->device->id].sync_state == neg_wait ||
                     info->device[SCpnt->device->id].sync_state == neg_complete) &&
                    (SCpnt->cmnd[0] == REQUEST_SENSE ||
                     SCpnt->cmnd[0] == INQUIRY)) {
                        info->device[SCpnt->device->id].sync_state = neg_inprogress;
                        msgqueue_addmsg(&info->scsi.msgs, 5,
                                        EXTENDED_MESSAGE, 3, EXTENDED_SDTR,
                                        1000 / info->ifcfg.clockrate,
                                        info->ifcfg.sync_max_depth);
                        break;
                }
#endif
        } while (0);

        __fas216_start_command(info, SCpnt);
}

static void fas216_allocate_tag(FAS216_Info *info, Scsi_Cmnd *SCpnt)
{
#ifdef SCSI2_TAG
        /*
         * tagged queuing - allocate a new tag to this command
         */
        if (SCpnt->device->simple_tags && SCpnt->cmnd[0] != REQUEST_SENSE &&
            SCpnt->cmnd[0] != INQUIRY) {
            SCpnt->device->current_tag += 1;
                if (SCpnt->device->current_tag == 0)
                    SCpnt->device->current_tag = 1;
                        SCpnt->tag = SCpnt->device->current_tag;
        } else
#endif
                set_bit(SCpnt->device->id * 8 + SCpnt->device->lun, info->busyluns);

        info->stats.removes += 1;
        switch (SCpnt->cmnd[0]) {
        case WRITE_6:
        case WRITE_10:
        case WRITE_12:
                info->stats.writes += 1;
                break;
        case READ_6:
        case READ_10:
        case READ_12:
                info->stats.reads += 1;
                break;
        default:
                info->stats.miscs += 1;
                break;
        }
}

static void fas216_do_bus_device_reset(FAS216_Info *info, Scsi_Cmnd *SCpnt)
{
        struct message *msg;

        /*
         * claim host busy
         */
        info->scsi.phase = PHASE_SELECTION;
        info->scsi.SCp = SCpnt->SCp;
        info->SCpnt = SCpnt;
        info->dma.transfer_type = fasdma_none;

        fas216_log(info, LOG_ERROR, "sending bus device reset");

        msgqueue_flush(&info->scsi.msgs);
        msgqueue_addmsg(&info->scsi.msgs, 1, BUS_DEVICE_RESET);

        /* following what the ESP driver says */
        fas216_set_stc(info, 0);
        fas216_cmd(info, CMD_NOP | CMD_WITHDMA);

        /* flush FIFO */
        fas216_cmd(info, CMD_FLUSHFIFO);

        /* load bus-id and timeout */
        fas216_writeb(info, REG_SDID, BUSID(SCpnt->device->id));
        fas216_writeb(info, REG_STIM, info->ifcfg.select_timeout);

        /* synchronous transfers */
        fas216_set_sync(info, SCpnt->device->id);

        msg = msgqueue_getmsg(&info->scsi.msgs, 0);

        fas216_writeb(info, REG_FF, BUS_DEVICE_RESET);
        msg->fifo = 1;

        fas216_cmd(info, CMD_SELECTATNSTOP);
}

/**
 * fas216_kick - kick a command to the interface
 * @info: our host interface to kick
 *
 * Kick a command to the interface, interface should be idle.
 * Notes: Interrupts are always disabled!
 */
static void fas216_kick(FAS216_Info *info)
{
        Scsi_Cmnd *SCpnt = NULL;
#define TYPE_OTHER      0
#define TYPE_RESET      1
#define TYPE_QUEUE      2
        int where_from = TYPE_OTHER;

        fas216_checkmagic(info);

        /*
         * Obtain the next command to process.
         */
        do {
                if (info->rstSCpnt) {
                        SCpnt = info->rstSCpnt;
                        /* don't remove it */
                        where_from = TYPE_RESET;
                        break;
                }

                if (info->reqSCpnt) {
                        SCpnt = info->reqSCpnt;
                        info->reqSCpnt = NULL;
                        break;
                }

                if (info->origSCpnt) {
                        SCpnt = info->origSCpnt;
                        info->origSCpnt = NULL;
                        break;
                }

                /* retrieve next command */
                if (!SCpnt) {
                        SCpnt = queue_remove_exclude(&info->queues.issue,
                                                     info->busyluns);
                        where_from = TYPE_QUEUE;
                        break;
                }
        } while (0);

        if (!SCpnt) {
                /*
                 * no command pending, so enable reselection.
                 */
                fas216_cmd(info, CMD_ENABLESEL);
                return;
        }

        /*
         * We're going to start a command, so disable reselection
         */
        fas216_cmd(info, CMD_DISABLESEL);

        if (info->scsi.disconnectable && info->SCpnt) {
                fas216_log(info, LOG_CONNECT,
                        "moved command for %d to disconnected queue",
                        info->SCpnt->device->id);
                queue_add_cmd_tail(&info->queues.disconnected, info->SCpnt);
                info->scsi.disconnectable = 0;
                info->SCpnt = NULL;
        }

        fas216_log_command(info, LOG_CONNECT | LOG_MESSAGES, SCpnt,
                           "starting");

        switch (where_from) {
        case TYPE_QUEUE:
                fas216_allocate_tag(info, SCpnt);
        case TYPE_OTHER:
                fas216_start_command(info, SCpnt);
                break;
        case TYPE_RESET:
                fas216_do_bus_device_reset(info, SCpnt);
                break;
        }

        fas216_log(info, LOG_CONNECT, "select: data pointers [%p, %X]",
                info->scsi.SCp.ptr, info->scsi.SCp.this_residual);

        /*
         * should now get either DISCONNECT or
         * (FUNCTION DONE with BUS SERVICE) interrupt
         */
}

/*
 * Clean up from issuing a BUS DEVICE RESET message to a device.
 */
static void
fas216_devicereset_done(FAS216_Info *info, Scsi_Cmnd *SCpnt, unsigned int result)
{
        fas216_log(info, LOG_ERROR, "fas216 device reset complete");

        info->rstSCpnt = NULL;
        info->rst_dev_status = 1;
        wake_up(&info->eh_wait);
}

/**
 * fas216_rq_sns_done - Finish processing automatic request sense command
 * @info: interface that completed
 * @SCpnt: command that completed
 * @result: driver byte of result
 *
 * Finish processing automatic request sense command
 */
static void
fas216_rq_sns_done(FAS216_Info *info, Scsi_Cmnd *SCpnt, unsigned int result)
{
        fas216_log_target(info, LOG_CONNECT, SCpnt->device->id,
                   "request sense complete, result=0x%04x%02x%02x",
                   result, SCpnt->SCp.Message, SCpnt->SCp.Status);

        if (result != DID_OK || SCpnt->SCp.Status != GOOD)
                /*
                 * Something went wrong.  Make sure that we don't
                 * have valid data in the sense buffer that could
                 * confuse the higher levels.
                 */
                memset(SCpnt->sense_buffer, 0, sizeof(SCpnt->sense_buffer));
//printk("scsi%d.%c: sense buffer: ", info->host->host_no, '0' + SCpnt->device->id);
//{ int i; for (i = 0; i < 32; i++) printk("%02x ", SCpnt->sense_buffer[i]); printk("\n"); }
        /*
         * Note that we don't set SCpnt->result, since that should
         * reflect the status of the command that we were asked by
         * the upper layers to process.  This would have been set
         * correctly by fas216_std_done.
         */
        SCpnt->scsi_done(SCpnt);
}

/**
 * fas216_std_done - finish processing of standard command
 * @info: interface that completed
 * @SCpnt: command that completed
 * @result: driver byte of result
 *
 * Finish processing of standard command
 */
static void
fas216_std_done(FAS216_Info *info, Scsi_Cmnd *SCpnt, unsigned int result)
{
        info->stats.fins += 1;

        SCpnt->result = result << 16 | info->scsi.SCp.Message << 8 |
                        info->scsi.SCp.Status;

        fas216_log_command(info, LOG_CONNECT, SCpnt,
                "command complete, result=0x%08x", SCpnt->result);

        /*
         * If the driver detected an error, we're all done.
         */
        if (host_byte(SCpnt->result) != DID_OK ||
            msg_byte(SCpnt->result) != COMMAND_COMPLETE)
                goto done;

        /*
         * If the command returned CHECK_CONDITION or COMMAND_TERMINATED
         * status, request the sense information.
         */
        if (status_byte(SCpnt->result) == CHECK_CONDITION ||
            status_byte(SCpnt->result) == COMMAND_TERMINATED)
                goto request_sense;

        /*
         * If the command did not complete with GOOD status,
         * we are all done here.
         */
        if (status_byte(SCpnt->result) != GOOD)
                goto done;

        /*
         * We have successfully completed a command.  Make sure that
         * we do not have any buffers left to transfer.  The world
         * is not perfect, and we seem to occasionally hit this.
         * It can be indicative of a buggy driver, target or the upper
         * levels of the SCSI code.
         */
        if (info->scsi.SCp.ptr) {
                switch (SCpnt->cmnd[0]) {
                case INQUIRY:
                case START_STOP:
                case MODE_SENSE:
                        break;

                default:
                        printk(KERN_ERR "scsi%d.%c: incomplete data transfer "
                                "detected: res=%08X ptr=%p len=%X CDB: ",
                                info->host->host_no, '0' + SCpnt->device->id,
                                SCpnt->result, info->scsi.SCp.ptr,
                                info->scsi.SCp.this_residual);
                        print_command(SCpnt->cmnd);
                        SCpnt->result &= ~(255 << 16);
                        SCpnt->result |= DID_BAD_TARGET << 16;
                        goto request_sense;
                }
        }

done:
        if (SCpnt->scsi_done) {
                SCpnt->scsi_done(SCpnt);
                return;
        }

        panic("scsi%d.H: null scsi_done function in fas216_done",
                info->host->host_no);


request_sense:
        if (SCpnt->cmnd[0] == REQUEST_SENSE)
                goto done;

        fas216_log_target(info, LOG_CONNECT, SCpnt->device->id,
                          "requesting sense");
        memset(SCpnt->cmnd, 0, sizeof (SCpnt->cmnd));
        SCpnt->cmnd[0] = REQUEST_SENSE;
        SCpnt->cmnd[1] = SCpnt->device->lun << 5;
        SCpnt->cmnd[4] = sizeof(SCpnt->sense_buffer);
        SCpnt->cmd_len = COMMAND_SIZE(SCpnt->cmnd[0]);
        SCpnt->SCp.buffer = NULL;
        SCpnt->SCp.buffers_residual = 0;
        SCpnt->SCp.ptr = (char *)SCpnt->sense_buffer;
        SCpnt->SCp.this_residual = sizeof(SCpnt->sense_buffer);
        SCpnt->SCp.Message = 0;
        SCpnt->SCp.Status = 0;
        SCpnt->request_bufflen = sizeof(SCpnt->sense_buffer);
        SCpnt->sc_data_direction = SCSI_DATA_READ;
        SCpnt->use_sg = 0;
        SCpnt->tag = 0;
        SCpnt->host_scribble = (void *)fas216_rq_sns_done;

        /*
         * Place this command into the high priority "request
         * sense" slot.  This will be the very next command
         * executed, unless a target connects to us.
         */
        if (info->reqSCpnt)
                printk(KERN_WARNING "scsi%d.%c: loosing request command\n",
                        info->host->host_no, '0' + SCpnt->device->id);
        info->reqSCpnt = SCpnt;
}

/**
 * fas216_done - complete processing for current command
 * @info: interface that completed
 * @result: driver byte of result
 *
 * Complete processing for current command
 */
static void fas216_done(FAS216_Info *info, unsigned int result)
{
        void (*fn)(FAS216_Info *, Scsi_Cmnd *, unsigned int);
        Scsi_Cmnd *SCpnt;
        unsigned long flags;

        fas216_checkmagic(info);

        if (!info->SCpnt)
                goto no_command;

        SCpnt = info->SCpnt;
        info->SCpnt = NULL;
        info->scsi.phase = PHASE_IDLE;

        if (info->scsi.aborting) {
                fas216_log(info, 0, "uncaught abort - returning DID_ABORT");
                result = DID_ABORT;
                info->scsi.aborting = 0;
        }

        /*
         * Sanity check the completion - if we have zero bytes left
         * to transfer, we should not have a valid pointer.
         */
        if (info->scsi.SCp.ptr && info->scsi.SCp.this_residual == 0) {
                printk("scsi%d.%c: zero bytes left to transfer, but "
                       "buffer pointer still valid: ptr=%p len=%08x CDB: ",
                       info->host->host_no, '0' + SCpnt->device->id,
                       info->scsi.SCp.ptr, info->scsi.SCp.this_residual);
                info->scsi.SCp.ptr = NULL;
                print_command(SCpnt->cmnd);
        }

        /*
         * Clear down this command as completed.  If we need to request
         * the sense information, fas216_kick will re-assert the busy
         * status.
         */
        info->device[SCpnt->device->id].parity_check = 0;
        clear_bit(SCpnt->device->id * 8 + SCpnt->device->lun, info->busyluns);

        fn = (void (*)(FAS216_Info *, Scsi_Cmnd *, unsigned int))SCpnt->host_scribble;
        fn(info, SCpnt, result);

        if (info->scsi.irq != NO_IRQ) {
                spin_lock_irqsave(&info->host_lock, flags);
                if (info->scsi.phase == PHASE_IDLE)
                        fas216_kick(info);
                spin_unlock_irqrestore(&info->host_lock, flags);
        }
        return;

no_command:
        panic("scsi%d.H: null command in fas216_done",
                info->host->host_no);
}

/**
 * fas216_queue_command - queue a command for adapter to process.
 * @SCpnt: Command to queue
 * @done: done function to call once command is complete
 *
 * Queue a command for adapter to process.
 * Returns: 0 on success, else error.
 * Notes: io_request_lock is held, interrupts are disabled.
 */
int fas216_queue_command(Scsi_Cmnd *SCpnt, void (*done)(Scsi_Cmnd *))
{
        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
        int result;

        fas216_checkmagic(info);

        fas216_log_command(info, LOG_CONNECT, SCpnt,
                           "received command (%p)", SCpnt);

        SCpnt->scsi_done = done;
        SCpnt->host_scribble = (void *)fas216_std_done;
        SCpnt->result = 0;

        init_SCp(SCpnt);

        info->stats.queues += 1;
        SCpnt->tag = 0;

        spin_lock(&info->host_lock);

        /*
         * Add command into execute queue and let it complete under
         * whatever scheme we're using.
         */
        result = !queue_add_cmd_ordered(&info->queues.issue, SCpnt);

        /*
         * If we successfully added the command,
         * kick the interface to get it moving.
         */
        if (result == 0 && info->scsi.phase == PHASE_IDLE)
                fas216_kick(info);
        spin_unlock(&info->host_lock);

        fas216_log_target(info, LOG_CONNECT, -1, "queue %s",
                result ? "failure" : "success");

        return result;
}

/**
 * fas216_internal_done - trigger restart of a waiting thread in fas216_noqueue_command
 * @SCpnt: Command to wake
 *
 * Trigger restart of a waiting thread in fas216_command
 */
static void fas216_internal_done(Scsi_Cmnd *SCpnt)
{
        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;

        fas216_checkmagic(info);

        info->internal_done = 1;
}

/**
 * fas216_noqueue_command - process a command for the adapter.
 * @SCpnt: Command to queue
 *
 * Queue a command for adapter to process.
 * Returns: scsi result code.
 * Notes: io_request_lock is held, interrupts are disabled.
 */
int fas216_noqueue_command(Scsi_Cmnd *SCpnt, void (*done)(Scsi_Cmnd *))
{
        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;

        fas216_checkmagic(info);

        /*
         * We should only be using this if we don't have an interrupt.
         * Provide some "incentive" to use the queueing code.
         */
        BUG_ON(info->scsi.irq != NO_IRQ);

        info->internal_done = 0;
        fas216_queue_command(SCpnt, fas216_internal_done);

        /*
         * This wastes time, since we can't return until the command is
         * complete. We can't sleep either since we may get re-entered!
         * However, we must re-enable interrupts, or else we'll be
         * waiting forever.
         */
        spin_unlock_irq(info->host->host_lock);

        while (!info->internal_done) {
                /*
                 * If we don't have an IRQ, then we must poll the card for
                 * it's interrupt, and use that to call this driver's
                 * interrupt routine.  That way, we keep the command
                 * progressing.  Maybe we can add some inteligence here
                 * and go to sleep if we know that the device is going
                 * to be some time (eg, disconnected).
                 */
                if (fas216_readb(info, REG_STAT) & STAT_INT) {
                        spin_lock_irq(info->host->host_lock);
                        fas216_intr(info);
                        spin_unlock_irq(info->host->host_lock);
                }
        }

        spin_lock_irq(info->host->host_lock);

        done(SCpnt);

        return 0;
}

/*
 * Error handler timeout function.  Indicate that we timed out,
 * and wake up any error handler process so it can continue.
 */
static void fas216_eh_timer(unsigned long data)
{
        FAS216_Info *info = (FAS216_Info *)data;

        fas216_log(info, LOG_ERROR, "error handling timed out\n");

        del_timer(&info->eh_timer);

        if (info->rst_bus_status == 0)
                info->rst_bus_status = -1;
        if (info->rst_dev_status == 0)
                info->rst_dev_status = -1;

        wake_up(&info->eh_wait);
}

enum res_find {
        res_failed,             /* not found                    */
        res_success,            /* command on issue queue       */
        res_hw_abort            /* command on disconnected dev  */
};

/**
 * fas216_do_abort - decide how to abort a command
 * @SCpnt: command to abort
 *
 * Decide how to abort a command.
 * Returns: abort status
 */
static enum res_find fas216_find_command(FAS216_Info *info, Scsi_Cmnd *SCpnt)
{
        enum res_find res = res_failed;

        if (queue_remove_cmd(&info->queues.issue, SCpnt)) {
                /*
                 * The command was on the issue queue, and has not been
                 * issued yet.  We can remove the command from the queue,
                 * and acknowledge the abort.  Neither the device nor the
                 * interface know about the command.
                 */
                printk("on issue queue ");

                res = res_success;
        } else if (queue_remove_cmd(&info->queues.disconnected, SCpnt)) {
                /*
                 * The command was on the disconnected queue.  We must
                 * reconnect with the device if possible, and send it
                 * an abort message.
                 */
                printk("on disconnected queue ");

                res = res_hw_abort;
        } else if (info->SCpnt == SCpnt) {
                printk("executing ");

                switch (info->scsi.phase) {
                /*
                 * If the interface is idle, and the command is 'disconnectable',
                 * then it is the same as on the disconnected queue.
                 */
                case PHASE_IDLE:
                        if (info->scsi.disconnectable) {
                                info->scsi.disconnectable = 0;
                                info->SCpnt = NULL;
                                res = res_hw_abort;
                        }
                        break;

                default:
                        break;
                }
        } else if (info->origSCpnt == SCpnt) {
                /*
                 * The command will be executed next, but a command
                 * is currently using the interface.  This is similar to
                 * being on the issue queue, except the busylun bit has
                 * been set.
                 */
                info->origSCpnt = NULL;
                clear_bit(SCpnt->device->id * 8 + SCpnt->device->lun, info->busyluns);
                printk("waiting for execution ");
                res = res_success;
        } else
                printk("unknown ");

        return res;
}

/**
 * fas216_eh_abort - abort this command
 * @SCpnt: command to abort
 *
 * Abort this command.
 * Returns: FAILED if unable to abort
 * Notes: io_request_lock is taken, and irqs are disabled
 */
int fas216_eh_abort(Scsi_Cmnd *SCpnt)
{
        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
        int result = FAILED;

        fas216_checkmagic(info);

        info->stats.aborts += 1;

        printk(KERN_WARNING "scsi%d: abort command ", info->host->host_no);
        print_command(SCpnt->data_cmnd);

        print_debug_list();
        fas216_dumpstate(info);

        printk(KERN_WARNING "scsi%d: abort %p ", info->host->host_no, SCpnt);

        switch (fas216_find_command(info, SCpnt)) {
        /*
         * We found the command, and cleared it out.  Either
         * the command is still known to be executing on the
         * target, or the busylun bit is not set.
         */
        case res_success:
                printk("success\n");
                result = SUCCESS;
                break;

        /*
         * We need to reconnect to the target and send it an
         * ABORT or ABORT_TAG message.  We can only do this
         * if the bus is free.
         */
        case res_hw_abort:
                

        /*
         * We are unable to abort the command for some reason.
         */
        default:
        case res_failed:
                printk("failed\n");
                break;
        }

        return result;
}

/**
 * fas216_eh_device_reset - Reset the device associated with this command
 * @SCpnt: command specifing device to reset
 *
 * Reset the device associated with this command.
 * Returns: FAILED if unable to reset.
 * Notes: We won't be re-entered, so we'll only have one device
 * reset on the go at one time.
 */
int fas216_eh_device_reset(Scsi_Cmnd *SCpnt)
{
        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
        unsigned long flags;
        int i, res = FAILED, target = SCpnt->device->id;

        fas216_log(info, LOG_ERROR, "device reset for target %d", target);

        spin_lock_irqsave(&info->host_lock, flags);

        do {
                /*
                 * If we are currently connected to a device, and
                 * it is the device we want to reset, there is
                 * nothing we can do here.  Chances are it is stuck,
                 * and we need a bus reset.
                 */
                if (info->SCpnt && !info->scsi.disconnectable &&
                    info->SCpnt->device->id == SCpnt->device->id)
                        break;

                /*
                 * We're going to be resetting this device.  Remove
                 * all pending commands from the driver.  By doing
                 * so, we guarantee that we won't touch the command
                 * structures except to process the reset request.
                 */
                queue_remove_all_target(&info->queues.issue, target);
                queue_remove_all_target(&info->queues.disconnected, target);
                if (info->origSCpnt && info->origSCpnt->device->id == target)
                        info->origSCpnt = NULL;
                if (info->reqSCpnt && info->reqSCpnt->device->id == target)
                        info->reqSCpnt = NULL;
                for (i = 0; i < 8; i++)
                        clear_bit(target * 8 + i, info->busyluns);

                /*
                 * Hijack this SCSI command structure to send
                 * a bus device reset message to this device.
                 */
                SCpnt->host_scribble = (void *)fas216_devicereset_done;

                info->rst_dev_status = 0;
                info->rstSCpnt = SCpnt;

                if (info->scsi.phase == PHASE_IDLE)
                        fas216_kick(info);

                mod_timer(&info->eh_timer, 30 * HZ);
                spin_unlock_irqrestore(&info->host_lock, flags);

                /*
                 * Wait up to 30 seconds for the reset to complete.
                 */
                wait_event(info->eh_wait, info->rst_dev_status);

                del_timer_sync(&info->eh_timer);
                spin_lock_irqsave(&info->host_lock, flags);
                info->rstSCpnt = NULL;

                if (info->rst_dev_status == 1)
                        res = SUCCESS;
        } while (0);

        SCpnt->host_scribble = NULL;
        spin_unlock_irqrestore(&info->host_lock, flags);

        fas216_log(info, LOG_ERROR, "device reset complete: %s\n",
                   res == SUCCESS ? "success" : "failed");

        return res;
}

/**
 * fas216_eh_bus_reset - Reset the bus associated with the command
 * @SCpnt: command specifing bus to reset
 *
 * Reset the bus associated with the command.
 * Returns: FAILED if unable to reset.
 * Notes: Further commands are blocked.
 */
int fas216_eh_bus_reset(Scsi_Cmnd *SCpnt)
{
        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
        unsigned long flags;
        Scsi_Device *SDpnt;

        fas216_checkmagic(info);
        fas216_log(info, LOG_ERROR, "resetting bus");

        info->stats.bus_resets += 1;

        spin_lock_irqsave(&info->host_lock, flags);

        /*
         * Stop all activity on this interface.
         */
        fas216_aborttransfer(info);
        fas216_writeb(info, REG_CNTL3, info->scsi.cfg[2]);

        /*
         * Clear any pending interrupts.
         */
        while (fas216_readb(info, REG_STAT) & STAT_INT)
                fas216_readb(info, REG_INST);

        info->rst_bus_status = 0;

        /*
         * For each attached hard-reset device, clear out
         * all command structures.  Leave the running
         * command in place.
         */
        shost_for_each_device(SDpnt, info->host) {
                int i;

                if (SDpnt->soft_reset)
                        continue;

                queue_remove_all_target(&info->queues.issue, SDpnt->id);
                queue_remove_all_target(&info->queues.disconnected, SDpnt->id);
                if (info->origSCpnt && info->origSCpnt->device->id == SDpnt->id)
                        info->origSCpnt = NULL;
                if (info->reqSCpnt && info->reqSCpnt->device->id == SDpnt->id)
                        info->reqSCpnt = NULL;
                info->SCpnt = NULL;

                for (i = 0; i < 8; i++)
                        clear_bit(SDpnt->id * 8 + i, info->busyluns);
        }

        info->scsi.phase = PHASE_IDLE;

        /*
         * Reset the SCSI bus.  Device cleanup happens in
         * the interrupt handler.
         */
        fas216_cmd(info, CMD_RESETSCSI);

        mod_timer(&info->eh_timer, jiffies + HZ);
        spin_unlock_irqrestore(&info->host_lock, flags);

        /*
         * Wait one second for the interrupt.
         */
        wait_event(info->eh_wait, info->rst_bus_status);
        del_timer_sync(&info->eh_timer);

        fas216_log(info, LOG_ERROR, "bus reset complete: %s\n",
                   info->rst_bus_status == 1 ? "success" : "failed");

        return info->rst_bus_status == 1 ? SUCCESS : FAILED;
}

/**
 * fas216_init_chip - Initialise FAS216 state after reset
 * @info: state structure for interface
 *
 * Initialise FAS216 state after reset
 */
static void fas216_init_chip(FAS216_Info *info)
{
        unsigned int clock = ((info->ifcfg.clockrate - 1) / 5 + 1) & 7;
        fas216_writeb(info, REG_CLKF, clock);
        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);
        fas216_writeb(info, REG_CNTL2, info->scsi.cfg[1]);
        fas216_writeb(info, REG_CNTL3, info->scsi.cfg[2]);
        fas216_writeb(info, REG_STIM, info->ifcfg.select_timeout);
        fas216_writeb(info, REG_SOF, 0);
        fas216_writeb(info, REG_STP, info->scsi.async_stp);
        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);
}

/**
 * fas216_eh_host_reset - Reset the host associated with this command
 * @SCpnt: command specifing host to reset
 *
 * Reset the host associated with this command.
 * Returns: FAILED if unable to reset.
 * Notes: io_request_lock is taken, and irqs are disabled
 */
int fas216_eh_host_reset(Scsi_Cmnd *SCpnt)
{
        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;

        fas216_checkmagic(info);

        printk("scsi%d.%c: %s: resetting host\n",
                info->host->host_no, '0' + SCpnt->device->id, __FUNCTION__);

        /*
         * Reset the SCSI chip.
         */
        fas216_cmd(info, CMD_RESETCHIP);

        /*
         * Ugly ugly ugly!
         * We need to release the host_lock and enable
         * IRQs if we sleep, but we must relock and disable
         * IRQs after the sleep.
         */
        spin_unlock_irq(info->host->host_lock);
        msleep(50 * 1000/100);
        spin_lock_irq(info->host->host_lock);

        /*
         * Release the SCSI reset.
         */
        fas216_cmd(info, CMD_NOP);

        fas216_init_chip(info);

        return SUCCESS;
}

#define TYPE_UNKNOWN    0
#define TYPE_NCR53C90   1
#define TYPE_NCR53C90A  2
#define TYPE_NCR53C9x   3
#define TYPE_Am53CF94   4
#define TYPE_EmFAS216   5
#define TYPE_QLFAS216   6

static char *chip_types[] = {
        "unknown",
        "NS NCR53C90",
        "NS NCR53C90A",
        "NS NCR53C9x",
        "AMD Am53CF94",
        "Emulex FAS216",
        "QLogic FAS216"
};

static int fas216_detect_type(FAS216_Info *info)
{
        int family, rev;

        /*
         * Reset the chip.
         */
        fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
        udelay(50);
        fas216_writeb(info, REG_CMD, CMD_NOP);

        /*
         * Check to see if control reg 2 is present.
         */
        fas216_writeb(info, REG_CNTL3, 0);
        fas216_writeb(info, REG_CNTL2, CNTL2_S2FE);

        /*
         * If we are unable to read back control reg 2
         * correctly, it is not present, and we have a
         * NCR53C90.
         */
        if ((fas216_readb(info, REG_CNTL2) & (~0xe0)) != CNTL2_S2FE)
                return TYPE_NCR53C90;

        /*
         * Now, check control register 3
         */
        fas216_writeb(info, REG_CNTL2, 0);
        fas216_writeb(info, REG_CNTL3, 0);
        fas216_writeb(info, REG_CNTL3, 5);

        /*
         * If we are unable to read the register back
         * correctly, we have a NCR53C90A
         */
        if (fas216_readb(info, REG_CNTL3) != 5)
                return TYPE_NCR53C90A;

        /*
         * Now read the ID from the chip.
         */
        fas216_writeb(info, REG_CNTL3, 0);

        fas216_writeb(info, REG_CNTL3, CNTL3_ADIDCHK);
        fas216_writeb(info, REG_CNTL3, 0);

        fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
        udelay(50);
        fas216_writeb(info, REG_CMD, CMD_WITHDMA | CMD_NOP);

        fas216_writeb(info, REG_CNTL2, CNTL2_ENF);
        fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
        udelay(50);
        fas216_writeb(info, REG_CMD, CMD_NOP);

        rev     = fas216_readb(info, REG_ID);
        family  = rev >> 3;
        rev    &= 7;

        switch (family) {
        case 0x01:
                if (rev == 4)
                        return TYPE_Am53CF94;
                break;

        case 0x02:
                switch (rev) {
                case 2:
                        return TYPE_EmFAS216;
                case 3:
                        return TYPE_QLFAS216;
                }
                break;

        default:
                break;
        }
        printk("family %x rev %x\n", family, rev);
        return TYPE_NCR53C9x;
}

/**
 * fas216_reset_state - Initialise driver internal state
 * @info: state to initialise
 *
 * Initialise driver internal state
 */
static void fas216_reset_state(FAS216_Info *info)
{
        int i;

        fas216_checkmagic(info);

        fas216_bus_reset(info);

        /*
         * Clear out all stale info in our state structure
         */
        memset(info->busyluns, 0, sizeof(info->busyluns));
        info->scsi.disconnectable = 0;
        info->scsi.aborting = 0;

        for (i = 0; i < 8; i++) {
                info->device[i].parity_enabled  = 0;
                info->device[i].parity_check    = 1;
        }

        /*
         * Drain all commands on disconnected queue
         */
        while (queue_remove(&info->queues.disconnected) != NULL);

        /*
         * Remove executing commands.
         */
        info->SCpnt     = NULL;
        info->reqSCpnt  = NULL;
        info->rstSCpnt  = NULL;
        info->origSCpnt = NULL;
}

/**
 * fas216_init - initialise FAS/NCR/AMD SCSI structures.
 * @host: a driver-specific filled-out structure
 *
 * Initialise FAS/NCR/AMD SCSI structures.
 * Returns: 0 on success
 */
int fas216_init(struct Scsi_Host *host)
{
        FAS216_Info *info = (FAS216_Info *)host->hostdata;

        info->magic_start    = MAGIC;
        info->magic_end      = MAGIC;
        info->host           = host;
        info->scsi.cfg[0]    = host->this_id | CNTL1_PERE;
        info->scsi.cfg[1]    = CNTL2_ENF | CNTL2_S2FE;
        info->scsi.cfg[2]    = info->ifcfg.cntl3 |
                               CNTL3_ADIDCHK | CNTL3_QTAG | CNTL3_G2CB | CNTL3_LBTM;
        info->scsi.async_stp = fas216_syncperiod(info, info->ifcfg.asyncperiod);

        info->rst_dev_status = -1;
        info->rst_bus_status = -1;
        init_waitqueue_head(&info->eh_wait);
        init_timer(&info->eh_timer);
        info->eh_timer.data  = (unsigned long)info;
        info->eh_timer.function = fas216_eh_timer;
        
        spin_lock_init(&info->host_lock);

        memset(&info->stats, 0, sizeof(info->stats));

        msgqueue_initialise(&info->scsi.msgs);

        if (!queue_initialise(&info->queues.issue))
                return -ENOMEM;

        if (!queue_initialise(&info->queues.disconnected)) {
                queue_free(&info->queues.issue);
                return -ENOMEM;
        }

        return 0;
}

/**
 * fas216_add - initialise FAS/NCR/AMD SCSI ic.
 * @host: a driver-specific filled-out structure
 * @dev: parent device
 *
 * Initialise FAS/NCR/AMD SCSI ic.
 * Returns: 0 on success
 */
int fas216_add(struct Scsi_Host *host, struct device *dev)
{
        FAS216_Info *info = (FAS216_Info *)host->hostdata;
        int type, ret;

        if (info->ifcfg.clockrate <= 10 || info->ifcfg.clockrate > 40) {
                printk(KERN_CRIT "fas216: invalid clock rate %u MHz\n",
                        info->ifcfg.clockrate);
                return -EINVAL;
        }

        fas216_reset_state(info);
        type = fas216_detect_type(info);
        info->scsi.type = chip_types[type];

        udelay(300);

        /*
         * Initialise the chip correctly.
         */
        fas216_init_chip(info);

        /*
         * Reset the SCSI bus.  We don't want to see
         * the resulting reset interrupt, so mask it
         * out.
         */
        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0] | CNTL1_DISR);
        fas216_writeb(info, REG_CMD, CMD_RESETSCSI);

        /*
         * scsi standard says wait 250ms
         */
        spin_unlock_irq(info->host->host_lock);
        msleep(100*1000/100);
        spin_lock_irq(info->host->host_lock);

        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);
        fas216_readb(info, REG_INST);

        fas216_checkmagic(info);

        ret = scsi_add_host(host, dev);
        if (ret)
                fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
        else
                scsi_scan_host(host);

        return ret;
}

void fas216_remove(struct Scsi_Host *host)
{
        FAS216_Info *info = (FAS216_Info *)host->hostdata;

        fas216_checkmagic(info);
        scsi_remove_host(host);

        fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
        scsi_host_put(host);
}

/**
 * fas216_release - release all resources for FAS/NCR/AMD SCSI ic.
 * @host: a driver-specific filled-out structure
 *
 * release all resources and put everything to bed for FAS/NCR/AMD SCSI ic.
 */
void fas216_release(struct Scsi_Host *host)
{
        FAS216_Info *info = (FAS216_Info *)host->hostdata;

        queue_free(&info->queues.disconnected);
        queue_free(&info->queues.issue);
}

int fas216_print_host(FAS216_Info *info, char *buffer)
{
        return sprintf(buffer,
                        "\n"
                        "Chip    : %s\n"
                        " Address: 0x%p\n"
                        " IRQ    : %d\n"
                        " DMA    : %d\n",
                        info->scsi.type, info->scsi.io_base,
                        info->scsi.irq, info->scsi.dma);
}

int fas216_print_stats(FAS216_Info *info, char *buffer)
{
        char *p = buffer;

        p += sprintf(p, "\n"
                        "Command Statistics:\n"
                        " Queued     : %u\n"
                        " Issued     : %u\n"
                        " Completed  : %u\n"
                        " Reads      : %u\n"
                        " Writes     : %u\n"
                        " Others     : %u\n"
                        " Disconnects: %u\n"
                        " Aborts     : %u\n"
                        " Bus resets : %u\n"
                        " Host resets: %u\n",
                        info->stats.queues,      info->stats.removes,
                        info->stats.fins,        info->stats.reads,
                        info->stats.writes,      info->stats.miscs,
                        info->stats.disconnects, info->stats.aborts,
                        info->stats.bus_resets,  info->stats.host_resets);

        return p - buffer;
}

int fas216_print_devices(FAS216_Info *info, char *buffer)
{
        struct fas216_device *dev;
        Scsi_Device *scd;
        char *p = buffer;

        p += sprintf(p, "Device/Lun TaggedQ       Parity   Sync\n");

        shost_for_each_device(scd, info->host) {
                dev = &info->device[scd->id];
                p += sprintf(p, "     %d/%d   ", scd->id, scd->lun);
                if (scd->tagged_supported)
                        p += sprintf(p, "%3sabled(%3d) ",
                                     scd->simple_tags ? "en" : "dis",
                                     scd->current_tag);
                else
                        p += sprintf(p, "unsupported   ");

                p += sprintf(p, "%3sabled ", dev->parity_enabled ? "en" : "dis");

                if (dev->sof)
                        p += sprintf(p, "offset %d, %d ns\n",
                                     dev->sof, dev->period * 4);
                else
                        p += sprintf(p, "async\n");
        }

        return p - buffer;
}

EXPORT_SYMBOL(fas216_init);
EXPORT_SYMBOL(fas216_add);
EXPORT_SYMBOL(fas216_queue_command);
EXPORT_SYMBOL(fas216_noqueue_command);
EXPORT_SYMBOL(fas216_intr);
EXPORT_SYMBOL(fas216_remove);
EXPORT_SYMBOL(fas216_release);
EXPORT_SYMBOL(fas216_eh_abort);
EXPORT_SYMBOL(fas216_eh_device_reset);
EXPORT_SYMBOL(fas216_eh_bus_reset);
EXPORT_SYMBOL(fas216_eh_host_reset);
EXPORT_SYMBOL(fas216_print_host);
EXPORT_SYMBOL(fas216_print_stats);
EXPORT_SYMBOL(fas216_print_devices);

MODULE_AUTHOR("Russell King");
MODULE_DESCRIPTION("Generic FAS216/NCR53C9x driver core");
MODULE_LICENSE("GPL");