[dragonfly.git] / sys / dev / disk / isp / isp_freebsd.c

/*-
 * 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.
 *
 * $FreeBSD: src/sys/dev/isp/isp_freebsd.c,v 1.176 2011/11/06 00:44:40 mjacob Exp $
 */

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

#define	THREAD_CREATE	kthread_create

MODULE_VERSION(isp, 1);
MODULE_DEPEND(isp, cam, 1, 1, 1);
int isp_announced = 0;
int isp_fabric_hysteresis = 5;
int isp_loop_down_limit = 60;	/* default loop down limit */
int isp_change_is_bad = 0;	/* "changed" devices are bad */
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 */
int isp_autoconfig = 1;		/* automatically attach/detach devices */
static const char *roles[4] = {
    "(none)", "Target", "Initiator", "Target/Initiator"
};
static const char prom3[] = "Chan %d PortID 0x%06x Departed from Target %u because of %s";
static const char rqo[] = "%s: Request Queue Overflow\n";

static void isp_freeze_loopdown(ispsoftc_t *, int, char *);
static d_ioctl_t ispioctl;
static void isp_intr_enable(void *);
static void isp_cam_async(void *, uint32_t, struct cam_path *, void *);
static void isp_poll(struct cam_sim *);
static timeout_t isp_watchdog;
static timeout_t isp_gdt;
static task_fn_t isp_gdt_task;
static timeout_t isp_ldt;
static task_fn_t isp_ldt_task;
static void isp_kthread(void *);
static void isp_action(struct cam_sim *, union ccb *);
#ifdef	ISP_INTERNAL_TARGET
static void isp_target_thread_pi(void *);
static void isp_target_thread_fc(void *);
#endif
static void isp_timer(void *);

static struct dev_ops isp_ops = {
	{ "isp", 0, D_DISK },
	.d_ioctl =	ispioctl,
};

static int
isp_attach_chan(ispsoftc_t *isp, struct cam_devq *devq, int chan)
{
	struct ccb_setasync csa;
	struct cam_sim *sim;
	struct cam_path *path;

	/*
	 * Construct our SIM entry.
	 */
	sim = cam_sim_alloc(isp_action, isp_poll, "isp", isp, device_get_unit(isp->isp_dev), &isp->isp_osinfo.lock, isp->isp_maxcmds, isp->isp_maxcmds, devq);
	cam_simq_release(devq);

	if (sim == NULL) {
		return (ENOMEM);
	}

	ISP_LOCK(isp);
	if (xpt_bus_register(sim, chan) != CAM_SUCCESS) {
		ISP_UNLOCK(isp);
		cam_sim_free(sim);
		return (EIO);
	}
	ISP_UNLOCK(isp);
	if (xpt_create_path_unlocked(&path, NULL, cam_sim_path(sim), CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
		ISP_LOCK(isp);
		xpt_bus_deregister(cam_sim_path(sim));
		ISP_UNLOCK(isp);
		cam_sim_free(sim);
		return (ENXIO);
	}
	xpt_setup_ccb(&csa.ccb_h, path, 5);
	csa.ccb_h.func_code = XPT_SASYNC_CB;
	csa.event_enable = AC_LOST_DEVICE;
	csa.callback = isp_cam_async;
	csa.callback_arg = sim;
	xpt_action((union ccb *)&csa);

	if (IS_SCSI(isp)) {
		struct isp_spi *spi = ISP_SPI_PC(isp, chan);
		spi->sim = sim;
		spi->path = path;
#ifdef	ISP_INTERNAL_TARGET
		ISP_SET_PC(isp, chan, proc_active, 1);
		if (THREAD_CREATE(isp_target_thread_pi, spi, &spi->target_proc, "%s: isp_test_tgt%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
			ISP_SET_PC(isp, chan, proc_active, 0);
			isp_prt(isp, ISP_LOGERR, "cannot create test target thread");
		}
#endif
	} else {
		fcparam *fcp = FCPARAM(isp, chan);
		struct isp_fc *fc = ISP_FC_PC(isp, chan);

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

		callout_init(&fc->ldt);
		callout_init(&fc->gdt);
		TASK_INIT(&fc->ltask, 1, isp_ldt_task, fc);
		TASK_INIT(&fc->gtask, 1, isp_gdt_task, fc);

		/*
		 * We start by being "loop down" if we have an initiator role
		 */
		if (fcp->role & ISP_ROLE_INITIATOR) {
			isp_freeze_loopdown(isp, chan, "isp_attach");
			callout_reset(&fc->ldt, isp_quickboot_time * hz, isp_ldt, fc);
			isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "Starting Initial Loop Down Timer @ %lu", (unsigned long) time_second);
		}
		ISP_UNLOCK(isp);
		if (THREAD_CREATE(isp_kthread, fc, &fc->kthread, "%s: fc_thrd%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
			xpt_free_path(fc->path);
			ISP_LOCK(isp);
			if (callout_active(&fc->ldt)) {
				callout_stop(&fc->ldt);
			}
			xpt_bus_deregister(cam_sim_path(fc->sim));
			ISP_UNLOCK(isp);
			cam_sim_free(fc->sim);
			return (ENOMEM);
		}
#ifdef	ISP_INTERNAL_TARGET
		ISP_SET_PC(isp, chan, proc_active, 1);
		if (THREAD_CREATE(isp_target_thread_fc, fc, &fc->target_proc, "%s: isp_test_tgt%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
			ISP_SET_PC(isp, chan, proc_active, 0);
			isp_prt(isp, ISP_LOGERR, "cannot create test target thread");
		}
#endif
		if (chan == 0) {
			SYSCTL_ADD_QUAD(&isp->isp_sysctl_ctx, SYSCTL_CHILDREN(isp->isp_sysctl_tree), OID_AUTO, "wwnn", CTLFLAG_RD, &FCPARAM(isp, 0)->isp_wwnn, 0, "World Wide Node Name");
			SYSCTL_ADD_QUAD(&isp->isp_sysctl_ctx, SYSCTL_CHILDREN(isp->isp_sysctl_tree), OID_AUTO, "wwpn", CTLFLAG_RD, &FCPARAM(isp, 0)->isp_wwpn, 0, "World Wide Port Name");
			SYSCTL_ADD_UINT(&isp->isp_sysctl_ctx, SYSCTL_CHILDREN(isp->isp_sysctl_tree), OID_AUTO, "loop_down_limit", CTLFLAG_RW, &ISP_FC_PC(isp, 0)->loop_down_limit, 0, "Loop Down Limit");
			SYSCTL_ADD_UINT(&isp->isp_sysctl_ctx, SYSCTL_CHILDREN(isp->isp_sysctl_tree), OID_AUTO, "gone_device_time", CTLFLAG_RW, &ISP_FC_PC(isp, 0)->gone_device_time, 0, "Gone Device Time");
		}
	}
	return (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;

	isp->isp_osinfo.ehook.ich_func = isp_intr_enable;
	isp->isp_osinfo.ehook.ich_arg = isp;
	isp->isp_osinfo.ehook.ich_desc = "isp";
	/*
	 * Haha. Set this first, because if we're loaded as a module isp_intr_enable
	 * will be called right awawy, which will clear isp_osinfo.ehook_active,
	 * which would be unwise to then set again later.
	 */
	isp->isp_osinfo.ehook_active = 1;
	if (config_intrhook_establish(&isp->isp_osinfo.ehook) != 0) {
		isp_prt(isp, ISP_LOGERR, "could not establish interrupt enable hook");
		return (-EIO);
	}

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

	sysctl_ctx_init(&isp->isp_sysctl_ctx);
	isp->isp_sysctl_tree = SYSCTL_ADD_NODE(&isp->isp_sysctl_ctx,
	    SYSCTL_STATIC_CHILDREN(_hw), OID_AUTO,
	    device_get_nameunit(isp->isp_dev), CTLFLAG_RD, 0, "");
	if (isp->isp_sysctl_tree == NULL) {
		device_printf(isp->isp_dev, "can't add sysctl node\n");
		return (EINVAL);
	}
	for (chan = 0; chan < isp->isp_nchan; chan++) {
		if (isp_attach_chan(isp, isp->isp_osinfo.devq, chan)) {
			goto unwind;
		}
	}

	callout_init(&isp->isp_osinfo.tmo);
	callout_reset(&isp->isp_osinfo.tmo, hz, isp_timer, isp);
	isp->isp_osinfo.timer_active = 1;

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

unwind:
	while (--chan >= 0) {
		struct cam_sim *sim;
		struct cam_path *path;
		if (IS_FC(isp)) {
			sim = ISP_FC_PC(isp, chan)->sim;
			path = ISP_FC_PC(isp, chan)->path;
		} else {
			sim = ISP_SPI_PC(isp, chan)->sim;
			path = ISP_SPI_PC(isp, chan)->path;
		}
		xpt_free_path(path);
		ISP_LOCK(isp);
		xpt_bus_deregister(cam_sim_path(sim));
		ISP_UNLOCK(isp);
		cam_sim_free(sim);
	}
	if (isp->isp_osinfo.ehook_active) {
		config_intrhook_disestablish(&isp->isp_osinfo.ehook);
		isp->isp_osinfo.ehook_active = 0;
	}
	if (isp->isp_osinfo.cdev) {
		destroy_dev(isp->isp_osinfo.cdev);
		isp->isp_osinfo.cdev = NULL;
	}
	isp->isp_osinfo.devq = NULL;
	return (-1);
}

int
isp_detach(ispsoftc_t *isp)
{
	struct cam_sim *sim;
	struct cam_path *path;
	struct ccb_setasync csa;
	int chan;

	ISP_LOCK(isp);
	for (chan = isp->isp_nchan - 1; chan >= 0; chan -= 1) {
		if (IS_FC(isp)) {
			sim = ISP_FC_PC(isp, chan)->sim;
			path = ISP_FC_PC(isp, chan)->path;
		} else {
			sim = ISP_SPI_PC(isp, chan)->sim;
			path = ISP_SPI_PC(isp, chan)->path;
		}
		if (sim->refcount > 2) {
			ISP_UNLOCK(isp);
			return (EBUSY);
		}
	}
	if (isp->isp_osinfo.timer_active) {
		callout_stop(&isp->isp_osinfo.tmo);
		isp->isp_osinfo.timer_active = 0;
	}
	for (chan = isp->isp_nchan - 1; chan >= 0; chan -= 1) {
		if (IS_FC(isp)) {
			sim = ISP_FC_PC(isp, chan)->sim;
			path = ISP_FC_PC(isp, chan)->path;
		} else {
			sim = ISP_SPI_PC(isp, chan)->sim;
			path = ISP_SPI_PC(isp, chan)->path;
		}
		xpt_setup_ccb(&csa.ccb_h, path, 5);
		csa.ccb_h.func_code = XPT_SASYNC_CB;
		csa.event_enable = 0;
		csa.callback = isp_cam_async;
		csa.callback_arg = sim;
		xpt_action((union ccb *)&csa);
		xpt_free_path(path);
		xpt_bus_deregister(cam_sim_path(sim));
		cam_sim_free(sim);
	}
	ISP_UNLOCK(isp);
	if (isp->isp_osinfo.cdev) {
		destroy_dev(isp->isp_osinfo.cdev);
		isp->isp_osinfo.cdev = NULL;
	}
	if (isp->isp_osinfo.ehook_active) {
		config_intrhook_disestablish(&isp->isp_osinfo.ehook);
		isp->isp_osinfo.ehook_active = 0;
	}
	if (isp->isp_osinfo.devq != NULL) {
		isp->isp_osinfo.devq = NULL;
	}
	if (isp->isp_sysctl_tree != NULL)
		sysctl_ctx_free(&isp->isp_sysctl_ctx);
	return (0);
}

static void
isp_freeze_loopdown(ispsoftc_t *isp, int chan, char *msg)
{
	if (IS_FC(isp)) {
		struct isp_fc *fc = ISP_FC_PC(isp, chan);
		if (fc->simqfrozen == 0) {
			isp_prt(isp, ISP_LOGDEBUG0, "%s: freeze simq (loopdown) chan %d", msg, chan);
			fc->simqfrozen = SIMQFRZ_LOOPDOWN;
			xpt_freeze_simq(fc->sim, 1);
		} else {
			isp_prt(isp, ISP_LOGDEBUG0, "%s: mark frozen (loopdown) chan %d", msg, chan);
			fc->simqfrozen |= SIMQFRZ_LOOPDOWN;
		}
	}
}

static void
isp_unfreeze_loopdown(ispsoftc_t *isp, int chan)
{
	if (IS_FC(isp)) {
		struct isp_fc *fc = ISP_FC_PC(isp, chan);
		int wasfrozen = fc->simqfrozen & SIMQFRZ_LOOPDOWN;
		fc->simqfrozen &= ~SIMQFRZ_LOOPDOWN;
		if (wasfrozen && fc->simqfrozen == 0) {
			isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "%s: Chan %d releasing simq", __func__, chan);
			xpt_release_simq(fc->sim, 1);
		}
	}
}


static int
ispioctl(struct dev_ioctl_args *ap)
{
	cdev_t dev = ap->a_head.a_dev;
	caddr_t addr = ap->a_data;
	u_long c = ap->a_cmd;
	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;
		}
		if (IS_FC(isp)) {
			*(int *)addr = FCPARAM(isp, chan)->role;
		} else {
			*(int *)addr = SDPARAM(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;
		}
		if (IS_FC(isp)) {
			/*
			 * We don't really support dual role at present on FC cards.
			 *
			 * We should, but a bunch of things are currently broken,
			 * so don't allow it.
			 */
			if (nr == ISP_ROLE_BOTH) {
				isp_prt(isp, ISP_LOGERR, "cannot support dual role at present");
				retval = EINVAL;
				break;
			}
			*(int *)addr = FCPARAM(isp, chan)->role;
#ifdef	ISP_INTERNAL_TARGET
			ISP_LOCK(isp);
			retval = isp_fc_change_role(isp, chan, nr);
			ISP_UNLOCK(isp);
#else
			FCPARAM(isp, chan)->role = nr;
#endif
		} else {
			*(int *)addr = SDPARAM(isp, chan)->role;
			SDPARAM(isp, chan)->role = nr;
		}
		retval = 0;
		break;

	case ISP_RESETHBA:
		ISP_LOCK(isp);
#ifdef	ISP_TARGET_MODE
		isp_del_all_wwn_entries(isp, ISP_NOCHAN);
#endif
		isp_reinit(isp, 0);
		ISP_UNLOCK(isp);
		retval = 0;
		break;

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

	case ISP_FC_LIP:
		if (IS_FC(isp)) {
			chan = *(int *)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 (IS_SCSI(isp)) {
			break;
		}
		if (ifc->loopid >= MAX_FC_TARG) {
			retval = EINVAL;
			break;
		}
		lp = &FCPARAM(isp, ifc->chan)->portdb[ifc->loopid];
		if (lp->state == FC_PORTDB_STATE_VALID || lp->target_mode) {
			ifc->role = lp->roles;
			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_GET_STATS:
	{
		isp_stats_t *sp = (isp_stats_t *) addr;

		ISP_MEMZERO(sp, sizeof (*sp));
		sp->isp_stat_version = ISP_STATS_VERSION;
		sp->isp_type = isp->isp_type;
		sp->isp_revision = isp->isp_revision;
		ISP_LOCK(isp);
		sp->isp_stats[ISP_INTCNT] = isp->isp_intcnt;
		sp->isp_stats[ISP_INTBOGUS] = isp->isp_intbogus;
		sp->isp_stats[ISP_INTMBOXC] = isp->isp_intmboxc;
		sp->isp_stats[ISP_INGOASYNC] = isp->isp_intoasync;
		sp->isp_stats[ISP_RSLTCCMPLT] = isp->isp_rsltccmplt;
		sp->isp_stats[ISP_FPHCCMCPLT] = isp->isp_fphccmplt;
		sp->isp_stats[ISP_RSCCHIWAT] = isp->isp_rscchiwater;
		sp->isp_stats[ISP_FPCCHIWAT] = isp->isp_fpcchiwater;
		ISP_UNLOCK(isp);
		retval = 0;
		break;
	}
	case ISP_CLR_STATS:
		ISP_LOCK(isp);
		isp->isp_intcnt = 0;
		isp->isp_intbogus = 0;
		isp->isp_intmboxc = 0;
		isp->isp_intoasync = 0;
		isp->isp_rsltccmplt = 0;
		isp->isp_fphccmplt = 0;
		isp->isp_rscchiwater = 0;
		isp->isp_fpcchiwater = 0;
		ISP_UNLOCK(isp);
		retval = 0;
		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;
		if (IS_FC(isp)) {
			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;
		} else {
			hba->fc_nports = MAX_TARGETS;
			hba->fc_speed = 0;
			hba->fc_topology = 0;
			hba->nvram_node_wwn = 0ull;
			hba->nvram_port_wwn = 0ull;
			hba->active_node_wwn = 0ull;
			hba->active_port_wwn = 0ull;
		}
		retval = 0;
		break;
	}
	case ISP_TSK_MGMT:
	{
		int needmarker;
		struct isp_fc_tsk_mgmt *fct = (struct isp_fc_tsk_mgmt *) addr;
		uint16_t loopid;
		mbreg_t mbs;

		if (IS_SCSI(isp)) {
			break;
		}

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

		needmarker = retval = 0;
		loopid = fct->loopid;
		ISP_LOCK(isp);
		if (IS_24XX(isp)) {
			uint8_t local[QENTRY_LEN];
			isp24xx_tmf_t *tmf;
			isp24xx_statusreq_t *sp;
			fcparam *fcp = FCPARAM(isp, chan);
			fcportdb_t *lp;
			int i;

			for (i = 0; i < MAX_FC_TARG; i++) {
				lp = &fcp->portdb[i];
				if (lp->handle == loopid) {
					break;
				}
			}
			if (i == MAX_FC_TARG) {
				retval = ENXIO;
				ISP_UNLOCK(isp);
				break;
			}
			/* XXX VALIDATE LP XXX */
			tmf = (isp24xx_tmf_t *) local;
			ISP_MEMZERO(tmf, QENTRY_LEN);
			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 = 2;
			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;
			}
			MBSINIT(&mbs, MBOX_EXEC_COMMAND_IOCB_A64, MBLOGALL, 5000000);
			mbs.param[1] = QENTRY_LEN;
			mbs.param[2] = DMA_WD1(fcp->isp_scdma);
			mbs.param[3] = DMA_WD0(fcp->isp_scdma);
			mbs.param[6] = DMA_WD3(fcp->isp_scdma);
			mbs.param[7] = DMA_WD2(fcp->isp_scdma);

			if (FC_SCRATCH_ACQUIRE(isp, chan)) {
				ISP_UNLOCK(isp);
				retval = ENOMEM;
				break;
			}
			isp_put_24xx_tmf(isp, tmf, fcp->isp_scratch);
			MEMORYBARRIER(isp, SYNC_SFORDEV, 0, QENTRY_LEN, chan);
			sp = (isp24xx_statusreq_t *) local;
			sp->req_completion_status = 1;
			retval = isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs);
			MEMORYBARRIER(isp, SYNC_SFORCPU, QENTRY_LEN, QENTRY_LEN, chan);
			isp_get_24xx_response(isp, &((isp24xx_statusreq_t *)fcp->isp_scratch)[1], sp);
			FC_SCRATCH_RELEASE(isp, chan);
			if (retval || sp->req_completion_status != 0) {
				FC_SCRATCH_RELEASE(isp, chan);
				retval = EIO;
			}
			if (retval == 0) {
				if (needmarker) {
					fcp->sendmarker = 1;
				}
			}
		} else {
			MBSINIT(&mbs, 0, MBLOGALL, 0);
			if (ISP_CAP_2KLOGIN(isp) == 0) {
				loopid <<= 8;
			}
			switch (fct->action) {
			case IPT_CLEAR_ACA:
				mbs.param[0] = MBOX_CLEAR_ACA;
				mbs.param[1] = loopid;
				mbs.param[2] = fct->lun;
				break;
			case IPT_TARGET_RESET:
				mbs.param[0] = MBOX_TARGET_RESET;
				mbs.param[1] = loopid;
				needmarker = 1;
				break;
			case IPT_LUN_RESET:
				mbs.param[0] = MBOX_LUN_RESET;
				mbs.param[1] = loopid;
				mbs.param[2] = fct->lun;
				needmarker = 1;
				break;
			case IPT_CLEAR_TASK_SET:
				mbs.param[0] = MBOX_CLEAR_TASK_SET;
				mbs.param[1] = loopid;
				mbs.param[2] = fct->lun;
				needmarker = 1;
				break;
			case IPT_ABORT_TASK_SET:
				mbs.param[0] = MBOX_ABORT_TASK_SET;
				mbs.param[1] = loopid;
				mbs.param[2] = fct->lun;
				needmarker = 1;
				break;
			default:
				retval = EINVAL;
				break;
			}
			if (retval == 0) {
				if (needmarker) {
					FCPARAM(isp, chan)->sendmarker = 1;
				}
				retval = isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs);
				if (retval) {
					retval = EIO;
				}
			}
		}
		ISP_UNLOCK(isp);
		break;
	}
	default:
		break;
	}
	return (retval);
}

static void
isp_intr_enable(void *arg)
{
	int chan;
	ispsoftc_t *isp = arg;
	ISP_LOCK(isp);
	for (chan = 0; chan < isp->isp_nchan; chan++) {
		if (IS_FC(isp)) {
			if (FCPARAM(isp, chan)->role != ISP_ROLE_NONE) {
				ISP_ENABLE_INTS(isp);
				break;
			}
		} else {
			if (SDPARAM(isp, chan)->role != ISP_ROLE_NONE) {
				ISP_ENABLE_INTS(isp);
				break;
			}
		}
	}
	isp->isp_osinfo.ehook_active = 0;
	ISP_UNLOCK(isp);
	/* Release our hook so that the boot can continue. */
	config_intrhook_disestablish(&isp->isp_osinfo.ehook);
}

/*
 * 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)
{
	((struct isp_pcmd *)ISP_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 int is_lun_enabled(ispsoftc_t *, int, lun_id_t);
static ISP_INLINE tstate_t *get_lun_statep(ispsoftc_t *, int, lun_id_t);
static ISP_INLINE tstate_t *get_lun_statep_from_tag(ispsoftc_t *, int, uint32_t);
static ISP_INLINE void rls_lun_statep(ispsoftc_t *, tstate_t *);
static ISP_INLINE inot_private_data_t *get_ntp_from_tagdata(ispsoftc_t *, uint32_t, uint32_t, tstate_t **);
static ISP_INLINE atio_private_data_t *isp_get_atpd(ispsoftc_t *, tstate_t *, uint32_t);
static ISP_INLINE void isp_put_atpd(ispsoftc_t *, tstate_t *, atio_private_data_t *);
static ISP_INLINE inot_private_data_t *isp_get_ntpd(ispsoftc_t *, tstate_t *);
static ISP_INLINE inot_private_data_t *isp_find_ntpd(ispsoftc_t *, tstate_t *, uint32_t, uint32_t);
static ISP_INLINE void isp_put_ntpd(ispsoftc_t *, tstate_t *, inot_private_data_t *);
static cam_status create_lun_state(ispsoftc_t *, int, struct cam_path *, tstate_t **);
static void destroy_lun_state(ispsoftc_t *, tstate_t *);
static void isp_enable_lun(ispsoftc_t *, union ccb *);
static void isp_enable_deferred_luns(ispsoftc_t *, int);
static cam_status isp_enable_deferred(ispsoftc_t *, int, lun_id_t);
static void isp_disable_lun(ispsoftc_t *, union ccb *);
static int isp_enable_target_mode(ispsoftc_t *, int);
static void isp_ledone(ispsoftc_t *, lun_entry_t *);
static timeout_t isp_refire_putback_atio;
static void isp_complete_ctio(union ccb *);
static void isp_target_putback_atio(union ccb *);
static void isp_target_start_ctio(ispsoftc_t *, union ccb *);
static void isp_handle_platform_atio(ispsoftc_t *, at_entry_t *);
static void isp_handle_platform_atio2(ispsoftc_t *, at2_entry_t *);
static void isp_handle_platform_atio7(ispsoftc_t *, at7_entry_t *);
static void isp_handle_platform_ctio(ispsoftc_t *, void *);
static void isp_handle_platform_notify_scsi(ispsoftc_t *, in_entry_t *);
static void isp_handle_platform_notify_fc(ispsoftc_t *, in_fcentry_t *);
static void isp_handle_platform_notify_24xx(ispsoftc_t *, in_fcentry_24xx_t *);
static int isp_handle_platform_target_notify_ack(ispsoftc_t *, isp_notify_t *);
static void isp_handle_platform_target_tmf(ispsoftc_t *, isp_notify_t *);
static void isp_target_mark_aborted(ispsoftc_t *, union ccb *);
static void isp_target_mark_aborted_early(ispsoftc_t *, tstate_t *, uint32_t);

static ISP_INLINE int
is_lun_enabled(ispsoftc_t *isp, int bus, lun_id_t lun)
{
	tstate_t *tptr;
	struct tslist *lhp;

	ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(lun)], lhp);
	SLIST_FOREACH(tptr, lhp, next) {
		if (xpt_path_lun_id(tptr->owner) == lun) {
			return (1);
		}
	}
	return (0);
}

static void
dump_tstates(ispsoftc_t *isp, int bus)
{
	int i, j;
	struct tslist *lhp;
	tstate_t *tptr = NULL;

	if (bus >= isp->isp_nchan) {
		return;
	}
	for (i = 0; i < LUN_HASH_SIZE; i++) {
		ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
		j = 0;
		SLIST_FOREACH(tptr, lhp, next) {
			xpt_print(tptr->owner, "[%d, %d] atio_cnt=%d inot_cnt=%d\n", i, j, tptr->atio_count, tptr->inot_count);
			j++;
		}
	}
}

static ISP_INLINE tstate_t *
get_lun_statep(ispsoftc_t *isp, int bus, lun_id_t lun)
{
	tstate_t *tptr = NULL;
	struct tslist *lhp;
	int i;

	if (bus < isp->isp_nchan) {
		for (i = 0; i < LUN_HASH_SIZE; i++) {
			ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
			SLIST_FOREACH(tptr, lhp, next) {
				if (xpt_path_lun_id(tptr->owner) == lun) {
					tptr->hold++;
					return (tptr);
				}
			}
		}
	}
	return (NULL);
}

static ISP_INLINE tstate_t *
get_lun_statep_from_tag(ispsoftc_t *isp, int bus, uint32_t tagval)
{
	tstate_t *tptr = NULL;
	atio_private_data_t *atp;
	struct tslist *lhp;
	int i;

	if (bus < isp->isp_nchan && tagval != 0) {
		for (i = 0; i < LUN_HASH_SIZE; i++) {
			ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
			SLIST_FOREACH(tptr, lhp, next) {
				atp = isp_get_atpd(isp, tptr, tagval);
				if (atp && atp->tag == tagval) {
					tptr->hold++;
					return (tptr);
				}
			}
		}
	}
	return (NULL);
}

static ISP_INLINE inot_private_data_t *
get_ntp_from_tagdata(ispsoftc_t *isp, uint32_t tag_id, uint32_t seq_id, tstate_t **rslt)
{
	inot_private_data_t *ntp;
	tstate_t *tptr;
	struct tslist *lhp;
	int bus, i;

	for (bus = 0; bus < isp->isp_nchan; bus++) {
		for (i = 0; i < LUN_HASH_SIZE; i++) {
			ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
			SLIST_FOREACH(tptr, lhp, next) {
				ntp = isp_find_ntpd(isp, tptr, tag_id, seq_id);
				if (ntp) {
					*rslt = tptr;
					tptr->hold++;
					return (ntp);
				}
			}
		}
	}
	return (NULL);
}
static ISP_INLINE void
rls_lun_statep(ispsoftc_t *isp, tstate_t *tptr)
{
	KASSERT((tptr->hold), ("tptr not held"));
	tptr->hold--;
}

static void
isp_tmcmd_restart(ispsoftc_t *isp)
{
	inot_private_data_t *ntp;
	tstate_t *tptr;
	struct tslist *lhp;
	int bus, i;

	for (bus = 0; bus < isp->isp_nchan; bus++) {
		for (i = 0; i < LUN_HASH_SIZE; i++) {
			ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
			SLIST_FOREACH(tptr, lhp, next) {
				inot_private_data_t *restart_queue = tptr->restart_queue;
				tptr->restart_queue = NULL;
				while (restart_queue) {
					ntp = restart_queue;
					restart_queue = ntp->rd.nt.nt_hba;
					if (IS_24XX(isp)) {
						isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at7_entry_t *)ntp->rd.data)->at_rxid);
						isp_handle_platform_atio7(isp, (at7_entry_t *) ntp->rd.data);
					} else {
						isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at2_entry_t *)ntp->rd.data)->at_rxid);
						isp_handle_platform_atio2(isp, (at2_entry_t *) ntp->rd.data);
					}
					isp_put_ntpd(isp, tptr, ntp);
					if (tptr->restart_queue && restart_queue != NULL) {
						ntp = tptr->restart_queue;
						tptr->restart_queue = restart_queue;
						while (restart_queue->rd.nt.nt_hba) {
							restart_queue = restart_queue->rd.nt.nt_hba;
						}
						restart_queue->rd.nt.nt_hba = ntp;
						break;
					}
				}
			}
		}
	}
}

static ISP_INLINE atio_private_data_t *
isp_get_atpd(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag)
{
	atio_private_data_t *atp;

	if (tag == 0) {
		atp = tptr->atfree;
		if (atp) {
			tptr->atfree = atp->next;
		}
		return (atp);
	}
	for (atp = tptr->atpool; atp < &tptr->atpool[ATPDPSIZE]; atp++) {
		if (atp->tag == tag) {
			return (atp);
		}
	}
	return (NULL);
}

static ISP_INLINE void
isp_put_atpd(ispsoftc_t *isp, tstate_t *tptr, atio_private_data_t *atp)
{
	atp->tag = 0;
	atp->dead = 0;
	atp->next = tptr->atfree;
	tptr->atfree = atp;
}

static void
isp_dump_atpd(ispsoftc_t *isp, tstate_t *tptr)
{
	atio_private_data_t *atp;
	const char *states[8] = { "Free", "ATIO", "CAM", "CTIO", "LAST_CTIO", "PDON", "?6", "7" };

	for (atp = tptr->atpool; atp < &tptr->atpool[ATPDPSIZE]; atp++) {
		if (atp->tag == 0) {
			continue;
		}
		xpt_print(tptr->owner, "ATP: [0x%x] origdlen %u bytes_xfrd %u last_xfr %u lun %u nphdl 0x%04x s_id 0x%06x d_id 0x%06x oxid 0x%04x state %s\n",
                    atp->tag, atp->orig_datalen, atp->bytes_xfered, atp->last_xframt, atp->lun, atp->nphdl, atp->sid, atp->portid, atp->oxid, states[atp->state & 0x7]);
	}
}


static ISP_INLINE inot_private_data_t *
isp_get_ntpd(ispsoftc_t *isp, tstate_t *tptr)
{
	inot_private_data_t *ntp;
	ntp = tptr->ntfree;
	if (ntp) {
		tptr->ntfree = ntp->next;
	}
	return (ntp);
}

static ISP_INLINE inot_private_data_t *
isp_find_ntpd(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag_id, uint32_t seq_id)
{
	inot_private_data_t *ntp;
	for (ntp = tptr->ntpool; ntp < &tptr->ntpool[ATPDPSIZE]; ntp++) {
		if (ntp->rd.tag_id == tag_id && ntp->rd.seq_id == seq_id) {
			return (ntp);
		}
	}
	return (NULL);
}

static ISP_INLINE void
isp_put_ntpd(ispsoftc_t *isp, tstate_t *tptr, inot_private_data_t *ntp)
{
	ntp->rd.tag_id = ntp->rd.seq_id = 0;
	ntp->next = tptr->ntfree;
	tptr->ntfree = ntp;
}

static cam_status
create_lun_state(ispsoftc_t *isp, int bus, struct cam_path *path, tstate_t **rslt)
{
	cam_status status;
	lun_id_t lun;
	struct tslist *lhp;
	tstate_t *tptr;
	int i;

	lun = xpt_path_lun_id(path);
	if (lun != CAM_LUN_WILDCARD) {
		if (lun >= ISP_MAX_LUNS(isp)) {
			return (CAM_LUN_INVALID);
		}
	}
	if (is_lun_enabled(isp, bus, lun)) {
		return (CAM_LUN_ALRDY_ENA);
	}
	tptr = kmalloc(sizeof (tstate_t), M_DEVBUF, M_WAITOK | M_ZERO);
	status = xpt_create_path(&tptr->owner, NULL, xpt_path_path_id(path), xpt_path_target_id(path), lun);
	if (status != CAM_REQ_CMP) {
		kfree(tptr, M_DEVBUF);
		return (status);
	}
	SLIST_INIT(&tptr->atios);
	SLIST_INIT(&tptr->inots);
	for (i = 0; i < ATPDPSIZE-1; i++) {
		tptr->atpool[i].next = &tptr->atpool[i+1];
		tptr->ntpool[i].next = &tptr->ntpool[i+1];
	}
	tptr->atfree = tptr->atpool;
	tptr->ntfree = tptr->ntpool;
	tptr->hold = 1;
	ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(xpt_path_lun_id(tptr->owner))], lhp);
	SLIST_INSERT_HEAD(lhp, tptr, next);
	*rslt = tptr;
	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, path, "created tstate\n");
	return (CAM_REQ_CMP);
}

static ISP_INLINE void
destroy_lun_state(ispsoftc_t *isp, tstate_t *tptr)
{
	struct tslist *lhp;
	KASSERT((tptr->hold == 0), ("tptr still held"));
	ISP_GET_PC_ADDR(isp, xpt_path_path_id(tptr->owner), lun_hash[LUN_HASH_FUNC(xpt_path_lun_id(tptr->owner))], lhp);
	SLIST_REMOVE(lhp, tptr, tstate, next);
	xpt_free_path(tptr->owner);
	kfree(tptr, M_DEVBUF);
}

/*
 * Enable a lun.
 */
static void
isp_enable_lun(ispsoftc_t *isp, union ccb *ccb)
{
	tstate_t *tptr = NULL;
	int bus, tm_enabled, target_role;
	target_id_t target;
	lun_id_t lun;

	/*
	 * We only support either a wildcard target/lun or a target ID of zero and a non-wildcard lun
	 */
	bus = XS_CHANNEL(ccb);
	target = ccb->ccb_h.target_id;
	lun = ccb->ccb_h.target_lun;
	if (target != CAM_TARGET_WILDCARD && target != 0) {
		ccb->ccb_h.status = CAM_TID_INVALID;
		xpt_done(ccb);
		return;
	}
	if (target == CAM_TARGET_WILDCARD && lun != CAM_LUN_WILDCARD) {
		ccb->ccb_h.status = CAM_LUN_INVALID;
		xpt_done(ccb);
		return;
	}

	if (target != CAM_TARGET_WILDCARD && lun == CAM_LUN_WILDCARD) {
		ccb->ccb_h.status = CAM_LUN_INVALID;
		xpt_done(ccb);
		return;
	}
	if (isp->isp_dblev & ISP_LOGTDEBUG0) {
		xpt_print(ccb->ccb_h.path, "enabling lun 0x%x on channel %d\n", lun, bus);
	}

	/*
	 * Wait until we're not busy with the lun enables subsystem
	 */
	while (isp->isp_osinfo.tmbusy) {
		isp->isp_osinfo.tmwanted = 1;
		mtx_sleep(isp, &isp->isp_lock, 0, "want_isp_enable_lun", 0);
	}
	isp->isp_osinfo.tmbusy = 1;

	/*
	 * This is as a good a place as any to check f/w capabilities.
	 */

	if (IS_FC(isp)) {
		if (ISP_CAP_TMODE(isp) == 0) {
			xpt_print(ccb->ccb_h.path, "firmware does not support target mode\n");
			ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
			goto done;
		}
		/*
		 * We *could* handle non-SCCLUN f/w, but we'd have to
		 * dork with our already fragile enable/disable code.
		 */
		if (ISP_CAP_SCCFW(isp) == 0) {
			xpt_print(ccb->ccb_h.path, "firmware not SCCLUN capable\n");
			ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
			goto done;
		}

		target_role = (FCPARAM(isp, bus)->role & ISP_ROLE_TARGET) != 0;

	} else {
		target_role = (SDPARAM(isp, bus)->role & ISP_ROLE_TARGET) != 0;
	}

	/*
	 * 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;
		goto done;
	}
	ccb->ccb_h.status = create_lun_state(isp, bus, ccb->ccb_h.path, &tptr);
	if (ccb->ccb_h.status != CAM_REQ_CMP) {
		goto done;
	}

	/*
	 * We have a tricky maneuver to perform here.
	 *
	 * If target mode isn't already enabled here,
	 * *and* our current role includes target mode,
	 * we enable target mode here.
	 *
	 */
	ISP_GET_PC(isp, bus, tm_enabled, tm_enabled);
	if (tm_enabled == 0 && target_role != 0) {
		if (isp_enable_target_mode(isp, bus)) {
			ccb->ccb_h.status = CAM_REQ_CMP_ERR;
			destroy_lun_state(isp, tptr);
			tptr = NULL;
			goto done;
		}
		tm_enabled = 1;
	}

	/*
	 * Now check to see whether this bus is in target mode already.
	 *
	 * If not, a later role change into target mode will finish the job.
	 */
	if (tm_enabled == 0) {
		ISP_SET_PC(isp, bus, tm_enable_defer, 1);
		ccb->ccb_h.status = CAM_REQ_CMP;
		xpt_print(ccb->ccb_h.path, "Target Mode Not Enabled Yet- Lun Enables Deferred\n");
		goto done;
	}

	/*
	 * Enable the lun.
	 */
	ccb->ccb_h.status = isp_enable_deferred(isp, bus, lun);

done:
	if (ccb->ccb_h.status != CAM_REQ_CMP && tptr) {
		destroy_lun_state(isp, tptr);
		tptr = NULL;
	}
	if (tptr) {
		rls_lun_statep(isp, tptr);
	}
	isp->isp_osinfo.tmbusy = 0;
	if (isp->isp_osinfo.tmwanted) {
		isp->isp_osinfo.tmwanted = 0;
		wakeup(isp);
	}
	xpt_done(ccb);
}

static void
isp_enable_deferred_luns(ispsoftc_t *isp, int bus)
{
	/*
	 * XXX: not entirely implemented yet
	 */
	(void) isp_enable_deferred(isp, bus, 0);
}

static uint32_t
isp_enable_deferred(ispsoftc_t *isp, int bus, lun_id_t lun)
{
	cam_status status;

	isp_prt(isp, ISP_LOGTINFO, "%s: bus %d lun %u", __func__, bus, lun);
	if (IS_24XX(isp) || (IS_FC(isp) && ISP_FC_PC(isp, bus)->tm_luns_enabled)) {
		status = CAM_REQ_CMP;
	} else {
		int cmd_cnt, not_cnt;

		if (IS_23XX(isp)) {
			cmd_cnt = DFLT_CMND_CNT;
			not_cnt = DFLT_INOT_CNT;
		} else {
			cmd_cnt = 64;
			not_cnt = 8;
		}
		status = CAM_REQ_INPROG;
		isp->isp_osinfo.rptr = &status;
		if (isp_lun_cmd(isp, RQSTYPE_ENABLE_LUN, bus, lun, DFLT_CMND_CNT, DFLT_INOT_CNT)) {
			status = CAM_RESRC_UNAVAIL;
		} else {
			mtx_sleep(&status, &isp->isp_lock, PRIBIO, "isp_enable_deferred", 0);
		}
		isp->isp_osinfo.rptr = NULL;
	}

	if (status == CAM_REQ_CMP) {
		ISP_SET_PC(isp, bus, tm_luns_enabled, 1);
		isp_prt(isp, ISP_LOGTINFO, "bus %d lun %u now enabled for target mode", bus, lun);
	}
	return (status);
}

static void
isp_disable_lun(ispsoftc_t *isp, union ccb *ccb)
{
	tstate_t *tptr = NULL;
	int bus;
	cam_status status;
	target_id_t target;
	lun_id_t lun;

	bus = XS_CHANNEL(ccb);
	target = ccb->ccb_h.target_id;
	lun = ccb->ccb_h.target_lun;
	if (target != CAM_TARGET_WILDCARD && target != 0) {
		ccb->ccb_h.status = CAM_TID_INVALID;
		xpt_done(ccb);
		return;
	}
	if (target == CAM_TARGET_WILDCARD && lun != CAM_LUN_WILDCARD) {
		ccb->ccb_h.status = CAM_LUN_INVALID;
		xpt_done(ccb);
		return;
	}

	if (target != CAM_TARGET_WILDCARD && lun == CAM_LUN_WILDCARD) {
		ccb->ccb_h.status = CAM_LUN_INVALID;
		xpt_done(ccb);
		return;
	}
	if (isp->isp_dblev & ISP_LOGTDEBUG0) {
		xpt_print(ccb->ccb_h.path, "enabling lun 0x%x on channel %d\n", lun, bus);
	}

	/*
	 * See if we're busy disabling a lun now.
	 */
	while (isp->isp_osinfo.tmbusy) {
		isp->isp_osinfo.tmwanted = 1;
		mtx_sleep(isp, &isp->isp_lock, PRIBIO, "want_isp_disable_lun", 0);
	}
	isp->isp_osinfo.tmbusy = 1;

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

	/*
	 * If we're a 24XX card, we're done.
	 */
	if (IS_24XX(isp)) {
		status = CAM_REQ_CMP;
		goto done;
	}

	/*
	 * For SCC FW, we only deal with lun zero.
	 */
	if (IS_FC(isp)) {
		lun = 0;
	}

	isp->isp_osinfo.rptr = &status;
	status = CAM_REQ_INPROG;
	if (isp_lun_cmd(isp, RQSTYPE_ENABLE_LUN, bus, lun, 0, 0)) {
		status = CAM_RESRC_UNAVAIL;
	} else {
		mtx_sleep(ccb, &isp->isp_lock, PRIBIO, "isp_disable_lun", 0);
	}
done:
	if (status == CAM_REQ_CMP) {
		xpt_print(ccb->ccb_h.path, "now disabled for target mode\n");
	}
	if (tptr) {
		destroy_lun_state(isp, tptr);
	}
	isp->isp_osinfo.rptr = NULL;
	isp->isp_osinfo.tmbusy = 0;
	if (isp->isp_osinfo.tmwanted) {
		isp->isp_osinfo.tmwanted = 0;
		wakeup(isp);
	}
	xpt_done(ccb);
}

static int
isp_enable_target_mode(ispsoftc_t *isp, int bus)
{
	int ct;

	ISP_GET_PC(isp, bus, tm_enabled, ct);
	if (ct != 0) {
		return (0);
	}

	if (IS_SCSI(isp)) {
		mbreg_t mbs;

		MBSINIT(&mbs, MBOX_ENABLE_TARGET_MODE, MBLOGALL, 0);
		mbs.param[0] = MBOX_ENABLE_TARGET_MODE;
		mbs.param[1] = ENABLE_TARGET_FLAG|ENABLE_TQING_FLAG;
		mbs.param[2] = bus << 7;
		if (isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs) < 0 || mbs.param[0] != MBOX_COMMAND_COMPLETE) {
			isp_prt(isp, ISP_LOGERR, "Unable to add Target Role to Bus %d", bus);
			return (EIO);
		}
		SDPARAM(isp, bus)->role |= ISP_ROLE_TARGET;
	}
	ISP_SET_PC(isp, bus, tm_enabled, 1);
	isp_prt(isp, ISP_LOGINFO, "Target Role added to Bus %d", bus);
	return (0);
}

#ifdef	NEEDED
static int
isp_disable_target_mode(ispsoftc_t *isp, int bus)
{
	int ct;

	ISP_GET_PC(isp, bus, tm_enabled, ct);
	if (ct == 0) {
		return (0);
	}

	if (IS_SCSI(isp)) {
		mbreg_t mbs;

		MBSINIT(&mbs, MBOX_ENABLE_TARGET_MODE, MBLOGALL, 0);
		mbs.param[2] = bus << 7;
		if (isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs) < 0 || mbs.param[0] != MBOX_COMMAND_COMPLETE) {
			isp_prt(isp, ISP_LOGERR, "Unable to subtract Target Role to Bus %d", bus);
			return (EIO);
		}
		SDPARAM(isp, bus)->role &= ~ISP_ROLE_TARGET;
	}
	ISP_SET_PC(isp, bus, tm_enabled, 0);
	isp_prt(isp, ISP_LOGINFO, "Target Role subtracted from Bus %d", bus);
	return (0);
}
#endif

static void
isp_ledone(ispsoftc_t *isp, lun_entry_t *lep)
{
	uint32_t *rptr;

	rptr = isp->isp_osinfo.rptr;
	if (lep->le_status != LUN_OK) {
		isp_prt(isp, ISP_LOGERR, "ENABLE/MODIFY LUN returned 0x%x", lep->le_status);
		if (rptr) {
			*rptr = CAM_REQ_CMP_ERR;
			wakeup_one(rptr);
		}
	} else {
		if (rptr) {
			*rptr = CAM_REQ_CMP;
			wakeup_one(rptr);
		}
	}
}

static void
isp_target_start_ctio(ispsoftc_t *isp, union ccb *ccb)
{
	void *qe;
	tstate_t *tptr;
	atio_private_data_t *atp;
	struct ccb_scsiio *cso = &ccb->csio;
	uint32_t dmaresult, handle;
	uint8_t local[QENTRY_LEN];

	/*
	 * Do some sanity checks.
	 */
	if (cso->dxfer_len == 0) {
		if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
			xpt_print(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);
			return;
		}
	}

	tptr = get_lun_statep(isp, XS_CHANNEL(ccb), XS_LUN(ccb));
	if (tptr == NULL) {
		tptr = get_lun_statep(isp, XS_CHANNEL(ccb), CAM_LUN_WILDCARD);
		if (tptr == NULL) {
			xpt_print(ccb->ccb_h.path, "%s: [0x%x] cannot find tstate pointer in %s\n", __func__, cso->tag_id);
			dump_tstates(isp, XS_CHANNEL(ccb));
			ccb->ccb_h.status = CAM_DEV_NOT_THERE;
			xpt_done(ccb);
			return;
		}
	}

	atp = isp_get_atpd(isp, tptr, cso->tag_id);
	if (atp == NULL) {
		xpt_print(ccb->ccb_h.path, "%s: [0x%x] cannot find private data adjunct\n", __func__, cso->tag_id);
		isp_dump_atpd(isp, tptr);
		ccb->ccb_h.status = CAM_REQ_CMP_ERR;
		xpt_done(ccb);
		return;
	}
	if (atp->dead) {
		xpt_print(ccb->ccb_h.path, "%s: [0x%x] stopping sending a CTIO for a dead command\n", __func__, cso->tag_id);
		ccb->ccb_h.status = CAM_REQ_ABORTED;
		xpt_done(ccb);
		return;
	}

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

	/*
	 * Get some resources
	 */
	if (isp_get_pcmd(isp, ccb)) {
		rls_lun_statep(isp, tptr);
		xpt_print(ccb->ccb_h.path, "out of PCMDs\n");
		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);
		return;
	}
	qe = isp_getrqentry(isp);
	if (qe == NULL) {
		xpt_print(ccb->ccb_h.path, rqo, __func__);
		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;
		goto out;
	}
	memset(local, 0, QENTRY_LEN);

	/*
	 * We're either moving data or completing a command here.
	 */
	if (IS_24XX(isp)) {
		ct7_entry_t *cto = (ct7_entry_t *) local;

		cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
		cto->ct_header.rqs_entry_count = 1;
		cto->ct_header.rqs_seqno = 1;
		cto->ct_nphdl = atp->nphdl;
		cto->ct_rxid = atp->tag;
		cto->ct_iid_lo = atp->portid;
		cto->ct_iid_hi = atp->portid >> 16;
		cto->ct_oxid = atp->oxid;
		cto->ct_vpidx = ISP_GET_VPIDX(isp, XS_CHANNEL(ccb));
		cto->ct_scsi_status = cso->scsi_status;
		cto->ct_timeout = 120;
		cto->ct_flags = atp->tattr << CT7_TASK_ATTR_SHIFT;
		if (ccb->ccb_h.flags & CAM_SEND_STATUS) {
			cto->ct_flags |= CT7_SENDSTATUS;
		}
		if (cso->dxfer_len == 0) {
			cto->ct_flags |= CT7_FLAG_MODE1 | CT7_NO_DATA;
			if ((ccb->ccb_h.flags & CAM_SEND_SENSE) != 0) {
				int m = min(cso->sense_len, sizeof (struct scsi_sense_data));
				cto->rsp.m1.ct_resplen = cto->ct_senselen = min(m, MAXRESPLEN_24XX);
				memcpy(cto->rsp.m1.ct_resp, &cso->sense_data, cto->ct_senselen);
				cto->ct_scsi_status |= (FCP_SNSLEN_VALID << 8);
			}
		} else {
			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;
			/*
			 * Don't overrun the limits placed on us
			 */
			if (atp->bytes_xfered + cso->dxfer_len > atp->orig_datalen) {
				cso->dxfer_len = atp->orig_datalen - atp->bytes_xfered;
			}
			atp->last_xframt = cso->dxfer_len;
			cto->rsp.m0.ct_xfrlen = cso->dxfer_len;
		}
		if (cto->ct_flags & CT7_SENDSTATUS) {
			int lvl = (cso->scsi_status)? ISP_LOGTINFO : ISP_LOGTDEBUG0;
			cto->ct_resid = atp->orig_datalen - (atp->bytes_xfered + cso->dxfer_len);
			if (cto->ct_resid < 0) {
				cto->ct_scsi_status |= (FCP_RESID_OVERFLOW << 8);
			} else if (cto->ct_resid > 0) {
				cto->ct_scsi_status |= (FCP_RESID_UNDERFLOW << 8);
			}
			atp->state = ATPD_STATE_LAST_CTIO;
			ISP_PATH_PRT(isp, lvl, cso->ccb_h.path, "%s: CTIO7[%x] CDB0=%x scsi status %x flags %x resid %d xfrlen %u offset %u\n", __func__, cto->ct_rxid,
			    atp->cdb0, cto->ct_scsi_status, cto->ct_flags, cto->ct_resid, cso->dxfer_len, atp->bytes_xfered);
		} else {
			cto->ct_resid = 0;
			ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, cso->ccb_h.path, "%s: CTIO7[%x] flags %x xfrlen %u offset %u\n", __func__, cto->ct_rxid, cto->ct_flags,
			    cso->dxfer_len, atp->bytes_xfered);
			atp->state = ATPD_STATE_CTIO;
		}
	} else if (IS_FC(isp)) {
		ct2_entry_t *cto = (ct2_entry_t *) local;

		cto->ct_header.rqs_entry_type = RQSTYPE_CTIO2;
		cto->ct_header.rqs_entry_count = 1;
		cto->ct_header.rqs_seqno = 1;
		if (ISP_CAP_2KLOGIN(isp) == 0) {
			((ct2e_entry_t *)cto)->ct_iid = cso->init_id;
		} else {
			cto->ct_iid = cso->init_id;
			if (ISP_CAP_SCCFW(isp) == 0) {
				cto->ct_lun = ccb->ccb_h.target_lun;
			}
		}


		cto->ct_rxid = cso->tag_id;
		if (cso->dxfer_len == 0) {
			cto->ct_flags |= CT2_FLAG_MODE1 | CT2_NO_DATA | CT2_SENDSTATUS;
			cto->rsp.m1.ct_scsi_status = cso->scsi_status;
			cto->ct_resid = atp->orig_datalen - atp->bytes_xfered;
			if (cto->ct_resid < 0) {
				cto->rsp.m1.ct_scsi_status |= CT2_DATA_OVER;
			} else if (cto->ct_resid > 0) {
				cto->rsp.m1.ct_scsi_status |= CT2_DATA_UNDER;
			}
			if ((ccb->ccb_h.flags & CAM_SEND_SENSE) != 0) {
				int m = min(cso->sense_len, MAXRESPLEN);
				memcpy(cto->rsp.m1.ct_resp, &cso->sense_data, m);
				cto->rsp.m1.ct_senselen = m;
				cto->rsp.m1.ct_scsi_status |= CT2_SNSLEN_VALID;
			} else if (cso->scsi_status == SCSI_STATUS_CHECK_COND) {
				/*
				 * XXX: DEBUG
				 */
				xpt_print(ccb->ccb_h.path, "CHECK CONDITION being sent without associated SENSE DATA for CDB=0x%x\n", atp->cdb0);
			}
		} else {
			cto->ct_flags |= CT2_FLAG_MODE0;
			if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
				cto->ct_flags |= CT2_DATA_IN;
			} else {
				cto->ct_flags |= CT2_DATA_OUT;
			}
			cto->ct_reloff = atp->bytes_xfered;
			cto->rsp.m0.ct_xfrlen = cso->dxfer_len;
			/*
			 * Don't overrun the limits placed on us
			 */
			if (atp->bytes_xfered + cso->dxfer_len > atp->orig_datalen) {
				cso->dxfer_len = atp->orig_datalen - atp->bytes_xfered;
			}
			if ((ccb->ccb_h.flags & CAM_SEND_STATUS) != 0) {
				cto->ct_flags |= CT2_SENDSTATUS;
				cto->rsp.m0.ct_scsi_status = cso->scsi_status;
				cto->ct_resid = atp->orig_datalen - (atp->bytes_xfered + cso->dxfer_len);
				if (cto->ct_resid < 0) {
					cto->rsp.m0.ct_scsi_status |= CT2_DATA_OVER;
				} else if (cto->ct_resid > 0) {
					cto->rsp.m0.ct_scsi_status |= CT2_DATA_UNDER;
				}
			} else {
				atp->last_xframt = cso->dxfer_len;
			}
			/*
			 * If we're sending data and status back together,
			 * we can't also send back sense data as well.
			 */
			ccb->ccb_h.flags &= ~CAM_SEND_SENSE;
		}

		if (cto->ct_flags & CT2_SENDSTATUS) {
			int lvl = (cso->scsi_status)? ISP_LOGTINFO : ISP_LOGTDEBUG0;
			cto->ct_flags |= CT2_CCINCR;
			atp->state = ATPD_STATE_LAST_CTIO;
			ISP_PATH_PRT(isp, lvl, cso->ccb_h.path, "%s: CTIO2[%x] CDB0=%x scsi status %x flags %x resid %d xfrlen %u offset %u\n", __func__, cto->ct_rxid,
			    atp->cdb0, cto->rsp.m0.ct_scsi_status, cto->ct_flags, cto->ct_resid, cso->dxfer_len, atp->bytes_xfered);
		} else {
			cto->ct_resid = 0;
			atp->state = ATPD_STATE_CTIO;
			ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: CTIO2[%x] flags %x xfrlen %u offset %u\n", __func__, cto->ct_rxid, cto->ct_flags,
			    cso->dxfer_len, atp->bytes_xfered);
		}
		cto->ct_timeout = 10;
	} else {
		ct_entry_t *cto = (ct_entry_t *) local;

		cto->ct_header.rqs_entry_type = RQSTYPE_CTIO;
		cto->ct_header.rqs_entry_count = 1;
		cto->ct_header.rqs_seqno = 1;
		cto->ct_iid = cso->init_id;
		cto->ct_iid |= XS_CHANNEL(ccb) << 7;
		cto->ct_tgt = ccb->ccb_h.target_id;
		cto->ct_lun = ccb->ccb_h.target_lun;
		cto->ct_fwhandle = cso->tag_id >> 16;
		if (AT_HAS_TAG(cso->tag_id)) {
			cto->ct_tag_val = cso->tag_id;
			cto->ct_flags |= CT_TQAE;
		}
		if (ccb->ccb_h.flags & CAM_DIS_DISCONNECT) {
			cto->ct_flags |= CT_NODISC;
		}
		if (cso->dxfer_len == 0) {
			cto->ct_flags |= CT_NO_DATA;
		} else if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
			cto->ct_flags |= CT_DATA_IN;
		} else {
			cto->ct_flags |= CT_DATA_OUT;
		}
		if (ccb->ccb_h.flags & CAM_SEND_STATUS) {
			cto->ct_flags |= CT_SENDSTATUS|CT_CCINCR;
			cto->ct_scsi_status = cso->scsi_status;
			cto->ct_resid = cso->resid;
			ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: CTIO[%x] scsi status %x resid %d tag_id %x\n", __func__,
			    cto->ct_fwhandle, cso->scsi_status, cso->resid, cso->tag_id);
		}
		ccb->ccb_h.flags &= ~CAM_SEND_SENSE;
		cto->ct_timeout = 10;
	}

	if (isp_allocate_xs_tgt(isp, ccb, &handle)) {
		xpt_print(ccb->ccb_h.path, "No XFLIST pointers for %s\n", __func__);
		ccb->ccb_h.status = CAM_REQUEUE_REQ;
		goto out;
	}


	/*
	 * 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.
	 */

	if (IS_24XX(isp)) {
		ct7_entry_t *cto = (ct7_entry_t *) local;
		cto->ct_syshandle = handle;
	} else if (IS_FC(isp)) {
		ct2_entry_t *cto = (ct2_entry_t *) local;
		cto->ct_syshandle = handle;
	} else {
		ct_entry_t *cto = (ct_entry_t *) local;
		cto->ct_syshandle = handle;
	}

	dmaresult = ISP_DMASETUP(isp, cso, (ispreq_t *) local);
	if (dmaresult == CMD_QUEUED) {
		isp->isp_nactive++;
		ccb->ccb_h.status |= CAM_SIM_QUEUED;
		rls_lun_statep(isp, tptr);
		return;
	}
	if (dmaresult == CMD_EAGAIN) {
		ccb->ccb_h.status = CAM_REQUEUE_REQ;
	} else {
		ccb->ccb_h.status = CAM_REQ_CMP_ERR;
	}
	isp_destroy_tgt_handle(isp, handle);
out:
	rls_lun_statep(isp, tptr);
	isp_free_pcmd(isp, ccb);
	xpt_done(ccb);
}

static void
isp_refire_putback_atio(void *arg)
{
	union ccb *ccb = arg;
	ispsoftc_t *isp = XS_ISP(ccb);
	ISP_LOCK(isp);
	isp_target_putback_atio(ccb);
	ISP_UNLOCK(isp);
}

static void
isp_target_putback_atio(union ccb *ccb)
{
	ispsoftc_t *isp;
	struct ccb_scsiio *cso;
	void *qe;

	isp = XS_ISP(ccb);

	qe = isp_getrqentry(isp);
	if (qe == NULL) {
		xpt_print(ccb->ccb_h.path, rqo, __func__);
		(void) timeout(isp_refire_putback_atio, ccb, 10);
		return;
	}
	memset(qe, 0, QENTRY_LEN);
	cso = &ccb->csio;
	if (IS_FC(isp)) {
		at2_entry_t local, *at = &local;
		ISP_MEMZERO(at, sizeof (at2_entry_t));
		at->at_header.rqs_entry_type = RQSTYPE_ATIO2;
		at->at_header.rqs_entry_count = 1;
		if (ISP_CAP_SCCFW(isp)) {
			at->at_scclun = (uint16_t) ccb->ccb_h.target_lun;
		} else {
			at->at_lun = (uint8_t) ccb->ccb_h.target_lun;
		}
		at->at_status = CT_OK;
		at->at_rxid = cso->tag_id;
		at->at_iid = cso->ccb_h.target_id;
		isp_put_atio2(isp, at, qe);
	} else {
		at_entry_t local, *at = &local;
		ISP_MEMZERO(at, sizeof (at_entry_t));
		at->at_header.rqs_entry_type = RQSTYPE_ATIO;
		at->at_header.rqs_entry_count = 1;
		at->at_iid = cso->init_id;
		at->at_iid |= XS_CHANNEL(ccb) << 7;
		at->at_tgt = cso->ccb_h.target_id;
		at->at_lun = cso->ccb_h.target_lun;
		at->at_status = CT_OK;
		at->at_tag_val = AT_GET_TAG(cso->tag_id);
		at->at_handle = AT_GET_HANDLE(cso->tag_id);
		isp_put_atio(isp, at, qe);
	}
	ISP_TDQE(isp, "isp_target_putback_atio", isp->isp_reqidx, qe);
	ISP_SYNC_REQUEST(isp);
	isp_complete_ctio(ccb);
}

static void
isp_complete_ctio(union ccb *ccb)
{
	if ((ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_INPROG) {
		ccb->ccb_h.status |= CAM_REQ_CMP;
	}
	ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
	isp_free_pcmd(XS_ISP(ccb), ccb);
	xpt_done(ccb);
}

/*
 * Handle ATIO stuff that the generic code can't.
 * This means handling CDBs.
 */

static void
isp_handle_platform_atio(ispsoftc_t *isp, at_entry_t *aep)
{
	tstate_t *tptr;
	int status, bus;
	struct ccb_accept_tio *atiop;
	atio_private_data_t *atp;

	/*
	 * The firmware status (except for the QLTM_SVALID bit)
	 * indicates why this ATIO was sent to us.
	 *
	 * If QLTM_SVALID is set, the firmware has recommended Sense Data.
	 *
	 * If the DISCONNECTS DISABLED bit is set in the flags field,
	 * we're still connected on the SCSI bus.
	 */
	status = aep->at_status;
	if ((status & ~QLTM_SVALID) == AT_PHASE_ERROR) {
		/*
		 * Bus Phase Sequence error. We should have sense data
		 * suggested by the f/w. I'm not sure quite yet what
		 * to do about this for CAM.
		 */
		isp_prt(isp, ISP_LOGWARN, "PHASE ERROR");
		isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
		return;
	}
	if ((status & ~QLTM_SVALID) != AT_CDB) {
		isp_prt(isp, ISP_LOGWARN, "bad atio (0x%x) leaked to platform", status);
		isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
		return;
	}

	bus = GET_BUS_VAL(aep->at_iid);
	tptr = get_lun_statep(isp, bus, aep->at_lun);
	if (tptr == NULL) {
		tptr = get_lun_statep(isp, bus, CAM_LUN_WILDCARD);
		if (tptr == NULL) {
			/*
			 * Because we can't autofeed sense data back with
			 * a command for parallel SCSI, we can't give back
			 * a CHECK CONDITION. We'll give back a BUSY status
			 * instead. This works out okay because the only
			 * time we should, in fact, get this, is in the
			 * case that somebody configured us without the
			 * blackhole driver, so they get what they deserve.
			 */
			isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
			return;
		}
	}

	atp = isp_get_atpd(isp, tptr, 0);
	atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
	if (atiop == NULL || atp == NULL) {
		/*
		 * Because we can't autofeed sense data back with
		 * a command for parallel SCSI, we can't give back
		 * a CHECK CONDITION. We'll give back a QUEUE FULL status
		 * instead. This works out okay because the only time we
		 * should, in fact, get this, is in the case that we've
		 * run out of ATIOS.
		 */
		xpt_print(tptr->owner, "no %s for lun %d from initiator %d\n", (atp == NULL && atiop == NULL)? "ATIOs *or* ATPS" :
		    ((atp == NULL)? "ATPs" : "ATIOs"), aep->at_lun, aep->at_iid);
		isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
		if (atp) {
			isp_put_atpd(isp, tptr, atp);
		}
		rls_lun_statep(isp, tptr);
		return;
	}
	atp->tag = aep->at_tag_val;
	if (atp->tag == 0) {
		atp->tag = ~0;
	}
	atp->state = ATPD_STATE_ATIO;
	SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
	tptr->atio_count--;
	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, atiop->ccb_h.path, "Take FREE ATIO count now %d\n", tptr->atio_count);
	atiop->ccb_h.target_id = aep->at_tgt;
	atiop->ccb_h.target_lun = aep->at_lun;
	if (aep->at_flags & AT_NODISC) {
		atiop->ccb_h.flags = CAM_DIS_DISCONNECT;
	} else {
		atiop->ccb_h.flags = 0;
	}

	if (status & QLTM_SVALID) {
		size_t amt = ISP_MIN(QLTM_SENSELEN, sizeof (atiop->sense_data));
		atiop->sense_len = amt;
		ISP_MEMCPY(&atiop->sense_data, aep->at_sense, amt);
	} else {
		atiop->sense_len = 0;
	}

	atiop->init_id = GET_IID_VAL(aep->at_iid);
	atiop->cdb_len = aep->at_cdblen;
	ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cdb, aep->at_cdblen);
	atiop->ccb_h.status = CAM_CDB_RECVD;
	/*
	 * Construct a tag 'id' based upon tag value (which may be 0..255)
	 * and the handle (which we have to preserve).
	 */
	atiop->tag_id = atp->tag;
	if (aep->at_flags & AT_TQAE) {
		atiop->tag_action = aep->at_tag_type;
		atiop->ccb_h.status |= CAM_TAG_ACTION_VALID;
	}
	atp->orig_datalen = 0;
	atp->bytes_xfered = 0;
	atp->last_xframt = 0;
	atp->lun = aep->at_lun;
	atp->nphdl = aep->at_iid;
	atp->portid = PORT_NONE;
	atp->oxid = 0;
	atp->cdb0 = atiop->cdb_io.cdb_bytes[0];
	atp->tattr = aep->at_tag_type;
	atp->state = ATPD_STATE_CAM;
	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, tptr->owner, "ATIO[%x] CDB=0x%x lun %d\n", aep->at_tag_val, atp->cdb0, atp->lun);
	rls_lun_statep(isp, tptr);
}

static void
isp_handle_platform_atio2(ispsoftc_t *isp, at2_entry_t *aep)
{
	lun_id_t lun;
	fcportdb_t *lp;
	tstate_t *tptr;
	struct ccb_accept_tio *atiop;
	uint16_t nphdl;
	atio_private_data_t *atp;
	inot_private_data_t *ntp;

	/*
	 * The firmware status (except for the QLTM_SVALID bit)
	 * indicates why this ATIO was sent to us.
	 *
	 * If QLTM_SVALID is set, the firmware has recommended Sense Data.
	 */
	if ((aep->at_status & ~QLTM_SVALID) != AT_CDB) {
		isp_prt(isp, ISP_LOGWARN, "bogus atio (0x%x) leaked to platform", aep->at_status);
		isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
		return;
	}

	if (ISP_CAP_SCCFW(isp)) {
		lun = aep->at_scclun;
	} else {
		lun = aep->at_lun;
	}
	if (ISP_CAP_2KLOGIN(isp)) {
		nphdl = ((at2e_entry_t *)aep)->at_iid;
	} else {
		nphdl = aep->at_iid;
	}
	tptr = get_lun_statep(isp, 0, lun);
	if (tptr == NULL) {
		tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
		if (tptr == NULL) {
			isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] no state pointer for lun %d", aep->at_rxid, lun);
			isp_endcmd(isp, aep, SCSI_STATUS_CHECK_COND | ECMD_SVALID | (0x5 << 12) | (0x25 << 16), 0);
			return;
		}
	}

	/*
	 * Start any commands pending resources first.
	 */
	if (tptr->restart_queue) {
		inot_private_data_t *restart_queue = tptr->restart_queue;
		tptr->restart_queue = NULL;
		while (restart_queue) {
			ntp = restart_queue;
			restart_queue = ntp->rd.nt.nt_hba;
			isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at2_entry_t *)ntp->rd.data)->at_rxid);
			isp_handle_platform_atio2(isp, (at2_entry_t *) ntp->rd.data);
			isp_put_ntpd(isp, tptr, ntp);
			/*
			 * If a recursion caused the restart queue to start to fill again,
			 * stop and splice the new list on top of the old list and restore
			 * it and go to noresrc.
			 */
			if (tptr->restart_queue) {
				ntp = tptr->restart_queue;
				tptr->restart_queue = restart_queue;
				while (restart_queue->rd.nt.nt_hba) {
					restart_queue = restart_queue->rd.nt.nt_hba;
				}
				restart_queue->rd.nt.nt_hba = ntp;
				goto noresrc;
			}
		}
	}

	atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
	if (atiop == NULL) {
		goto noresrc;
	}

	atp = isp_get_atpd(isp, tptr, 0);
	if (atp == NULL) {
		goto noresrc;
	}

	atp->tag = aep->at_rxid;
	atp->state = ATPD_STATE_ATIO;
	SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
	tptr->atio_count--;
	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, atiop->ccb_h.path, "Take FREE ATIO count now %d\n", tptr->atio_count);
	atiop->ccb_h.target_id = FCPARAM(isp, 0)->isp_loopid;
	atiop->ccb_h.target_lun = lun;

	/*
	 * We don't get 'suggested' sense data as we do with SCSI cards.
	 */
	atiop->sense_len = 0;
	if (ISP_CAP_2KLOGIN(isp)) {
		/*
		 * NB: We could not possibly have 2K logins if we
		 * NB: also did not have SCC FW.
		 */
		atiop->init_id = ((at2e_entry_t *)aep)->at_iid;
	} else {
		atiop->init_id = aep->at_iid;
	}

	/*
	 * If we're not in the port database, add ourselves.
	 */
	if (!IS_2100(isp) && isp_find_pdb_by_loopid(isp, 0, atiop->init_id, &lp) == 0) {
		uint64_t iid =
			(((uint64_t) aep->at_wwpn[0]) << 48) |
			(((uint64_t) aep->at_wwpn[1]) << 32) |
			(((uint64_t) aep->at_wwpn[2]) << 16) |
			(((uint64_t) aep->at_wwpn[3]) <<  0);
		/*
		 * However, make sure we delete ourselves if otherwise
		 * we were there but at a different loop id.
		 */
		if (isp_find_pdb_by_wwn(isp, 0, iid, &lp)) {
			isp_del_wwn_entry(isp, 0, iid, lp->handle, lp->portid);
		}
		isp_add_wwn_entry(isp, 0, iid, atiop->init_id, PORT_ANY);
	}
	atiop->cdb_len = ATIO2_CDBLEN;
	ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cdb, ATIO2_CDBLEN);
	atiop->ccb_h.status = CAM_CDB_RECVD;
	atiop->tag_id = atp->tag;
	switch (aep->at_taskflags & ATIO2_TC_ATTR_MASK) {
	case ATIO2_TC_ATTR_SIMPLEQ:
		atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
		atiop->tag_action = MSG_SIMPLE_Q_TAG;
		break;
	case ATIO2_TC_ATTR_HEADOFQ:
		atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
		atiop->tag_action = MSG_HEAD_OF_Q_TAG;
		break;
	case ATIO2_TC_ATTR_ORDERED:
		atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
		atiop->tag_action = MSG_ORDERED_Q_TAG;
		break;
	case ATIO2_TC_ATTR_ACAQ:		/* ?? */
	case ATIO2_TC_ATTR_UNTAGGED:
	default:
		atiop->tag_action = 0;
		break;
	}

	atp->orig_datalen = aep->at_datalen;
	atp->bytes_xfered = 0;
	atp->last_xframt = 0;
	atp->lun = lun;
	atp->nphdl = atiop->init_id;
	atp->sid = PORT_ANY;
	atp->oxid = aep->at_oxid;
	atp->cdb0 = aep->at_cdb[0];
	atp->tattr = aep->at_taskflags & ATIO2_TC_ATTR_MASK;
	atp->state = ATPD_STATE_CAM;
	xpt_done((union ccb *)atiop);
	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, tptr->owner, "ATIO2[%x] CDB=0x%x lun %d datalen %u\n", aep->at_rxid, atp->cdb0, lun, atp->orig_datalen);
	rls_lun_statep(isp, tptr);
	return;
noresrc:
	ntp = isp_get_ntpd(isp, tptr);
	if (ntp == NULL) {
		rls_lun_statep(isp, tptr);
		isp_endcmd(isp, aep, nphdl, 0, SCSI_STATUS_BUSY, 0);
		return;
	}
	memcpy(ntp->rd.data, aep, QENTRY_LEN);
	ntp->rd.nt.nt_hba = tptr->restart_queue;
	tptr->restart_queue = ntp;
	rls_lun_statep(isp, tptr);
}

static void
isp_handle_platform_atio7(ispsoftc_t *isp, at7_entry_t *aep)
{
	int cdbxlen;
	uint16_t lun, chan, nphdl = NIL_HANDLE;
	uint32_t did, sid;
	uint64_t wwn = INI_NONE;
	fcportdb_t *lp;
	tstate_t *tptr;
	struct ccb_accept_tio *atiop;
	atio_private_data_t *atp = NULL;
	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 = (aep->at_cmnd.fcp_cmnd_lun[0] << 8) | aep->at_cmnd.fcp_cmnd_lun[1];

	/*
	 * Find the N-port handle, and Virtual Port Index for this command.
	 *
	 * If we can't, we're somewhat in trouble because we can't actually respond w/o that information.
	 * We also, as a matter of course, need to know the WWN of the initiator too.
	 */
	if (ISP_CAP_MULTI_ID(isp)) {
		/*
		 * Find the right channel based upon D_ID
		 */
		isp_find_chan_by_did(isp, did, &chan);

		if (chan == ISP_NOCHAN) {
			NANOTIME_T now;

			/*
			 * If we don't recognizer our own D_DID, terminate the exchange, unless we're within 2 seconds of startup
			 * It's a bit tricky here as we need to stash this command *somewhere*.
			 */
			GET_NANOTIME(&now);
			if (NANOTIME_SUB(&isp->isp_init_time, &now) > 2000000000ULL) {
				isp_prt(isp, ISP_LOGWARN, "%s: [RX_ID 0x%x] D_ID %x not found on any channel- dropping", __func__, aep->at_rxid, did);
				isp_endcmd(isp, aep, NIL_HANDLE, ISP_NOCHAN, ECMD_TERMINATE, 0);
				return;
			}
			tptr = get_lun_statep(isp, 0, 0);
			if (tptr == NULL) {
				tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
				if (tptr == NULL) {
					isp_prt(isp, ISP_LOGWARN, "%s: [RX_ID 0x%x] D_ID %x not found on any channel and no tptr- dropping", __func__, aep->at_rxid, did);
					isp_endcmd(isp, aep, NIL_HANDLE, ISP_NOCHAN, ECMD_TERMINATE, 0);
					return;
				}
			}
			isp_prt(isp, ISP_LOGWARN, "%s: [RX_ID 0x%x] D_ID %x not found on any channel- deferring", __func__, aep->at_rxid, did);
			goto noresrc;
		}
		isp_prt(isp, ISP_LOGTDEBUG0, "%s: [RX_ID 0x%x] D_ID 0x%06x found on Chan %d for S_ID 0x%06x", __func__, aep->at_rxid, did, chan, sid);
	} else {
		chan = 0;
	}

	/*
	 * Find the PDB entry for this initiator
	 */
	if (isp_find_pdb_by_sid(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_endcmd(isp, aep, NIL_HANDLE, chan, ECMD_TERMINATE, 0);
		return;
	}
	nphdl = lp->handle;
	wwn = lp->port_wwn;

	/*
	 * 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_LOGTDEBUG0, "[0x%x] no state pointer for lun %d or wildcard", aep->at_rxid, lun);
			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 (tptr->restart_queue) {
		inot_private_data_t *restart_queue = tptr->restart_queue;
		tptr->restart_queue = NULL;
		while (restart_queue) {
			ntp = restart_queue;
			restart_queue = ntp->rd.nt.nt_hba;
			isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at7_entry_t *)ntp->rd.data)->at_rxid);
			isp_handle_platform_atio7(isp, (at7_entry_t *) ntp->rd.data);
			isp_put_ntpd(isp, tptr, ntp);
			/*
			 * If a recursion caused the restart queue to start to fill again,
			 * stop and splice the new list on top of the old list and restore
			 * it and go to noresrc.
			 */
			if (tptr->restart_queue) {
				if (restart_queue) {
					ntp = tptr->restart_queue;
					tptr->restart_queue = restart_queue;
					while (restart_queue->rd.nt.nt_hba) {
						restart_queue = restart_queue->rd.nt.nt_hba;
					}
					restart_queue->rd.nt.nt_hba = ntp;
				}
				goto noresrc;
			}
		}
	}

	/*
	 * If the f/w is out of resources, just send a BUSY status back.
	 */
	if (aep->at_rxid == AT7_NORESRC_RXID) {
		rls_lun_statep(isp, tptr);
		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;
	}

	atp = isp_get_atpd(isp, tptr, 0);
	if (atp == NULL) {
		isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] out of atps", aep->at_rxid);
		goto noresrc;
	}
	if (isp_get_atpd(isp, tptr, aep->at_rxid)) {
		isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] tag wraparound in isp_handle_platforms_atio7 (N-Port Handle 0x%04x S_ID 0x%04x OX_ID 0x%04x)\n",
		    aep->at_rxid, nphdl, sid, aep->at_hdr.ox_id);
		/*
		 * It's not a "no resource" condition- but we can treat it like one
		 */
		goto noresrc;
	}

	atp->tag = aep->at_rxid;
	atp->state = ATPD_STATE_ATIO;
	SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
	tptr->atio_count--;
	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, atiop->ccb_h.path, "Take FREE ATIO count now %d\n", tptr->atio_count);
	atiop->init_id = nphdl;
	atiop->ccb_h.target_id = FCPARAM(isp, chan)->isp_loopid;
	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_Q_TAG;
		break;
	case FCP_CMND_TASK_ATTR_HEAD:
		atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
		atiop->tag_action = MSG_HEAD_OF_Q_TAG;
		break;
	case FCP_CMND_TASK_ATTR_ORDERED:
		atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
		atiop->tag_action = MSG_ORDERED_Q_TAG;
		break;
	default:
		/* FALLTHROUGH */
	case FCP_CMND_TASK_ATTR_ACA:
	case FCP_CMND_TASK_ATTR_UNTAGGED:
		atiop->tag_action = 0;
		break;
	}
	atp->orig_datalen = aep->at_cmnd.cdb_dl.sf.fcp_cmnd_dl;
	atp->bytes_xfered = 0;
	atp->last_xframt = 0;
	atp->lun = lun;
	atp->nphdl = nphdl;
	atp->portid = sid;
	atp->oxid = aep->at_hdr.ox_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_PATH_PRT(isp, ISP_LOGTDEBUG0, tptr->owner, "ATIO7[%x] CDB=0x%x lun %d datalen %u\n", aep->at_rxid, atp->cdb0, lun, atp->orig_datalen);
	xpt_done((union ccb *)atiop);
	rls_lun_statep(isp, tptr);
	return;
noresrc:
	if (atp) {
		isp_put_atpd(isp, tptr, atp);
	}
	ntp = isp_get_ntpd(isp, tptr);
	if (ntp == NULL) {
		rls_lun_statep(isp, tptr);
		isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_BUSY, 0);
		return;
	}
	memcpy(ntp->rd.data, aep, QENTRY_LEN);
	ntp->rd.nt.nt_hba = tptr->restart_queue;
	tptr->restart_queue = ntp;
	rls_lun_statep(isp, tptr);
}

static void
isp_handle_platform_ctio(ispsoftc_t *isp, void *arg)
{
	union ccb *ccb;
	int sentstatus, ok, notify_cam, resid = 0;
	tstate_t *tptr = NULL;
	atio_private_data_t *atp = NULL;
	int bus;
	uint32_t tval, handle;

	/*
	 * CTIO handles are 16 bits.
	 * CTIO2 and CTIO7 are 32 bits.
	 */

	if (IS_SCSI(isp)) {
		handle = ((ct_entry_t *)arg)->ct_syshandle;
	} else {
		handle = ((ct2_entry_t *)arg)->ct_syshandle;
	}
	ccb = isp_find_xs_tgt(isp, handle);
	if (ccb == NULL) {
		isp_print_bytes(isp, "null ccb in isp_handle_platform_ctio", QENTRY_LEN, arg);
		return;
	}
	isp_destroy_tgt_handle(isp, handle);
	bus = XS_CHANNEL(ccb);
	tptr = get_lun_statep(isp, bus, XS_LUN(ccb));
	if (tptr == NULL) {
		tptr = get_lun_statep(isp, bus, CAM_LUN_WILDCARD);
	}
	KASSERT((tptr != NULL), ("cannot get state pointer"));
	if (isp->isp_nactive) {
		isp->isp_nactive++;
	}
	if (IS_24XX(isp)) {
		ct7_entry_t *ct = arg;

		atp = isp_get_atpd(isp, tptr, ct->ct_rxid);
		if (atp == NULL) {
			rls_lun_statep(isp, tptr);
			isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x after I/O", __func__, ct->ct_rxid);
			return;
		}

		sentstatus = ct->ct_flags & CT7_SENDSTATUS;
		ok = (ct->ct_nphdl == CT7_OK);
		if (ok && sentstatus && (ccb->ccb_h.flags & CAM_SEND_SENSE)) {
			ccb->ccb_h.status |= CAM_SENT_SENSE;
		}
		notify_cam = ct->ct_header.rqs_seqno & 0x1;
		if ((ct->ct_flags & CT7_DATAMASK) != CT7_NO_DATA) {
			resid = ct->ct_resid;
			atp->bytes_xfered += (atp->last_xframt - resid);
			atp->last_xframt = 0;
		}
		if (ct->ct_nphdl == CT_HBA_RESET) {
			ok = 0;
			notify_cam = 1;
			sentstatus = 1;
			ccb->ccb_h.status |= CAM_UNREC_HBA_ERROR;
		} else if (!ok) {
			ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
		}
		tval = atp->tag;
		isp_prt(isp, ok? ISP_LOGTDEBUG0 : ISP_LOGWARN, "%s: CTIO7[%x] sts 0x%x flg 0x%x sns %d resid %d %s", __func__,
		    ct->ct_rxid, ct->ct_nphdl, ct->ct_flags, (ccb->ccb_h.status & CAM_SENT_SENSE) != 0, resid, sentstatus? "FIN" : "MID");
		atp->state = ATPD_STATE_PDON; /* XXX: should really come after isp_complete_ctio */
	} else if (IS_FC(isp)) {
		ct2_entry_t *ct = arg;

		atp = isp_get_atpd(isp, tptr, ct->ct_rxid);
		if (atp == NULL) {
			rls_lun_statep(isp, tptr);
			isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x after I/O", __func__, ct->ct_rxid);
			return;
		}
		sentstatus = ct->ct_flags & CT2_SENDSTATUS;
		ok = (ct->ct_status & ~QLTM_SVALID) == CT_OK;
		if (ok && sentstatus && (ccb->ccb_h.flags & CAM_SEND_SENSE)) {
			ccb->ccb_h.status |= CAM_SENT_SENSE;
		}
		notify_cam = ct->ct_header.rqs_seqno & 0x1;
		if ((ct->ct_flags & CT2_DATAMASK) != CT2_NO_DATA) {
			resid = ct->ct_resid;
			atp->bytes_xfered += (atp->last_xframt - resid);
			atp->last_xframt = 0;
		}
		if (ct->ct_status == CT_HBA_RESET) {
			ok = 0;
			notify_cam = 1;
			sentstatus = 1;
			ccb->ccb_h.status |= CAM_UNREC_HBA_ERROR;
		} else if (!ok) {
			ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
		}
		isp_prt(isp, ok? ISP_LOGTDEBUG0 : ISP_LOGWARN, "%s: CTIO2[%x] sts 0x%x flg 0x%x sns %d resid %d %s", __func__,
		    ct->ct_rxid, ct->ct_status, ct->ct_flags, (ccb->ccb_h.status & CAM_SENT_SENSE) != 0, resid, sentstatus? "FIN" : "MID");
		tval = atp->tag;
		atp->state = ATPD_STATE_PDON; /* XXX: should really come after isp_complete_ctio */
	} else {
		ct_entry_t *ct = arg;
		sentstatus = ct->ct_flags & CT_SENDSTATUS;
		ok = (ct->ct_status  & ~QLTM_SVALID) == CT_OK;
		/*
		 * We *ought* to be able to get back to the original ATIO
		 * here, but for some reason this gets lost. It's just as
		 * well because it's squirrelled away as part of periph
		 * private data.
		 *
		 * We can live without it as long as we continue to use
		 * the auto-replenish feature for CTIOs.
		 */
		notify_cam = ct->ct_header.rqs_seqno & 0x1;
		if (ct->ct_status == (CT_HBA_RESET & 0xff)) {
			ok = 0;
			notify_cam = 1;
			sentstatus = 1;
			ccb->ccb_h.status |= CAM_UNREC_HBA_ERROR;
		} else if (!ok) {
			ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
		} else if (ct->ct_status & QLTM_SVALID) {
			char *sp = (char *)ct;
			sp += CTIO_SENSE_OFFSET;
			ccb->csio.sense_len = min(sizeof (ccb->csio.sense_data), QLTM_SENSELEN);
			ISP_MEMCPY(&ccb->csio.sense_data, sp, ccb->csio.sense_len);
			ccb->ccb_h.status |= CAM_AUTOSNS_VALID;
		}
		if ((ct->ct_flags & CT_DATAMASK) != CT_NO_DATA) {
			resid = ct->ct_resid;
		}
		isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO[%x] tag %x S_ID 0x%x lun %d sts %x flg %x resid %d %s", __func__,
		    ct->ct_fwhandle, ct->ct_tag_val, ct->ct_iid, ct->ct_lun, ct->ct_status, ct->ct_flags, resid, sentstatus? "FIN" : "MID");
		tval = ct->ct_fwhandle;
	}
	ccb->csio.resid += resid;

	/*
	 * We're here either because intermediate data transfers are done
	 * and/or the final status CTIO (which may have joined with a
	 * Data Transfer) is done.
	 *
	 * In any case, for this platform, the upper layers figure out
	 * what to do next, so all we do here is collect status and
	 * pass information along. Any DMA handles have already been
	 * freed.
	 */
	if (notify_cam == 0) {
		isp_prt(isp, ISP_LOGTDEBUG0, "  INTER CTIO[0x%x] done", tval);
		return;
	}
	if (tptr) {
		rls_lun_statep(isp, tptr);
	}
	isp_prt(isp, ISP_LOGTDEBUG0, "%s CTIO[0x%x] done", (sentstatus)? "  FINAL " : "MIDTERM ", tval);

	if (!ok && !IS_24XX(isp)) {
		isp_target_putback_atio(ccb);
	} else {
		isp_complete_ctio(ccb);
	}
}

static void
isp_handle_platform_notify_scsi(ispsoftc_t *isp, in_entry_t *inot)
{
	(void) isp_notify_ack(isp, inot);
}

static void
isp_handle_platform_notify_fc(ispsoftc_t *isp, in_fcentry_t *inp)
{
	int needack = 1;
	switch (inp->in_status) {
	case IN_PORT_LOGOUT:
		/*
		 * XXX: Need to delete this initiator's WWN from the database
		 * XXX: Need to send this LOGOUT upstream
		 */
		isp_prt(isp, ISP_LOGWARN, "port logout of S_ID 0x%x", inp->in_iid);
		break;
	case IN_PORT_CHANGED:
		isp_prt(isp, ISP_LOGWARN, "port changed for S_ID 0x%x", inp->in_iid);
		break;
	case IN_GLOBAL_LOGO:
		isp_del_all_wwn_entries(isp, 0);
		isp_prt(isp, ISP_LOGINFO, "all ports logged out");
		break;
	case IN_ABORT_TASK:
	{
		tstate_t *tptr;
		uint16_t lun;
		uint32_t loopid;
		uint64_t wwn;
		atio_private_data_t *atp;
		fcportdb_t *lp;
		struct ccb_immediate_notify *inot = NULL;

		if (ISP_CAP_SCCFW(isp)) {
			lun = inp->in_scclun;
		} else {
			lun = inp->in_lun;
		}
		if (ISP_CAP_2KLOGIN(isp)) {
			loopid = ((in_fcentry_e_t *)inp)->in_iid;
		} else {
			loopid = inp->in_iid;
		}
		if (isp_find_pdb_by_loopid(isp, 0, loopid, &lp)) {
			wwn = lp->port_wwn;
		} else {
			wwn = INI_ANY;
		}
		tptr = get_lun_statep(isp, 0, lun);
		if (tptr == NULL) {
			tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
			if (tptr == NULL) {
				isp_prt(isp, ISP_LOGWARN, "ABORT TASK for lun %u- but no tstate", lun);
				return;
			}
		}
		atp = isp_get_atpd(isp, tptr, inp->in_seqid);

		if (atp) {
			inot = (struct ccb_immediate_notify *) SLIST_FIRST(&tptr->inots);
			isp_prt(isp, ISP_LOGTDEBUG0, "ABORT TASK RX_ID %x WWN 0x%016llx state %d", inp->in_seqid, (unsigned long long) wwn, atp->state);
			if (inot) {
				tptr->inot_count--;
				SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
				ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, inot->ccb_h.path, "%s: Take FREE INOT count now %d\n", __func__, tptr->inot_count);
			} else {
				ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, tptr->owner, "out of INOT structures\n");
			}
		} else {
			ISP_PATH_PRT(isp, ISP_LOGWARN, tptr->owner, "abort task RX_ID %x from wwn 0x%016llx, state unknown\n", inp->in_seqid, wwn);
		}
		if (inot) {
			isp_notify_t tmp, *nt = &tmp;
			ISP_MEMZERO(nt, sizeof (isp_notify_t));
			nt->nt_hba = isp;
			nt->nt_tgt = FCPARAM(isp, 0)->isp_wwpn;
			nt->nt_wwn = wwn;
			nt->nt_nphdl = loopid;
			nt->nt_sid = PORT_ANY;
			nt->nt_did = PORT_ANY;
			nt->nt_lun = lun;
			nt->nt_need_ack = 1;
			nt->nt_channel = 0;
			nt->nt_ncode = NT_ABORT_TASK;
			nt->nt_lreserved = inot;
			isp_handle_platform_target_tmf(isp, nt);
			needack = 0;
		}
		rls_lun_statep(isp, tptr);
		break;
	}
	default:
		break;
	}
	if (needack) {
		(void) isp_notify_ack(isp, inp);
	}
}

static void
isp_handle_platform_notify_24xx(ispsoftc_t *isp, in_fcentry_24xx_t *inot)
{
	uint16_t nphdl;
	uint32_t portid;
	fcportdb_t *lp;
	uint8_t *ptr = NULL;
	uint64_t wwn;

	nphdl = inot->in_nphdl;
	if (nphdl != NIL_HANDLE) {
		portid = inot->in_portid_hi << 16 | inot->in_portid_lo;
	} else {
		portid = PORT_ANY;
	}

	switch (inot->in_status) {
	case IN24XX_ELS_RCVD:
	{
		char buf[16], *msg;
		int chan = ISP_GET_VPIDX(isp, inot->in_vpidx);

		/*
		 * Note that we're just getting notification that an ELS was received
		 * (possibly with some associated information sent upstream). This is
		 * *not* the same as being given the ELS frame to accept or reject.
		 */
		switch (inot->in_status_subcode) {
		case LOGO:
			msg = "LOGO";
			if (ISP_FW_NEWER_THAN(isp, 4, 0, 25)) {
				ptr = (uint8_t *)inot;  /* point to unswizzled entry! */
				wwn =	(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF])   << 56) |
					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+1]) << 48) |
					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+2]) << 40) |
					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+3]) << 32) |
					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+4]) << 24) |
					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+5]) << 16) |
					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+6]) <<  8) |
					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+7]));
			} else {
				wwn = INI_ANY;
			}
			isp_del_wwn_entry(isp, chan, wwn, nphdl, portid);
			break;
		case PRLO:
			msg = "PRLO";
			break;
		case PLOGI:
		case PRLI:
			/*
			 * Treat PRLI the same as PLOGI and make a database entry for it.
			 */
			if (inot->in_status_subcode == PLOGI)
				msg = "PLOGI";
			else
				msg = "PRLI";
			if (ISP_FW_NEWER_THAN(isp, 4, 0, 25)) {
				ptr = (uint8_t *)inot;  /* point to unswizzled entry! */
				wwn =	(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF])   << 56) |
					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+1]) << 48) |
					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+2]) << 40) |
					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+3]) << 32) |
					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+4]) << 24) |
					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+5]) << 16) |
					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+6]) <<  8) |
					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+7]));
			} else {
				wwn = INI_NONE;
			}
			isp_add_wwn_entry(isp, chan, wwn, nphdl, portid);
			break;
		case PDISC:
			msg = "PDISC";
			break;
		case ADISC:
			msg = "ADISC";
			break;
		default:
			ISP_SNPRINTF(buf, sizeof (buf), "ELS 0x%x", inot->in_status_subcode);
			msg = buf;
			break;
		}
		if (inot->in_flags & IN24XX_FLAG_PUREX_IOCB) {
			isp_prt(isp, ISP_LOGERR, "%s Chan %d ELS N-port handle %x PortID 0x%06x marked as needing a PUREX response", msg, chan, nphdl, portid);
			break;
		}
		isp_prt(isp, ISP_LOGTDEBUG0, "%s Chan %d ELS N-port handle %x PortID 0x%06x RX_ID 0x%x OX_ID 0x%x", msg, chan, nphdl, portid,
		    inot->in_rxid, inot->in_oxid);
		(void) isp_notify_ack(isp, inot);
		break;
	}

	case IN24XX_PORT_LOGOUT:
		ptr = "PORT LOGOUT";
		if (isp_find_pdb_by_loopid(isp, ISP_GET_VPIDX(isp, inot->in_vpidx), nphdl, &lp)) {
			isp_del_wwn_entry(isp, ISP_GET_VPIDX(isp, inot->in_vpidx), lp->port_wwn, nphdl, lp->portid);
		}
		/* FALLTHROUGH */
	case IN24XX_PORT_CHANGED:
		if (ptr == NULL) {
			ptr = "PORT CHANGED";
		}
		/* FALLTHROUGH */
	case IN24XX_LIP_RESET:
		if (ptr == NULL) {
			ptr = "LIP RESET";
		}
		isp_prt(isp, ISP_LOGINFO, "Chan %d %s (sub-status 0x%x) for N-port handle 0x%x", ISP_GET_VPIDX(isp, inot->in_vpidx), ptr, inot->in_status_subcode, nphdl);

		/*
		 * All subcodes here are irrelevant. What is relevant
		 * is that we need to terminate all active commands from
		 * this initiator (known by N-port handle).
		 */
		/* XXX IMPLEMENT XXX */
		(void) isp_notify_ack(isp, inot);
		break;

	case IN24XX_LINK_RESET:
	case IN24XX_LINK_FAILED:
	case IN24XX_SRR_RCVD:
	default:
		(void) isp_notify_ack(isp, inot);
		break;
	}
}

static int
isp_handle_platform_target_notify_ack(ispsoftc_t *isp, isp_notify_t *mp)
{

	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 (IS_24XX(isp) && mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ATIO) {
		ct7_entry_t local, *cto = &local;
		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_sid(isp, mp->nt_channel, sid, &lp)) {
			nphdl = lp->handle;
		} else {
			nphdl = NIL_HANDLE;
		}
		ISP_MEMZERO(&local, sizeof (local));
		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;
		return (isp_target_put_entry(isp, &local));
	}

	/*
	 * This case is for a responding to an ABTS frame
	 */
	if (IS_24XX(isp) && mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD) {

		/*
		 * Overload nt_need_ack here to mark whether we've terminated the associated command.
		 */
		if (mp->nt_need_ack) {
			uint8_t storage[QENTRY_LEN];
			ct7_entry_t *cto = (ct7_entry_t *) storage;
			abts_t *abts = (abts_t *)mp->nt_lreserved;

			ISP_MEMZERO(cto, sizeof (ct7_entry_t));
			isp_prt(isp, ISP_LOGTDEBUG0, "%s: [%x] terminating after ABTS received", __func__, abts->abts_rxid_task);
			cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
			cto->ct_header.rqs_entry_count = 1;
			cto->ct_nphdl = mp->nt_nphdl;
			cto->ct_rxid = abts->abts_rxid_task;
			cto->ct_iid_lo = mp->nt_sid;
			cto->ct_iid_hi = mp->nt_sid >> 16;
			cto->ct_oxid = abts->abts_ox_id;
			cto->ct_vpidx = mp->nt_channel;
			cto->ct_flags = CT7_NOACK|CT7_TERMINATE;
			if (isp_target_put_entry(isp, cto)) {
				return (ENOMEM);
			}
			mp->nt_need_ack = 0;
		}
		if (isp_acknak_abts(isp, mp->nt_lreserved, 0) == ENOMEM) {
			return (ENOMEM);
		} else {
			return (0);
		}
	}

	/*
	 * Handle logout cases here
	 */
	if (mp->nt_ncode == NT_GLOBAL_LOGOUT) {
		isp_del_all_wwn_entries(isp, mp->nt_channel);
	}

	if (mp->nt_ncode == NT_LOGOUT) {
		if (!IS_2100(isp) && IS_FC(isp)) {
			isp_del_wwn_entries(isp, mp);
		}
	}

	/*
	 * 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);
		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;
	lun_id_t lun;

	isp_prt(isp, ISP_LOGTDEBUG0, "%s: code 0x%x sid  0x%x tagval 0x%016llx chan %d lun 0x%x", __func__, notify->nt_ncode,
	    notify->nt_sid, (unsigned long long) notify->nt_tagval, notify->nt_channel, notify->nt_lun);
	/*
	 * NB: This assignment is necessary because of tricky type conversion.
	 * XXX: This is tricky and I need to check this. If the lun isn't known
	 * XXX: for the task management function, it does not of necessity follow
	 * XXX: that it should go up stream to the wildcard listener.
	 */
	if (notify->nt_lun == LUN_ANY) {
		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 0x%x", __func__, notify->nt_channel, 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 0x%x", __func__, notify->nt_channel, lun);
		goto bad;
	}

	if (isp_find_pdb_by_sid(isp, notify->nt_channel, notify->nt_sid, &lp) == 0) {
		inot->initiator_id = CAM_TARGET_WILDCARD;
	} else {
		inot->initiator_id = lp->handle;
	}
	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, tptr, inot->tag_id);
		inot->arg = MSG_ABORT_TASK;
		break;
	case NT_ABORT_TASK_SET:
		isp_target_mark_aborted_early(isp, 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;
	default:
		isp_prt(isp, ISP_LOGWARN, "%s: unknown TMF code 0x%x for chan %d lun 0x%x", __func__, notify->nt_ncode, notify->nt_channel, lun);
		goto bad;
	}

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

	tptr->inot_count--;
	SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
	rls_lun_statep(isp, tptr);
	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, inot->ccb_h.path, "%s: Take FREE INOT count now %d\n", __func__, tptr->inot_count);
	inot->ccb_h.status = CAM_MESSAGE_RECV;
	xpt_done((union ccb *)inot);
	return;
bad:
	if (tptr) {
		rls_lun_statep(isp, tptr);
	}
	if (notify->nt_need_ack && notify->nt_lreserved) {
		if (((isphdr_t *)notify->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD) {
			(void) isp_acknak_abts(isp, notify->nt_lreserved, ENOMEM);
		} else {
			(void) isp_notify_ack(isp, notify->nt_lreserved);
		}
	}
}

/*
 * Find the associated private data and mark it as dead so
 * we don't try to work on it any further.
 */
static void
isp_target_mark_aborted(ispsoftc_t *isp, union ccb *ccb)
{
	tstate_t *tptr;
	atio_private_data_t *atp;

	tptr = get_lun_statep(isp, XS_CHANNEL(ccb), XS_LUN(ccb));
	if (tptr == NULL) {
		tptr = get_lun_statep(isp, XS_CHANNEL(ccb), CAM_LUN_WILDCARD);
		if (tptr == NULL) {
			ccb->ccb_h.status = CAM_REQ_INVALID;
			return;
		}
	}

	atp = isp_get_atpd(isp, tptr, ccb->atio.tag_id);
	if (atp == NULL) {
		ccb->ccb_h.status = CAM_REQ_INVALID;
		return;
	}
	atp->dead = 1;
	ccb->ccb_h.status = CAM_REQ_CMP;
}

static void
isp_target_mark_aborted_early(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag_id)
{
	atio_private_data_t *atp;
	inot_private_data_t *restart_queue = tptr->restart_queue;

	/*
	 * First, clean any commands pending restart
	 */
	tptr->restart_queue = NULL;
	while (restart_queue) {
		uint32_t this_tag_id;
		inot_private_data_t *ntp = restart_queue;

		restart_queue = ntp->rd.nt.nt_hba;

		if (IS_24XX(isp)) {
			this_tag_id = ((at7_entry_t *)ntp->rd.data)->at_rxid;
		} else {
			this_tag_id = ((at2_entry_t *)ntp->rd.data)->at_rxid;
		}
		if ((uint64_t)tag_id == TAG_ANY || tag_id == this_tag_id) {
			isp_put_ntpd(isp, tptr, ntp);
		} else {
			ntp->rd.nt.nt_hba = tptr->restart_queue;
			tptr->restart_queue = ntp;
		}
	}

	/*
	 * Now mark other ones dead as well.
	 */
	for (atp = tptr->atpool; atp < &tptr->atpool[ATPDPSIZE]; atp++) {
		if ((uint64_t)tag_id == TAG_ANY || atp->tag == tag_id) {
			atp->dead = 1;
		}
	}
}


#ifdef	ISP_INTERNAL_TARGET
// #define	ISP_FORCE_TIMEOUT		1
// #define	ISP_TEST_WWNS			1
// #define	ISP_TEST_SEPARATE_STATUS	1

#define	ccb_data_offset		ppriv_field0
#define	ccb_atio		ppriv_ptr1
#define	ccb_inot		ppriv_ptr1

#define	MAX_ISP_TARG_TRANSFER	(2 << 20)
#define	NISP_TARG_CMDS		1024
#define	NISP_TARG_NOTIFIES	1024
#define	DISK_SHIFT		9
#define	JUNK_SIZE		256

#ifndef	VERIFY_10
#define	VERIFY_10	0x2f
#endif

TAILQ_HEAD(ccb_queue, ccb_hdr);
extern u_int vm_kmem_size;
static int ca;
static uint32_t disk_size;
static uint8_t *disk_data = NULL;
static uint8_t *junk_data;
static MALLOC_DEFINE(M_ISPTARG, "ISPTARG", "ISP TARGET data");
struct isptarg_softc {
	/* CCBs (CTIOs, ATIOs, INOTs) pending on the controller */
	struct ccb_queue	work_queue;
	struct ccb_queue	rework_queue;
	struct ccb_queue	running_queue;
	struct ccb_queue	inot_queue;
	struct cam_periph       *periph;
	struct cam_path	 	*path;
	ispsoftc_t		*isp;
};
static periph_ctor_t	isptargctor;
static periph_dtor_t	isptargdtor;
static periph_start_t	isptargstart;
static periph_init_t	isptarginit;
static void		isptarg_done(struct cam_periph *, union ccb *);
static void		isptargasync(void *, u_int32_t, struct cam_path *, void *);


static int isptarg_rwparm(uint8_t *, uint8_t *, uint64_t, uint32_t, uint8_t **, uint32_t *, int *);

static struct periph_driver isptargdriver =
{
	isptarginit, "isptarg", TAILQ_HEAD_INITIALIZER(isptargdriver.units), /* generation */ 0
};

static void
isptarginit(void)
{
}

static void
isptargnotify(ispsoftc_t *isp, union ccb *iccb, struct ccb_immediate_notify *inot)
{
	struct ccb_notify_acknowledge *ack = &iccb->cna2;

	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, inot->ccb_h.path, "%s: [0x%x] immediate notify for 0x%x from 0x%x status 0x%x arg 0x%x\n", __func__,
	    inot->tag_id, inot->initiator_id, inot->seq_id, inot->ccb_h.status, inot->arg);
	ack->ccb_h.func_code = XPT_NOTIFY_ACKNOWLEDGE;
	ack->ccb_h.flags = 0;
	ack->ccb_h.retry_count = 0;
	ack->ccb_h.cbfcnp = isptarg_done;
	ack->ccb_h.timeout = 0;
	ack->ccb_h.ccb_inot = inot;
	ack->tag_id = inot->tag_id;
	ack->seq_id = inot->seq_id;
	ack->initiator_id = inot->initiator_id;
	xpt_action(iccb);
}

static void
isptargstart(struct cam_periph *periph, union ccb *iccb)
{
	const uint8_t niliqd[SHORT_INQUIRY_LENGTH] = {
		0x7f, 0x0, 0x5, 0x2, 32, 0, 0, 0x32,
		'F', 'R', 'E', 'E', 'B', 'S', 'D', ' ',
		'S', 'C', 'S', 'I', ' ', 'N', 'U', 'L',
		'L', ' ', 'D', 'E', 'V', 'I', 'C', 'E',
		'0', '0', '0', '1'
	};
	const uint8_t iqd[SHORT_INQUIRY_LENGTH] = {
		0, 0x0, 0x5, 0x2, 32, 0, 0, 0x32,
		'F', 'R', 'E', 'E', 'B', 'S', 'D', ' ',
		'S', 'C', 'S', 'I', ' ', 'M', 'E', 'M',
		'O', 'R', 'Y', ' ', 'D', 'I', 'S', 'K',
		'0', '0', '0', '1'
	};
	int i, more = 0, last;
	struct isptarg_softc *softc = periph->softc;
	struct ccb_scsiio *csio;
	lun_id_t return_lun;
	struct ccb_accept_tio *atio;
	uint8_t *cdb, *ptr, status;
	uint8_t *data_ptr;
	uint32_t data_len, flags;
	struct ccb_hdr *ccbh;

	KKASSERT(lockstatus(periph->sim->mtx, curthread) != 0);
	ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, iccb->ccb_h.path, "%s: function code 0x%x INOTQ=%c WORKQ=%c REWORKQ=%c\n", __func__, iccb->ccb_h.func_code,
	    TAILQ_FIRST(&softc->inot_queue)? 'y' : 'n', TAILQ_FIRST(&softc->work_queue)? 'y' : 'n', TAILQ_FIRST(&softc->rework_queue)? 'y' : 'n');
	/*
	 * Check for immediate notifies first
	 */
	ccbh = TAILQ_FIRST(&softc->inot_queue);
	if (ccbh) {
		TAILQ_REMOVE(&softc->inot_queue, ccbh, periph_links.tqe);
		if (TAILQ_FIRST(&softc->inot_queue) || TAILQ_FIRST(&softc->work_queue) || TAILQ_FIRST(&softc->rework_queue)) {
			xpt_schedule(periph, 1);
		}
		isptargnotify(softc->isp, iccb, (struct ccb_immediate_notify *)ccbh);
		return;
	}

	/*
	 * Check the rework (continuation) work queue first.
	 */
	ccbh = TAILQ_FIRST(&softc->rework_queue);
	if (ccbh) {
		atio = (struct ccb_accept_tio *)ccbh;
		TAILQ_REMOVE(&softc->rework_queue, ccbh, periph_links.tqe);
		more = TAILQ_FIRST(&softc->work_queue) || TAILQ_FIRST(&softc->rework_queue);
	} else {
		ccbh = TAILQ_FIRST(&softc->work_queue);
		if (ccbh == NULL) {
			ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, iccb->ccb_h.path, "%s: woken up but no work?\n", __func__);
			xpt_release_ccb(iccb);
			return;
		}
		atio = (struct ccb_accept_tio *)ccbh;
		TAILQ_REMOVE(&softc->work_queue, ccbh, periph_links.tqe);
		more = TAILQ_FIRST(&softc->work_queue) != NULL;
		atio->ccb_h.ccb_data_offset = 0;
	}

	if (atio->tag_id == 0xffffffff || atio->ccb_h.func_code != XPT_ACCEPT_TARGET_IO) {
		panic("BAD ATIO");
	}

	data_ptr = NULL;
	data_len = 0;
	csio = &iccb->csio;
	status = SCSI_STATUS_OK;
	flags = CAM_SEND_STATUS;
	memset(&atio->sense_data, 0, sizeof (atio->sense_data));
	cdb = atio->cdb_io.cdb_bytes;
	ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, ccbh->path, "%s: [0x%x] processing ATIO from 0x%x CDB=0x%x data_offset=%u\n", __func__, atio->tag_id, atio->init_id,
	    cdb[0], atio->ccb_h.ccb_data_offset);

	return_lun = XS_LUN(atio);
	if (return_lun != 0) {
		xpt_print(atio->ccb_h.path, "[0x%x] Non-Zero Lun %d: cdb0=0x%x\n", atio->tag_id, return_lun, cdb[0]);
		if (cdb[0] != INQUIRY && cdb[0] != REPORT_LUNS && cdb[0] != REQUEST_SENSE) {
			status = SCSI_STATUS_CHECK_COND;
			atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_ILLEGAL_REQUEST;
			atio->sense_data.add_sense_code = 0x25;
			atio->sense_data.add_sense_code_qual = 0x0;
			atio->sense_len = sizeof (atio->sense_data);
		}
		return_lun = CAM_LUN_WILDCARD;
	}

	switch (cdb[0]) {
	case REQUEST_SENSE:
		flags |= CAM_DIR_IN;
		data_len = sizeof (atio->sense_data);
		junk_data[0] = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_NO_SENSE;
		memset(junk_data+1, 0, data_len-1);
		if (data_len > cdb[4]) {
			data_len = cdb[4];
		}
		if (data_len) {
			data_ptr = junk_data;
		}
		break;
	case READ_6:
	case READ_10:
	case READ_12:
	case READ_16:
		if (isptarg_rwparm(cdb, disk_data, disk_size, atio->ccb_h.ccb_data_offset, &data_ptr, &data_len, &last)) {
			status = SCSI_STATUS_CHECK_COND;
			atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
			atio->sense_data.add_sense_code = 0x5;
			atio->sense_data.add_sense_code_qual = 0x24;
			atio->sense_len = sizeof (atio->sense_data);
		} else {
#ifdef	ISP_FORCE_TIMEOUT
			{
				static int foo;
				if (foo++ == 500) {
					if (more) {
						xpt_schedule(periph, 1);
					}
					foo = 0;
					return;
				}
			}
#endif
#ifdef	ISP_TEST_SEPARATE_STATUS
			if (last && data_len) {
				last = 0;
			}
#endif
			if (last == 0) {
				flags &= ~CAM_SEND_STATUS;
			}
			if (data_len) {
				atio->ccb_h.ccb_data_offset += data_len;
				flags |= CAM_DIR_IN;
			} else {
				flags |= CAM_DIR_NONE;
			}
		}
		break;
	case WRITE_6:
	case WRITE_10:
	case WRITE_12:
	case WRITE_16:
		if (isptarg_rwparm(cdb, disk_data, disk_size, atio->ccb_h.ccb_data_offset, &data_ptr, &data_len, &last)) {
			status = SCSI_STATUS_CHECK_COND;
			atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
			atio->sense_data.add_sense_code = 0x5;
			atio->sense_data.add_sense_code_qual = 0x24;
			atio->sense_len = sizeof (atio->sense_data);
		} else {
#ifdef	ISP_FORCE_TIMEOUT
			{
				static int foo;
				if (foo++ == 500) {
					if (more) {
						xpt_schedule(periph, 1);
					}
					foo = 0;
					return;
				}
			}
#endif
#ifdef	ISP_TEST_SEPARATE_STATUS
			if (last && data_len) {
				last = 0;
			}
#endif
			if (last == 0) {
				flags &= ~CAM_SEND_STATUS;
			}
			if (data_len) {
				atio->ccb_h.ccb_data_offset += data_len;
				flags |= CAM_DIR_OUT;
			} else {
				flags |= CAM_DIR_NONE;
			}
		}
		break;
	case INQUIRY:
		flags |= CAM_DIR_IN;
		if (cdb[1] || cdb[2] || cdb[3]) {
			status = SCSI_STATUS_CHECK_COND;
			atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
			atio->sense_data.add_sense_code = 0x5;
			atio->sense_data.add_sense_code_qual = 0x20;
			atio->sense_len = sizeof (atio->sense_data);
			break;
		}
		data_len = sizeof (iqd);
		if (data_len > cdb[4]) {
			data_len = cdb[4];
		}
		if (data_len) {
			if (XS_LUN(iccb) != 0) {
				memcpy(junk_data, niliqd, sizeof (iqd));
			} else {
				memcpy(junk_data, iqd, sizeof (iqd));
			}
			data_ptr = junk_data;
		}
		break;
	case TEST_UNIT_READY:
		flags |= CAM_DIR_NONE;
		if (ca) {
			ca = 0;
			status = SCSI_STATUS_CHECK_COND;
			atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
			atio->sense_data.add_sense_code = 0x28;
			atio->sense_data.add_sense_code_qual = 0x0;
			atio->sense_len = sizeof (atio->sense_data);
		}
		break;
	case SYNCHRONIZE_CACHE:
	case START_STOP:
	case RESERVE:
	case RELEASE:
	case VERIFY_10:
		flags |= CAM_DIR_NONE;
		break;

	case READ_CAPACITY:
		flags |= CAM_DIR_IN;
		if (cdb[2] || cdb[3] || cdb[4] || cdb[5]) {
			status = SCSI_STATUS_CHECK_COND;
			atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
			atio->sense_data.add_sense_code = 0x5;
			atio->sense_data.add_sense_code_qual = 0x24;
			atio->sense_len = sizeof (atio->sense_data);
			break;
		}
		if (cdb[8] & 0x1) { /* PMI */
			junk_data[0] = 0xff;
			junk_data[1] = 0xff;
			junk_data[2] = 0xff;
			junk_data[3] = 0xff;
		} else {
			uint64_t last_blk = (disk_size >> DISK_SHIFT) - 1;
			if (last_blk < 0xffffffffULL) {
			    junk_data[0] = (last_blk >> 24) & 0xff;
			    junk_data[1] = (last_blk >> 16) & 0xff;
			    junk_data[2] = (last_blk >>  8) & 0xff;
			    junk_data[3] = (last_blk) & 0xff;
			} else {
			    junk_data[0] = 0xff;
			    junk_data[1] = 0xff;
			    junk_data[2] = 0xff;
			    junk_data[3] = 0xff;
			}
		}
		junk_data[4] = ((1 << DISK_SHIFT) >> 24) & 0xff;
		junk_data[5] = ((1 << DISK_SHIFT) >> 16) & 0xff;
		junk_data[6] = ((1 << DISK_SHIFT) >>  8) & 0xff;
		junk_data[7] = ((1 << DISK_SHIFT)) & 0xff;
		data_ptr = junk_data;
		data_len = 8;
		break;
	case REPORT_LUNS:
		flags |= CAM_DIR_IN;
		memset(junk_data, 0, JUNK_SIZE);
		junk_data[0] = (1 << 3) >> 24;
		junk_data[1] = (1 << 3) >> 16;
		junk_data[2] = (1 << 3) >> 8;
		junk_data[3] = (1 << 3);
		ptr = NULL;
		for (i = 0; i < 1; i++) {
			ptr = &junk_data[8 + (1 << 3)];
			if (i >= 256) {
				ptr[0] = 0x40 | ((i >> 8) & 0x3f);
			}
			ptr[1] = i;
		}
		data_ptr = junk_data;
		data_len = (ptr + 8) - junk_data;
		break;

	default:
		flags |= CAM_DIR_NONE;
		status = SCSI_STATUS_CHECK_COND;
		atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
		atio->sense_data.add_sense_code = 0x5;
		atio->sense_data.add_sense_code_qual = 0x20;
		atio->sense_len = sizeof (atio->sense_data);
		break;
	}

	/*
	 * If we are done with the transaction, tell the
	 * controller to send status and perform a CMD_CMPLT.
	 * If we have associated sense data, see if we can
	 * send that too.
	 */
	if (status == SCSI_STATUS_CHECK_COND) {
		flags |= CAM_SEND_SENSE;
		csio->sense_len = atio->sense_len;
		csio->sense_data = atio->sense_data;
		flags &= ~CAM_DIR_MASK;
		data_len = 0;
		data_ptr = NULL;
	}
	cam_fill_ctio(csio, 0, isptarg_done, flags, MSG_SIMPLE_Q_TAG, atio->tag_id, atio->init_id, status, data_ptr, data_len, 0);
	iccb->ccb_h.target_id = atio->ccb_h.target_id;
	iccb->ccb_h.target_lun = return_lun;
	iccb->ccb_h.ccb_atio = atio;
	xpt_action(iccb);

	if ((atio->ccb_h.status & CAM_DEV_QFRZN) != 0) {
		cam_release_devq(periph->path, 0, 0, 0, 0);
		atio->ccb_h.status &= ~CAM_DEV_QFRZN;
	}
	if (more) {
		xpt_schedule(periph, 1);
	}
}

static cam_status
isptargctor(struct cam_periph *periph, void *arg)
{
	struct isptarg_softc *softc;

	softc = (struct isptarg_softc *)arg;
	periph->softc = softc;
	softc->periph = periph;
	softc->path = periph->path;
	ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, periph->path, "%s called\n", __func__);
	return (CAM_REQ_CMP);
}

static void
isptargdtor(struct cam_periph *periph)
{
	struct isptarg_softc *softc;
	softc = (struct isptarg_softc *)periph->softc;
	ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, periph->path, "%s called\n", __func__);
	softc->periph = NULL;
	softc->path = NULL;
	periph->softc = NULL;
}

static void
isptarg_done(struct cam_periph *periph, union ccb *ccb)
{
	struct isptarg_softc *softc;
	ispsoftc_t *isp;
	struct ccb_accept_tio *atio;
	struct ccb_immediate_notify *inot;
	cam_status status;

	softc = (struct isptarg_softc *)periph->softc;
	isp = softc->isp;
	status = ccb->ccb_h.status & CAM_STATUS_MASK;

	switch (ccb->ccb_h.func_code) {
	case XPT_ACCEPT_TARGET_IO:
		atio = (struct ccb_accept_tio *) ccb;
		ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] ATIO seen in %s\n", atio->tag_id, __func__);
		TAILQ_INSERT_TAIL(&softc->work_queue, &ccb->ccb_h, periph_links.tqe);
		xpt_schedule(periph, 1);
		break;
	case XPT_IMMEDIATE_NOTIFY:
		inot = (struct ccb_immediate_notify *) ccb;
		ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] INOT for 0x%x seen in %s\n", inot->tag_id, inot->seq_id, __func__);
		TAILQ_INSERT_TAIL(&softc->inot_queue, &ccb->ccb_h, periph_links.tqe);
		xpt_schedule(periph, 1);
		break;
	case XPT_CONT_TARGET_IO:
		if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
			cam_release_devq(ccb->ccb_h.path, 0, 0, 0, 0);
			ccb->ccb_h.status &= ~CAM_DEV_QFRZN;
		}
		atio = ccb->ccb_h.ccb_atio;
		if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
			cam_error_print(ccb, CAM_ESF_ALL, CAM_EPF_ALL);
			xpt_action((union ccb *)atio);
		} else if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
			ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] MID CTIO seen in %s\n", atio->tag_id, __func__);
			TAILQ_INSERT_TAIL(&softc->rework_queue, &atio->ccb_h, periph_links.tqe);
			xpt_schedule(periph, 1);
		} else {
			ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] FINAL CTIO seen in %s\n", atio->tag_id, __func__);
			xpt_action((union ccb *)atio);
		}
		xpt_release_ccb(ccb);
		break;
	case XPT_NOTIFY_ACKNOWLEDGE:
		if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
			cam_release_devq(ccb->ccb_h.path, 0, 0, 0, 0);
			ccb->ccb_h.status &= ~CAM_DEV_QFRZN;
		}
		inot = ccb->ccb_h.ccb_inot;
		ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, inot->ccb_h.path, "[0x%x] recycle notify for tag 0x%x\n", inot->tag_id, inot->seq_id);
		xpt_release_ccb(ccb);
		xpt_action((union ccb *)inot);
		break;
	default:
		xpt_print(ccb->ccb_h.path, "unexpected code 0x%x\n", ccb->ccb_h.func_code);
		break;
	}
}

static void
isptargasync(void *callback_arg, u_int32_t code, struct cam_path *path, void *arg)
{
	struct ac_contract *acp = arg;
	struct ac_device_changed *fc = (struct ac_device_changed *) acp->contract_data;

	if (code != AC_CONTRACT) {
		return;
	}
	xpt_print(path, "0x%016llx Port ID 0x%06x %s\n", (unsigned long long) fc->wwpn, fc->port, fc->arrived? "arrived" : "departed");
}

static void
isp_target_thread(ispsoftc_t *isp, int chan)
{
	union ccb *ccb = NULL;
	int i;
	void *wchan;
	cam_status status;
	struct isptarg_softc *softc = NULL;
	struct cam_periph *periph = NULL, *wperiph = NULL;
	struct cam_path *path, *wpath;
	struct cam_sim *sim;

	if (disk_data == NULL) {
		disk_size = roundup2(vm_kmem_size >> 1, (1ULL << 20));
		if (disk_size < (50 << 20)) {
			disk_size = 50 << 20;
		}
		disk_data = kmalloc(disk_size, M_ISPTARG, M_WAITOK | M_ZERO);
		isp_prt(isp, ISP_LOGINFO, "allocated a %ju MiB disk", (uintmax_t) (disk_size >> 20));
	}
	junk_data = kmalloc(JUNK_SIZE, M_ISPTARG, M_WAITOK | M_ZERO);


	softc = kmalloc(sizeof (*softc), M_ISPTARG, M_WAITOK | M_ZERO);
	TAILQ_INIT(&softc->work_queue);
	TAILQ_INIT(&softc->rework_queue);
	TAILQ_INIT(&softc->running_queue);
	TAILQ_INIT(&softc->inot_queue);
	softc->isp = isp;

	periphdriver_register(&isptargdriver);
	ISP_GET_PC(isp, chan, sim, sim);
	ISP_GET_PC(isp, chan, path,  path);
	status = xpt_create_path_unlocked(&wpath, NULL, cam_sim_path(sim), CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD);
	if (status != CAM_REQ_CMP) {
		isp_prt(isp, ISP_LOGERR, "%s: could not allocate wildcard path", __func__);
		return;
	}
	status = xpt_create_path_unlocked(&path, NULL, cam_sim_path(sim), 0, 0);
	if (status != CAM_REQ_CMP) {
		xpt_free_path(wpath);
		isp_prt(isp, ISP_LOGERR, "%s: could not allocate path", __func__);
		return;
	}

	ccb = xpt_alloc_ccb();

	ISP_LOCK(isp);
	status = cam_periph_alloc(isptargctor, NULL, isptargdtor, isptargstart, "isptarg", CAM_PERIPH_BIO, wpath, NULL, 0, softc);
	if (status != CAM_REQ_CMP) {
		ISP_UNLOCK(isp);
		isp_prt(isp, ISP_LOGERR, "%s: cam_periph_alloc for wildcard failed", __func__);
		goto out;
	}
	wperiph = cam_periph_find(wpath, "isptarg");
	if (wperiph == NULL) {
		ISP_UNLOCK(isp);
		isp_prt(isp, ISP_LOGERR, "%s: wildcard periph already allocated but doesn't exist", __func__);
		goto out;
	}

	status = cam_periph_alloc(isptargctor, NULL, isptargdtor, isptargstart, "isptarg", CAM_PERIPH_BIO, path, NULL, 0, softc);
	if (status != CAM_REQ_CMP) {
		ISP_UNLOCK(isp);
		isp_prt(isp, ISP_LOGERR, "%s: cam_periph_alloc failed", __func__);
		goto out;
	}

	periph = cam_periph_find(path, "isptarg");
	if (periph == NULL) {
		ISP_UNLOCK(isp);
		isp_prt(isp, ISP_LOGERR, "%s: periph already allocated but doesn't exist", __func__);
		goto out;
	}

	status = xpt_register_async(AC_CONTRACT, isptargasync, isp, wpath);
	if (status != CAM_REQ_CMP) {
		ISP_UNLOCK(isp);
		isp_prt(isp, ISP_LOGERR, "%s: xpt_register_async failed", __func__);
		goto out;
	}

	ISP_UNLOCK(isp);

	ccb = xpt_alloc_ccb();

	/*
	 * Make sure role is none.
	 */
	xpt_setup_ccb(&ccb->ccb_h, periph->path, 10);
	ccb->ccb_h.func_code = XPT_SET_SIM_KNOB;
	ccb->knob.xport_specific.fc.role = KNOB_ROLE_NONE;
#ifdef	ISP_TEST_WWNS
	ccb->knob.xport_specific.fc.valid = KNOB_VALID_ROLE | KNOB_VALID_ADDRESS;
	ccb->knob.xport_specific.fc.wwnn = 0x508004d000000000ULL | (device_get_unit(isp->isp_osinfo.dev) << 8) | (chan << 16);
	ccb->knob.xport_specific.fc.wwpn = 0x508004d000000001ULL | (device_get_unit(isp->isp_osinfo.dev) << 8) | (chan << 16);
#else
	ccb->knob.xport_specific.fc.valid = KNOB_VALID_ROLE;
#endif

	ISP_LOCK(isp);
	xpt_action(ccb);
	ISP_UNLOCK(isp);

	/*
	 * Now enable luns
	 */
	xpt_setup_ccb(&ccb->ccb_h, periph->path, 10);
	ccb->ccb_h.func_code = XPT_EN_LUN;
	ccb->cel.enable = 1;
	ISP_LOCK(isp);
	xpt_action(ccb);
	ISP_UNLOCK(isp);
	if (ccb->ccb_h.status != CAM_REQ_CMP) {
		xpt_free_ccb(ccb);
		xpt_print(periph->path, "failed to enable lun (0x%x)\n", ccb->ccb_h.status);
		goto out;
	}

	xpt_setup_ccb(&ccb->ccb_h, wperiph->path, 10);
	ccb->ccb_h.func_code = XPT_EN_LUN;
	ccb->cel.enable = 1;
	ISP_LOCK(isp);
	xpt_action(ccb);
	ISP_UNLOCK(isp);
	if (ccb->ccb_h.status != CAM_REQ_CMP) {
		xpt_free_ccb(ccb);
		xpt_print(wperiph->path, "failed to enable lun (0x%x)\n", ccb->ccb_h.status);
		goto out;
	}
	xpt_free_ccb(ccb);

	/*
	 * Add resources
	 */
	ISP_GET_PC_ADDR(isp, chan, target_proc, wchan);
	for (i = 0; i < 4; i++) {
		ccb = kmalloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
		xpt_setup_ccb(&ccb->ccb_h, wperiph->path, 1);
		ccb->ccb_h.func_code = XPT_ACCEPT_TARGET_IO;
		ccb->ccb_h.cbfcnp = isptarg_done;
		ISP_LOCK(isp);
		xpt_action(ccb);
		ISP_UNLOCK(isp);
	}
	for (i = 0; i < NISP_TARG_CMDS; i++) {
		ccb = kmalloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
		xpt_setup_ccb(&ccb->ccb_h, periph->path, 1);
		ccb->ccb_h.func_code = XPT_ACCEPT_TARGET_IO;
		ccb->ccb_h.cbfcnp = isptarg_done;
		ISP_LOCK(isp);
		xpt_action(ccb);
		ISP_UNLOCK(isp);
	}
	for (i = 0; i < 4; i++) {
		ccb = kmalloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
		xpt_setup_ccb(&ccb->ccb_h, wperiph->path, 1);
		ccb->ccb_h.func_code = XPT_IMMEDIATE_NOTIFY;
		ccb->ccb_h.cbfcnp = isptarg_done;
		ISP_LOCK(isp);
		xpt_action(ccb);
		ISP_UNLOCK(isp);
	}
	for (i = 0; i < NISP_TARG_NOTIFIES; i++) {
		ccb = kmalloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
		xpt_setup_ccb(&ccb->ccb_h, periph->path, 1);
		ccb->ccb_h.func_code = XPT_IMMEDIATE_NOTIFY;
		ccb->ccb_h.cbfcnp = isptarg_done;
		ISP_LOCK(isp);
		xpt_action(ccb);
		ISP_UNLOCK(isp);
	}

	/*
	 * Now turn it all back on
	 */
	xpt_setup_ccb(&ccb->ccb_h, periph->path, 10);
	ccb->ccb_h.func_code = XPT_SET_SIM_KNOB;
	ccb->knob.xport_specific.fc.valid = KNOB_VALID_ROLE;
	ccb->knob.xport_specific.fc.role = KNOB_ROLE_TARGET;
	ISP_LOCK(isp);
	xpt_action(ccb);
	ISP_UNLOCK(isp);

	/*
	 * Okay, while things are still active, sleep...
	 */
	ISP_LOCK(isp);
	for (;;) {
		ISP_GET_PC(isp, chan, proc_active, i);
		if (i == 0) {
			break;
		}
		lksleep(wchan, &isp->isp_lock, PUSER, "tsnooze", 0);
	}
	ISP_UNLOCK(isp);

out:
	if (wperiph) {
		cam_periph_invalidate(wperiph);
	}
	if (periph) {
		cam_periph_invalidate(periph);
	}
	if (junk_data) {
		kfree(junk_data, M_ISPTARG);
	}
	if (disk_data) {
		kfree(disk_data, M_ISPTARG);
	}
	if (softc) {
		kfree(softc, M_ISPTARG);
	}
	xpt_free_path(path);
	xpt_free_path(wpath);
}

static void
isp_target_thread_pi(void *arg)
{
	struct isp_spi *pi = arg;
	isp_target_thread(cam_sim_softc(pi->sim), cam_sim_bus(pi->sim));
}

static void
isp_target_thread_fc(void *arg)
{
	struct isp_fc *fc = arg;
	isp_target_thread(cam_sim_softc(fc->sim), cam_sim_bus(fc->sim));
}

static int
isptarg_rwparm(uint8_t *cdb, uint8_t *dp, uint64_t dl, uint32_t offset, uint8_t **kp, uint32_t *tl, int *lp)
{
	uint32_t cnt, curcnt;
	uint64_t lba;

	switch (cdb[0]) {
	case WRITE_16:
	case READ_16: