/*-
 * SPDX-License-Identifier: BSD-2-Clause
 *
 * Copyright (c) 2009-2020 Alexander Motin <mav@FreeBSD.org>
 * Copyright (c) 1997-2009 by Matthew Jacob
 * 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 immediately at the beginning of the file, without modification,
 *    this list of conditions, and the following disclaimer.
 * 2. 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 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 AUTHOR 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.
 */

/*
 * Platform (FreeBSD) dependent common attachment code for Qlogic adapters.
 */
#include <sys/cdefs.h>
#include <dev/isp/isp_freebsd.h>
#include <sys/unistd.h>
#include <sys/kthread.h>
#include <sys/conf.h>
#include <sys/module.h>
#include <sys/ioccom.h>
#include <dev/isp/isp_ioctl.h>
#include <sys/devicestat.h>
#include <cam/cam_periph.h>
#include <cam/cam_xpt_periph.h>

MODULE_VERSION(isp, 1);
MODULE_DEPEND(isp, cam, 1, 1, 1);
int isp_announced = 0;
int isp_loop_down_limit = 60;   /* default loop down limit */
int isp_quickboot_time = 7;     /* don't wait more than N secs for loop up */
int isp_gone_device_time = 30;  /* grace time before reporting device lost */
static const char prom3[] = "Chan %d [%u] PortID 0x%06x Departed because of %s";

static void isp_freeze_loopdown(ispsoftc_t *, int);
static void isp_loop_changed(ispsoftc_t *isp, int chan);
static void isp_rq_check_above(ispsoftc_t *);
static void isp_rq_check_below(ispsoftc_t *);
static d_ioctl_t ispioctl;
static void isp_poll(struct cam_sim *);
static callout_func_t isp_watchdog;
static callout_func_t isp_gdt;
static task_fn_t isp_gdt_task;
static void isp_kthread(void *);
static void isp_action(struct cam_sim *, union ccb *);
static int isp_timer_count;
static void isp_timer(void *);

static struct cdevsw isp_cdevsw = {
        .d_version =    D_VERSION,
        .d_ioctl =      ispioctl,
        .d_name =       "isp",
};

static int
isp_role_sysctl(SYSCTL_HANDLER_ARGS)
{
        ispsoftc_t *isp = (ispsoftc_t *)arg1;
        int chan = arg2;
        int error, old, value;

        value = FCPARAM(isp, chan)->role;

        error = sysctl_handle_int(oidp, &value, 0, req);
        if ((error != 0) || (req->newptr == NULL))
                return (error);

        if (value < ISP_ROLE_NONE || value > ISP_ROLE_BOTH)
                return (EINVAL);

        ISP_LOCK(isp);
        old = FCPARAM(isp, chan)->role;

        /* We don't allow target mode switch from here. */
        value = (old & ISP_ROLE_TARGET) | (value & ISP_ROLE_INITIATOR);

        /* If nothing has changed -- we are done. */
        if (value == old) {
                ISP_UNLOCK(isp);
                return (0);
        }

        /* Actually change the role. */
        error = isp_control(isp, ISPCTL_CHANGE_ROLE, chan, value);
        ISP_UNLOCK(isp);
        return (error);
}

static int
isp_attach_chan(ispsoftc_t *isp, struct cam_devq *devq, int chan)
{
        fcparam *fcp = FCPARAM(isp, chan);
        struct isp_fc *fc = ISP_FC_PC(isp, chan);
        struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(isp->isp_osinfo.dev);
        struct sysctl_oid *tree = device_get_sysctl_tree(isp->isp_osinfo.dev);
        char name[16];
        struct cam_sim *sim;
        struct cam_path *path;
#ifdef  ISP_TARGET_MODE
        int i;
#endif

        sim = cam_sim_alloc(isp_action, isp_poll, "isp", isp,
            device_get_unit(isp->isp_dev), &isp->isp_lock,
            isp->isp_maxcmds, isp->isp_maxcmds, devq);
        if (sim == NULL)
                return (ENOMEM);

        if (xpt_bus_register(sim, isp->isp_dev, chan) != CAM_SUCCESS) {
                cam_sim_free(sim, FALSE);
                return (EIO);
        }
        if (xpt_create_path(&path, NULL, cam_sim_path(sim), CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
                xpt_bus_deregister(cam_sim_path(sim));
                cam_sim_free(sim, FALSE);
                return (ENXIO);
        }

        ISP_LOCK(isp);
        fc->sim = sim;
        fc->path = path;
        fc->isp = isp;
        fc->ready = 1;
        fcp->isp_use_gft_id = 1;
        fcp->isp_use_gff_id = 1;

        callout_init_mtx(&fc->gdt, &isp->isp_lock, 0);
        TASK_INIT(&fc->gtask, 1, isp_gdt_task, fc);
#ifdef  ISP_TARGET_MODE
        TAILQ_INIT(&fc->waitq);
        STAILQ_INIT(&fc->ntfree);
        for (i = 0; i < ATPDPSIZE; i++)
                STAILQ_INSERT_TAIL(&fc->ntfree, &fc->ntpool[i], next);
        LIST_INIT(&fc->atfree);
        for (i = ATPDPSIZE-1; i >= 0; i--)
                LIST_INSERT_HEAD(&fc->atfree, &fc->atpool[i], next);
        for (i = 0; i < ATPDPHASHSIZE; i++)
                LIST_INIT(&fc->atused[i]);
#endif
        isp_loop_changed(isp, chan);
        ISP_UNLOCK(isp);
        if (kproc_create(isp_kthread, fc, &fc->kproc, 0, 0,
            "%s_%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
                xpt_free_path(fc->path);
                xpt_bus_deregister(cam_sim_path(fc->sim));
                cam_sim_free(fc->sim, FALSE);
                return (ENOMEM);
        }
        fc->num_threads += 1;
        if (chan > 0) {
                snprintf(name, sizeof(name), "chan%d", chan);
                tree = SYSCTL_ADD_NODE(ctx, SYSCTL_CHILDREN(tree),
                    OID_AUTO, name, CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
                    "Virtual channel");
        }
        SYSCTL_ADD_QUAD(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "wwnn", CTLFLAG_RD, &fcp->isp_wwnn,
            "World Wide Node Name");
        SYSCTL_ADD_QUAD(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "wwpn", CTLFLAG_RD, &fcp->isp_wwpn,
            "World Wide Port Name");
        SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "loop_down_limit", CTLFLAG_RW, &fc->loop_down_limit, 0,
            "Loop Down Limit");
        SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "gone_device_time", CTLFLAG_RW, &fc->gone_device_time, 0,
            "Gone Device Time");
#if defined(ISP_TARGET_MODE) && defined(DEBUG)
        SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "inject_lost_data_frame", CTLFLAG_RW, &fc->inject_lost_data_frame, 0,
            "Cause a Lost Frame on a Read");
#endif
        SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "role", CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE,
            isp, chan, isp_role_sysctl, "I", "Current role");
        SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "speed", CTLFLAG_RD, &fcp->isp_gbspeed, 0,
            "Connection speed in gigabits");
        SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "linkstate", CTLFLAG_RD, &fcp->isp_linkstate, 0,
            "Link state");
        SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "fwstate", CTLFLAG_RD, &fcp->isp_fwstate, 0,
            "Firmware state");
        SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "loopstate", CTLFLAG_RD, &fcp->isp_loopstate, 0,
            "Loop state");
        SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "topo", CTLFLAG_RD, &fcp->isp_topo, 0,
            "Connection topology");
        SYSCTL_ADD_INT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "use_gft_id", CTLFLAG_RWTUN, &fcp->isp_use_gft_id, 0,
            "Use GFT_ID during fabric scan");
        SYSCTL_ADD_INT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "use_gff_id", CTLFLAG_RWTUN, &fcp->isp_use_gff_id, 0,
            "Use GFF_ID during fabric scan");
        SYSCTL_ADD_STRING(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "fw_version_flash", CTLFLAG_RD, fcp->fw_version_flash, 0,
            "Firmware version in (active) flash region");
        SYSCTL_ADD_STRING(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "fw_version_ispfw", CTLFLAG_RD, fcp->fw_version_ispfw, 0,
            "Firmware version loaded from ispfw(4)");
        SYSCTL_ADD_STRING(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
            "fw_version_run", CTLFLAG_RD, fcp->fw_version_run, 0,
            "Firmware version currently running");
        return (0);
}

static void
isp_detach_chan(ispsoftc_t *isp, int chan)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        xpt_free_path(fc->path);
        xpt_bus_deregister(cam_sim_path(fc->sim));
        cam_sim_free(fc->sim, FALSE);

        /* Wait for the channel's spawned threads to exit. */
        wakeup(fc);
        while (fc->num_threads != 0)
                mtx_sleep(&fc->num_threads, &isp->isp_lock, PRIBIO, "isp_reap", 0);
}

int
isp_attach(ispsoftc_t *isp)
{
        const char *nu = device_get_nameunit(isp->isp_osinfo.dev);
        int du = device_get_unit(isp->isp_dev);
        int chan;

        /*
         * Create the device queue for our SIM(s).
         */
        isp->isp_osinfo.devq = cam_simq_alloc(isp->isp_maxcmds);
        if (isp->isp_osinfo.devq == NULL) {
                return (EIO);
        }

        for (chan = 0; chan < isp->isp_nchan; chan++) {
                if (isp_attach_chan(isp, isp->isp_osinfo.devq, chan)) {
                        goto unwind;
                }
        }

        callout_init_mtx(&isp->isp_osinfo.tmo, &isp->isp_lock, 0);
        isp_timer_count = hz >> 2;
        callout_reset(&isp->isp_osinfo.tmo, isp_timer_count, isp_timer, isp);

        isp->isp_osinfo.cdev = make_dev(&isp_cdevsw, du, UID_ROOT, GID_OPERATOR, 0600, "%s", nu);
        if (isp->isp_osinfo.cdev) {
                isp->isp_osinfo.cdev->si_drv1 = isp;
        }
        return (0);

unwind:
        ISP_LOCK(isp);
        isp->isp_osinfo.is_exiting = 1;
        while (--chan >= 0)
                isp_detach_chan(isp, chan);
        ISP_UNLOCK(isp);
        cam_simq_free(isp->isp_osinfo.devq);
        isp->isp_osinfo.devq = NULL;
        return (-1);
}

int
isp_detach(ispsoftc_t *isp)
{
        int chan;

        if (isp->isp_osinfo.cdev) {
                destroy_dev(isp->isp_osinfo.cdev);
                isp->isp_osinfo.cdev = NULL;
        }
        ISP_LOCK(isp);
        /* Tell spawned threads that we're exiting. */
        isp->isp_osinfo.is_exiting = 1;
        for (chan = isp->isp_nchan - 1; chan >= 0; chan -= 1)
                isp_detach_chan(isp, chan);
        ISP_UNLOCK(isp);
        callout_drain(&isp->isp_osinfo.tmo);
        cam_simq_free(isp->isp_osinfo.devq);
        return (0);
}

static void
isp_freeze_loopdown(ispsoftc_t *isp, int chan)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        if (fc->sim == NULL)
                return;
        if (fc->simqfrozen == 0) {
                isp_prt(isp, ISP_LOGDEBUG0,
                    "Chan %d Freeze simq (loopdown)", chan);
                fc->simqfrozen = SIMQFRZ_LOOPDOWN;
                xpt_hold_boot();
                xpt_freeze_simq(fc->sim, 1);
        } else {
                isp_prt(isp, ISP_LOGDEBUG0,
                    "Chan %d Mark simq frozen (loopdown)", chan);
                fc->simqfrozen |= SIMQFRZ_LOOPDOWN;
        }
}

static void
isp_unfreeze_loopdown(ispsoftc_t *isp, int chan)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        if (fc->sim == NULL)
                return;
        int wasfrozen = fc->simqfrozen & SIMQFRZ_LOOPDOWN;
        fc->simqfrozen &= ~SIMQFRZ_LOOPDOWN;
        if (wasfrozen && fc->simqfrozen == 0) {
                isp_prt(isp, ISP_LOGDEBUG0,
                    "Chan %d Release simq", chan);
                xpt_release_simq(fc->sim, 1);
                xpt_release_boot();
        }
}

/*
 * Functions to protect from request queue overflow by freezing SIM queue.
 * XXX: freezing only one arbitrary SIM, since they all share the queue.
 */
static void
isp_rq_check_above(ispsoftc_t *isp)
{
        struct isp_fc *fc = ISP_FC_PC(isp, 0);

        if (isp->isp_rqovf || fc->sim == NULL)
                return;
        if (!isp_rqentry_avail(isp, QENTRY_MAX)) {
                xpt_freeze_simq(fc->sim, 1);
                isp->isp_rqovf = 1;
        }
}

static void
isp_rq_check_below(ispsoftc_t *isp)
{
        struct isp_fc *fc = ISP_FC_PC(isp, 0);

        if (!isp->isp_rqovf || fc->sim == NULL)
                return;
        if (isp_rqentry_avail(isp, QENTRY_MAX)) {
                xpt_release_simq(fc->sim, 0);
                isp->isp_rqovf = 0;
        }
}

static int
ispioctl(struct cdev *dev, u_long c, caddr_t addr, int flags, struct thread *td)
{
        ispsoftc_t *isp;
        int nr, chan, retval = ENOTTY;

        isp = dev->si_drv1;

        switch (c) {
        case ISP_SDBLEV:
        {
                int olddblev = isp->isp_dblev;
                isp->isp_dblev = *(int *)addr;
                *(int *)addr = olddblev;
                retval = 0;
                break;
        }
        case ISP_GETROLE:
                chan = *(int *)addr;
                if (chan < 0 || chan >= isp->isp_nchan) {
                        retval = -ENXIO;
                        break;
                }
                *(int *)addr = FCPARAM(isp, chan)->role;
                retval = 0;
                break;
        case ISP_SETROLE:
                nr = *(int *)addr;
                chan = nr >> 8;
                if (chan < 0 || chan >= isp->isp_nchan) {
                        retval = -ENXIO;
                        break;
                }
                nr &= 0xff;
                if (nr & ~(ISP_ROLE_INITIATOR|ISP_ROLE_TARGET)) {
                        retval = EINVAL;
                        break;
                }
                ISP_LOCK(isp);
                *(int *)addr = FCPARAM(isp, chan)->role;
                retval = isp_control(isp, ISPCTL_CHANGE_ROLE, chan, nr);
                ISP_UNLOCK(isp);
                break;

        case ISP_RESETHBA:
                ISP_LOCK(isp);
                isp_reinit(isp, 0);
                ISP_UNLOCK(isp);
                retval = 0;
                break;

        case ISP_RESCAN:
                chan = *(intptr_t *)addr;
                if (chan < 0 || chan >= isp->isp_nchan) {
                        retval = -ENXIO;
                        break;
                }
                ISP_LOCK(isp);
                if (isp_fc_runstate(isp, chan, 5 * 1000000) != LOOP_READY) {
                        retval = EIO;
                } else {
                        retval = 0;
                }
                ISP_UNLOCK(isp);
                break;

        case ISP_FC_LIP:
                chan = *(intptr_t *)addr;
                if (chan < 0 || chan >= isp->isp_nchan) {
                        retval = -ENXIO;
                        break;
                }
                ISP_LOCK(isp);
                if (isp_control(isp, ISPCTL_SEND_LIP, chan)) {
                        retval = EIO;
                } else {
                        retval = 0;
                }
                ISP_UNLOCK(isp);
                break;
        case ISP_FC_GETDINFO:
        {
                struct isp_fc_device *ifc = (struct isp_fc_device *) addr;
                fcportdb_t *lp;

                if (ifc->loopid >= MAX_FC_TARG) {
                        retval = EINVAL;
                        break;
                }
                lp = &FCPARAM(isp, ifc->chan)->portdb[ifc->loopid];
                if (lp->state != FC_PORTDB_STATE_NIL) {
                        ifc->role = (lp->prli_word3 & SVC3_ROLE_MASK) >> SVC3_ROLE_SHIFT;
                        ifc->loopid = lp->handle;
                        ifc->portid = lp->portid;
                        ifc->node_wwn = lp->node_wwn;
                        ifc->port_wwn = lp->port_wwn;
                        retval = 0;
                } else {
                        retval = ENODEV;
                }
                break;
        }
        case ISP_FC_GETHINFO:
        {
                struct isp_hba_device *hba = (struct isp_hba_device *) addr;
                int chan = hba->fc_channel;

                if (chan < 0 || chan >= isp->isp_nchan) {
                        retval = ENXIO;
                        break;
                }
                hba->fc_fw_major = ISP_FW_MAJORX(isp->isp_fwrev);
                hba->fc_fw_minor = ISP_FW_MINORX(isp->isp_fwrev);
                hba->fc_fw_micro = ISP_FW_MICROX(isp->isp_fwrev);
                hba->fc_nchannels = isp->isp_nchan;
                hba->fc_nports = MAX_FC_TARG;
                hba->fc_speed = FCPARAM(isp, hba->fc_channel)->isp_gbspeed;
                hba->fc_topology = FCPARAM(isp, chan)->isp_topo + 1;
                hba->fc_loopid = FCPARAM(isp, chan)->isp_loopid;
                hba->nvram_node_wwn = FCPARAM(isp, chan)->isp_wwnn_nvram;
                hba->nvram_port_wwn = FCPARAM(isp, chan)->isp_wwpn_nvram;
                hba->active_node_wwn = FCPARAM(isp, chan)->isp_wwnn;
                hba->active_port_wwn = FCPARAM(isp, chan)->isp_wwpn;
                retval = 0;
                break;
        }
        case ISP_TSK_MGMT:
        {
                int needmarker;
                struct isp_fc_tsk_mgmt *fct = (struct isp_fc_tsk_mgmt *) addr;
                uint16_t nphdl;
                isp24xx_tmf_t tmf;
                isp24xx_statusreq_t sp;
                fcparam *fcp;
                fcportdb_t *lp;
                int i;

                chan = fct->chan;
                if (chan < 0 || chan >= isp->isp_nchan) {
                        retval = -ENXIO;
                        break;
                }

                needmarker = retval = 0;
                nphdl = fct->loopid;
                ISP_LOCK(isp);
                fcp = FCPARAM(isp, chan);

                for (i = 0; i < MAX_FC_TARG; i++) {
                        lp = &fcp->portdb[i];
                        if (lp->handle == nphdl) {
                                break;
                        }
                }
                if (i == MAX_FC_TARG) {
                        retval = ENXIO;
                        ISP_UNLOCK(isp);
                        break;
                }
                ISP_MEMZERO(&tmf, sizeof(tmf));
                tmf.tmf_header.rqs_entry_type = RQSTYPE_TSK_MGMT;
                tmf.tmf_header.rqs_entry_count = 1;
                tmf.tmf_nphdl = lp->handle;
                tmf.tmf_delay = 2;
                tmf.tmf_timeout = 4;
                tmf.tmf_tidlo = lp->portid;
                tmf.tmf_tidhi = lp->portid >> 16;
                tmf.tmf_vpidx = ISP_GET_VPIDX(isp, chan);
                tmf.tmf_lun[1] = fct->lun & 0xff;
                if (fct->lun >= 256) {
                        tmf.tmf_lun[0] = 0x40 | (fct->lun >> 8);
                }
                switch (fct->action) {
                case IPT_CLEAR_ACA:
                        tmf.tmf_flags = ISP24XX_TMF_CLEAR_ACA;
                        break;
                case IPT_TARGET_RESET:
                        tmf.tmf_flags = ISP24XX_TMF_TARGET_RESET;
                        needmarker = 1;
                        break;
                case IPT_LUN_RESET:
                        tmf.tmf_flags = ISP24XX_TMF_LUN_RESET;
                        needmarker = 1;
                        break;
                case IPT_CLEAR_TASK_SET:
                        tmf.tmf_flags = ISP24XX_TMF_CLEAR_TASK_SET;
                        needmarker = 1;
                        break;
                case IPT_ABORT_TASK_SET:
                        tmf.tmf_flags = ISP24XX_TMF_ABORT_TASK_SET;
                        needmarker = 1;
                        break;
                default:
                        retval = EINVAL;
                        break;
                }
                if (retval) {
                        ISP_UNLOCK(isp);
                        break;
                }

                retval = isp_exec_entry_queue(isp, &tmf, &sp, 5);
                if (retval != 0) {
                        isp_prt(isp, ISP_LOGERR, "%s: TMF of chan %d error %d",
                            __func__, chan, retval);
                        ISP_UNLOCK(isp);
                        break;
                }

                if (sp.req_completion_status != 0)
                        retval = EIO;
                else if (needmarker)
                        fcp->sendmarker = 1;
                ISP_UNLOCK(isp);
                break;
        }
        default:
                break;
        }
        return (retval);
}

/*
 * Local Inlines
 */

static ISP_INLINE int isp_get_pcmd(ispsoftc_t *, union ccb *);
static ISP_INLINE void isp_free_pcmd(ispsoftc_t *, union ccb *);

static ISP_INLINE int
isp_get_pcmd(ispsoftc_t *isp, union ccb *ccb)
{
        ISP_PCMD(ccb) = isp->isp_osinfo.pcmd_free;
        if (ISP_PCMD(ccb) == NULL) {
                return (-1);
        }
        isp->isp_osinfo.pcmd_free = ((struct isp_pcmd *)ISP_PCMD(ccb))->next;
        return (0);
}

static ISP_INLINE void
isp_free_pcmd(ispsoftc_t *isp, union ccb *ccb)
{
        if (ISP_PCMD(ccb)) {
#ifdef  ISP_TARGET_MODE
                PISP_PCMD(ccb)->datalen = 0;
#endif
                PISP_PCMD(ccb)->next = isp->isp_osinfo.pcmd_free;
                isp->isp_osinfo.pcmd_free = ISP_PCMD(ccb);
                ISP_PCMD(ccb) = NULL;
        }
}

/*
 * Put the target mode functions here, because some are inlines
 */
#ifdef  ISP_TARGET_MODE
static ISP_INLINE tstate_t *get_lun_statep(ispsoftc_t *, int, lun_id_t);
static atio_private_data_t *isp_get_atpd(ispsoftc_t *, int, uint32_t, void *);
static atio_private_data_t *isp_find_atpd(ispsoftc_t *, int, uint32_t);
static atio_private_data_t *isp_find_atpd_ccb(ispsoftc_t *, int, uint32_t, void *);
static void isp_put_atpd(ispsoftc_t *, int, atio_private_data_t *);
static inot_private_data_t *isp_get_ntpd(ispsoftc_t *, int);
static inot_private_data_t *isp_find_ntpd(ispsoftc_t *, int, uint32_t, uint32_t);
static void isp_put_ntpd(ispsoftc_t *, int, inot_private_data_t *);
static tstate_t *create_lun_state(ispsoftc_t *, int, struct cam_path *);
static void destroy_lun_state(ispsoftc_t *, int, tstate_t *);
static void isp_enable_lun(ispsoftc_t *, union ccb *);
static void isp_disable_lun(ispsoftc_t *, union ccb *);
static callout_func_t isp_refire_notify_ack;
static void isp_complete_ctio(ispsoftc_t *isp, union ccb *);
enum Start_Ctio_How { FROM_CAM, FROM_TIMER, FROM_SRR, FROM_CTIO_DONE };
static void isp_target_start_ctio(ispsoftc_t *, union ccb *, enum Start_Ctio_How);
static void isp_handle_platform_atio7(ispsoftc_t *, at7_entry_t *);
static void isp_handle_platform_ctio(ispsoftc_t *, ct7_entry_t *);
static int isp_handle_platform_target_notify_ack(ispsoftc_t *, isp_notify_t *, uint32_t rsp);
static void isp_handle_platform_target_tmf(ispsoftc_t *, isp_notify_t *);
static void isp_target_mark_aborted_early(ispsoftc_t *, int chan, tstate_t *, uint32_t);

static ISP_INLINE tstate_t *
get_lun_statep(ispsoftc_t *isp, int bus, lun_id_t lun)
{
        struct isp_fc *fc = ISP_FC_PC(isp, bus);
        tstate_t *tptr;

        SLIST_FOREACH(tptr, &fc->lun_hash[LUN_HASH_FUNC(lun)], next) {
                if (tptr->ts_lun == lun)
                        return (tptr);
        }
        return (NULL);
}

static int
isp_atio_restart(ispsoftc_t *isp, int bus, tstate_t *tptr)
{
        inot_private_data_t *ntp;
        struct ntpdlist rq;

        if (STAILQ_EMPTY(&tptr->restart_queue))
                return (0);
        STAILQ_INIT(&rq);
        STAILQ_CONCAT(&rq, &tptr->restart_queue);
        while ((ntp = STAILQ_FIRST(&rq)) != NULL) {
                STAILQ_REMOVE_HEAD(&rq, next);
                isp_prt(isp, ISP_LOGTDEBUG0,
                    "%s: restarting resrc deprived %x", __func__,
                    ((at7_entry_t *)ntp->data)->at_rxid);
                isp_handle_platform_atio7(isp, (at7_entry_t *) ntp->data);
                isp_put_ntpd(isp, bus, ntp);
                if (!STAILQ_EMPTY(&tptr->restart_queue))
                        break;
        }
        if (!STAILQ_EMPTY(&rq)) {
                STAILQ_CONCAT(&rq, &tptr->restart_queue);
                STAILQ_CONCAT(&tptr->restart_queue, &rq);
        }
        return (!STAILQ_EMPTY(&tptr->restart_queue));
}

static void
isp_tmcmd_restart(ispsoftc_t *isp)
{
        struct isp_fc *fc;
        tstate_t *tptr;
        union ccb *ccb;
        int bus, i;

        for (bus = 0; bus < isp->isp_nchan; bus++) {
                fc = ISP_FC_PC(isp, bus);
                for (i = 0; i < LUN_HASH_SIZE; i++) {
                        SLIST_FOREACH(tptr, &fc->lun_hash[i], next)
                                isp_atio_restart(isp, bus, tptr);
                }

                /*
                 * We only need to do this once per channel.
                 */
                ccb = (union ccb *)TAILQ_FIRST(&fc->waitq);
                if (ccb != NULL) {
                        TAILQ_REMOVE(&fc->waitq, &ccb->ccb_h, sim_links.tqe);
                        isp_target_start_ctio(isp, ccb, FROM_TIMER);
                }
        }
        isp_rq_check_above(isp);
        isp_rq_check_below(isp);
}

static atio_private_data_t *
isp_get_atpd(ispsoftc_t *isp, int chan, uint32_t tag, void *ccb)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);
        atio_private_data_t *atp;

        atp = LIST_FIRST(&fc->atfree);
        if (atp) {
                LIST_REMOVE(atp, next);
                atp->ccb = ccb;
                atp->tag = tag;
                LIST_INSERT_HEAD(&fc->atused[ATPDPHASH(tag)], atp, next);
        }
        return (atp);
}

static atio_private_data_t *
isp_find_atpd(ispsoftc_t *isp, int chan, uint32_t tag)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);
        atio_private_data_t *atp;

        LIST_FOREACH(atp, &fc->atused[ATPDPHASH(tag)], next) {
                if (atp->tag == tag)
                        return (atp);
        }
        return (NULL);
}

/*
 * Similar to above, but in addition to tag searches for opaque CCB pointer,
 * It can be used in situations when the tag alone may already be reused.
 */
static atio_private_data_t *
isp_find_atpd_ccb(ispsoftc_t *isp, int chan, uint32_t tag, void *ccb)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);
        atio_private_data_t *atp;

        LIST_FOREACH(atp, &fc->atused[ATPDPHASH(tag)], next) {
                if (atp->tag == tag && atp->ccb == ccb)
                        return (atp);
        }
        return (NULL);
}

static void
isp_put_atpd(ispsoftc_t *isp, int chan, atio_private_data_t *atp)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        if (atp->ests)
                isp_put_ecmd(isp, atp->ests);
        LIST_REMOVE(atp, next);
        memset(atp, 0, sizeof (*atp));
        LIST_INSERT_HEAD(&fc->atfree, atp, next);
}

static void
isp_dump_atpd(ispsoftc_t *isp, int chan)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);
        atio_private_data_t *atp;
        const char *states[8] = { "Free", "ATIO", "CAM", "CTIO", "LAST_CTIO", "PDON", "?6", "7" };

        for (atp = fc->atpool; atp < &fc->atpool[ATPDPSIZE]; atp++) {
                if (atp->state == ATPD_STATE_FREE)
                        continue;
                isp_prt(isp, ISP_LOGALL, "Chan %d ATP [0x%x] origdlen %u bytes_xfrd %u lun %jx nphdl 0x%04x s_id 0x%06x d_id 0x%06x oxid 0x%04x state %s",
                    chan, atp->tag, atp->orig_datalen, atp->bytes_xfered, (uintmax_t)atp->lun, atp->nphdl, atp->sid, atp->did, atp->oxid, states[atp->state & 0x7]);
        }
}

static inot_private_data_t *
isp_get_ntpd(ispsoftc_t *isp, int chan)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);
        inot_private_data_t *ntp;

        ntp = STAILQ_FIRST(&fc->ntfree);
        if (ntp)
                STAILQ_REMOVE_HEAD(&fc->ntfree, next);
        return (ntp);
}

static inot_private_data_t *
isp_find_ntpd(ispsoftc_t *isp, int chan, uint32_t tag_id, uint32_t seq_id)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);
        inot_private_data_t *ntp;

        for (ntp = fc->ntpool; ntp < &fc->ntpool[ATPDPSIZE]; ntp++) {
                if (ntp->tag_id == tag_id && ntp->seq_id == seq_id)
                        return (ntp);
        }
        return (NULL);
}

static void
isp_put_ntpd(ispsoftc_t *isp, int chan, inot_private_data_t *ntp)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        ntp->tag_id = ntp->seq_id = 0;
        STAILQ_INSERT_HEAD(&fc->ntfree, ntp, next);
}

tstate_t *
create_lun_state(ispsoftc_t *isp, int bus, struct cam_path *path)
{
        struct isp_fc *fc = ISP_FC_PC(isp, bus);
        lun_id_t lun;
        tstate_t *tptr;

        lun = xpt_path_lun_id(path);
        tptr = malloc(sizeof (tstate_t), M_DEVBUF, M_NOWAIT|M_ZERO);
        if (tptr == NULL)
                return (NULL);
        tptr->ts_lun = lun;
        SLIST_INIT(&tptr->atios);
        SLIST_INIT(&tptr->inots);
        STAILQ_INIT(&tptr->restart_queue);
        SLIST_INSERT_HEAD(&fc->lun_hash[LUN_HASH_FUNC(lun)], tptr, next);
        ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, path, "created tstate\n");
        return (tptr);
}

static void
destroy_lun_state(ispsoftc_t *isp, int bus, tstate_t *tptr)
{
        struct isp_fc *fc = ISP_FC_PC(isp, bus);
        union ccb *ccb;
        inot_private_data_t *ntp;

        while ((ccb = (union ccb *)SLIST_FIRST(&tptr->atios)) != NULL) {
                SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
                ccb->ccb_h.status = CAM_REQ_ABORTED;
                xpt_done(ccb);
        };
        while ((ccb = (union ccb *)SLIST_FIRST(&tptr->inots)) != NULL) {
                SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
                ccb->ccb_h.status = CAM_REQ_ABORTED;
                xpt_done(ccb);
        }
        while ((ntp = STAILQ_FIRST(&tptr->restart_queue)) != NULL) {
                isp_endcmd(isp, ntp->data, NIL_HANDLE, bus, SCSI_STATUS_BUSY, 0);
                STAILQ_REMOVE_HEAD(&tptr->restart_queue, next);
                isp_put_ntpd(isp, bus, ntp);
        }
        SLIST_REMOVE(&fc->lun_hash[LUN_HASH_FUNC(tptr->ts_lun)], tptr, tstate, next);
        free(tptr, M_DEVBUF);
}

static void
isp_enable_lun(ispsoftc_t *isp, union ccb *ccb)
{
        tstate_t *tptr;
        int bus = XS_CHANNEL(ccb);
        target_id_t target = ccb->ccb_h.target_id;
        lun_id_t lun = ccb->ccb_h.target_lun;

        /*
         * We only support either target and lun both wildcard
         * or target and lun both non-wildcard.
         */
        ISP_PATH_PRT(isp, ISP_LOGTDEBUG0|ISP_LOGCONFIG, ccb->ccb_h.path,
            "enabling lun %jx\n", (uintmax_t)lun);
        if ((target == CAM_TARGET_WILDCARD) != (lun == CAM_LUN_WILDCARD)) {
                ccb->ccb_h.status = CAM_LUN_INVALID;
                xpt_done(ccb);
                return;
        }

        /* Create the state pointer. It should not already exist. */
        tptr = get_lun_statep(isp, bus, lun);
        if (tptr) {
                ccb->ccb_h.status = CAM_LUN_ALRDY_ENA;
                xpt_done(ccb);
                return;
        }
        tptr = create_lun_state(isp, bus, ccb->ccb_h.path);
        if (tptr == NULL) {
                ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
                xpt_done(ccb);
                return;
        }

        ccb->ccb_h.status = CAM_REQ_CMP;
        xpt_done(ccb);
}

static void
isp_disable_lun(ispsoftc_t *isp, union ccb *ccb)
{
        tstate_t *tptr;
        int bus = XS_CHANNEL(ccb);
        target_id_t target = ccb->ccb_h.target_id;
        lun_id_t lun = ccb->ccb_h.target_lun;

        ISP_PATH_PRT(isp, ISP_LOGTDEBUG0|ISP_LOGCONFIG, ccb->ccb_h.path,
            "disabling lun %jx\n", (uintmax_t)lun);
        if ((target == CAM_TARGET_WILDCARD) != (lun == CAM_LUN_WILDCARD)) {
                ccb->ccb_h.status = CAM_LUN_INVALID;
                xpt_done(ccb);
                return;
        }

        /* Find the state pointer. */
        if ((tptr = get_lun_statep(isp, bus, lun)) == NULL) {
                ccb->ccb_h.status = CAM_PATH_INVALID;
                xpt_done(ccb);
                return;
        }

        destroy_lun_state(isp, bus, tptr);
        ccb->ccb_h.status = CAM_REQ_CMP;
        xpt_done(ccb);
}

static void
isp_target_start_ctio(ispsoftc_t *isp, union ccb *ccb, enum Start_Ctio_How how)
{
        int fctape, sendstatus, resid;
        fcparam *fcp;
        atio_private_data_t *atp;
        struct ccb_scsiio *cso;
        struct isp_ccbq *waitq;
        uint32_t dmaresult, handle, xfrlen, sense_length, tmp;
        ct7_entry_t local, *cto = &local;

        isp_prt(isp, ISP_LOGTDEBUG0, "%s: ENTRY[0x%x] how %u xfrlen %u sendstatus %d sense_len %u", __func__, ccb->csio.tag_id, how, ccb->csio.dxfer_len,
            (ccb->ccb_h.flags & CAM_SEND_STATUS) != 0, ((ccb->ccb_h.flags & CAM_SEND_SENSE)? ccb->csio.sense_len : 0));

        waitq = &ISP_FC_PC(isp, XS_CHANNEL(ccb))->waitq;
        switch (how) {
        case FROM_CAM:
                /*
                 * Insert at the tail of the list, if any, waiting CTIO CCBs
                 */
                TAILQ_INSERT_TAIL(waitq, &ccb->ccb_h, sim_links.tqe);
                break;
        case FROM_TIMER:
        case FROM_SRR:
        case FROM_CTIO_DONE:
                TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
                break;
        }

        while ((ccb = (union ccb *) TAILQ_FIRST(waitq)) != NULL) {
                TAILQ_REMOVE(waitq, &ccb->ccb_h, sim_links.tqe);

                cso = &ccb->csio;
                xfrlen = cso->dxfer_len;
                if (xfrlen == 0) {
                        if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
                                ISP_PATH_PRT(isp, ISP_LOGERR, ccb->ccb_h.path, "a data transfer length of zero but no status to send is wrong\n");
                                ccb->ccb_h.status = CAM_REQ_INVALID;
                                xpt_done(ccb);
                                continue;
                        }
                }

                atp = isp_find_atpd(isp, XS_CHANNEL(ccb), cso->tag_id);
                if (atp == NULL) {
                        isp_prt(isp, ISP_LOGERR, "%s: [0x%x] cannot find private data adjunct in %s", __func__, cso->tag_id, __func__);
                        isp_dump_atpd(isp, XS_CHANNEL(ccb));
                        ccb->ccb_h.status = CAM_REQ_CMP_ERR;
                        xpt_done(ccb);
                        continue;
                }

                /*
                 * Is this command a dead duck?
                 */
                if (atp->dead) {
                        isp_prt(isp, ISP_LOGERR, "%s: [0x%x] not sending a CTIO for a dead command", __func__, cso->tag_id);
                        ccb->ccb_h.status = CAM_REQ_ABORTED;
                        xpt_done(ccb);
                        continue;
                }

                /*
                 * Check to make sure we're still in target mode.
                 */
                fcp = FCPARAM(isp, XS_CHANNEL(ccb));
                if ((fcp->role & ISP_ROLE_TARGET) == 0) {
                        isp_prt(isp, ISP_LOGERR, "%s: [0x%x] stopping sending a CTIO because we're no longer in target mode", __func__, cso->tag_id);
                        ccb->ccb_h.status = CAM_PROVIDE_FAIL;
                        xpt_done(ccb);
                        continue;
                }

                /*
                 * We're only handling ATPD_CCB_OUTSTANDING outstanding CCB at a time (one of which
                 * could be split into two CTIOs to split data and status).
                 */
                if (atp->ctcnt >= ATPD_CCB_OUTSTANDING) {
                        isp_prt(isp, ISP_LOGTINFO, "[0x%x] handling only %d CCBs at a time (flags for this ccb: 0x%x)", cso->tag_id, ATPD_CCB_OUTSTANDING, ccb->ccb_h.flags);
                        TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
                        break;
                }

                /*
                 * Does the initiator expect FC-Tape style responses?
                 */
                if ((atp->word3 & PRLI_WD3_RETRY) && fcp->fctape_enabled) {
                        fctape = 1;
                } else {
                        fctape = 0;
                }

                /*
                 * If we already did the data xfer portion of a CTIO that sends data
                 * and status, don't do it again and do the status portion now.
                 */
                if (atp->sendst) {
                        isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] now sending synthesized status orig_dl=%u xfered=%u bit=%u",
                            cso->tag_id, atp->orig_datalen, atp->bytes_xfered, atp->bytes_in_transit);
                        xfrlen = 0;     /* we already did the data transfer */
                        atp->sendst = 0;
                }
                if (ccb->ccb_h.flags & CAM_SEND_STATUS) {
                        sendstatus = 1;
                } else {
                        sendstatus = 0;
                }

                if (ccb->ccb_h.flags & CAM_SEND_SENSE) {
                        KASSERT((sendstatus != 0), ("how can you have CAM_SEND_SENSE w/o CAM_SEND_STATUS?"));
                        /*
                         * Sense length is not the entire sense data structure size. Periph
                         * drivers don't seem to be setting sense_len to reflect the actual
                         * size. We'll peek inside to get the right amount.
                         */
                        sense_length = cso->sense_len;

                        /*
                         * This 'cannot' happen
                         */
                        if (sense_length > (XCMD_SIZE - MIN_FCP_RESPONSE_SIZE)) {
                                sense_length = XCMD_SIZE - MIN_FCP_RESPONSE_SIZE;
                        }
                } else {
                        sense_length = 0;
                }

                /*
                 * Check for overflow
                 */
                tmp = atp->bytes_xfered + atp->bytes_in_transit;
                if (xfrlen > 0 && tmp > atp->orig_datalen) {
                        isp_prt(isp, ISP_LOGERR,
                            "%s: [0x%x] data overflow by %u bytes", __func__,
                            cso->tag_id, tmp + xfrlen - atp->orig_datalen);
                        ccb->ccb_h.status = CAM_DATA_RUN_ERR;
                        xpt_done(ccb);
                        continue;
                }
                if (xfrlen > atp->orig_datalen - tmp) {
                        xfrlen = atp->orig_datalen - tmp;
                        if (xfrlen == 0 && !sendstatus) {
                                cso->resid = cso->dxfer_len;
                                ccb->ccb_h.status = CAM_REQ_CMP;
                                xpt_done(ccb);
                                continue;
                        }
                }

                memset(cto, 0, QENTRY_LEN);
                cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
                cto->ct_header.rqs_entry_count = 1;
                cto->ct_header.rqs_seqno |= ATPD_SEQ_NOTIFY_CAM;
                ATPD_SET_SEQNO(cto, atp);
                cto->ct_nphdl = atp->nphdl;
                cto->ct_rxid = atp->tag;
                cto->ct_iid_lo = atp->sid;
                cto->ct_iid_hi = atp->sid >> 16;
                cto->ct_oxid = atp->oxid;
                cto->ct_vpidx = ISP_GET_VPIDX(isp, XS_CHANNEL(ccb));
                cto->ct_timeout = XS_TIME(ccb);
                cto->ct_flags = atp->tattr << CT7_TASK_ATTR_SHIFT;

                /*
                 * Mode 1, status, no data. Only possible when we are sending status, have
                 * no data to transfer, and any sense data can fit into a ct7_entry_t.
                 *
                 * Mode 2, status, no data. We have to use this in the case that
                 * the sense data won't fit into a ct7_entry_t.
                 *
                 */
                if (sendstatus && xfrlen == 0) {
                        cto->ct_flags |= CT7_SENDSTATUS | CT7_NO_DATA;
                        resid = atp->orig_datalen - atp->bytes_xfered - atp->bytes_in_transit;
                        if (sense_length <= MAXRESPLEN_24XX) {
                                cto->ct_flags |= CT7_FLAG_MODE1;
                                cto->ct_scsi_status = cso->scsi_status;
                                if (resid < 0) {
                                        cto->ct_resid = -resid;
                                        cto->ct_scsi_status |= (FCP_RESID_OVERFLOW << 8);
                                } else if (resid > 0) {
                                        cto->ct_resid = resid;
                                        cto->ct_scsi_status |= (FCP_RESID_UNDERFLOW << 8);
                                }
                                if (fctape) {
                                        cto->ct_flags |= CT7_CONFIRM|CT7_EXPLCT_CONF;
                                }
                                if (sense_length) {
                                        cto->ct_scsi_status |= (FCP_SNSLEN_VALID << 8);
                                        cto->rsp.m1.ct_resplen = cto->ct_senselen = sense_length;
                                        memcpy(cto->rsp.m1.ct_resp, &cso->sense_data, sense_length);
                                }
                        } else {
                                bus_addr_t addr;
                                fcp_rsp_iu_t rp;

                                if (atp->ests == NULL) {
                                        atp->ests = isp_get_ecmd(isp);
                                        if (atp->ests == NULL) {
                                                TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
                                                break;
                                        }
                                }
                                memset(&rp, 0, sizeof(rp));
                                if (fctape) {
                                        cto->ct_flags |= CT7_CONFIRM|CT7_EXPLCT_CONF;
                                        rp.fcp_rsp_bits |= FCP_CONF_REQ;
                                }
                                cto->ct_flags |= CT7_FLAG_MODE2;
                                rp.fcp_rsp_scsi_status = cso->scsi_status;
                                if (resid < 0) {
                                        rp.fcp_rsp_resid = -resid;
                                        rp.fcp_rsp_bits |= FCP_RESID_OVERFLOW;
                                } else if (resid > 0) {
                                        rp.fcp_rsp_resid = resid;
                                        rp.fcp_rsp_bits |= FCP_RESID_UNDERFLOW;
                                }
                                if (sense_length) {
                                        rp.fcp_rsp_snslen = sense_length;
                                        cto->ct_senselen = sense_length;
                                        rp.fcp_rsp_bits |= FCP_SNSLEN_VALID;
                                        isp_put_fcp_rsp_iu(isp, &rp, atp->ests);
                                        memcpy(((fcp_rsp_iu_t *)atp->ests)->fcp_rsp_extra, &cso->sense_data, sense_length);
                                } else {
                                        isp_put_fcp_rsp_iu(isp, &rp, atp->ests);
                                }
                                if (isp->isp_dblev & ISP_LOGTDEBUG1) {
                                        isp_print_bytes(isp, "FCP Response Frame After Swizzling", MIN_FCP_RESPONSE_SIZE + sense_length, atp->ests);
                                }
                                bus_dmamap_sync(isp->isp_osinfo.ecmd_dmat, isp->isp_osinfo.ecmd_map, BUS_DMASYNC_PREWRITE);
                                addr = isp->isp_osinfo.ecmd_dma;
                                addr += ((((isp_ecmd_t *)atp->ests) - isp->isp_osinfo.ecmd_base) * XCMD_SIZE);
                                isp_prt(isp, ISP_LOGTDEBUG0, "%s: ests base %p vaddr %p ecmd_dma %jx addr %jx len %u", __func__, isp->isp_osinfo.ecmd_base, atp->ests,
                                    (uintmax_t) isp->isp_osinfo.ecmd_dma, (uintmax_t)addr, MIN_FCP_RESPONSE_SIZE + sense_length);
                                cto->rsp.m2.ct_datalen = MIN_FCP_RESPONSE_SIZE + sense_length;
                                cto->rsp.m2.ct_fcp_rsp_iudata.ds_base = DMA_LO32(addr);
                                cto->rsp.m2.ct_fcp_rsp_iudata.ds_basehi = DMA_HI32(addr);
                                cto->rsp.m2.ct_fcp_rsp_iudata.ds_count = MIN_FCP_RESPONSE_SIZE + sense_length;
                        }
                        if (sense_length) {
                                isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO7[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d slen %u sense: %x %x/%x/%x", __func__,
                                    cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cto->ct_scsi_status, cto->ct_flags, cto->ct_resid, sense_length,
                                    cso->sense_data.error_code, cso->sense_data.sense_buf[1], cso->sense_data.sense_buf[11], cso->sense_data.sense_buf[12]);
                        } else {
                                isp_prt(isp, ISP_LOGDEBUG0, "%s: CTIO7[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d", __func__,
                                    cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cto->ct_scsi_status, cto->ct_flags, cto->ct_resid);
                        }
                        atp->state = ATPD_STATE_LAST_CTIO;
                }

                /*
                 * Mode 0 data transfers, *possibly* with status.
                 */
                if (xfrlen != 0) {
                        cto->ct_flags |= CT7_FLAG_MODE0;
                        if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
                                cto->ct_flags |= CT7_DATA_IN;
                        } else {
                                cto->ct_flags |= CT7_DATA_OUT;
                        }

                        cto->rsp.m0.reloff = atp->bytes_xfered + atp->bytes_in_transit;
                        cto->rsp.m0.ct_xfrlen = xfrlen;

#ifdef  DEBUG
                        if (ISP_FC_PC(isp, XS_CHANNEL(ccb))->inject_lost_data_frame && xfrlen > ISP_FC_PC(isp, XS_CHANNEL(ccb))->inject_lost_data_frame) {
                                isp_prt(isp, ISP_LOGWARN, "%s: truncating data frame with xfrlen %d to %d", __func__, xfrlen, xfrlen - (xfrlen >> 2));
                                ISP_FC_PC(isp, XS_CHANNEL(ccb))->inject_lost_data_frame = 0;
                                cto->rsp.m0.ct_xfrlen -= xfrlen >> 2;
                        }
#endif
                        if (sendstatus) {
                                resid = atp->orig_datalen - atp->bytes_xfered - xfrlen;
                                if (cso->scsi_status == SCSI_STATUS_OK && resid == 0 /* && fctape == 0 */) {
                                        cto->ct_flags |= CT7_SENDSTATUS;
                                        atp->state = ATPD_STATE_LAST_CTIO;
                                        if (fctape) {
                                                cto->ct_flags |= CT7_CONFIRM|CT7_EXPLCT_CONF;
                                        }
                                } else {
                                        atp->sendst = 1;        /* send status later */
                                        cto->ct_header.rqs_seqno &= ~ATPD_SEQ_NOTIFY_CAM;
                                        atp->state = ATPD_STATE_CTIO;
                                }
                        } else {
                                atp->state = ATPD_STATE_CTIO;
                        }
                        isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO7[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x xfrlen=%u off=%u", __func__,
                            cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cto->ct_scsi_status, cto->ct_flags, xfrlen, atp->bytes_xfered);
                }

                if (isp_get_pcmd(isp, ccb)) {
                        ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "out of PCMDs\n");
                        TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
                        break;
                }
                handle = isp_allocate_handle(isp, ccb, ISP_HANDLE_TARGET);
                if (handle == 0) {
                        ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "No XFLIST pointers for %s\n", __func__);
                        TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
                        isp_free_pcmd(isp, ccb);
                        break;
                }
                atp->bytes_in_transit += xfrlen;
                PISP_PCMD(ccb)->datalen = xfrlen;

                /*
                 * Call the dma setup routines for this entry (and any subsequent
                 * CTIOs) if there's data to move, and then tell the f/w it's got
                 * new things to play with. As with isp_start's usage of DMA setup,
                 * any swizzling is done in the machine dependent layer. Because
                 * of this, we put the request onto the queue area first in native
                 * format.
                 */
                cto->ct_syshandle = handle;
                dmaresult = ISP_DMASETUP(isp, cso, cto);
                if (dmaresult != 0) {
                        isp_destroy_handle(isp, handle);
                        isp_free_pcmd(isp, ccb);
                        if (dmaresult == CMD_EAGAIN) {
                                TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
                                break;
                        }
                        ccb->ccb_h.status = CAM_REQ_CMP_ERR;
                        xpt_done(ccb);
                        continue;
                }
                ccb->ccb_h.status = CAM_REQ_INPROG | CAM_SIM_QUEUED;
                if (xfrlen) {
                        ccb->ccb_h.spriv_field0 = atp->bytes_xfered;
                } else {
                        ccb->ccb_h.spriv_field0 = ~0;
                }
                atp->ctcnt++;
                atp->seqno++;
        }
}

static void
isp_refire_notify_ack(void *arg)
{
        isp_tna_t *tp  = arg;
        ispsoftc_t *isp = tp->isp;

        ISP_ASSERT_LOCKED(isp);
        if (isp_notify_ack(isp, tp->not)) {
                callout_schedule(&tp->timer, 5);
        } else {
                free(tp, M_DEVBUF);
        }
}


static void
isp_complete_ctio(ispsoftc_t *isp, union ccb *ccb)
{

        isp_rq_check_below(isp);
        ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
        xpt_done(ccb);
}

static void
isp_handle_platform_atio7(ispsoftc_t *isp, at7_entry_t *aep)
{
        int cdbxlen;
        lun_id_t lun;
        uint16_t chan, nphdl = NIL_HANDLE;
        uint32_t did, sid;
        fcportdb_t *lp;
        tstate_t *tptr;
        struct ccb_accept_tio *atiop;
        atio_private_data_t *atp = NULL;
        atio_private_data_t *oatp;
        inot_private_data_t *ntp;

        did = (aep->at_hdr.d_id[0] << 16) | (aep->at_hdr.d_id[1] << 8) | aep->at_hdr.d_id[2];
        sid = (aep->at_hdr.s_id[0] << 16) | (aep->at_hdr.s_id[1] << 8) | aep->at_hdr.s_id[2];
        lun = CAM_EXTLUN_BYTE_SWIZZLE(be64dec(aep->at_cmnd.fcp_cmnd_lun));

        if (ISP_CAP_MULTI_ID(isp) && isp->isp_nchan > 1) {
                /* Channel has to be derived from D_ID */
                isp_find_chan_by_did(isp, did, &chan);
                if (chan == ISP_NOCHAN) {
                        isp_prt(isp, ISP_LOGWARN,
                            "%s: [RX_ID 0x%x] D_ID %x not found on any channel",
                            __func__, aep->at_rxid, did);
                        isp_endcmd(isp, aep, NIL_HANDLE, ISP_NOCHAN,
                            ECMD_TERMINATE, 0);
                        return;
                }
        } else {
                chan = 0;
        }

        /*
         * Find the PDB entry for this initiator
         */
        if (isp_find_pdb_by_portid(isp, chan, sid, &lp) == 0) {
                /*
                 * If we're not in the port database terminate the exchange.
                 */
                isp_prt(isp, ISP_LOGTINFO, "%s: [RX_ID 0x%x] D_ID 0x%06x found on Chan %d for S_ID 0x%06x wasn't in PDB already",
                    __func__, aep->at_rxid, did, chan, sid);
                isp_dump_portdb(isp, chan);
                isp_endcmd(isp, aep, NIL_HANDLE, chan, ECMD_TERMINATE, 0);
                return;
        }
        nphdl = lp->handle;

        /*
         * Get the tstate pointer
         */
        tptr = get_lun_statep(isp, chan, lun);
        if (tptr == NULL) {
                tptr = get_lun_statep(isp, chan, CAM_LUN_WILDCARD);
                if (tptr == NULL) {
                        isp_prt(isp, ISP_LOGWARN,
                            "%s: [0x%x] no state pointer for lun %jx or wildcard",
                            __func__, aep->at_rxid, (uintmax_t)lun);
                        if (lun == 0) {
                                isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_BUSY, 0);
                        } else {
                                isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_CHECK_COND | ECMD_SVALID | (0x5 << 12) | (0x25 << 16), 0);
                        }
                        return;
                }
        }

        /*
         * Start any commands pending resources first.
         */
        if (isp_atio_restart(isp, chan, tptr))
                goto noresrc;

        /*
         * If the f/w is out of resources, just send a BUSY status back.
         */
        if (aep->at_rxid == AT7_NORESRC_RXID) {
                isp_endcmd(isp, aep, nphdl, chan, SCSI_BUSY, 0);
                return;
        }

        /*
         * If we're out of resources, just send a BUSY status back.
         */
        atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
        if (atiop == NULL) {
                isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] out of atios", aep->at_rxid);
                goto noresrc;
        }

        oatp = isp_find_atpd(isp, chan, aep->at_rxid);
        if (oatp) {
                isp_prt(isp, oatp->state == ATPD_STATE_LAST_CTIO ? ISP_LOGTDEBUG0 :
                    ISP_LOGWARN, "[0x%x] tag wraparound (N-Port Handle "
                    "0x%04x S_ID 0x%04x OX_ID 0x%04x) oatp state %d",
                    aep->at_rxid, nphdl, sid, aep->at_hdr.ox_id, oatp->state);
                /*
                 * It's not a "no resource" condition- but we can treat it like one
                 */
                goto noresrc;
        }
        atp = isp_get_atpd(isp, chan, aep->at_rxid, atiop);
        if (atp == NULL) {
                isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] out of atps", aep->at_rxid);
                isp_endcmd(isp, aep, nphdl, chan, SCSI_BUSY, 0);
                return;
        }
        atp->word3 = lp->prli_word3;
        atp->state = ATPD_STATE_ATIO;
        SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
        ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, atiop->ccb_h.path, "Take FREE ATIO\n");
        atiop->init_id = FC_PORTDB_TGT(isp, chan, lp);
        atiop->ccb_h.target_id = ISP_MAX_TARGETS(isp);
        atiop->ccb_h.target_lun = lun;
        atiop->sense_len = 0;
        cdbxlen = aep->at_cmnd.fcp_cmnd_alen_datadir >> FCP_CMND_ADDTL_CDBLEN_SHIFT;
        if (cdbxlen) {
                isp_prt(isp, ISP_LOGWARN, "additional CDBLEN ignored");
        }
        cdbxlen = sizeof (aep->at_cmnd.cdb_dl.sf.fcp_cmnd_cdb);
        ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cmnd.cdb_dl.sf.fcp_cmnd_cdb, cdbxlen);
        atiop->cdb_len = cdbxlen;
        atiop->ccb_h.status = CAM_CDB_RECVD;
        atiop->tag_id = atp->tag;
        switch (aep->at_cmnd.fcp_cmnd_task_attribute & FCP_CMND_TASK_ATTR_MASK) {
        case FCP_CMND_TASK_ATTR_SIMPLE:
                atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
                atiop->tag_action = MSG_SIMPLE_TASK;
                break;
        case FCP_CMND_TASK_ATTR_HEAD:
                atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
                atiop->tag_action = MSG_HEAD_OF_QUEUE_TASK;
                break;
        case FCP_CMND_TASK_ATTR_ORDERED:
                atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
                atiop->tag_action = MSG_ORDERED_TASK;
                break;
        case FCP_CMND_TASK_ATTR_ACA:
                atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
                atiop->tag_action = MSG_ACA_TASK;
                break;
        case FCP_CMND_TASK_ATTR_UNTAGGED:
        default:
                atiop->tag_action = 0;
                break;
        }
        atiop->priority = (aep->at_cmnd.fcp_cmnd_task_attribute &
            FCP_CMND_PRIO_MASK) >> FCP_CMND_PRIO_SHIFT;
        atp->orig_datalen = aep->at_cmnd.cdb_dl.sf.fcp_cmnd_dl;
        atp->bytes_xfered = 0;
        atp->lun = lun;
        atp->nphdl = nphdl;
        atp->sid = sid;
        atp->did = did;
        atp->oxid = aep->at_hdr.ox_id;
        atp->rxid = aep->at_hdr.rx_id;
        atp->cdb0 = atiop->cdb_io.cdb_bytes[0];
        atp->tattr = aep->at_cmnd.fcp_cmnd_task_attribute & FCP_CMND_TASK_ATTR_MASK;
        atp->state = ATPD_STATE_CAM;
        isp_prt(isp, ISP_LOGTDEBUG0, "ATIO7[0x%x] CDB=0x%x lun %jx datalen %u",
            aep->at_rxid, atp->cdb0, (uintmax_t)lun, atp->orig_datalen);
        xpt_done((union ccb *)atiop);
        return;
noresrc:
        KASSERT(atp == NULL, ("%s: atp is not NULL on noresrc!\n", __func__));
        ntp = isp_get_ntpd(isp, chan);
        if (ntp == NULL) {
                isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_BUSY, 0);
                return;
        }
        memcpy(ntp->data, aep, QENTRY_LEN);
        STAILQ_INSERT_TAIL(&tptr->restart_queue, ntp, next);
}


/*
 * Handle starting an SRR (sequence retransmit request)
 * We get here when we've gotten the immediate notify
 * and the return of all outstanding CTIOs for this
 * transaction.
 */
static void
isp_handle_srr_start(ispsoftc_t *isp, atio_private_data_t *atp)
{
        in_fcentry_24xx_t *inot;
        uint32_t srr_off, ccb_off, ccb_len, ccb_end;
        union ccb *ccb;

        inot = (in_fcentry_24xx_t *)atp->srr;
        srr_off = inot->in_srr_reloff_lo | (inot->in_srr_reloff_hi << 16);
        ccb = atp->srr_ccb;
        atp->srr_ccb = NULL;
        atp->nsrr++;
        if (ccb == NULL) {
                isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] null ccb", atp->tag);
                goto fail;
        }

        ccb_off = ccb->ccb_h.spriv_field0;
        ccb_len = ccb->csio.dxfer_len;
        ccb_end = (ccb_off == ~0)? ~0 : ccb_off + ccb_len;

        switch (inot->in_srr_iu) {
        case R_CTL_INFO_SOLICITED_DATA:
                /*
                 * We have to restart a FCP_DATA data out transaction
                 */
                atp->sendst = 0;
                atp->bytes_xfered = srr_off;
                if (ccb_len == 0) {
                        isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] SRR offset 0x%x but current CCB doesn't transfer data", atp->tag, srr_off);
                        goto mdp;
                }
                if (srr_off < ccb_off || ccb_off > srr_off + ccb_len) {
                        isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] SRR offset 0x%x not covered by current CCB data range [0x%x..0x%x]", atp->tag, srr_off, ccb_off, ccb_end);
                        goto mdp;
                }
                isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] SRR offset 0x%x covered by current CCB data range [0x%x..0x%x]", atp->tag, srr_off, ccb_off, ccb_end);
                break;
        case R_CTL_INFO_COMMAND_STATUS:
                isp_prt(isp, ISP_LOGTINFO, "SRR[0x%x] Got an FCP RSP SRR- resending status", atp->tag);
                atp->sendst = 1;
                /*
                 * We have to restart a FCP_RSP IU transaction
                 */
                break;
        case R_CTL_INFO_DATA_DESCRIPTOR:
                /*
                 * We have to restart an FCP DATA in transaction
                 */
                isp_prt(isp, ISP_LOGWARN, "Got an FCP DATA IN SRR- dropping");
                goto fail;

        default:
                isp_prt(isp, ISP_LOGWARN, "Got an unknown information (%x) SRR- dropping", inot->in_srr_iu);
                goto fail;
        }

        /*
         * We can't do anything until this is acked, so we might as well start it now.
         * We aren't going to do the usual asynchronous ack issue because we need
         * to make sure this gets on the wire first.
         */
        if (isp_notify_ack(isp, inot)) {
                isp_prt(isp, ISP_LOGWARN, "could not push positive ack for SRR- you lose");
                goto fail;
        }
        isp_target_start_ctio(isp, ccb, FROM_SRR);
        return;
fail:
        inot->in_reserved = 1;
        isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
        ccb->ccb_h.status &= ~CAM_STATUS_MASK;
        ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
        isp_complete_ctio(isp, ccb);
        return;
mdp:
        if (isp_notify_ack(isp, inot)) {
                isp_prt(isp, ISP_LOGWARN, "could not push positive ack for SRR- you lose");
                goto fail;
        }
        ccb->ccb_h.status &= ~CAM_STATUS_MASK;
        ccb->ccb_h.status |= CAM_MESSAGE_RECV;
        /*
         * This is not a strict interpretation of MDP, but it's close
         */
        ccb->csio.msg_ptr = &ccb->csio.sense_data.sense_buf[SSD_FULL_SIZE - 16];
        ccb->csio.msg_len = 7;
        ccb->csio.msg_ptr[0] = MSG_EXTENDED;
        ccb->csio.msg_ptr[1] = 5;
        ccb->csio.msg_ptr[2] = 0;       /* modify data pointer */
        ccb->csio.msg_ptr[3] = srr_off >> 24;
        ccb->csio.msg_ptr[4] = srr_off >> 16;
        ccb->csio.msg_ptr[5] = srr_off >> 8;
        ccb->csio.msg_ptr[6] = srr_off;
        isp_complete_ctio(isp, ccb);
}


static void
isp_handle_platform_srr(ispsoftc_t *isp, isp_notify_t *notify)
{
        in_fcentry_24xx_t *inot = notify->nt_lreserved;
        atio_private_data_t *atp;
        uint32_t tag = notify->nt_tagval & 0xffffffff;

        atp = isp_find_atpd(isp, notify->nt_channel, tag);
        if (atp == NULL) {
                isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x in SRR Notify",
                    __func__, tag);
                isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
                return;
        }
        atp->srr_notify_rcvd = 1;
        memcpy(atp->srr, inot, sizeof (atp->srr));
        isp_prt(isp, ISP_LOGTINFO, "SRR[0x%x] flags 0x%x srr_iu %x reloff 0x%x",
            inot->in_rxid, inot->in_flags, inot->in_srr_iu,
            ((uint32_t)inot->in_srr_reloff_hi << 16) | inot->in_srr_reloff_lo);
        if (atp->srr_ccb)
                isp_handle_srr_start(isp, atp);
}

static void
isp_handle_platform_ctio(ispsoftc_t *isp, ct7_entry_t *ct)
{
        union ccb *ccb;
        int sentstatus = 0, ok = 0, notify_cam = 0, failure = 0;
        atio_private_data_t *atp = NULL;
        int bus;
        uint32_t handle, data_requested, resid;

        handle = ct->ct_syshandle;
        ccb = isp_find_xs(isp, handle);
        if (ccb == NULL) {
                isp_print_bytes(isp, "null ccb in isp_handle_platform_ctio", QENTRY_LEN, ct);
                return;
        }
        isp_destroy_handle(isp, handle);
        resid = data_requested = PISP_PCMD(ccb)->datalen;
        isp_free_pcmd(isp, ccb);

        bus = XS_CHANNEL(ccb);
        atp = isp_find_atpd(isp, bus, ct->ct_rxid);
        if (atp == NULL) {
                /*
                 * XXX: isp_clear_commands() generates fake CTIO with zero
                 * ct_rxid value, filling only ct_syshandle.  Workaround
                 * that using tag_id from the CCB, pointed by ct_syshandle.
                 */
                atp = isp_find_atpd(isp, bus, ccb->csio.tag_id);
        }
        if (atp == NULL) {
                isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x after I/O", __func__, ccb->csio.tag_id);
                return;
        }
        KASSERT((atp->ctcnt > 0), ("ctio count not greater than zero"));
        atp->bytes_in_transit -= data_requested;
        atp->ctcnt -= 1;
        ccb->ccb_h.status &= ~CAM_STATUS_MASK;

        if (ct->ct_nphdl == CT7_SRR) {
                atp->srr_ccb = ccb;
                if (atp->srr_notify_rcvd)
                        isp_handle_srr_start(isp, atp);
                return;
        }
        if (ct->ct_nphdl == CT_HBA_RESET) {
                sentstatus = (ccb->ccb_h.flags & CAM_SEND_STATUS) &&
                    (atp->sendst == 0);
                failure = CAM_UNREC_HBA_ERROR;
        } else {
                sentstatus = ct->ct_flags & CT7_SENDSTATUS;
                ok = (ct->ct_nphdl == CT7_OK);
                notify_cam = (ct->ct_header.rqs_seqno & ATPD_SEQ_NOTIFY_CAM) != 0;
                if ((ct->ct_flags & CT7_DATAMASK) != CT7_NO_DATA)
                        resid = ct->ct_resid;
        }
        isp_prt(isp, ok? ISP_LOGTDEBUG0 : ISP_LOGWARN, "%s: CTIO7[%x] seq %u nc %d sts 0x%x flg 0x%x sns %d resid %d %s", __func__, ct->ct_rxid, ATPD_GET_SEQNO(ct),
           notify_cam, ct->ct_nphdl, ct->ct_flags, (ccb->ccb_h.status & CAM_SENT_SENSE) != 0, resid, sentstatus? "FIN" : "MID");
        if (ok) {
                if (data_requested > 0) {
                        atp->bytes_xfered += data_requested - resid;
                        ccb->csio.resid = ccb->csio.dxfer_len -
                            (data_requested - resid);
                }
                if (sentstatus && (ccb->ccb_h.flags & CAM_SEND_SENSE))
                        ccb->ccb_h.status |= CAM_SENT_SENSE;
                ccb->ccb_h.status |= CAM_REQ_CMP;
        } else {
                notify_cam = 1;
                if (failure == CAM_UNREC_HBA_ERROR)
                        ccb->ccb_h.status |= CAM_UNREC_HBA_ERROR;
                else
                        ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
        }
        atp->state = ATPD_STATE_PDON;

        /*
         * We never *not* notify CAM when there has been any error (ok == 0),
         * so we never need to do an ATIO putback if we're not notifying CAM.
         */
        isp_prt(isp, ISP_LOGTDEBUG0, "%s CTIO[0x%x] done (ok=%d nc=%d nowsendstatus=%d ccb ss=%d)",
            (sentstatus)? "  FINAL " : "MIDTERM ", atp->tag, ok, notify_cam, atp->sendst, (ccb->ccb_h.flags & CAM_SEND_STATUS) != 0);
        if (notify_cam == 0) {
                if (atp->sendst) {
                        isp_target_start_ctio(isp, ccb, FROM_CTIO_DONE);
                }
                return;
        }

        /*
         * We are done with this ATIO if we successfully sent status.
         * In all other cases expect either another CTIO or XPT_ABORT.
         */
        if (ok && sentstatus)
                isp_put_atpd(isp, bus, atp);

        /*
         * We're telling CAM we're done with this CTIO transaction.
         *
         * 24XX cards never need an ATIO put back.
         */
        isp_complete_ctio(isp, ccb);
}

static int
isp_handle_platform_target_notify_ack(ispsoftc_t *isp, isp_notify_t *mp, uint32_t rsp)
{
        ct7_entry_t local, *cto = &local;

        if (isp->isp_state != ISP_RUNSTATE) {
                isp_prt(isp, ISP_LOGTINFO, "Notify Code 0x%x (qevalid=%d) acked- h/w not ready (dropping)", mp->nt_ncode, mp->nt_lreserved != NULL);
                return (0);
        }

        /*
         * This case is for a Task Management Function, which shows up as an ATIO7 entry.
         */
        if (mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ATIO) {
                at7_entry_t *aep = (at7_entry_t *)mp->nt_lreserved;
                fcportdb_t *lp;
                uint32_t sid;
                uint16_t nphdl;

                sid = (aep->at_hdr.s_id[0] << 16) | (aep->at_hdr.s_id[1] << 8) | aep->at_hdr.s_id[2];
                if (isp_find_pdb_by_portid(isp, mp->nt_channel, sid, &lp)) {
                        nphdl = lp->handle;
                } else {
                        nphdl = NIL_HANDLE;
                }
                ISP_MEMZERO(cto, sizeof (ct7_entry_t));
                cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
                cto->ct_header.rqs_entry_count = 1;
                cto->ct_nphdl = nphdl;
                cto->ct_rxid = aep->at_rxid;
                cto->ct_vpidx = mp->nt_channel;
                cto->ct_iid_lo = sid;
                cto->ct_iid_hi = sid >> 16;
                cto->ct_oxid = aep->at_hdr.ox_id;
                cto->ct_flags = CT7_SENDSTATUS|CT7_NOACK|CT7_NO_DATA|CT7_FLAG_MODE1;
                cto->ct_flags |= (aep->at_ta_len >> 12) << CT7_TASK_ATTR_SHIFT;
                if (rsp != 0) {
                        cto->ct_scsi_status |= (FCP_RSPLEN_VALID << 8);
                        cto->rsp.m1.ct_resplen = 4;
                        ISP_MEMZERO(cto->rsp.m1.ct_resp, sizeof (cto->rsp.m1.ct_resp));
                        cto->rsp.m1.ct_resp[0] = rsp & 0xff;
                        cto->rsp.m1.ct_resp[1] = (rsp >> 8) & 0xff;
                        cto->rsp.m1.ct_resp[2] = (rsp >> 16) & 0xff;
                        cto->rsp.m1.ct_resp[3] = (rsp >> 24) & 0xff;
                }
                return (isp_send_entry(isp, cto));
        }

        /*
         * This case is for a responding to an ABTS frame
         */
        if (mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD)
                return (isp_acknak_abts(isp, mp->nt_lreserved, (rsp == 0) ? 0 : EINVAL));

        /*
         * General purpose acknowledgement
         */
        if (mp->nt_need_ack) {
                isp_prt(isp, ISP_LOGTINFO, "Notify Code 0x%x (qevalid=%d) being acked", mp->nt_ncode, mp->nt_lreserved != NULL);
                /*
                 * Don't need to use the guaranteed send because the caller can retry
                 */
                return (isp_notify_ack(isp, mp->nt_lreserved));
        }
        return (0);
}

/*
 * Handle task management functions.
 *
 * We show up here with a notify structure filled out.
 *
 * The nt_lreserved tag points to the original queue entry
 */
static void
isp_handle_platform_target_tmf(ispsoftc_t *isp, isp_notify_t *notify)
{
        tstate_t *tptr;
        fcportdb_t *lp;
        struct ccb_immediate_notify *inot;
        inot_private_data_t *ntp = NULL;
        atio_private_data_t *atp;
        lun_id_t lun;

        isp_prt(isp, ISP_LOGTDEBUG0, "%s: code 0x%x sid  0x%x tagval 0x%016llx chan %d lun %jx", __func__, notify->nt_ncode,
            notify->nt_sid, (unsigned long long) notify->nt_tagval, notify->nt_channel, notify->nt_lun);
        if (notify->nt_lun == LUN_ANY) {
                if (notify->nt_tagval == TAG_ANY) {
                        lun = CAM_LUN_WILDCARD;
                } else {
                        atp = isp_find_atpd(isp, notify->nt_channel,
                            notify->nt_tagval & 0xffffffff);
                        lun = atp ? atp->lun : CAM_LUN_WILDCARD;
                }
        } else {
                lun = notify->nt_lun;
        }
        tptr = get_lun_statep(isp, notify->nt_channel, lun);
        if (tptr == NULL) {
                tptr = get_lun_statep(isp, notify->nt_channel, CAM_LUN_WILDCARD);
                if (tptr == NULL) {
                        isp_prt(isp, ISP_LOGWARN, "%s: no state pointer found for chan %d lun %#jx", __func__, notify->nt_channel, (uintmax_t)lun);
                        goto bad;
                }
        }
        inot = (struct ccb_immediate_notify *) SLIST_FIRST(&tptr->inots);
        if (inot == NULL) {
                isp_prt(isp, ISP_LOGWARN, "%s: out of immediate notify structures for chan %d lun %#jx", __func__, notify->nt_channel, (uintmax_t)lun);
                goto bad;
        }

        inot->ccb_h.target_id = ISP_MAX_TARGETS(isp);
        inot->ccb_h.target_lun = lun;
        if (isp_find_pdb_by_portid(isp, notify->nt_channel, notify->nt_sid, &lp) == 0 &&
            isp_find_pdb_by_handle(isp, notify->nt_channel, notify->nt_nphdl, &lp) == 0) {
                inot->initiator_id = CAM_TARGET_WILDCARD;
        } else {
                inot->initiator_id = FC_PORTDB_TGT(isp, notify->nt_channel, lp);
        }
        inot->seq_id = notify->nt_tagval;
        inot->tag_id = notify->nt_tagval >> 32;

        switch (notify->nt_ncode) {
        case NT_ABORT_TASK:
                isp_target_mark_aborted_early(isp, notify->nt_channel, tptr, inot->tag_id);
                inot->arg = MSG_ABORT_TASK;
                break;
        case NT_ABORT_TASK_SET:
                isp_target_mark_aborted_early(isp, notify->nt_channel, tptr, TAG_ANY);
                inot->arg = MSG_ABORT_TASK_SET;
                break;
        case NT_CLEAR_ACA:
                inot->arg = MSG_CLEAR_ACA;
                break;
        case NT_CLEAR_TASK_SET:
                inot->arg = MSG_CLEAR_TASK_SET;
                break;
        case NT_LUN_RESET:
                inot->arg = MSG_LOGICAL_UNIT_RESET;
                break;
        case NT_TARGET_RESET:
                inot->arg = MSG_TARGET_RESET;
                break;
        case NT_QUERY_TASK_SET:
                inot->arg = MSG_QUERY_TASK_SET;
                break;
        case NT_QUERY_ASYNC_EVENT:
                inot->arg = MSG_QUERY_ASYNC_EVENT;
                break;
        default:
                isp_prt(isp, ISP_LOGWARN, "%s: unknown TMF code 0x%x for chan %d lun %#jx", __func__, notify->nt_ncode, notify->nt_channel, (uintmax_t)lun);
                goto bad;
        }

        ntp = isp_get_ntpd(isp, notify->nt_channel);
        if (ntp == NULL) {
                isp_prt(isp, ISP_LOGWARN, "%s: out of inotify private structures", __func__);
                goto bad;
        }
        ISP_MEMCPY(&ntp->nt, notify, sizeof (isp_notify_t));
        if (notify->nt_lreserved) {
                ISP_MEMCPY(&ntp->data, notify->nt_lreserved, QENTRY_LEN);
                ntp->nt.nt_lreserved = &ntp->data;
        }
        ntp->seq_id = notify->nt_tagval;
        ntp->tag_id = notify->nt_tagval >> 32;

        SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
        ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, inot->ccb_h.path, "Take FREE INOT\n");
        inot->ccb_h.status = CAM_MESSAGE_RECV;
        xpt_done((union ccb *)inot);
        return;
bad:
        if (notify->nt_need_ack) {
                if (((isphdr_t *)notify->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD) {
                        if (isp_acknak_abts(isp, notify->nt_lreserved, ENOMEM)) {
                                isp_prt(isp, ISP_LOGWARN, "you lose- unable to send an ACKNAK");
                        }
                } else {
                        isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, notify->nt_lreserved);
                }
        }
}

/*
 * Clean aborted commands pending restart
 */
static void
isp_target_mark_aborted_early(ispsoftc_t *isp, int chan, tstate_t *tptr, uint32_t tag_id)
{
        inot_private_data_t *ntp, *tmp;
        uint32_t this_tag_id;

        STAILQ_FOREACH_SAFE(ntp, &tptr->restart_queue, next, tmp) {
                this_tag_id = ((at7_entry_t *)ntp->data)->at_rxid;
                if ((uint64_t)tag_id == TAG_ANY || tag_id == this_tag_id) {
                        STAILQ_REMOVE(&tptr->restart_queue, ntp,
                            inot_private_data, next);
                        isp_endcmd(isp, ntp->data, NIL_HANDLE, chan,
                            ECMD_TERMINATE, 0);
                        isp_put_ntpd(isp, chan, ntp);
                }
        }
}
#endif

static void
isp_poll(struct cam_sim *sim)
{
        ispsoftc_t *isp = cam_sim_softc(sim);

        ISP_RUN_ISR(isp);
}


static void
isp_watchdog(void *arg)
{
        struct ccb_scsiio *xs = arg;
        ispsoftc_t *isp;
        uint32_t ohandle = ISP_HANDLE_FREE, handle;

        isp = XS_ISP(xs);

        handle = isp_find_handle(isp, xs);

        /*
         * Hand crank the interrupt code just to be sure the command isn't stuck somewhere.
         */
        if (handle != ISP_HANDLE_FREE) {
                ISP_RUN_ISR(isp);
                ohandle = handle;
                handle = isp_find_handle(isp, xs);
        }
        if (handle != ISP_HANDLE_FREE) {
                /*
                 * Try and make sure the command is really dead before
                 * we release the handle (and DMA resources) for reuse.
                 *
                 * If we are successful in aborting the command then
                 * we're done here because we'll get the command returned
                 * back separately.
                 */
                if (isp_control(isp, ISPCTL_ABORT_CMD, xs) == 0) {
                        return;
                }

                /*
                 * Note that after calling the above, the command may in
                 * fact have been completed.
                 */
                xs = isp_find_xs(isp, handle);

                /*
                 * If the command no longer exists, then we won't
                 * be able to find the xs again with this handle.
                 */
                if (xs == NULL) {
                        return;
                }

                /*
                 * After this point, the command is really dead.
                 */
                ISP_DMAFREE(isp, xs);
                isp_destroy_handle(isp, handle);
                isp_prt(isp, ISP_LOGERR, "%s: timeout for handle 0x%x", __func__, handle);
                XS_SETERR(xs, CAM_CMD_TIMEOUT);
                isp_done(xs);
        } else {
                if (ohandle != ISP_HANDLE_FREE) {
                        isp_prt(isp, ISP_LOGWARN, "%s: timeout for handle 0x%x, recovered during interrupt", __func__, ohandle);
                } else {
                        isp_prt(isp, ISP_LOGWARN, "%s: timeout for handle already free", __func__);
                }
        }
}

static void
isp_make_here(ispsoftc_t *isp, fcportdb_t *fcp, int chan, int tgt)
{
        union ccb *ccb;
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        /*
         * Allocate a CCB, create a wildcard path for this target and schedule a rescan.
         */
        ccb = xpt_alloc_ccb_nowait();
        if (ccb == NULL) {
                isp_prt(isp, ISP_LOGWARN, "Chan %d unable to alloc CCB for rescan", chan);
                return;
        }
        if (xpt_create_path(&ccb->ccb_h.path, NULL, cam_sim_path(fc->sim),
            tgt, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
                isp_prt(isp, ISP_LOGWARN, "unable to create path for rescan");
                xpt_free_ccb(ccb);
                return;
        }
        xpt_rescan(ccb);
}

static void
isp_make_gone(ispsoftc_t *isp, fcportdb_t *fcp, int chan, int tgt)
{
        struct cam_path *tp;
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        if (xpt_create_path(&tp, NULL, cam_sim_path(fc->sim), tgt, CAM_LUN_WILDCARD) == CAM_REQ_CMP) {
                xpt_async(AC_LOST_DEVICE, tp, NULL);
                xpt_free_path(tp);
        }
}

/*
 * Gone Device Timer Function- when we have decided that a device has gone
 * away, we wait a specific period of time prior to telling the OS it has
 * gone away.
 *
 * This timer function fires once a second and then scans the port database
 * for devices that are marked dead but still have a virtual target assigned.
 * We decrement a counter for that port database entry, and when it hits zero,
 * we tell the OS the device has gone away.
 */
static void
isp_gdt(void *arg)
{
        struct isp_fc *fc = arg;
        taskqueue_enqueue(taskqueue_thread, &fc->gtask);
}

static void
isp_gdt_task(void *arg, int pending)
{
        struct isp_fc *fc = arg;
        ispsoftc_t *isp = fc->isp;
        int chan = fc - ISP_FC_PC(isp, 0);
        fcportdb_t *lp;
        struct ac_contract ac;
        struct ac_device_changed *adc;
        int dbidx, more_to_do = 0;

        ISP_LOCK(isp);
        isp_prt(isp, ISP_LOGDEBUG0, "Chan %d GDT timer expired", chan);
        for (dbidx = 0; dbidx < MAX_FC_TARG; dbidx++) {
                lp = &FCPARAM(isp, chan)->portdb[dbidx];

                if (lp->state != FC_PORTDB_STATE_ZOMBIE) {
                        continue;
                }
                if (lp->gone_timer != 0) {
                        lp->gone_timer -= 1;
                        more_to_do++;
                        continue;
                }
                isp_prt(isp, ISP_LOGCONFIG, prom3, chan, dbidx, lp->portid, "Gone Device Timeout");
                if (lp->is_target) {
                        lp->is_target = 0;
                        isp_make_gone(isp, lp, chan, dbidx);
                }
                if (lp->is_initiator) {
                        lp->is_initiator = 0;
                        ac.contract_number = AC_CONTRACT_DEV_CHG;
                        adc = (struct ac_device_changed *) ac.contract_data;
                        adc->wwpn = lp->port_wwn;
                        adc->port = lp->portid;
                        adc->target = dbidx;
                        adc->arrived = 0;
                        xpt_async(AC_CONTRACT, fc->path, &ac);
                }
                lp->state = FC_PORTDB_STATE_NIL;
        }
        if (fc->ready) {
                if (more_to_do) {
                        callout_reset(&fc->gdt, hz, isp_gdt, fc);
                } else {
                        callout_deactivate(&fc->gdt);
                        isp_prt(isp, ISP_LOG_SANCFG, "Chan %d Stopping Gone Device Timer @ %lu", chan, (unsigned long) time_uptime);
                }
        }
        ISP_UNLOCK(isp);
}

/*
 * When loop goes down we remember the time and freeze CAM command queue.
 * During some time period we are trying to reprobe the loop.  But if we
 * fail, we tell the OS that devices have gone away and drop the freeze.
 *
 * We don't clear the devices out of our port database because, when loop
 * come back up, we have to do some actual cleanup with the chip at that
 * point (implicit PLOGO, e.g., to get the chip's port database state right).
 */
static void
isp_loop_changed(ispsoftc_t *isp, int chan)
{
        fcparam *fcp = FCPARAM(isp, chan);
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        if (fc->loop_down_time)
                return;
        isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Loop changed", chan);
        if (fcp->role & ISP_ROLE_INITIATOR)
                isp_freeze_loopdown(isp, chan);
        fc->loop_down_time = time_uptime;
        wakeup(fc);
}

static void
isp_loop_up(ispsoftc_t *isp, int chan)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Loop is up", chan);
        fc->loop_seen_once = 1;
        fc->loop_down_time = 0;
        isp_unfreeze_loopdown(isp, chan);
}

static void
isp_loop_dead(ispsoftc_t *isp, int chan)
{
        fcparam *fcp = FCPARAM(isp, chan);
        struct isp_fc *fc = ISP_FC_PC(isp, chan);
        fcportdb_t *lp;
        struct ac_contract ac;
        struct ac_device_changed *adc;
        int dbidx, i;

        isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Loop is dead", chan);

        /*
         * Notify to the OS all targets who we now consider have departed.
         */
        for (dbidx = 0; dbidx < MAX_FC_TARG; dbidx++) {
                lp = &fcp->portdb[dbidx];

                if (lp->state == FC_PORTDB_STATE_NIL)
                        continue;

                for (i = 0; i < ISP_HANDLE_NUM(isp); i++) {
                        struct ccb_scsiio *xs;

                        if (ISP_H2HT(isp->isp_xflist[i].handle) != ISP_HANDLE_INITIATOR) {
                                continue;
                        }
                        if ((xs = isp->isp_xflist[i].cmd) == NULL) {
                                continue;
                        }
                        if (dbidx != XS_TGT(xs)) {
                                continue;
                        }
                        isp_prt(isp, ISP_LOGWARN, "command handle 0x%x for %d.%d.%jx orphaned by loop down timeout",
                            isp->isp_xflist[i].handle, chan, XS_TGT(xs),
                            (uintmax_t)XS_LUN(xs));

                        /*
                         * Just like in isp_watchdog, abort the outstanding
                         * command or immediately free its resources if it is
                         * not active
                         */
                        if (isp_control(isp, ISPCTL_ABORT_CMD, xs) == 0) {
                                continue;
                        }

                        ISP_DMAFREE(isp, xs);
                        isp_destroy_handle(isp, isp->isp_xflist[i].handle);
                        isp_prt(isp, ISP_LOGWARN, "command handle 0x%x for %d.%d.%jx could not be aborted and was destroyed",
                            isp->isp_xflist[i].handle, chan, XS_TGT(xs),
                            (uintmax_t)XS_LUN(xs));
                        XS_SETERR(xs, HBA_BUSRESET);
                        isp_done(xs);
                }

                isp_prt(isp, ISP_LOGCONFIG, prom3, chan, dbidx, lp->portid, "Loop Down Timeout");
                if (lp->is_target) {
                        lp->is_target = 0;
                        isp_make_gone(isp, lp, chan, dbidx);
                }
                if (lp->is_initiator) {
                        lp->is_initiator = 0;
                        ac.contract_number = AC_CONTRACT_DEV_CHG;
                        adc = (struct ac_device_changed *) ac.contract_data;
                        adc->wwpn = lp->port_wwn;
                        adc->port = lp->portid;
                        adc->target = dbidx;
                        adc->arrived = 0;
                        xpt_async(AC_CONTRACT, fc->path, &ac);
                }
        }

        isp_unfreeze_loopdown(isp, chan);
        fc->loop_down_time = 0;
}

static void
isp_kthread(void *arg)
{
        struct isp_fc *fc = arg;
        ispsoftc_t *isp = fc->isp;
        int chan = fc - ISP_FC_PC(isp, 0);
        int slp = 0, d;
        int lb, lim;

        ISP_LOCK(isp);
        while (isp->isp_osinfo.is_exiting == 0) {
                isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0,
                    "Chan %d Checking FC state", chan);
                lb = isp_fc_runstate(isp, chan, 250000);
                isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0,
                    "Chan %d FC got to %s state", chan,
                    isp_fc_loop_statename(lb));

                /*
                 * Our action is different based upon whether we're supporting
                 * Initiator mode or not. If we are, we might freeze the simq
                 * when loop is down and set all sorts of different delays to
                 * check again.
                 *
                 * If not, we simply just wait for loop to come up.
                 */
                if (lb == LOOP_READY || lb < 0) {
                        slp = 0;
                } else {
                        /*
                         * If we've never seen loop up and we've waited longer
                         * than quickboot time, or we've seen loop up but we've
                         * waited longer than loop_down_limit, give up and go
                         * to sleep until loop comes up.
                         */
                        if (fc->loop_seen_once == 0)
                                lim = isp_quickboot_time;
                        else
                                lim = fc->loop_down_limit;
                        d = time_uptime - fc->loop_down_time;
                        if (d >= lim)
                                slp = 0;
                        else if (d < 10)
                                slp = 1;
                        else if (d < 30)
                                slp = 5;
                        else if (d < 60)
                                slp = 10;
                        else if (d < 120)
                                slp = 20;
                        else
                                slp = 30;
                }

                if (slp == 0) {
                        if (lb == LOOP_READY)
                                isp_loop_up(isp, chan);
                        else
                                isp_loop_dead(isp, chan);
                }

                isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0,
                    "Chan %d sleep for %d seconds", chan, slp);
                msleep(fc, &isp->isp_lock, PRIBIO, "ispf", slp * hz);
        }
        fc->num_threads -= 1;
        wakeup(&fc->num_threads);
        ISP_UNLOCK(isp);
        kthread_exit();
}

#ifdef  ISP_TARGET_MODE
static int
isp_abort_atpd(ispsoftc_t *isp, int chan, atio_private_data_t *atp)
{
        uint8_t storage[QENTRY_LEN];
        ct7_entry_t *cto = (ct7_entry_t *) storage;

        ISP_MEMZERO(cto, sizeof (ct7_entry_t));
        cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
        cto->ct_header.rqs_entry_count = 1;
        cto->ct_nphdl = atp->nphdl;
        cto->ct_vpidx = chan;
        cto->ct_iid_lo = atp->sid;
        cto->ct_iid_hi = atp->sid >> 16;
        cto->ct_rxid = atp->tag;
        cto->ct_flags = CT7_NOACK|CT7_TERMINATE;
        cto->ct_oxid = atp->oxid;
        return (isp_send_entry(isp, cto));
}

static void
isp_abort_atio(ispsoftc_t *isp, union ccb *ccb)
{
        atio_private_data_t *atp;
        union ccb *accb = ccb->cab.abort_ccb;
        struct ccb_hdr *sccb;
        tstate_t *tptr;

        tptr = get_lun_statep(isp, XS_CHANNEL(accb), XS_LUN(accb));
        if (tptr != NULL) {
                /* Search for the ATIO among queueued. */
                SLIST_FOREACH(sccb, &tptr->atios, sim_links.sle) {
                        if (sccb != &accb->ccb_h)
                                continue;
                        SLIST_REMOVE(&tptr->atios, sccb, ccb_hdr, sim_links.sle);
                        ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, sccb->path,
                            "Abort FREE ATIO\n");
                        accb->ccb_h.status = CAM_REQ_ABORTED;
                        xpt_done(accb);
                        ccb->ccb_h.status = CAM_REQ_CMP;
                        return;
                }
        }

        /* Search for the ATIO among running. */
        atp = isp_find_atpd_ccb(isp, XS_CHANNEL(accb), accb->atio.tag_id, accb);
        if (atp != NULL) {
                if (isp_abort_atpd(isp, XS_CHANNEL(accb), atp)) {
                        ccb->ccb_h.status = CAM_UA_ABORT;
                        return;
                }
                isp_put_atpd(isp, XS_CHANNEL(accb), atp);
        }

        ccb->ccb_h.status = CAM_REQ_CMP;
}

static void
isp_abort_inot(ispsoftc_t *isp, union ccb *ccb)
{
        inot_private_data_t *ntp;
        union ccb *accb = ccb->cab.abort_ccb;
        struct ccb_hdr *sccb;
        tstate_t *tptr;

        tptr = get_lun_statep(isp, XS_CHANNEL(accb), XS_LUN(accb));
        if (tptr != NULL) {
                /* Search for the INOT among queueued. */
                SLIST_FOREACH(sccb, &tptr->inots, sim_links.sle) {
                        if (sccb != &accb->ccb_h)
                                continue;
                        SLIST_REMOVE(&tptr->inots, sccb, ccb_hdr, sim_links.sle);
                        ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, sccb->path,
                            "Abort FREE INOT\n");
                        accb->ccb_h.status = CAM_REQ_ABORTED;
                        xpt_done(accb);
                        ccb->ccb_h.status = CAM_REQ_CMP;
                        return;
                }
        }

        /* Search for the INOT among running. */
        ntp = isp_find_ntpd(isp, XS_CHANNEL(accb), accb->cin1.tag_id, accb->cin1.seq_id);
        if (ntp != NULL) {
                if (ntp->nt.nt_need_ack) {
                        isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK,
                            ntp->nt.nt_lreserved);
                }
                isp_put_ntpd(isp, XS_CHANNEL(accb), ntp);
                ccb->ccb_h.status = CAM_REQ_CMP;
        } else {
                ccb->ccb_h.status = CAM_UA_ABORT;
                return;
        }
}
#endif

static void
isp_action(struct cam_sim *sim, union ccb *ccb)
{
        int bus, tgt, error;
        ispsoftc_t *isp;
        fcparam *fcp;
        struct ccb_trans_settings *cts;
        sbintime_t ts;

        CAM_DEBUG(ccb->ccb_h.path, CAM_DEBUG_TRACE, ("isp_action\n"));

        isp = (ispsoftc_t *)cam_sim_softc(sim);
        ISP_ASSERT_LOCKED(isp);
        bus = cam_sim_bus(sim);
        isp_prt(isp, ISP_LOGDEBUG2, "isp_action code %x", ccb->ccb_h.func_code);
        ISP_PCMD(ccb) = NULL;

        switch (ccb->ccb_h.func_code) {
        case XPT_SCSI_IO:       /* Execute the requested I/O operation */
                /*
                 * Do a couple of preliminary checks...
                 */
                if ((ccb->ccb_h.flags & CAM_CDB_POINTER) != 0) {
                        if ((ccb->ccb_h.flags & CAM_CDB_PHYS) != 0) {
                                ccb->ccb_h.status = CAM_REQ_INVALID;
                                isp_done((struct ccb_scsiio *) ccb);
                                break;
                        }
                }
#ifdef  DIAGNOSTIC
                if (ccb->ccb_h.target_id >= ISP_MAX_TARGETS(isp)) {
                        xpt_print(ccb->ccb_h.path, "invalid target\n");
                        ccb->ccb_h.status = CAM_PATH_INVALID;
                }
                if (ccb->ccb_h.status == CAM_PATH_INVALID) {
                        xpt_done(ccb);
                        break;
                }
#endif
                ccb->csio.scsi_status = SCSI_STATUS_OK;
                if (isp_get_pcmd(isp, ccb)) {
                        isp_prt(isp, ISP_LOGWARN, "out of PCMDs");
                        cam_freeze_devq(ccb->ccb_h.path);
                        cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 250, 0);
                        ccb->ccb_h.status = CAM_REQUEUE_REQ;
                        xpt_done(ccb);
                        break;
                }
                error = isp_start((XS_T *) ccb);
                isp_rq_check_above(isp);
                switch (error) {
                case 0:
                        ccb->ccb_h.status |= CAM_SIM_QUEUED;
                        if (ccb->ccb_h.timeout == CAM_TIME_INFINITY)
                                break;
                        /* Give firmware extra 10s to handle timeout. */
                        ts = SBT_1MS * ccb->ccb_h.timeout + 10 * SBT_1S;
                        callout_reset_sbt(&PISP_PCMD(ccb)->wdog, ts, 0,
                            isp_watchdog, ccb, 0);
                        break;
                case CMD_RQLATER:
                        isp_prt(isp, ISP_LOGDEBUG0, "%d.%jx retry later",
                            XS_TGT(ccb), (uintmax_t)XS_LUN(ccb));
                        cam_freeze_devq(ccb->ccb_h.path);
                        cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 1000, 0);
                        ccb->ccb_h.status = CAM_REQUEUE_REQ;
                        isp_free_pcmd(isp, ccb);
                        xpt_done(ccb);
                        break;
                case CMD_EAGAIN:
                        isp_free_pcmd(isp, ccb);
                        cam_freeze_devq(ccb->ccb_h.path);
                        cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 10, 0);
                        ccb->ccb_h.status = CAM_REQUEUE_REQ;
                        xpt_done(ccb);
                        break;
                case CMD_COMPLETE:
                        isp_done((struct ccb_scsiio *) ccb);
                        break;
                default:
                        isp_prt(isp, ISP_LOGERR, "What's this? 0x%x at %d in file %s", error, __LINE__, __FILE__);
                        ccb->ccb_h.status = CAM_REQUEUE_REQ;
                        isp_free_pcmd(isp, ccb);
                        xpt_done(ccb);
                }
                break;

#ifdef  ISP_TARGET_MODE
        case XPT_EN_LUN:                /* Enable/Disable LUN as a target */
                if (ccb->cel.enable) {
                        isp_enable_lun(isp, ccb);
                } else {
                        isp_disable_lun(isp, ccb);
                }
                break;
        case XPT_IMMEDIATE_NOTIFY:      /* Add Immediate Notify Resource */
        case XPT_ACCEPT_TARGET_IO:      /* Add Accept Target IO Resource */
        {
                tstate_t *tptr = get_lun_statep(isp, XS_CHANNEL(ccb), ccb->ccb_h.target_lun);
                if (tptr == NULL) {
                        const char *str;

                        if (ccb->ccb_h.func_code == XPT_IMMEDIATE_NOTIFY)
                                str = "XPT_IMMEDIATE_NOTIFY";
                        else
                                str = "XPT_ACCEPT_TARGET_IO";
                        ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path,
                            "%s: no state pointer found for %s\n",
                            __func__, str);
                        ccb->ccb_h.status = CAM_DEV_NOT_THERE;
                        xpt_done(ccb);
                        break;
                }

                if (ccb->ccb_h.func_code == XPT_ACCEPT_TARGET_IO) {
                        ccb->atio.tag_id = 0;
                        SLIST_INSERT_HEAD(&tptr->atios, &ccb->ccb_h, sim_links.sle);
                        ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, ccb->ccb_h.path,
                            "Put FREE ATIO\n");
                } else if (ccb->ccb_h.func_code == XPT_IMMEDIATE_NOTIFY) {
                        ccb->cin1.seq_id = ccb->cin1.tag_id = 0;
                        SLIST_INSERT_HEAD(&tptr->inots, &ccb->ccb_h, sim_links.sle);
                        ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, ccb->ccb_h.path,
                            "Put FREE INOT\n");
                }
                ccb->ccb_h.status = CAM_REQ_INPROG;
                break;
        }
        case XPT_NOTIFY_ACKNOWLEDGE:            /* notify ack */
        {
                atio_private_data_t *atp;
                inot_private_data_t *ntp;

                /*
                 * XXX: Because we cannot guarantee that the path information in the notify acknowledge ccb
                 * XXX: matches that for the immediate notify, we have to *search* for the notify structure
                 */
                /*
                 * All the relevant path information is in the associated immediate notify
                 */
                ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: [0x%x] NOTIFY ACKNOWLEDGE for 0x%x seen\n", __func__, ccb->cna2.tag_id, ccb->cna2.seq_id);
                ntp = isp_find_ntpd(isp, XS_CHANNEL(ccb), ccb->cna2.tag_id, ccb->cna2.seq_id);
                if (ntp == NULL) {
                        ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "%s: [0x%x] XPT_NOTIFY_ACKNOWLEDGE of 0x%x cannot find ntp private data\n", __func__,
                             ccb->cna2.tag_id, ccb->cna2.seq_id);
                        ccb->ccb_h.status = CAM_DEV_NOT_THERE;
                        xpt_done(ccb);
                        break;
                }

                /*
                 * Target should abort all affected tasks before ACK-ing INOT,
                 * but if/since it doesn't, add this hack to allow tag reuse.
                 * We can not do it if some CTIOs are in progress, or we won't
                 * handle the completions.  In such case just block new ones.
                 */
                uint32_t rsp = (ccb->ccb_h.flags & CAM_SEND_STATUS) ? ccb->cna2.arg : 0;
                if (ntp->nt.nt_ncode == NT_ABORT_TASK && (rsp & 0xff) == 0 &&
                    (atp = isp_find_atpd(isp, XS_CHANNEL(ccb), ccb->cna2.seq_id)) != NULL) {
                        if (atp->ctcnt == 0 &&
                            isp_abort_atpd(isp, XS_CHANNEL(ccb), atp) == 0)
                                isp_put_atpd(isp, XS_CHANNEL(ccb), atp);
                        else
                                atp->dead = 1;
                }

                if (isp_handle_platform_target_notify_ack(isp, &ntp->nt, rsp)) {
                        cam_freeze_devq(ccb->ccb_h.path);
                        cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 10, 0);
                        ccb->ccb_h.status &= ~CAM_STATUS_MASK;
                        ccb->ccb_h.status |= CAM_REQUEUE_REQ;
                        break;
                }
                isp_put_ntpd(isp, XS_CHANNEL(ccb), ntp);
                ccb->ccb_h.status = CAM_REQ_CMP;
                ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: [0x%x] calling xpt_done for tag 0x%x\n", __func__, ccb->cna2.tag_id, ccb->cna2.seq_id);
                xpt_done(ccb);
                break;
        }
        case XPT_CONT_TARGET_IO:
                isp_target_start_ctio(isp, ccb, FROM_CAM);
                isp_rq_check_above(isp);
                break;
#endif
        case XPT_RESET_DEV:             /* BDR the specified SCSI device */
                tgt = ccb->ccb_h.target_id;
                tgt |= (bus << 16);

                error = isp_control(isp, ISPCTL_RESET_DEV, bus, tgt);
                if (error) {
                        ccb->ccb_h.status = CAM_REQ_CMP_ERR;
                } else {
                        /*
                         * If we have a FC device, reset the Command
                         * Reference Number, because the target will expect
                         * that we re-start the CRN at 1 after a reset.
                         */
                        isp_fcp_reset_crn(isp, bus, tgt, /*tgt_set*/ 1);

                        ccb->ccb_h.status = CAM_REQ_CMP;
                }
                xpt_done(ccb);
                break;
        case XPT_ABORT:                 /* Abort the specified CCB */
        {
                union ccb *accb = ccb->cab.abort_ccb;
                switch (accb->ccb_h.func_code) {
#ifdef  ISP_TARGET_MODE
                case XPT_ACCEPT_TARGET_IO:
                        isp_abort_atio(isp, ccb);
                        break;
                case XPT_IMMEDIATE_NOTIFY:
                        isp_abort_inot(isp, ccb);
                        break;
#endif
                case XPT_SCSI_IO:
                        error = isp_control(isp, ISPCTL_ABORT_CMD, accb);
                        if (error) {
                                ccb->ccb_h.status = CAM_UA_ABORT;
                        } else {
                                ccb->ccb_h.status = CAM_REQ_CMP;
                        }
                        break;
                default:
                        ccb->ccb_h.status = CAM_REQ_INVALID;
                        break;
                }
                /*
                 * This is not a queued CCB, so the caller expects it to be
                 * complete when control is returned.
                 */
                break;
        }
#define IS_CURRENT_SETTINGS(c)  (c->type == CTS_TYPE_CURRENT_SETTINGS)
        case XPT_SET_TRAN_SETTINGS:     /* Nexus Settings */
                cts = &ccb->cts;
                if (!IS_CURRENT_SETTINGS(cts)) {
                        ccb->ccb_h.status = CAM_REQ_INVALID;
                        xpt_done(ccb);
                        break;
                }
                ccb->ccb_h.status = CAM_REQ_CMP;
                xpt_done(ccb);
                break;
        case XPT_GET_TRAN_SETTINGS:
        {
                struct ccb_trans_settings_scsi *scsi;
                struct ccb_trans_settings_fc *fc;

                cts = &ccb->cts;
                scsi = &cts->proto_specific.scsi;
                fc = &cts->xport_specific.fc;
                tgt = cts->ccb_h.target_id;
                fcp = FCPARAM(isp, bus);

                cts->protocol = PROTO_SCSI;
                cts->protocol_version = SCSI_REV_2;
                cts->transport = XPORT_FC;
                cts->transport_version = 0;

                scsi->valid = CTS_SCSI_VALID_TQ;
                scsi->flags = CTS_SCSI_FLAGS_TAG_ENB;
                fc->valid = CTS_FC_VALID_SPEED;
                fc->bitrate = fcp->isp_gbspeed * 100000;
                if (tgt < MAX_FC_TARG) {
                        fcportdb_t *lp = &fcp->portdb[tgt];
                        fc->wwnn = lp->node_wwn;
                        fc->wwpn = lp->port_wwn;
                        fc->port = lp->portid;
                        fc->valid |= CTS_FC_VALID_WWNN | CTS_FC_VALID_WWPN | CTS_FC_VALID_PORT;
                }
                ccb->ccb_h.status = CAM_REQ_CMP;
                xpt_done(ccb);
                break;
        }
        case XPT_CALC_GEOMETRY:
                cam_calc_geometry(&ccb->ccg, 1);
                xpt_done(ccb);
                break;

        case XPT_RESET_BUS:             /* Reset the specified bus */
                error = isp_control(isp, ISPCTL_RESET_BUS, bus);
                if (error) {
                        ccb->ccb_h.status = CAM_REQ_CMP_ERR;
                        xpt_done(ccb);
                        break;
                }
                if (bootverbose) {
                        xpt_print(ccb->ccb_h.path, "reset bus on channel %d\n", bus);
                }
                xpt_async(AC_BUS_RESET, ISP_FC_PC(isp, bus)->path, 0);
                ccb->ccb_h.status = CAM_REQ_CMP;
                xpt_done(ccb);
                break;

        case XPT_TERM_IO:               /* Terminate the I/O process */
                ccb->ccb_h.status = CAM_REQ_INVALID;
                xpt_done(ccb);
                break;

        case XPT_SET_SIM_KNOB:          /* Set SIM knobs */
        {
                struct ccb_sim_knob *kp = &ccb->knob;
                fcparam *fcp = FCPARAM(isp, bus);

                if (kp->xport_specific.fc.valid & KNOB_VALID_ADDRESS) {
                        fcp->isp_wwnn = ISP_FC_PC(isp, bus)->def_wwnn = kp->xport_specific.fc.wwnn;
                        fcp->isp_wwpn = ISP_FC_PC(isp, bus)->def_wwpn = kp->xport_specific.fc.wwpn;
                        isp_prt(isp, ISP_LOGALL, "Setting Channel %d wwns to 0x%jx 0x%jx", bus, fcp->isp_wwnn, fcp->isp_wwpn);
                }
                ccb->ccb_h.status = CAM_REQ_CMP;
                if (kp->xport_specific.fc.valid & KNOB_VALID_ROLE) {
                        int rchange = 0;
                        int newrole = 0;

                        switch (kp->xport_specific.fc.role) {
                        case KNOB_ROLE_NONE:
                                if (fcp->role != ISP_ROLE_NONE) {
                                        rchange = 1;
                                        newrole = ISP_ROLE_NONE;
                                }
                                break;
                        case KNOB_ROLE_TARGET:
                                if (fcp->role != ISP_ROLE_TARGET) {
                                        rchange = 1;
                                        newrole = ISP_ROLE_TARGET;
                                }
                                break;
                        case KNOB_ROLE_INITIATOR:
                                if (fcp->role != ISP_ROLE_INITIATOR) {
                                        rchange = 1;
                                        newrole = ISP_ROLE_INITIATOR;
                                }
                                break;
                        case KNOB_ROLE_BOTH:
                                if (fcp->role != ISP_ROLE_BOTH) {
                                        rchange = 1;
                                        newrole = ISP_ROLE_BOTH;
                                }
                                break;
                        }
                        if (rchange) {
                                ISP_PATH_PRT(isp, ISP_LOGCONFIG, ccb->ccb_h.path, "changing role on from %d to %d\n", fcp->role, newrole);
                                if (isp_control(isp, ISPCTL_CHANGE_ROLE,
                                    bus, newrole) != 0) {
                                        ccb->ccb_h.status = CAM_REQ_CMP_ERR;
                                        xpt_done(ccb);
                                        break;
                                }
                        }
                }
                xpt_done(ccb);
                break;
        }
        case XPT_GET_SIM_KNOB_OLD:      /* Get SIM knobs -- compat value */
        case XPT_GET_SIM_KNOB:          /* Get SIM knobs */
        {
                struct ccb_sim_knob *kp = &ccb->knob;
                fcparam *fcp = FCPARAM(isp, bus);

                kp->xport_specific.fc.wwnn = fcp->isp_wwnn;
                kp->xport_specific.fc.wwpn = fcp->isp_wwpn;
                switch (fcp->role) {
                case ISP_ROLE_NONE:
                        kp->xport_specific.fc.role = KNOB_ROLE_NONE;
                        break;
                case ISP_ROLE_TARGET:
                        kp->xport_specific.fc.role = KNOB_ROLE_TARGET;
                        break;
                case ISP_ROLE_INITIATOR:
                        kp->xport_specific.fc.role = KNOB_ROLE_INITIATOR;
                        break;
                case ISP_ROLE_BOTH:
                        kp->xport_specific.fc.role = KNOB_ROLE_BOTH;
                        break;
                }
                kp->xport_specific.fc.valid = KNOB_VALID_ADDRESS | KNOB_VALID_ROLE;
                ccb->ccb_h.status = CAM_REQ_CMP;
                xpt_done(ccb);
                break;
        }
        case XPT_PATH_INQ:              /* Path routing inquiry */
        {
                struct ccb_pathinq *cpi = &ccb->cpi;

                cpi->version_num = 1;
#ifdef  ISP_TARGET_MODE
                cpi->target_sprt = PIT_PROCESSOR | PIT_DISCONNECT | PIT_TERM_IO;
#else
                cpi->target_sprt = 0;
#endif
                cpi->hba_eng_cnt = 0;
                cpi->max_target = ISP_MAX_TARGETS(isp) - 1;
                cpi->max_lun = 255;
                cpi->bus_id = cam_sim_bus(sim);
                cpi->maxio = (ISP_NSEG64_MAX - 1) * PAGE_SIZE;

                fcp = FCPARAM(isp, bus);

                cpi->hba_misc = PIM_NOBUSRESET | PIM_UNMAPPED;
                cpi->hba_misc |= PIM_EXTLUNS | PIM_NOSCAN;

                /*
                 * Because our loop ID can shift from time to time,
                 * make our initiator ID out of range of our bus.
                 */
                cpi->initiator_id = cpi->max_target + 1;

                /*
                 * Set base transfer capabilities for Fibre Channel, for this HBA.
                 */
                if (IS_25XX(isp))
                        cpi->base_transfer_speed = 8000000;
                else
                        cpi->base_transfer_speed = 4000000;
                cpi->hba_inquiry = PI_TAG_ABLE;
                cpi->transport = XPORT_FC;
                cpi->transport_version = 0;
                cpi->xport_specific.fc.wwnn = fcp->isp_wwnn;
                cpi->xport_specific.fc.wwpn = fcp->isp_wwpn;
                cpi->xport_specific.fc.port = fcp->isp_portid;
                cpi->xport_specific.fc.bitrate = fcp->isp_gbspeed * 1000;
                cpi->protocol = PROTO_SCSI;
                cpi->protocol_version = SCSI_REV_2;
                strlcpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
                strlcpy(cpi->hba_vid, "Qlogic", HBA_IDLEN);
                strlcpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
                cpi->unit_number = cam_sim_unit(sim);
                cpi->ccb_h.status = CAM_REQ_CMP;
                xpt_done(ccb);
                break;
        }
        default:
                ccb->ccb_h.status = CAM_REQ_INVALID;
                xpt_done(ccb);
                break;
        }
}

void
isp_done(XS_T *sccb)
{
        ispsoftc_t *isp = XS_ISP(sccb);
        uint32_t status;

        if (XS_NOERR(sccb))
                XS_SETERR(sccb, CAM_REQ_CMP);

        if ((sccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP && (sccb->scsi_status != SCSI_STATUS_OK)) {
                sccb->ccb_h.status &= ~CAM_STATUS_MASK;
                if ((sccb->scsi_status == SCSI_STATUS_CHECK_COND) && (sccb->ccb_h.status & CAM_AUTOSNS_VALID) == 0) {
                        sccb->ccb_h.status |= CAM_AUTOSENSE_FAIL;
                } else {
                        sccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR;
                }
        }

        sccb->ccb_h.status &= ~CAM_SIM_QUEUED;
        status = sccb->ccb_h.status & CAM_STATUS_MASK;
        if (status != CAM_REQ_CMP &&
            (sccb->ccb_h.status & CAM_DEV_QFRZN) == 0) {
                sccb->ccb_h.status |= CAM_DEV_QFRZN;
                xpt_freeze_devq(sccb->ccb_h.path, 1);
        }

        if (ISP_PCMD(sccb)) {
                if (callout_active(&PISP_PCMD(sccb)->wdog))
                        callout_stop(&PISP_PCMD(sccb)->wdog);
                isp_free_pcmd(isp, (union ccb *) sccb);
        }
        isp_rq_check_below(isp);
        xpt_done((union ccb *) sccb);
}

void
isp_async(ispsoftc_t *isp, ispasync_t cmd, ...)
{
        int bus;
        static const char prom[] = "Chan %d [%d] WWPN 0x%16jx PortID 0x%06x handle 0x%x %s %s";
        char buf[64];
        char *msg = NULL;
        target_id_t tgt = 0;
        fcportdb_t *lp;
        struct isp_fc *fc;
        struct ac_contract ac;
        struct ac_device_changed *adc;
        va_list ap;

        switch (cmd) {
        case ISPASYNC_LOOP_RESET:
        {
                uint16_t lipp;
                fcparam *fcp;
                va_start(ap, cmd);
                bus = va_arg(ap, int);
                va_end(ap);

                lipp = ISP_READ(isp, OUTMAILBOX1);
                fcp = FCPARAM(isp, bus);

                isp_prt(isp, ISP_LOGINFO, "Chan %d LOOP Reset, LIP primitive %x", bus, lipp);
                /*
                 * Per FCP-4, a Reset LIP should result in a CRN reset. Other
                 * LIPs and loop up/down events should never reset the CRN. For
                 * an as of yet unknown reason, 24xx series cards (and
                 * potentially others) can interrupt with a LIP Reset status
                 * when no LIP reset came down the wire. Additionally, the LIP
                 * primitive accompanying this status would not be a valid LIP
                 * Reset primitive, but some variation of an invalid AL_PA
                 * LIP. As a result, we have to verify the AL_PD in the LIP
                 * addresses our port before blindly resetting.
                */
                if (FCP_IS_DEST_ALPD(fcp, (lipp & 0x00FF)))
                        isp_fcp_reset_crn(isp, bus, /*tgt*/0, /*tgt_set*/ 0);
                isp_loop_changed(isp, bus);
                break;
        }
        case ISPASYNC_LIP:
                if (msg == NULL)
                        msg = "LIP Received";
                /* FALLTHROUGH */
        case ISPASYNC_LOOP_DOWN:
                if (msg == NULL)
                        msg = "LOOP Down";
                /* FALLTHROUGH */
        case ISPASYNC_LOOP_UP:
                if (msg == NULL)
                        msg = "LOOP Up";
                va_start(ap, cmd);
                bus = va_arg(ap, int);
                va_end(ap);
                isp_loop_changed(isp, bus);
                isp_prt(isp, ISP_LOGINFO, "Chan %d %s", bus, msg);
                break;
        case ISPASYNC_DEV_ARRIVED:
                va_start(ap, cmd);
                bus = va_arg(ap, int);
                lp = va_arg(ap, fcportdb_t *);
                va_end(ap);
                fc = ISP_FC_PC(isp, bus);
                tgt = FC_PORTDB_TGT(isp, bus, lp);
                isp_gen_role_str(buf, sizeof (buf), lp->prli_word3);
                isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "arrived");
                if ((FCPARAM(isp, bus)->role & ISP_ROLE_INITIATOR) &&
                    (lp->prli_word3 & PRLI_WD3_TARGET_FUNCTION)) {
                        lp->is_target = 1;
                        isp_fcp_reset_crn(isp, bus, tgt, /*tgt_set*/ 1);
                        isp_make_here(isp, lp, bus, tgt);
                }
                if ((FCPARAM(isp, bus)->role & ISP_ROLE_TARGET) &&
                    (lp->prli_word3 & PRLI_WD3_INITIATOR_FUNCTION)) {
                        lp->is_initiator = 1;
                        ac.contract_number = AC_CONTRACT_DEV_CHG;
                        adc = (struct ac_device_changed *) ac.contract_data;
                        adc->wwpn = lp->port_wwn;
                        adc->port = lp->portid;
                        adc->target = tgt;
                        adc->arrived = 1;
                        xpt_async(AC_CONTRACT, fc->path, &ac);
                }
                break;
        case ISPASYNC_DEV_CHANGED:
        case ISPASYNC_DEV_STAYED:
        {
                int crn_reset_done;

                crn_reset_done = 0;
                va_start(ap, cmd);
                bus = va_arg(ap, int);
                lp = va_arg(ap, fcportdb_t *);
                va_end(ap);
                fc = ISP_FC_PC(isp, bus);
                tgt = FC_PORTDB_TGT(isp, bus, lp);
                isp_gen_role_str(buf, sizeof (buf), lp->new_prli_word3);
                if (cmd == ISPASYNC_DEV_CHANGED)
                        isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->new_portid, lp->handle, buf, "changed");
                else
                        isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "stayed");

                if (lp->is_target !=
                    ((FCPARAM(isp, bus)->role & ISP_ROLE_INITIATOR) &&
                     (lp->new_prli_word3 & PRLI_WD3_TARGET_FUNCTION))) {
                        lp->is_target = !lp->is_target;
                        if (lp->is_target) {
                                if (cmd == ISPASYNC_DEV_CHANGED) {
                                        isp_fcp_reset_crn(isp, bus, tgt, /*tgt_set*/ 1);
                                        crn_reset_done = 1;
                                }
                                isp_make_here(isp, lp, bus, tgt);
                        } else {
                                isp_make_gone(isp, lp, bus, tgt);
                                if (cmd == ISPASYNC_DEV_CHANGED) {
                                        isp_fcp_reset_crn(isp, bus, tgt, /*tgt_set*/ 1);
                                        crn_reset_done = 1;
                                }
                        }
                }
                if (lp->is_initiator !=
                    ((FCPARAM(isp, bus)->role & ISP_ROLE_TARGET) &&
                     (lp->new_prli_word3 & PRLI_WD3_INITIATOR_FUNCTION))) {
                        lp->is_initiator = !lp->is_initiator;
                        ac.contract_number = AC_CONTRACT_DEV_CHG;
                        adc = (struct ac_device_changed *) ac.contract_data;
                        adc->wwpn = lp->port_wwn;
                        adc->port = lp->portid;
                        adc->target = tgt;
                        adc->arrived = lp->is_initiator;
                        xpt_async(AC_CONTRACT, fc->path, &ac);
                }

                if ((cmd == ISPASYNC_DEV_CHANGED) &&
                    (crn_reset_done == 0))
                        isp_fcp_reset_crn(isp, bus, tgt, /*tgt_set*/ 1);

                break;
        }
        case ISPASYNC_DEV_GONE:
                va_start(ap, cmd);
                bus = va_arg(ap, int);
                lp = va_arg(ap, fcportdb_t *);
                va_end(ap);
                fc = ISP_FC_PC(isp, bus);
                tgt = FC_PORTDB_TGT(isp, bus, lp);
                /*
                 * If this has a virtual target or initiator set the isp_gdt
                 * timer running on it to delay its departure.
                 */
                isp_gen_role_str(buf, sizeof (buf), lp->prli_word3);
                if (lp->is_target || lp->is_initiator) {
                        lp->state = FC_PORTDB_STATE_ZOMBIE;
                        lp->gone_timer = fc->gone_device_time;
                        isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "gone zombie");
                        if (fc->ready && !callout_active(&fc->gdt)) {
                                isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Starting Gone Device Timer with %u seconds time now %lu", bus, lp->gone_timer, (unsigned long)time_uptime);
                                callout_reset(&fc->gdt, hz, isp_gdt, fc);
                        }
                        break;
                }
                isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "gone");
                break;
        case ISPASYNC_CHANGE_NOTIFY:
        {
                char *msg;
                int evt, nphdl, nlstate, portid, reason;

                va_start(ap, cmd);
                bus = va_arg(ap, int);
                evt = va_arg(ap, int);
                if (evt == ISPASYNC_CHANGE_PDB) {
                        nphdl = va_arg(ap, int);
                        nlstate = va_arg(ap, int);
                        reason = va_arg(ap, int);
                } else if (evt == ISPASYNC_CHANGE_SNS) {
                        portid = va_arg(ap, int);
                } else {
                        nphdl = NIL_HANDLE;
                        nlstate = reason = 0;
                }
                va_end(ap);

                if (evt == ISPASYNC_CHANGE_PDB) {
                        int tgt_set = 0;
                        msg = "Port Database Changed";
                        isp_prt(isp, ISP_LOGINFO,
                            "Chan %d %s (nphdl 0x%x state 0x%x reason 0x%x)",
                            bus, msg, nphdl, nlstate, reason);
                        /*
                         * Port database syncs are not sufficient for
                         * determining that logins or logouts are done on the
                         * loop, but this information is directly available from
                         * the reason code from the incoming mbox. We must reset
                         * the fcp crn on these events according to FCP-4
                         */
                        switch (reason) {
                        case PDB24XX_AE_IMPL_LOGO_1:
                        case PDB24XX_AE_IMPL_LOGO_2:
                        case PDB24XX_AE_IMPL_LOGO_3:
                        case PDB24XX_AE_PLOGI_RCVD:
                        case PDB24XX_AE_PRLI_RCVD:
                        case PDB24XX_AE_PRLO_RCVD:
                        case PDB24XX_AE_LOGO_RCVD:
                        case PDB24XX_AE_PLOGI_DONE:
                        case PDB24XX_AE_PRLI_DONE:
                                /*
                                 * If the event is not global, twiddle tgt and
                                 * tgt_set to nominate only the target
                                 * associated with the nphdl.
                                 */
                                if (nphdl != PDB24XX_AE_GLOBAL) {
                                        /* Break if we don't yet have the pdb */
                                        if (!isp_find_pdb_by_handle(isp, bus, nphdl, &lp))
                                                break;
                                        tgt = FC_PORTDB_TGT(isp, bus, lp);
                                        tgt_set = 1;
                                }
                                isp_fcp_reset_crn(isp, bus, tgt, tgt_set);
                                break;
                        default:
                                break; /* NOP */
                        }
                } else if (evt == ISPASYNC_CHANGE_SNS) {
                        msg = "Name Server Database Changed";
                        isp_prt(isp, ISP_LOGINFO, "Chan %d %s (PortID 0x%06x)",
                            bus, msg, portid);
                } else {
                        msg = "Other Change Notify";
                        isp_prt(isp, ISP_LOGINFO, "Chan %d %s", bus, msg);
                }
                isp_loop_changed(isp, bus);
                break;
        }
#ifdef  ISP_TARGET_MODE
        case ISPASYNC_TARGET_NOTIFY:
        {
                isp_notify_t *notify;
                va_start(ap, cmd);
                notify = va_arg(ap, isp_notify_t *);
                va_end(ap);
                switch (notify->nt_ncode) {
                case NT_ABORT_TASK:
                case NT_ABORT_TASK_SET:
                case NT_CLEAR_ACA:
                case NT_CLEAR_TASK_SET:
                case NT_LUN_RESET:
                case NT_TARGET_RESET:
                case NT_QUERY_TASK_SET:
                case NT_QUERY_ASYNC_EVENT:
                        /*
                         * These are task management functions.
                         */
                        isp_handle_platform_target_tmf(isp, notify);
                        break;
                case NT_LIP_RESET:
                case NT_LINK_UP:
                case NT_LINK_DOWN:
                case NT_HBA_RESET:
                        /*
                         * No action need be taken here.
                         */
                        break;
                case NT_SRR:
                        isp_handle_platform_srr(isp, notify);
                        break;
                default:
                        isp_prt(isp, ISP_LOGALL, "target notify code 0x%x", notify->nt_ncode);
                        isp_handle_platform_target_notify_ack(isp, notify, 0);
                        break;
                }
                break;
        }
        case ISPASYNC_TARGET_NOTIFY_ACK:
        {
                void *inot;
                va_start(ap, cmd);
                inot = va_arg(ap, void *);
                va_end(ap);
                if (isp_notify_ack(isp, inot)) {
                        isp_tna_t *tp = malloc(sizeof (*tp), M_DEVBUF, M_NOWAIT);
                        if (tp) {
                                tp->isp = isp;
                                memcpy(tp->data, inot, sizeof (tp->data));
                                tp->not = tp->data;
                                callout_init_mtx(&tp->timer, &isp->isp_lock, 0);
                                callout_reset(&tp->timer, 5,
                                    isp_refire_notify_ack, tp);
                        } else {
                                isp_prt(isp, ISP_LOGERR, "you lose- cannot allocate a notify refire");
                        }
                }
                break;
        }
        case ISPASYNC_TARGET_ACTION:
        {
                isphdr_t *hp;

                va_start(ap, cmd);
                hp = va_arg(ap, isphdr_t *);
                va_end(ap);
                switch (hp->rqs_entry_type) {
                case RQSTYPE_ATIO:
                        isp_handle_platform_atio7(isp, (at7_entry_t *)hp);
                        break;
                case RQSTYPE_CTIO7:
                        isp_handle_platform_ctio(isp, (ct7_entry_t *)hp);
                        break;
                default:
                        isp_prt(isp, ISP_LOGWARN, "%s: unhandled target action 0x%x",
                            __func__, hp->rqs_entry_type);
                        break;
                }
                break;
        }
#endif
        case ISPASYNC_FW_CRASH:
        {
                uint16_t mbox1;
                mbox1 = ISP_READ(isp, OUTMAILBOX1);
                isp_prt(isp, ISP_LOGERR, "Internal Firmware Error @ RISC Address 0x%x", mbox1);
#if 0
                isp_reinit(isp, 1);
                isp_async(isp, ISPASYNC_FW_RESTARTED, NULL);
#endif
                break;
        }
        default:
                isp_prt(isp, ISP_LOGERR, "unknown isp_async event %d", cmd);
                break;
        }
}

uint64_t
isp_default_wwn(ispsoftc_t * isp, int chan, int isactive, int iswwnn)
{
        uint64_t seed;
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        /* First try to use explicitly configured WWNs. */
        seed = iswwnn ? fc->def_wwnn : fc->def_wwpn;
        if (seed)
                return (seed);

        /* Otherwise try to use WWNs from NVRAM. */
        if (isactive) {
                seed = iswwnn ? FCPARAM(isp, chan)->isp_wwnn_nvram :
                    FCPARAM(isp, chan)->isp_wwpn_nvram;
                if (seed)
                        return (seed);
        }

        /* If still no WWNs, try to steal them from the first channel. */
        if (chan > 0) {
                seed = iswwnn ? ISP_FC_PC(isp, 0)->def_wwnn :
                    ISP_FC_PC(isp, 0)->def_wwpn;
                if (seed == 0) {
                        seed = iswwnn ? FCPARAM(isp, 0)->isp_wwnn_nvram :
                            FCPARAM(isp, 0)->isp_wwpn_nvram;
                }
        }

        /* If still nothing -- improvise. */
        if (seed == 0) {
                seed = 0x400000007F000000ull + device_get_unit(isp->isp_dev);
                if (!iswwnn)
                        seed ^= 0x0100000000000000ULL;
        }

        /* For additional channels we have to improvise even more. */
        if (!iswwnn && chan > 0) {
                /*
                 * We'll stick our channel number plus one first into bits
                 * 57..59 and thence into bits 52..55 which allows for 8 bits
                 * of channel which is enough for our maximum of 255 channels.
                 */
                seed ^= 0x0100000000000000ULL;
                seed ^= ((uint64_t) (chan + 1) & 0xf) << 56;
                seed ^= ((uint64_t) ((chan + 1) >> 4) & 0xf) << 52;
        }
        return (seed);
}

void
isp_prt(ispsoftc_t *isp, int level, const char *fmt, ...)
{
        int loc;
        char lbuf[200];
        va_list ap;

        if (level != ISP_LOGALL && (level & isp->isp_dblev) == 0) {
                return;
        }
        snprintf(lbuf, sizeof (lbuf), "%s: ", device_get_nameunit(isp->isp_dev));
        loc = strlen(lbuf);
        va_start(ap, fmt);
        vsnprintf(&lbuf[loc], sizeof (lbuf) - loc - 1, fmt, ap);
        va_end(ap);
        printf("%s\n", lbuf);
}

void
isp_xs_prt(ispsoftc_t *isp, XS_T *xs, int level, const char *fmt, ...)
{
        va_list ap;
        if (level != ISP_LOGALL && (level & isp->isp_dblev) == 0) {
                return;
        }
        xpt_print_path(xs->ccb_h.path);
        va_start(ap, fmt);
        vprintf(fmt, ap);
        va_end(ap);
        printf("\n");
}

uint64_t
isp_nanotime_sub(struct timespec *b, struct timespec *a)
{
        uint64_t elapsed;
        struct timespec x;

        timespecsub(b, a, &x);
        elapsed = GET_NANOSEC(&x);
        if (elapsed == 0)
                elapsed++;
        return (elapsed);
}

int
isp_fc_scratch_acquire(ispsoftc_t *isp, int chan)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);

        if (fc->fcbsy)
                return (-1);
        fc->fcbsy = 1;
        return (0);
}

void
isp_platform_intr(void *arg)
{
        ispsoftc_t *isp = arg;

        ISP_LOCK(isp);
        ISP_RUN_ISR(isp);
        ISP_UNLOCK(isp);
}

void
isp_platform_intr_resp(void *arg)
{
        ispsoftc_t *isp = arg;

        ISP_LOCK(isp);
        isp_intr_respq(isp);
        ISP_UNLOCK(isp);

        /* We have handshake enabled, so explicitly complete interrupt */
        ISP_WRITE(isp, BIU2400_HCCR, HCCR_2400_CMD_CLEAR_RISC_INT);
}

void
isp_platform_intr_atio(void *arg)
{
        ispsoftc_t *isp = arg;

        ISP_LOCK(isp);
#ifdef  ISP_TARGET_MODE
        isp_intr_atioq(isp);
#endif
        ISP_UNLOCK(isp);

        /* We have handshake enabled, so explicitly complete interrupt */
        ISP_WRITE(isp, BIU2400_HCCR, HCCR_2400_CMD_CLEAR_RISC_INT);
}

typedef struct {
        ispsoftc_t              *isp;
        struct ccb_scsiio       *csio;
        void                    *qe;
        int                     error;
} mush_t;

static void
isp_dma2(void *arg, bus_dma_segment_t *dm_segs, int nseg, int error)
{
        mush_t *mp = (mush_t *) arg;
        ispsoftc_t *isp= mp->isp;
        struct ccb_scsiio *csio = mp->csio;
        bus_dmasync_op_t op;

        if (error) {
                mp->error = error;
                return;
        }
        if ((csio->ccb_h.func_code == XPT_CONT_TARGET_IO) ^
            ((csio->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN))
                op = BUS_DMASYNC_PREREAD;
        else
                op = BUS_DMASYNC_PREWRITE;
        bus_dmamap_sync(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap, op);

        mp->error = ISP_SEND_CMD(isp, mp->qe, dm_segs, nseg);
        if (mp->error)
                isp_dmafree(isp, csio);
}

int
isp_dmasetup(ispsoftc_t *isp, struct ccb_scsiio *csio, void *qe)
{
        mush_t mp;
        int error;

        if (XS_XFRLEN(csio)) {
                mp.isp = isp;
                mp.csio = csio;
                mp.qe = qe;
                mp.error = 0;
                error = bus_dmamap_load_ccb(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap,
                    (union ccb *)csio, isp_dma2, &mp, BUS_DMA_NOWAIT);
                if (error == 0)
                        error = mp.error;
        } else {
                error = ISP_SEND_CMD(isp, qe, NULL, 0);
        }
        switch (error) {
        case 0:
        case CMD_COMPLETE:
        case CMD_EAGAIN:
        case CMD_RQLATER:
                break;
        case ENOMEM:
                error = CMD_EAGAIN;
                break;
        case EINVAL:
        case EFBIG:
                csio->ccb_h.status = CAM_REQ_INVALID;
                error = CMD_COMPLETE;
                break;
        default:
                csio->ccb_h.status = CAM_UNREC_HBA_ERROR;
                error = CMD_COMPLETE;
                break;
        }
        return (error);
}

void
isp_dmafree(ispsoftc_t *isp, struct ccb_scsiio *csio)
{
        bus_dmasync_op_t op;

        if (XS_XFRLEN(csio) == 0)
                return;

        if ((csio->ccb_h.func_code == XPT_CONT_TARGET_IO) ^
            ((csio->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN))
                op = BUS_DMASYNC_POSTREAD;
        else
                op = BUS_DMASYNC_POSTWRITE;
        bus_dmamap_sync(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap, op);
        bus_dmamap_unload(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap);
}

/*
 * Reset the command reference number for all LUNs on a specific target
 * (needed when a target arrives again) or for all targets on a port
 * (needed for events like a LIP).
 */
void
isp_fcp_reset_crn(ispsoftc_t *isp, int chan, uint32_t tgt, int tgt_set)
{
        struct isp_fc *fc = ISP_FC_PC(isp, chan);
        struct isp_nexus *nxp;
        int i;

        if (tgt_set == 0)
                isp_prt(isp, ISP_LOGDEBUG0,
                    "Chan %d resetting CRN on all targets", chan);
        else
                isp_prt(isp, ISP_LOGDEBUG0,
                    "Chan %d resetting CRN on target %u", chan, tgt);

        for (i = 0; i < NEXUS_HASH_WIDTH; i++) {
                for (nxp = fc->nexus_hash[i]; nxp != NULL; nxp = nxp->next) {
                        if (tgt_set == 0 || tgt == nxp->tgt)
                                nxp->crnseed = 0;
                }
        }
}

int
isp_fcp_next_crn(ispsoftc_t *isp, uint8_t *crnp, XS_T *cmd)
{
        lun_id_t lun;
        uint32_t chan, tgt;
        struct isp_fc *fc;
        struct isp_nexus *nxp;
        int idx;

        chan = XS_CHANNEL(cmd);
        tgt = XS_TGT(cmd);
        lun = XS_LUN(cmd);
        fc = ISP_FC_PC(isp, chan);
        idx = NEXUS_HASH(tgt, lun);
        nxp = fc->nexus_hash[idx];

        while (nxp) {
                if (nxp->tgt == tgt && nxp->lun == lun)
                        break;
                nxp = nxp->next;
        }
        if (nxp == NULL) {
                nxp = fc->nexus_free_list;
                if (nxp == NULL) {
                        nxp = malloc(sizeof (struct isp_nexus), M_DEVBUF, M_ZERO|M_NOWAIT);
                        if (nxp == NULL) {
                                return (-1);
                        }
                } else {
                        fc->nexus_free_list = nxp->next;
                }
                nxp->tgt = tgt;
                nxp->lun = lun;
                nxp->next = fc->nexus_hash[idx];
                fc->nexus_hash[idx] = nxp;
        }
        if (nxp->crnseed == 0)
                nxp->crnseed = 1;
        *crnp = nxp->crnseed++;
        return (0);
}

/*
 * We enter with the lock held
 */
void
isp_timer(void *arg)
{
        ispsoftc_t *isp = arg;
#ifdef  ISP_TARGET_MODE
        isp_tmcmd_restart(isp);
#endif
        callout_reset(&isp->isp_osinfo.tmo, isp_timer_count, isp_timer, isp);
}

#ifdef  ISP_TARGET_MODE
isp_ecmd_t *
isp_get_ecmd(ispsoftc_t *isp)
{
        isp_ecmd_t *ecmd = isp->isp_osinfo.ecmd_free;
        if (ecmd) {
                isp->isp_osinfo.ecmd_free = ecmd->next;
        }
        return (ecmd);
}

void
isp_put_ecmd(ispsoftc_t *isp, isp_ecmd_t *ecmd)
{
        ecmd->next = isp->isp_osinfo.ecmd_free;
        isp->isp_osinfo.ecmd_free = ecmd;
}
#endif