root/sys/dev/ic/ncr53c9x.c
/*      $NetBSD: ncr53c9x.c,v 1.156 2021/12/05 08:16:10 msaitoh Exp $   */

/*-
 * Copyright (c) 1998, 2002 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by Charles M. Hannum.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

/*
 * Copyright (c) 1994 Peter Galbavy
 * Copyright (c) 1995 Paul Kranenburg
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *      This product includes software developed by Peter Galbavy
 * 4. The name of the author may not be used to endorse or promote products
 *    derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

/*
 * Based on aic6360 by Jarle Greipsland
 *
 * Acknowledgements: Many of the algorithms used in this driver are
 * inspired by the work of Julian Elischer (julian@tfs.com) and
 * Charles Hannum (mycroft@duality.gnu.ai.mit.edu).  Thanks a million!
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ncr53c9x.c,v 1.156 2021/12/05 08:16:10 msaitoh Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <sys/kernel.h>
#include <sys/errno.h>
#include <sys/ioctl.h>
#include <sys/device.h>
#include <sys/buf.h>
#include <sys/malloc.h>
#include <sys/proc.h>
#include <sys/queue.h>
#include <sys/pool.h>
#include <sys/scsiio.h>

#include <dev/scsipi/scsi_spc.h>
#include <dev/scsipi/scsi_all.h>
#include <dev/scsipi/scsipi_all.h>
#include <dev/scsipi/scsiconf.h>
#include <dev/scsipi/scsi_message.h>

#include <dev/ic/ncr53c9xreg.h>
#include <dev/ic/ncr53c9xvar.h>

int ncr53c9x_debug = NCR_SHOWMISC; /*NCR_SHOWPHASE|NCR_SHOWMISC|NCR_SHOWTRAC|NCR_SHOWCMDS;*/
#ifdef DEBUG
int ncr53c9x_notag = 0;
#endif

static void     ncr53c9x_readregs(struct ncr53c9x_softc *);
static void     ncr53c9x_select(struct ncr53c9x_softc *, struct ncr53c9x_ecb *);
static int      ncr53c9x_reselect(struct ncr53c9x_softc *, int, int, int);
#if 0
static void     ncr53c9x_scsi_reset(struct ncr53c9x_softc *);
#endif
static void     ncr53c9x_clear(struct ncr53c9x_softc *, scsipi_xfer_result_t);
static int      ncr53c9x_poll(struct ncr53c9x_softc *,
                              struct scsipi_xfer *, int);
static void     ncr53c9x_sched(struct ncr53c9x_softc *);
static void     ncr53c9x_done(struct ncr53c9x_softc *, struct ncr53c9x_ecb *);
static void     ncr53c9x_msgin(struct ncr53c9x_softc *);
static void     ncr53c9x_msgout(struct ncr53c9x_softc *);
static void     ncr53c9x_timeout(void *arg);
static void     ncr53c9x_watch(void *arg);
static void     ncr53c9x_dequeue(struct ncr53c9x_softc *,
                                 struct ncr53c9x_ecb *);
static int      ncr53c9x_ioctl(struct scsipi_channel *, u_long,
                               void *, int, struct proc *);

void ncr53c9x_sense(struct ncr53c9x_softc *, struct ncr53c9x_ecb *);
void ncr53c9x_free_ecb(struct ncr53c9x_softc *, struct ncr53c9x_ecb *);
struct ncr53c9x_ecb *ncr53c9x_get_ecb(struct ncr53c9x_softc *, int);

static inline int ncr53c9x_stp2cpb(struct ncr53c9x_softc *, int);
static inline void ncr53c9x_setsync(struct ncr53c9x_softc *,
                                    struct ncr53c9x_tinfo *);
void   ncr53c9x_update_xfer_mode (struct ncr53c9x_softc *, int);
static struct ncr53c9x_linfo *ncr53c9x_lunsearch(struct ncr53c9x_tinfo *,
                                                 int64_t lun);

static void ncr53c9x_wrfifo(struct ncr53c9x_softc *, uint8_t *, int);

static int  ncr53c9x_rdfifo(struct ncr53c9x_softc *, int);
#define NCR_RDFIFO_START   0
#define NCR_RDFIFO_CONTINUE 1


#define NCR_SET_COUNT(sc, size) do { \
                NCR_WRITE_REG((sc), NCR_TCL, (size));                   \
                NCR_WRITE_REG((sc), NCR_TCM, (size) >> 8);              \
                if ((sc->sc_cfg2 & NCRCFG2_FE) ||                       \
                    (sc->sc_rev == NCR_VARIANT_FAS366)) {               \
                        NCR_WRITE_REG((sc), NCR_TCH, (size) >> 16);     \
                }                                                       \
                if (sc->sc_rev == NCR_VARIANT_FAS366) {                 \
                        NCR_WRITE_REG(sc, NCR_RCH, 0);                  \
                }                                                       \
} while (/* CONSTCOND */0)

static int ecb_pool_initialized = 0;
static struct pool ecb_pool;

/*
 * Names for the NCR53c9x variants, corresponding to the variant tags
 * in ncr53c9xvar.h.
 */
static const char *ncr53c9x_variant_names[] = {
        "ESP100",
        "ESP100A",
        "ESP200",
        "NCR53C94",
        "NCR53C96",
        "ESP406",
        "FAS408",
        "FAS216",
        "AM53C974",
        "FAS366/HME",
        "NCR53C90 (86C01)",
};

/*
 * Search linked list for LUN info by LUN id.
 */
static struct ncr53c9x_linfo *
ncr53c9x_lunsearch(struct ncr53c9x_tinfo *ti, int64_t lun)
{
        struct ncr53c9x_linfo *li;

        LIST_FOREACH(li, &ti->luns, link)
                if (li->lun == lun)
                        return li;
        return NULL;
}

/*
 * Attach this instance, and then all the sub-devices
 */
void
ncr53c9x_attach(struct ncr53c9x_softc *sc)
{
        struct scsipi_adapter *adapt = &sc->sc_adapter;
        struct scsipi_channel *chan = &sc->sc_channel;

        mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_BIO);

        callout_init(&sc->sc_watchdog, 0);

        /*
         * Note, the front-end has set us up to print the chip variation.
         */
        if (sc->sc_rev >= NCR_VARIANT_MAX) {
                aprint_error(": unknown variant %d, devices not attached\n",
                    sc->sc_rev);
                return;
        }

        aprint_normal(": %s, %dMHz, SCSI ID %d\n",
            ncr53c9x_variant_names[sc->sc_rev], sc->sc_freq, sc->sc_id);

        sc->sc_ntarg = (sc->sc_rev == NCR_VARIANT_FAS366) ? 16 : 8;

        /*
         * Allocate SCSI message buffers.
         * Front-ends can override allocation to avoid alignment
         * handling in the DMA engines. Note that that ncr53c9x_msgout()
         * can request a 1 byte DMA transfer.
         */
        if (sc->sc_omess == NULL)
                sc->sc_omess = malloc(NCR_MAX_MSG_LEN, M_DEVBUF, M_WAITOK);

        if (sc->sc_imess == NULL)
                sc->sc_imess = malloc(NCR_MAX_MSG_LEN + 1, M_DEVBUF, M_WAITOK);

        sc->sc_tinfo = malloc(sc->sc_ntarg * sizeof(sc->sc_tinfo[0]),
            M_DEVBUF, M_WAITOK | M_ZERO);

        /*
         * Treat NCR53C90 with the 86C01 DMA chip exactly as ESP100
         * from now on.
         */
        if (sc->sc_rev == NCR_VARIANT_NCR53C90_86C01)
                sc->sc_rev = NCR_VARIANT_ESP100;

        sc->sc_ccf = FREQTOCCF(sc->sc_freq);

        /* The value *must not* be == 1. Make it 2 */
        if (sc->sc_ccf == 1)
                sc->sc_ccf = 2;

        /*
         * The recommended timeout is 250ms. This register is loaded
         * with a value calculated as follows, from the docs:
         *
         *              (timeout period) x (CLK frequency)
         *      reg = -------------------------------------
         *               8192 x (Clock Conversion Factor)
         *
         * Since CCF has a linear relation to CLK, this generally computes
         * to the constant of 153.
         */
        sc->sc_timeout = ((250 * 1000) * sc->sc_freq) / (8192 * sc->sc_ccf);

        /* CCF register only has 3 bits; 0 is actually 8 */
        sc->sc_ccf &= 7;

        /*
         * Fill in the scsipi_adapter.
         */
        adapt->adapt_dev = sc->sc_dev;
        adapt->adapt_nchannels = 1;
        adapt->adapt_openings = 256;
        adapt->adapt_max_periph = 256;
        adapt->adapt_ioctl = ncr53c9x_ioctl;
        /* adapt_request initialized by front-end */
        /* adapt_minphys initialized by front-end */

        /*
         * Fill in the scsipi_channel.
         */
        memset(chan, 0, sizeof(*chan));
        chan->chan_adapter = adapt;
        chan->chan_bustype = &scsi_bustype;
        chan->chan_channel = 0;
        chan->chan_ntargets = sc->sc_ntarg;
        chan->chan_nluns = 8;
        chan->chan_id = sc->sc_id;

        /*
         * Add reference to adapter so that we drop the reference after
         * config_found() to make sure the adapter is disabled.
         */
        if (scsipi_adapter_addref(adapt) != 0) {
                aprint_error_dev(sc->sc_dev, "unable to enable controller\n");
                return;
        }

        /* Reset state & bus */
        sc->sc_cfflags = device_cfdata(sc->sc_dev)->cf_flags;
        sc->sc_state = 0;
        ncr53c9x_init(sc, 0);   /* no bus reset yet, leave that to scsibus* */

        /*
         * Now try to attach all the sub-devices
         */
        sc->sc_child = config_found(sc->sc_dev, &sc->sc_channel, scsiprint,
            CFARGS_NONE);

        scsipi_adapter_delref(adapt);
        callout_reset(&sc->sc_watchdog, 60 * hz, ncr53c9x_watch, sc);
}

int
ncr53c9x_detach(struct ncr53c9x_softc *sc, int flags)
{
        struct ncr53c9x_linfo *li, *nextli;
        int t;
        int error;

        callout_stop(&sc->sc_watchdog);

        if (sc->sc_tinfo) {
                /* Cancel all commands. */
                ncr53c9x_clear(sc, XS_DRIVER_STUFFUP);

                /* Free logical units. */
                for (t = 0; t < sc->sc_ntarg; t++) {
                        for (li = LIST_FIRST(&sc->sc_tinfo[t].luns); li;
                            li = nextli) {
                                nextli = LIST_NEXT(li, link);
                                free(li, M_DEVBUF);
                        }
                }
        }

        if (sc->sc_child) {
                error = config_detach(sc->sc_child, flags);
                if (error)
                        return error;
        }

        if (sc->sc_imess)
                free(sc->sc_imess, M_DEVBUF);
        if (sc->sc_omess)
                free(sc->sc_omess, M_DEVBUF);

        mutex_destroy(&sc->sc_lock);

        return 0;
}

/*
 * This is the generic ncr53c9x reset function. It does not reset the SCSI bus,
 * only this controller, but kills any on-going commands, and also stops
 * and resets the DMA.
 *
 * After reset, registers are loaded with the defaults from the attach
 * routine above.
 */
void
ncr53c9x_reset(struct ncr53c9x_softc *sc)
{

        /* reset DMA first */
        NCRDMA_RESET(sc);

        /* reset SCSI chip */
        NCRCMD(sc, NCRCMD_RSTCHIP);
        NCRCMD(sc, NCRCMD_NOP);
        DELAY(500);

        /* do these backwards, and fall through */
        switch (sc->sc_rev) {
        case NCR_VARIANT_ESP406:
        case NCR_VARIANT_FAS408:
                NCR_WRITE_REG(sc, NCR_CFG5, sc->sc_cfg5 | NCRCFG5_SINT);
                NCR_WRITE_REG(sc, NCR_CFG4, sc->sc_cfg4);
                /* FALLTHROUGH */
        case NCR_VARIANT_AM53C974:
        case NCR_VARIANT_FAS216:
        case NCR_VARIANT_NCR53C94:
        case NCR_VARIANT_NCR53C96:
        case NCR_VARIANT_ESP200:
                sc->sc_features |= NCR_F_HASCFG3;
                NCR_WRITE_REG(sc, NCR_CFG3, sc->sc_cfg3);
                /* FALLTHROUGH */
        case NCR_VARIANT_ESP100A:
                sc->sc_features |= NCR_F_SELATN3;
                NCR_WRITE_REG(sc, NCR_CFG2, sc->sc_cfg2);
                /* FALLTHROUGH */
        case NCR_VARIANT_ESP100:
                NCR_WRITE_REG(sc, NCR_CFG1, sc->sc_cfg1);
                NCR_WRITE_REG(sc, NCR_CCF, sc->sc_ccf);
                NCR_WRITE_REG(sc, NCR_SYNCOFF, 0);
                NCR_WRITE_REG(sc, NCR_TIMEOUT, sc->sc_timeout);
                break;

        case NCR_VARIANT_FAS366:
                sc->sc_features |=
                    NCR_F_HASCFG3 | NCR_F_FASTSCSI | NCR_F_SELATN3;
                sc->sc_cfg3 = NCRFASCFG3_FASTCLK | NCRFASCFG3_OBAUTO;
                sc->sc_cfg3_fscsi = NCRFASCFG3_FASTSCSI;
                NCR_WRITE_REG(sc, NCR_CFG3, sc->sc_cfg3);
                sc->sc_cfg2 = 0; /* NCRCFG2_HMEFE| NCRCFG2_HME32 */
                NCR_WRITE_REG(sc, NCR_CFG2, sc->sc_cfg2);
                NCR_WRITE_REG(sc, NCR_CFG1, sc->sc_cfg1);
                NCR_WRITE_REG(sc, NCR_CCF, sc->sc_ccf);
                NCR_WRITE_REG(sc, NCR_SYNCOFF, 0);
                NCR_WRITE_REG(sc, NCR_TIMEOUT, sc->sc_timeout);
                break;

        default:
                printf("%s: unknown revision code, assuming ESP100\n",
                    device_xname(sc->sc_dev));
                NCR_WRITE_REG(sc, NCR_CFG1, sc->sc_cfg1);
                NCR_WRITE_REG(sc, NCR_CCF, sc->sc_ccf);
                NCR_WRITE_REG(sc, NCR_SYNCOFF, 0);
                NCR_WRITE_REG(sc, NCR_TIMEOUT, sc->sc_timeout);
        }

        if (sc->sc_rev == NCR_VARIANT_AM53C974)
                NCR_WRITE_REG(sc, NCR_AMDCFG4, sc->sc_cfg4);

#if 0
        printf("%s: ncr53c9x_reset: revision %d\n",
            device_xname(sc->sc_dev), sc->sc_rev);
        printf("%s: ncr53c9x_reset: cfg1 0x%x, cfg2 0x%x, cfg3 0x%x, "
            "ccf 0x%x, timeout 0x%x\n",
            device_xname(sc->sc_dev), sc->sc_cfg1, sc->sc_cfg2, sc->sc_cfg3,
            sc->sc_ccf, sc->sc_timeout);
#endif
}

#if 0
/*
 * Reset the SCSI bus, but not the chip
 */
void
ncr53c9x_scsi_reset(struct ncr53c9x_softc *sc)
{

        (*sc->sc_glue->gl_dma_stop)(sc);

        printf("%s: resetting SCSI bus\n", device_xname(sc->sc_dev));
        NCRCMD(sc, NCRCMD_RSTSCSI);
}
#endif

/*
 * Clear all commands
 */
void
ncr53c9x_clear(struct ncr53c9x_softc *sc, scsipi_xfer_result_t result)
{
        struct ncr53c9x_ecb *ecb;
        struct ncr53c9x_linfo *li;
        int i, r;

        /* Cancel any active commands. */
        sc->sc_state = NCR_CLEANING;
        sc->sc_msgify = 0;
        ecb = sc->sc_nexus;
        if (ecb != NULL) {
                ecb->xs->error = result;
                ncr53c9x_done(sc, ecb);
        }
        /* Cancel outstanding disconnected commands on each LUN */
        for (r = 0; r < sc->sc_ntarg; r++) {
                LIST_FOREACH(li, &sc->sc_tinfo[r].luns, link) {
                        ecb = li->untagged;
                        if (ecb != NULL) {
                                li->untagged = NULL;
                                /*
                                 * XXXXXXX
                                 *
                                 * Should we terminate a command
                                 * that never reached the disk?
                                 */
                                li->busy = 0;
                                ecb->xs->error = result;
                                ncr53c9x_done(sc, ecb);
                        }
                        for (i = 0; i < 256; i++) {
                                ecb = li->queued[i];
                                if (ecb != NULL) {
                                        li->queued[i] = NULL;
                                        ecb->xs->error = result;
                                        ncr53c9x_done(sc, ecb);
                                }
                        }
                        li->used = 0;
                }
        }
}

/*
 * Initialize ncr53c9x state machine
 */
void
ncr53c9x_init(struct ncr53c9x_softc *sc, int doreset)
{
        int r;

        NCR_MISC(("[NCR_INIT(%d) %d] ", doreset, sc->sc_state));

        if (!ecb_pool_initialized) {
                /* All instances share this pool */
                pool_init(&ecb_pool, sizeof(struct ncr53c9x_ecb), 0, 0, 0,
                    "ncr53c9x_ecb", NULL, IPL_BIO);
                /* make sure to always have some items to play with */
                pool_prime(&ecb_pool, 1);
                ecb_pool_initialized = 1;
        }

        if (sc->sc_state == 0) {
                /* First time through; initialize. */

                TAILQ_INIT(&sc->ready_list);
                sc->sc_nexus = NULL;
                memset(sc->sc_tinfo, 0, sizeof(*sc->sc_tinfo));
                for (r = 0; r < sc->sc_ntarg; r++) {
                        LIST_INIT(&sc->sc_tinfo[r].luns);
                }
        } else {
                ncr53c9x_clear(sc, XS_TIMEOUT);
        }

        /*
         * reset the chip to a known state
         */
        ncr53c9x_reset(sc);

        sc->sc_flags = 0;
        sc->sc_msgpriq = sc->sc_msgout = sc->sc_msgoutq = 0;
        sc->sc_phase = sc->sc_prevphase = INVALID_PHASE;

        /* XXXSMP scsipi */
        KERNEL_LOCK(1, curlwp);

        for (r = 0; r < sc->sc_ntarg; r++) {
                struct ncr53c9x_tinfo *ti = &sc->sc_tinfo[r];
/* XXX - config flags per target: low bits: no reselect; high bits: no synch */

                ti->flags = ((sc->sc_minsync &&
                    !(sc->sc_cfflags & (1 << ((r & 7) + 8)))) ?
                    0 : T_SYNCHOFF) |
                    ((sc->sc_cfflags & (1 << (r & 7))) ? T_RSELECTOFF : 0);
#ifdef DEBUG
                if (ncr53c9x_notag)
                        ti->flags &= ~T_TAG;
#endif
                ti->period = sc->sc_minsync;
                ti->offset = 0;
                ti->cfg3   = 0;

                ncr53c9x_update_xfer_mode(sc, r);
        }

        if (doreset) {
                sc->sc_state = NCR_SBR;
                NCRCMD(sc, NCRCMD_RSTSCSI);

                /* Notify upper layer */
                scsipi_async_event(&sc->sc_channel, ASYNC_EVENT_RESET, NULL);
        } else {
                sc->sc_state = NCR_IDLE;
                ncr53c9x_sched(sc);
        }

        /* XXXSMP scsipi */
        KERNEL_UNLOCK_ONE(curlwp);
}

/*
 * Read the NCR registers, and save their contents for later use.
 * NCR_STAT, NCR_STEP & NCR_INTR are mostly zeroed out when reading
 * NCR_INTR - so make sure it is the last read.
 *
 * I think that (from reading the docs) most bits in these registers
 * only make sense when he DMA CSR has an interrupt showing. Call only
 * if an interrupt is pending.
 */
inline void
ncr53c9x_readregs(struct ncr53c9x_softc *sc)
{

        sc->sc_espstat = NCR_READ_REG(sc, NCR_STAT);
        /* Only the stepo bits are of interest */
        sc->sc_espstep = NCR_READ_REG(sc, NCR_STEP) & NCRSTEP_MASK;

        if (sc->sc_rev == NCR_VARIANT_FAS366)
                sc->sc_espstat2 = NCR_READ_REG(sc, NCR_STAT2);

        sc->sc_espintr = NCR_READ_REG(sc, NCR_INTR);

        if (sc->sc_glue->gl_clear_latched_intr != NULL)
                (*sc->sc_glue->gl_clear_latched_intr)(sc);

        /*
         * Determine the SCSI bus phase, return either a real SCSI bus phase
         * or some pseudo phase we use to detect certain exceptions.
         */

        sc->sc_phase = (sc->sc_espintr & NCRINTR_DIS) ?
            /* Disconnected */ BUSFREE_PHASE : sc->sc_espstat & NCRSTAT_PHASE;

        NCR_INTS(("regs[intr=%02x,stat=%02x,step=%02x,stat2=%02x] ",
            sc->sc_espintr, sc->sc_espstat, sc->sc_espstep, sc->sc_espstat2));
}

/*
 * Convert Synchronous Transfer Period to chip register Clock Per Byte value.
 */
static inline int
ncr53c9x_stp2cpb(struct ncr53c9x_softc *sc, int period)
{
        int v;

        v = (sc->sc_freq * period) / 250;
        if (ncr53c9x_cpb2stp(sc, v) < period)
                /* Correct round-down error */
                v++;
        return v;
}

static inline void
ncr53c9x_setsync(struct ncr53c9x_softc *sc, struct ncr53c9x_tinfo *ti)
{
        uint8_t syncoff, synctp;
        uint8_t cfg3 = sc->sc_cfg3 | ti->cfg3;

        if (ti->flags & T_SYNCMODE) {
                syncoff = ti->offset;
                synctp = ncr53c9x_stp2cpb(sc, ti->period);
                if (sc->sc_features & NCR_F_FASTSCSI) {
                        /*
                         * If the period is 200ns or less (ti->period <= 50),
                         * put the chip in Fast SCSI mode.
                         */
                        if (ti->period <= 50)
                                /*
                                 * There are (at least) 4 variations of the
                                 * configuration 3 register.  The drive attach
                                 * routine sets the appropriate bit to put the
                                 * chip into Fast SCSI mode so that it doesn't
                                 * have to be figured out here each time.
                                 */
                                cfg3 |= sc->sc_cfg3_fscsi;
                }

                /*
                 * Am53c974 requires different SYNCTP values when the
                 * FSCSI bit is off.
                 */
                if (sc->sc_rev == NCR_VARIANT_AM53C974 &&
                    (cfg3 & NCRAMDCFG3_FSCSI) == 0)
                        synctp--;
        } else {
                syncoff = 0;
                synctp = 0;
        }

        if (sc->sc_features & NCR_F_HASCFG3)
                NCR_WRITE_REG(sc, NCR_CFG3, cfg3);

        NCR_WRITE_REG(sc, NCR_SYNCOFF, syncoff);
        NCR_WRITE_REG(sc, NCR_SYNCTP, synctp);
}

/*
 * Send a command to a target, set the driver state to NCR_SELECTING
 * and let the caller take care of the rest.
 *
 * Keeping this as a function allows me to say that this may be done
 * by DMA instead of programmed I/O soon.
 */
void
ncr53c9x_select(struct ncr53c9x_softc *sc, struct ncr53c9x_ecb *ecb)
{
        struct scsipi_periph *periph = ecb->xs->xs_periph;
        int target = periph->periph_target;
        int lun = periph->periph_lun;
        struct ncr53c9x_tinfo *ti = &sc->sc_tinfo[target];
        int tiflags = ti->flags;
        uint8_t *cmd;
        int clen;
        bool selatn3, selatns;
        size_t dmasize;

        NCR_TRACE(("[ncr53c9x_select(t%d,l%d,cmd:%x,tag:%x,%x)] ",
            target, lun, ecb->cmd.cmd.opcode, ecb->tag[0], ecb->tag[1]));

        sc->sc_state = NCR_SELECTING;
        /*
         * Schedule the timeout now, the first time we will go away
         * expecting to come back due to an interrupt, because it is
         * always possible that the interrupt may never happen.
         */
        if ((ecb->xs->xs_control & XS_CTL_POLL) == 0) {
                callout_reset(&ecb->xs->xs_callout, mstohz(ecb->timeout),
                    ncr53c9x_timeout, ecb);
        }

        /*
         * The docs say the target register is never reset, and I
         * can't think of a better place to set it
         */
        if (sc->sc_rev == NCR_VARIANT_FAS366) {
                NCRCMD(sc, NCRCMD_FLUSH);
                NCR_WRITE_REG(sc, NCR_SELID, target | NCR_BUSID_HME);
        } else {
                NCR_WRITE_REG(sc, NCR_SELID, target);
        }
        ncr53c9x_setsync(sc, ti);

        if ((ecb->flags & ECB_SENSE) != 0) {
                /*
                 * For REQUEST SENSE, we should not send an IDENTIFY or
                 * otherwise mangle the target.  There should be no MESSAGE IN
                 * phase.
                 */
                if (sc->sc_features & NCR_F_DMASELECT) {
                        /* setup DMA transfer for command */
                        dmasize = clen = ecb->clen;
                        sc->sc_cmdlen = clen;
                        sc->sc_cmdp = (void *)&ecb->cmd.cmd;

                        NCRDMA_SETUP(sc, &sc->sc_cmdp, &sc->sc_cmdlen, 0,
                            &dmasize);
                        /* Program the SCSI counter */
                        NCR_SET_COUNT(sc, dmasize);

                        if (sc->sc_rev != NCR_VARIANT_FAS366)
                                NCRCMD(sc, NCRCMD_NOP | NCRCMD_DMA);

                        /* And get the targets attention */
                        NCRCMD(sc, NCRCMD_SELNATN | NCRCMD_DMA);
                        NCRDMA_GO(sc);
                } else {
                        ncr53c9x_wrfifo(sc, (uint8_t *)&ecb->cmd.cmd,
                            ecb->clen);
                        sc->sc_cmdlen = 0;
                        NCRCMD(sc, NCRCMD_SELNATN);
                }
                return;
        }

        selatn3 = selatns = false;
        if (ecb->tag[0] != 0) {
                if (sc->sc_features & NCR_F_SELATN3)
                        /* use SELATN3 to send tag messages */
                        selatn3 = true;
                else
                        /* We don't have SELATN3; use SELATNS to send tags */
                        selatns = true;
        }

        if (ti->flags & T_NEGOTIATE) {
                /* We have to use SELATNS to send sync/wide messages */
                selatn3 = false;
                selatns = true;
        }

        cmd = (uint8_t *)&ecb->cmd.cmd;

        if (selatn3) {
                /* We'll use tags with SELATN3 */
                clen = ecb->clen + 3;
                cmd -= 3;
                cmd[0] = MSG_IDENTIFY(lun, 1);  /* msg[0] */
                cmd[1] = ecb->tag[0];           /* msg[1] */
                cmd[2] = ecb->tag[1];           /* msg[2] */
        } else {
                /* We don't have tags, or will send messages with SELATNS */
                clen = ecb->clen + 1;
                cmd -= 1;
                cmd[0] = MSG_IDENTIFY(lun, (tiflags & T_RSELECTOFF) == 0);
        }

        if ((sc->sc_features & NCR_F_DMASELECT) && !selatns) {

                /* setup DMA transfer for command */
                dmasize = clen;
                sc->sc_cmdlen = clen;
                sc->sc_cmdp = cmd;

                NCRDMA_SETUP(sc, &sc->sc_cmdp, &sc->sc_cmdlen, 0, &dmasize);
                /* Program the SCSI counter */
                NCR_SET_COUNT(sc, dmasize);

                /* load the count in */
                /* if (sc->sc_rev != NCR_VARIANT_FAS366) */
                        NCRCMD(sc, NCRCMD_NOP | NCRCMD_DMA);

                /* And get the targets attention */
                if (selatn3) {
                        sc->sc_msgout = SEND_TAG;
                        sc->sc_flags |= NCR_ATN;
                        NCRCMD(sc, NCRCMD_SELATN3 | NCRCMD_DMA);
                } else
                        NCRCMD(sc, NCRCMD_SELATN | NCRCMD_DMA);
                NCRDMA_GO(sc);
                return;
        }

        /*
         * Who am I. This is where we tell the target that we are
         * happy for it to disconnect etc.
         */

        /* Now get the command into the FIFO */
        sc->sc_cmdlen = 0;
        ncr53c9x_wrfifo(sc, cmd, clen);

        /* And get the targets attention */
        if (selatns) {
                NCR_MSGS(("SELATNS \n"));
                /* Arbitrate, select and stop after IDENTIFY message */
                NCRCMD(sc, NCRCMD_SELATNS);
        } else if (selatn3) {
                sc->sc_msgout = SEND_TAG;
                sc->sc_flags |= NCR_ATN;
                NCRCMD(sc, NCRCMD_SELATN3);
        } else
                NCRCMD(sc, NCRCMD_SELATN);
}

void
ncr53c9x_free_ecb(struct ncr53c9x_softc *sc, struct ncr53c9x_ecb *ecb)
{
        int s;

        s = splbio();
        ecb->flags = 0;
        pool_put(&ecb_pool, (void *)ecb);
        splx(s);
        return;
}

struct ncr53c9x_ecb *
ncr53c9x_get_ecb(struct ncr53c9x_softc *sc, int flags)
{
        struct ncr53c9x_ecb *ecb;
        int s;

        s = splbio();
        ecb = pool_get(&ecb_pool, PR_NOWAIT | PR_ZERO);
        if (ecb)
                ecb->flags |= ECB_ALLOC;
        splx(s);
        return ecb;
}

/*
 * DRIVER FUNCTIONS CALLABLE FROM HIGHER LEVEL DRIVERS
 */

/*
 * Start a SCSI-command
 * This function is called by the higher level SCSI-driver to queue/run
 * SCSI-commands.
 */

void
ncr53c9x_scsipi_request(struct scsipi_channel *chan, scsipi_adapter_req_t req,
    void *arg)
{
        struct scsipi_xfer *xs;
        struct scsipi_periph *periph;
        struct ncr53c9x_softc *sc;
        struct ncr53c9x_ecb *ecb;
        int flags;

        NCR_TRACE(("[ncr53c9x_scsipi_request] "));

        sc = device_private(chan->chan_adapter->adapt_dev);
        mutex_enter(&sc->sc_lock);

        switch (req) {
        case ADAPTER_REQ_RUN_XFER:
                xs = arg;
                periph = xs->xs_periph;
                flags = xs->xs_control;

                NCR_CMDS(("[0x%x, %d]->%d ", (int)xs->cmd->opcode, xs->cmdlen,
                    periph->periph_target));

                /* Get an ECB to use. */
                ecb = ncr53c9x_get_ecb(sc, xs->xs_control);
                /*
                 * This should never happen as we track resources
                 * in the mid-layer, but for now it can as pool_get()
                 * can fail.
                 */
                if (ecb == NULL) {
                        scsipi_printaddr(periph);
                        printf("%s: unable to allocate ecb\n",
                            device_xname(sc->sc_dev));
                        xs->error = XS_RESOURCE_SHORTAGE;
                        mutex_exit(&sc->sc_lock);
                        scsipi_done(xs);
                        return;
                }

                /* Initialize ecb */
                ecb->xs = xs;
                ecb->timeout = xs->timeout;

                if (flags & XS_CTL_RESET) {
                        ecb->flags |= ECB_RESET;
                        ecb->clen = 0;
                        ecb->dleft = 0;
                } else {
                        memcpy(&ecb->cmd.cmd, xs->cmd, xs->cmdlen);
                        ecb->clen = xs->cmdlen;
                        ecb->daddr = xs->data;
                        ecb->dleft = xs->datalen;
                }
                ecb->stat = 0;

                TAILQ_INSERT_TAIL(&sc->ready_list, ecb, chain);
                ecb->flags |= ECB_READY;
                if (sc->sc_state == NCR_IDLE)
                        ncr53c9x_sched(sc);

                if ((flags & XS_CTL_POLL) == 0)
                        break;

                /* Not allowed to use interrupts, use polling instead */
                if (ncr53c9x_poll(sc, xs, ecb->timeout)) {
                        ncr53c9x_timeout(ecb);
                        if (ncr53c9x_poll(sc, xs, ecb->timeout))
                                ncr53c9x_timeout(ecb);
                }
                break;

        case ADAPTER_REQ_GROW_RESOURCES:
                /* XXX Not supported. */
                break;

        case ADAPTER_REQ_SET_XFER_MODE:
            {
                struct ncr53c9x_tinfo *ti;
                struct scsipi_xfer_mode *xm = arg;

                ti = &sc->sc_tinfo[xm->xm_target];
                ti->flags &= ~(T_NEGOTIATE|T_SYNCMODE);
                ti->period = 0;
                ti->offset = 0;

                if ((sc->sc_cfflags & (1 << ((xm->xm_target & 7) + 16))) == 0 &&
                    (xm->xm_mode & PERIPH_CAP_TQING)) {
                        NCR_MISC(("%s: target %d: tagged queuing\n",
                            device_xname(sc->sc_dev), xm->xm_target));
                        ti->flags |= T_TAG;
                } else
                        ti->flags &= ~T_TAG;

                if ((xm->xm_mode & PERIPH_CAP_WIDE16) != 0) {
                        NCR_MISC(("%s: target %d: wide scsi negotiation\n",
                            device_xname(sc->sc_dev), xm->xm_target));
                        if (sc->sc_rev == NCR_VARIANT_FAS366) {
                                ti->flags |= T_WIDE;
                                ti->width = 1;
                        }
                }

                if ((xm->xm_mode & PERIPH_CAP_SYNC) != 0 &&
                    (ti->flags & T_SYNCHOFF) == 0 && sc->sc_minsync != 0) {
                        NCR_MISC(("%s: target %d: sync negotiation\n",
                            device_xname(sc->sc_dev), xm->xm_target));
                        ti->flags |= T_NEGOTIATE;
                        ti->period = sc->sc_minsync;
                }
                /*
                 * If we're not going to negotiate, send the notification
                 * now, since it won't happen later.
                 */
                if ((ti->flags & T_NEGOTIATE) == 0)
                        ncr53c9x_update_xfer_mode(sc, xm->xm_target);
            }
                break;
        }

        mutex_exit(&sc->sc_lock);
}

void
ncr53c9x_update_xfer_mode(struct ncr53c9x_softc *sc, int target)
{
        struct scsipi_xfer_mode xm;
        struct ncr53c9x_tinfo *ti = &sc->sc_tinfo[target];

        xm.xm_target = target;
        xm.xm_mode = 0;
        xm.xm_period = 0;
        xm.xm_offset = 0;

        if (ti->flags & T_SYNCMODE) {
                xm.xm_mode |= PERIPH_CAP_SYNC;
                xm.xm_period = ti->period;
                xm.xm_offset = ti->offset;
        }
        if (ti->width)
                xm.xm_mode |= PERIPH_CAP_WIDE16;

        if ((ti->flags & (T_RSELECTOFF|T_TAG)) == T_TAG)
                xm.xm_mode |= PERIPH_CAP_TQING;

        scsipi_async_event(&sc->sc_channel, ASYNC_EVENT_XFER_MODE, &xm);
}

/*
 * Used when interrupt driven I/O isn't allowed, e.g. during boot.
 */
int
ncr53c9x_poll(struct ncr53c9x_softc *sc, struct scsipi_xfer *xs, int count)
{

        NCR_TRACE(("[ncr53c9x_poll] "));
        while (count) {
                if (NCRDMA_ISINTR(sc)) {
                        mutex_exit(&sc->sc_lock);
                        ncr53c9x_intr(sc);
                        mutex_enter(&sc->sc_lock);
                }
#if alternatively
                if (NCR_READ_REG(sc, NCR_STAT) & NCRSTAT_INT)
                        ncr53c9x_intr(sc);
#endif
                if ((xs->xs_status & XS_STS_DONE) != 0)
                        return 0;
                if (sc->sc_state == NCR_IDLE) {
                        NCR_TRACE(("[ncr53c9x_poll: rescheduling] "));
                        ncr53c9x_sched(sc);
                }
                DELAY(1000);
                count--;
        }
        return 1;
}

int
ncr53c9x_ioctl(struct scsipi_channel *chan, u_long cmd, void *arg,
    int flag, struct proc *p)
{
        struct ncr53c9x_softc *sc;
        int error = 0;

        sc = device_private(chan->chan_adapter->adapt_dev);
        switch (cmd) {
        case SCBUSIORESET:
                mutex_enter(&sc->sc_lock);
                ncr53c9x_init(sc, 1);
                mutex_exit(&sc->sc_lock);
                break;
        default:
                error = ENOTTY;
                break;
        }
        return error;
}


/*
 * LOW LEVEL SCSI UTILITIES
 */

/*
 * Schedule a scsi operation.  This has now been pulled out of the interrupt
 * handler so that we may call it from ncr53c9x_scsipi_request and
 * ncr53c9x_done.  This may save us an unnecessary interrupt just to get
 * things going.  Should only be called when state == NCR_IDLE and at bio pl.
 */
void
ncr53c9x_sched(struct ncr53c9x_softc *sc)
{
        struct ncr53c9x_ecb *ecb;
        struct scsipi_periph *periph;
        struct ncr53c9x_tinfo *ti;
        struct ncr53c9x_linfo *li;
        int lun;
        int tag;

        NCR_TRACE(("[ncr53c9x_sched] "));
        if (sc->sc_state != NCR_IDLE)
                panic("%s: not IDLE (state=%d)", __func__, sc->sc_state);

        /*
         * Find first ecb in ready queue that is for a target/lunit
         * combinations that is not busy.
         */
        for (ecb = TAILQ_FIRST(&sc->ready_list); ecb != NULL;
            ecb = TAILQ_NEXT(ecb, chain)) {
                periph = ecb->xs->xs_periph;
                ti = &sc->sc_tinfo[periph->periph_target];
                lun = periph->periph_lun;

                /* Select type of tag for this command */
                if ((ti->flags & T_RSELECTOFF) != 0)
                        tag = 0;
                else if ((ti->flags & T_TAG) == 0)
                        tag = 0;
                else if ((ecb->flags & ECB_SENSE) != 0)
                        tag = 0;
                else
                        tag = ecb->xs->xs_tag_type;
#if 0
                /* XXXX Use tags for polled commands? */
                if (ecb->xs->xs_control & XS_CTL_POLL)
                        tag = 0;
#endif

                li = TINFO_LUN(ti, lun);
                if (li == NULL) {
                        /* Initialize LUN info and add to list. */
                        li = malloc(sizeof(*li), M_DEVBUF, M_NOWAIT|M_ZERO);
                        if (li == NULL) {
                                continue;
                        }
                        li->lun = lun;

                        LIST_INSERT_HEAD(&ti->luns, li, link);
                        if (lun < NCR_NLUN)
                                ti->lun[lun] = li;
                }
                li->last_used = time_second;
                if (tag == 0) {
                        /* Try to issue this as an un-tagged command */
                        if (li->untagged == NULL)
                                li->untagged = ecb;
                }
                if (li->untagged != NULL) {
                        tag = 0;
                        if ((li->busy != 1) && li->used == 0) {
                                /* We need to issue this untagged command now */
                                ecb = li->untagged;
                                periph = ecb->xs->xs_periph;
                        } else {
                                /* Not ready yet */
                                continue;
                        }
                }
                ecb->tag[0] = tag;
                if (tag != 0) {
                        li->queued[ecb->xs->xs_tag_id] = ecb;
                        ecb->tag[1] = ecb->xs->xs_tag_id;
                        li->used++;
                }
                if (li->untagged != NULL && (li->busy != 1)) {
                        li->busy = 1;
                        TAILQ_REMOVE(&sc->ready_list, ecb, chain);
                        ecb->flags &= ~ECB_READY;
                        sc->sc_nexus = ecb;
                        ncr53c9x_select(sc, ecb);
                        break;
                }
                if (li->untagged == NULL && tag != 0) {
                        TAILQ_REMOVE(&sc->ready_list, ecb, chain);
                        ecb->flags &= ~ECB_READY;
                        sc->sc_nexus = ecb;
                        ncr53c9x_select(sc, ecb);
                        break;
                } else {
                        NCR_TRACE(("%d:%d busy\n",
                            periph->periph_target,
                            periph->periph_lun));
                }
        }
}

void
ncr53c9x_sense(struct ncr53c9x_softc *sc, struct ncr53c9x_ecb *ecb)
{
        struct scsipi_xfer *xs = ecb->xs;
        struct scsipi_periph *periph = xs->xs_periph;
        struct ncr53c9x_tinfo *ti = &sc->sc_tinfo[periph->periph_target];
        struct scsi_request_sense *ss = (void *)&ecb->cmd.cmd;
        struct ncr53c9x_linfo *li;
        int lun = periph->periph_lun;

        NCR_TRACE(("requesting sense "));
        /* Next, setup a request sense command block */
        memset(ss, 0, sizeof(*ss));
        ss->opcode = SCSI_REQUEST_SENSE;
        ss->byte2 = periph->periph_lun << SCSI_CMD_LUN_SHIFT;
        ss->length = sizeof(struct scsi_sense_data);
        ecb->clen = sizeof(*ss);
        ecb->daddr = (uint8_t *)&xs->sense.scsi_sense;
        ecb->dleft = sizeof(struct scsi_sense_data);
        ecb->flags |= ECB_SENSE;
        ecb->timeout = NCR_SENSE_TIMEOUT;
        ti->senses++;
        li = TINFO_LUN(ti, lun);
        if (li->busy)
                li->busy = 0;
        ncr53c9x_dequeue(sc, ecb);
        li->untagged = ecb; /* must be executed first to fix C/A */
        li->busy = 2;
        if (ecb == sc->sc_nexus) {
                ncr53c9x_select(sc, ecb);
        } else {
                TAILQ_INSERT_HEAD(&sc->ready_list, ecb, chain);
                ecb->flags |= ECB_READY;
                if (sc->sc_state == NCR_IDLE)
                        ncr53c9x_sched(sc);
        }
}

/*
 * POST PROCESSING OF SCSI_CMD (usually current)
 */
void
ncr53c9x_done(struct ncr53c9x_softc *sc, struct ncr53c9x_ecb *ecb)
{
        struct scsipi_xfer *xs = ecb->xs;
        struct scsipi_periph *periph = xs->xs_periph;
        struct ncr53c9x_tinfo *ti = &sc->sc_tinfo[periph->periph_target];
        int lun = periph->periph_lun;
        struct ncr53c9x_linfo *li = TINFO_LUN(ti, lun);

        NCR_TRACE(("[ncr53c9x_done(error:%x)] ", xs->error));

        if ((xs->xs_control & XS_CTL_POLL) == 0)
                callout_stop(&xs->xs_callout);

        /*
         * Now, if we've come here with no error code, i.e. we've kept the
         * initial XS_NOERROR, and the status code signals that we should
         * check sense, we'll need to set up a request sense cmd block and
         * push the command back into the ready queue *before* any other
         * commands for this target/lunit, else we lose the sense info.
         * We don't support chk sense conditions for the request sense cmd.
         */
        if (xs->error == XS_NOERROR) {
                xs->status = ecb->stat;
                if ((ecb->flags & ECB_ABORT) != 0) {
                        xs->error = XS_TIMEOUT;
                } else if ((ecb->flags & ECB_SENSE) != 0) {
                        xs->error = XS_SENSE;
                } else if ((ecb->stat & ST_MASK) == SCSI_CHECK) {
                        /* First, save the return values */
                        xs->resid = ecb->dleft;
                        ncr53c9x_sense(sc, ecb);
                        return;
                } else {
                        xs->resid = ecb->dleft;
                }
                if (xs->status == SCSI_QUEUE_FULL || xs->status == XS_BUSY)
                        xs->error = XS_BUSY;
        }

#ifdef NCR53C9X_DEBUG
        if (ncr53c9x_debug & NCR_SHOWTRAC) {
                if (xs->resid != 0)
                        printf("resid=%d ", xs->resid);
                if (xs->error == XS_SENSE)
                        printf("sense=0x%02x\n",
                            xs->sense.scsi_sense.response_code);
                else
                        printf("error=%d\n", xs->error);
        }
#endif

        /*
         * Remove the ECB from whatever queue it's on.
         */
        ncr53c9x_dequeue(sc, ecb);
        if (ecb == sc->sc_nexus) {
                sc->sc_nexus = NULL;
                if (sc->sc_state != NCR_CLEANING) {
                        sc->sc_state = NCR_IDLE;
                        ncr53c9x_sched(sc);
                }
        }

        if (xs->error == XS_SELTIMEOUT) {
                /* Selection timeout -- discard this LUN if empty */
                if (li->untagged == NULL && li->used == 0) {
                        if (lun < NCR_NLUN)
                                ti->lun[lun] = NULL;
                        LIST_REMOVE(li, link);
                        free(li, M_DEVBUF);
                }
        }

        ncr53c9x_free_ecb(sc, ecb);
        ti->cmds++;
        mutex_exit(&sc->sc_lock);
        scsipi_done(xs);
        mutex_enter(&sc->sc_lock);
}

void
ncr53c9x_dequeue(struct ncr53c9x_softc *sc, struct ncr53c9x_ecb *ecb)
{
        struct ncr53c9x_tinfo *ti =
            &sc->sc_tinfo[ecb->xs->xs_periph->periph_target];
        struct ncr53c9x_linfo *li;
        int64_t lun = ecb->xs->xs_periph->periph_lun;

        li = TINFO_LUN(ti, lun);
#ifdef DIAGNOSTIC
        if (li == NULL || li->lun != lun)
                panic("%s: lun %" PRIx64 " for ecb %p does not exist",
                    __func__, lun, ecb);
#endif
        if (li->untagged == ecb) {
                li->busy = 0;
                li->untagged = NULL;
        }
        if (ecb->tag[0] && li->queued[ecb->tag[1]] != NULL) {
#ifdef DIAGNOSTIC
                if (li->queued[ecb->tag[1]] != NULL &&
                    (li->queued[ecb->tag[1]] != ecb))
                        panic("%s: slot %d for lun %" PRIx64 " has %p "
                            "instead of ecb %p\n", __func__, ecb->tag[1],
                            lun,
                            li->queued[ecb->tag[1]], ecb);
#endif
                li->queued[ecb->tag[1]] = NULL;
                li->used--;
        }

        if ((ecb->flags & ECB_READY) != 0) {
                ecb->flags &= ~ECB_READY;
                TAILQ_REMOVE(&sc->ready_list, ecb, chain);
        }
}

/*
 * INTERRUPT/PROTOCOL ENGINE
 */

/*
 * Schedule an outgoing message by prioritizing it, and asserting
 * attention on the bus. We can only do this when we are the initiator
 * else there will be an illegal command interrupt.
 */
#define ncr53c9x_sched_msgout(m) \
        do {                                                    \
                NCR_MSGS(("ncr53c9x_sched_msgout %x %d", m, __LINE__)); \
                NCRCMD(sc, NCRCMD_SETATN);                      \
                sc->sc_flags |= NCR_ATN;                        \
                sc->sc_msgpriq |= (m);                          \
        } while (/* CONSTCOND */0)

static void
ncr53c9x_flushfifo(struct ncr53c9x_softc *sc)
{

        NCR_TRACE(("[flushfifo] "));

        NCRCMD(sc, NCRCMD_FLUSH);

        if (sc->sc_phase == COMMAND_PHASE ||
            sc->sc_phase == MESSAGE_OUT_PHASE)
                DELAY(2);
}

static int
ncr53c9x_rdfifo(struct ncr53c9x_softc *sc, int how)
{
        int i, n;
        uint8_t *ibuf;

        switch (how) {
        case NCR_RDFIFO_START:
                ibuf = sc->sc_imess;
                sc->sc_imlen = 0;
                break;
        case NCR_RDFIFO_CONTINUE:
                ibuf = sc->sc_imess + sc->sc_imlen;
                break;
        default:
                panic("%s: bad flag", __func__);
                break;
        }

        /*
         * XXX buffer (sc_imess) size for message
         */

        n = NCR_READ_REG(sc, NCR_FFLAG) & NCRFIFO_FF;

        if (sc->sc_rev == NCR_VARIANT_FAS366) {
                n *= 2;

                for (i = 0; i < n; i++)
                        ibuf[i] = NCR_READ_REG(sc, NCR_FIFO);

                if (sc->sc_espstat2 & NCRFAS_STAT2_ISHUTTLE) {

                        NCR_WRITE_REG(sc, NCR_FIFO, 0);
                        ibuf[i++] = NCR_READ_REG(sc, NCR_FIFO);

                        NCR_READ_REG(sc, NCR_FIFO);

                        ncr53c9x_flushfifo(sc);
                }
        } else {
                for (i = 0; i < n; i++)
                        ibuf[i] = NCR_READ_REG(sc, NCR_FIFO);
        }

        sc->sc_imlen += i;

#if 0
#ifdef NCR53C9X_DEBUG
        {
                int j;

                NCR_TRACE(("\n[rdfifo %s (%d):",
                    (how == NCR_RDFIFO_START) ? "start" : "cont",
                    (int)sc->sc_imlen));
                if (ncr53c9x_debug & NCR_SHOWTRAC) {
                        for (j = 0; j < sc->sc_imlen; j++)
                                printf(" %02x", sc->sc_imess[j]);
                        printf("]\n");
                }
        }
#endif
#endif
        return sc->sc_imlen;
}

static void
ncr53c9x_wrfifo(struct ncr53c9x_softc *sc, uint8_t *p, int len)
{
        int i;

#ifdef NCR53C9X_DEBUG
        NCR_MSGS(("[wrfifo(%d):", len));
        if (ncr53c9x_debug & NCR_SHOWMSGS) {
                for (i = 0; i < len; i++)
                        printf(" %02x", p[i]);
                printf("]\n");
        }
#endif

        for (i = 0; i < len; i++) {
                NCR_WRITE_REG(sc, NCR_FIFO, p[i]);

                if (sc->sc_rev == NCR_VARIANT_FAS366)
                        NCR_WRITE_REG(sc, NCR_FIFO, 0);
        }
}

int
ncr53c9x_reselect(struct ncr53c9x_softc *sc, int message, int tagtype,
    int tagid)
{
        uint8_t selid, target, lun;
        struct ncr53c9x_ecb *ecb = NULL;
        struct ncr53c9x_tinfo *ti;
        struct ncr53c9x_linfo *li;

        if (sc->sc_rev == NCR_VARIANT_FAS366) {
                target = sc->sc_selid;
        } else {
                /*
                 * The SCSI chip made a snapshot of the data bus
                 * while the reselection was being negotiated.
                 * This enables us to determine which target did
                 * the reselect.
                 */
                selid = sc->sc_selid & ~(1 << sc->sc_id);
                if (selid & (selid - 1)) {
                        printf("%s: reselect with invalid selid %02x;"
                            " sending DEVICE RESET\n",
                            device_xname(sc->sc_dev), selid);
                        goto reset;
                }

                target = ffs(selid) - 1;
        }
        lun = message & 0x07;

        /*
         * Search wait queue for disconnected cmd
         * The list should be short, so I haven't bothered with
         * any more sophisticated structures than a simple
         * singly linked list.
         */
        ti = &sc->sc_tinfo[target];
        li = TINFO_LUN(ti, lun);

        /*
         * We can get as far as the LUN with the IDENTIFY
         * message.  Check to see if we're running an
         * un-tagged command.  Otherwise ack the IDENTIFY
         * and wait for a tag message.
         */
        if (li != NULL) {
                if (li->untagged != NULL && li->busy)
                        ecb = li->untagged;
                else if (tagtype != MSG_SIMPLE_Q_TAG) {
                        /* Wait for tag to come by */
                        sc->sc_state = NCR_IDENTIFIED;
                        return 0;
                } else if (tagtype)
                        ecb = li->queued[tagid];
        }
        if (ecb == NULL) {
                printf("%s: reselect from target %d lun %d tag %x:%x "
                    "with no nexus; sending ABORT\n",
                    device_xname(sc->sc_dev), target, lun, tagtype, tagid);
                goto abort;
        }

        /* Make this nexus active again. */
        sc->sc_state = NCR_CONNECTED;
        sc->sc_nexus = ecb;
        ncr53c9x_setsync(sc, ti);

        if (ecb->flags & ECB_RESET)
                ncr53c9x_sched_msgout(SEND_DEV_RESET);
        else if (ecb->flags & ECB_ABORT)
                ncr53c9x_sched_msgout(SEND_ABORT);

        /* Do an implicit RESTORE POINTERS. */
        sc->sc_dp = ecb->daddr;
        sc->sc_dleft = ecb->dleft;

        return 0;

reset:
        ncr53c9x_sched_msgout(SEND_DEV_RESET);
        return 1;

abort:
        ncr53c9x_sched_msgout(SEND_ABORT);
        return 1;
}

static inline int
__verify_msg_format(uint8_t *p, int len)
{

        if (len == 1 && MSG_IS1BYTE(p[0]))
                return 1;
        if (len == 2 && MSG_IS2BYTE(p[0]))
                return 1;
        if (len >= 3 && MSG_ISEXTENDED(p[0]) &&
            len == p[1] + 2)
                return 1;

        return 0;
}

/*
 * Get an incoming message as initiator.
 *
 * The SCSI bus must already be in MESSAGE_IN_PHASE and there is a
 * byte in the FIFO
 */
void
ncr53c9x_msgin(struct ncr53c9x_softc *sc)
{

        NCR_TRACE(("[ncr53c9x_msgin(curmsglen:%ld)] ", (long)sc->sc_imlen));

        if (sc->sc_imlen == 0) {
                printf("%s: msgin: no msg byte available\n",
                    device_xname(sc->sc_dev));
                return;
        }

        /*
         * Prepare for a new message.  A message should (according
         * to the SCSI standard) be transmitted in one single
         * MESSAGE_IN_PHASE. If we have been in some other phase,
         * then this is a new message.
         */
        if (sc->sc_prevphase != MESSAGE_IN_PHASE &&
            sc->sc_state != NCR_RESELECTED) {
                printf("%s: phase change, dropping message, "
                    "prev %d, state %d\n",
                    device_xname(sc->sc_dev), sc->sc_prevphase, sc->sc_state);
                sc->sc_flags &= ~NCR_DROP_MSGI;
                sc->sc_imlen = 0;
        }

        /*
         * If we're going to reject the message, don't bother storing
         * the incoming bytes.  But still, we need to ACK them.
         */
        if ((sc->sc_flags & NCR_DROP_MSGI) != 0) {
                NCRCMD(sc, NCRCMD_MSGOK);
                printf("<dropping msg byte %x>", sc->sc_imess[sc->sc_imlen]);
                return;
        }

        if (sc->sc_imlen >= NCR_MAX_MSG_LEN) {
                ncr53c9x_sched_msgout(SEND_REJECT);
                sc->sc_flags |= NCR_DROP_MSGI;
        } else {
                uint8_t *pb;
                int plen;

                switch (sc->sc_state) {
                /*
                 * if received message is the first of reselection
                 * then first byte is selid, and then message
                 */
                case NCR_RESELECTED:
                        pb = sc->sc_imess + 1;
                        plen = sc->sc_imlen - 1;
                        break;
                default:
                        pb = sc->sc_imess;
                        plen = sc->sc_imlen;
                        break;
                }

                if (__verify_msg_format(pb, plen))
                        goto gotit;
        }

        /* Ack what we have so far */
        NCRCMD(sc, NCRCMD_MSGOK);
        return;

gotit:
        NCR_MSGS(("gotmsg(%x) state %d", sc->sc_imess[0], sc->sc_state));
        /* we got complete message, flush the imess, */
        /* XXX nobody uses imlen below */
        sc->sc_imlen = 0;
        /*
         * Now we should have a complete message (1 byte, 2 byte
         * and moderately long extended messages).  We only handle
         * extended messages which total length is shorter than
         * NCR_MAX_MSG_LEN.  Longer messages will be amputated.
         */
        switch (sc->sc_state) {
                struct ncr53c9x_ecb *ecb;
                struct ncr53c9x_tinfo *ti;
                struct ncr53c9x_linfo *li;
                int lun;

        case NCR_CONNECTED:
                ecb = sc->sc_nexus;
                ti = &sc->sc_tinfo[ecb->xs->xs_periph->periph_target];

                switch (sc->sc_imess[0]) {
                case MSG_CMDCOMPLETE:
                        NCR_MSGS(("cmdcomplete "));
                        if (sc->sc_dleft < 0) {
                                scsipi_printaddr(ecb->xs->xs_periph);
                                printf("%s: got %ld extra bytes\n",
                                    device_xname(sc->sc_dev),
                                    -(long)sc->sc_dleft);
                                sc->sc_dleft = 0;
                        }
                        ecb->dleft = (ecb->flags & ECB_TENTATIVE_DONE) ?
                            0 : sc->sc_dleft;
                        if ((ecb->flags & ECB_SENSE) == 0)
                                ecb->xs->resid = ecb->dleft;
                        sc->sc_state = NCR_CMDCOMPLETE;
                        break;

                case MSG_MESSAGE_REJECT:
                        NCR_MSGS(("msg reject (msgout=%x) ", sc->sc_msgout));
                        switch (sc->sc_msgout) {
                        case SEND_TAG:
                                /*
                                 * Target does not like tagged queuing.
                                 *  - Flush the command queue
                                 *  - Disable tagged queuing for the target
                                 *  - Dequeue ecb from the queued array.
                                 */
                                printf("%s: tagged queuing rejected: "
                                    "target %d\n",
                                    device_xname(sc->sc_dev),
                                    ecb->xs->xs_periph->periph_target);

                                NCR_MSGS(("(rejected sent tag)"));
                                NCRCMD(sc, NCRCMD_FLUSH);
                                DELAY(1);
                                ti->flags &= ~T_TAG;
                                lun = ecb->xs->xs_periph->periph_lun;
                                li = TINFO_LUN(ti, lun);
                                if (ecb->tag[0] &&
                                    li->queued[ecb->tag[1]] != NULL) {
                                        li->queued[ecb->tag[1]] = NULL;
                                        li->used--;
                                }
                                ecb->tag[0] = ecb->tag[1] = 0;
                                li->untagged = ecb;
                                li->busy = 1;
                                break;

                        case SEND_SDTR:
                                printf("%s: sync transfer rejected: "
                                    "target %d\n",
                                    device_xname(sc->sc_dev),
                                    ecb->xs->xs_periph->periph_target);

                                sc->sc_flags &= ~NCR_SYNCHNEGO;
                                ti->flags &= ~(T_NEGOTIATE | T_SYNCMODE);
                                ncr53c9x_setsync(sc, ti);
                                ncr53c9x_update_xfer_mode(sc,
                                    ecb->xs->xs_periph->periph_target);
                                break;

                        case SEND_WDTR:
                                printf("%s: wide transfer rejected: "
                                    "target %d\n",
                                    device_xname(sc->sc_dev),
                                    ecb->xs->xs_periph->periph_target);
                                ti->flags &= ~(T_WIDE | T_WDTRSENT);
                                ti->width = 0;
                                break;

                        case SEND_INIT_DET_ERR:
                                goto abort;
                        }
                        break;

                case MSG_NOOP:
                        NCR_MSGS(("noop "));
                        break;

                case MSG_HEAD_OF_Q_TAG:
                case MSG_SIMPLE_Q_TAG:
                case MSG_ORDERED_Q_TAG:
                        NCR_MSGS(("TAG %x:%x",
                            sc->sc_imess[0], sc->sc_imess[1]));
                        break;

                case MSG_DISCONNECT:
                        NCR_MSGS(("disconnect "));
                        ti->dconns++;
                        sc->sc_state = NCR_DISCONNECT;

                        /*
                         * Mark the fact that all bytes have moved. The
                         * target may not bother to do a SAVE POINTERS
                         * at this stage. This flag will set the residual
                         * count to zero on MSG COMPLETE.
                         */
                        if (sc->sc_dleft == 0)
                                ecb->flags |= ECB_TENTATIVE_DONE;

                        break;

                case MSG_SAVEDATAPOINTER:
                        NCR_MSGS(("save datapointer "));
                        ecb->daddr = sc->sc_dp;
                        ecb->dleft = sc->sc_dleft;
                        break;

                case MSG_RESTOREPOINTERS:
                        NCR_MSGS(("restore datapointer "));
                        sc->sc_dp = ecb->daddr;
                        sc->sc_dleft = ecb->dleft;
                        break;

                case MSG_EXTENDED:
                        NCR_MSGS(("extended(%x) ", sc->sc_imess[2]));
                        switch (sc->sc_imess[2]) {
                        case MSG_EXT_SDTR:
                                NCR_MSGS(("SDTR period %d, offset %d ",
                                    sc->sc_imess[3], sc->sc_imess[4]));
                                if (sc->sc_imess[1] != 3)
                                        goto reject;
                                ti->period = sc->sc_imess[3];
                                ti->offset = sc->sc_imess[4];
                                ti->flags &= ~T_NEGOTIATE;
                                if (sc->sc_minsync == 0 ||
                                    ti->offset == 0 ||
                                    ti->period > 124) {
#if 0
#ifdef NCR53C9X_DEBUG
                                        scsipi_printaddr(ecb->xs->xs_periph);
                                        printf("async mode\n");
#endif
#endif
                                        ti->flags &= ~T_SYNCMODE;
                                        if ((sc->sc_flags&NCR_SYNCHNEGO) == 0) {
                                                /*
                                                 * target initiated negotiation
                                                 */
                                                ti->offset = 0;
                                                ncr53c9x_sched_msgout(
                                                    SEND_SDTR);
                                        }
                                } else {
                                        int p;

                                        p = ncr53c9x_stp2cpb(sc, ti->period);
                                        ti->period = ncr53c9x_cpb2stp(sc, p);
                                        if ((sc->sc_flags&NCR_SYNCHNEGO) == 0) {
                                                /*
                                                 * target initiated negotiation
                                                 */
                                                if (ti->period <
                                                    sc->sc_minsync)
                                                        ti->period =
                                                            sc->sc_minsync;
                                                if (ti->offset > 15)
                                                        ti->offset = 15;
                                                ti->flags &= ~T_SYNCMODE;
                                                ncr53c9x_sched_msgout(
                                                    SEND_SDTR);
                                        } else {
                                                /* we are sync */
                                                ti->flags |= T_SYNCMODE;
                                        }
                                }
                                ncr53c9x_update_xfer_mode(sc,
                                    ecb->xs->xs_periph->periph_target);
                                sc->sc_flags &= ~NCR_SYNCHNEGO;
                                ncr53c9x_setsync(sc, ti);
                                break;

                        case MSG_EXT_WDTR:
#ifdef NCR53C9X_DEBUG
                                printf("%s: wide mode %d\n",
                                    device_xname(sc->sc_dev), sc->sc_imess[3]);
#endif
                                if (sc->sc_imess[3] == 1) {
                                        ti->cfg3 |= NCRFASCFG3_EWIDE;
                                        ncr53c9x_setsync(sc, ti);
                                } else
                                        ti->width = 0;
                                /*
                                 * Device started width negotiation.
                                 */
                                if ((ti->flags & T_WDTRSENT) == 0)
                                        ncr53c9x_sched_msgout(SEND_WDTR);
                                ti->flags &= ~(T_WIDE | T_WDTRSENT);
                                break;
                        default:
                                scsipi_printaddr(ecb->xs->xs_periph);
                                printf("%s: unrecognized MESSAGE EXTENDED;"
                                    " sending REJECT\n",
                                    device_xname(sc->sc_dev));
                                goto reject;
                        }
                        break;
                case MSG_IGN_WIDE_RESIDUE:
                        NCR_MSGS(("ignore wide residue "));
                        break;

                default:
                        NCR_MSGS(("ident "));
                        scsipi_printaddr(ecb->xs->xs_periph);
                        printf("%s: unrecognized MESSAGE (%x); sending REJECT\n",
                            device_xname(sc->sc_dev), sc->sc_imess[0]);
                reject:
                        ncr53c9x_sched_msgout(SEND_REJECT);
                        break;
                }
                break;

        case NCR_IDENTIFIED:
                /*
                 * IDENTIFY message was received and queue tag is expected now
                 */
                if ((sc->sc_imess[0] != MSG_SIMPLE_Q_TAG) ||
                    (sc->sc_msgify == 0)) {
                        printf("%s: TAG reselect without IDENTIFY;"
                            " MSG %x;"
                            " sending DEVICE RESET\n",
                            device_xname(sc->sc_dev),
                            sc->sc_imess[0]);
                        goto reset;
                }
                (void)ncr53c9x_reselect(sc, sc->sc_msgify,
                    sc->sc_imess[0], sc->sc_imess[1]);
                break;

        case NCR_RESELECTED:
                if (MSG_ISIDENTIFY(sc->sc_imess[1])) {
                        sc->sc_msgify = sc->sc_imess[1];
                } else {
                        printf("%s: reselect without IDENTIFY;"
                            " MSG %x;"
                            " sending DEVICE RESET\n",
                            device_xname(sc->sc_dev),
                            sc->sc_imess[1]);
                        goto reset;
                }
                (void)ncr53c9x_reselect(sc, sc->sc_msgify, 0, 0);
                break;

        default:
                printf("%s: unexpected MESSAGE IN; sending DEVICE RESET\n",
                    device_xname(sc->sc_dev));
        reset:
                ncr53c9x_sched_msgout(SEND_DEV_RESET);
                break;

        abort:
                ncr53c9x_sched_msgout(SEND_ABORT);
                break;
        }

        /* if we have more messages to send set ATN */
        if (sc->sc_msgpriq)
                NCRCMD(sc, NCRCMD_SETATN);

        /* Ack last message byte */
        NCRCMD(sc, NCRCMD_MSGOK);

        /* Done, reset message pointer. */
        sc->sc_flags &= ~NCR_DROP_MSGI;
        sc->sc_imlen = 0;
}


/*
 * Send the highest priority, scheduled message
 */
void
ncr53c9x_msgout(struct ncr53c9x_softc *sc)
{
        struct ncr53c9x_tinfo *ti;
        struct ncr53c9x_ecb *ecb;
        size_t size;

        NCR_TRACE(("[ncr53c9x_msgout(priq:%x, prevphase:%x)]",
            sc->sc_msgpriq, sc->sc_prevphase));

        /*
         * XXX - the NCR_ATN flag is not in sync with the actual ATN
         *       condition on the SCSI bus. The 53c9x chip
         *       automatically turns off ATN before sending the
         *       message byte.  (see also the comment below in the
         *       default case when picking out a message to send)
         */
        if (sc->sc_flags & NCR_ATN) {
                if (sc->sc_prevphase != MESSAGE_OUT_PHASE) {
                new:
                        NCRCMD(sc, NCRCMD_FLUSH);
#if 0
                        DELAY(1);
#endif
                        sc->sc_msgoutq = 0;
                        sc->sc_omlen = 0;
                }
        } else {
                if (sc->sc_prevphase == MESSAGE_OUT_PHASE) {
                        ncr53c9x_sched_msgout(sc->sc_msgoutq);
                        goto new;
                } else {
                        printf("%s at line %d: unexpected MESSAGE OUT phase\n",
                            device_xname(sc->sc_dev), __LINE__);
                }
        }

        if (sc->sc_omlen == 0) {
                /* Pick up highest priority message */
                sc->sc_msgout = sc->sc_msgpriq & -sc->sc_msgpriq;
                sc->sc_msgoutq |= sc->sc_msgout;
                sc->sc_msgpriq &= ~sc->sc_msgout;
                sc->sc_omlen = 1;               /* "Default" message len */
                switch (sc->sc_msgout) {
                case SEND_SDTR:
                        ecb = sc->sc_nexus;
                        ti = &sc->sc_tinfo[ecb->xs->xs_periph->periph_target];
                        sc->sc_omess[0] = MSG_EXTENDED;
                        sc->sc_omess[1] = MSG_EXT_SDTR_LEN;
                        sc->sc_omess[2] = MSG_EXT_SDTR;
                        sc->sc_omess[3] = ti->period;
                        sc->sc_omess[4] = ti->offset;
                        sc->sc_omlen = 5;
                        if ((sc->sc_flags & NCR_SYNCHNEGO) == 0) {
                                ti->flags |= T_SYNCMODE;
                                ncr53c9x_setsync(sc, ti);
                        }
                        break;
                case SEND_WDTR:
                        ecb = sc->sc_nexus;
                        ti = &sc->sc_tinfo[ecb->xs->xs_periph->periph_target];
                        sc->sc_omess[0] = MSG_EXTENDED;
                        sc->sc_omess[1] = MSG_EXT_WDTR_LEN;
                        sc->sc_omess[2] = MSG_EXT_WDTR;
                        sc->sc_omess[3] = ti->width;
                        sc->sc_omlen = 4;
                        break;
                case SEND_IDENTIFY:
                        if (sc->sc_state != NCR_CONNECTED) {
                                printf("%s at line %d: no nexus\n",
                                    device_xname(sc->sc_dev), __LINE__);
                        }
                        ecb = sc->sc_nexus;
                        sc->sc_omess[0] =
                            MSG_IDENTIFY(ecb->xs->xs_periph->periph_lun, 0);
                        break;
                case SEND_TAG:
                        if (sc->sc_state != NCR_CONNECTED) {
                                printf("%s at line %d: no nexus\n",
                                    device_xname(sc->sc_dev), __LINE__);
                        }
                        ecb = sc->sc_nexus;
                        sc->sc_omess[0] = ecb->tag[0];
                        sc->sc_omess[1] = ecb->tag[1];
                        sc->sc_omlen = 2;
                        break;
                case SEND_DEV_RESET:
                        sc->sc_flags |= NCR_ABORTING;
                        sc->sc_omess[0] = MSG_BUS_DEV_RESET;
                        ecb = sc->sc_nexus;
                        ti = &sc->sc_tinfo[ecb->xs->xs_periph->periph_target];
                        ti->flags &= ~T_SYNCMODE;
                        ncr53c9x_update_xfer_mode(sc,
                            ecb->xs->xs_periph->periph_target);
                        if ((ti->flags & T_SYNCHOFF) == 0)
                                /* We can re-start sync negotiation */
                                ti->flags |= T_NEGOTIATE;
                        break;
                case SEND_PARITY_ERROR:
                        sc->sc_omess[0] = MSG_PARITY_ERROR;
                        break;
                case SEND_ABORT:
                        sc->sc_flags |= NCR_ABORTING;
                        sc->sc_omess[0] = MSG_ABORT;
                        break;
                case SEND_INIT_DET_ERR:
                        sc->sc_omess[0] = MSG_INITIATOR_DET_ERR;
                        break;
                case SEND_REJECT:
                        sc->sc_omess[0] = MSG_MESSAGE_REJECT;
                        break;
                default:
                        /*
                         * We normally do not get here, since the chip
                         * automatically turns off ATN before the last
                         * byte of a message is sent to the target.
                         * However, if the target rejects our (multi-byte)
                         * message early by switching to MSG IN phase
                         * ATN remains on, so the target may return to
                         * MSG OUT phase. If there are no scheduled messages
                         * left we send a NO-OP.
                         *
                         * XXX - Note that this leaves no useful purpose for
                         * the NCR_ATN flag.
                         */
                        sc->sc_flags &= ~NCR_ATN;
                        sc->sc_omess[0] = MSG_NOOP;
                        break;
                }
                sc->sc_omp = sc->sc_omess;
        }

#ifdef DEBUG
        if (ncr53c9x_debug & NCR_SHOWMSGS) {
                int i;

                NCR_MSGS(("<msgout:"));
                for (i = 0; i < sc->sc_omlen; i++)
                        NCR_MSGS((" %02x", sc->sc_omess[i]));
                NCR_MSGS(("> "));
        }
#endif
        if (sc->sc_rev == NCR_VARIANT_FAS366) {
                /*
                 * XXX fifo size
                 */
                ncr53c9x_flushfifo(sc);
                ncr53c9x_wrfifo(sc, sc->sc_omp, sc->sc_omlen);
                sc->sc_cmdlen = 0;
                NCRCMD(sc, NCRCMD_TRANS);
        } else {
                /* (re)send the message */
                size = uimin(sc->sc_omlen, sc->sc_maxxfer);
                NCRDMA_SETUP(sc, &sc->sc_omp, &sc->sc_omlen, 0, &size);
                /* Program the SCSI counter */
                NCR_SET_COUNT(sc, size);

                /* Load the count in and start the message-out transfer */
                NCRCMD(sc, NCRCMD_NOP | NCRCMD_DMA);
                NCRCMD(sc, NCRCMD_TRANS | NCRCMD_DMA);
                NCRDMA_GO(sc);
        }
}

/*
 * This is the most critical part of the driver, and has to know
 * how to deal with *all* error conditions and phases from the SCSI
 * bus. If there are no errors and the DMA was active, then call the
 * DMA pseudo-interrupt handler. If this returns 1, then that was it
 * and we can return from here without further processing.
 *
 * Most of this needs verifying.
 */
int
ncr53c9x_intr(void *arg)
{
        struct ncr53c9x_softc *sc = arg;
        struct ncr53c9x_ecb *ecb;
        struct scsipi_periph *periph;
        struct ncr53c9x_tinfo *ti;
        size_t size;
        int nfifo;

        NCR_INTS(("[ncr53c9x_intr: state %d]", sc->sc_state));

        if (!NCRDMA_ISINTR(sc))
                return 0;

        mutex_enter(&sc->sc_lock);
again:
        /* and what do the registers say... */
        ncr53c9x_readregs(sc);

        sc->sc_intrcnt.ev_count++;

        /*
         * At the moment, only a SCSI Bus Reset or Illegal
         * Command are classed as errors. A disconnect is a
         * valid condition, and we let the code check is the
         * "NCR_BUSFREE_OK" flag was set before declaring it
         * and error.
         *
         * Also, the status register tells us about "Gross
         * Errors" and "Parity errors". Only the Gross Error
         * is really bad, and the parity errors are dealt
         * with later
         *
         * TODO
         *      If there are too many parity error, go to slow
         *      cable mode ?
         */

        /* SCSI Reset */
        if ((sc->sc_espintr & NCRINTR_SBR) != 0) {
                if ((NCR_READ_REG(sc, NCR_FFLAG) & NCRFIFO_FF) != 0) {
                        NCRCMD(sc, NCRCMD_FLUSH);
                        DELAY(1);
                }
                if (sc->sc_state != NCR_SBR) {
                        printf("%s: SCSI bus reset\n",
                            device_xname(sc->sc_dev));
                        ncr53c9x_init(sc, 0); /* Restart everything */
                        goto out;
                }
#if 0
/*XXX*/         printf("<expected bus reset: "
                    "[intr %x, stat %x, step %d]>\n",
                    sc->sc_espintr, sc->sc_espstat, sc->sc_espstep);
#endif
                if (sc->sc_nexus != NULL)
                        panic("%s: nexus in reset state",
                            device_xname(sc->sc_dev));
                goto sched;
        }

        ecb = sc->sc_nexus;

#define NCRINTR_ERR (NCRINTR_SBR|NCRINTR_ILL)
        if (sc->sc_espintr & NCRINTR_ERR ||
            sc->sc_espstat & NCRSTAT_GE) {

                if ((sc->sc_espstat & NCRSTAT_GE) != 0) {
                        /* Gross Error; no target ? */
                        if (NCR_READ_REG(sc, NCR_FFLAG) & NCRFIFO_FF) {
                                NCRCMD(sc, NCRCMD_FLUSH);
                                DELAY(1);
                        }
                        if (sc->sc_state == NCR_CONNECTED ||
                            sc->sc_state == NCR_SELECTING) {
                                ecb->xs->error = XS_TIMEOUT;
                                ncr53c9x_done(sc, ecb);
                        }
                        goto out;
                }

                if ((sc->sc_espintr & NCRINTR_ILL) != 0) {
                        if ((sc->sc_flags & NCR_EXPECT_ILLCMD) != 0) {
                                /*
                                 * Eat away "Illegal command" interrupt
                                 * on a ESP100 caused by a re-selection
                                 * while we were trying to select
                                 * another target.
                                 */
#ifdef NCR53C9X_DEBUG
                                printf("%s: ESP100 work-around activated\n",
                                        device_xname(sc->sc_dev));
#endif
                                sc->sc_flags &= ~NCR_EXPECT_ILLCMD;
                                goto out;
                        }
                        /* illegal command, out of sync ? */
                        printf("%s: illegal command: 0x%x "
                            "(state %d, phase %x, prevphase %x)\n",
                            device_xname(sc->sc_dev), sc->sc_lastcmd,
                            sc->sc_state, sc->sc_phase, sc->sc_prevphase);
                        if (NCR_READ_REG(sc, NCR_FFLAG) & NCRFIFO_FF) {
                                NCRCMD(sc, NCRCMD_FLUSH);
                                DELAY(1);
                        }
                        ncr53c9x_init(sc, 1); /* Restart everything */
                        goto out;
                }
        }
        sc->sc_flags &= ~NCR_EXPECT_ILLCMD;

        /*
         * Call if DMA is active.
         *
         * If DMA_INTR returns true, then maybe go 'round the loop
         * again in case there is no more DMA queued, but a phase
         * change is expected.
         */
        if (NCRDMA_ISACTIVE(sc)) {
                int r = NCRDMA_INTR(sc);
                if (r == -1) {
                        printf("%s: DMA error; resetting\n",
                            device_xname(sc->sc_dev));
                        ncr53c9x_init(sc, 1);
                        goto out;
                }
                /* If DMA active here, then go back to work... */
                if (NCRDMA_ISACTIVE(sc))
                        goto out;

                if ((sc->sc_espstat & NCRSTAT_TC) == 0) {
                        /*
                         * DMA not completed.  If we can not find a
                         * acceptable explanation, print a diagnostic.
                         */
                        if (sc->sc_state == NCR_SELECTING)
                                /*
                                 * This can happen if we are reselected
                                 * while using DMA to select a target.
                                 */
                                /*void*/;
                        else if (sc->sc_prevphase == MESSAGE_OUT_PHASE) {
                                /*
                                 * Our (multi-byte) message (eg SDTR) was
                                 * interrupted by the target to send
                                 * a MSG REJECT.
                                 * Print diagnostic if current phase
                                 * is not MESSAGE IN.
                                 */
                                if (sc->sc_phase != MESSAGE_IN_PHASE)
                                        printf("%s: !TC on MSG OUT"
                                            " [intr %x, stat %x, step %d]"
                                            " prevphase %x, resid %lx\n",
                                            device_xname(sc->sc_dev),
                                            sc->sc_espintr,
                                            sc->sc_espstat,
                                            sc->sc_espstep,
                                            sc->sc_prevphase,
                                            (u_long)sc->sc_omlen);
                        } else if (sc->sc_dleft == 0) {
                                /*
                                 * The DMA operation was started for
                                 * a DATA transfer. Print a diagnostic
                                 * if the DMA counter and TC bit
                                 * appear to be out of sync.
                                 */
                                printf("%s: !TC on DATA XFER"
                                    " [intr %x, stat %x, step %d]"
                                    " prevphase %x, resid %x\n",
                                    device_xname(sc->sc_dev),
                                    sc->sc_espintr,
                                    sc->sc_espstat,
                                    sc->sc_espstep,
                                    sc->sc_prevphase,
                                    ecb ? ecb->dleft : -1);
                        }
                }
        }

        /*
         * Check for less serious errors.
         */
        if ((sc->sc_espstat & NCRSTAT_PE) != 0) {
                printf("%s: SCSI bus parity error\n", device_xname(sc->sc_dev));
                if (sc->sc_prevphase == MESSAGE_IN_PHASE)
                        ncr53c9x_sched_msgout(SEND_PARITY_ERROR);
                else
                        ncr53c9x_sched_msgout(SEND_INIT_DET_ERR);
        }

        if ((sc->sc_espintr & NCRINTR_DIS) != 0) {
                sc->sc_msgify = 0;
                NCR_INTS(("<DISC [intr %x, stat %x, step %d]>",
                    sc->sc_espintr,sc->sc_espstat,sc->sc_espstep));
                if (NCR_READ_REG(sc, NCR_FFLAG) & NCRFIFO_FF) {
                        NCRCMD(sc, NCRCMD_FLUSH);
#if 0
                        DELAY(1);
#endif
                }
                /*
                 * This command must (apparently) be issued within
                 * 250mS of a disconnect. So here you are...
                 */
                NCRCMD(sc, NCRCMD_ENSEL);

                switch (sc->sc_state) {
                case NCR_RESELECTED:
                        goto sched;

                case NCR_SELECTING:
                {
                        struct ncr53c9x_linfo *li;

                        ecb->xs->error = XS_SELTIMEOUT;

                        /* Selection timeout -- discard all LUNs if empty */
                        periph = ecb->xs->xs_periph;
                        ti = &sc->sc_tinfo[periph->periph_target];
                        li = LIST_FIRST(&ti->luns);
                        while (li != NULL) {
                                if (li->untagged == NULL && li->used == 0) {
                                        if (li->lun < NCR_NLUN)
                                                ti->lun[li->lun] = NULL;
                                        LIST_REMOVE(li, link);
                                        free(li, M_DEVBUF);
                                        /*
                                         * Restart the search at the beginning
                                         */
                                        li = LIST_FIRST(&ti->luns);
                                        continue;
                                }
                                li = LIST_NEXT(li, link);
                        }
                        goto finish;
                }
                case NCR_CONNECTED:
                        if ((sc->sc_flags & NCR_SYNCHNEGO) != 0) {
#ifdef NCR53C9X_DEBUG
                                if (ecb != NULL)
                                        scsipi_printaddr(ecb->xs->xs_periph);
                                printf("sync nego not completed!\n");
#endif
                                ti = &sc->sc_tinfo[
                                    ecb->xs->xs_periph->periph_target];
                                sc->sc_flags &= ~NCR_SYNCHNEGO;
                                ti->flags &= ~(T_NEGOTIATE | T_SYNCMODE);
                        }

                        /* it may be OK to disconnect */
                        if ((sc->sc_flags & NCR_ABORTING) == 0) {
                                /*
                                 * Section 5.1.1 of the SCSI 2 spec
                                 * suggests issuing a REQUEST SENSE
                                 * following an unexpected disconnect.
                                 * Some devices go into a contingent
                                 * allegiance condition when
                                 * disconnecting, and this is necessary
                                 * to clean up their state.
                                 */
                                printf("%s: unexpected disconnect "
                        "[state %d, intr %x, stat %x, phase(c %x, p %x)]; ",
                                        device_xname(sc->sc_dev), sc->sc_state,
                                        sc->sc_espintr, sc->sc_espstat,
                                        sc->sc_phase, sc->sc_prevphase);

                                if ((ecb->flags & ECB_SENSE) != 0) {
                                        printf("resetting\n");
                                        goto reset;
                                }
                                printf("sending REQUEST SENSE\n");
                                callout_stop(&ecb->xs->xs_callout);
                                ncr53c9x_sense(sc, ecb);
                                goto out;
                        }

                        ecb->xs->error = XS_TIMEOUT;
                        goto finish;

                case NCR_DISCONNECT:
                        sc->sc_nexus = NULL;
                        goto sched;

                case NCR_CMDCOMPLETE:
                        goto finish;
                }
        }

        switch (sc->sc_state) {

        case NCR_SBR:
                printf("%s: waiting for SCSI Bus Reset to happen\n",
                    device_xname(sc->sc_dev));
                goto out;

        case NCR_RESELECTED:
                /*
                 * we must be continuing a message ?
                 */
                printf("%s: unhandled reselect continuation, "
                    "state %d, intr %02x\n",
                    device_xname(sc->sc_dev), sc->sc_state, sc->sc_espintr);
                ncr53c9x_init(sc, 1);
                goto out;

        case NCR_IDENTIFIED:
                ecb = sc->sc_nexus;
                if (sc->sc_phase != MESSAGE_IN_PHASE) {
                        int i = (NCR_READ_REG(sc, NCR_FFLAG) & NCRFIFO_FF);
                        /*
                         * Things are seriously screwed up.
                         * Pull the brakes, i.e. reset
                         */
                        printf("%s: target didn't send tag: %d bytes in fifo\n",
                            device_xname(sc->sc_dev), i);
                        /* Drain and display fifo */
                        while (i-- > 0)
                                printf("[%d] ", NCR_READ_REG(sc, NCR_FIFO));

                        ncr53c9x_init(sc, 1);
                        goto out;
                } else
                        goto msgin;

        case NCR_IDLE:
        case NCR_SELECTING:
                ecb = sc->sc_nexus;
                if (sc->sc_espintr & NCRINTR_RESEL) {
                        sc->sc_msgpriq = sc->sc_msgout = sc->sc_msgoutq = 0;
                        sc->sc_flags = 0;
                        /*
                         * If we're trying to select a
                         * target ourselves, push our command
                         * back into the ready list.
                         */
                        if (sc->sc_state == NCR_SELECTING) {
                                NCR_INTS(("backoff selector "));
                                callout_stop(&ecb->xs->xs_callout);
                                ncr53c9x_dequeue(sc, ecb);
                                TAILQ_INSERT_HEAD(&sc->ready_list, ecb, chain);
                                ecb->flags |= ECB_READY;
                                ecb = sc->sc_nexus = NULL;
                        }
                        sc->sc_state = NCR_RESELECTED;
                        if (sc->sc_phase != MESSAGE_IN_PHASE) {
                                /*
                                 * Things are seriously screwed up.
                                 * Pull the brakes, i.e. reset
                                 */
                                printf("%s: target didn't identify\n",
                                    device_xname(sc->sc_dev));
                                ncr53c9x_init(sc, 1);
                                goto out;
                        }
                        /*
                         * The C90 only inhibits FIFO writes until reselection
                         * is complete, instead of waiting until the interrupt
                         * status register has been read.  So, if the reselect
                         * happens while we were entering command bytes (for
                         * another target) some of those bytes can appear in
                         * the FIFO here, after the interrupt is taken.
                         *
                         * To remedy this situation, pull the Selection ID
                         * and Identify message from the FIFO directly, and
                         * ignore any extraneous fifo contents. Also, set
                         * a flag that allows one Illegal Command Interrupt
                         * to occur which the chip also generates as a result
                         * of writing to the FIFO during a reselect.
                         */
                        if (sc->sc_rev == NCR_VARIANT_ESP100) {
                                nfifo = NCR_READ_REG(sc, NCR_FFLAG) &
                                    NCRFIFO_FF;
                                sc->sc_imess[0] = NCR_READ_REG(sc, NCR_FIFO);
                                sc->sc_imess[1] = NCR_READ_REG(sc, NCR_FIFO);
                                sc->sc_imlen = 2;
                                if (nfifo != 2) {
                                        /* Flush the rest */
                                        NCRCMD(sc, NCRCMD_FLUSH);
                                }
                                sc->sc_flags |= NCR_EXPECT_ILLCMD;
                                if (nfifo > 2)
                                        nfifo = 2; /* We fixed it.. */
                        } else
                                nfifo = ncr53c9x_rdfifo(sc, NCR_RDFIFO_START);

                        if (nfifo != 2) {
                                printf("%s: RESELECT: %d bytes in FIFO! "
                                    "[intr %x, stat %x, step %d, "
                                    "prevphase %x]\n",
                                    device_xname(sc->sc_dev),
                                    nfifo,
                                    sc->sc_espintr,
                                    sc->sc_espstat,
                                    sc->sc_espstep,
                                    sc->sc_prevphase);
                                ncr53c9x_init(sc, 1);
                                goto out;
                        }
                        sc->sc_selid = sc->sc_imess[0];
                        NCR_INTS(("selid=%02x ", sc->sc_selid));

                        /* Handle identify message */
                        ncr53c9x_msgin(sc);

                        if (sc->sc_state != NCR_CONNECTED &&
                            sc->sc_state != NCR_IDENTIFIED) {
                                /* IDENTIFY fail?! */
                                printf("%s: identify failed, "
                                    "state %d, intr %02x\n",
                                    device_xname(sc->sc_dev),
                                    sc->sc_state, sc->sc_espintr);
                                ncr53c9x_init(sc, 1);
                                goto out;
                        }
                        goto shortcut; /* ie. next phase expected soon */
                }

#define NCRINTR_DONE    (NCRINTR_FC | NCRINTR_BS)
                if ((sc->sc_espintr & NCRINTR_DONE) == NCRINTR_DONE) {
                        /*
                         * Arbitration won; examine the `step' register
                         * to determine how far the selection could progress.
                         */
                        ecb = sc->sc_nexus;
                        if (ecb == NULL)
                                panic("%s: no nexus", __func__);

                        periph = ecb->xs->xs_periph;
                        ti = &sc->sc_tinfo[periph->periph_target];

                        switch (sc->sc_espstep) {
                        case 0:
                                /*
                                 * The target did not respond with a
                                 * message out phase - probably an old
                                 * device that doesn't recognize ATN.
                                 * Clear ATN and just continue, the
                                 * target should be in the command
                                 * phase.
                                 * XXXX check for command phase?
                                 */
                                NCRCMD(sc, NCRCMD_RSTATN);
                                break;
                        case 1:
                                if ((ti->flags & T_NEGOTIATE) == 0 &&
                                    ecb->tag[0] == 0) {
                                        printf("%s: step 1 & !NEG\n",
                                            device_xname(sc->sc_dev));
                                        goto reset;
                                }
                                if (sc->sc_phase != MESSAGE_OUT_PHASE) {
                                        printf("%s: !MSGOUT\n",
                                            device_xname(sc->sc_dev));
                                        goto reset;
                                }
                                if (ti->flags & T_WIDE) {
                                        ti->flags |= T_WDTRSENT;
                                        ncr53c9x_sched_msgout(SEND_WDTR);
                                }
                                if (ti->flags & T_NEGOTIATE) {
                                        /* Start negotiating */
                                        ti->period = sc->sc_minsync;
                                        ti->offset = 15;
                                        sc->sc_flags |= NCR_SYNCHNEGO;
                                        if (ecb->tag[0])
                                                ncr53c9x_sched_msgout(
                                                    SEND_TAG | SEND_SDTR);
                                        else
                                                ncr53c9x_sched_msgout(
                                                    SEND_SDTR);
                                } else {
                                        /* Could not do ATN3 so send TAG */
                                        ncr53c9x_sched_msgout(SEND_TAG);
                                }
                                sc->sc_prevphase = MESSAGE_OUT_PHASE; /* XXXX */
                                break;
                        case 3:
                                /*
                                 * Grr, this is supposed to mean
                                 * "target left command phase  prematurely".
                                 * It seems to happen regularly when
                                 * sync mode is on.
                                 * Look at FIFO to see if command went out.
                                 * (Timing problems?)
                                 */
                                if (sc->sc_features & NCR_F_DMASELECT) {
                                        if (sc->sc_cmdlen == 0)
                                                /* Hope for the best.. */
                                                break;
                                } else if ((NCR_READ_REG(sc, NCR_FFLAG)
                                    & NCRFIFO_FF) == 0) {
                                        /* Hope for the best.. */
                                        break;
                                }
                                printf("(%s:%d:%d): selection failed;"
                                    " %d left in FIFO "
                                    "[intr %x, stat %x, step %d]\n",
                                    device_xname(sc->sc_dev),
                                    periph->periph_target,
                                    periph->periph_lun,
                                    NCR_READ_REG(sc, NCR_FFLAG)
                                     & NCRFIFO_FF,
                                    sc->sc_espintr, sc->sc_espstat,
                                    sc->sc_espstep);
                                NCRCMD(sc, NCRCMD_FLUSH);
                                ncr53c9x_sched_msgout(SEND_ABORT);
                                goto out;
                        case 2:
                                /* Select stuck at Command Phase */
                                NCRCMD(sc, NCRCMD_FLUSH);
                                break;
                        case 4:
                                if (sc->sc_features & NCR_F_DMASELECT &&
                                    sc->sc_cmdlen != 0)
                                        printf("(%s:%d:%d): select; "
                                            "%lu left in DMA buffer "
                                            "[intr %x, stat %x, step %d]\n",
                                            device_xname(sc->sc_dev),
                                            periph->periph_target,
                                            periph->periph_lun,
                                            (u_long)sc->sc_cmdlen,
                                            sc->sc_espintr,
                                            sc->sc_espstat,
                                            sc->sc_espstep);
                                /* So far, everything went fine */
                                break;
                        }

                        sc->sc_prevphase = INVALID_PHASE; /* ?? */
                        /* Do an implicit RESTORE POINTERS. */
                        sc->sc_dp = ecb->daddr;
                        sc->sc_dleft = ecb->dleft;
                        sc->sc_state = NCR_CONNECTED;
                        break;

                } else {

                        printf("%s: unexpected status after select"
                            ": [intr %x, stat %x, step %x]\n",
                            device_xname(sc->sc_dev),
                            sc->sc_espintr, sc->sc_espstat, sc->sc_espstep);
                        NCRCMD(sc, NCRCMD_FLUSH);
                        DELAY(1);
                        goto reset;
                }
                if (sc->sc_state == NCR_IDLE) {
                        printf("%s: stray interrupt\n",
                            device_xname(sc->sc_dev));
                        mutex_exit(&sc->sc_lock);
                        return 0;
                }
                break;

        case NCR_CONNECTED:
                if ((sc->sc_flags & NCR_ICCS) != 0) {
                        /* "Initiate Command Complete Steps" in progress */
                        uint8_t msg;

                        sc->sc_flags &= ~NCR_ICCS;

                        if ((sc->sc_espintr & NCRINTR_DONE) == 0) {
                                printf("%s: ICCS: "
                                    ": [intr %x, stat %x, step %x]\n",
                                    device_xname(sc->sc_dev),
                                    sc->sc_espintr, sc->sc_espstat,
                                    sc->sc_espstep);
                        }
                        ncr53c9x_rdfifo(sc, NCR_RDFIFO_START);
                        if (sc->sc_imlen < 2)
                                printf("%s: can't get status, only %d bytes\n",
                                    device_xname(sc->sc_dev),
                                    (int)sc->sc_imlen);
                        ecb->stat = sc->sc_imess[sc->sc_imlen - 2];
                        msg = sc->sc_imess[sc->sc_imlen - 1];
                        NCR_PHASE(("<stat:(%x,%x)>", ecb->stat, msg));
                        if (msg == MSG_CMDCOMPLETE) {
                                ecb->dleft = (ecb->flags & ECB_TENTATIVE_DONE)
                                    ? 0 : sc->sc_dleft;
                                if ((ecb->flags & ECB_SENSE) == 0)
                                        ecb->xs->resid = ecb->dleft;
                                sc->sc_state = NCR_CMDCOMPLETE;
                        } else
                                printf("%s: STATUS_PHASE: msg %d\n",
                                    device_xname(sc->sc_dev), msg);
                        sc->sc_imlen = 0;
                        NCRCMD(sc, NCRCMD_MSGOK);
                        goto shortcut; /* ie. wait for disconnect */
                }
                break;

        default:
                printf("%s: invalid state: %d [intr %x, phase(c %x, p %x)]\n",
                        device_xname(sc->sc_dev), sc->sc_state,
                        sc->sc_espintr, sc->sc_phase, sc->sc_prevphase);
                goto reset;
        }

        /*
         * Driver is now in state NCR_CONNECTED, i.e. we
         * have a current command working the SCSI bus.
         */
        if (sc->sc_state != NCR_CONNECTED || ecb == NULL) {
                panic("%s: no nexus", __func__);
        }

        switch (sc->sc_phase) {
        case MESSAGE_OUT_PHASE:
                NCR_PHASE(("MESSAGE_OUT_PHASE "));
                ncr53c9x_msgout(sc);
                sc->sc_prevphase = MESSAGE_OUT_PHASE;
                break;

        case MESSAGE_IN_PHASE:
msgin:
                NCR_PHASE(("MESSAGE_IN_PHASE "));
                if ((sc->sc_espintr & NCRINTR_BS) != 0) {
                        if ((sc->sc_rev != NCR_VARIANT_FAS366) ||
                            (sc->sc_espstat2 & NCRFAS_STAT2_EMPTY) == 0) {
                                NCRCMD(sc, NCRCMD_FLUSH);
                        }
                        sc->sc_flags |= NCR_WAITI;
                        NCRCMD(sc, NCRCMD_TRANS);
                } else if ((sc->sc_espintr & NCRINTR_FC) != 0) {
                        if ((sc->sc_flags & NCR_WAITI) == 0) {
                                printf("%s: MSGIN: unexpected FC bit: "
                                    "[intr %x, stat %x, step %x]\n",
                                    device_xname(sc->sc_dev),
                                    sc->sc_espintr, sc->sc_espstat,
                                    sc->sc_espstep);
                        }
                        sc->sc_flags &= ~NCR_WAITI;
                        ncr53c9x_rdfifo(sc,
                            (sc->sc_prevphase == sc->sc_phase) ?
                            NCR_RDFIFO_CONTINUE : NCR_RDFIFO_START);
                        ncr53c9x_msgin(sc);
                } else {
                        printf("%s: MSGIN: weird bits: "
                            "[intr %x, stat %x, step %x]\n",
                            device_xname(sc->sc_dev),
                            sc->sc_espintr, sc->sc_espstat, sc->sc_espstep);
                }
                sc->sc_prevphase = MESSAGE_IN_PHASE;
                goto shortcut;  /* i.e. expect data to be ready */

        case COMMAND_PHASE:
                /*
                 * Send the command block. Normally we don't see this
                 * phase because the SEL_ATN command takes care of
                 * all this. However, we end up here if either the
                 * target or we wanted to exchange some more messages
                 * first (e.g. to start negotiations).
                 */

                NCR_PHASE(("COMMAND_PHASE 0x%02x (%d) ",
                    ecb->cmd.cmd.opcode, ecb->clen));
                if (NCR_READ_REG(sc, NCR_FFLAG) & NCRFIFO_FF) {
                        NCRCMD(sc, NCRCMD_FLUSH);
#if 0
                        DELAY(1);
#endif
                }
                if (sc->sc_features & NCR_F_DMASELECT) {
                        /* setup DMA transfer for command */
                        size = ecb->clen;
                        sc->sc_cmdlen = size;
                        sc->sc_cmdp = (void *)&ecb->cmd.cmd;
                        NCRDMA_SETUP(sc, &sc->sc_cmdp, &sc->sc_cmdlen,
                            0, &size);
                        /* Program the SCSI counter */
                        NCR_SET_COUNT(sc, size);

                        /* load the count in */
                        NCRCMD(sc, NCRCMD_NOP | NCRCMD_DMA);

                        /* start the command transfer */
                        NCRCMD(sc, NCRCMD_TRANS | NCRCMD_DMA);
                        NCRDMA_GO(sc);
                } else {
                        ncr53c9x_wrfifo(sc, (uint8_t *)&ecb->cmd.cmd,
                            ecb->clen);
                        sc->sc_cmdlen = 0;
                        NCRCMD(sc, NCRCMD_TRANS);
                }
                sc->sc_prevphase = COMMAND_PHASE;
                break;

        case DATA_OUT_PHASE:
                NCR_PHASE(("DATA_OUT_PHASE [%ld] ",(long)sc->sc_dleft));
                NCRCMD(sc, NCRCMD_FLUSH);
                size = uimin(sc->sc_dleft, sc->sc_maxxfer);
                NCRDMA_SETUP(sc, &sc->sc_dp, &sc->sc_dleft, 0, &size);
                sc->sc_prevphase = DATA_OUT_PHASE;
                goto setup_xfer;

        case DATA_IN_PHASE:
                NCR_PHASE(("DATA_IN_PHASE "));
                if (sc->sc_rev == NCR_VARIANT_ESP100)
                        NCRCMD(sc, NCRCMD_FLUSH);
                size = uimin(sc->sc_dleft, sc->sc_maxxfer);
                NCRDMA_SETUP(sc, &sc->sc_dp, &sc->sc_dleft, 1, &size);
                sc->sc_prevphase = DATA_IN_PHASE;
        setup_xfer:
                /* Target returned to data phase: wipe "done" memory */
                ecb->flags &= ~ECB_TENTATIVE_DONE;

                /* Program the SCSI counter */
                NCR_SET_COUNT(sc, size);

                /* load the count in */
                NCRCMD(sc, NCRCMD_NOP | NCRCMD_DMA);

                /*
                 * Note that if `size' is 0, we've already transceived
                 * all the bytes we want but we're still in DATA PHASE.
                 * Apparently, the device needs padding. Also, a
                 * transfer size of 0 means "maximum" to the chip
                 * DMA logic.
                 */
                NCRCMD(sc,
                    (size == 0 ? NCRCMD_TRPAD : NCRCMD_TRANS) | NCRCMD_DMA);
                NCRDMA_GO(sc);
                goto out;

        case STATUS_PHASE:
                NCR_PHASE(("STATUS_PHASE "));
                sc->sc_flags |= NCR_ICCS;
                NCRCMD(sc, NCRCMD_ICCS);
                sc->sc_prevphase = STATUS_PHASE;
                goto shortcut;  /* i.e. expect status results soon */

        case INVALID_PHASE:
                break;

        default:
                printf("%s: unexpected bus phase; resetting\n",
                    device_xname(sc->sc_dev));
                goto reset;
        }

out:
        mutex_exit(&sc->sc_lock);
        return 1;

reset:
        ncr53c9x_init(sc, 1);
        goto out;

finish:
        ncr53c9x_done(sc, ecb);
        goto out;

sched:
        sc->sc_state = NCR_IDLE;
        ncr53c9x_sched(sc);
        goto out;

shortcut:
        /*
         * The idea is that many of the SCSI operations take very little
         * time, and going away and getting interrupted is too high an
         * overhead to pay. For example, selecting, sending a message
         * and command and then doing some work can be done in one "pass".
         *
         * The delay is a heuristic. It is 2 when at 20MHz, 2 at 25MHz and 1
         * at 40MHz. This needs testing.
         */
        {
                struct timeval wait, cur;

                microtime(&wait);
                wait.tv_usec += 50 / sc->sc_freq;
                if (wait.tv_usec > 1000000) {
                        wait.tv_sec++;
                        wait.tv_usec -= 1000000;
                }
                do {
                        if (NCRDMA_ISINTR(sc))
                                goto again;
                        microtime(&cur);
                } while (timercmp(&cur, &wait, <=));
        }
        goto out;
}

void
ncr53c9x_abort(struct ncr53c9x_softc *sc, struct ncr53c9x_ecb *ecb)
{

        /* 2 secs for the abort */
        ecb->timeout = NCR_ABORT_TIMEOUT;
        ecb->flags |= ECB_ABORT;

        if (ecb == sc->sc_nexus) {
                /*
                 * If we're still selecting, the message will be scheduled
                 * after selection is complete.
                 */
                if (sc->sc_state == NCR_CONNECTED)
                        ncr53c9x_sched_msgout(SEND_ABORT);

                /*
                 * Reschedule timeout.
                 */
                callout_reset(&ecb->xs->xs_callout, mstohz(ecb->timeout),
                    ncr53c9x_timeout, ecb);
        } else {
                /*
                 * Just leave the command where it is.
                 * XXX - what choice do we have but to reset the SCSI
                 *       eventually?
                 */
                if (sc->sc_state == NCR_IDLE)
                        ncr53c9x_sched(sc);
        }
}

void
ncr53c9x_timeout(void *arg)
{
        struct ncr53c9x_ecb *ecb = arg;
        struct scsipi_xfer *xs = ecb->xs;
        struct scsipi_periph *periph = xs->xs_periph;
        struct ncr53c9x_softc *sc;
        struct ncr53c9x_tinfo *ti;

        sc = device_private(periph->periph_channel->chan_adapter->adapt_dev);
        ti = &sc->sc_tinfo[periph->periph_target];

        scsipi_printaddr(periph);
        printf("%s: timed out [ecb %p (flags 0x%x, dleft %x, stat %x)], "
            "<state %d, nexus %p, phase(l %x, c %x, p %x), resid %lx, "
            "msg(q %x,o %x) %s>",
            device_xname(sc->sc_dev),
            ecb, ecb->flags, ecb->dleft, ecb->stat,
            sc->sc_state, sc->sc_nexus,
            NCR_READ_REG(sc, NCR_STAT),
            sc->sc_phase, sc->sc_prevphase,
            (long)sc->sc_dleft, sc->sc_msgpriq, sc->sc_msgout,
            NCRDMA_ISACTIVE(sc) ? "DMA active" : "");
#if NCR53C9X_DEBUG > 1
        printf("TRACE: %s.", ecb->trace);
#endif

        mutex_enter(&sc->sc_lock);

        if (ecb->flags & ECB_ABORT) {
                /* abort timed out */
                printf(" AGAIN\n");

                ncr53c9x_init(sc, 1);
        } else {
                /* abort the operation that has timed out */
                printf("\n");
                xs->error = XS_TIMEOUT;
                ncr53c9x_abort(sc, ecb);

                /* Disable sync mode if stuck in a data phase */
                if (ecb == sc->sc_nexus &&
                    (ti->flags & T_SYNCMODE) != 0 &&
                    (sc->sc_phase & (MSGI | CDI)) == 0) {
                        /* XXX ASYNC CALLBACK! */
                        scsipi_printaddr(periph);
                        printf("sync negotiation disabled\n");
                        sc->sc_cfflags |=
                            (1 << ((periph->periph_target & 7) + 8));
                        ncr53c9x_update_xfer_mode(sc, periph->periph_target);
                }
        }

        mutex_exit(&sc->sc_lock);
}

void
ncr53c9x_watch(void *arg)
{
        struct ncr53c9x_softc *sc = arg;
        struct ncr53c9x_tinfo *ti;
        struct ncr53c9x_linfo *li;
        int t;
        /* Delete any structures that have not been used in 10min. */
        time_t old = time_second - (10 * 60);

        mutex_enter(&sc->sc_lock);
        for (t = 0; t < sc->sc_ntarg; t++) {
                ti = &sc->sc_tinfo[t];
                li = LIST_FIRST(&ti->luns);
                while (li) {
                        if (li->last_used < old &&
                            li->untagged == NULL &&
                            li->used == 0) {
                                if (li->lun < NCR_NLUN)
                                        ti->lun[li->lun] = NULL;
                                LIST_REMOVE(li, link);
                                free(li, M_DEVBUF);
                                /* Restart the search at the beginning */
                                li = LIST_FIRST(&ti->luns);
                                continue;
                        }
                        li = LIST_NEXT(li, link);
                }
        }
        mutex_exit(&sc->sc_lock);
        callout_reset(&sc->sc_watchdog, 60 * hz, ncr53c9x_watch, sc);
}