Merge branch 'drm-fixes' of git://people.freedesktop.org/~airlied/linux

[deliverable/linux.git] / drivers / scsi / atari_NCR5380.c

/*
 * NCR 5380 generic driver routines.  These should make it *trivial*
 * to implement 5380 SCSI drivers under Linux with a non-trantor
 * architecture.
 *
 * Note that these routines also work with NR53c400 family chips.
 *
 * Copyright 1993, Drew Eckhardt
 * Visionary Computing
 * (Unix and Linux consulting and custom programming)
 * drew@colorado.edu
 * +1 (303) 666-5836
 *
 * For more information, please consult
 *
 * NCR 5380 Family
 * SCSI Protocol Controller
 * Databook
 *
 * NCR Microelectronics
 * 1635 Aeroplaza Drive
 * Colorado Springs, CO 80916
 * 1+ (719) 578-3400
 * 1+ (800) 334-5454
 */

/* Ported to Atari by Roman Hodek and others. */

/* Adapted for the sun3 by Sam Creasey. */

/*
 * Design
 *
 * This is a generic 5380 driver.  To use it on a different platform,
 * one simply writes appropriate system specific macros (ie, data
 * transfer - some PC's will use the I/O bus, 68K's must use
 * memory mapped) and drops this file in their 'C' wrapper.
 *
 * As far as command queueing, two queues are maintained for
 * each 5380 in the system - commands that haven't been issued yet,
 * and commands that are currently executing.  This means that an
 * unlimited number of commands may be queued, letting
 * more commands propagate from the higher driver levels giving higher
 * throughput.  Note that both I_T_L and I_T_L_Q nexuses are supported,
 * allowing multiple commands to propagate all the way to a SCSI-II device
 * while a command is already executing.
 *
 *
 * Issues specific to the NCR5380 :
 *
 * When used in a PIO or pseudo-dma mode, the NCR5380 is a braindead
 * piece of hardware that requires you to sit in a loop polling for
 * the REQ signal as long as you are connected.  Some devices are
 * brain dead (ie, many TEXEL CD ROM drives) and won't disconnect
 * while doing long seek operations. [...] These
 * broken devices are the exception rather than the rule and I'd rather
 * spend my time optimizing for the normal case.
 *
 * Architecture :
 *
 * At the heart of the design is a coroutine, NCR5380_main,
 * which is started from a workqueue for each NCR5380 host in the
 * system.  It attempts to establish I_T_L or I_T_L_Q nexuses by
 * removing the commands from the issue queue and calling
 * NCR5380_select() if a nexus is not established.
 *
 * Once a nexus is established, the NCR5380_information_transfer()
 * phase goes through the various phases as instructed by the target.
 * if the target goes into MSG IN and sends a DISCONNECT message,
 * the command structure is placed into the per instance disconnected
 * queue, and NCR5380_main tries to find more work.  If the target is
 * idle for too long, the system will try to sleep.
 *
 * If a command has disconnected, eventually an interrupt will trigger,
 * calling NCR5380_intr()  which will in turn call NCR5380_reselect
 * to reestablish a nexus.  This will run main if necessary.
 *
 * On command termination, the done function will be called as
 * appropriate.
 *
 * SCSI pointers are maintained in the SCp field of SCSI command
 * structures, being initialized after the command is connected
 * in NCR5380_select, and set as appropriate in NCR5380_information_transfer.
 * Note that in violation of the standard, an implicit SAVE POINTERS operation
 * is done, since some BROKEN disks fail to issue an explicit SAVE POINTERS.
 */

/*
 * Using this file :
 * This file a skeleton Linux SCSI driver for the NCR 5380 series
 * of chips.  To use it, you write an architecture specific functions
 * and macros and include this file in your driver.
 *
 * These macros control options :
 * AUTOSENSE - if defined, REQUEST SENSE will be performed automatically
 * for commands that return with a CHECK CONDITION status.
 *
 * DIFFERENTIAL - if defined, NCR53c81 chips will use external differential
 * transceivers.
 *
 * REAL_DMA - if defined, REAL DMA is used during the data transfer phases.
 *
 * SUPPORT_TAGS - if defined, SCSI-2 tagged queuing is used where possible
 *
 * These macros MUST be defined :
 *
 * NCR5380_read(register)  - read from the specified register
 *
 * NCR5380_write(register, value) - write to the specific register
 *
 * NCR5380_implementation_fields  - additional fields needed for this
 * specific implementation of the NCR5380
 *
 * Either real DMA *or* pseudo DMA may be implemented
 * REAL functions :
 * NCR5380_REAL_DMA should be defined if real DMA is to be used.
 * Note that the DMA setup functions should return the number of bytes
 * that they were able to program the controller for.
 *
 * Also note that generic i386/PC versions of these macros are
 * available as NCR5380_i386_dma_write_setup,
 * NCR5380_i386_dma_read_setup, and NCR5380_i386_dma_residual.
 *
 * NCR5380_dma_write_setup(instance, src, count) - initialize
 * NCR5380_dma_read_setup(instance, dst, count) - initialize
 * NCR5380_dma_residual(instance); - residual count
 *
 * PSEUDO functions :
 * NCR5380_pwrite(instance, src, count)
 * NCR5380_pread(instance, dst, count);
 *
 * The generic driver is initialized by calling NCR5380_init(instance),
 * after setting the appropriate host specific fields and ID.  If the
 * driver wishes to autoprobe for an IRQ line, the NCR5380_probe_irq(instance,
 * possible) function may be used.
 */

static int do_abort(struct Scsi_Host *);
static void do_reset(struct Scsi_Host *);

#ifdef SUPPORT_TAGS

/*
 * Functions for handling tagged queuing
 * =====================================
 *
 * ++roman (01/96): Now I've implemented SCSI-2 tagged queuing. Some notes:
 *
 * Using consecutive numbers for the tags is no good idea in my eyes. There
 * could be wrong re-usings if the counter (8 bit!) wraps and some early
 * command has been preempted for a long time. My solution: a bitfield for
 * remembering used tags.
 *
 * There's also the problem that each target has a certain queue size, but we
 * cannot know it in advance :-( We just see a QUEUE_FULL status being
 * returned. So, in this case, the driver internal queue size assumption is
 * reduced to the number of active tags if QUEUE_FULL is returned by the
 * target.
 *
 * We're also not allowed running tagged commands as long as an untagged
 * command is active. And REQUEST SENSE commands after a contingent allegiance
 * condition _must_ be untagged. To keep track whether an untagged command has
 * been issued, the host->busy array is still employed, as it is without
 * support for tagged queuing.
 *
 * One could suspect that there are possible race conditions between
 * is_lun_busy(), cmd_get_tag() and cmd_free_tag(). But I think this isn't the
 * case: is_lun_busy() and cmd_get_tag() are both called from NCR5380_main(),
 * which already guaranteed to be running at most once. It is also the only
 * place where tags/LUNs are allocated. So no other allocation can slip
 * between that pair, there could only happen a reselection, which can free a
 * tag, but that doesn't hurt. Only the sequence in cmd_free_tag() becomes
 * important: the tag bit must be cleared before 'nr_allocated' is decreased.
 */

static void __init init_tags(struct NCR5380_hostdata *hostdata)
{
        int target, lun;
        struct tag_alloc *ta;

        if (!(hostdata->flags & FLAG_TAGGED_QUEUING))
                return;

        for (target = 0; target < 8; ++target) {
                for (lun = 0; lun < 8; ++lun) {
                        ta = &hostdata->TagAlloc[target][lun];
                        bitmap_zero(ta->allocated, MAX_TAGS);
                        ta->nr_allocated = 0;
                        /* At the beginning, assume the maximum queue size we could
                         * support (MAX_TAGS). This value will be decreased if the target
                         * returns QUEUE_FULL status.
                         */
                        ta->queue_size = MAX_TAGS;
                }
        }
}


/* Check if we can issue a command to this LUN: First see if the LUN is marked
 * busy by an untagged command. If the command should use tagged queuing, also
 * check that there is a free tag and the target's queue won't overflow. This
 * function should be called with interrupts disabled to avoid race
 * conditions.
 */

static int is_lun_busy(struct scsi_cmnd *cmd, int should_be_tagged)
{
        u8 lun = cmd->device->lun;
        struct Scsi_Host *instance = cmd->device->host;
        struct NCR5380_hostdata *hostdata = shost_priv(instance);

        if (hostdata->busy[cmd->device->id] & (1 << lun))
                return 1;
        if (!should_be_tagged ||
            !(hostdata->flags & FLAG_TAGGED_QUEUING) ||
            !cmd->device->tagged_supported)
                return 0;
        if (hostdata->TagAlloc[scmd_id(cmd)][lun].nr_allocated >=
            hostdata->TagAlloc[scmd_id(cmd)][lun].queue_size) {
                dsprintk(NDEBUG_TAGS, instance, "target %d lun %d: no free tags\n",
                         scmd_id(cmd), lun);
                return 1;
        }
        return 0;
}


/* Allocate a tag for a command (there are no checks anymore, check_lun_busy()
 * must be called before!), or reserve the LUN in 'busy' if the command is
 * untagged.
 */

static void cmd_get_tag(struct scsi_cmnd *cmd, int should_be_tagged)
{
        u8 lun = cmd->device->lun;
        struct Scsi_Host *instance = cmd->device->host;
        struct NCR5380_hostdata *hostdata = shost_priv(instance);

        /* If we or the target don't support tagged queuing, allocate the LUN for
         * an untagged command.
         */
        if (!should_be_tagged ||
            !(hostdata->flags & FLAG_TAGGED_QUEUING) ||
            !cmd->device->tagged_supported) {
                cmd->tag = TAG_NONE;
                hostdata->busy[cmd->device->id] |= (1 << lun);
                dsprintk(NDEBUG_TAGS, instance, "target %d lun %d now allocated by untagged command\n",
                         scmd_id(cmd), lun);
        } else {
                struct tag_alloc *ta = &hostdata->TagAlloc[scmd_id(cmd)][lun];

                cmd->tag = find_first_zero_bit(ta->allocated, MAX_TAGS);
                set_bit(cmd->tag, ta->allocated);
                ta->nr_allocated++;
                dsprintk(NDEBUG_TAGS, instance, "using tag %d for target %d lun %d (%d tags allocated)\n",
                         cmd->tag, scmd_id(cmd), lun, ta->nr_allocated);
        }
}


/* Mark the tag of command 'cmd' as free, or in case of an untagged command,
 * unlock the LUN.
 */

static void cmd_free_tag(struct scsi_cmnd *cmd)
{
        u8 lun = cmd->device->lun;
        struct Scsi_Host *instance = cmd->device->host;
        struct NCR5380_hostdata *hostdata = shost_priv(instance);

        if (cmd->tag == TAG_NONE) {
                hostdata->busy[cmd->device->id] &= ~(1 << lun);
                dsprintk(NDEBUG_TAGS, instance, "target %d lun %d untagged cmd freed\n",
                         scmd_id(cmd), lun);
        } else if (cmd->tag >= MAX_TAGS) {
                shost_printk(KERN_NOTICE, instance,
                             "trying to free bad tag %d!\n", cmd->tag);
        } else {
                struct tag_alloc *ta = &hostdata->TagAlloc[scmd_id(cmd)][lun];
                clear_bit(cmd->tag, ta->allocated);
                ta->nr_allocated--;
                dsprintk(NDEBUG_TAGS, instance, "freed tag %d for target %d lun %d\n",
                         cmd->tag, scmd_id(cmd), lun);
        }
}


static void free_all_tags(struct NCR5380_hostdata *hostdata)
{
        int target, lun;
        struct tag_alloc *ta;

        if (!(hostdata->flags & FLAG_TAGGED_QUEUING))
                return;

        for (target = 0; target < 8; ++target) {
                for (lun = 0; lun < 8; ++lun) {
                        ta = &hostdata->TagAlloc[target][lun];
                        bitmap_zero(ta->allocated, MAX_TAGS);
                        ta->nr_allocated = 0;
                }
        }
}

#endif /* SUPPORT_TAGS */

/**
 * merge_contiguous_buffers - coalesce scatter-gather list entries
 * @cmd: command requesting IO
 *
 * Try to merge several scatter-gather buffers into one DMA transfer.
 * This is possible if the scatter buffers lie on physically
 * contiguous addresses. The first scatter-gather buffer's data are
 * assumed to be already transferred into cmd->SCp.this_residual.
 * Every buffer merged avoids an interrupt and a DMA setup operation.
 */

static void merge_contiguous_buffers(struct scsi_cmnd *cmd)
{
#if !defined(CONFIG_SUN3)
        unsigned long endaddr;
#if (NDEBUG & NDEBUG_MERGING)
        unsigned long oldlen = cmd->SCp.this_residual;
        int cnt = 1;
#endif

        for (endaddr = virt_to_phys(cmd->SCp.ptr + cmd->SCp.this_residual - 1) + 1;
             cmd->SCp.buffers_residual &&
             virt_to_phys(sg_virt(&cmd->SCp.buffer[1])) == endaddr;) {
                dprintk(NDEBUG_MERGING, "VTOP(%p) == %08lx -> merging\n",
                           page_address(sg_page(&cmd->SCp.buffer[1])), endaddr);
#if (NDEBUG & NDEBUG_MERGING)
                ++cnt;
#endif
                ++cmd->SCp.buffer;
                --cmd->SCp.buffers_residual;
                cmd->SCp.this_residual += cmd->SCp.buffer->length;
                endaddr += cmd->SCp.buffer->length;
        }
#if (NDEBUG & NDEBUG_MERGING)
        if (oldlen != cmd->SCp.this_residual)
                dprintk(NDEBUG_MERGING, "merged %d buffers from %p, new length %08x\n",
                           cnt, cmd->SCp.ptr, cmd->SCp.this_residual);
#endif
#endif /* !defined(CONFIG_SUN3) */
}

/**
 * initialize_SCp - init the scsi pointer field
 * @cmd: command block to set up
 *
 * Set up the internal fields in the SCSI command.
 */

static inline void initialize_SCp(struct scsi_cmnd *cmd)
{
        /*
         * Initialize the Scsi Pointer field so that all of the commands in the
         * various queues are valid.
         */

        if (scsi_bufflen(cmd)) {
                cmd->SCp.buffer = scsi_sglist(cmd);
                cmd->SCp.buffers_residual = scsi_sg_count(cmd) - 1;
                cmd->SCp.ptr = sg_virt(cmd->SCp.buffer);
                cmd->SCp.this_residual = cmd->SCp.buffer->length;

                merge_contiguous_buffers(cmd);
        } else {
                cmd->SCp.buffer = NULL;
                cmd->SCp.buffers_residual = 0;
                cmd->SCp.ptr = NULL;
                cmd->SCp.this_residual = 0;
        }

        cmd->SCp.Status = 0;
        cmd->SCp.Message = 0;
}

/**
 * NCR5380_poll_politely2 - wait for two chip register values
 * @instance: controller to poll
 * @reg1: 5380 register to poll
 * @bit1: Bitmask to check
 * @val1: Expected value
 * @reg2: Second 5380 register to poll
 * @bit2: Second bitmask to check
 * @val2: Second expected value
 * @wait: Time-out in jiffies
 *
 * Polls the chip in a reasonably efficient manner waiting for an
 * event to occur. After a short quick poll we begin to yield the CPU
 * (if possible). In irq contexts the time-out is arbitrarily limited.
 * Callers may hold locks as long as they are held in irq mode.
 *
 * Returns 0 if either or both event(s) occurred otherwise -ETIMEDOUT.
 */

static int NCR5380_poll_politely2(struct Scsi_Host *instance,
                                  int reg1, int bit1, int val1,
                                  int reg2, int bit2, int val2, int wait)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        unsigned long deadline = jiffies + wait;
        unsigned long n;

        /* Busy-wait for up to 10 ms */
        n = min(10000U, jiffies_to_usecs(wait));
        n *= hostdata->accesses_per_ms;
        n /= 2000;
        do {
                if ((NCR5380_read(reg1) & bit1) == val1)
                        return 0;
                if ((NCR5380_read(reg2) & bit2) == val2)
                        return 0;
                cpu_relax();
        } while (n--);

        if (irqs_disabled() || in_interrupt())
                return -ETIMEDOUT;

        /* Repeatedly sleep for 1 ms until deadline */
        while (time_is_after_jiffies(deadline)) {
                schedule_timeout_uninterruptible(1);
                if ((NCR5380_read(reg1) & bit1) == val1)
                        return 0;
                if ((NCR5380_read(reg2) & bit2) == val2)
                        return 0;
        }

        return -ETIMEDOUT;
}

static inline int NCR5380_poll_politely(struct Scsi_Host *instance,
                                        int reg, int bit, int val, int wait)
{
        return NCR5380_poll_politely2(instance, reg, bit, val,
                                                reg, bit, val, wait);
}

#if NDEBUG
static struct {
        unsigned char mask;
        const char *name;
} signals[] = {
        {SR_DBP, "PARITY"},
        {SR_RST, "RST"},
        {SR_BSY, "BSY"},
        {SR_REQ, "REQ"},
        {SR_MSG, "MSG"},
        {SR_CD, "CD"},
        {SR_IO, "IO"},
        {SR_SEL, "SEL"},
        {0, NULL}
},
basrs[] = {
        {BASR_ATN, "ATN"},
        {BASR_ACK, "ACK"},
        {0, NULL}
},
icrs[] = {
        {ICR_ASSERT_RST, "ASSERT RST"},
        {ICR_ASSERT_ACK, "ASSERT ACK"},
        {ICR_ASSERT_BSY, "ASSERT BSY"},
        {ICR_ASSERT_SEL, "ASSERT SEL"},
        {ICR_ASSERT_ATN, "ASSERT ATN"},
        {ICR_ASSERT_DATA, "ASSERT DATA"},
        {0, NULL}
},
mrs[] = {
        {MR_BLOCK_DMA_MODE, "MODE BLOCK DMA"},
        {MR_TARGET, "MODE TARGET"},
        {MR_ENABLE_PAR_CHECK, "MODE PARITY CHECK"},
        {MR_ENABLE_PAR_INTR, "MODE PARITY INTR"},
        {MR_ENABLE_EOP_INTR, "MODE EOP INTR"},
        {MR_MONITOR_BSY, "MODE MONITOR BSY"},
        {MR_DMA_MODE, "MODE DMA"},
        {MR_ARBITRATE, "MODE ARBITRATION"},
        {0, NULL}
};

/**
 * NCR5380_print - print scsi bus signals
 * @instance: adapter state to dump
 *
 * Print the SCSI bus signals for debugging purposes
 */

static void NCR5380_print(struct Scsi_Host *instance)
{
        unsigned char status, data, basr, mr, icr, i;

        data = NCR5380_read(CURRENT_SCSI_DATA_REG);
        status = NCR5380_read(STATUS_REG);
        mr = NCR5380_read(MODE_REG);
        icr = NCR5380_read(INITIATOR_COMMAND_REG);
        basr = NCR5380_read(BUS_AND_STATUS_REG);

        printk("STATUS_REG: %02x ", status);
        for (i = 0; signals[i].mask; ++i)
                if (status & signals[i].mask)
                        printk(",%s", signals[i].name);
        printk("\nBASR: %02x ", basr);
        for (i = 0; basrs[i].mask; ++i)
                if (basr & basrs[i].mask)
                        printk(",%s", basrs[i].name);
        printk("\nICR: %02x ", icr);
        for (i = 0; icrs[i].mask; ++i)
                if (icr & icrs[i].mask)
                        printk(",%s", icrs[i].name);
        printk("\nMODE: %02x ", mr);
        for (i = 0; mrs[i].mask; ++i)
                if (mr & mrs[i].mask)
                        printk(",%s", mrs[i].name);
        printk("\n");
}

static struct {
        unsigned char value;
        const char *name;
} phases[] = {
        {PHASE_DATAOUT, "DATAOUT"},
        {PHASE_DATAIN, "DATAIN"},
        {PHASE_CMDOUT, "CMDOUT"},
        {PHASE_STATIN, "STATIN"},
        {PHASE_MSGOUT, "MSGOUT"},
        {PHASE_MSGIN, "MSGIN"},
        {PHASE_UNKNOWN, "UNKNOWN"}
};

/**
 * NCR5380_print_phase - show SCSI phase
 * @instance: adapter to dump
 *
 * Print the current SCSI phase for debugging purposes
 */

static void NCR5380_print_phase(struct Scsi_Host *instance)
{
        unsigned char status;
        int i;

        status = NCR5380_read(STATUS_REG);
        if (!(status & SR_REQ))
                shost_printk(KERN_DEBUG, instance, "REQ not asserted, phase unknown.\n");
        else {
                for (i = 0; (phases[i].value != PHASE_UNKNOWN) &&
                     (phases[i].value != (status & PHASE_MASK)); ++i)
                        ;
                shost_printk(KERN_DEBUG, instance, "phase %s\n", phases[i].name);
        }
}
#endif

/**
 * NCR58380_info - report driver and host information
 * @instance: relevant scsi host instance
 *
 * For use as the host template info() handler.
 */

static const char *NCR5380_info(struct Scsi_Host *instance)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);

        return hostdata->info;
}

static void prepare_info(struct Scsi_Host *instance)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);

        snprintf(hostdata->info, sizeof(hostdata->info),
                 "%s, io_port 0x%lx, n_io_port %d, "
                 "base 0x%lx, irq %d, "
                 "can_queue %d, cmd_per_lun %d, "
                 "sg_tablesize %d, this_id %d, "
                 "flags { %s%s}, "
                 "options { %s} ",
                 instance->hostt->name, instance->io_port, instance->n_io_port,
                 instance->base, instance->irq,
                 instance->can_queue, instance->cmd_per_lun,
                 instance->sg_tablesize, instance->this_id,
                 hostdata->flags & FLAG_TAGGED_QUEUING ? "TAGGED_QUEUING " : "",
                 hostdata->flags & FLAG_TOSHIBA_DELAY  ? "TOSHIBA_DELAY "  : "",
#ifdef DIFFERENTIAL
                 "DIFFERENTIAL "
#endif
#ifdef REAL_DMA
                 "REAL_DMA "
#endif
#ifdef PARITY
                 "PARITY "
#endif
#ifdef SUPPORT_TAGS
                 "SUPPORT_TAGS "
#endif
                 "");
}

/**
 * NCR5380_init - initialise an NCR5380
 * @instance: adapter to configure
 * @flags: control flags
 *
 * Initializes *instance and corresponding 5380 chip,
 * with flags OR'd into the initial flags value.
 *
 * Notes : I assume that the host, hostno, and id bits have been
 * set correctly. I don't care about the irq and other fields.
 *
 * Returns 0 for success
 */

static int __init NCR5380_init(struct Scsi_Host *instance, int flags)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        int i;
        unsigned long deadline;

        hostdata->host = instance;
        hostdata->id_mask = 1 << instance->this_id;
        hostdata->id_higher_mask = 0;
        for (i = hostdata->id_mask; i <= 0x80; i <<= 1)
                if (i > hostdata->id_mask)
                        hostdata->id_higher_mask |= i;
        for (i = 0; i < 8; ++i)
                hostdata->busy[i] = 0;
#ifdef SUPPORT_TAGS
        init_tags(hostdata);
#endif
#if defined (REAL_DMA)
        hostdata->dma_len = 0;
#endif
        spin_lock_init(&hostdata->lock);
        hostdata->connected = NULL;
        hostdata->sensing = NULL;
        INIT_LIST_HEAD(&hostdata->autosense);
        INIT_LIST_HEAD(&hostdata->unissued);
        INIT_LIST_HEAD(&hostdata->disconnected);

        hostdata->flags = flags;

        INIT_WORK(&hostdata->main_task, NCR5380_main);
        hostdata->work_q = alloc_workqueue("ncr5380_%d",
                                WQ_UNBOUND | WQ_MEM_RECLAIM,
                                1, instance->host_no);
        if (!hostdata->work_q)
                return -ENOMEM;

        prepare_info(instance);

        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
        NCR5380_write(MODE_REG, MR_BASE);
        NCR5380_write(TARGET_COMMAND_REG, 0);
        NCR5380_write(SELECT_ENABLE_REG, 0);

        /* Calibrate register polling loop */
        i = 0;
        deadline = jiffies + 1;
        do {
                cpu_relax();
        } while (time_is_after_jiffies(deadline));
        deadline += msecs_to_jiffies(256);
        do {
                NCR5380_read(STATUS_REG);
                ++i;
                cpu_relax();
        } while (time_is_after_jiffies(deadline));
        hostdata->accesses_per_ms = i / 256;

        return 0;
}

/**
 * NCR5380_maybe_reset_bus - Detect and correct bus wedge problems.
 * @instance: adapter to check
 *
 * If the system crashed, it may have crashed with a connected target and
 * the SCSI bus busy. Check for BUS FREE phase. If not, try to abort the
 * currently established nexus, which we know nothing about. Failing that
 * do a bus reset.
 *
 * Note that a bus reset will cause the chip to assert IRQ.
 *
 * Returns 0 if successful, otherwise -ENXIO.
 */

static int NCR5380_maybe_reset_bus(struct Scsi_Host *instance)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        int pass;

        for (pass = 1; (NCR5380_read(STATUS_REG) & SR_BSY) && pass <= 6; ++pass) {
                switch (pass) {
                case 1:
                case 3:
                case 5:
                        shost_printk(KERN_ERR, instance, "SCSI bus busy, waiting up to five seconds\n");
                        NCR5380_poll_politely(instance,
                                              STATUS_REG, SR_BSY, 0, 5 * HZ);
                        break;
                case 2:
                        shost_printk(KERN_ERR, instance, "bus busy, attempting abort\n");
                        do_abort(instance);
                        break;
                case 4:
                        shost_printk(KERN_ERR, instance, "bus busy, attempting reset\n");
                        do_reset(instance);
                        /* Wait after a reset; the SCSI standard calls for
                         * 250ms, we wait 500ms to be on the safe side.
                         * But some Toshiba CD-ROMs need ten times that.
                         */
                        if (hostdata->flags & FLAG_TOSHIBA_DELAY)
                                msleep(2500);
                        else
                                msleep(500);
                        break;
                case 6:
                        shost_printk(KERN_ERR, instance, "bus locked solid\n");
                        return -ENXIO;
                }
        }
        return 0;
}

/**
 * NCR5380_exit - remove an NCR5380
 * @instance: adapter to remove
 *
 * Assumes that no more work can be queued (e.g. by NCR5380_intr).
 */

static void NCR5380_exit(struct Scsi_Host *instance)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);

        cancel_work_sync(&hostdata->main_task);
        destroy_workqueue(hostdata->work_q);
}

/**
 * complete_cmd - finish processing a command and return it to the SCSI ML
 * @instance: the host instance
 * @cmd: command to complete
 */

static void complete_cmd(struct Scsi_Host *instance,
                         struct scsi_cmnd *cmd)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);

        dsprintk(NDEBUG_QUEUES, instance, "complete_cmd: cmd %p\n", cmd);

        if (hostdata->sensing == cmd) {
                /* Autosense processing ends here */
                if ((cmd->result & 0xff) != SAM_STAT_GOOD) {
                        scsi_eh_restore_cmnd(cmd, &hostdata->ses);
                        set_host_byte(cmd, DID_ERROR);
                } else
                        scsi_eh_restore_cmnd(cmd, &hostdata->ses);
                hostdata->sensing = NULL;
        }

#ifdef SUPPORT_TAGS
        cmd_free_tag(cmd);
#else
        hostdata->busy[scmd_id(cmd)] &= ~(1 << cmd->device->lun);
#endif
        cmd->scsi_done(cmd);
}

/**
 * NCR5380_queue_command - queue a command
 * @instance: the relevant SCSI adapter
 * @cmd: SCSI command
 *
 * cmd is added to the per-instance issue queue, with minor
 * twiddling done to the host specific fields of cmd.  If the
 * main coroutine is not running, it is restarted.
 */

static int NCR5380_queue_command(struct Scsi_Host *instance,
                                 struct scsi_cmnd *cmd)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        struct NCR5380_cmd *ncmd = scsi_cmd_priv(cmd);
        unsigned long flags;

#if (NDEBUG & NDEBUG_NO_WRITE)
        switch (cmd->cmnd[0]) {
        case WRITE_6:
        case WRITE_10:
                shost_printk(KERN_DEBUG, instance, "WRITE attempted with NDEBUG_NO_WRITE set\n");
                cmd->result = (DID_ERROR << 16);
                cmd->scsi_done(cmd);
                return 0;
        }
#endif /* (NDEBUG & NDEBUG_NO_WRITE) */

        cmd->result = 0;

        /*
         * ++roman: Just disabling the NCR interrupt isn't sufficient here,
         * because also a timer int can trigger an abort or reset, which would
         * alter queues and touch the lock.
         */
        if (!NCR5380_acquire_dma_irq(instance))
                return SCSI_MLQUEUE_HOST_BUSY;

        spin_lock_irqsave(&hostdata->lock, flags);

        /*
         * Insert the cmd into the issue queue. Note that REQUEST SENSE
         * commands are added to the head of the queue since any command will
         * clear the contingent allegiance condition that exists and the
         * sense data is only guaranteed to be valid while the condition exists.
         */

        if (cmd->cmnd[0] == REQUEST_SENSE)
                list_add(&ncmd->list, &hostdata->unissued);
        else
                list_add_tail(&ncmd->list, &hostdata->unissued);

        spin_unlock_irqrestore(&hostdata->lock, flags);

        dsprintk(NDEBUG_QUEUES, instance, "command %p added to %s of queue\n",
                 cmd, (cmd->cmnd[0] == REQUEST_SENSE) ? "head" : "tail");

        /* Kick off command processing */
        queue_work(hostdata->work_q, &hostdata->main_task);
        return 0;
}

static inline void maybe_release_dma_irq(struct Scsi_Host *instance)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);

        /* Caller does the locking needed to set & test these data atomically */
        if (list_empty(&hostdata->disconnected) &&
            list_empty(&hostdata->unissued) &&
            list_empty(&hostdata->autosense) &&
            !hostdata->connected &&
            !hostdata->selecting)
                NCR5380_release_dma_irq(instance);
}

/**
 * dequeue_next_cmd - dequeue a command for processing
 * @instance: the scsi host instance
 *
 * Priority is given to commands on the autosense queue. These commands
 * need autosense because of a CHECK CONDITION result.
 *
 * Returns a command pointer if a command is found for a target that is
 * not already busy. Otherwise returns NULL.
 */

static struct scsi_cmnd *dequeue_next_cmd(struct Scsi_Host *instance)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        struct NCR5380_cmd *ncmd;
        struct scsi_cmnd *cmd;

        if (list_empty(&hostdata->autosense)) {
                list_for_each_entry(ncmd, &hostdata->unissued, list) {
                        cmd = NCR5380_to_scmd(ncmd);
                        dsprintk(NDEBUG_QUEUES, instance, "dequeue: cmd=%p target=%d busy=0x%02x lun=%llu\n",
                                 cmd, scmd_id(cmd), hostdata->busy[scmd_id(cmd)], cmd->device->lun);

                        if (
#ifdef SUPPORT_TAGS
                            !is_lun_busy(cmd, 1)
#else
                            !(hostdata->busy[scmd_id(cmd)] & (1 << cmd->device->lun))
#endif
                        ) {
                                list_del(&ncmd->list);
                                dsprintk(NDEBUG_QUEUES, instance,
                                         "dequeue: removed %p from issue queue\n", cmd);
                                return cmd;
                        }
                }
        } else {
                /* Autosense processing begins here */
                ncmd = list_first_entry(&hostdata->autosense,
                                        struct NCR5380_cmd, list);
                list_del(&ncmd->list);
                cmd = NCR5380_to_scmd(ncmd);
                dsprintk(NDEBUG_QUEUES, instance,
                         "dequeue: removed %p from autosense queue\n", cmd);
                scsi_eh_prep_cmnd(cmd, &hostdata->ses, NULL, 0, ~0);
                hostdata->sensing = cmd;
                return cmd;
        }
        return NULL;
}

static void requeue_cmd(struct Scsi_Host *instance, struct scsi_cmnd *cmd)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        struct NCR5380_cmd *ncmd = scsi_cmd_priv(cmd);

        if (hostdata->sensing) {
                scsi_eh_restore_cmnd(cmd, &hostdata->ses);
                list_add(&ncmd->list, &hostdata->autosense);
                hostdata->sensing = NULL;
        } else
                list_add(&ncmd->list, &hostdata->unissued);
}

/**
 * NCR5380_main - NCR state machines
 *
 * NCR5380_main is a coroutine that runs as long as more work can
 * be done on the NCR5380 host adapters in a system.  Both
 * NCR5380_queue_command() and NCR5380_intr() will try to start it
 * in case it is not running.
 */

static void NCR5380_main(struct work_struct *work)
{
        struct NCR5380_hostdata *hostdata =
                container_of(work, struct NCR5380_hostdata, main_task);
        struct Scsi_Host *instance = hostdata->host;
        struct scsi_cmnd *cmd;
        int done;

        /*
         * ++roman: Just disabling the NCR interrupt isn't sufficient here,
         * because also a timer int can trigger an abort or reset, which can
         * alter queues and touch the Falcon lock.
         */

        do {
                done = 1;

                spin_lock_irq(&hostdata->lock);
                while (!hostdata->connected &&
                       (cmd = dequeue_next_cmd(instance))) {

                        dsprintk(NDEBUG_MAIN, instance, "main: dequeued %p\n", cmd);

                        /*
                         * Attempt to establish an I_T_L nexus here.
                         * On success, instance->hostdata->connected is set.
                         * On failure, we must add the command back to the
                         * issue queue so we can keep trying.
                         */
                        /*
                         * REQUEST SENSE commands are issued without tagged
                         * queueing, even on SCSI-II devices because the
                         * contingent allegiance condition exists for the
                         * entire unit.
                         */
                        /* ++roman: ...and the standard also requires that
                         * REQUEST SENSE command are untagged.
                         */

#ifdef SUPPORT_TAGS
                        cmd_get_tag(cmd, cmd->cmnd[0] != REQUEST_SENSE);
#endif
                        cmd = NCR5380_select(instance, cmd);
                        if (!cmd) {
                                dsprintk(NDEBUG_MAIN, instance, "main: select complete\n");
                                maybe_release_dma_irq(instance);
                        } else {
                                dsprintk(NDEBUG_MAIN | NDEBUG_QUEUES, instance,
                                         "main: select failed, returning %p to queue\n", cmd);
                                requeue_cmd(instance, cmd);
#ifdef SUPPORT_TAGS
                                cmd_free_tag(cmd);
#endif
                        }
                }
                if (hostdata->connected
#ifdef REAL_DMA
                    && !hostdata->dma_len
#endif
                    ) {
                        dsprintk(NDEBUG_MAIN, instance, "main: performing information transfer\n");
                        NCR5380_information_transfer(instance);
                        done = 0;
                }
                spin_unlock_irq(&hostdata->lock);
                if (!done)
                        cond_resched();
        } while (!done);
}


#ifdef REAL_DMA
/*
 * Function : void NCR5380_dma_complete (struct Scsi_Host *instance)
 *
 * Purpose : Called by interrupt handler when DMA finishes or a phase
 * mismatch occurs (which would finish the DMA transfer).
 *
 * Inputs : instance - this instance of the NCR5380.
 */

static void NCR5380_dma_complete(struct Scsi_Host *instance)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        int transferred;
        unsigned char **data;
        int *count;
        int saved_data = 0, overrun = 0;
        unsigned char p;

        if (hostdata->read_overruns) {
                p = hostdata->connected->SCp.phase;
                if (p & SR_IO) {
                        udelay(10);
                        if ((NCR5380_read(BUS_AND_STATUS_REG) &
                             (BASR_PHASE_MATCH|BASR_ACK)) ==
                            (BASR_PHASE_MATCH|BASR_ACK)) {
                                saved_data = NCR5380_read(INPUT_DATA_REG);
                                overrun = 1;
                                dsprintk(NDEBUG_DMA, instance, "read overrun handled\n");
                        }
                }
        }

#if defined(CONFIG_SUN3)
        if ((sun3scsi_dma_finish(rq_data_dir(hostdata->connected->request)))) {
                pr_err("scsi%d: overrun in UDC counter -- not prepared to deal with this!\n",
                       instance->host_no);
                BUG();
        }

        /* make sure we're not stuck in a data phase */
        if ((NCR5380_read(BUS_AND_STATUS_REG) & (BASR_PHASE_MATCH | BASR_ACK)) ==
            (BASR_PHASE_MATCH | BASR_ACK)) {
                pr_err("scsi%d: BASR %02x\n", instance->host_no,
                       NCR5380_read(BUS_AND_STATUS_REG));
                pr_err("scsi%d: bus stuck in data phase -- probably a single byte overrun!\n",
                       instance->host_no);
                BUG();
        }
#endif

        NCR5380_write(MODE_REG, MR_BASE);
        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
        NCR5380_read(RESET_PARITY_INTERRUPT_REG);

        transferred = hostdata->dma_len - NCR5380_dma_residual(instance);
        hostdata->dma_len = 0;

        data = (unsigned char **)&hostdata->connected->SCp.ptr;
        count = &hostdata->connected->SCp.this_residual;
        *data += transferred;
        *count -= transferred;

        if (hostdata->read_overruns) {
                int cnt, toPIO;

                if ((NCR5380_read(STATUS_REG) & PHASE_MASK) == p && (p & SR_IO)) {
                        cnt = toPIO = hostdata->read_overruns;
                        if (overrun) {
                                dprintk(NDEBUG_DMA, "Got an input overrun, using saved byte\n");
                                *(*data)++ = saved_data;
                                (*count)--;
                                cnt--;
                                toPIO--;
                        }
                        dprintk(NDEBUG_DMA, "Doing %d-byte PIO to 0x%08lx\n", cnt, (long)*data);
                        NCR5380_transfer_pio(instance, &p, &cnt, data);
                        *count -= toPIO - cnt;
                }
        }
}
#endif /* REAL_DMA */


/**
 * NCR5380_intr - generic NCR5380 irq handler
 * @irq: interrupt number
 * @dev_id: device info
 *
 * Handle interrupts, reestablishing I_T_L or I_T_L_Q nexuses
 * from the disconnected queue, and restarting NCR5380_main()
 * as required.
 *
 * The chip can assert IRQ in any of six different conditions. The IRQ flag
 * is then cleared by reading the Reset Parity/Interrupt Register (RPIR).
 * Three of these six conditions are latched in the Bus and Status Register:
 * - End of DMA (cleared by ending DMA Mode)
 * - Parity error (cleared by reading RPIR)
 * - Loss of BSY (cleared by reading RPIR)
 * Two conditions have flag bits that are not latched:
 * - Bus phase mismatch (non-maskable in DMA Mode, cleared by ending DMA Mode)
 * - Bus reset (non-maskable)
 * The remaining condition has no flag bit at all:
 * - Selection/reselection
 *
 * Hence, establishing the cause(s) of any interrupt is partly guesswork.
 * In "The DP8490 and DP5380 Comparison Guide", National Semiconductor
 * claimed that "the design of the [DP8490] interrupt logic ensures
 * interrupts will not be lost (they can be on the DP5380)."
 * The L5380/53C80 datasheet from LOGIC Devices has more details.
 *
 * Checking for bus reset by reading RST is futile because of interrupt
 * latency, but a bus reset will reset chip logic. Checking for parity error
 * is unnecessary because that interrupt is never enabled. A Loss of BSY
 * condition will clear DMA Mode. We can tell when this occurs because the
 * the Busy Monitor interrupt is enabled together with DMA Mode.
 */

static irqreturn_t NCR5380_intr(int irq, void *dev_id)
{
        struct Scsi_Host *instance = dev_id;
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        int handled = 0;
        unsigned char basr;
        unsigned long flags;

        spin_lock_irqsave(&hostdata->lock, flags);

        basr = NCR5380_read(BUS_AND_STATUS_REG);
        if (basr & BASR_IRQ) {
                unsigned char mr = NCR5380_read(MODE_REG);
                unsigned char sr = NCR5380_read(STATUS_REG);

                dsprintk(NDEBUG_INTR, instance, "IRQ %d, BASR 0x%02x, SR 0x%02x, MR 0x%02x\n",
                         irq, basr, sr, mr);

#if defined(REAL_DMA)
                if ((mr & MR_DMA_MODE) || (mr & MR_MONITOR_BSY)) {
                        /* Probably End of DMA, Phase Mismatch or Loss of BSY.
                         * We ack IRQ after clearing Mode Register. Workarounds
                         * for End of DMA errata need to happen in DMA Mode.
                         */

                        dsprintk(NDEBUG_INTR, instance, "interrupt in DMA mode\n");

                        if (hostdata->connected) {
                                NCR5380_dma_complete(instance);
                                queue_work(hostdata->work_q, &hostdata->main_task);
                        } else {
                                NCR5380_write(MODE_REG, MR_BASE);
                                NCR5380_read(RESET_PARITY_INTERRUPT_REG);
                        }
                } else
#endif /* REAL_DMA */
                if ((NCR5380_read(CURRENT_SCSI_DATA_REG) & hostdata->id_mask) &&
                    (sr & (SR_SEL | SR_IO | SR_BSY | SR_RST)) == (SR_SEL | SR_IO)) {
                        /* Probably reselected */
                        NCR5380_write(SELECT_ENABLE_REG, 0);
                        NCR5380_read(RESET_PARITY_INTERRUPT_REG);

                        dsprintk(NDEBUG_INTR, instance, "interrupt with SEL and IO\n");

                        if (!hostdata->connected) {
                                NCR5380_reselect(instance);
                                queue_work(hostdata->work_q, &hostdata->main_task);
                        }
                        if (!hostdata->connected)
                                NCR5380_write(SELECT_ENABLE_REG, hostdata->id_mask);
                } else {
                        /* Probably Bus Reset */
                        NCR5380_read(RESET_PARITY_INTERRUPT_REG);

                        dsprintk(NDEBUG_INTR, instance, "unknown interrupt\n");
#ifdef SUN3_SCSI_VME
                        dregs->csr |= CSR_DMA_ENABLE;
#endif
                }
                handled = 1;
        } else {
                shost_printk(KERN_NOTICE, instance, "interrupt without IRQ bit\n");
#ifdef SUN3_SCSI_VME
                dregs->csr |= CSR_DMA_ENABLE;
#endif
        }

        spin_unlock_irqrestore(&hostdata->lock, flags);

        return IRQ_RETVAL(handled);
}

/*
 * Function : int NCR5380_select(struct Scsi_Host *instance,
 * struct scsi_cmnd *cmd)
 *
 * Purpose : establishes I_T_L or I_T_L_Q nexus for new or existing command,
 * including ARBITRATION, SELECTION, and initial message out for
 * IDENTIFY and queue messages.
 *
 * Inputs : instance - instantiation of the 5380 driver on which this
 * target lives, cmd - SCSI command to execute.
 *
 * Returns cmd if selection failed but should be retried,
 * NULL if selection failed and should not be retried, or
 * NULL if selection succeeded (hostdata->connected == cmd).
 *
 * Side effects :
 * If bus busy, arbitration failed, etc, NCR5380_select() will exit
 * with registers as they should have been on entry - ie
 * SELECT_ENABLE will be set appropriately, the NCR5380
 * will cease to drive any SCSI bus signals.
 *
 * If successful : I_T_L or I_T_L_Q nexus will be established,
 * instance->connected will be set to cmd.
 * SELECT interrupt will be disabled.
 *
 * If failed (no target) : cmd->scsi_done() will be called, and the
 * cmd->result host byte set to DID_BAD_TARGET.
 */

static struct scsi_cmnd *NCR5380_select(struct Scsi_Host *instance,
                                        struct scsi_cmnd *cmd)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        unsigned char tmp[3], phase;
        unsigned char *data;
        int len;
        int err;

        NCR5380_dprint(NDEBUG_ARBITRATION, instance);
        dsprintk(NDEBUG_ARBITRATION, instance, "starting arbitration, id = %d\n",
                 instance->this_id);

        /*
         * Arbitration and selection phases are slow and involve dropping the
         * lock, so we have to watch out for EH. An exception handler may
         * change 'selecting' to NULL. This function will then return NULL
         * so that the caller will forget about 'cmd'. (During information
         * transfer phases, EH may change 'connected' to NULL.)
         */
        hostdata->selecting = cmd;

        /*
         * Set the phase bits to 0, otherwise the NCR5380 won't drive the
         * data bus during SELECTION.
         */

        NCR5380_write(TARGET_COMMAND_REG, 0);

        /*
         * Start arbitration.
         */

        NCR5380_write(OUTPUT_DATA_REG, hostdata->id_mask);
        NCR5380_write(MODE_REG, MR_ARBITRATE);

        /* The chip now waits for BUS FREE phase. Then after the 800 ns
         * Bus Free Delay, arbitration will begin.
         */

        spin_unlock_irq(&hostdata->lock);
        err = NCR5380_poll_politely2(instance, MODE_REG, MR_ARBITRATE, 0,
                        INITIATOR_COMMAND_REG, ICR_ARBITRATION_PROGRESS,
                                               ICR_ARBITRATION_PROGRESS, HZ);
        spin_lock_irq(&hostdata->lock);
        if (!(NCR5380_read(MODE_REG) & MR_ARBITRATE)) {
                /* Reselection interrupt */
                goto out;
        }
        if (err < 0) {
                NCR5380_write(MODE_REG, MR_BASE);
                shost_printk(KERN_ERR, instance,
                             "select: arbitration timeout\n");
                goto out;
        }
        spin_unlock_irq(&hostdata->lock);

        /* The SCSI-2 arbitration delay is 2.4 us */
        udelay(3);

        /* Check for lost arbitration */
        if ((NCR5380_read(INITIATOR_COMMAND_REG) & ICR_ARBITRATION_LOST) ||
            (NCR5380_read(CURRENT_SCSI_DATA_REG) & hostdata->id_higher_mask) ||
            (NCR5380_read(INITIATOR_COMMAND_REG) & ICR_ARBITRATION_LOST)) {
                NCR5380_write(MODE_REG, MR_BASE);
                dsprintk(NDEBUG_ARBITRATION, instance, "lost arbitration, deasserting MR_ARBITRATE\n");
                spin_lock_irq(&hostdata->lock);
                goto out;
        }

        /* After/during arbitration, BSY should be asserted.
         * IBM DPES-31080 Version S31Q works now
         * Tnx to Thomas_Roesch@m2.maus.de for finding this! (Roman)
         */
        NCR5380_write(INITIATOR_COMMAND_REG,
                      ICR_BASE | ICR_ASSERT_SEL | ICR_ASSERT_BSY);

        /*
         * Again, bus clear + bus settle time is 1.2us, however, this is
         * a minimum so we'll udelay ceil(1.2)
         */

        if (hostdata->flags & FLAG_TOSHIBA_DELAY)
                udelay(15);
        else
                udelay(2);

        spin_lock_irq(&hostdata->lock);

        /* NCR5380_reselect() clears MODE_REG after a reselection interrupt */
        if (!(NCR5380_read(MODE_REG) & MR_ARBITRATE))
                goto out;

        if (!hostdata->selecting) {
                NCR5380_write(MODE_REG, MR_BASE);
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                goto out;
        }

        dsprintk(NDEBUG_ARBITRATION, instance, "won arbitration\n");

        /*
         * Now that we have won arbitration, start Selection process, asserting
         * the host and target ID's on the SCSI bus.
         */

        NCR5380_write(OUTPUT_DATA_REG, hostdata->id_mask | (1 << scmd_id(cmd)));

        /*
         * Raise ATN while SEL is true before BSY goes false from arbitration,
         * since this is the only way to guarantee that we'll get a MESSAGE OUT
         * phase immediately after selection.
         */

        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_BSY |
                      ICR_ASSERT_DATA | ICR_ASSERT_ATN | ICR_ASSERT_SEL);
        NCR5380_write(MODE_REG, MR_BASE);

        /*
         * Reselect interrupts must be turned off prior to the dropping of BSY,
         * otherwise we will trigger an interrupt.
         */
        NCR5380_write(SELECT_ENABLE_REG, 0);

        spin_unlock_irq(&hostdata->lock);

        /*
         * The initiator shall then wait at least two deskew delays and release
         * the BSY signal.
         */
        udelay(1);        /* wingel -- wait two bus deskew delay >2*45ns */

        /* Reset BSY */
        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_DATA |
                      ICR_ASSERT_ATN | ICR_ASSERT_SEL);

        /*
         * Something weird happens when we cease to drive BSY - looks
         * like the board/chip is letting us do another read before the
         * appropriate propagation delay has expired, and we're confusing
         * a BSY signal from ourselves as the target's response to SELECTION.
         *
         * A small delay (the 'C++' frontend breaks the pipeline with an
         * unnecessary jump, making it work on my 386-33/Trantor T128, the
         * tighter 'C' code breaks and requires this) solves the problem -
         * the 1 us delay is arbitrary, and only used because this delay will
         * be the same on other platforms and since it works here, it should
         * work there.
         *
         * wingel suggests that this could be due to failing to wait
         * one deskew delay.
         */

        udelay(1);

        dsprintk(NDEBUG_SELECTION, instance, "selecting target %d\n", scmd_id(cmd));

        /*
         * The SCSI specification calls for a 250 ms timeout for the actual
         * selection.
         */

        err = NCR5380_poll_politely(instance, STATUS_REG, SR_BSY, SR_BSY,
                                    msecs_to_jiffies(250));

        if ((NCR5380_read(STATUS_REG) & (SR_SEL | SR_IO)) == (SR_SEL | SR_IO)) {
                spin_lock_irq(&hostdata->lock);
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                NCR5380_reselect(instance);
                if (!hostdata->connected)
                        NCR5380_write(SELECT_ENABLE_REG, hostdata->id_mask);
                shost_printk(KERN_ERR, instance, "reselection after won arbitration?\n");
                goto out;
        }

        if (err < 0) {
                spin_lock_irq(&hostdata->lock);
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                NCR5380_write(SELECT_ENABLE_REG, hostdata->id_mask);
                /* Can't touch cmd if it has been reclaimed by the scsi ML */
                if (hostdata->selecting) {
                        cmd->result = DID_BAD_TARGET << 16;
                        complete_cmd(instance, cmd);
                        dsprintk(NDEBUG_SELECTION, instance, "target did not respond within 250ms\n");
                        cmd = NULL;
                }
                goto out;
        }

        /*
         * No less than two deskew delays after the initiator detects the
         * BSY signal is true, it shall release the SEL signal and may
         * change the DATA BUS.                                     -wingel
         */

        udelay(1);

        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_ATN);

        /*
         * Since we followed the SCSI spec, and raised ATN while SEL
         * was true but before BSY was false during selection, the information
         * transfer phase should be a MESSAGE OUT phase so that we can send the
         * IDENTIFY message.
         *
         * If SCSI-II tagged queuing is enabled, we also send a SIMPLE_QUEUE_TAG
         * message (2 bytes) with a tag ID that we increment with every command
         * until it wraps back to 0.
         *
         * XXX - it turns out that there are some broken SCSI-II devices,
         * which claim to support tagged queuing but fail when more than
         * some number of commands are issued at once.
         */

        /* Wait for start of REQ/ACK handshake */

        err = NCR5380_poll_politely(instance, STATUS_REG, SR_REQ, SR_REQ, HZ);
        spin_lock_irq(&hostdata->lock);
        if (err < 0) {
                shost_printk(KERN_ERR, instance, "select: REQ timeout\n");
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                NCR5380_write(SELECT_ENABLE_REG, hostdata->id_mask);
                goto out;
        }
        if (!hostdata->selecting) {
                do_abort(instance);
                goto out;
        }

        dsprintk(NDEBUG_SELECTION, instance, "target %d selected, going into MESSAGE OUT phase.\n",
                 scmd_id(cmd));
        tmp[0] = IDENTIFY(1, cmd->device->lun);

#ifdef SUPPORT_TAGS
        if (cmd->tag != TAG_NONE) {
                tmp[1] = hostdata->last_message = SIMPLE_QUEUE_TAG;
                tmp[2] = cmd->tag;
                len = 3;
        } else
                len = 1;
#else
        len = 1;
        cmd->tag = 0;
#endif /* SUPPORT_TAGS */

        /* Send message(s) */
        data = tmp;
        phase = PHASE_MSGOUT;
        NCR5380_transfer_pio(instance, &phase, &len, &data);
        dsprintk(NDEBUG_SELECTION, instance, "nexus established.\n");
        /* XXX need to handle errors here */

        hostdata->connected = cmd;
#ifndef SUPPORT_TAGS
        hostdata->busy[cmd->device->id] |= 1 << cmd->device->lun;
#endif
#ifdef SUN3_SCSI_VME
        dregs->csr |= CSR_INTR;
#endif

        initialize_SCp(cmd);

        cmd = NULL;

out:
        if (!hostdata->selecting)
                return NULL;
        hostdata->selecting = NULL;
        return cmd;
}

/*
 * Function : int NCR5380_transfer_pio (struct Scsi_Host *instance,
 * unsigned char *phase, int *count, unsigned char **data)
 *
 * Purpose : transfers data in given phase using polled I/O
 *
 * Inputs : instance - instance of driver, *phase - pointer to
 * what phase is expected, *count - pointer to number of
 * bytes to transfer, **data - pointer to data pointer.
 *
 * Returns : -1 when different phase is entered without transferring
 * maximum number of bytes, 0 if all bytes are transferred or exit
 * is in same phase.
 *
 * Also, *phase, *count, *data are modified in place.
 *
 * XXX Note : handling for bus free may be useful.
 */

/*
 * Note : this code is not as quick as it could be, however it
 * IS 100% reliable, and for the actual data transfer where speed
 * counts, we will always do a pseudo DMA or DMA transfer.
 */

static int NCR5380_transfer_pio(struct Scsi_Host *instance,
                                unsigned char *phase, int *count,
                                unsigned char **data)
{
        unsigned char p = *phase, tmp;
        int c = *count;
        unsigned char *d = *data;

        /*
         * The NCR5380 chip will only drive the SCSI bus when the
         * phase specified in the appropriate bits of the TARGET COMMAND
         * REGISTER match the STATUS REGISTER
         */

        NCR5380_write(TARGET_COMMAND_REG, PHASE_SR_TO_TCR(p));

        do {
                /*
                 * Wait for assertion of REQ, after which the phase bits will be
                 * valid
                 */

                if (NCR5380_poll_politely(instance, STATUS_REG, SR_REQ, SR_REQ, HZ) < 0)
                        break;

                dsprintk(NDEBUG_HANDSHAKE, instance, "REQ asserted\n");

                /* Check for phase mismatch */
                if ((NCR5380_read(STATUS_REG) & PHASE_MASK) != p) {
                        dsprintk(NDEBUG_PIO, instance, "phase mismatch\n");
                        NCR5380_dprint_phase(NDEBUG_PIO, instance);
                        break;
                }

                /* Do actual transfer from SCSI bus to / from memory */
                if (!(p & SR_IO))
                        NCR5380_write(OUTPUT_DATA_REG, *d);
                else
                        *d = NCR5380_read(CURRENT_SCSI_DATA_REG);

                ++d;

                /*
                 * The SCSI standard suggests that in MSGOUT phase, the initiator
                 * should drop ATN on the last byte of the message phase
                 * after REQ has been asserted for the handshake but before
                 * the initiator raises ACK.
                 */

                if (!(p & SR_IO)) {
                        if (!((p & SR_MSG) && c > 1)) {
                                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_DATA);
                                NCR5380_dprint(NDEBUG_PIO, instance);
                                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE |
                                              ICR_ASSERT_DATA | ICR_ASSERT_ACK);
                        } else {
                                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE |
                                              ICR_ASSERT_DATA | ICR_ASSERT_ATN);
                                NCR5380_dprint(NDEBUG_PIO, instance);
                                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE |
                                              ICR_ASSERT_DATA | ICR_ASSERT_ATN | ICR_ASSERT_ACK);
                        }
                } else {
                        NCR5380_dprint(NDEBUG_PIO, instance);
                        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_ACK);
                }

                if (NCR5380_poll_politely(instance,
                                          STATUS_REG, SR_REQ, 0, 5 * HZ) < 0)
                        break;

                dsprintk(NDEBUG_HANDSHAKE, instance, "REQ negated, handshake complete\n");

/*
 * We have several special cases to consider during REQ/ACK handshaking :
 * 1.  We were in MSGOUT phase, and we are on the last byte of the
 * message.  ATN must be dropped as ACK is dropped.
 *
 * 2.  We are in a MSGIN phase, and we are on the last byte of the
 * message.  We must exit with ACK asserted, so that the calling
 * code may raise ATN before dropping ACK to reject the message.
 *
 * 3.  ACK and ATN are clear and the target may proceed as normal.
 */
                if (!(p == PHASE_MSGIN && c == 1)) {
                        if (p == PHASE_MSGOUT && c > 1)
                                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_ATN);
                        else
                                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                }
        } while (--c);

        dsprintk(NDEBUG_PIO, instance, "residual %d\n", c);

        *count = c;
        *data = d;
        tmp = NCR5380_read(STATUS_REG);
        /* The phase read from the bus is valid if either REQ is (already)
         * asserted or if ACK hasn't been released yet. The latter applies if
         * we're in MSG IN, DATA IN or STATUS and all bytes have been received.
         */
        if ((tmp & SR_REQ) || ((tmp & SR_IO) && c == 0))
                *phase = tmp & PHASE_MASK;
        else
                *phase = PHASE_UNKNOWN;

        if (!c || (*phase == p))
                return 0;
        else
                return -1;
}

/**
 * do_reset - issue a reset command
 * @instance: adapter to reset
 *
 * Issue a reset sequence to the NCR5380 and try and get the bus
 * back into sane shape.
 *
 * This clears the reset interrupt flag because there may be no handler for
 * it. When the driver is initialized, the NCR5380_intr() handler has not yet
 * been installed. And when in EH we may have released the ST DMA interrupt.
 */

static void do_reset(struct Scsi_Host *instance)
{
        unsigned long flags;

        local_irq_save(flags);
        NCR5380_write(TARGET_COMMAND_REG,
                      PHASE_SR_TO_TCR(NCR5380_read(STATUS_REG) & PHASE_MASK));
        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_RST);
        udelay(50);
        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
        (void)NCR5380_read(RESET_PARITY_INTERRUPT_REG);
        local_irq_restore(flags);
}

/**
 * do_abort - abort the currently established nexus by going to
 * MESSAGE OUT phase and sending an ABORT message.
 * @instance: relevant scsi host instance
 *
 * Returns 0 on success, -1 on failure.
 */

static int do_abort(struct Scsi_Host *instance)
{
        unsigned char *msgptr, phase, tmp;
        int len;
        int rc;

        /* Request message out phase */
        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_ATN);

        /*
         * Wait for the target to indicate a valid phase by asserting
         * REQ.  Once this happens, we'll have either a MSGOUT phase
         * and can immediately send the ABORT message, or we'll have some
         * other phase and will have to source/sink data.
         *
         * We really don't care what value was on the bus or what value
         * the target sees, so we just handshake.
         */

        rc = NCR5380_poll_politely(instance, STATUS_REG, SR_REQ, SR_REQ, 10 * HZ);
        if (rc < 0)
                goto timeout;

        tmp = NCR5380_read(STATUS_REG) & PHASE_MASK;

        NCR5380_write(TARGET_COMMAND_REG, PHASE_SR_TO_TCR(tmp));

        if (tmp != PHASE_MSGOUT) {
                NCR5380_write(INITIATOR_COMMAND_REG,
                              ICR_BASE | ICR_ASSERT_ATN | ICR_ASSERT_ACK);
                rc = NCR5380_poll_politely(instance, STATUS_REG, SR_REQ, 0, 3 * HZ);
                if (rc < 0)
                        goto timeout;
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_ATN);
        }

        tmp = ABORT;
        msgptr = &tmp;
        len = 1;
        phase = PHASE_MSGOUT;
        NCR5380_transfer_pio(instance, &phase, &len, &msgptr);

        /*
         * If we got here, and the command completed successfully,
         * we're about to go into bus free state.
         */

        return len ? -1 : 0;

timeout:
        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
        return -1;
}

#if defined(REAL_DMA)
/*
 * Function : int NCR5380_transfer_dma (struct Scsi_Host *instance,
 * unsigned char *phase, int *count, unsigned char **data)
 *
 * Purpose : transfers data in given phase using either real
 * or pseudo DMA.
 *
 * Inputs : instance - instance of driver, *phase - pointer to
 * what phase is expected, *count - pointer to number of
 * bytes to transfer, **data - pointer to data pointer.
 *
 * Returns : -1 when different phase is entered without transferring
 * maximum number of bytes, 0 if all bytes or transferred or exit
 * is in same phase.
 *
 * Also, *phase, *count, *data are modified in place.
 */


static int NCR5380_transfer_dma(struct Scsi_Host *instance,
                                unsigned char *phase, int *count,
                                unsigned char **data)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        register int c = *count;
        register unsigned char p = *phase;

#if defined(CONFIG_SUN3)
        /* sanity check */
        if (!sun3_dma_setup_done) {
                pr_err("scsi%d: transfer_dma without setup!\n",
                       instance->host_no);
                BUG();
        }
        hostdata->dma_len = c;

        dsprintk(NDEBUG_DMA, instance, "initializing DMA %s: length %d, address %p\n",
                 (p & SR_IO) ? "receive" : "send", c, *data);

        /* netbsd turns off ints here, why not be safe and do it too */

        /* send start chain */
        sun3scsi_dma_start(c, *data);

        NCR5380_write(TARGET_COMMAND_REG, PHASE_SR_TO_TCR(p));
        NCR5380_write(MODE_REG, MR_BASE | MR_DMA_MODE | MR_MONITOR_BSY |
                                MR_ENABLE_EOP_INTR);
        if (p & SR_IO) {
                NCR5380_write(INITIATOR_COMMAND_REG, 0);
                NCR5380_write(START_DMA_INITIATOR_RECEIVE_REG, 0);
        } else {
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_ASSERT_DATA);
                NCR5380_write(START_DMA_SEND_REG, 0);
        }

#ifdef SUN3_SCSI_VME
        dregs->csr |= CSR_DMA_ENABLE;
#endif

        sun3_dma_active = 1;

#else /* !defined(CONFIG_SUN3) */
        register unsigned char *d = *data;
        unsigned char tmp;

        if ((tmp = (NCR5380_read(STATUS_REG) & PHASE_MASK)) != p) {
                *phase = tmp;
                return -1;
        }

        if (hostdata->read_overruns && (p & SR_IO))
                c -= hostdata->read_overruns;

        dsprintk(NDEBUG_DMA, instance, "initializing DMA %s: length %d, address %p\n",
                 (p & SR_IO) ? "receive" : "send", c, d);

        NCR5380_write(TARGET_COMMAND_REG, PHASE_SR_TO_TCR(p));
        NCR5380_write(MODE_REG, MR_BASE | MR_DMA_MODE | MR_MONITOR_BSY |
                                MR_ENABLE_EOP_INTR);

        if (!(hostdata->flags & FLAG_LATE_DMA_SETUP)) {
                /* On the Medusa, it is a must to initialize the DMA before
                 * starting the NCR. This is also the cleaner way for the TT.
                 */
                hostdata->dma_len = (p & SR_IO) ?
                        NCR5380_dma_read_setup(instance, d, c) :
                        NCR5380_dma_write_setup(instance, d, c);
        }

        if (p & SR_IO)
                NCR5380_write(START_DMA_INITIATOR_RECEIVE_REG, 0);
        else {
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_DATA);
                NCR5380_write(START_DMA_SEND_REG, 0);
        }

        if (hostdata->flags & FLAG_LATE_DMA_SETUP) {
                /* On the Falcon, the DMA setup must be done after the last */
                /* NCR access, else the DMA setup gets trashed!
                 */
                hostdata->dma_len = (p & SR_IO) ?
                        NCR5380_dma_read_setup(instance, d, c) :
                        NCR5380_dma_write_setup(instance, d, c);
        }
#endif /* !defined(CONFIG_SUN3) */

        return 0;
}
#endif /* defined(REAL_DMA) */

/*
 * Function : NCR5380_information_transfer (struct Scsi_Host *instance)
 *
 * Purpose : run through the various SCSI phases and do as the target
 * directs us to.  Operates on the currently connected command,
 * instance->connected.
 *
 * Inputs : instance, instance for which we are doing commands
 *
 * Side effects : SCSI things happen, the disconnected queue will be
 * modified if a command disconnects, *instance->connected will
 * change.
 *
 * XXX Note : we need to watch for bus free or a reset condition here
 * to recover from an unexpected bus free condition.
 */

static void NCR5380_information_transfer(struct Scsi_Host *instance)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        unsigned char msgout = NOP;
        int sink = 0;
        int len;
#if defined(REAL_DMA)
        int transfersize;
#endif
        unsigned char *data;
        unsigned char phase, tmp, extended_msg[10], old_phase = 0xff;
        struct scsi_cmnd *cmd;

#ifdef SUN3_SCSI_VME
        dregs->csr |= CSR_INTR;
#endif

        while ((cmd = hostdata->connected)) {
                struct NCR5380_cmd *ncmd = scsi_cmd_priv(cmd);

                tmp = NCR5380_read(STATUS_REG);
                /* We only have a valid SCSI phase when REQ is asserted */
                if (tmp & SR_REQ) {
                        phase = (tmp & PHASE_MASK);
                        if (phase != old_phase) {
                                old_phase = phase;
                                NCR5380_dprint_phase(NDEBUG_INFORMATION, instance);
                        }
#if defined(CONFIG_SUN3)
                        if (phase == PHASE_CMDOUT) {
#if defined(REAL_DMA)
                                void *d;
                                unsigned long count;

                                if (!cmd->SCp.this_residual && cmd->SCp.buffers_residual) {
                                        count = cmd->SCp.buffer->length;
                                        d = sg_virt(cmd->SCp.buffer);
                                } else {
                                        count = cmd->SCp.this_residual;
                                        d = cmd->SCp.ptr;
                                }
                                /* this command setup for dma yet? */
                                if ((count >= DMA_MIN_SIZE) && (sun3_dma_setup_done != cmd)) {
                                        if (cmd->request->cmd_type == REQ_TYPE_FS) {
                                                sun3scsi_dma_setup(instance, d, count,
                                                                   rq_data_dir(cmd->request));
                                                sun3_dma_setup_done = cmd;
                                        }
                                }
#endif
#ifdef SUN3_SCSI_VME
                                dregs->csr |= CSR_INTR;
#endif
                        }
#endif /* CONFIG_SUN3 */

                        if (sink && (phase != PHASE_MSGOUT)) {
                                NCR5380_write(TARGET_COMMAND_REG, PHASE_SR_TO_TCR(tmp));

                                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_ATN |
                                              ICR_ASSERT_ACK);
                                while (NCR5380_read(STATUS_REG) & SR_REQ)
                                        ;
                                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE |
                                              ICR_ASSERT_ATN);
                                sink = 0;
                                continue;
                        }

                        switch (phase) {
                        case PHASE_DATAOUT:
#if (NDEBUG & NDEBUG_NO_DATAOUT)
                                shost_printk(KERN_DEBUG, instance, "NDEBUG_NO_DATAOUT set, attempted DATAOUT aborted\n");
                                sink = 1;
                                do_abort(instance);
                                cmd->result = DID_ERROR << 16;
                                complete_cmd(instance, cmd);
                                return;
#endif
                        case PHASE_DATAIN:
                                /*
                                 * If there is no room left in the current buffer in the
                                 * scatter-gather list, move onto the next one.
                                 */

                                if (!cmd->SCp.this_residual && cmd->SCp.buffers_residual) {
                                        ++cmd->SCp.buffer;
                                        --cmd->SCp.buffers_residual;
                                        cmd->SCp.this_residual = cmd->SCp.buffer->length;
                                        cmd->SCp.ptr = sg_virt(cmd->SCp.buffer);
                                        merge_contiguous_buffers(cmd);
                                        dsprintk(NDEBUG_INFORMATION, instance, "%d bytes and %d buffers left\n",
                                                 cmd->SCp.this_residual,
                                                 cmd->SCp.buffers_residual);
                                }

                                /*
                                 * The preferred transfer method is going to be
                                 * PSEUDO-DMA for systems that are strictly PIO,
                                 * since we can let the hardware do the handshaking.
                                 *
                                 * For this to work, we need to know the transfersize
                                 * ahead of time, since the pseudo-DMA code will sit
                                 * in an unconditional loop.
                                 */

                                /* ++roman: I suggest, this should be
                                 * #if def(REAL_DMA)
                                 * instead of leaving REAL_DMA out.
                                 */

#if defined(REAL_DMA)
#if !defined(CONFIG_SUN3)
                                transfersize = 0;
                                if (!cmd->device->borken)
#endif
                                        transfersize = NCR5380_dma_xfer_len(instance, cmd, phase);

                                if (transfersize >= DMA_MIN_SIZE) {
                                        len = transfersize;
                                        cmd->SCp.phase = phase;
                                        if (NCR5380_transfer_dma(instance, &phase,
                                            &len, (unsigned char **)&cmd->SCp.ptr)) {
                                                /*
                                                 * If the watchdog timer fires, all future
                                                 * accesses to this device will use the
                                                 * polled-IO.
                                                 */
                                                scmd_printk(KERN_INFO, cmd,
                                                        "switching to slow handshake\n");
                                                cmd->device->borken = 1;
                                                sink = 1;
                                                do_abort(instance);
                                                cmd->result = DID_ERROR << 16;
                                                complete_cmd(instance, cmd);
                                                /* XXX - need to source or sink data here, as appropriate */
                                        } else {
#ifdef REAL_DMA
                                                /* ++roman: When using real DMA,
                                                 * information_transfer() should return after
                                                 * starting DMA since it has nothing more to
                                                 * do.
                                                 */
                                                return;
#else
                                                cmd->SCp.this_residual -= transfersize - len;
#endif
                                        }
                                } else
#endif /* defined(REAL_DMA) */
                                {
                                        spin_unlock_irq(&hostdata->lock);
                                        NCR5380_transfer_pio(instance, &phase,
                                                             (int *)&cmd->SCp.this_residual,
                                                             (unsigned char **)&cmd->SCp.ptr);
                                        spin_lock_irq(&hostdata->lock);
                                }
#if defined(CONFIG_SUN3) && defined(REAL_DMA)
                                /* if we had intended to dma that command clear it */
                                if (sun3_dma_setup_done == cmd)
                                        sun3_dma_setup_done = NULL;
#endif
                                break;
                        case PHASE_MSGIN:
                                len = 1;
                                data = &tmp;
                                NCR5380_transfer_pio(instance, &phase, &len, &data);
                                cmd->SCp.Message = tmp;

                                switch (tmp) {
                                case ABORT:
                                case COMMAND_COMPLETE:
                                        /* Accept message by clearing ACK */
                                        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                                        dsprintk(NDEBUG_QUEUES, instance,
                                                 "COMMAND COMPLETE %p target %d lun %llu\n",
                                                 cmd, scmd_id(cmd), cmd->device->lun);

                                        hostdata->connected = NULL;
#ifdef SUPPORT_TAGS
                                        cmd_free_tag(cmd);
                                        if (status_byte(cmd->SCp.Status) == QUEUE_FULL) {
                                                u8 lun = cmd->device->lun;
                                                struct tag_alloc *ta = &hostdata->TagAlloc[scmd_id(cmd)][lun];

                                                dsprintk(NDEBUG_TAGS, instance,
                                                         "QUEUE_FULL %p target %d lun %d nr_allocated %d\n",
                                                         cmd, scmd_id(cmd), lun, ta->nr_allocated);
                                                if (ta->queue_size > ta->nr_allocated)
                                                        ta->queue_size = ta->nr_allocated;
                                        }
#endif

                                        cmd->result &= ~0xffff;
                                        cmd->result |= cmd->SCp.Status;
                                        cmd->result |= cmd->SCp.Message << 8;

                                        if (cmd->cmnd[0] == REQUEST_SENSE)
                                                complete_cmd(instance, cmd);
                                        else {
                                                if (cmd->SCp.Status == SAM_STAT_CHECK_CONDITION ||
                                                    cmd->SCp.Status == SAM_STAT_COMMAND_TERMINATED) {
                                                        dsprintk(NDEBUG_QUEUES, instance, "autosense: adding cmd %p to tail of autosense queue\n",
                                                                 cmd);
                                                        list_add_tail(&ncmd->list,
                                                                      &hostdata->autosense);
                                                } else
                                                        complete_cmd(instance, cmd);
                                        }

                                        /*
                                         * Restore phase bits to 0 so an interrupted selection,
                                         * arbitration can resume.
                                         */
                                        NCR5380_write(TARGET_COMMAND_REG, 0);

                                        /* Enable reselect interrupts */
                                        NCR5380_write(SELECT_ENABLE_REG, hostdata->id_mask);

                                        maybe_release_dma_irq(instance);
                                        return;
                                case MESSAGE_REJECT:
                                        /* Accept message by clearing ACK */
                                        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                                        switch (hostdata->last_message) {
                                        case HEAD_OF_QUEUE_TAG:
                                        case ORDERED_QUEUE_TAG:
                                        case SIMPLE_QUEUE_TAG:
                                                /* The target obviously doesn't support tagged
                                                 * queuing, even though it announced this ability in
                                                 * its INQUIRY data ?!? (maybe only this LUN?) Ok,
                                                 * clear 'tagged_supported' and lock the LUN, since
                                                 * the command is treated as untagged further on.
                                                 */
                                                cmd->device->tagged_supported = 0;
                                                hostdata->busy[cmd->device->id] |= (1 << cmd->device->lun);
                                                cmd->tag = TAG_NONE;
                                                dsprintk(NDEBUG_TAGS, instance, "target %d lun %llu rejected QUEUE_TAG message; tagged queuing disabled\n",
                                                         scmd_id(cmd), cmd->device->lun);
                                                break;
                                        }
                                        break;
                                case DISCONNECT:
                                        /* Accept message by clearing ACK */
                                        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                                        hostdata->connected = NULL;
                                        list_add(&ncmd->list, &hostdata->disconnected);
                                        dsprintk(NDEBUG_INFORMATION | NDEBUG_QUEUES,
                                                 instance, "connected command %p for target %d lun %llu moved to disconnected queue\n",
                                                 cmd, scmd_id(cmd), cmd->device->lun);

                                        /*
                                         * Restore phase bits to 0 so an interrupted selection,
                                         * arbitration can resume.
                                         */
                                        NCR5380_write(TARGET_COMMAND_REG, 0);

                                        /* Enable reselect interrupts */
                                        NCR5380_write(SELECT_ENABLE_REG, hostdata->id_mask);
#ifdef SUN3_SCSI_VME
                                        dregs->csr |= CSR_DMA_ENABLE;
#endif
                                        return;
                                        /*
                                         * The SCSI data pointer is *IMPLICITLY* saved on a disconnect
                                         * operation, in violation of the SCSI spec so we can safely
                                         * ignore SAVE/RESTORE pointers calls.
                                         *
                                         * Unfortunately, some disks violate the SCSI spec and
                                         * don't issue the required SAVE_POINTERS message before
                                         * disconnecting, and we have to break spec to remain
                                         * compatible.
                                         */
                                case SAVE_POINTERS:
                                case RESTORE_POINTERS:
                                        /* Accept message by clearing ACK */
                                        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                                        break;
                                case EXTENDED_MESSAGE:
                                        /*
                                         * Start the message buffer with the EXTENDED_MESSAGE
                                         * byte, since spi_print_msg() wants the whole thing.
                                         */
                                        extended_msg[0] = EXTENDED_MESSAGE;
                                        /* Accept first byte by clearing ACK */
                                        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);

                                        spin_unlock_irq(&hostdata->lock);

                                        dsprintk(NDEBUG_EXTENDED, instance, "receiving extended message\n");

                                        len = 2;
                                        data = extended_msg + 1;
                                        phase = PHASE_MSGIN;
                                        NCR5380_transfer_pio(instance, &phase, &len, &data);
                                        dsprintk(NDEBUG_EXTENDED, instance, "length %d, code 0x%02x\n",
                                                 (int)extended_msg[1],
                                                 (int)extended_msg[2]);

                                        if (!len && extended_msg[1] > 0 &&
                                            extended_msg[1] <= sizeof(extended_msg) - 2) {
                                                /* Accept third byte by clearing ACK */
                                                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                                                len = extended_msg[1] - 1;
                                                data = extended_msg + 3;
                                                phase = PHASE_MSGIN;

                                                NCR5380_transfer_pio(instance, &phase, &len, &data);
                                                dsprintk(NDEBUG_EXTENDED, instance, "message received, residual %d\n",
                                                         len);

                                                switch (extended_msg[2]) {
                                                case EXTENDED_SDTR:
                                                case EXTENDED_WDTR:
                                                case EXTENDED_MODIFY_DATA_POINTER:
                                                case EXTENDED_EXTENDED_IDENTIFY:
                                                        tmp = 0;
                                                }
                                        } else if (len) {
                                                shost_printk(KERN_ERR, instance, "error receiving extended message\n");
                                                tmp = 0;
                                        } else {
                                                shost_printk(KERN_NOTICE, instance, "extended message code %02x length %d is too long\n",
                                                             extended_msg[2], extended_msg[1]);
                                                tmp = 0;
                                        }

                                        spin_lock_irq(&hostdata->lock);
                                        if (!hostdata->connected)
                                                return;

                                        /* Fall through to reject message */

                                        /*
                                         * If we get something weird that we aren't expecting,
                                         * reject it.
                                         */
                                default:
                                        if (!tmp) {
                                                shost_printk(KERN_ERR, instance, "rejecting message ");
                                                spi_print_msg(extended_msg);
                                                printk("\n");
                                        } else if (tmp != EXTENDED_MESSAGE)
                                                scmd_printk(KERN_INFO, cmd,
                                                            "rejecting unknown message %02x\n",
                                                            tmp);
                                        else
                                                scmd_printk(KERN_INFO, cmd,
                                                            "rejecting unknown extended message code %02x, length %d\n",
                                                            extended_msg[1], extended_msg[0]);

                                        msgout = MESSAGE_REJECT;
                                        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_ATN);
                                        break;
                                } /* switch (tmp) */
                                break;
                        case PHASE_MSGOUT:
                                len = 1;
                                data = &msgout;
                                hostdata->last_message = msgout;
                                NCR5380_transfer_pio(instance, &phase, &len, &data);
                                if (msgout == ABORT) {
                                        hostdata->connected = NULL;
                                        cmd->result = DID_ERROR << 16;
                                        complete_cmd(instance, cmd);
                                        maybe_release_dma_irq(instance);
                                        NCR5380_write(SELECT_ENABLE_REG, hostdata->id_mask);
                                        return;
                                }
                                msgout = NOP;
                                break;
                        case PHASE_CMDOUT:
                                len = cmd->cmd_len;
                                data = cmd->cmnd;
                                /*
                                 * XXX for performance reasons, on machines with a
                                 * PSEUDO-DMA architecture we should probably
                                 * use the dma transfer function.
                                 */
                                NCR5380_transfer_pio(instance, &phase, &len, &data);
                                break;
                        case PHASE_STATIN:
                                len = 1;
                                data = &tmp;
                                NCR5380_transfer_pio(instance, &phase, &len, &data);
                                cmd->SCp.Status = tmp;
                                break;
                        default:
                                shost_printk(KERN_ERR, instance, "unknown phase\n");
                                NCR5380_dprint(NDEBUG_ANY, instance);
                        } /* switch(phase) */
                } else {
                        spin_unlock_irq(&hostdata->lock);
                        NCR5380_poll_politely(instance, STATUS_REG, SR_REQ, SR_REQ, HZ);
                        spin_lock_irq(&hostdata->lock);
                }
        }
}

/*
 * Function : void NCR5380_reselect (struct Scsi_Host *instance)
 *
 * Purpose : does reselection, initializing the instance->connected
 * field to point to the scsi_cmnd for which the I_T_L or I_T_L_Q
 * nexus has been reestablished,
 *
 * Inputs : instance - this instance of the NCR5380.
 */


/* it might eventually prove necessary to do a dma setup on
   reselection, but it doesn't seem to be needed now -- sam */

static void NCR5380_reselect(struct Scsi_Host *instance)
{
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        unsigned char target_mask;
        unsigned char lun;
#ifdef SUPPORT_TAGS
        unsigned char tag;
#endif
        unsigned char msg[3];
        int __maybe_unused len;
        unsigned char __maybe_unused *data, __maybe_unused phase;
        struct NCR5380_cmd *ncmd;
        struct scsi_cmnd *tmp;

        /*
         * Disable arbitration, etc. since the host adapter obviously
         * lost, and tell an interrupted NCR5380_select() to restart.
         */

        NCR5380_write(MODE_REG, MR_BASE);

        target_mask = NCR5380_read(CURRENT_SCSI_DATA_REG) & ~(hostdata->id_mask);

        dsprintk(NDEBUG_RESELECTION, instance, "reselect\n");

        /*
         * At this point, we have detected that our SCSI ID is on the bus,
         * SEL is true and BSY was false for at least one bus settle delay
         * (400 ns).
         *
         * We must assert BSY ourselves, until the target drops the SEL
         * signal.
         */

        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_BSY);
        if (NCR5380_poll_politely(instance,
                                  STATUS_REG, SR_SEL, 0, 2 * HZ) < 0) {
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                return;
        }
        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);

        /*
         * Wait for target to go into MSGIN.
         */

        if (NCR5380_poll_politely(instance,
                                  STATUS_REG, SR_REQ, SR_REQ, 2 * HZ) < 0) {
                do_abort(instance);
                return;
        }

#if defined(CONFIG_SUN3) && defined(REAL_DMA)
        /* acknowledge toggle to MSGIN */
        NCR5380_write(TARGET_COMMAND_REG, PHASE_SR_TO_TCR(PHASE_MSGIN));

        /* peek at the byte without really hitting the bus */
        msg[0] = NCR5380_read(CURRENT_SCSI_DATA_REG);
#else
        len = 1;
        data = msg;
        phase = PHASE_MSGIN;
        NCR5380_transfer_pio(instance, &phase, &len, &data);

        if (len) {
                do_abort(instance);
                return;
        }
#endif

        if (!(msg[0] & 0x80)) {
                shost_printk(KERN_ERR, instance, "expecting IDENTIFY message, got ");
                spi_print_msg(msg);
                printk("\n");
                do_abort(instance);
                return;
        }
        lun = msg[0] & 0x07;

#if defined(SUPPORT_TAGS) && !defined(CONFIG_SUN3)
        /* If the phase is still MSGIN, the target wants to send some more
         * messages. In case it supports tagged queuing, this is probably a
         * SIMPLE_QUEUE_TAG for the I_T_L_Q nexus.
         */
        tag = TAG_NONE;
        if (phase == PHASE_MSGIN && (hostdata->flags & FLAG_TAGGED_QUEUING)) {
                /* Accept previous IDENTIFY message by clearing ACK */
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                len = 2;
                data = msg + 1;
                if (!NCR5380_transfer_pio(instance, &phase, &len, &data) &&
                    msg[1] == SIMPLE_QUEUE_TAG)
                        tag = msg[2];
                dsprintk(NDEBUG_TAGS, instance, "reselect: target mask %02x, lun %d sent tag %d\n",
                         target_mask, lun, tag);
        }
#endif

        /*
         * Find the command corresponding to the I_T_L or I_T_L_Q  nexus we
         * just reestablished, and remove it from the disconnected queue.
         */

        tmp = NULL;
        list_for_each_entry(ncmd, &hostdata->disconnected, list) {
                struct scsi_cmnd *cmd = NCR5380_to_scmd(ncmd);

                if (target_mask == (1 << scmd_id(cmd)) &&
                    lun == (u8)cmd->device->lun
#ifdef SUPPORT_TAGS
                    && (tag == cmd->tag)
#endif
                    ) {
                        list_del(&ncmd->list);
                        tmp = cmd;
                        break;
                }
        }

        if (tmp) {
                dsprintk(NDEBUG_RESELECTION | NDEBUG_QUEUES, instance,
                         "reselect: removed %p from disconnected queue\n", tmp);
        } else {

#ifdef SUPPORT_TAGS
                shost_printk(KERN_ERR, instance, "target bitmask 0x%02x lun %d tag %d not in disconnected queue.\n",
                             target_mask, lun, tag);
#else
                shost_printk(KERN_ERR, instance, "target bitmask 0x%02x lun %d not in disconnected queue.\n",
                             target_mask, lun);
#endif
                /*
                 * Since we have an established nexus that we can't do anything
                 * with, we must abort it.
                 */
                do_abort(instance);
                return;
        }

#if defined(CONFIG_SUN3) && defined(REAL_DMA)
        /* engage dma setup for the command we just saw */
        {
                void *d;
                unsigned long count;

                if (!tmp->SCp.this_residual && tmp->SCp.buffers_residual) {
                        count = tmp->SCp.buffer->length;
                        d = sg_virt(tmp->SCp.buffer);
                } else {
                        count = tmp->SCp.this_residual;
                        d = tmp->SCp.ptr;
                }
                /* setup this command for dma if not already */
                if ((count >= DMA_MIN_SIZE) && (sun3_dma_setup_done != tmp)) {
                        sun3scsi_dma_setup(instance, d, count,
                                           rq_data_dir(tmp->request));
                        sun3_dma_setup_done = tmp;
                }
        }

        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE | ICR_ASSERT_ACK);
#endif

        /* Accept message by clearing ACK */
        NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);

#if defined(SUPPORT_TAGS) && defined(CONFIG_SUN3)
        /* If the phase is still MSGIN, the target wants to send some more
         * messages. In case it supports tagged queuing, this is probably a
         * SIMPLE_QUEUE_TAG for the I_T_L_Q nexus.
         */
        tag = TAG_NONE;
        if (phase == PHASE_MSGIN && setup_use_tagged_queuing) {
                /* Accept previous IDENTIFY message by clearing ACK */
                NCR5380_write(INITIATOR_COMMAND_REG, ICR_BASE);
                len = 2;
                data = msg + 1;
                if (!NCR5380_transfer_pio(instance, &phase, &len, &data) &&
                    msg[1] == SIMPLE_QUEUE_TAG)
                        tag = msg[2];
                dsprintk(NDEBUG_TAGS, instance, "reselect: target mask %02x, lun %d sent tag %d\n"
                         target_mask, lun, tag);
        }
#endif

        hostdata->connected = tmp;
        dsprintk(NDEBUG_RESELECTION, instance, "nexus established, target %d, lun %llu, tag %d\n",
                 scmd_id(tmp), tmp->device->lun, tmp->tag);
}


/**
 * list_find_cmd - test for presence of a command in a linked list
 * @haystack: list of commands
 * @needle: command to search for
 */

static bool list_find_cmd(struct list_head *haystack,
                          struct scsi_cmnd *needle)
{
        struct NCR5380_cmd *ncmd;

        list_for_each_entry(ncmd, haystack, list)
                if (NCR5380_to_scmd(ncmd) == needle)
                        return true;
        return false;
}

/**
 * list_remove_cmd - remove a command from linked list
 * @haystack: list of commands
 * @needle: command to remove
 */

static bool list_del_cmd(struct list_head *haystack,
                         struct scsi_cmnd *needle)
{
        if (list_find_cmd(haystack, needle)) {
                struct NCR5380_cmd *ncmd = scsi_cmd_priv(needle);

                list_del(&ncmd->list);
                return true;
        }
        return false;
}

/**
 * NCR5380_abort - scsi host eh_abort_handler() method
 * @cmd: the command to be aborted
 *
 * Try to abort a given command by removing it from queues and/or sending
 * the target an abort message. This may not succeed in causing a target
 * to abort the command. Nonetheless, the low-level driver must forget about
 * the command because the mid-layer reclaims it and it may be re-issued.
 *
 * The normal path taken by a command is as follows. For EH we trace this
 * same path to locate and abort the command.
 *
 * unissued -> selecting -> [unissued -> selecting ->]... connected ->
 * [disconnected -> connected ->]...
 * [autosense -> connected ->] done
 *
 * If cmd is unissued then just remove it.
 * If cmd is disconnected, try to select the target.
 * If cmd is connected, try to send an abort message.
 * If cmd is waiting for autosense, give it a chance to complete but check
 * that it isn't left connected.
 * If cmd was not found at all then presumably it has already been completed,
 * in which case return SUCCESS to try to avoid further EH measures.
 * If the command has not completed yet, we must not fail to find it.
 */

static int NCR5380_abort(struct scsi_cmnd *cmd)
{
        struct Scsi_Host *instance = cmd->device->host;
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        unsigned long flags;
        int result = SUCCESS;

        spin_lock_irqsave(&hostdata->lock, flags);

#if (NDEBUG & NDEBUG_ANY)
        scmd_printk(KERN_INFO, cmd, __func__);
#endif
        NCR5380_dprint(NDEBUG_ANY, instance);
        NCR5380_dprint_phase(NDEBUG_ANY, instance);

        if (list_del_cmd(&hostdata->unissued, cmd)) {
                dsprintk(NDEBUG_ABORT, instance,
                         "abort: removed %p from issue queue\n", cmd);
                cmd->result = DID_ABORT << 16;
                cmd->scsi_done(cmd); /* No tag or busy flag to worry about */
        }

        if (hostdata->selecting == cmd) {
                dsprintk(NDEBUG_ABORT, instance,
                         "abort: cmd %p == selecting\n", cmd);
                hostdata->selecting = NULL;
                cmd->result = DID_ABORT << 16;
                complete_cmd(instance, cmd);
                goto out;
        }

        if (list_del_cmd(&hostdata->disconnected, cmd)) {
                dsprintk(NDEBUG_ABORT, instance,
                         "abort: removed %p from disconnected list\n", cmd);
                cmd->result = DID_ERROR << 16;
                if (!hostdata->connected)
                        NCR5380_select(instance, cmd);
                if (hostdata->connected != cmd) {
                        complete_cmd(instance, cmd);
                        result = FAILED;
                        goto out;
                }
        }

        if (hostdata->connected == cmd) {
                dsprintk(NDEBUG_ABORT, instance, "abort: cmd %p is connected\n", cmd);
                hostdata->connected = NULL;
                if (do_abort(instance)) {
                        set_host_byte(cmd, DID_ERROR);
                        complete_cmd(instance, cmd);
                        result = FAILED;
                        goto out;
                }
                set_host_byte(cmd, DID_ABORT);
#ifdef REAL_DMA
                hostdata->dma_len = 0;
#endif
                if (cmd->cmnd[0] == REQUEST_SENSE)
                        complete_cmd(instance, cmd);
                else {
                        struct NCR5380_cmd *ncmd = scsi_cmd_priv(cmd);

                        /* Perform autosense for this command */
                        list_add(&ncmd->list, &hostdata->autosense);
                }
        }

        if (list_find_cmd(&hostdata->autosense, cmd)) {
                dsprintk(NDEBUG_ABORT, instance,
                         "abort: found %p on sense queue\n", cmd);
                spin_unlock_irqrestore(&hostdata->lock, flags);
                queue_work(hostdata->work_q, &hostdata->main_task);
                msleep(1000);
                spin_lock_irqsave(&hostdata->lock, flags);
                if (list_del_cmd(&hostdata->autosense, cmd)) {
                        dsprintk(NDEBUG_ABORT, instance,
                                 "abort: removed %p from sense queue\n", cmd);
                        set_host_byte(cmd, DID_ABORT);
                        complete_cmd(instance, cmd);
                        goto out;
                }
        }

        if (hostdata->connected == cmd) {
                dsprintk(NDEBUG_ABORT, instance, "abort: cmd %p is connected\n", cmd);
                hostdata->connected = NULL;
                if (do_abort(instance)) {
                        set_host_byte(cmd, DID_ERROR);
                        complete_cmd(instance, cmd);
                        result = FAILED;
                        goto out;
                }
                set_host_byte(cmd, DID_ABORT);
#ifdef REAL_DMA
                hostdata->dma_len = 0;
#endif
                complete_cmd(instance, cmd);
        }

out:
        if (result == FAILED)
                dsprintk(NDEBUG_ABORT, instance, "abort: failed to abort %p\n", cmd);
        else
                dsprintk(NDEBUG_ABORT, instance, "abort: successfully aborted %p\n", cmd);

        queue_work(hostdata->work_q, &hostdata->main_task);
        maybe_release_dma_irq(instance);
        spin_unlock_irqrestore(&hostdata->lock, flags);

        return result;
}


/**
 * NCR5380_bus_reset - reset the SCSI bus
 * @cmd: SCSI command undergoing EH
 *
 * Returns SUCCESS
 */

static int NCR5380_bus_reset(struct scsi_cmnd *cmd)
{
        struct Scsi_Host *instance = cmd->device->host;
        struct NCR5380_hostdata *hostdata = shost_priv(instance);
        int i;
        unsigned long flags;
        struct NCR5380_cmd *ncmd;

        spin_lock_irqsave(&hostdata->lock, flags);

#if (NDEBUG & NDEBUG_ANY)
        scmd_printk(KERN_INFO, cmd, __func__);
#endif
        NCR5380_dprint(NDEBUG_ANY, instance);
        NCR5380_dprint_phase(NDEBUG_ANY, instance);

        do_reset(instance);

        /* reset NCR registers */
        NCR5380_write(MODE_REG, MR_BASE);
        NCR5380_write(TARGET_COMMAND_REG, 0);
        NCR5380_write(SELECT_ENABLE_REG, 0);

        /* After the reset, there are no more connected or disconnected commands
         * and no busy units; so clear the low-level status here to avoid
         * conflicts when the mid-level code tries to wake up the affected
         * commands!
         */

        hostdata->selecting = NULL;

        list_for_each_entry(ncmd, &hostdata->disconnected, list) {
                struct scsi_cmnd *cmd = NCR5380_to_scmd(ncmd);

                set_host_byte(cmd, DID_RESET);
                cmd->scsi_done(cmd);
        }

        list_for_each_entry(ncmd, &hostdata->autosense, list) {
                struct scsi_cmnd *cmd = NCR5380_to_scmd(ncmd);

                set_host_byte(cmd, DID_RESET);
                cmd->scsi_done(cmd);
        }

        if (hostdata->connected) {
                set_host_byte(hostdata->connected, DID_RESET);
                complete_cmd(instance, hostdata->connected);
                hostdata->connected = NULL;
        }

        if (hostdata->sensing) {
                set_host_byte(hostdata->connected, DID_RESET);
                complete_cmd(instance, hostdata->sensing);
                hostdata->sensing = NULL;
        }

#ifdef SUPPORT_TAGS
        free_all_tags(hostdata);
#endif
        for (i = 0; i < 8; ++i)
                hostdata->busy[i] = 0;
#ifdef REAL_DMA
        hostdata->dma_len = 0;
#endif

        queue_work(hostdata->work_q, &hostdata->main_task);
        maybe_release_dma_irq(instance);
        spin_unlock_irqrestore(&hostdata->lock, flags);

        return SUCCESS;
}