xref: /freebsd/sys/dev/isp/isp_freebsd.c (revision a9fcb51fbb8d2c5b47a35bcae5b4d5fb771c5985)
1 /*-
2  * Copyright (c) 1997-2009 by Matthew Jacob
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice immediately at the beginning of the file, without modification,
10  *    this list of conditions, and the following disclaimer.
11  * 2. The name of the author may not be used to endorse or promote products
12  *    derived from this software without specific prior written permission.
13  *
14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
18  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24  * SUCH DAMAGE.
25  */
26 
27 /*
28  * Platform (FreeBSD) dependent common attachment code for Qlogic adapters.
29  */
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD$");
32 
33 #include <dev/isp/isp_freebsd.h>
34 #include <sys/unistd.h>
35 #include <sys/kthread.h>
36 #include <sys/conf.h>
37 #include <sys/module.h>
38 #include <sys/ioccom.h>
39 #include <dev/isp/isp_ioctl.h>
40 #include <sys/devicestat.h>
41 #include <cam/cam_periph.h>
42 #include <cam/cam_xpt_periph.h>
43 
44 #if	__FreeBSD_version < 800002
45 #define	THREAD_CREATE	kthread_create
46 #else
47 #define	THREAD_CREATE	kproc_create
48 #endif
49 
50 MODULE_VERSION(isp, 1);
51 MODULE_DEPEND(isp, cam, 1, 1, 1);
52 int isp_announced = 0;
53 int isp_fabric_hysteresis = 5;
54 int isp_loop_down_limit = 60;	/* default loop down limit */
55 int isp_quickboot_time = 7;	/* don't wait more than N secs for loop up */
56 int isp_gone_device_time = 30;	/* grace time before reporting device lost */
57 int isp_autoconfig = 1;		/* automatically attach/detach devices */
58 static const char prom3[] = "Chan %d [%u] PortID 0x%06x Departed because of %s";
59 
60 static void isp_freeze_loopdown(ispsoftc_t *, int, char *);
61 static d_ioctl_t ispioctl;
62 static void isp_intr_enable(void *);
63 static void isp_cam_async(void *, uint32_t, struct cam_path *, void *);
64 static void isp_poll(struct cam_sim *);
65 static timeout_t isp_watchdog;
66 static timeout_t isp_gdt;
67 static task_fn_t isp_gdt_task;
68 static timeout_t isp_ldt;
69 static task_fn_t isp_ldt_task;
70 static void isp_kthread(void *);
71 static void isp_action(struct cam_sim *, union ccb *);
72 #ifdef	ISP_INTERNAL_TARGET
73 static void isp_target_thread_pi(void *);
74 static void isp_target_thread_fc(void *);
75 #endif
76 static int isp_timer_count;
77 static void isp_timer(void *);
78 
79 static struct cdevsw isp_cdevsw = {
80 	.d_version =	D_VERSION,
81 	.d_ioctl =	ispioctl,
82 	.d_name =	"isp",
83 };
84 
85 static int
86 isp_role_sysctl(SYSCTL_HANDLER_ARGS)
87 {
88 	ispsoftc_t *isp = (ispsoftc_t *)arg1;
89 	int chan = arg2;
90 	int error, old, value;
91 
92 	value = FCPARAM(isp, chan)->role;
93 
94 	error = sysctl_handle_int(oidp, &value, 0, req);
95 	if ((error != 0) || (req->newptr == NULL))
96 		return (error);
97 
98 	if (value < ISP_ROLE_NONE || value > ISP_ROLE_BOTH)
99 		return (EINVAL);
100 
101 	ISP_LOCK(isp);
102 	old = FCPARAM(isp, chan)->role;
103 
104 	/* We don't allow target mode switch from here. */
105 	value = (old & ISP_ROLE_TARGET) | (value & ISP_ROLE_INITIATOR);
106 
107 	/* If nothing has changed -- we are done. */
108 	if (value == old) {
109 		ISP_UNLOCK(isp);
110 		return (0);
111 	}
112 
113 	/* Actually change the role. */
114 	error = isp_control(isp, ISPCTL_CHANGE_ROLE, chan, value);
115 	ISP_UNLOCK(isp);
116 	return (error);
117 }
118 
119 static int
120 isp_attach_chan(ispsoftc_t *isp, struct cam_devq *devq, int chan)
121 {
122 	struct ccb_setasync csa;
123 	struct cam_sim *sim;
124 	struct cam_path *path;
125 
126 	/*
127 	 * Construct our SIM entry.
128 	 */
129 	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);
130 
131 	if (sim == NULL) {
132 		return (ENOMEM);
133 	}
134 
135 	ISP_LOCK(isp);
136 	if (xpt_bus_register(sim, isp->isp_dev, chan) != CAM_SUCCESS) {
137 		ISP_UNLOCK(isp);
138 		cam_sim_free(sim, FALSE);
139 		return (EIO);
140 	}
141 	ISP_UNLOCK(isp);
142 	if (xpt_create_path(&path, NULL, cam_sim_path(sim), CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
143 		ISP_LOCK(isp);
144 		xpt_bus_deregister(cam_sim_path(sim));
145 		ISP_UNLOCK(isp);
146 		cam_sim_free(sim, FALSE);
147 		return (ENXIO);
148 	}
149 	xpt_setup_ccb(&csa.ccb_h, path, 5);
150 	csa.ccb_h.func_code = XPT_SASYNC_CB;
151 	csa.event_enable = AC_LOST_DEVICE;
152 	csa.callback = isp_cam_async;
153 	csa.callback_arg = sim;
154 
155 	ISP_LOCK(isp);
156 	xpt_action((union ccb *)&csa);
157 	ISP_UNLOCK(isp);
158 
159 	if (IS_SCSI(isp)) {
160 		struct isp_spi *spi = ISP_SPI_PC(isp, chan);
161 		spi->sim = sim;
162 		spi->path = path;
163 #ifdef	ISP_INTERNAL_TARGET
164 		ISP_SET_PC(isp, chan, proc_active, 1);
165 		if (THREAD_CREATE(isp_target_thread_pi, spi, &spi->target_proc, 0, 0, "%s: isp_test_tgt%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
166 			ISP_SET_PC(isp, chan, proc_active, 0);
167 			isp_prt(isp, ISP_LOGERR, "cannot create test target thread");
168 		}
169 		ISP_SPI_PC(isp, chan)->num_threads += 1;
170 #endif
171 	} else {
172 		fcparam *fcp = FCPARAM(isp, chan);
173 		struct isp_fc *fc = ISP_FC_PC(isp, chan);
174 		struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(isp->isp_osinfo.dev);
175 		struct sysctl_oid *tree = device_get_sysctl_tree(isp->isp_osinfo.dev);
176 		char name[16];
177 
178 		ISP_LOCK(isp);
179 		fc->sim = sim;
180 		fc->path = path;
181 		fc->isp = isp;
182 		fc->ready = 1;
183 
184 		callout_init_mtx(&fc->ldt, &isp->isp_osinfo.lock, 0);
185 		callout_init_mtx(&fc->gdt, &isp->isp_osinfo.lock, 0);
186 		TASK_INIT(&fc->ltask, 1, isp_ldt_task, fc);
187 		TASK_INIT(&fc->gtask, 1, isp_gdt_task, fc);
188 
189 		/*
190 		 * We start by being "loop down" if we have an initiator role
191 		 */
192 		if (fcp->role & ISP_ROLE_INITIATOR) {
193 			isp_freeze_loopdown(isp, chan, "isp_attach");
194 			callout_reset(&fc->ldt, isp_quickboot_time * hz, isp_ldt, fc);
195 			isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Starting Initial Loop Down Timer @ %lu", (unsigned long) time_uptime);
196 		}
197 		ISP_UNLOCK(isp);
198 		if (THREAD_CREATE(isp_kthread, fc, &fc->kproc, 0, 0, "%s: fc_thrd%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
199 			xpt_free_path(fc->path);
200 			ISP_LOCK(isp);
201 			if (callout_active(&fc->ldt))
202 				callout_stop(&fc->ldt);
203 			xpt_bus_deregister(cam_sim_path(fc->sim));
204 			ISP_UNLOCK(isp);
205 			cam_sim_free(fc->sim, FALSE);
206 			return (ENOMEM);
207 		}
208 		ISP_FC_PC(isp, chan)->num_threads += 1;
209 #ifdef	ISP_INTERNAL_TARGET
210 		ISP_SET_PC(isp, chan, proc_active, 1);
211 		if (THREAD_CREATE(isp_target_thread_fc, fc, &fc->target_proc, 0, 0, "%s: isp_test_tgt%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
212 			ISP_SET_PC(isp, chan, proc_active, 0);
213 			isp_prt(isp, ISP_LOGERR, "cannot create test target thread");
214 		}
215 		ISP_FC_PC(isp, chan)->num_threads += 1;
216 #endif
217 		if (chan > 0) {
218 			snprintf(name, sizeof(name), "chan%d", chan);
219 			tree = SYSCTL_ADD_NODE(ctx, SYSCTL_CHILDREN(tree),
220 			    OID_AUTO, name, CTLFLAG_RW, 0, "Virtual channel");
221 		}
222 		SYSCTL_ADD_QUAD(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, "wwnn", CTLFLAG_RD, &FCPARAM(isp, chan)->isp_wwnn, "World Wide Node Name");
223 		SYSCTL_ADD_QUAD(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, "wwpn", CTLFLAG_RD, &FCPARAM(isp, chan)->isp_wwpn, "World Wide Port Name");
224 		SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, "loop_down_limit", CTLFLAG_RW, &ISP_FC_PC(isp, chan)->loop_down_limit, 0, "Loop Down Limit");
225 		SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, "gone_device_time", CTLFLAG_RW, &ISP_FC_PC(isp, chan)->gone_device_time, 0, "Gone Device Time");
226 #if defined(ISP_TARGET_MODE) && defined(DEBUG)
227 		SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, "inject_lost_data_frame", CTLFLAG_RW, &ISP_FC_PC(isp, chan)->inject_lost_data_frame, 0, "Cause a Lost Frame on a Read");
228 #endif
229 		SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
230 		    "role", CTLTYPE_INT | CTLFLAG_RW, isp, chan,
231 		    isp_role_sysctl, "I", "Current role");
232 	}
233 	return (0);
234 }
235 
236 static void
237 isp_detach_internal_target(ispsoftc_t *isp, int chan)
238 {
239 #ifdef ISP_INTERNAL_TARGET
240 	void *wchan;
241 
242 	ISP_GET_PC(isp, chan, target_proc, wchan);
243 	ISP_SET_PC(isp, chan, proc_active, 0);
244 	wakeup(wchan);
245 #endif
246 }
247 
248 static void
249 isp_detach_chan(ispsoftc_t *isp, int chan)
250 {
251 	struct cam_sim *sim;
252 	struct cam_path *path;
253 	struct ccb_setasync csa;
254 	int *num_threads;
255 
256 	ISP_GET_PC(isp, chan, sim, sim);
257 	ISP_GET_PC(isp, chan, path, path);
258 	ISP_GET_PC_ADDR(isp, chan, num_threads, num_threads);
259 
260 	xpt_setup_ccb(&csa.ccb_h, path, 5);
261 	csa.ccb_h.func_code = XPT_SASYNC_CB;
262 	csa.event_enable = 0;
263 	csa.callback = isp_cam_async;
264 	csa.callback_arg = sim;
265 	xpt_action((union ccb *)&csa);
266 	xpt_free_path(path);
267 	xpt_bus_deregister(cam_sim_path(sim));
268 	cam_sim_free(sim, FALSE);
269 
270 	/* Wait for the channel's spawned threads to exit. */
271 	wakeup(isp->isp_osinfo.pc.ptr);
272 	isp_detach_internal_target(isp, chan);
273 	while (*num_threads != 0)
274 		mtx_sleep(isp, &isp->isp_osinfo.lock, PRIBIO, "isp_reap", 100);
275 }
276 
277 int
278 isp_attach(ispsoftc_t *isp)
279 {
280 	const char *nu = device_get_nameunit(isp->isp_osinfo.dev);
281 	int du = device_get_unit(isp->isp_dev);
282 	int chan;
283 
284 	isp->isp_osinfo.ehook.ich_func = isp_intr_enable;
285 	isp->isp_osinfo.ehook.ich_arg = isp;
286 	/*
287 	 * Haha. Set this first, because if we're loaded as a module isp_intr_enable
288 	 * will be called right awawy, which will clear isp_osinfo.ehook_active,
289 	 * which would be unwise to then set again later.
290 	 */
291 	isp->isp_osinfo.ehook_active = 1;
292 	if (config_intrhook_establish(&isp->isp_osinfo.ehook) != 0) {
293 		isp_prt(isp, ISP_LOGERR, "could not establish interrupt enable hook");
294 		return (-EIO);
295 	}
296 
297 	/*
298 	 * Create the device queue for our SIM(s).
299 	 */
300 	isp->isp_osinfo.devq = cam_simq_alloc(isp->isp_maxcmds);
301 	if (isp->isp_osinfo.devq == NULL) {
302 		config_intrhook_disestablish(&isp->isp_osinfo.ehook);
303 		return (EIO);
304 	}
305 
306 	for (chan = 0; chan < isp->isp_nchan; chan++) {
307 		if (isp_attach_chan(isp, isp->isp_osinfo.devq, chan)) {
308 			goto unwind;
309 		}
310 	}
311 
312 	callout_init_mtx(&isp->isp_osinfo.tmo, &isp->isp_osinfo.lock, 0);
313 	isp_timer_count = hz >> 2;
314 	callout_reset(&isp->isp_osinfo.tmo, isp_timer_count, isp_timer, isp);
315 	isp->isp_osinfo.timer_active = 1;
316 
317 	isp->isp_osinfo.cdev = make_dev(&isp_cdevsw, du, UID_ROOT, GID_OPERATOR, 0600, "%s", nu);
318 	if (isp->isp_osinfo.cdev) {
319 		isp->isp_osinfo.cdev->si_drv1 = isp;
320 	}
321 	return (0);
322 
323 unwind:
324 	while (--chan >= 0) {
325 		struct cam_sim *sim;
326 		struct cam_path *path;
327 
328 		ISP_GET_PC(isp, chan, sim, sim);
329 		ISP_GET_PC(isp, chan, path, path);
330 		xpt_free_path(path);
331 		ISP_LOCK(isp);
332 		xpt_bus_deregister(cam_sim_path(sim));
333 		ISP_UNLOCK(isp);
334 		cam_sim_free(sim, FALSE);
335 	}
336 	if (isp->isp_osinfo.ehook_active) {
337 		config_intrhook_disestablish(&isp->isp_osinfo.ehook);
338 		isp->isp_osinfo.ehook_active = 0;
339 	}
340 	if (isp->isp_osinfo.cdev) {
341 		destroy_dev(isp->isp_osinfo.cdev);
342 		isp->isp_osinfo.cdev = NULL;
343 	}
344 	cam_simq_free(isp->isp_osinfo.devq);
345 	isp->isp_osinfo.devq = NULL;
346 	return (-1);
347 }
348 
349 int
350 isp_detach(ispsoftc_t *isp)
351 {
352 	struct cam_sim *sim;
353 	int chan;
354 
355 	ISP_LOCK(isp);
356 	for (chan = isp->isp_nchan - 1; chan >= 0; chan -= 1) {
357 		ISP_GET_PC(isp, chan, sim, sim);
358 		if (sim->refcount > 2) {
359 			ISP_UNLOCK(isp);
360 			return (EBUSY);
361 		}
362 	}
363 	/* Tell spawned threads that we're exiting. */
364 	isp->isp_osinfo.is_exiting = 1;
365 	if (isp->isp_osinfo.timer_active) {
366 		callout_stop(&isp->isp_osinfo.tmo);
367 		isp->isp_osinfo.timer_active = 0;
368 	}
369 	for (chan = isp->isp_nchan - 1; chan >= 0; chan -= 1)
370 		isp_detach_chan(isp, chan);
371 	ISP_UNLOCK(isp);
372 
373 	if (isp->isp_osinfo.cdev) {
374 		destroy_dev(isp->isp_osinfo.cdev);
375 		isp->isp_osinfo.cdev = NULL;
376 	}
377 	if (isp->isp_osinfo.ehook_active) {
378 		config_intrhook_disestablish(&isp->isp_osinfo.ehook);
379 		isp->isp_osinfo.ehook_active = 0;
380 	}
381 	if (isp->isp_osinfo.devq != NULL) {
382 		cam_simq_free(isp->isp_osinfo.devq);
383 		isp->isp_osinfo.devq = NULL;
384 	}
385 	return (0);
386 }
387 
388 static void
389 isp_freeze_loopdown(ispsoftc_t *isp, int chan, char *msg)
390 {
391 	if (IS_FC(isp)) {
392 		struct isp_fc *fc = ISP_FC_PC(isp, chan);
393 		if (fc->simqfrozen == 0) {
394 			isp_prt(isp, ISP_LOGDEBUG0, "%s: freeze simq (loopdown) chan %d", msg, chan);
395 			fc->simqfrozen = SIMQFRZ_LOOPDOWN;
396 			xpt_freeze_simq(fc->sim, 1);
397 		} else {
398 			isp_prt(isp, ISP_LOGDEBUG0, "%s: mark frozen (loopdown) chan %d", msg, chan);
399 			fc->simqfrozen |= SIMQFRZ_LOOPDOWN;
400 		}
401 	}
402 }
403 
404 static void
405 isp_unfreeze_loopdown(ispsoftc_t *isp, int chan)
406 {
407 	if (IS_FC(isp)) {
408 		struct isp_fc *fc = ISP_FC_PC(isp, chan);
409 		int wasfrozen = fc->simqfrozen & SIMQFRZ_LOOPDOWN;
410 		fc->simqfrozen &= ~SIMQFRZ_LOOPDOWN;
411 		if (wasfrozen && fc->simqfrozen == 0) {
412 			isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "%s: Chan %d releasing simq", __func__, chan);
413 			xpt_release_simq(fc->sim, 1);
414 		}
415 	}
416 }
417 
418 
419 static int
420 ispioctl(struct cdev *dev, u_long c, caddr_t addr, int flags, struct thread *td)
421 {
422 	ispsoftc_t *isp;
423 	int nr, chan, retval = ENOTTY;
424 
425 	isp = dev->si_drv1;
426 
427 	switch (c) {
428 	case ISP_SDBLEV:
429 	{
430 		int olddblev = isp->isp_dblev;
431 		isp->isp_dblev = *(int *)addr;
432 		*(int *)addr = olddblev;
433 		retval = 0;
434 		break;
435 	}
436 	case ISP_GETROLE:
437 		chan = *(int *)addr;
438 		if (chan < 0 || chan >= isp->isp_nchan) {
439 			retval = -ENXIO;
440 			break;
441 		}
442 		if (IS_FC(isp)) {
443 			*(int *)addr = FCPARAM(isp, chan)->role;
444 		} else {
445 			*(int *)addr = SDPARAM(isp, chan)->role;
446 		}
447 		retval = 0;
448 		break;
449 	case ISP_SETROLE:
450 		nr = *(int *)addr;
451 		chan = nr >> 8;
452 		if (chan < 0 || chan >= isp->isp_nchan) {
453 			retval = -ENXIO;
454 			break;
455 		}
456 		nr &= 0xff;
457 		if (nr & ~(ISP_ROLE_INITIATOR|ISP_ROLE_TARGET)) {
458 			retval = EINVAL;
459 			break;
460 		}
461 		ISP_LOCK(isp);
462 		if (IS_FC(isp))
463 			*(int *)addr = FCPARAM(isp, chan)->role;
464 		else
465 			*(int *)addr = SDPARAM(isp, chan)->role;
466 		retval = isp_control(isp, ISPCTL_CHANGE_ROLE, chan, nr);
467 		ISP_UNLOCK(isp);
468 		retval = 0;
469 		break;
470 
471 	case ISP_RESETHBA:
472 		ISP_LOCK(isp);
473 		isp_reinit(isp, 0);
474 		ISP_UNLOCK(isp);
475 		retval = 0;
476 		break;
477 
478 	case ISP_RESCAN:
479 		if (IS_FC(isp)) {
480 			chan = *(int *)addr;
481 			if (chan < 0 || chan >= isp->isp_nchan) {
482 				retval = -ENXIO;
483 				break;
484 			}
485 			ISP_LOCK(isp);
486 			if (isp_fc_runstate(isp, chan, 5 * 1000000)) {
487 				retval = EIO;
488 			} else {
489 				retval = 0;
490 			}
491 			ISP_UNLOCK(isp);
492 		}
493 		break;
494 
495 	case ISP_FC_LIP:
496 		if (IS_FC(isp)) {
497 			chan = *(int *)addr;
498 			if (chan < 0 || chan >= isp->isp_nchan) {
499 				retval = -ENXIO;
500 				break;
501 			}
502 			ISP_LOCK(isp);
503 			if (isp_control(isp, ISPCTL_SEND_LIP, chan)) {
504 				retval = EIO;
505 			} else {
506 				retval = 0;
507 			}
508 			ISP_UNLOCK(isp);
509 		}
510 		break;
511 	case ISP_FC_GETDINFO:
512 	{
513 		struct isp_fc_device *ifc = (struct isp_fc_device *) addr;
514 		fcportdb_t *lp;
515 
516 		if (IS_SCSI(isp)) {
517 			break;
518 		}
519 		if (ifc->loopid >= MAX_FC_TARG) {
520 			retval = EINVAL;
521 			break;
522 		}
523 		lp = &FCPARAM(isp, ifc->chan)->portdb[ifc->loopid];
524 		if (lp->state != FC_PORTDB_STATE_NIL) {
525 			ifc->role = (lp->prli_word3 & SVC3_ROLE_MASK) >> SVC3_ROLE_SHIFT;
526 			ifc->loopid = lp->handle;
527 			ifc->portid = lp->portid;
528 			ifc->node_wwn = lp->node_wwn;
529 			ifc->port_wwn = lp->port_wwn;
530 			retval = 0;
531 		} else {
532 			retval = ENODEV;
533 		}
534 		break;
535 	}
536 	case ISP_GET_STATS:
537 	{
538 		isp_stats_t *sp = (isp_stats_t *) addr;
539 
540 		ISP_MEMZERO(sp, sizeof (*sp));
541 		sp->isp_stat_version = ISP_STATS_VERSION;
542 		sp->isp_type = isp->isp_type;
543 		sp->isp_revision = isp->isp_revision;
544 		ISP_LOCK(isp);
545 		sp->isp_stats[ISP_INTCNT] = isp->isp_intcnt;
546 		sp->isp_stats[ISP_INTBOGUS] = isp->isp_intbogus;
547 		sp->isp_stats[ISP_INTMBOXC] = isp->isp_intmboxc;
548 		sp->isp_stats[ISP_INGOASYNC] = isp->isp_intoasync;
549 		sp->isp_stats[ISP_RSLTCCMPLT] = isp->isp_rsltccmplt;
550 		sp->isp_stats[ISP_FPHCCMCPLT] = isp->isp_fphccmplt;
551 		sp->isp_stats[ISP_RSCCHIWAT] = isp->isp_rscchiwater;
552 		sp->isp_stats[ISP_FPCCHIWAT] = isp->isp_fpcchiwater;
553 		ISP_UNLOCK(isp);
554 		retval = 0;
555 		break;
556 	}
557 	case ISP_CLR_STATS:
558 		ISP_LOCK(isp);
559 		isp->isp_intcnt = 0;
560 		isp->isp_intbogus = 0;
561 		isp->isp_intmboxc = 0;
562 		isp->isp_intoasync = 0;
563 		isp->isp_rsltccmplt = 0;
564 		isp->isp_fphccmplt = 0;
565 		isp->isp_rscchiwater = 0;
566 		isp->isp_fpcchiwater = 0;
567 		ISP_UNLOCK(isp);
568 		retval = 0;
569 		break;
570 	case ISP_FC_GETHINFO:
571 	{
572 		struct isp_hba_device *hba = (struct isp_hba_device *) addr;
573 		int chan = hba->fc_channel;
574 
575 		if (chan < 0 || chan >= isp->isp_nchan) {
576 			retval = ENXIO;
577 			break;
578 		}
579 		hba->fc_fw_major = ISP_FW_MAJORX(isp->isp_fwrev);
580 		hba->fc_fw_minor = ISP_FW_MINORX(isp->isp_fwrev);
581 		hba->fc_fw_micro = ISP_FW_MICROX(isp->isp_fwrev);
582 		hba->fc_nchannels = isp->isp_nchan;
583 		if (IS_FC(isp)) {
584 			hba->fc_nports = MAX_FC_TARG;
585 			hba->fc_speed = FCPARAM(isp, hba->fc_channel)->isp_gbspeed;
586 			hba->fc_topology = FCPARAM(isp, chan)->isp_topo + 1;
587 			hba->fc_loopid = FCPARAM(isp, chan)->isp_loopid;
588 			hba->nvram_node_wwn = FCPARAM(isp, chan)->isp_wwnn_nvram;
589 			hba->nvram_port_wwn = FCPARAM(isp, chan)->isp_wwpn_nvram;
590 			hba->active_node_wwn = FCPARAM(isp, chan)->isp_wwnn;
591 			hba->active_port_wwn = FCPARAM(isp, chan)->isp_wwpn;
592 		} else {
593 			hba->fc_nports = MAX_TARGETS;
594 			hba->fc_speed = 0;
595 			hba->fc_topology = 0;
596 			hba->nvram_node_wwn = 0ull;
597 			hba->nvram_port_wwn = 0ull;
598 			hba->active_node_wwn = 0ull;
599 			hba->active_port_wwn = 0ull;
600 		}
601 		retval = 0;
602 		break;
603 	}
604 	case ISP_TSK_MGMT:
605 	{
606 		int needmarker;
607 		struct isp_fc_tsk_mgmt *fct = (struct isp_fc_tsk_mgmt *) addr;
608 		uint16_t loopid;
609 		mbreg_t mbs;
610 
611 		if (IS_SCSI(isp)) {
612 			break;
613 		}
614 
615 		chan = fct->chan;
616 		if (chan < 0 || chan >= isp->isp_nchan) {
617 			retval = -ENXIO;
618 			break;
619 		}
620 
621 		needmarker = retval = 0;
622 		loopid = fct->loopid;
623 		ISP_LOCK(isp);
624 		if (IS_24XX(isp)) {
625 			uint8_t local[QENTRY_LEN];
626 			isp24xx_tmf_t *tmf;
627 			isp24xx_statusreq_t *sp;
628 			fcparam *fcp = FCPARAM(isp, chan);
629 			fcportdb_t *lp;
630 			int i;
631 
632 			for (i = 0; i < MAX_FC_TARG; i++) {
633 				lp = &fcp->portdb[i];
634 				if (lp->handle == loopid) {
635 					break;
636 				}
637 			}
638 			if (i == MAX_FC_TARG) {
639 				retval = ENXIO;
640 				ISP_UNLOCK(isp);
641 				break;
642 			}
643 			/* XXX VALIDATE LP XXX */
644 			tmf = (isp24xx_tmf_t *) local;
645 			ISP_MEMZERO(tmf, QENTRY_LEN);
646 			tmf->tmf_header.rqs_entry_type = RQSTYPE_TSK_MGMT;
647 			tmf->tmf_header.rqs_entry_count = 1;
648 			tmf->tmf_nphdl = lp->handle;
649 			tmf->tmf_delay = 2;
650 			tmf->tmf_timeout = 2;
651 			tmf->tmf_tidlo = lp->portid;
652 			tmf->tmf_tidhi = lp->portid >> 16;
653 			tmf->tmf_vpidx = ISP_GET_VPIDX(isp, chan);
654 			tmf->tmf_lun[1] = fct->lun & 0xff;
655 			if (fct->lun >= 256) {
656 				tmf->tmf_lun[0] = 0x40 | (fct->lun >> 8);
657 			}
658 			switch (fct->action) {
659 			case IPT_CLEAR_ACA:
660 				tmf->tmf_flags = ISP24XX_TMF_CLEAR_ACA;
661 				break;
662 			case IPT_TARGET_RESET:
663 				tmf->tmf_flags = ISP24XX_TMF_TARGET_RESET;
664 				needmarker = 1;
665 				break;
666 			case IPT_LUN_RESET:
667 				tmf->tmf_flags = ISP24XX_TMF_LUN_RESET;
668 				needmarker = 1;
669 				break;
670 			case IPT_CLEAR_TASK_SET:
671 				tmf->tmf_flags = ISP24XX_TMF_CLEAR_TASK_SET;
672 				needmarker = 1;
673 				break;
674 			case IPT_ABORT_TASK_SET:
675 				tmf->tmf_flags = ISP24XX_TMF_ABORT_TASK_SET;
676 				needmarker = 1;
677 				break;
678 			default:
679 				retval = EINVAL;
680 				break;
681 			}
682 			if (retval) {
683 				ISP_UNLOCK(isp);
684 				break;
685 			}
686 			MBSINIT(&mbs, MBOX_EXEC_COMMAND_IOCB_A64, MBLOGALL, 5000000);
687 			mbs.param[1] = QENTRY_LEN;
688 			mbs.param[2] = DMA_WD1(fcp->isp_scdma);
689 			mbs.param[3] = DMA_WD0(fcp->isp_scdma);
690 			mbs.param[6] = DMA_WD3(fcp->isp_scdma);
691 			mbs.param[7] = DMA_WD2(fcp->isp_scdma);
692 
693 			if (FC_SCRATCH_ACQUIRE(isp, chan)) {
694 				ISP_UNLOCK(isp);
695 				retval = ENOMEM;
696 				break;
697 			}
698 			isp_put_24xx_tmf(isp, tmf, fcp->isp_scratch);
699 			MEMORYBARRIER(isp, SYNC_SFORDEV, 0, QENTRY_LEN, chan);
700 			sp = (isp24xx_statusreq_t *) local;
701 			sp->req_completion_status = 1;
702 			retval = isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs);
703 			MEMORYBARRIER(isp, SYNC_SFORCPU, QENTRY_LEN, QENTRY_LEN, chan);
704 			isp_get_24xx_response(isp, &((isp24xx_statusreq_t *)fcp->isp_scratch)[1], sp);
705 			FC_SCRATCH_RELEASE(isp, chan);
706 			if (retval || sp->req_completion_status != 0) {
707 				FC_SCRATCH_RELEASE(isp, chan);
708 				retval = EIO;
709 			}
710 			if (retval == 0) {
711 				if (needmarker) {
712 					fcp->sendmarker = 1;
713 				}
714 			}
715 		} else {
716 			MBSINIT(&mbs, 0, MBLOGALL, 0);
717 			if (ISP_CAP_2KLOGIN(isp) == 0) {
718 				loopid <<= 8;
719 			}
720 			switch (fct->action) {
721 			case IPT_CLEAR_ACA:
722 				mbs.param[0] = MBOX_CLEAR_ACA;
723 				mbs.param[1] = loopid;
724 				mbs.param[2] = fct->lun;
725 				break;
726 			case IPT_TARGET_RESET:
727 				mbs.param[0] = MBOX_TARGET_RESET;
728 				mbs.param[1] = loopid;
729 				needmarker = 1;
730 				break;
731 			case IPT_LUN_RESET:
732 				mbs.param[0] = MBOX_LUN_RESET;
733 				mbs.param[1] = loopid;
734 				mbs.param[2] = fct->lun;
735 				needmarker = 1;
736 				break;
737 			case IPT_CLEAR_TASK_SET:
738 				mbs.param[0] = MBOX_CLEAR_TASK_SET;
739 				mbs.param[1] = loopid;
740 				mbs.param[2] = fct->lun;
741 				needmarker = 1;
742 				break;
743 			case IPT_ABORT_TASK_SET:
744 				mbs.param[0] = MBOX_ABORT_TASK_SET;
745 				mbs.param[1] = loopid;
746 				mbs.param[2] = fct->lun;
747 				needmarker = 1;
748 				break;
749 			default:
750 				retval = EINVAL;
751 				break;
752 			}
753 			if (retval == 0) {
754 				if (needmarker) {
755 					FCPARAM(isp, chan)->sendmarker = 1;
756 				}
757 				retval = isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs);
758 				if (retval) {
759 					retval = EIO;
760 				}
761 			}
762 		}
763 		ISP_UNLOCK(isp);
764 		break;
765 	}
766 	default:
767 		break;
768 	}
769 	return (retval);
770 }
771 
772 static void
773 isp_intr_enable(void *arg)
774 {
775 	int chan;
776 	ispsoftc_t *isp = arg;
777 	ISP_LOCK(isp);
778 	for (chan = 0; chan < isp->isp_nchan; chan++) {
779 		if (IS_FC(isp)) {
780 			if (FCPARAM(isp, chan)->role != ISP_ROLE_NONE) {
781 				ISP_ENABLE_INTS(isp);
782 				break;
783 			}
784 		} else {
785 			if (SDPARAM(isp, chan)->role != ISP_ROLE_NONE) {
786 				ISP_ENABLE_INTS(isp);
787 				break;
788 			}
789 		}
790 	}
791 	isp->isp_osinfo.ehook_active = 0;
792 	ISP_UNLOCK(isp);
793 	/* Release our hook so that the boot can continue. */
794 	config_intrhook_disestablish(&isp->isp_osinfo.ehook);
795 }
796 
797 /*
798  * Local Inlines
799  */
800 
801 static ISP_INLINE int isp_get_pcmd(ispsoftc_t *, union ccb *);
802 static ISP_INLINE void isp_free_pcmd(ispsoftc_t *, union ccb *);
803 
804 static ISP_INLINE int
805 isp_get_pcmd(ispsoftc_t *isp, union ccb *ccb)
806 {
807 	ISP_PCMD(ccb) = isp->isp_osinfo.pcmd_free;
808 	if (ISP_PCMD(ccb) == NULL) {
809 		return (-1);
810 	}
811 	isp->isp_osinfo.pcmd_free = ((struct isp_pcmd *)ISP_PCMD(ccb))->next;
812 	return (0);
813 }
814 
815 static ISP_INLINE void
816 isp_free_pcmd(ispsoftc_t *isp, union ccb *ccb)
817 {
818 	if (ISP_PCMD(ccb)) {
819 #ifdef	ISP_TARGET_MODE
820 		PISP_PCMD(ccb)->datalen = 0;
821 		PISP_PCMD(ccb)->totslen = 0;
822 		PISP_PCMD(ccb)->cumslen = 0;
823 		PISP_PCMD(ccb)->crn = 0;
824 #endif
825 		PISP_PCMD(ccb)->next = isp->isp_osinfo.pcmd_free;
826 		isp->isp_osinfo.pcmd_free = ISP_PCMD(ccb);
827 		ISP_PCMD(ccb) = NULL;
828 	}
829 }
830 
831 /*
832  * Put the target mode functions here, because some are inlines
833  */
834 #ifdef	ISP_TARGET_MODE
835 static ISP_INLINE void isp_tmlock(ispsoftc_t *, const char *);
836 static ISP_INLINE void isp_tmunlk(ispsoftc_t *);
837 static ISP_INLINE int is_any_lun_enabled(ispsoftc_t *, int);
838 static ISP_INLINE int is_lun_enabled(ispsoftc_t *, int, lun_id_t);
839 static ISP_INLINE tstate_t *get_lun_statep(ispsoftc_t *, int, lun_id_t);
840 static ISP_INLINE tstate_t *get_lun_statep_from_tag(ispsoftc_t *, int, uint32_t);
841 static ISP_INLINE void rls_lun_statep(ispsoftc_t *, tstate_t *);
842 static ISP_INLINE inot_private_data_t *get_ntp_from_tagdata(ispsoftc_t *, uint32_t, uint32_t, tstate_t **);
843 static ISP_INLINE atio_private_data_t *isp_get_atpd(ispsoftc_t *, tstate_t *, uint32_t);
844 static ISP_INLINE atio_private_data_t *isp_find_atpd(ispsoftc_t *, tstate_t *, uint32_t);
845 static ISP_INLINE void isp_put_atpd(ispsoftc_t *, tstate_t *, atio_private_data_t *);
846 static ISP_INLINE inot_private_data_t *isp_get_ntpd(ispsoftc_t *, tstate_t *);
847 static ISP_INLINE inot_private_data_t *isp_find_ntpd(ispsoftc_t *, tstate_t *, uint32_t, uint32_t);
848 static ISP_INLINE void isp_put_ntpd(ispsoftc_t *, tstate_t *, inot_private_data_t *);
849 static cam_status create_lun_state(ispsoftc_t *, int, struct cam_path *, tstate_t **);
850 static void destroy_lun_state(ispsoftc_t *, tstate_t *);
851 static void isp_enable_lun(ispsoftc_t *, union ccb *);
852 static cam_status isp_enable_deferred_luns(ispsoftc_t *, int);
853 static cam_status isp_enable_deferred(ispsoftc_t *, int, lun_id_t);
854 static void isp_disable_lun(ispsoftc_t *, union ccb *);
855 static int isp_enable_target_mode(ispsoftc_t *, int);
856 static int isp_disable_target_mode(ispsoftc_t *, int);
857 static void isp_ledone(ispsoftc_t *, lun_entry_t *);
858 static timeout_t isp_refire_putback_atio;
859 static timeout_t isp_refire_notify_ack;
860 static void isp_complete_ctio(union ccb *);
861 static void isp_target_putback_atio(union ccb *);
862 enum Start_Ctio_How { FROM_CAM, FROM_TIMER, FROM_SRR, FROM_CTIO_DONE };
863 static void isp_target_start_ctio(ispsoftc_t *, union ccb *, enum Start_Ctio_How);
864 static void isp_handle_platform_atio(ispsoftc_t *, at_entry_t *);
865 static void isp_handle_platform_atio2(ispsoftc_t *, at2_entry_t *);
866 static void isp_handle_platform_atio7(ispsoftc_t *, at7_entry_t *);
867 static void isp_handle_platform_ctio(ispsoftc_t *, void *);
868 static void isp_handle_platform_notify_scsi(ispsoftc_t *, in_entry_t *);
869 static void isp_handle_platform_notify_fc(ispsoftc_t *, in_fcentry_t *);
870 static void isp_handle_platform_notify_24xx(ispsoftc_t *, in_fcentry_24xx_t *);
871 static int isp_handle_platform_target_notify_ack(ispsoftc_t *, isp_notify_t *);
872 static void isp_handle_platform_target_tmf(ispsoftc_t *, isp_notify_t *);
873 static void isp_target_mark_aborted(ispsoftc_t *, union ccb *);
874 static void isp_target_mark_aborted_early(ispsoftc_t *, tstate_t *, uint32_t);
875 
876 static ISP_INLINE void
877 isp_tmlock(ispsoftc_t *isp, const char *msg)
878 {
879 	while (isp->isp_osinfo.tmbusy) {
880 		isp->isp_osinfo.tmwanted = 1;
881 		mtx_sleep(isp, &isp->isp_lock, PRIBIO, msg, 0);
882 	}
883 	isp->isp_osinfo.tmbusy = 1;
884 }
885 
886 static ISP_INLINE void
887 isp_tmunlk(ispsoftc_t *isp)
888 {
889 	isp->isp_osinfo.tmbusy = 0;
890 	if (isp->isp_osinfo.tmwanted) {
891 		isp->isp_osinfo.tmwanted = 0;
892 		wakeup(isp);
893 	}
894 }
895 
896 static ISP_INLINE int
897 is_any_lun_enabled(ispsoftc_t *isp, int bus)
898 {
899 	struct tslist *lhp;
900 	int i;
901 
902 	for (i = 0; i < LUN_HASH_SIZE; i++) {
903 		ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
904 		if (SLIST_FIRST(lhp))
905 			return (1);
906 	}
907 	return (0);
908 }
909 
910 static ISP_INLINE int
911 is_lun_enabled(ispsoftc_t *isp, int bus, lun_id_t lun)
912 {
913 	tstate_t *tptr;
914 	struct tslist *lhp;
915 
916 	ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(lun)], lhp);
917 	SLIST_FOREACH(tptr, lhp, next) {
918 		if (tptr->ts_lun == lun) {
919 			return (1);
920 		}
921 	}
922 	return (0);
923 }
924 
925 static void
926 dump_tstates(ispsoftc_t *isp, int bus)
927 {
928 	int i, j;
929 	struct tslist *lhp;
930 	tstate_t *tptr = NULL;
931 
932 	if (bus >= isp->isp_nchan) {
933 		return;
934 	}
935 	for (i = 0; i < LUN_HASH_SIZE; i++) {
936 		ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
937 		j = 0;
938 		SLIST_FOREACH(tptr, lhp, next) {
939 			xpt_print(tptr->owner, "[%d, %d] atio_cnt=%d inot_cnt=%d\n", i, j, tptr->atio_count, tptr->inot_count);
940 			j++;
941 		}
942 	}
943 }
944 
945 static ISP_INLINE tstate_t *
946 get_lun_statep(ispsoftc_t *isp, int bus, lun_id_t lun)
947 {
948 	tstate_t *tptr = NULL;
949 	struct tslist *lhp;
950 
951 	if (bus < isp->isp_nchan) {
952 		ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(lun)], lhp);
953 		SLIST_FOREACH(tptr, lhp, next) {
954 			if (tptr->ts_lun == lun) {
955 				tptr->hold++;
956 				return (tptr);
957 			}
958 		}
959 	}
960 	return (NULL);
961 }
962 
963 static ISP_INLINE tstate_t *
964 get_lun_statep_from_tag(ispsoftc_t *isp, int bus, uint32_t tagval)
965 {
966 	tstate_t *tptr = NULL;
967 	atio_private_data_t *atp;
968 	struct tslist *lhp;
969 	int i;
970 
971 	if (bus < isp->isp_nchan && tagval != 0) {
972 		for (i = 0; i < LUN_HASH_SIZE; i++) {
973 			ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
974 			SLIST_FOREACH(tptr, lhp, next) {
975 				atp = isp_find_atpd(isp, tptr, tagval);
976 				if (atp) {
977 					tptr->hold++;
978 					return (tptr);
979 				}
980 			}
981 		}
982 	}
983 	return (NULL);
984 }
985 
986 static ISP_INLINE inot_private_data_t *
987 get_ntp_from_tagdata(ispsoftc_t *isp, uint32_t tag_id, uint32_t seq_id, tstate_t **rslt)
988 {
989 	inot_private_data_t *ntp;
990 	tstate_t *tptr;
991 	struct tslist *lhp;
992 	int bus, i;
993 
994 	for (bus = 0; bus < isp->isp_nchan; bus++) {
995 		for (i = 0; i < LUN_HASH_SIZE; i++) {
996 			ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
997 			SLIST_FOREACH(tptr, lhp, next) {
998 				ntp = isp_find_ntpd(isp, tptr, tag_id, seq_id);
999 				if (ntp) {
1000 					*rslt = tptr;
1001 					tptr->hold++;
1002 					return (ntp);
1003 				}
1004 			}
1005 		}
1006 	}
1007 	return (NULL);
1008 }
1009 
1010 static ISP_INLINE void
1011 rls_lun_statep(ispsoftc_t *isp, tstate_t *tptr)
1012 {
1013 	KASSERT((tptr->hold), ("tptr not held"));
1014 	tptr->hold--;
1015 }
1016 
1017 static void
1018 isp_tmcmd_restart(ispsoftc_t *isp)
1019 {
1020 	inot_private_data_t *ntp;
1021 	inot_private_data_t *restart_queue;
1022 	tstate_t *tptr;
1023 	union ccb *ccb;
1024 	struct tslist *lhp;
1025 	int bus, i;
1026 
1027 	for (bus = 0; bus < isp->isp_nchan; bus++) {
1028 		for (i = 0; i < LUN_HASH_SIZE; i++) {
1029 			ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
1030 			SLIST_FOREACH(tptr, lhp, next) {
1031 				if ((restart_queue = tptr->restart_queue) != NULL)
1032 					tptr->restart_queue = NULL;
1033 				while (restart_queue) {
1034 					ntp = restart_queue;
1035 					restart_queue = ntp->rd.nt.nt_hba;
1036 					if (IS_24XX(isp)) {
1037 						isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at7_entry_t *)ntp->rd.data)->at_rxid);
1038 						isp_handle_platform_atio7(isp, (at7_entry_t *) ntp->rd.data);
1039 					} else {
1040 						isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at2_entry_t *)ntp->rd.data)->at_rxid);
1041 						isp_handle_platform_atio2(isp, (at2_entry_t *) ntp->rd.data);
1042 					}
1043 					isp_put_ntpd(isp, tptr, ntp);
1044 					if (tptr->restart_queue && restart_queue != NULL) {
1045 						ntp = tptr->restart_queue;
1046 						tptr->restart_queue = restart_queue;
1047 						while (restart_queue->rd.nt.nt_hba) {
1048 							restart_queue = restart_queue->rd.nt.nt_hba;
1049 						}
1050 						restart_queue->rd.nt.nt_hba = ntp;
1051 						break;
1052 					}
1053 				}
1054 				/*
1055 				 * We only need to do this once per tptr
1056 				 */
1057 				if (!TAILQ_EMPTY(&tptr->waitq)) {
1058 					ccb = (union ccb *)TAILQ_LAST(&tptr->waitq, isp_ccbq);
1059 					TAILQ_REMOVE(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
1060 					isp_target_start_ctio(isp, ccb, FROM_TIMER);
1061 				}
1062 			}
1063 		}
1064 	}
1065 }
1066 
1067 static ISP_INLINE atio_private_data_t *
1068 isp_get_atpd(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag)
1069 {
1070 	atio_private_data_t *atp;
1071 
1072 	atp = LIST_FIRST(&tptr->atfree);
1073 	if (atp) {
1074 		LIST_REMOVE(atp, next);
1075 		atp->tag = tag;
1076 		LIST_INSERT_HEAD(&tptr->atused[ATPDPHASH(tag)], atp, next);
1077 	}
1078 	return (atp);
1079 }
1080 
1081 static ISP_INLINE atio_private_data_t *
1082 isp_find_atpd(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag)
1083 {
1084 	atio_private_data_t *atp;
1085 
1086 	LIST_FOREACH(atp, &tptr->atused[ATPDPHASH(tag)], next) {
1087 		if (atp->tag == tag)
1088 			return (atp);
1089 	}
1090 	return (NULL);
1091 }
1092 
1093 static ISP_INLINE void
1094 isp_put_atpd(ispsoftc_t *isp, tstate_t *tptr, atio_private_data_t *atp)
1095 {
1096 	if (atp->ests) {
1097 		isp_put_ecmd(isp, atp->ests);
1098 	}
1099 	LIST_REMOVE(atp, next);
1100 	memset(atp, 0, sizeof (*atp));
1101 	LIST_INSERT_HEAD(&tptr->atfree, atp, next);
1102 }
1103 
1104 static void
1105 isp_dump_atpd(ispsoftc_t *isp, tstate_t *tptr)
1106 {
1107 	atio_private_data_t *atp;
1108 	const char *states[8] = { "Free", "ATIO", "CAM", "CTIO", "LAST_CTIO", "PDON", "?6", "7" };
1109 
1110 	for (atp = tptr->atpool; atp < &tptr->atpool[ATPDPSIZE]; atp++) {
1111 		xpt_print(tptr->owner, "ATP: [0x%x] origdlen %u bytes_xfrd %u lun %u nphdl 0x%04x s_id 0x%06x d_id 0x%06x oxid 0x%04x state %s\n",
1112 		    atp->tag, atp->orig_datalen, atp->bytes_xfered, atp->lun, atp->nphdl, atp->sid, atp->portid, atp->oxid, states[atp->state & 0x7]);
1113 	}
1114 }
1115 
1116 
1117 static ISP_INLINE inot_private_data_t *
1118 isp_get_ntpd(ispsoftc_t *isp, tstate_t *tptr)
1119 {
1120 	inot_private_data_t *ntp;
1121 	ntp = tptr->ntfree;
1122 	if (ntp) {
1123 		tptr->ntfree = ntp->next;
1124 	}
1125 	return (ntp);
1126 }
1127 
1128 static ISP_INLINE inot_private_data_t *
1129 isp_find_ntpd(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag_id, uint32_t seq_id)
1130 {
1131 	inot_private_data_t *ntp;
1132 	for (ntp = tptr->ntpool; ntp < &tptr->ntpool[ATPDPSIZE]; ntp++) {
1133 		if (ntp->rd.tag_id == tag_id && ntp->rd.seq_id == seq_id) {
1134 			return (ntp);
1135 		}
1136 	}
1137 	return (NULL);
1138 }
1139 
1140 static ISP_INLINE void
1141 isp_put_ntpd(ispsoftc_t *isp, tstate_t *tptr, inot_private_data_t *ntp)
1142 {
1143 	ntp->rd.tag_id = ntp->rd.seq_id = 0;
1144 	ntp->next = tptr->ntfree;
1145 	tptr->ntfree = ntp;
1146 }
1147 
1148 static cam_status
1149 create_lun_state(ispsoftc_t *isp, int bus, struct cam_path *path, tstate_t **rslt)
1150 {
1151 	cam_status status;
1152 	lun_id_t lun;
1153 	struct tslist *lhp;
1154 	tstate_t *tptr;
1155 	int i;
1156 
1157 	lun = xpt_path_lun_id(path);
1158 	if (lun != CAM_LUN_WILDCARD) {
1159 		if (lun >= ISP_MAX_LUNS(isp)) {
1160 			return (CAM_LUN_INVALID);
1161 		}
1162 	}
1163 	if (is_lun_enabled(isp, bus, lun)) {
1164 		return (CAM_LUN_ALRDY_ENA);
1165 	}
1166 	tptr = malloc(sizeof (tstate_t), M_DEVBUF, M_NOWAIT|M_ZERO);
1167 	if (tptr == NULL) {
1168 		return (CAM_RESRC_UNAVAIL);
1169 	}
1170 	tptr->ts_lun = lun;
1171 	status = xpt_create_path(&tptr->owner, NULL, xpt_path_path_id(path), xpt_path_target_id(path), lun);
1172 	if (status != CAM_REQ_CMP) {
1173 		free(tptr, M_DEVBUF);
1174 		return (status);
1175 	}
1176 	SLIST_INIT(&tptr->atios);
1177 	SLIST_INIT(&tptr->inots);
1178 	TAILQ_INIT(&tptr->waitq);
1179 	LIST_INIT(&tptr->atfree);
1180 	for (i = ATPDPSIZE-1; i >= 0; i--)
1181 		LIST_INSERT_HEAD(&tptr->atfree, &tptr->atpool[i], next);
1182 	for (i = 0; i < ATPDPHASHSIZE; i++)
1183 		LIST_INIT(&tptr->atused[i]);
1184 	for (i = 0; i < ATPDPSIZE-1; i++)
1185 		tptr->ntpool[i].next = &tptr->ntpool[i+1];
1186 	tptr->ntfree = tptr->ntpool;
1187 	tptr->hold = 1;
1188 	ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(lun)], lhp);
1189 	SLIST_INSERT_HEAD(lhp, tptr, next);
1190 	*rslt = tptr;
1191 	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, path, "created tstate\n");
1192 	return (CAM_REQ_CMP);
1193 }
1194 
1195 static ISP_INLINE void
1196 destroy_lun_state(ispsoftc_t *isp, tstate_t *tptr)
1197 {
1198 	union ccb *ccb;
1199 	struct tslist *lhp;
1200 
1201 	KASSERT((tptr->hold != 0), ("tptr is not held"));
1202 	KASSERT((tptr->hold == 1), ("tptr still held (%d)", tptr->hold));
1203 	do {
1204 		ccb = (union ccb *)SLIST_FIRST(&tptr->atios);
1205 		if (ccb) {
1206 			SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
1207 			ccb->ccb_h.status = CAM_REQ_ABORTED;
1208 			xpt_done(ccb);
1209 		}
1210 	} while (ccb);
1211 	do {
1212 		ccb = (union ccb *)SLIST_FIRST(&tptr->inots);
1213 		if (ccb) {
1214 			SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
1215 			ccb->ccb_h.status = CAM_REQ_ABORTED;
1216 			xpt_done(ccb);
1217 		}
1218 	} while (ccb);
1219 	ISP_GET_PC_ADDR(isp, cam_sim_bus(xpt_path_sim(tptr->owner)), lun_hash[LUN_HASH_FUNC(tptr->ts_lun)], lhp);
1220 	SLIST_REMOVE(lhp, tptr, tstate, next);
1221 	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, tptr->owner, "destroyed tstate\n");
1222 	xpt_free_path(tptr->owner);
1223 	free(tptr, M_DEVBUF);
1224 }
1225 
1226 /*
1227  * Enable a lun.
1228  */
1229 static void
1230 isp_enable_lun(ispsoftc_t *isp, union ccb *ccb)
1231 {
1232 	tstate_t *tptr = NULL;
1233 	int bus, tm_enabled, target_role;
1234 	target_id_t target;
1235 	lun_id_t lun;
1236 
1237 
1238 	/*
1239 	 * We only support either a wildcard target/lun or a target ID of zero and a non-wildcard lun
1240 	 */
1241 	bus = XS_CHANNEL(ccb);
1242 	target = ccb->ccb_h.target_id;
1243 	lun = ccb->ccb_h.target_lun;
1244 	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0|ISP_LOGCONFIG, ccb->ccb_h.path, "enabling lun %u\n", lun);
1245 	if (target == CAM_TARGET_WILDCARD && lun != CAM_LUN_WILDCARD) {
1246 		ccb->ccb_h.status = CAM_LUN_INVALID;
1247 		xpt_done(ccb);
1248 		return;
1249 	}
1250 
1251 	if (target != CAM_TARGET_WILDCARD && lun == CAM_LUN_WILDCARD) {
1252 		ccb->ccb_h.status = CAM_LUN_INVALID;
1253 		xpt_done(ccb);
1254 		return;
1255 	}
1256 	if (isp->isp_dblev & ISP_LOGTDEBUG0) {
1257 		xpt_print(ccb->ccb_h.path, "enabling lun 0x%x on channel %d\n", lun, bus);
1258 	}
1259 
1260 	/*
1261 	 * Wait until we're not busy with the lun enables subsystem
1262 	 */
1263 	isp_tmlock(isp, "isp_enable_lun");
1264 
1265 	/*
1266 	 * This is as a good a place as any to check f/w capabilities.
1267 	 */
1268 
1269 	if (IS_FC(isp)) {
1270 		if (ISP_CAP_TMODE(isp) == 0) {
1271 			xpt_print(ccb->ccb_h.path, "firmware does not support target mode\n");
1272 			ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
1273 			goto done;
1274 		}
1275 		/*
1276 		 * We *could* handle non-SCCLUN f/w, but we'd have to
1277 		 * dork with our already fragile enable/disable code.
1278 		 */
1279 		if (ISP_CAP_SCCFW(isp) == 0) {
1280 			xpt_print(ccb->ccb_h.path, "firmware not SCCLUN capable\n");
1281 			ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
1282 			goto done;
1283 		}
1284 
1285 		target_role = (FCPARAM(isp, bus)->role & ISP_ROLE_TARGET) != 0;
1286 
1287 	} else {
1288 		target_role = (SDPARAM(isp, bus)->role & ISP_ROLE_TARGET) != 0;
1289 	}
1290 
1291 	/*
1292 	 * Create the state pointer.
1293 	 * It should not already exist.
1294 	 */
1295 	tptr = get_lun_statep(isp, bus, lun);
1296 	if (tptr) {
1297 		ccb->ccb_h.status = CAM_LUN_ALRDY_ENA;
1298 		goto done;
1299 	}
1300 	ccb->ccb_h.status = create_lun_state(isp, bus, ccb->ccb_h.path, &tptr);
1301 	if (ccb->ccb_h.status != CAM_REQ_CMP) {
1302 		goto done;
1303 	}
1304 
1305 	/*
1306 	 * We have a tricky maneuver to perform here.
1307 	 *
1308 	 * If target mode isn't already enabled here,
1309 	 * *and* our current role includes target mode,
1310 	 * we enable target mode here.
1311 	 *
1312 	 */
1313 	ISP_GET_PC(isp, bus, tm_enabled, tm_enabled);
1314 	if (tm_enabled == 0 && target_role != 0) {
1315 		if (isp_enable_target_mode(isp, bus)) {
1316 			ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1317 			destroy_lun_state(isp, tptr);
1318 			tptr = NULL;
1319 			goto done;
1320 		}
1321 		tm_enabled = 1;
1322 	}
1323 
1324 	/*
1325 	 * Now check to see whether this bus is in target mode already.
1326 	 *
1327 	 * If not, a later role change into target mode will finish the job.
1328 	 */
1329 	if (tm_enabled == 0) {
1330 		ISP_SET_PC(isp, bus, tm_enable_defer, 1);
1331 		ccb->ccb_h.status = CAM_REQ_CMP;
1332 		xpt_print(ccb->ccb_h.path, "Target Mode not enabled yet- lun enable deferred\n");
1333 		goto done1;
1334 	}
1335 
1336 	/*
1337 	 * Enable the lun.
1338 	 */
1339 	ccb->ccb_h.status = isp_enable_deferred(isp, bus, lun);
1340 
1341 done:
1342 	if (ccb->ccb_h.status != CAM_REQ_CMP)  {
1343 		if (tptr) {
1344 			destroy_lun_state(isp, tptr);
1345 			tptr = NULL;
1346 		}
1347 	} else {
1348 		tptr->enabled = 1;
1349 	}
1350 done1:
1351 	if (tptr) {
1352 		rls_lun_statep(isp, tptr);
1353 	}
1354 
1355 	/*
1356 	 * And we're outta here....
1357 	 */
1358 	isp_tmunlk(isp);
1359 	xpt_done(ccb);
1360 }
1361 
1362 static cam_status
1363 isp_enable_deferred_luns(ispsoftc_t *isp, int bus)
1364 {
1365 	tstate_t *tptr = NULL;
1366 	struct tslist *lhp;
1367 	int i, n;
1368 
1369 
1370 	ISP_GET_PC(isp, bus, tm_enabled, i);
1371 	if (i == 1) {
1372 		return (CAM_REQ_CMP);
1373 	}
1374 	ISP_GET_PC(isp, bus, tm_enable_defer, i);
1375 	if (i == 0) {
1376 		return (CAM_REQ_CMP);
1377 	}
1378 	/*
1379 	 * If this succeeds, it will set tm_enable
1380 	 */
1381 	if (isp_enable_target_mode(isp, bus)) {
1382 		return (CAM_REQ_CMP_ERR);
1383 	}
1384 	isp_tmlock(isp, "isp_enable_deferred_luns");
1385 	for (n = i = 0; i < LUN_HASH_SIZE; i++) {
1386 		ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
1387 		SLIST_FOREACH(tptr, lhp, next) {
1388 			tptr->hold++;
1389 			if (tptr->enabled == 0) {
1390 				if (isp_enable_deferred(isp, bus, tptr->ts_lun) == CAM_REQ_CMP) {
1391 					tptr->enabled = 1;
1392 					n++;
1393 				}
1394 			} else {
1395 				n++;
1396 			}
1397 			tptr->hold--;
1398 		}
1399 	}
1400 	isp_tmunlk(isp);
1401 	if (n == 0) {
1402 		return (CAM_REQ_CMP_ERR);
1403 	}
1404 	ISP_SET_PC(isp, bus, tm_enable_defer, 0);
1405 	return (CAM_REQ_CMP);
1406 }
1407 
1408 static cam_status
1409 isp_enable_deferred(ispsoftc_t *isp, int bus, lun_id_t lun)
1410 {
1411 	cam_status status;
1412 	int luns_already_enabled;
1413 
1414 	ISP_GET_PC(isp, bus, tm_luns_enabled, luns_already_enabled);
1415 	isp_prt(isp, ISP_LOGTINFO, "%s: bus %d lun %jx luns_enabled %d", __func__, bus, (uintmax_t)lun, luns_already_enabled);
1416 	if (IS_24XX(isp) || (IS_FC(isp) && luns_already_enabled)) {
1417 		status = CAM_REQ_CMP;
1418 	} else {
1419 		int cmd_cnt, not_cnt;
1420 
1421 		if (IS_23XX(isp)) {
1422 			cmd_cnt = DFLT_CMND_CNT;
1423 			not_cnt = DFLT_INOT_CNT;
1424 		} else {
1425 			cmd_cnt = 64;
1426 			not_cnt = 8;
1427 		}
1428 		status = CAM_REQ_INPROG;
1429 		isp->isp_osinfo.rptr = &status;
1430 		if (isp_lun_cmd(isp, RQSTYPE_ENABLE_LUN, bus, lun == CAM_LUN_WILDCARD? 0 : lun, cmd_cnt, not_cnt)) {
1431 			status = CAM_RESRC_UNAVAIL;
1432 		} else {
1433 			mtx_sleep(&status, &isp->isp_lock, PRIBIO, "isp_enable_deferred", 0);
1434 		}
1435 		isp->isp_osinfo.rptr = NULL;
1436 	}
1437 	if (status == CAM_REQ_CMP) {
1438 		ISP_SET_PC(isp, bus, tm_luns_enabled, 1);
1439 		isp_prt(isp, ISP_LOGCONFIG|ISP_LOGTINFO, "bus %d lun %jx now enabled for target mode", bus, (uintmax_t)lun);
1440 	}
1441 	return (status);
1442 }
1443 
1444 static void
1445 isp_disable_lun(ispsoftc_t *isp, union ccb *ccb)
1446 {
1447 	tstate_t *tptr = NULL;
1448 	int bus;
1449 	cam_status status;
1450 	target_id_t target;
1451 	lun_id_t lun;
1452 
1453 	bus = XS_CHANNEL(ccb);
1454 	target = ccb->ccb_h.target_id;
1455 	lun = ccb->ccb_h.target_lun;
1456 	ISP_PATH_PRT(isp, ISP_LOGTDEBUG0|ISP_LOGCONFIG, ccb->ccb_h.path, "disabling lun %u\n", lun);
1457 	if (target == CAM_TARGET_WILDCARD && lun != CAM_LUN_WILDCARD) {
1458 		ccb->ccb_h.status = CAM_LUN_INVALID;
1459 		xpt_done(ccb);
1460 		return;
1461 	}
1462 
1463 	if (target != CAM_TARGET_WILDCARD && lun == CAM_LUN_WILDCARD) {
1464 		ccb->ccb_h.status = CAM_LUN_INVALID;
1465 		xpt_done(ccb);
1466 		return;
1467 	}
1468 
1469 	/*
1470 	 * See if we're busy disabling a lun now.
1471 	 */
1472 	isp_tmlock(isp, "isp_disable_lun");
1473 	status = CAM_REQ_INPROG;
1474 
1475 	/*
1476 	 * Find the state pointer.
1477 	 */
1478 	if ((tptr = get_lun_statep(isp, bus, lun)) == NULL) {
1479 		status = CAM_PATH_INVALID;
1480 		goto done;
1481 	}
1482 
1483 	/*
1484 	 * If we're a 24XX card, we're done.
1485 	 */
1486 	if (IS_24XX(isp)) {
1487 		status = CAM_REQ_CMP;
1488 		goto done;
1489 	}
1490 
1491 	/*
1492 	 * For SCC FW, we only deal with lun zero.
1493 	 */
1494 	if (IS_FC(isp) && lun > 0) {
1495 		status = CAM_REQ_CMP;
1496 		goto done;
1497 	}
1498 	isp->isp_osinfo.rptr = &status;
1499 	if (isp_lun_cmd(isp, RQSTYPE_ENABLE_LUN, bus, lun, 0, 0)) {
1500 		status = CAM_RESRC_UNAVAIL;
1501 	} else {
1502 		mtx_sleep(ccb, &isp->isp_lock, PRIBIO, "isp_disable_lun", 0);
1503 	}
1504 	isp->isp_osinfo.rptr = NULL;
1505 done:
1506 	if (status == CAM_REQ_CMP) {
1507 		tptr->enabled = 0;
1508 		if (is_any_lun_enabled(isp, bus) == 0) {
1509 			if (isp_disable_target_mode(isp, bus)) {
1510 				status = CAM_REQ_CMP_ERR;
1511 			}
1512 		}
1513 	}
1514 	ccb->ccb_h.status = status;
1515 	if (status == CAM_REQ_CMP) {
1516 		destroy_lun_state(isp, tptr);
1517 		xpt_print(ccb->ccb_h.path, "lun now disabled for target mode\n");
1518 	} else {
1519 		if (tptr)
1520 			rls_lun_statep(isp, tptr);
1521 	}
1522 	isp_tmunlk(isp);
1523 	xpt_done(ccb);
1524 }
1525 
1526 static int
1527 isp_enable_target_mode(ispsoftc_t *isp, int bus)
1528 {
1529 	int tm_enabled;
1530 
1531 	ISP_GET_PC(isp, bus, tm_enabled, tm_enabled);
1532 	if (tm_enabled != 0) {
1533 		return (0);
1534 	}
1535 	if (IS_SCSI(isp)) {
1536 		mbreg_t mbs;
1537 		MBSINIT(&mbs, MBOX_ENABLE_TARGET_MODE, MBLOGALL, 0);
1538 		mbs.param[0] = MBOX_ENABLE_TARGET_MODE;
1539 		mbs.param[1] = ENABLE_TARGET_FLAG|ENABLE_TQING_FLAG;
1540 		mbs.param[2] = bus << 7;
1541 		if (isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs) < 0 || mbs.param[0] != MBOX_COMMAND_COMPLETE) {
1542 			isp_prt(isp, ISP_LOGERR, "Unable to enable Target Role on Bus %d", bus);
1543 			return (EIO);
1544 		}
1545 	}
1546 	ISP_SET_PC(isp, bus, tm_enabled, 1);
1547 	isp_prt(isp, ISP_LOGINFO, "Target Role enabled on Bus %d", bus);
1548 	return (0);
1549 }
1550 
1551 static int
1552 isp_disable_target_mode(ispsoftc_t *isp, int bus)
1553 {
1554 	int tm_enabled;
1555 
1556 	ISP_GET_PC(isp, bus, tm_enabled, tm_enabled);
1557 	if (tm_enabled == 0) {
1558 		return (0);
1559 	}
1560 	if (IS_SCSI(isp)) {
1561 		mbreg_t mbs;
1562 		MBSINIT(&mbs, MBOX_ENABLE_TARGET_MODE, MBLOGALL, 0);
1563 		mbs.param[2] = bus << 7;
1564 		if (isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs) < 0 || mbs.param[0] != MBOX_COMMAND_COMPLETE) {
1565 			isp_prt(isp, ISP_LOGERR, "Unable to disable Target Role on Bus %d", bus);
1566 			return (EIO);
1567 		}
1568 	}
1569 	ISP_SET_PC(isp, bus, tm_enabled, 0);
1570 	isp_prt(isp, ISP_LOGINFO, "Target Role disabled on Bus %d", bus);
1571 	return (0);
1572 }
1573 
1574 static void
1575 isp_ledone(ispsoftc_t *isp, lun_entry_t *lep)
1576 {
1577 	uint32_t *rptr;
1578 
1579 	rptr = isp->isp_osinfo.rptr;
1580 	if (lep->le_status != LUN_OK) {
1581 		isp_prt(isp, ISP_LOGERR, "ENABLE/MODIFY LUN returned 0x%x", lep->le_status);
1582 		if (rptr) {
1583 			*rptr = CAM_REQ_CMP_ERR;
1584 			wakeup_one(rptr);
1585 		}
1586 	} else {
1587 		if (rptr) {
1588 			*rptr = CAM_REQ_CMP;
1589 			wakeup_one(rptr);
1590 		}
1591 	}
1592 }
1593 
1594 static void
1595 isp_target_start_ctio(ispsoftc_t *isp, union ccb *ccb, enum Start_Ctio_How how)
1596 {
1597 	int fctape, sendstatus, resid;
1598 	tstate_t *tptr;
1599 	fcparam *fcp;
1600 	atio_private_data_t *atp;
1601 	struct ccb_scsiio *cso;
1602 	uint32_t dmaresult, handle, xfrlen, sense_length, tmp;
1603 	uint8_t local[QENTRY_LEN];
1604 
1605 	tptr = get_lun_statep(isp, XS_CHANNEL(ccb), XS_LUN(ccb));
1606 	if (tptr == NULL) {
1607 		tptr = get_lun_statep(isp, XS_CHANNEL(ccb), CAM_LUN_WILDCARD);
1608 		if (tptr == NULL) {
1609 			isp_prt(isp, ISP_LOGERR, "%s: [0x%x] cannot find tstate pointer", __func__, ccb->csio.tag_id);
1610 			ccb->ccb_h.status = CAM_DEV_NOT_THERE;
1611 			xpt_done(ccb);
1612 			return;
1613 		}
1614 	}
1615 	isp_prt(isp, ISP_LOGTDEBUG0, "%s: ENTRY[0x%x] how %u xfrlen %u sendstatus %d sense_len %u", __func__, ccb->csio.tag_id, how, ccb->csio.dxfer_len,
1616 	    (ccb->ccb_h.flags & CAM_SEND_STATUS) != 0, ((ccb->ccb_h.flags & CAM_SEND_SENSE)? ccb->csio.sense_len : 0));
1617 
1618 	switch (how) {
1619 	case FROM_TIMER:
1620 	case FROM_CAM:
1621 		/*
1622 		 * Insert at the tail of the list, if any, waiting CTIO CCBs
1623 		 */
1624 		TAILQ_INSERT_TAIL(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
1625 		break;
1626 	case FROM_SRR:
1627 	case FROM_CTIO_DONE:
1628 		TAILQ_INSERT_HEAD(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
1629 		break;
1630 	}
1631 
1632 	while (TAILQ_FIRST(&tptr->waitq) != NULL) {
1633 		ccb = (union ccb *) TAILQ_FIRST(&tptr->waitq);
1634 		TAILQ_REMOVE(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
1635 
1636 		cso = &ccb->csio;
1637 		xfrlen = cso->dxfer_len;
1638 		if (xfrlen == 0) {
1639 			if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
1640 				ISP_PATH_PRT(isp, ISP_LOGERR, ccb->ccb_h.path, "a data transfer length of zero but no status to send is wrong\n");
1641 				ccb->ccb_h.status = CAM_REQ_INVALID;
1642 				xpt_done(ccb);
1643 				continue;
1644 			}
1645 		}
1646 
1647 		atp = isp_find_atpd(isp, tptr, cso->tag_id);
1648 		if (atp == NULL) {
1649 			isp_prt(isp, ISP_LOGERR, "%s: [0x%x] cannot find private data adjunct in %s", __func__, cso->tag_id, __func__);
1650 			isp_dump_atpd(isp, tptr);
1651 			ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1652 			xpt_done(ccb);
1653 			continue;
1654 		}
1655 
1656 		/*
1657 		 * Is this command a dead duck?
1658 		 */
1659 		if (atp->dead) {
1660 			isp_prt(isp, ISP_LOGERR, "%s: [0x%x] not sending a CTIO for a dead command", __func__, cso->tag_id);
1661 			ccb->ccb_h.status = CAM_REQ_ABORTED;
1662 			xpt_done(ccb);
1663 			continue;
1664 		}
1665 
1666 		/*
1667 		 * Check to make sure we're still in target mode.
1668 		 */
1669 		fcp = FCPARAM(isp, XS_CHANNEL(ccb));
1670 		if ((fcp->role & ISP_ROLE_TARGET) == 0) {
1671 			isp_prt(isp, ISP_LOGERR, "%s: [0x%x] stopping sending a CTIO because we're no longer in target mode", __func__, cso->tag_id);
1672 			ccb->ccb_h.status = CAM_PROVIDE_FAIL;
1673 			xpt_done(ccb);
1674 			continue;
1675 		}
1676 
1677 		/*
1678 		 * We're only handling ATPD_CCB_OUTSTANDING outstanding CCB at a time (one of which
1679 		 * could be split into two CTIOs to split data and status).
1680 		 */
1681 		if (atp->ctcnt >= ATPD_CCB_OUTSTANDING) {
1682 			isp_prt(isp, ISP_LOGTINFO, "[0x%x] handling only %d CCBs at a time (flags for this ccb: 0x%x)", cso->tag_id, ATPD_CCB_OUTSTANDING, ccb->ccb_h.flags);
1683 			TAILQ_INSERT_HEAD(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
1684 			break;
1685 		}
1686 
1687 		/*
1688 		 * Does the initiator expect FC-Tape style responses?
1689 		 */
1690 		if ((atp->word3 & PRLI_WD3_RETRY) && fcp->fctape_enabled) {
1691 			fctape = 1;
1692 		} else {
1693 			fctape = 0;
1694 		}
1695 
1696 		/*
1697 		 * If we already did the data xfer portion of a CTIO that sends data
1698 		 * and status, don't do it again and do the status portion now.
1699 		 */
1700 		if (atp->sendst) {
1701 			isp_prt(isp, ISP_LOGTINFO, "[0x%x] now sending synthesized status orig_dl=%u xfered=%u bit=%u",
1702 			    cso->tag_id, atp->orig_datalen, atp->bytes_xfered, atp->bytes_in_transit);
1703 			xfrlen = 0;	/* we already did the data transfer */
1704 			atp->sendst = 0;
1705 		}
1706 		if (ccb->ccb_h.flags & CAM_SEND_STATUS) {
1707 			sendstatus = 1;
1708 		} else {
1709 			sendstatus = 0;
1710 		}
1711 
1712 		if (ccb->ccb_h.flags & CAM_SEND_SENSE) {
1713 			KASSERT((sendstatus != 0), ("how can you have CAM_SEND_SENSE w/o CAM_SEND_STATUS?"));
1714 			/*
1715 			 * Sense length is not the entire sense data structure size. Periph
1716 			 * drivers don't seem to be setting sense_len to reflect the actual
1717 			 * size. We'll peek inside to get the right amount.
1718 			 */
1719 			sense_length = cso->sense_len;
1720 
1721 			/*
1722 			 * This 'cannot' happen
1723 			 */
1724 			if (sense_length > (XCMD_SIZE - MIN_FCP_RESPONSE_SIZE)) {
1725 				sense_length = XCMD_SIZE - MIN_FCP_RESPONSE_SIZE;
1726 			}
1727 		} else {
1728 			sense_length = 0;
1729 		}
1730 
1731 		memset(local, 0, QENTRY_LEN);
1732 
1733 		/*
1734 		 * Check for overflow
1735 		 */
1736 		tmp = atp->bytes_xfered + atp->bytes_in_transit + xfrlen;
1737 		if (tmp > atp->orig_datalen) {
1738 			isp_prt(isp, ISP_LOGERR, "%s: [0x%x] data overflow by %u bytes", __func__, cso->tag_id, tmp - atp->orig_datalen);
1739 			ccb->ccb_h.status = CAM_DATA_RUN_ERR;
1740 			xpt_done(ccb);
1741 			continue;
1742 		}
1743 
1744 		if (IS_24XX(isp)) {
1745 			ct7_entry_t *cto = (ct7_entry_t *) local;
1746 
1747 			cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
1748 			cto->ct_header.rqs_entry_count = 1;
1749 			cto->ct_header.rqs_seqno |= ATPD_SEQ_NOTIFY_CAM;
1750 			ATPD_SET_SEQNO(cto, atp);
1751 			cto->ct_nphdl = atp->nphdl;
1752 			cto->ct_rxid = atp->tag;
1753 			cto->ct_iid_lo = atp->portid;
1754 			cto->ct_iid_hi = atp->portid >> 16;
1755 			cto->ct_oxid = atp->oxid;
1756 			cto->ct_vpidx = ISP_GET_VPIDX(isp, XS_CHANNEL(ccb));
1757 			cto->ct_timeout = 120;
1758 			cto->ct_flags = atp->tattr << CT7_TASK_ATTR_SHIFT;
1759 
1760 			/*
1761 			 * Mode 1, status, no data. Only possible when we are sending status, have
1762 			 * no data to transfer, and any sense data can fit into a ct7_entry_t.
1763 			 *
1764 			 * Mode 2, status, no data. We have to use this in the case that
1765 			 * the sense data won't fit into a ct7_entry_t.
1766 			 *
1767 			 */
1768 			if (sendstatus && xfrlen == 0) {
1769 				cto->ct_flags |= CT7_SENDSTATUS | CT7_NO_DATA;
1770 				resid = atp->orig_datalen - atp->bytes_xfered - atp->bytes_in_transit;
1771 				if (sense_length <= MAXRESPLEN_24XX) {
1772 					if (resid < 0) {
1773 						cto->ct_resid = -resid;
1774 					} else if (resid > 0) {
1775 						cto->ct_resid = resid;
1776 					}
1777 					cto->ct_flags |= CT7_FLAG_MODE1;
1778 					cto->ct_scsi_status = cso->scsi_status;
1779 					if (resid < 0) {
1780 						cto->ct_scsi_status |= (FCP_RESID_OVERFLOW << 8);
1781 					} else if (resid > 0) {
1782 						cto->ct_scsi_status |= (FCP_RESID_UNDERFLOW << 8);
1783 					}
1784 					if (fctape) {
1785 						cto->ct_flags |= CT7_CONFIRM|CT7_EXPLCT_CONF;
1786 					}
1787 					if (sense_length) {
1788 						cto->ct_scsi_status |= (FCP_SNSLEN_VALID << 8);
1789 						cto->rsp.m1.ct_resplen = cto->ct_senselen = sense_length;
1790 						memcpy(cto->rsp.m1.ct_resp, &cso->sense_data, sense_length);
1791 					}
1792 				} else {
1793 					bus_addr_t addr;
1794 					char buf[XCMD_SIZE];
1795 					fcp_rsp_iu_t *rp;
1796 
1797 					if (atp->ests == NULL) {
1798 						atp->ests = isp_get_ecmd(isp);
1799 						if (atp->ests == NULL) {
1800 							TAILQ_INSERT_HEAD(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
1801 							break;
1802 						}
1803 					}
1804 					memset(buf, 0, sizeof (buf));
1805 					rp = (fcp_rsp_iu_t *)buf;
1806 					if (fctape) {
1807 						cto->ct_flags |= CT7_CONFIRM|CT7_EXPLCT_CONF;
1808 						rp->fcp_rsp_bits |= FCP_CONF_REQ;
1809 					}
1810 					cto->ct_flags |= CT7_FLAG_MODE2;
1811 	        			rp->fcp_rsp_scsi_status = cso->scsi_status;
1812 					if (resid < 0) {
1813 						rp->fcp_rsp_resid = -resid;
1814 						rp->fcp_rsp_bits |= FCP_RESID_OVERFLOW;
1815 					} else if (resid > 0) {
1816 						rp->fcp_rsp_resid = resid;
1817 						rp->fcp_rsp_bits |= FCP_RESID_UNDERFLOW;
1818 					}
1819 					if (sense_length) {
1820 	        				rp->fcp_rsp_snslen = sense_length;
1821 						cto->ct_senselen = sense_length;
1822 						rp->fcp_rsp_bits |= FCP_SNSLEN_VALID;
1823 						isp_put_fcp_rsp_iu(isp, rp, atp->ests);
1824 						memcpy(((fcp_rsp_iu_t *)atp->ests)->fcp_rsp_extra, &cso->sense_data, sense_length);
1825 					} else {
1826 						isp_put_fcp_rsp_iu(isp, rp, atp->ests);
1827 					}
1828 					if (isp->isp_dblev & ISP_LOGTDEBUG1) {
1829 						isp_print_bytes(isp, "FCP Response Frame After Swizzling", MIN_FCP_RESPONSE_SIZE + sense_length, atp->ests);
1830 					}
1831 					addr = isp->isp_osinfo.ecmd_dma;
1832 					addr += ((((isp_ecmd_t *)atp->ests) - isp->isp_osinfo.ecmd_base) * XCMD_SIZE);
1833 					isp_prt(isp, ISP_LOGTDEBUG0, "%s: ests base %p vaddr %p ecmd_dma %jx addr %jx len %u", __func__, isp->isp_osinfo.ecmd_base, atp->ests,
1834 					    (uintmax_t) isp->isp_osinfo.ecmd_dma, (uintmax_t)addr, MIN_FCP_RESPONSE_SIZE + sense_length);
1835 					cto->rsp.m2.ct_datalen = MIN_FCP_RESPONSE_SIZE + sense_length;
1836 					cto->rsp.m2.ct_fcp_rsp_iudata.ds_base = DMA_LO32(addr);
1837 					cto->rsp.m2.ct_fcp_rsp_iudata.ds_basehi = DMA_HI32(addr);
1838 					cto->rsp.m2.ct_fcp_rsp_iudata.ds_count = MIN_FCP_RESPONSE_SIZE + sense_length;
1839 				}
1840 				if (sense_length) {
1841 					isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO7[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d slen %u sense: %x %x/%x/%x", __func__,
1842 					    cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cto->ct_scsi_status, cto->ct_flags, cto->ct_resid, sense_length,
1843 					    cso->sense_data.error_code, cso->sense_data.sense_buf[1], cso->sense_data.sense_buf[11], cso->sense_data.sense_buf[12]);
1844 				} else {
1845 					isp_prt(isp, ISP_LOGDEBUG0, "%s: CTIO7[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d", __func__,
1846 					    cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cto->ct_scsi_status, cto->ct_flags, cto->ct_resid);
1847 				}
1848 				atp->state = ATPD_STATE_LAST_CTIO;
1849 			}
1850 
1851 			/*
1852 			 * Mode 0 data transfers, *possibly* with status.
1853 			 */
1854 			if (xfrlen != 0) {
1855 				cto->ct_flags |= CT7_FLAG_MODE0;
1856 				if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1857 					cto->ct_flags |= CT7_DATA_IN;
1858 				} else {
1859 					cto->ct_flags |= CT7_DATA_OUT;
1860 				}
1861 
1862 				cto->rsp.m0.reloff = atp->bytes_xfered + atp->bytes_in_transit;
1863 				cto->rsp.m0.ct_xfrlen = xfrlen;
1864 
1865 #ifdef	DEBUG
1866 				if (ISP_FC_PC(isp, XS_CHANNEL(ccb))->inject_lost_data_frame && xfrlen > ISP_FC_PC(isp, XS_CHANNEL(ccb))->inject_lost_data_frame) {
1867 					isp_prt(isp, ISP_LOGWARN, "%s: truncating data frame with xfrlen %d to %d", __func__, xfrlen, xfrlen - (xfrlen >> 2));
1868 					ISP_FC_PC(isp, XS_CHANNEL(ccb))->inject_lost_data_frame = 0;
1869 					cto->rsp.m0.ct_xfrlen -= xfrlen >> 2;
1870 				}
1871 #endif
1872 				if (sendstatus) {
1873 					resid = atp->orig_datalen - atp->bytes_xfered - xfrlen;
1874 					if (cso->scsi_status == SCSI_STATUS_OK && resid == 0 /* && fctape == 0 */) {
1875 						cto->ct_flags |= CT7_SENDSTATUS;
1876 						atp->state = ATPD_STATE_LAST_CTIO;
1877 						if (fctape) {
1878 							cto->ct_flags |= CT7_CONFIRM|CT7_EXPLCT_CONF;
1879 						}
1880 					} else {
1881 						atp->sendst = 1;	/* send status later */
1882 						cto->ct_header.rqs_seqno &= ~ATPD_SEQ_NOTIFY_CAM;
1883 						atp->state = ATPD_STATE_CTIO;
1884 					}
1885 				} else {
1886 					atp->state = ATPD_STATE_CTIO;
1887 				}
1888 				isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO7[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x xfrlen=%u off=%u", __func__,
1889 				    cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cto->ct_scsi_status, cto->ct_flags, xfrlen, atp->bytes_xfered);
1890 			}
1891 		} else if (IS_FC(isp)) {
1892 			ct2_entry_t *cto = (ct2_entry_t *) local;
1893 
1894 			if (isp->isp_osinfo.sixtyfourbit)
1895 				cto->ct_header.rqs_entry_type = RQSTYPE_CTIO3;
1896 			else
1897 				cto->ct_header.rqs_entry_type = RQSTYPE_CTIO2;
1898 			cto->ct_header.rqs_entry_count = 1;
1899 			cto->ct_header.rqs_seqno |= ATPD_SEQ_NOTIFY_CAM;
1900 			ATPD_SET_SEQNO(cto, atp);
1901 			if (ISP_CAP_2KLOGIN(isp)) {
1902 				((ct2e_entry_t *)cto)->ct_iid = atp->nphdl;
1903 			} else {
1904 				cto->ct_iid = atp->nphdl;
1905 				if (ISP_CAP_SCCFW(isp) == 0) {
1906 					cto->ct_lun = ccb->ccb_h.target_lun;
1907 				}
1908 			}
1909 			cto->ct_timeout = 10;
1910 			cto->ct_rxid = cso->tag_id;
1911 
1912 			/*
1913 			 * Mode 1, status, no data. Only possible when we are sending status, have
1914 			 * no data to transfer, and the sense length can fit in the ct7_entry.
1915 			 *
1916 			 * Mode 2, status, no data. We have to use this in the case the response
1917 			 * length won't fit into a ct2_entry_t.
1918 			 *
1919 			 * We'll fill out this structure with information as if this were a
1920 			 * Mode 1. The hardware layer will create the Mode 2 FCP RSP IU as
1921 			 * needed based upon this.
1922 			 */
1923 			if (sendstatus && xfrlen == 0) {
1924 				cto->ct_flags |= CT2_SENDSTATUS | CT2_NO_DATA;
1925 				resid = atp->orig_datalen - atp->bytes_xfered - atp->bytes_in_transit;
1926 				if (sense_length <= MAXRESPLEN) {
1927 					if (resid < 0) {
1928 						cto->ct_resid = -resid;
1929 					} else if (resid > 0) {
1930 						cto->ct_resid = resid;
1931 					}
1932 					cto->ct_flags |= CT2_FLAG_MODE1;
1933 					cto->rsp.m1.ct_scsi_status = cso->scsi_status;
1934 					if (resid < 0) {
1935 						cto->rsp.m1.ct_scsi_status |= CT2_DATA_OVER;
1936 					} else if (resid > 0) {
1937 						cto->rsp.m1.ct_scsi_status |= CT2_DATA_UNDER;
1938 					}
1939 					if (fctape) {
1940 						cto->ct_flags |= CT2_CONFIRM;
1941 					}
1942 					if (sense_length) {
1943 						cto->rsp.m1.ct_scsi_status |= CT2_SNSLEN_VALID;
1944 						cto->rsp.m1.ct_resplen = cto->rsp.m1.ct_senselen = sense_length;
1945 						memcpy(cto->rsp.m1.ct_resp, &cso->sense_data, sense_length);
1946 					}
1947 				} else {
1948 					bus_addr_t addr;
1949 					char buf[XCMD_SIZE];
1950 					fcp_rsp_iu_t *rp;
1951 
1952 					if (atp->ests == NULL) {
1953 						atp->ests = isp_get_ecmd(isp);
1954 						if (atp->ests == NULL) {
1955 							TAILQ_INSERT_HEAD(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
1956 							break;
1957 						}
1958 					}
1959 					memset(buf, 0, sizeof (buf));
1960 					rp = (fcp_rsp_iu_t *)buf;
1961 					if (fctape) {
1962 						cto->ct_flags |= CT2_CONFIRM;
1963 						rp->fcp_rsp_bits |= FCP_CONF_REQ;
1964 					}
1965 					cto->ct_flags |= CT2_FLAG_MODE2;
1966 	        			rp->fcp_rsp_scsi_status = cso->scsi_status;
1967 					if (resid < 0) {
1968 						rp->fcp_rsp_resid = -resid;
1969 						rp->fcp_rsp_bits |= FCP_RESID_OVERFLOW;
1970 					} else if (resid > 0) {
1971 						rp->fcp_rsp_resid = resid;
1972 						rp->fcp_rsp_bits |= FCP_RESID_UNDERFLOW;
1973 					}
1974 					if (sense_length) {
1975 	        				rp->fcp_rsp_snslen = sense_length;
1976 						rp->fcp_rsp_bits |= FCP_SNSLEN_VALID;
1977 						isp_put_fcp_rsp_iu(isp, rp, atp->ests);
1978 						memcpy(((fcp_rsp_iu_t *)atp->ests)->fcp_rsp_extra, &cso->sense_data, sense_length);
1979 					} else {
1980 						isp_put_fcp_rsp_iu(isp, rp, atp->ests);
1981 					}
1982 					if (isp->isp_dblev & ISP_LOGTDEBUG1) {
1983 						isp_print_bytes(isp, "FCP Response Frame After Swizzling", MIN_FCP_RESPONSE_SIZE + sense_length, atp->ests);
1984 					}
1985 					addr = isp->isp_osinfo.ecmd_dma;
1986 					addr += ((((isp_ecmd_t *)atp->ests) - isp->isp_osinfo.ecmd_base) * XCMD_SIZE);
1987 					isp_prt(isp, ISP_LOGTDEBUG0, "%s: ests base %p vaddr %p ecmd_dma %jx addr %jx len %u", __func__, isp->isp_osinfo.ecmd_base, atp->ests,
1988 					    (uintmax_t) isp->isp_osinfo.ecmd_dma, (uintmax_t)addr, MIN_FCP_RESPONSE_SIZE + sense_length);
1989 					cto->rsp.m2.ct_datalen = MIN_FCP_RESPONSE_SIZE + sense_length;
1990 					if (isp->isp_osinfo.sixtyfourbit) {
1991 						cto->rsp.m2.u.ct_fcp_rsp_iudata_64.ds_base = DMA_LO32(addr);
1992 						cto->rsp.m2.u.ct_fcp_rsp_iudata_64.ds_basehi = DMA_HI32(addr);
1993 						cto->rsp.m2.u.ct_fcp_rsp_iudata_64.ds_count = MIN_FCP_RESPONSE_SIZE + sense_length;
1994 					} else {
1995 						cto->rsp.m2.u.ct_fcp_rsp_iudata_32.ds_base = DMA_LO32(addr);
1996 						cto->rsp.m2.u.ct_fcp_rsp_iudata_32.ds_count = MIN_FCP_RESPONSE_SIZE + sense_length;
1997 					}
1998 				}
1999 				if (sense_length) {
2000 					isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO2[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d sense: %x %x/%x/%x", __func__,
2001 					    cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cso->scsi_status, cto->ct_flags, cto->ct_resid,
2002 					    cso->sense_data.error_code, cso->sense_data.sense_buf[1], cso->sense_data.sense_buf[11], cso->sense_data.sense_buf[12]);
2003 				} else {
2004 					isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO2[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d", __func__, cto->ct_rxid,
2005 					    ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cso->scsi_status, cto->ct_flags, cto->ct_resid);
2006 				}
2007 				atp->state = ATPD_STATE_LAST_CTIO;
2008 			}
2009 
2010 			if (xfrlen != 0) {
2011 				cto->ct_flags |= CT2_FLAG_MODE0;
2012 				if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
2013 					cto->ct_flags |= CT2_DATA_IN;
2014 				} else {
2015 					cto->ct_flags |= CT2_DATA_OUT;
2016 				}
2017 
2018 				cto->ct_reloff = atp->bytes_xfered + atp->bytes_in_transit;
2019 				cto->rsp.m0.ct_xfrlen = xfrlen;
2020 
2021 				if (sendstatus) {
2022 					resid = atp->orig_datalen - atp->bytes_xfered - xfrlen;
2023 					if (cso->scsi_status == SCSI_STATUS_OK && resid == 0 /*&& fctape == 0*/) {
2024 						cto->ct_flags |= CT2_SENDSTATUS;
2025 						atp->state = ATPD_STATE_LAST_CTIO;
2026 						if (fctape) {
2027 							cto->ct_flags |= CT2_CONFIRM;
2028 						}
2029 					} else {
2030 						atp->sendst = 1;	/* send status later */
2031 						cto->ct_header.rqs_seqno &= ~ATPD_SEQ_NOTIFY_CAM;
2032 						atp->state = ATPD_STATE_CTIO;
2033 					}
2034 				} else {
2035 					atp->state = ATPD_STATE_CTIO;
2036 				}
2037 			}
2038 			isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO2[%x] seq %u nc %d CDB0=%x scsi status %x flags %x resid %d xfrlen %u offset %u", __func__, cto->ct_rxid,
2039 			    ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cso->scsi_status, cto->ct_flags, cto->ct_resid, cso->dxfer_len, atp->bytes_xfered);
2040 		} else {
2041 			ct_entry_t *cto = (ct_entry_t *) local;
2042 
2043 			cto->ct_header.rqs_entry_type = RQSTYPE_CTIO;
2044 			cto->ct_header.rqs_entry_count = 1;
2045 			cto->ct_header.rqs_seqno |= ATPD_SEQ_NOTIFY_CAM;
2046 			ATPD_SET_SEQNO(cto, atp);
2047 			cto->ct_iid = cso->init_id;
2048 			cto->ct_iid |= XS_CHANNEL(ccb) << 7;
2049 			cto->ct_tgt = ccb->ccb_h.target_id;
2050 			cto->ct_lun = ccb->ccb_h.target_lun;
2051 			cto->ct_fwhandle = cso->tag_id;
2052 			if (atp->rxid) {
2053 				cto->ct_tag_val = atp->rxid;
2054 				cto->ct_flags |= CT_TQAE;
2055 			}
2056 			if (ccb->ccb_h.flags & CAM_DIS_DISCONNECT) {
2057 				cto->ct_flags |= CT_NODISC;
2058 			}
2059 			if (cso->dxfer_len == 0) {
2060 				cto->ct_flags |= CT_NO_DATA;
2061 			} else if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
2062 				cto->ct_flags |= CT_DATA_IN;
2063 			} else {
2064 				cto->ct_flags |= CT_DATA_OUT;
2065 			}
2066 			if (ccb->ccb_h.flags & CAM_SEND_STATUS) {
2067 				cto->ct_flags |= CT_SENDSTATUS|CT_CCINCR;
2068 				cto->ct_scsi_status = cso->scsi_status;
2069 				cto->ct_resid = atp->orig_datalen - atp->bytes_xfered - atp->bytes_in_transit - xfrlen;
2070 				isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO[%x] seq %u nc %d scsi status %x resid %d tag_id %x", __func__,
2071 				    cto->ct_fwhandle, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), cso->scsi_status, cso->resid, cso->tag_id);
2072 			}
2073 			ccb->ccb_h.flags &= ~CAM_SEND_SENSE;
2074 			cto->ct_timeout = 10;
2075 		}
2076 
2077 		if (isp_get_pcmd(isp, ccb)) {
2078 			ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "out of PCMDs\n");
2079 			TAILQ_INSERT_HEAD(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
2080 			break;
2081 		}
2082 		if (isp_allocate_xs_tgt(isp, ccb, &handle)) {
2083 			ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "No XFLIST pointers for %s\n", __func__);
2084 			TAILQ_INSERT_HEAD(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
2085 			isp_free_pcmd(isp, ccb);
2086 			break;
2087 		}
2088 		atp->bytes_in_transit += xfrlen;
2089 		PISP_PCMD(ccb)->datalen = xfrlen;
2090 
2091 
2092 		/*
2093 		 * Call the dma setup routines for this entry (and any subsequent
2094 		 * CTIOs) if there's data to move, and then tell the f/w it's got
2095 		 * new things to play with. As with isp_start's usage of DMA setup,
2096 		 * any swizzling is done in the machine dependent layer. Because
2097 		 * of this, we put the request onto the queue area first in native
2098 		 * format.
2099 		 */
2100 
2101 		if (IS_24XX(isp)) {
2102 			ct7_entry_t *cto = (ct7_entry_t *) local;
2103 			cto->ct_syshandle = handle;
2104 		} else if (IS_FC(isp)) {
2105 			ct2_entry_t *cto = (ct2_entry_t *) local;
2106 			cto->ct_syshandle = handle;
2107 		} else {
2108 			ct_entry_t *cto = (ct_entry_t *) local;
2109 			cto->ct_syshandle = handle;
2110 		}
2111 
2112 		dmaresult = ISP_DMASETUP(isp, cso, (ispreq_t *) local);
2113 		if (dmaresult != CMD_QUEUED) {
2114 			isp_destroy_tgt_handle(isp, handle);
2115 			isp_free_pcmd(isp, ccb);
2116 			if (dmaresult == CMD_EAGAIN) {
2117 				TAILQ_INSERT_HEAD(&tptr->waitq, &ccb->ccb_h, periph_links.tqe);
2118 				break;
2119 			}
2120 			ccb->ccb_h.status = CAM_REQ_CMP_ERR;
2121 			xpt_done(ccb);
2122 			continue;
2123 		}
2124 		isp->isp_nactive++;
2125 		ccb->ccb_h.status = CAM_REQ_INPROG | CAM_SIM_QUEUED;
2126 		if (xfrlen) {
2127 			ccb->ccb_h.spriv_field0 = atp->bytes_xfered;
2128 		} else {
2129 			ccb->ccb_h.spriv_field0 = ~0;
2130 		}
2131 		atp->ctcnt++;
2132 		atp->seqno++;
2133 	}
2134 	rls_lun_statep(isp, tptr);
2135 }
2136 
2137 static void
2138 isp_refire_putback_atio(void *arg)
2139 {
2140 	union ccb *ccb = arg;
2141 
2142 	ISP_ASSERT_LOCKED((ispsoftc_t *)XS_ISP(ccb));
2143 	isp_target_putback_atio(ccb);
2144 }
2145 
2146 static void
2147 isp_refire_notify_ack(void *arg)
2148 {
2149 	isp_tna_t *tp  = arg;
2150 	ispsoftc_t *isp = tp->isp;
2151 
2152 	ISP_ASSERT_LOCKED(isp);
2153 	if (isp_notify_ack(isp, tp->not)) {
2154 		callout_schedule(&tp->timer, 5);
2155 	} else {
2156 		free(tp, M_DEVBUF);
2157 	}
2158 }
2159 
2160 
2161 static void
2162 isp_target_putback_atio(union ccb *ccb)
2163 {
2164 	ispsoftc_t *isp;
2165 	struct ccb_scsiio *cso;
2166 	void *qe;
2167 
2168 	isp = XS_ISP(ccb);
2169 
2170 	qe = isp_getrqentry(isp);
2171 	if (qe == NULL) {
2172 		xpt_print(ccb->ccb_h.path,
2173 		    "%s: Request Queue Overflow\n", __func__);
2174 		callout_reset(&PISP_PCMD(ccb)->wdog, 10,
2175 		    isp_refire_putback_atio, ccb);
2176 		return;
2177 	}
2178 	memset(qe, 0, QENTRY_LEN);
2179 	cso = &ccb->csio;
2180 	if (IS_FC(isp)) {
2181 		at2_entry_t local, *at = &local;
2182 		ISP_MEMZERO(at, sizeof (at2_entry_t));
2183 		at->at_header.rqs_entry_type = RQSTYPE_ATIO2;
2184 		at->at_header.rqs_entry_count = 1;
2185 		if (ISP_CAP_SCCFW(isp)) {
2186 			at->at_scclun = (uint16_t) ccb->ccb_h.target_lun;
2187 		} else {
2188 			at->at_lun = (uint8_t) ccb->ccb_h.target_lun;
2189 		}
2190 		at->at_status = CT_OK;
2191 		at->at_rxid = cso->tag_id;
2192 		at->at_iid = cso->ccb_h.target_id;
2193 		isp_put_atio2(isp, at, qe);
2194 	} else {
2195 		at_entry_t local, *at = &local;
2196 		ISP_MEMZERO(at, sizeof (at_entry_t));
2197 		at->at_header.rqs_entry_type = RQSTYPE_ATIO;
2198 		at->at_header.rqs_entry_count = 1;
2199 		at->at_iid = cso->init_id;
2200 		at->at_iid |= XS_CHANNEL(ccb) << 7;
2201 		at->at_tgt = cso->ccb_h.target_id;
2202 		at->at_lun = cso->ccb_h.target_lun;
2203 		at->at_status = CT_OK;
2204 		at->at_tag_val = AT_GET_TAG(cso->tag_id);
2205 		at->at_handle = AT_GET_HANDLE(cso->tag_id);
2206 		isp_put_atio(isp, at, qe);
2207 	}
2208 	ISP_TDQE(isp, "isp_target_putback_atio", isp->isp_reqidx, qe);
2209 	ISP_SYNC_REQUEST(isp);
2210 	isp_complete_ctio(ccb);
2211 }
2212 
2213 static void
2214 isp_complete_ctio(union ccb *ccb)
2215 {
2216 	if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_INPROG) {
2217 		ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
2218 		xpt_done(ccb);
2219 	}
2220 }
2221 
2222 /*
2223  * Handle ATIO stuff that the generic code can't.
2224  * This means handling CDBs.
2225  */
2226 
2227 static void
2228 isp_handle_platform_atio(ispsoftc_t *isp, at_entry_t *aep)
2229 {
2230 	tstate_t *tptr;
2231 	int status, bus;
2232 	struct ccb_accept_tio *atiop;
2233 	atio_private_data_t *atp;
2234 
2235 	/*
2236 	 * The firmware status (except for the QLTM_SVALID bit)
2237 	 * indicates why this ATIO was sent to us.
2238 	 *
2239 	 * If QLTM_SVALID is set, the firmware has recommended Sense Data.
2240 	 *
2241 	 * If the DISCONNECTS DISABLED bit is set in the flags field,
2242 	 * we're still connected on the SCSI bus.
2243 	 */
2244 	status = aep->at_status;
2245 	if ((status & ~QLTM_SVALID) == AT_PHASE_ERROR) {
2246 		/*
2247 		 * Bus Phase Sequence error. We should have sense data
2248 		 * suggested by the f/w. I'm not sure quite yet what
2249 		 * to do about this for CAM.
2250 		 */
2251 		isp_prt(isp, ISP_LOGWARN, "PHASE ERROR");
2252 		isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
2253 		return;
2254 	}
2255 	if ((status & ~QLTM_SVALID) != AT_CDB) {
2256 		isp_prt(isp, ISP_LOGWARN, "bad atio (0x%x) leaked to platform", status);
2257 		isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
2258 		return;
2259 	}
2260 
2261 	bus = GET_BUS_VAL(aep->at_iid);
2262 	tptr = get_lun_statep(isp, bus, aep->at_lun);
2263 	if (tptr == NULL) {
2264 		tptr = get_lun_statep(isp, bus, CAM_LUN_WILDCARD);
2265 		if (tptr == NULL) {
2266 			/*
2267 			 * Because we can't autofeed sense data back with
2268 			 * a command for parallel SCSI, we can't give back
2269 			 * a CHECK CONDITION. We'll give back a BUSY status
2270 			 * instead. This works out okay because the only
2271 			 * time we should, in fact, get this, is in the
2272 			 * case that somebody configured us without the
2273 			 * blackhole driver, so they get what they deserve.
2274 			 */
2275 			isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
2276 			return;
2277 		}
2278 	}
2279 
2280 	atp = isp_get_atpd(isp, tptr, aep->at_handle);
2281 	atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
2282 	if (atiop == NULL || atp == NULL) {
2283 		/*
2284 		 * Because we can't autofeed sense data back with
2285 		 * a command for parallel SCSI, we can't give back
2286 		 * a CHECK CONDITION. We'll give back a QUEUE FULL status
2287 		 * instead. This works out okay because the only time we
2288 		 * should, in fact, get this, is in the case that we've
2289 		 * run out of ATIOS.
2290 		 */
2291 		xpt_print(tptr->owner, "no %s for lun %d from initiator %d\n", (atp == NULL && atiop == NULL)? "ATIOs *or* ATPS" :
2292 		    ((atp == NULL)? "ATPs" : "ATIOs"), aep->at_lun, aep->at_iid);
2293 		isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
2294 		if (atp) {
2295 			isp_put_atpd(isp, tptr, atp);
2296 		}
2297 		rls_lun_statep(isp, tptr);
2298 		return;
2299 	}
2300 	atp->rxid = aep->at_tag_val;
2301 	atp->state = ATPD_STATE_ATIO;
2302 	SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
2303 	tptr->atio_count--;
2304 	ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, atiop->ccb_h.path, "Take FREE ATIO count now %d\n", tptr->atio_count);
2305 	atiop->ccb_h.target_id = aep->at_tgt;
2306 	atiop->ccb_h.target_lun = aep->at_lun;
2307 	if (aep->at_flags & AT_NODISC) {
2308 		atiop->ccb_h.flags |= CAM_DIS_DISCONNECT;
2309 	} else {
2310 		atiop->ccb_h.flags &= ~CAM_DIS_DISCONNECT;
2311 	}
2312 
2313 	if (status & QLTM_SVALID) {
2314 		size_t amt = ISP_MIN(QLTM_SENSELEN, sizeof (atiop->sense_data));
2315 		atiop->sense_len = amt;
2316 		ISP_MEMCPY(&atiop->sense_data, aep->at_sense, amt);
2317 	} else {
2318 		atiop->sense_len = 0;
2319 	}
2320 
2321 	atiop->init_id = GET_IID_VAL(aep->at_iid);
2322 	atiop->cdb_len = aep->at_cdblen;
2323 	ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cdb, aep->at_cdblen);
2324 	atiop->ccb_h.status = CAM_CDB_RECVD;
2325 	/*
2326 	 * Construct a tag 'id' based upon tag value (which may be 0..255)
2327 	 * and the handle (which we have to preserve).
2328 	 */
2329 	atiop->tag_id = atp->tag;
2330 	if (aep->at_flags & AT_TQAE) {
2331 		atiop->tag_action = aep->at_tag_type;
2332 		atiop->ccb_h.status |= CAM_TAG_ACTION_VALID;
2333 	}
2334 	atp->orig_datalen = 0;
2335 	atp->bytes_xfered = 0;
2336 	atp->lun = aep->at_lun;
2337 	atp->nphdl = aep->at_iid;
2338 	atp->portid = PORT_NONE;
2339 	atp->oxid = 0;
2340 	atp->cdb0 = atiop->cdb_io.cdb_bytes[0];
2341 	atp->tattr = aep->at_tag_type;
2342 	atp->state = ATPD_STATE_CAM;
2343 	isp_prt(isp, ISP_LOGTDEBUG0, "ATIO[0x%x] CDB=0x%x lun %d", aep->at_tag_val, atp->cdb0, atp->lun);
2344 	rls_lun_statep(isp, tptr);
2345 }
2346 
2347 static void
2348 isp_handle_platform_atio2(ispsoftc_t *isp, at2_entry_t *aep)
2349 {
2350 	lun_id_t lun;
2351 	fcportdb_t *lp;
2352 	tstate_t *tptr;
2353 	struct ccb_accept_tio *atiop;
2354 	uint16_t nphdl;
2355 	atio_private_data_t *atp;
2356 	inot_private_data_t *ntp;
2357 
2358 	/*
2359 	 * The firmware status (except for the QLTM_SVALID bit)
2360 	 * indicates why this ATIO was sent to us.
2361 	 *
2362 	 * If QLTM_SVALID is set, the firmware has recommended Sense Data.
2363 	 */
2364 	if ((aep->at_status & ~QLTM_SVALID) != AT_CDB) {
2365 		isp_prt(isp, ISP_LOGWARN, "bogus atio (0x%x) leaked to platform", aep->at_status);
2366 		isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
2367 		return;
2368 	}
2369 
2370 	if (ISP_CAP_SCCFW(isp)) {
2371 		lun = aep->at_scclun;
2372 	} else {
2373 		lun = aep->at_lun;
2374 	}
2375 	if (ISP_CAP_2KLOGIN(isp)) {
2376 		nphdl = ((at2e_entry_t *)aep)->at_iid;
2377 	} else {
2378 		nphdl = aep->at_iid;
2379 	}
2380 	tptr = get_lun_statep(isp, 0, lun);
2381 	if (tptr == NULL) {
2382 		tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
2383 		if (tptr == NULL) {
2384 			isp_prt(isp, ISP_LOGWARN, "%s: [0x%x] no state pointer for lun %jx or wildcard", __func__, aep->at_rxid, (uintmax_t)lun);
2385 			if (lun == 0) {
2386 				isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
2387 			} else {
2388 				isp_endcmd(isp, aep, SCSI_STATUS_CHECK_COND | ECMD_SVALID | (0x5 << 12) | (0x25 << 16), 0);
2389 			}
2390 			return;
2391 		}
2392 	}
2393 
2394 	/*
2395 	 * Start any commands pending resources first.
2396 	 */
2397 	if (tptr->restart_queue) {
2398 		inot_private_data_t *restart_queue = tptr->restart_queue;
2399 		tptr->restart_queue = NULL;
2400 		while (restart_queue) {
2401 			ntp = restart_queue;
2402 			restart_queue = ntp->rd.nt.nt_hba;
2403 			isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at2_entry_t *)ntp->rd.data)->at_rxid);
2404 			isp_handle_platform_atio2(isp, (at2_entry_t *) ntp->rd.data);
2405 			isp_put_ntpd(isp, tptr, ntp);
2406 			/*
2407 			 * If a recursion caused the restart queue to start to fill again,
2408 			 * stop and splice the new list on top of the old list and restore
2409 			 * it and go to noresrc.
2410 			 */
2411 			if (tptr->restart_queue) {
2412 				ntp = tptr->restart_queue;
2413 				tptr->restart_queue = restart_queue;
2414 				while (restart_queue->rd.nt.nt_hba) {
2415 					restart_queue = restart_queue->rd.nt.nt_hba;
2416 				}
2417 				restart_queue->rd.nt.nt_hba = ntp;
2418 				goto noresrc;
2419 			}
2420 		}
2421 	}
2422 
2423 	atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
2424 	if (atiop == NULL) {
2425 		goto noresrc;
2426 	}
2427 
2428 	atp = isp_get_atpd(isp, tptr, aep->at_rxid);
2429 	if (atp == NULL) {
2430 		goto noresrc;
2431 	}
2432 
2433 	atp->state = ATPD_STATE_ATIO;
2434 	SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
2435 	tptr->atio_count--;
2436 	isp_prt(isp, ISP_LOGTDEBUG2, "Take FREE ATIO count now %d", tptr->atio_count);
2437 	atiop->ccb_h.target_id = FCPARAM(isp, 0)->isp_loopid;
2438 	atiop->ccb_h.target_lun = lun;
2439 
2440 	/*
2441 	 * We don't get 'suggested' sense data as we do with SCSI cards.
2442 	 */
2443 	atiop->sense_len = 0;
2444 
2445 	/*
2446 	 * If we're not in the port database, add ourselves.
2447 	 */
2448 	if (IS_2100(isp))
2449 		atiop->init_id = nphdl;
2450 	else {
2451 		if ((isp_find_pdb_by_handle(isp, 0, nphdl, &lp) == 0 ||
2452 		     lp->state == FC_PORTDB_STATE_ZOMBIE)) {
2453 			uint64_t iid =
2454 				(((uint64_t) aep->at_wwpn[0]) << 48) |
2455 				(((uint64_t) aep->at_wwpn[1]) << 32) |
2456 				(((uint64_t) aep->at_wwpn[2]) << 16) |
2457 				(((uint64_t) aep->at_wwpn[3]) <<  0);
2458 			isp_add_wwn_entry(isp, 0, iid, nphdl, PORT_ANY, 0);
2459 			isp_find_pdb_by_handle(isp, 0, nphdl, &lp);
2460 		}
2461 		atiop->init_id = FC_PORTDB_TGT(isp, 0, lp);
2462 	}
2463 	atiop->cdb_len = ATIO2_CDBLEN;
2464 	ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cdb, ATIO2_CDBLEN);
2465 	atiop->ccb_h.status = CAM_CDB_RECVD;
2466 	atiop->tag_id = atp->tag;
2467 	switch (aep->at_taskflags & ATIO2_TC_ATTR_MASK) {
2468 	case ATIO2_TC_ATTR_SIMPLEQ:
2469 		atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
2470 		atiop->tag_action = MSG_SIMPLE_Q_TAG;
2471 		break;
2472 	case ATIO2_TC_ATTR_HEADOFQ:
2473 		atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
2474 		atiop->tag_action = MSG_HEAD_OF_Q_TAG;
2475 		break;
2476 	case ATIO2_TC_ATTR_ORDERED:
2477 		atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
2478 		atiop->tag_action = MSG_ORDERED_Q_TAG;
2479 		break;
2480 	case ATIO2_TC_ATTR_ACAQ:		/* ?? */
2481 	case ATIO2_TC_ATTR_UNTAGGED:
2482 	default:
2483 		atiop->tag_action = 0;
2484 		break;
2485 	}
2486 
2487 	atp->orig_datalen = aep->at_datalen;
2488 	atp->bytes_xfered = 0;
2489 	atp->lun = lun;
2490 	atp->nphdl = nphdl;
2491 	atp->sid = PORT_ANY;
2492 	atp->oxid = aep->at_oxid;
2493 	atp->cdb0 = aep->at_cdb[0];
2494 	atp->tattr = aep->at_taskflags & ATIO2_TC_ATTR_MASK;
2495 	atp->state = ATPD_STATE_CAM;
2496 	xpt_done((union ccb *)atiop);
2497 	isp_prt(isp, ISP_LOGTDEBUG0, "ATIO2[0x%x] CDB=0x%x lun %jx datalen %u", aep->at_rxid, atp->cdb0, (uintmax_t)lun, atp->orig_datalen);
2498 	rls_lun_statep(isp, tptr);
2499 	return;
2500 noresrc:
2501 	ntp = isp_get_ntpd(isp, tptr);
2502 	if (ntp == NULL) {
2503 		rls_lun_statep(isp, tptr);
2504 		isp_endcmd(isp, aep, nphdl, 0, SCSI_STATUS_BUSY, 0);
2505 		return;
2506 	}
2507 	memcpy(ntp->rd.data, aep, QENTRY_LEN);
2508 	ntp->rd.nt.nt_hba = tptr->restart_queue;
2509 	tptr->restart_queue = ntp;
2510 	rls_lun_statep(isp, tptr);
2511 }
2512 
2513 static void
2514 isp_handle_platform_atio7(ispsoftc_t *isp, at7_entry_t *aep)
2515 {
2516 	int cdbxlen;
2517 	uint16_t lun, chan, nphdl = NIL_HANDLE;
2518 	uint32_t did, sid;
2519 	fcportdb_t *lp;
2520 	tstate_t *tptr;
2521 	struct ccb_accept_tio *atiop;
2522 	atio_private_data_t *atp = NULL;
2523 	atio_private_data_t *oatp;
2524 	inot_private_data_t *ntp;
2525 
2526 	did = (aep->at_hdr.d_id[0] << 16) | (aep->at_hdr.d_id[1] << 8) | aep->at_hdr.d_id[2];
2527 	sid = (aep->at_hdr.s_id[0] << 16) | (aep->at_hdr.s_id[1] << 8) | aep->at_hdr.s_id[2];
2528 	lun = (aep->at_cmnd.fcp_cmnd_lun[0] << 8) | aep->at_cmnd.fcp_cmnd_lun[1];
2529 
2530 	/*
2531 	 * Find the N-port handle, and Virtual Port Index for this command.
2532 	 *
2533 	 * If we can't, we're somewhat in trouble because we can't actually respond w/o that information.
2534 	 * We also, as a matter of course, need to know the WWN of the initiator too.
2535 	 */
2536 	if (ISP_CAP_MULTI_ID(isp) && isp->isp_nchan > 1) {
2537 		/*
2538 		 * Find the right channel based upon D_ID
2539 		 */
2540 		isp_find_chan_by_did(isp, did, &chan);
2541 
2542 		if (chan == ISP_NOCHAN) {
2543 			NANOTIME_T now;
2544 
2545 			/*
2546 			 * If we don't recognizer our own D_DID, terminate the exchange, unless we're within 2 seconds of startup
2547 			 * It's a bit tricky here as we need to stash this command *somewhere*.
2548 			 */
2549 			GET_NANOTIME(&now);
2550 			if (NANOTIME_SUB(&isp->isp_init_time, &now) > 2000000000ULL) {
2551 				isp_prt(isp, ISP_LOGWARN, "%s: [RX_ID 0x%x] D_ID %x not found on any channel- dropping", __func__, aep->at_rxid, did);
2552 				isp_endcmd(isp, aep, NIL_HANDLE, ISP_NOCHAN, ECMD_TERMINATE, 0);
2553 				return;
2554 			}
2555 			tptr = get_lun_statep(isp, 0, 0);
2556 			if (tptr == NULL) {
2557 				tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
2558 				if (tptr == NULL) {
2559 					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);
2560 					isp_endcmd(isp, aep, NIL_HANDLE, ISP_NOCHAN, ECMD_TERMINATE, 0);
2561 					return;
2562 				}
2563 			}
2564 			isp_prt(isp, ISP_LOGWARN, "%s: [RX_ID 0x%x] D_ID %x not found on any channel- deferring", __func__, aep->at_rxid, did);
2565 			goto noresrc;
2566 		}
2567 		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);
2568 	} else {
2569 		chan = 0;
2570 	}
2571 
2572 	/*
2573 	 * Find the PDB entry for this initiator
2574 	 */
2575 	if (isp_find_pdb_by_sid(isp, chan, sid, &lp) == 0) {
2576 		/*
2577 		 * If we're not in the port database terminate the exchange.
2578 		 */
2579 		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",
2580 		    __func__, aep->at_rxid, did, chan, sid);
2581 		isp_dump_portdb(isp, chan);
2582 		isp_endcmd(isp, aep, NIL_HANDLE, chan, ECMD_TERMINATE, 0);
2583 		return;
2584 	}
2585 	nphdl = lp->handle;
2586 
2587 	/*
2588 	 * Get the tstate pointer
2589 	 */
2590 	tptr = get_lun_statep(isp, chan, lun);
2591 	if (tptr == NULL) {
2592 		tptr = get_lun_statep(isp, chan, CAM_LUN_WILDCARD);
2593 		if (tptr == NULL) {
2594 			isp_prt(isp, ISP_LOGWARN, "%s: [0x%x] no state pointer for lun %d or wildcard", __func__, aep->at_rxid, lun);
2595 			if (lun == 0) {
2596 				isp_endcmd(isp, aep, nphdl, SCSI_STATUS_BUSY, 0);
2597 			} else {
2598 				isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_CHECK_COND | ECMD_SVALID | (0x5 << 12) | (0x25 << 16), 0);
2599 			}
2600 			return;
2601 		}
2602 	}
2603 
2604 	/*
2605 	 * Start any commands pending resources first.
2606 	 */
2607 	if (tptr->restart_queue) {
2608 		inot_private_data_t *restart_queue = tptr->restart_queue;
2609 		tptr->restart_queue = NULL;
2610 		while (restart_queue) {
2611 			ntp = restart_queue;
2612 			restart_queue = ntp->rd.nt.nt_hba;
2613 			isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at7_entry_t *)ntp->rd.data)->at_rxid);
2614 			isp_handle_platform_atio7(isp, (at7_entry_t *) ntp->rd.data);
2615 			isp_put_ntpd(isp, tptr, ntp);
2616 			/*
2617 			 * If a recursion caused the restart queue to start to fill again,
2618 			 * stop and splice the new list on top of the old list and restore
2619 			 * it and go to noresrc.
2620 			 */
2621 			if (tptr->restart_queue) {
2622 				isp_prt(isp, ISP_LOGTDEBUG0, "%s: restart queue refilling", __func__);
2623 				if (restart_queue) {
2624 					ntp = tptr->restart_queue;
2625 					tptr->restart_queue = restart_queue;
2626 					while (restart_queue->rd.nt.nt_hba) {
2627 						restart_queue = restart_queue->rd.nt.nt_hba;
2628 					}
2629 					restart_queue->rd.nt.nt_hba = ntp;
2630 				}
2631 				goto noresrc;
2632 			}
2633 		}
2634 	}
2635 
2636 	/*
2637 	 * If the f/w is out of resources, just send a BUSY status back.
2638 	 */
2639 	if (aep->at_rxid == AT7_NORESRC_RXID) {
2640 		rls_lun_statep(isp, tptr);
2641 		isp_endcmd(isp, aep, nphdl, chan, SCSI_BUSY, 0);
2642 		return;
2643 	}
2644 
2645 	/*
2646 	 * If we're out of resources, just send a BUSY status back.
2647 	 */
2648 	atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
2649 	if (atiop == NULL) {
2650 		isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] out of atios", aep->at_rxid);
2651 		goto noresrc;
2652 	}
2653 
2654 	oatp = isp_find_atpd(isp, tptr, aep->at_rxid);
2655 	if (oatp) {
2656 		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) oatp state %d",
2657 		    aep->at_rxid, nphdl, sid, aep->at_hdr.ox_id, oatp->state);
2658 		/*
2659 		 * It's not a "no resource" condition- but we can treat it like one
2660 		 */
2661 		goto noresrc;
2662 	}
2663 	atp = isp_get_atpd(isp, tptr, aep->at_rxid);
2664 	if (atp == NULL) {
2665 		isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] out of atps", aep->at_rxid);
2666 		goto noresrc;
2667 	}
2668 	atp->word3 = lp->prli_word3;
2669 	atp->state = ATPD_STATE_ATIO;
2670 	SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
2671 	tptr->atio_count--;
2672 	ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, atiop->ccb_h.path, "Take FREE ATIO count now %d\n", tptr->atio_count);
2673 	atiop->init_id = FC_PORTDB_TGT(isp, chan, lp);
2674 	atiop->ccb_h.target_id = FCPARAM(isp, chan)->isp_loopid;
2675 	atiop->ccb_h.target_lun = lun;
2676 	atiop->sense_len = 0;
2677 	cdbxlen = aep->at_cmnd.fcp_cmnd_alen_datadir >> FCP_CMND_ADDTL_CDBLEN_SHIFT;
2678 	if (cdbxlen) {
2679 		isp_prt(isp, ISP_LOGWARN, "additional CDBLEN ignored");
2680 	}
2681 	cdbxlen = sizeof (aep->at_cmnd.cdb_dl.sf.fcp_cmnd_cdb);
2682 	ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cmnd.cdb_dl.sf.fcp_cmnd_cdb, cdbxlen);
2683 	atiop->cdb_len = cdbxlen;
2684 	atiop->ccb_h.status = CAM_CDB_RECVD;
2685 	atiop->tag_id = atp->tag;
2686 	switch (aep->at_cmnd.fcp_cmnd_task_attribute & FCP_CMND_TASK_ATTR_MASK) {
2687 	case FCP_CMND_TASK_ATTR_SIMPLE:
2688 		atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
2689 		atiop->tag_action = MSG_SIMPLE_Q_TAG;
2690 		break;
2691 	case FCP_CMND_TASK_ATTR_HEAD:
2692 		atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
2693 		atiop->tag_action = MSG_HEAD_OF_Q_TAG;
2694 		break;
2695 	case FCP_CMND_TASK_ATTR_ORDERED:
2696 		atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
2697 		atiop->tag_action = MSG_ORDERED_Q_TAG;
2698 		break;
2699 	default:
2700 		/* FALLTHROUGH */
2701 	case FCP_CMND_TASK_ATTR_ACA:
2702 	case FCP_CMND_TASK_ATTR_UNTAGGED:
2703 		atiop->tag_action = 0;
2704 		break;
2705 	}
2706 	atp->orig_datalen = aep->at_cmnd.cdb_dl.sf.fcp_cmnd_dl;
2707 	atp->bytes_xfered = 0;
2708 	atp->lun = lun;
2709 	atp->nphdl = nphdl;
2710 	atp->portid = sid;
2711 	atp->oxid = aep->at_hdr.ox_id;
2712 	atp->rxid = aep->at_hdr.rx_id;
2713 	atp->cdb0 = atiop->cdb_io.cdb_bytes[0];
2714 	atp->tattr = aep->at_cmnd.fcp_cmnd_task_attribute & FCP_CMND_TASK_ATTR_MASK;
2715 	atp->state = ATPD_STATE_CAM;
2716 	isp_prt(isp, ISP_LOGTDEBUG0, "ATIO7[0x%x] CDB=0x%x lun %d datalen %u", aep->at_rxid, atp->cdb0, lun, atp->orig_datalen);
2717 	xpt_done((union ccb *)atiop);
2718 	rls_lun_statep(isp, tptr);
2719 	return;
2720 noresrc:
2721 	if (atp) {
2722 		isp_put_atpd(isp, tptr, atp);
2723 	}
2724 	ntp = isp_get_ntpd(isp, tptr);
2725 	if (ntp == NULL) {
2726 		rls_lun_statep(isp, tptr);
2727 		isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_BUSY, 0);
2728 		return;
2729 	}
2730 	memcpy(ntp->rd.data, aep, QENTRY_LEN);
2731 	ntp->rd.nt.nt_hba = tptr->restart_queue;
2732 	tptr->restart_queue = ntp;
2733 	rls_lun_statep(isp, tptr);
2734 }
2735 
2736 
2737 /*
2738  * Handle starting an SRR (sequence retransmit request)
2739  * We get here when we've gotten the immediate notify
2740  * and the return of all outstanding CTIOs for this
2741  * transaction.
2742  */
2743 static void
2744 isp_handle_srr_start(ispsoftc_t *isp, tstate_t *tptr, atio_private_data_t *atp)
2745 {
2746 	in_fcentry_24xx_t *inot;
2747 	uint32_t srr_off, ccb_off, ccb_len, ccb_end;
2748 	union ccb *ccb;
2749 
2750 	inot = (in_fcentry_24xx_t *)atp->srr;
2751 	srr_off = inot->in_srr_reloff_lo | (inot->in_srr_reloff_hi << 16);
2752 	ccb = atp->srr_ccb;
2753 	atp->srr_ccb = NULL;
2754 	atp->nsrr++;
2755 	if (ccb == NULL) {
2756 		isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] null ccb", atp->tag);
2757 		goto fail;
2758 	}
2759 
2760 	ccb_off = ccb->ccb_h.spriv_field0;
2761 	ccb_len = ccb->csio.dxfer_len;
2762         ccb_end = (ccb_off == ~0)? ~0 : ccb_off + ccb_len;
2763 
2764 	switch (inot->in_srr_iu) {
2765 	case R_CTL_INFO_SOLICITED_DATA:
2766 		/*
2767 		 * We have to restart a FCP_DATA data out transaction
2768 		 */
2769 		atp->sendst = 0;
2770 		atp->bytes_xfered = srr_off;
2771 		if (ccb_len == 0) {
2772 			isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] SRR offset 0x%x but current CCB doesn't transfer data", atp->tag, srr_off);
2773 			goto mdp;
2774 		}
2775  		if (srr_off < ccb_off || ccb_off > srr_off + ccb_len) {
2776 			isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] SRR offset 0x%x not covered by current CCB data range [0x%x..0x%x]", atp->tag, srr_off, ccb_off, ccb_end);
2777 			goto mdp;
2778 		}
2779 		isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] SRR offset 0x%x covered by current CCB data range [0x%x..0x%x]", atp->tag, srr_off, ccb_off, ccb_end);
2780 		break;
2781 	case R_CTL_INFO_COMMAND_STATUS:
2782 		isp_prt(isp, ISP_LOGTINFO, "SRR[0x%x] Got an FCP RSP SRR- resending status", atp->tag);
2783 		atp->sendst = 1;
2784 		/*
2785 		 * We have to restart a FCP_RSP IU transaction
2786 		 */
2787 		break;
2788 	case R_CTL_INFO_DATA_DESCRIPTOR:
2789 		/*
2790 		 * We have to restart an FCP DATA in transaction
2791 		 */
2792 		isp_prt(isp, ISP_LOGWARN, "Got an FCP DATA IN SRR- dropping");
2793 		goto fail;
2794 
2795 	default:
2796 		isp_prt(isp, ISP_LOGWARN, "Got an unknown information (%x) SRR- dropping", inot->in_srr_iu);
2797 		goto fail;
2798 	}
2799 
2800 	/*
2801 	 * We can't do anything until this is acked, so we might as well start it now.
2802 	 * We aren't going to do the usual asynchronous ack issue because we need
2803 	 * to make sure this gets on the wire first.
2804 	 */
2805 	if (isp_notify_ack(isp, inot)) {
2806 		isp_prt(isp, ISP_LOGWARN, "could not push positive ack for SRR- you lose");
2807 		goto fail;
2808 	}
2809 	isp_target_start_ctio(isp, ccb, FROM_SRR);
2810 	return;
2811 fail:
2812 	inot->in_reserved = 1;
2813 	isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
2814 	ccb->ccb_h.status &= ~CAM_STATUS_MASK;
2815 	ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
2816 	isp_complete_ctio(ccb);
2817 	return;
2818 mdp:
2819 	if (isp_notify_ack(isp, inot)) {
2820 		isp_prt(isp, ISP_LOGWARN, "could not push positive ack for SRR- you lose");
2821 		goto fail;
2822 	}
2823 	ccb->ccb_h.status &= ~CAM_STATUS_MASK;
2824 	ccb->ccb_h.status = CAM_MESSAGE_RECV;
2825 	/*
2826 	 * This is not a strict interpretation of MDP, but it's close
2827 	 */
2828 	ccb->csio.msg_ptr = &ccb->csio.sense_data.sense_buf[SSD_FULL_SIZE - 16];
2829 	ccb->csio.msg_len = 7;
2830 	ccb->csio.msg_ptr[0] = MSG_EXTENDED;
2831 	ccb->csio.msg_ptr[1] = 5;
2832 	ccb->csio.msg_ptr[2] = 0;	/* modify data pointer */
2833 	ccb->csio.msg_ptr[3] = srr_off >> 24;
2834 	ccb->csio.msg_ptr[4] = srr_off >> 16;
2835 	ccb->csio.msg_ptr[5] = srr_off >> 8;
2836 	ccb->csio.msg_ptr[6] = srr_off;
2837 	isp_complete_ctio(ccb);
2838 }
2839 
2840 
2841 static void
2842 isp_handle_srr_notify(ispsoftc_t *isp, void *inot_raw)
2843 {
2844 	tstate_t *tptr;
2845 	in_fcentry_24xx_t *inot = inot_raw;
2846 	atio_private_data_t *atp;
2847 	uint32_t tag = inot->in_rxid;
2848 	uint32_t bus = inot->in_vpidx;
2849 
2850 	if (!IS_24XX(isp)) {
2851 		isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot_raw);
2852 		return;
2853 	}
2854 
2855 	tptr = get_lun_statep_from_tag(isp, bus, tag);
2856 	if (tptr == NULL) {
2857 		isp_prt(isp, ISP_LOGERR, "%s: cannot find tptr for tag %x in SRR Notify", __func__, tag);
2858 		isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
2859 		return;
2860 	}
2861 	atp = isp_find_atpd(isp, tptr, tag);
2862 	if (atp == NULL) {
2863 		rls_lun_statep(isp, tptr);
2864 		isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x in SRR Notify", __func__, tag);
2865 		isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
2866 		return;
2867 	}
2868 	atp->srr_notify_rcvd = 1;
2869 	memcpy(atp->srr, inot, sizeof (atp->srr));
2870 	isp_prt(isp, ISP_LOGTINFO /* ISP_LOGTDEBUG0 */, "SRR[0x%x] inot->in_rxid flags 0x%x srr_iu=%x reloff 0x%x", inot->in_rxid, inot->in_flags, inot->in_srr_iu,
2871 	    inot->in_srr_reloff_lo | (inot->in_srr_reloff_hi << 16));
2872 	if (atp->srr_ccb)
2873 		isp_handle_srr_start(isp, tptr, atp);
2874 	rls_lun_statep(isp, tptr);
2875 }
2876 
2877 static void
2878 isp_handle_platform_ctio(ispsoftc_t *isp, void *arg)
2879 {
2880 	union ccb *ccb;
2881 	int sentstatus = 0, ok = 0, notify_cam = 0, resid = 0, failure = 0;
2882 	tstate_t *tptr = NULL;
2883 	atio_private_data_t *atp = NULL;
2884 	int bus;
2885 	uint32_t handle, moved_data = 0, data_requested;
2886 
2887 	/*
2888 	 * CTIO handles are 16 bits.
2889 	 * CTIO2 and CTIO7 are 32 bits.
2890 	 */
2891 
2892 	if (IS_SCSI(isp)) {
2893 		handle = ((ct_entry_t *)arg)->ct_syshandle;
2894 	} else {
2895 		handle = ((ct2_entry_t *)arg)->ct_syshandle;
2896 	}
2897 	ccb = isp_find_xs_tgt(isp, handle);
2898 	if (ccb == NULL) {
2899 		isp_print_bytes(isp, "null ccb in isp_handle_platform_ctio", QENTRY_LEN, arg);
2900 		return;
2901 	}
2902 	isp_destroy_tgt_handle(isp, handle);
2903 	data_requested = PISP_PCMD(ccb)->datalen;
2904 	isp_free_pcmd(isp, ccb);
2905 	if (isp->isp_nactive) {
2906 		isp->isp_nactive--;
2907 	}
2908 
2909 	bus = XS_CHANNEL(ccb);
2910 	tptr = get_lun_statep(isp, bus, XS_LUN(ccb));
2911 	if (tptr == NULL) {
2912 		tptr = get_lun_statep(isp, bus, CAM_LUN_WILDCARD);
2913 	}
2914 	if (tptr == NULL) {
2915 		isp_prt(isp, ISP_LOGERR, "%s: cannot find tptr for tag %x after I/O", __func__, ccb->csio.tag_id);
2916 		return;
2917 	}
2918 
2919 	if (IS_24XX(isp)) {
2920 		atp = isp_find_atpd(isp, tptr, ((ct7_entry_t *)arg)->ct_rxid);
2921 	} else if (IS_FC(isp)) {
2922 		atp = isp_find_atpd(isp, tptr, ((ct2_entry_t *)arg)->ct_rxid);
2923 	} else {
2924 		atp = isp_find_atpd(isp, tptr, ((ct_entry_t *)arg)->ct_fwhandle);
2925 	}
2926 	if (atp == NULL) {
2927 		/*
2928 		 * XXX: isp_clear_commands() generates fake CTIO with zero
2929 		 * ct_rxid value, filling only ct_syshandle.  Workaround
2930 		 * that using tag_id from the CCB, pointed by ct_syshandle.
2931 		 */
2932 		atp = isp_find_atpd(isp, tptr, ccb->csio.tag_id);
2933 	}
2934 	if (atp == NULL) {
2935 		rls_lun_statep(isp, tptr);
2936 		isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x after I/O", __func__, ccb->csio.tag_id);
2937 		return;
2938 	}
2939 	KASSERT((atp->ctcnt > 0), ("ctio count not greater than zero"));
2940 	atp->bytes_in_transit -= data_requested;
2941 	atp->ctcnt -= 1;
2942 	ccb->ccb_h.status &= ~CAM_STATUS_MASK;
2943 
2944 	if (IS_24XX(isp)) {
2945 		ct7_entry_t *ct = arg;
2946 
2947 		if (ct->ct_nphdl == CT7_SRR) {
2948 			atp->srr_ccb = ccb;
2949 			if (atp->srr_notify_rcvd)
2950 				isp_handle_srr_start(isp, tptr, atp);
2951 			rls_lun_statep(isp, tptr);
2952 			return;
2953 		}
2954 		if (ct->ct_nphdl == CT_HBA_RESET) {
2955 			failure = CAM_UNREC_HBA_ERROR;
2956 		} else {
2957 			sentstatus = ct->ct_flags & CT7_SENDSTATUS;
2958 			ok = (ct->ct_nphdl == CT7_OK);
2959 			notify_cam = (ct->ct_header.rqs_seqno & ATPD_SEQ_NOTIFY_CAM) != 0;
2960 			if ((ct->ct_flags & CT7_DATAMASK) != CT7_NO_DATA) {
2961 				resid = ct->ct_resid;
2962 				moved_data = data_requested - resid;
2963 			}
2964 		}
2965 		isp_prt(isp, ok? ISP_LOGTDEBUG0 : ISP_LOGWARN, "%s: CTIO7[%x] seq %u nc %d sts 0x%x flg 0x%x sns %d resid %d %s", __func__, ct->ct_rxid, ATPD_GET_SEQNO(ct),
2966 		   notify_cam, ct->ct_nphdl, ct->ct_flags, (ccb->ccb_h.status & CAM_SENT_SENSE) != 0, resid, sentstatus? "FIN" : "MID");
2967 	} else if (IS_FC(isp)) {
2968 		ct2_entry_t *ct = arg;
2969 		if (ct->ct_status == CT_SRR) {
2970 			atp->srr_ccb = ccb;
2971 			if (atp->srr_notify_rcvd)
2972 				isp_handle_srr_start(isp, tptr, atp);
2973 			rls_lun_statep(isp, tptr);
2974 			isp_target_putback_atio(ccb);
2975 			return;
2976 		}
2977 		if (ct->ct_status == CT_HBA_RESET) {
2978 			failure = CAM_UNREC_HBA_ERROR;
2979 		} else {
2980 			sentstatus = ct->ct_flags & CT2_SENDSTATUS;
2981 			ok = (ct->ct_status & ~QLTM_SVALID) == CT_OK;
2982 			notify_cam = (ct->ct_header.rqs_seqno & ATPD_SEQ_NOTIFY_CAM) != 0;
2983 			if ((ct->ct_flags & CT2_DATAMASK) != CT2_NO_DATA) {
2984 				resid = ct->ct_resid;
2985 				moved_data = data_requested - resid;
2986 			}
2987 		}
2988 		isp_prt(isp, ok? ISP_LOGTDEBUG0 : ISP_LOGWARN, "%s: CTIO2[%x] seq %u nc %d sts 0x%x flg 0x%x sns %d resid %d %s", __func__, ct->ct_rxid, ATPD_GET_SEQNO(ct),
2989 		    notify_cam, ct->ct_status, ct->ct_flags, (ccb->ccb_h.status & CAM_SENT_SENSE) != 0, resid, sentstatus? "FIN" : "MID");
2990 	} else {
2991 		ct_entry_t *ct = arg;
2992 
2993 		if (ct->ct_status == (CT_HBA_RESET & 0xff)) {
2994 			failure = CAM_UNREC_HBA_ERROR;
2995 		} else {
2996 			sentstatus = ct->ct_flags & CT_SENDSTATUS;
2997 			ok = (ct->ct_status  & ~QLTM_SVALID) == CT_OK;
2998 			notify_cam = (ct->ct_header.rqs_seqno & ATPD_SEQ_NOTIFY_CAM) != 0;
2999 		}
3000 		if ((ct->ct_flags & CT_DATAMASK) != CT_NO_DATA) {
3001 			resid = ct->ct_resid;
3002 			moved_data = data_requested - resid;
3003 		}
3004 		isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO[%x] seq %u nc %d tag %x S_ID 0x%x lun %d sts %x flg %x resid %d %s", __func__, ct->ct_fwhandle, ATPD_GET_SEQNO(ct),
3005 		    notify_cam, ct->ct_tag_val, ct->ct_iid, ct->ct_lun, ct->ct_status, ct->ct_flags, resid, sentstatus? "FIN" : "MID");
3006 	}
3007 	if (ok) {
3008 		if (moved_data) {
3009 			atp->bytes_xfered += moved_data;
3010 			ccb->csio.resid = atp->orig_datalen - atp->bytes_xfered - atp->bytes_in_transit;
3011 		}
3012 		if (sentstatus && (ccb->ccb_h.flags & CAM_SEND_SENSE)) {
3013 			ccb->ccb_h.status |= CAM_SENT_SENSE;
3014 		}
3015 		ccb->ccb_h.status |= CAM_REQ_CMP;
3016 	} else {
3017 		notify_cam = 1;
3018 		if (failure == CAM_UNREC_HBA_ERROR)
3019 			ccb->ccb_h.status |= CAM_UNREC_HBA_ERROR;
3020 		else
3021 			ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
3022 	}
3023 	atp->state = ATPD_STATE_PDON;
3024 	rls_lun_statep(isp, tptr);
3025 
3026 	/*
3027 	 * We never *not* notify CAM when there has been any error (ok == 0),
3028 	 * so we never need to do an ATIO putback if we're not notifying CAM.
3029 	 */
3030 	isp_prt(isp, ISP_LOGTDEBUG0, "%s CTIO[0x%x] done (ok=%d nc=%d nowsendstatus=%d ccb ss=%d)",
3031 	    (sentstatus)? "  FINAL " : "MIDTERM ", atp->tag, ok, notify_cam, atp->sendst, (ccb->ccb_h.flags & CAM_SEND_STATUS) != 0);
3032 	if (notify_cam == 0) {
3033 		if (atp->sendst) {
3034 			isp_target_start_ctio(isp, ccb, FROM_CTIO_DONE);
3035 		}
3036 		return;
3037 	}
3038 
3039 	/*
3040 	 * We're telling CAM we're done with this CTIO transaction.
3041 	 *
3042 	 * 24XX cards never need an ATIO put back.
3043 	 *
3044 	 * Other cards need one put back only on error.
3045 	 * In the latter case, a timeout will re-fire
3046 	 * and try again in case we didn't have
3047 	 * queue resources to do so at first. In any case,
3048 	 * once the putback is done we do the completion
3049 	 * call.
3050 	 */
3051 	if (ok || IS_24XX(isp)) {
3052 		isp_complete_ctio(ccb);
3053 	} else {
3054 		isp_target_putback_atio(ccb);
3055 	}
3056 }
3057 
3058 static void
3059 isp_handle_platform_notify_scsi(ispsoftc_t *isp, in_entry_t *inot)
3060 {
3061 	isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
3062 }
3063 
3064 static void
3065 isp_handle_platform_notify_fc(ispsoftc_t *isp, in_fcentry_t *inp)
3066 {
3067 	int needack = 1;
3068 	switch (inp->in_status) {
3069 	case IN_PORT_LOGOUT:
3070 		/*
3071 		 * XXX: Need to delete this initiator's WWN from the database
3072 		 * XXX: Need to send this LOGOUT upstream
3073 		 */
3074 		isp_prt(isp, ISP_LOGWARN, "port logout of S_ID 0x%x", inp->in_iid);
3075 		break;
3076 	case IN_PORT_CHANGED:
3077 		isp_prt(isp, ISP_LOGWARN, "port changed for S_ID 0x%x", inp->in_iid);
3078 		break;
3079 	case IN_GLOBAL_LOGO:
3080 		isp_del_all_wwn_entries(isp, 0);
3081 		isp_prt(isp, ISP_LOGINFO, "all ports logged out");
3082 		break;
3083 	case IN_ABORT_TASK:
3084 	{
3085 		tstate_t *tptr;
3086 		uint16_t lun;
3087 		uint32_t loopid, sid;
3088 		uint64_t wwn;
3089 		atio_private_data_t *atp;
3090 		fcportdb_t *lp;
3091 		struct ccb_immediate_notify *inot = NULL;
3092 
3093 		if (ISP_CAP_SCCFW(isp)) {
3094 			lun = inp->in_scclun;
3095 		} else {
3096 			lun = inp->in_lun;
3097 		}
3098 		if (ISP_CAP_2KLOGIN(isp)) {
3099 			loopid = ((in_fcentry_e_t *)inp)->in_iid;
3100 		} else {
3101 			loopid = inp->in_iid;
3102 		}
3103 		if (isp_find_pdb_by_handle(isp, 0, loopid, &lp)) {
3104 			wwn = lp->port_wwn;
3105 			sid = lp->portid;
3106 		} else {
3107 			wwn = INI_ANY;
3108 			sid = PORT_ANY;
3109 		}
3110 		tptr = get_lun_statep(isp, 0, lun);
3111 		if (tptr == NULL) {
3112 			tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
3113 			if (tptr == NULL) {
3114 				isp_prt(isp, ISP_LOGWARN, "ABORT TASK for lun %u- but no tstate", lun);
3115 				return;
3116 			}
3117 		}
3118 		atp = isp_find_atpd(isp, tptr, inp->in_seqid);
3119 
3120 		if (atp) {
3121 			inot = (struct ccb_immediate_notify *) SLIST_FIRST(&tptr->inots);
3122 			isp_prt(isp, ISP_LOGTDEBUG0, "ABORT TASK RX_ID %x WWN 0x%016llx state %d", inp->in_seqid, (unsigned long long) wwn, atp->state);
3123 			if (inot) {
3124 				tptr->inot_count--;
3125 				SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
3126 				ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, inot->ccb_h.path, "%s: Take FREE INOT count now %d\n", __func__, tptr->inot_count);
3127 			} else {
3128 				ISP_PATH_PRT(isp, ISP_LOGWARN, tptr->owner, "out of INOT structures\n");
3129 			}
3130 		} else {
3131 			ISP_PATH_PRT(isp, ISP_LOGWARN, tptr->owner, "abort task RX_ID %x from wwn 0x%016llx, state unknown\n", inp->in_seqid, wwn);
3132 		}
3133 		if (inot) {
3134 			isp_notify_t tmp, *nt = &tmp;
3135 			ISP_MEMZERO(nt, sizeof (isp_notify_t));
3136     			nt->nt_hba = isp;
3137 			nt->nt_tgt = FCPARAM(isp, 0)->isp_wwpn;
3138 			nt->nt_wwn = wwn;
3139 			nt->nt_nphdl = loopid;
3140 			nt->nt_sid = sid;
3141 			nt->nt_did = PORT_ANY;
3142     			nt->nt_lun = lun;
3143             		nt->nt_need_ack = 1;
3144     			nt->nt_channel = 0;
3145     			nt->nt_ncode = NT_ABORT_TASK;
3146     			nt->nt_lreserved = inot;
3147 			isp_handle_platform_target_tmf(isp, nt);
3148 			needack = 0;
3149 		}
3150 		rls_lun_statep(isp, tptr);
3151 		break;
3152 	}
3153 	default:
3154 		break;
3155 	}
3156 	if (needack) {
3157 		isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inp);
3158 	}
3159 }
3160 
3161 static void
3162 isp_handle_platform_notify_24xx(ispsoftc_t *isp, in_fcentry_24xx_t *inot)
3163 {
3164 	uint16_t nphdl;
3165 	uint16_t prli_options = 0;
3166 	uint32_t portid;
3167 	fcportdb_t *lp;
3168 	uint8_t *ptr = NULL;
3169 	uint64_t wwn;
3170 
3171 	nphdl = inot->in_nphdl;
3172 	if (nphdl != NIL_HANDLE) {
3173 		portid = inot->in_portid_hi << 16 | inot->in_portid_lo;
3174 	} else {
3175 		portid = PORT_ANY;
3176 	}
3177 
3178 	switch (inot->in_status) {
3179 	case IN24XX_ELS_RCVD:
3180 	{
3181 		char buf[16], *msg;
3182 		int chan = ISP_GET_VPIDX(isp, inot->in_vpidx);
3183 
3184 		/*
3185 		 * Note that we're just getting notification that an ELS was received
3186 		 * (possibly with some associated information sent upstream). This is
3187 		 * *not* the same as being given the ELS frame to accept or reject.
3188 		 */
3189 		switch (inot->in_status_subcode) {
3190 		case LOGO:
3191 			msg = "LOGO";
3192 			if (ISP_FW_NEWER_THAN(isp, 4, 0, 25)) {
3193 				ptr = (uint8_t *)inot;  /* point to unswizzled entry! */
3194 				wwn =	(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF])   << 56) |
3195 					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+1]) << 48) |
3196 					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+2]) << 40) |
3197 					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+3]) << 32) |
3198 					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+4]) << 24) |
3199 					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+5]) << 16) |
3200 					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+6]) <<  8) |
3201 					(((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+7]));
3202 			} else {
3203 				wwn = INI_ANY;
3204 			}
3205 			isp_del_wwn_entry(isp, chan, wwn, nphdl, portid);
3206 			break;
3207 		case PRLO:
3208 			msg = "PRLO";
3209 			break;
3210 		case PLOGI:
3211 		case PRLI:
3212 			/*
3213 			 * Treat PRLI the same as PLOGI and make a database entry for it.
3214 			 */
3215 			if (inot->in_status_subcode == PLOGI) {
3216 				msg = "PLOGI";
3217 			} else {
3218 				prli_options = inot->in_prli_options;
3219 				msg = "PRLI";
3220 			}
3221 			if (ISP_FW_NEWER_THAN(isp, 4, 0, 25)) {
3222 				ptr = (uint8_t *)inot;  /* point to unswizzled entry! */
3223 				wwn =	(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF])   << 56) |
3224 					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+1]) << 48) |
3225 					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+2]) << 40) |
3226 					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+3]) << 32) |
3227 					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+4]) << 24) |
3228 					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+5]) << 16) |
3229 					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+6]) <<  8) |
3230 					(((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+7]));
3231 			} else {
3232 				wwn = INI_NONE;
3233 			}
3234 			isp_add_wwn_entry(isp, chan, wwn, nphdl, portid, prli_options);
3235 			break;
3236 		case PDISC:
3237 			msg = "PDISC";
3238 			break;
3239 		case ADISC:
3240 			msg = "ADISC";
3241 			break;
3242 		default:
3243 			ISP_SNPRINTF(buf, sizeof (buf), "ELS 0x%x", inot->in_status_subcode);
3244 			msg = buf;
3245 			break;
3246 		}
3247 		if (inot->in_flags & IN24XX_FLAG_PUREX_IOCB) {
3248 			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);
3249 			break;
3250 		}
3251 		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,
3252 		    inot->in_rxid, inot->in_oxid);
3253 		isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
3254 		break;
3255 	}
3256 
3257 	case IN24XX_PORT_LOGOUT:
3258 		ptr = "PORT LOGOUT";
3259 		if (isp_find_pdb_by_handle(isp, ISP_GET_VPIDX(isp, inot->in_vpidx), nphdl, &lp)) {
3260 			isp_del_wwn_entry(isp, ISP_GET_VPIDX(isp, inot->in_vpidx), lp->port_wwn, nphdl, lp->portid);
3261 		}
3262 		/* FALLTHROUGH */
3263 	case IN24XX_PORT_CHANGED:
3264 		if (ptr == NULL) {
3265 			ptr = "PORT CHANGED";
3266 		}
3267 		/* FALLTHROUGH */
3268 	case IN24XX_LIP_RESET:
3269 		if (ptr == NULL) {
3270 			ptr = "LIP RESET";
3271 		}
3272 		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);
3273 
3274 		/*
3275 		 * All subcodes here are irrelevant. What is relevant
3276 		 * is that we need to terminate all active commands from
3277 		 * this initiator (known by N-port handle).
3278 		 */
3279 		/* XXX IMPLEMENT XXX */
3280 		isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
3281 		break;
3282 
3283 	case IN24XX_SRR_RCVD:
3284 #ifdef	ISP_TARGET_MODE
3285 		isp_handle_srr_notify(isp, inot);
3286 		break;
3287 #else
3288 		if (ptr == NULL) {
3289 			ptr = "SRR RCVD";
3290 		}
3291 		/* FALLTHROUGH */
3292 #endif
3293 	case IN24XX_LINK_RESET:
3294 		if (ptr == NULL) {
3295 			ptr = "LINK RESET";
3296 		}
3297 	case IN24XX_LINK_FAILED:
3298 		if (ptr == NULL) {
3299 			ptr = "LINK FAILED";
3300 		}
3301 	default:
3302 		isp_prt(isp, ISP_LOGWARN, "Chan %d %s", ISP_GET_VPIDX(isp, inot->in_vpidx), ptr);
3303 		isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
3304 		break;
3305 	}
3306 }
3307 
3308 static int
3309 isp_handle_platform_target_notify_ack(ispsoftc_t *isp, isp_notify_t *mp)
3310 {
3311 
3312 	if (isp->isp_state != ISP_RUNSTATE) {
3313 		isp_prt(isp, ISP_LOGTINFO, "Notify Code 0x%x (qevalid=%d) acked- h/w not ready (dropping)", mp->nt_ncode, mp->nt_lreserved != NULL);
3314 		return (0);
3315 	}
3316 
3317 	/*
3318 	 * This case is for a Task Management Function, which shows up as an ATIO7 entry.
3319 	 */
3320 	if (IS_24XX(isp) && mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ATIO) {
3321 		ct7_entry_t local, *cto = &local;
3322 		at7_entry_t *aep = (at7_entry_t *)mp->nt_lreserved;
3323 		fcportdb_t *lp;
3324 		uint32_t sid;
3325 		uint16_t nphdl;
3326 
3327 		sid = (aep->at_hdr.s_id[0] << 16) | (aep->at_hdr.s_id[1] << 8) | aep->at_hdr.s_id[2];
3328 		if (isp_find_pdb_by_sid(isp, mp->nt_channel, sid, &lp)) {
3329 			nphdl = lp->handle;
3330 		} else {
3331 			nphdl = NIL_HANDLE;
3332 		}
3333 		ISP_MEMZERO(&local, sizeof (local));
3334 		cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
3335 		cto->ct_header.rqs_entry_count = 1;
3336 		cto->ct_nphdl = nphdl;
3337 		cto->ct_rxid = aep->at_rxid;
3338 		cto->ct_vpidx = mp->nt_channel;
3339 		cto->ct_iid_lo = sid;
3340 		cto->ct_iid_hi = sid >> 16;
3341 		cto->ct_oxid = aep->at_hdr.ox_id;
3342 		cto->ct_flags = CT7_SENDSTATUS|CT7_NOACK|CT7_NO_DATA|CT7_FLAG_MODE1;
3343 		cto->ct_flags |= (aep->at_ta_len >> 12) << CT7_TASK_ATTR_SHIFT;
3344 		return (isp_target_put_entry(isp, &local));
3345 	}
3346 
3347 	/*
3348 	 * This case is for a responding to an ABTS frame
3349 	 */
3350 	if (IS_24XX(isp) && mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD) {
3351 
3352 		/*
3353 		 * Overload nt_need_ack here to mark whether we've terminated the associated command.
3354 		 */
3355 		if (mp->nt_need_ack) {
3356 			uint8_t storage[QENTRY_LEN];
3357 			ct7_entry_t *cto = (ct7_entry_t *) storage;
3358 			abts_t *abts = (abts_t *)mp->nt_lreserved;
3359 
3360 			ISP_MEMZERO(cto, sizeof (ct7_entry_t));
3361 			isp_prt(isp, ISP_LOGTDEBUG0, "%s: [%x] terminating after ABTS received", __func__, abts->abts_rxid_task);
3362 			cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
3363 			cto->ct_header.rqs_entry_count = 1;
3364 			cto->ct_nphdl = mp->nt_nphdl;
3365 			cto->ct_rxid = abts->abts_rxid_task;
3366 			cto->ct_iid_lo = mp->nt_sid;
3367 			cto->ct_iid_hi = mp->nt_sid >> 16;
3368 			cto->ct_oxid = abts->abts_ox_id;
3369 			cto->ct_vpidx = mp->nt_channel;
3370 			cto->ct_flags = CT7_NOACK|CT7_TERMINATE;
3371 			if (isp_target_put_entry(isp, cto)) {
3372 				return (ENOMEM);
3373 			}
3374 			mp->nt_need_ack = 0;
3375 		}
3376 		if (isp_acknak_abts(isp, mp->nt_lreserved, 0) == ENOMEM) {
3377 			return (ENOMEM);
3378 		} else {
3379 			return (0);
3380 		}
3381 	}
3382 
3383 	/*
3384 	 * Handle logout cases here
3385 	 */
3386 	if (mp->nt_ncode == NT_GLOBAL_LOGOUT) {
3387 		isp_del_all_wwn_entries(isp, mp->nt_channel);
3388 	}
3389 
3390 	if (mp->nt_ncode == NT_LOGOUT) {
3391 		if (!IS_2100(isp) && IS_FC(isp)) {
3392 			isp_del_wwn_entries(isp, mp);
3393 		}
3394 	}
3395 
3396 	/*
3397 	 * General purpose acknowledgement
3398 	 */
3399 	if (mp->nt_need_ack) {
3400 		isp_prt(isp, ISP_LOGTINFO, "Notify Code 0x%x (qevalid=%d) being acked", mp->nt_ncode, mp->nt_lreserved != NULL);
3401 		/*
3402 		 * Don't need to use the guaranteed send because the caller can retry
3403 		 */
3404 		return (isp_notify_ack(isp, mp->nt_lreserved));
3405 	}
3406 	return (0);
3407 }
3408 
3409 /*
3410  * Handle task management functions.
3411  *
3412  * We show up here with a notify structure filled out.
3413  *
3414  * The nt_lreserved tag points to the original queue entry
3415  */
3416 static void
3417 isp_handle_platform_target_tmf(ispsoftc_t *isp, isp_notify_t *notify)
3418 {
3419 	tstate_t *tptr;
3420 	fcportdb_t *lp;
3421 	struct ccb_immediate_notify *inot;
3422 	inot_private_data_t *ntp = NULL;
3423 	lun_id_t lun;
3424 
3425 	isp_prt(isp, ISP_LOGTDEBUG0, "%s: code 0x%x sid  0x%x tagval 0x%016llx chan %d lun 0x%x", __func__, notify->nt_ncode,
3426 	    notify->nt_sid, (unsigned long long) notify->nt_tagval, notify->nt_channel, notify->nt_lun);
3427 	/*
3428 	 * NB: This assignment is necessary because of tricky type conversion.
3429 	 * XXX: This is tricky and I need to check this. If the lun isn't known
3430 	 * XXX: for the task management function, it does not of necessity follow
3431 	 * XXX: that it should go up stream to the wildcard listener.
3432 	 */
3433 	if (notify->nt_lun == LUN_ANY) {
3434 		lun = CAM_LUN_WILDCARD;
3435 	} else {
3436 		lun = notify->nt_lun;
3437 	}
3438 	tptr = get_lun_statep(isp, notify->nt_channel, lun);
3439 	if (tptr == NULL) {
3440 		tptr = get_lun_statep(isp, notify->nt_channel, CAM_LUN_WILDCARD);
3441 		if (tptr == NULL) {
3442 			isp_prt(isp, ISP_LOGWARN, "%s: no state pointer found for chan %d lun %#jx", __func__, notify->nt_channel, (uintmax_t)lun);
3443 			goto bad;
3444 		}
3445 	}
3446 	inot = (struct ccb_immediate_notify *) SLIST_FIRST(&tptr->inots);
3447 	if (inot == NULL) {
3448 		isp_prt(isp, ISP_LOGWARN, "%s: out of immediate notify structures for chan %d lun %#jx", __func__, notify->nt_channel, (uintmax_t)lun);
3449 		goto bad;
3450 	}
3451 
3452 	if (isp_find_pdb_by_sid(isp, notify->nt_channel, notify->nt_sid, &lp) == 0 &&
3453 	    isp_find_pdb_by_handle(isp, notify->nt_channel, notify->nt_nphdl, &lp) == 0) {
3454 		inot->initiator_id = CAM_TARGET_WILDCARD;
3455 	} else {
3456 		inot->initiator_id = FC_PORTDB_TGT(isp, notify->nt_channel, lp);
3457 	}
3458 	inot->seq_id = notify->nt_tagval;
3459 	inot->tag_id = notify->nt_tagval >> 32;
3460 
3461 	switch (notify->nt_ncode) {
3462 	case NT_ABORT_TASK:
3463 		isp_target_mark_aborted_early(isp, tptr, inot->tag_id);
3464 		inot->arg = MSG_ABORT_TASK;
3465 		break;
3466 	case NT_ABORT_TASK_SET:
3467 		isp_target_mark_aborted_early(isp, tptr, TAG_ANY);
3468 		inot->arg = MSG_ABORT_TASK_SET;
3469 		break;
3470 	case NT_CLEAR_ACA:
3471 		inot->arg = MSG_CLEAR_ACA;
3472 		break;
3473 	case NT_CLEAR_TASK_SET:
3474 		inot->arg = MSG_CLEAR_TASK_SET;
3475 		break;
3476 	case NT_LUN_RESET:
3477 		inot->arg = MSG_LOGICAL_UNIT_RESET;
3478 		break;
3479 	case NT_TARGET_RESET:
3480 		inot->arg = MSG_TARGET_RESET;
3481 		break;
3482 	default:
3483 		isp_prt(isp, ISP_LOGWARN, "%s: unknown TMF code 0x%x for chan %d lun %#jx", __func__, notify->nt_ncode, notify->nt_channel, (uintmax_t)lun);
3484 		goto bad;
3485 	}
3486 
3487 	ntp = isp_get_ntpd(isp, tptr);
3488 	if (ntp == NULL) {
3489 		isp_prt(isp, ISP_LOGWARN, "%s: out of inotify private structures", __func__);
3490 		goto bad;
3491 	}
3492 	ISP_MEMCPY(&ntp->rd.nt, notify, sizeof (isp_notify_t));
3493 	if (notify->nt_lreserved) {
3494 		ISP_MEMCPY(&ntp->rd.data, notify->nt_lreserved, QENTRY_LEN);
3495 		ntp->rd.nt.nt_lreserved = &ntp->rd.data;
3496 	}
3497 	ntp->rd.seq_id = notify->nt_tagval;
3498 	ntp->rd.tag_id = notify->nt_tagval >> 32;
3499 
3500 	tptr->inot_count--;
3501 	SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
3502 	rls_lun_statep(isp, tptr);
3503 	ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, inot->ccb_h.path, "%s: Take FREE INOT count now %d\n", __func__, tptr->inot_count);
3504 	inot->ccb_h.status = CAM_MESSAGE_RECV;
3505 	xpt_done((union ccb *)inot);
3506 	return;
3507 bad:
3508 	if (tptr) {
3509 		rls_lun_statep(isp, tptr);
3510 	}
3511 	if (notify->nt_need_ack && notify->nt_lreserved) {
3512 		if (((isphdr_t *)notify->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD) {
3513 			if (isp_acknak_abts(isp, notify->nt_lreserved, ENOMEM)) {
3514 				isp_prt(isp, ISP_LOGWARN, "you lose- unable to send an ACKNAK");
3515 			}
3516 		} else {
3517 			isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, notify->nt_lreserved);
3518 		}
3519 	}
3520 }
3521 
3522 /*
3523  * Find the associated private data and mark it as dead so
3524  * we don't try to work on it any further.
3525  */
3526 static void
3527 isp_target_mark_aborted(ispsoftc_t *isp, union ccb *ccb)
3528 {
3529 	tstate_t *tptr;
3530 	atio_private_data_t *atp;
3531 	union ccb *accb = ccb->cab.abort_ccb;
3532 
3533 	tptr = get_lun_statep(isp, XS_CHANNEL(accb), XS_LUN(accb));
3534 	if (tptr == NULL) {
3535 		tptr = get_lun_statep(isp, XS_CHANNEL(accb), CAM_LUN_WILDCARD);
3536 		if (tptr == NULL) {
3537 			ccb->ccb_h.status = CAM_REQ_INVALID;
3538 			return;
3539 		}
3540 	}
3541 
3542 	atp = isp_find_atpd(isp, tptr, accb->atio.tag_id);
3543 	if (atp == NULL) {
3544 		ccb->ccb_h.status = CAM_REQ_INVALID;
3545 	} else {
3546 		atp->dead = 1;
3547 		ccb->ccb_h.status = CAM_REQ_CMP;
3548 	}
3549 	rls_lun_statep(isp, tptr);
3550 }
3551 
3552 static void
3553 isp_target_mark_aborted_early(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag_id)
3554 {
3555 	atio_private_data_t *atp;
3556 	inot_private_data_t *restart_queue = tptr->restart_queue;
3557 
3558 	/*
3559 	 * First, clean any commands pending restart
3560 	 */
3561 	tptr->restart_queue = NULL;
3562 	while (restart_queue) {
3563 		uint32_t this_tag_id;
3564 		inot_private_data_t *ntp = restart_queue;
3565 
3566 		restart_queue = ntp->rd.nt.nt_hba;
3567 
3568 		if (IS_24XX(isp)) {
3569 			this_tag_id = ((at7_entry_t *)ntp->rd.data)->at_rxid;
3570 		} else {
3571 			this_tag_id = ((at2_entry_t *)ntp->rd.data)->at_rxid;
3572 		}
3573 		if ((uint64_t)tag_id == TAG_ANY || tag_id == this_tag_id) {
3574 			isp_put_ntpd(isp, tptr, ntp);
3575 		} else {
3576 			ntp->rd.nt.nt_hba = tptr->restart_queue;
3577 			tptr->restart_queue = ntp;
3578 		}
3579 	}
3580 
3581 	/*
3582 	 * Now mark other ones dead as well.
3583 	 */
3584 	for (atp = tptr->atpool; atp < &tptr->atpool[ATPDPSIZE]; atp++) {
3585 		if ((uint64_t)tag_id == TAG_ANY || atp->tag == tag_id) {
3586 			atp->dead = 1;
3587 		}
3588 	}
3589 }
3590 
3591 
3592 #ifdef	ISP_INTERNAL_TARGET
3593 //#define	ISP_SEPARATE_STATUS	1
3594 #define	ISP_MULTI_CCBS		1
3595 #if defined(ISP_MULTI_CCBS) && !defined(ISP_SEPARATE_STATUS)
3596 #define	ISP_SEPARATE_STATUS 1
3597 #endif
3598 
3599 typedef struct periph_private_data_t {
3600 	union ccb *ccb;			/* original ATIO or Immediate Notify */
3601 	unsigned long	offset;		/* current offset */
3602 	int		sequence;	/* current CTIO sequence */
3603 	int		ctio_cnt;	/* current # of ctio's outstanding */
3604 	int
3605 		status_sent	: 1,
3606 		on_queue	: 1;	/* on restart queue */
3607 } ppd_t;
3608 /*
3609  * Each ATIO we allocate will have periph private data associated with it
3610  * that maintains per-command state. This private to each ATIO.
3611  */
3612 #define	ATIO_PPD(ccb)		((ppd_t *)(((struct ccb_hdr *)ccb)->ppriv_ptr0))
3613 /*
3614  * Each CTIO we send downstream will get a pointer to the ATIO itself
3615  * so that on completion we can retrieve that pointer.
3616  */
3617 #define	ccb_atio		ppriv_ptr1
3618 #define	ccb_inot		ppriv_ptr1
3619 
3620 /*
3621  * Each CTIO we send downstream will contain a sequence number
3622  */
3623 #define	CTIO_SEQ(ccb)		ccb->ccb_h.ppriv_field0
3624 
3625 #define	MAX_ISP_TARG_TRANSFER	(2 << 20)
3626 #define	NISP_TARG_CMDS		64
3627 #define	NISP_TARG_NOTIFIES	64
3628 #define	DISK_SHIFT		9
3629 #define	JUNK_SIZE		256
3630 #define	MULTI_CCB_DATA_LIM	8192
3631 //#define	MULTI_CCB_DATA_CNT	64
3632 #define	MULTI_CCB_DATA_CNT	8
3633 
3634 extern u_int vm_kmem_size;
3635 static int ca;
3636 static uint32_t disk_size;
3637 static uint8_t *disk_data = NULL;
3638 static uint8_t *junk_data;
3639 static MALLOC_DEFINE(M_ISPTARG, "ISPTARG", "ISP TARGET data");
3640 struct isptarg_softc {
3641 	/* CCBs (CTIOs, ATIOs, INOTs) pending on the controller */
3642 	struct isp_ccbq		work_queue;
3643 	struct isp_ccbq		rework_queue;
3644 	struct isp_ccbq		running_queue;
3645 	struct isp_ccbq		inot_queue;
3646 	struct cam_periph       *periph;
3647 	struct cam_path	 	*path;
3648 	ispsoftc_t		*isp;
3649 };
3650 static periph_ctor_t	isptargctor;
3651 static periph_dtor_t	isptargdtor;
3652 static periph_start_t	isptargstart;
3653 static periph_init_t	isptarginit;
3654 static void		isptarg_done(struct cam_periph *, union ccb *);
3655 static void		isptargasync(void *, u_int32_t, struct cam_path *, void *);
3656 
3657 
3658 static int isptarg_rwparm(uint8_t *, uint8_t *, uint64_t, uint32_t, uint8_t **, uint32_t *, int *);
3659 
3660 static struct periph_driver isptargdriver =
3661 {
3662 	isptarginit, "isptarg", TAILQ_HEAD_INITIALIZER(isptargdriver.units), 0
3663 };
3664 
3665 static void
3666 isptarginit(void)
3667 {
3668 }
3669 
3670 static void
3671 isptargnotify(ispsoftc_t *isp, union ccb *iccb, struct ccb_immediate_notify *inot)
3672 {
3673 	struct ccb_notify_acknowledge *ack = &iccb->cna2;
3674 
3675 	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__,
3676 	    inot->tag_id, inot->initiator_id, inot->seq_id, inot->ccb_h.status, inot->arg);
3677 	ack->ccb_h.func_code = XPT_NOTIFY_ACKNOWLEDGE;
3678 	ack->ccb_h.flags = 0;
3679 	ack->ccb_h.retry_count = 0;
3680 	ack->ccb_h.cbfcnp = isptarg_done;
3681 	ack->ccb_h.timeout = 0;
3682 	ack->ccb_h.ccb_inot = inot;
3683 	ack->tag_id = inot->tag_id;
3684 	ack->seq_id = inot->seq_id;
3685 	ack->initiator_id = inot->initiator_id;
3686 	xpt_action(iccb);
3687 }
3688 
3689 static void
3690 isptargstart(struct cam_periph *periph, union ccb *iccb)
3691 {
3692 	const uint8_t niliqd[SHORT_INQUIRY_LENGTH] = {
3693 		0x7f, 0x0, 0x5, 0x2, 32, 0, 0, 0x32,
3694 		'F', 'R', 'E', 'E', 'B', 'S', 'D', ' ',
3695 		'S', 'C', 'S', 'I', ' ', 'N', 'U', 'L',
3696 		'L', ' ', 'D', 'E', 'V', 'I', 'C', 'E',
3697 		'0', '0', '0', '1'
3698 	};
3699 	const uint8_t iqd[SHORT_INQUIRY_LENGTH] = {
3700 		0, 0x0, 0x5, 0x2, 32, 0, 0, 0x32,
3701 		'F', 'R', 'E', 'E', 'B', 'S', 'D', ' ',
3702 		'S', 'C', 'S', 'I', ' ', 'M', 'E', 'M',
3703 		'O', 'R', 'Y', ' ', 'D', 'I', 'S', 'K',
3704 		'0', '0', '0', '1'
3705 	};
3706 	int r, i, more = 0, last, is_data_cmd = 0, is_write;
3707 	char *queue;
3708 	struct isptarg_softc *softc = periph->softc;
3709 	struct ccb_scsiio *csio;
3710 	lun_id_t return_lun;
3711 	struct ccb_accept_tio *atio;
3712 	uint8_t *cdb, *ptr, status;
3713 	uint8_t *data_ptr;
3714 	uint32_t data_len, flags;
3715 	struct ccb_hdr *ccbh;
3716 
3717 	mtx_assert(periph->sim->mtx, MA_OWNED);
3718 	ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG1, iccb->ccb_h.path, "%s: function code 0x%x INOTQ=%c WORKQ=%c REWORKQ=%c\n", __func__, iccb->ccb_h.func_code,
3719 	    TAILQ_FIRST(&softc->inot_queue)? 'y' : 'n', TAILQ_FIRST(&softc->work_queue)? 'y' : 'n', TAILQ_FIRST(&softc->rework_queue)? 'y' : 'n');
3720 	/*
3721 	 * Check for immediate notifies first
3722 	 */
3723 	ccbh = TAILQ_FIRST(&softc->inot_queue);
3724 	if (ccbh) {
3725 		TAILQ_REMOVE(&softc->inot_queue, ccbh, periph_links.tqe);
3726 		if (TAILQ_FIRST(&softc->inot_queue) || TAILQ_FIRST(&softc->work_queue) || TAILQ_FIRST(&softc->rework_queue)) {
3727 			xpt_schedule(periph, 1);
3728 		}
3729 		isptargnotify(softc->isp, iccb, (struct ccb_immediate_notify *)ccbh);
3730 		return;
3731 	}
3732 
3733 	/*
3734 	 * Check the rework (continuation) work queue first.
3735 	 */
3736 	ccbh = TAILQ_FIRST(&softc->rework_queue);
3737 	if (ccbh) {
3738 		atio = (struct ccb_accept_tio *)ccbh;
3739 		TAILQ_REMOVE(&softc->rework_queue, ccbh, periph_links.tqe);
3740 		more = TAILQ_FIRST(&softc->work_queue) || TAILQ_FIRST(&softc->rework_queue);
3741 		queue = "rework";
3742 	} else {
3743 		ccbh = TAILQ_FIRST(&softc->work_queue);
3744 		if (ccbh == NULL) {
3745 			xpt_release_ccb(iccb);
3746 			return;
3747 		}
3748 		atio = (struct ccb_accept_tio *)ccbh;
3749 		TAILQ_REMOVE(&softc->work_queue, ccbh, periph_links.tqe);
3750 		more = TAILQ_FIRST(&softc->work_queue) != NULL;
3751 		queue = "work";
3752 	}
3753 	ATIO_PPD(atio)->on_queue = 0;
3754 
3755 	if (atio->tag_id == 0xffffffff || atio->ccb_h.func_code != XPT_ACCEPT_TARGET_IO) {
3756 		panic("BAD ATIO");
3757 	}
3758 
3759 	data_len = is_write = 0;
3760 	data_ptr = NULL;
3761 	csio = &iccb->csio;
3762 	status = SCSI_STATUS_OK;
3763 	flags = CAM_SEND_STATUS;
3764 	memset(&atio->sense_data, 0, sizeof (atio->sense_data));
3765 	cdb = atio->cdb_io.cdb_bytes;
3766 	ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, ccbh->path, "%s: [0x%x] processing ATIO from %s queue initiator 0x%x CDB=0x%x data_offset=%u\n", __func__, atio->tag_id,
3767 	    queue, atio->init_id, cdb[0], ATIO_PPD(atio)->offset);
3768 
3769 	return_lun = XS_LUN(atio);
3770 	if (return_lun != 0) {
3771 		xpt_print(atio->ccb_h.path, "[0x%x] Non-Zero Lun %d: cdb0=0x%x\n", atio->tag_id, return_lun, cdb[0]);
3772 		if (cdb[0] != INQUIRY && cdb[0] != REPORT_LUNS && cdb[0] != REQUEST_SENSE) {
3773 			status = SCSI_STATUS_CHECK_COND;
3774 			SDFIXED(atio->sense_data)->error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR;
3775 			SDFIXED(atio->sense_data)->flags = SSD_KEY_ILLEGAL_REQUEST;
3776 			SDFIXED(atio->sense_data)->add_sense_code = 0x25;	/* LOGICAL UNIT NOT SUPPORTED */
3777 			atio->sense_len = SSD_MIN_SIZE;
3778 		}
3779 		return_lun = CAM_LUN_WILDCARD;
3780 	}
3781 
3782 	switch (cdb[0]) {
3783 	case REQUEST_SENSE:
3784 		flags |= CAM_DIR_IN;
3785 		data_len = sizeof (atio->sense_data);
3786 		junk_data[0] = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_NO_SENSE;
3787 		memset(junk_data+1, 0, data_len-1);
3788 		if (data_len > cdb[4]) {
3789 			data_len = cdb[4];
3790 		}
3791 		if (data_len) {
3792 			data_ptr = junk_data;
3793 		}
3794 		break;
3795 	case WRITE_6:
3796 	case WRITE_10:
3797 	case WRITE_12:
3798 	case WRITE_16:
3799 		is_write = 1;
3800 		/* FALLTHROUGH */
3801 	case READ_6:
3802 	case READ_10:
3803 	case READ_12:
3804 	case READ_16:
3805 		is_data_cmd = 1;
3806 		r = isptarg_rwparm(cdb, disk_data, disk_size, ATIO_PPD(atio)->offset, &data_ptr, &data_len, &last);
3807 		if (r != 0) {
3808 			status = SCSI_STATUS_CHECK_COND;
3809 			SDFIXED(atio->sense_data)->error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR;
3810 			SDFIXED(atio->sense_data)->flags = SSD_KEY_ILLEGAL_REQUEST;
3811 			if (r == -1) {
3812 				SDFIXED(atio->sense_data)->add_sense_code = 0x21;	/* LOGICAL BLOCK ADDRESS OUT OF RANGE */
3813 			} else {
3814 				SDFIXED(atio->sense_data)->add_sense_code = 0x20;	/* INVALID COMMAND OPERATION CODE */
3815 			}
3816 			atio->sense_len = SSD_MIN_SIZE;
3817 		} else {
3818 #ifdef	ISP_SEPARATE_STATUS
3819 			if (last && data_len) {
3820 				last = 0;
3821 			}
3822 #endif
3823 			if (last == 0) {
3824 				flags &= ~CAM_SEND_STATUS;
3825 			}
3826 			if (data_len) {
3827 				ATIO_PPD(atio)->offset += data_len;
3828 				if (is_write)
3829 					flags |= CAM_DIR_OUT;
3830 				else
3831 					flags |= CAM_DIR_IN;
3832 			} else {
3833 				flags |= CAM_DIR_NONE;
3834 			}
3835 		}
3836 		break;
3837 	case INQUIRY:
3838 		flags |= CAM_DIR_IN;
3839 		if (cdb[1] || cdb[2] || cdb[3]) {
3840 			status = SCSI_STATUS_CHECK_COND;
3841 			SDFIXED(atio->sense_data)->error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR;
3842 			SDFIXED(atio->sense_data)->flags = SSD_KEY_UNIT_ATTENTION;
3843 			SDFIXED(atio->sense_data)->add_sense_code = 0x24;	/* INVALID FIELD IN CDB */
3844 			atio->sense_len = SSD_MIN_SIZE;
3845 			break;
3846 		}
3847 		data_len = sizeof (iqd);
3848 		if (data_len > cdb[4]) {
3849 			data_len = cdb[4];
3850 		}
3851 		if (data_len) {
3852 			if (XS_LUN(iccb) != 0) {
3853 				memcpy(junk_data, niliqd, sizeof (iqd));
3854 			} else {
3855 				memcpy(junk_data, iqd, sizeof (iqd));
3856 			}
3857 			data_ptr = junk_data;
3858 		}
3859 		break;
3860 	case TEST_UNIT_READY:
3861 		flags |= CAM_DIR_NONE;
3862 		if (ca) {
3863 			ca = 0;
3864 			status = SCSI_STATUS_CHECK_COND;
3865 			SDFIXED(atio->sense_data)->error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR;
3866 			SDFIXED(atio->sense_data)->flags = SSD_KEY_UNIT_ATTENTION;
3867 			SDFIXED(atio->sense_data)->add_sense_code = 0x29;	/* POWER ON, RESET, OR BUS DEVICE RESET OCCURRED */
3868 			atio->sense_len = SSD_MIN_SIZE;
3869 		}
3870 		break;
3871 	case SYNCHRONIZE_CACHE:
3872 	case START_STOP:
3873 	case RESERVE:
3874 	case RELEASE:
3875 	case VERIFY_10:
3876 		flags |= CAM_DIR_NONE;
3877 		break;
3878 
3879 	case READ_CAPACITY:
3880 		flags |= CAM_DIR_IN;
3881 		if (cdb[2] || cdb[3] || cdb[4] || cdb[5]) {
3882 			status = SCSI_STATUS_CHECK_COND;
3883 			SDFIXED(atio->sense_data)->error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR;
3884 			SDFIXED(atio->sense_data)->flags = SSD_KEY_ILLEGAL_REQUEST;
3885 			SDFIXED(atio->sense_data)->add_sense_code =  0x24;	/* INVALID FIELD IN CDB */
3886 			atio->sense_len = SSD_MIN_SIZE;
3887 			break;
3888 		}
3889 		if (cdb[8] & 0x1) { /* PMI */
3890 			junk_data[0] = 0xff;
3891 			junk_data[1] = 0xff;
3892 			junk_data[2] = 0xff;
3893 			junk_data[3] = 0xff;
3894 		} else {
3895 			uint64_t last_blk = (disk_size >> DISK_SHIFT) - 1;
3896 			if (last_blk < 0xffffffffULL) {
3897 			    junk_data[0] = (last_blk >> 24) & 0xff;
3898 			    junk_data[1] = (last_blk >> 16) & 0xff;
3899 			    junk_data[2] = (last_blk >>  8) & 0xff;
3900 			    junk_data[3] = (last_blk) & 0xff;
3901 			} else {
3902 			    junk_data[0] = 0xff;
3903 			    junk_data[1] = 0xff;
3904 			    junk_data[2] = 0xff;
3905 			    junk_data[3] = 0xff;
3906 			}
3907 		}
3908 		junk_data[4] = ((1 << DISK_SHIFT) >> 24) & 0xff;
3909 		junk_data[5] = ((1 << DISK_SHIFT) >> 16) & 0xff;
3910 		junk_data[6] = ((1 << DISK_SHIFT) >>  8) & 0xff;
3911 		junk_data[7] = ((1 << DISK_SHIFT)) & 0xff;
3912 		data_ptr = junk_data;
3913 		data_len = 8;
3914 		break;
3915 	case REPORT_LUNS:
3916 		flags |= CAM_DIR_IN;
3917 		memset(junk_data, 0, JUNK_SIZE);
3918 		junk_data[0] = (1 << 3) >> 24;
3919 		junk_data[1] = (1 << 3) >> 16;
3920 		junk_data[2] = (1 << 3) >> 8;
3921 		junk_data[3] = (1 << 3);
3922 		ptr = NULL;
3923 		for (i = 0; i < 1; i++) {
3924 			ptr = &junk_data[8 + (i << 3)];
3925 			if (i >= 256) {
3926 				ptr[0] = 0x40 | ((i >> 8) & 0x3f);
3927 			}
3928 			ptr[1] = i;
3929 		}
3930 		data_ptr = junk_data;
3931 		data_len = (ptr + 8) - junk_data;
3932 		break;
3933 
3934 	default:
3935 		flags |= CAM_DIR_NONE;
3936 		status = SCSI_STATUS_CHECK_COND;
3937 		SDFIXED(atio->sense_data)->error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR;
3938 		SDFIXED(atio->sense_data)->flags = SSD_KEY_ILLEGAL_REQUEST;
3939 		SDFIXED(atio->sense_data)->add_sense_code = 0x20;	/* INVALID COMMAND OPERATION CODE */
3940 		atio->sense_len = SSD_MIN_SIZE;
3941 		break;
3942 	}
3943 
3944 	/*
3945 	 * If we are done with the transaction, tell the
3946 	 * controller to send status and perform a CMD_CMPLT.
3947 	 * If we have associated sense data, see if we can
3948 	 * send that too.
3949 	 */
3950 	if (status == SCSI_STATUS_CHECK_COND) {
3951 		flags |= CAM_SEND_SENSE;
3952 		csio->sense_len = atio->sense_len;
3953 		csio->sense_data = atio->sense_data;
3954 		flags &= ~CAM_DIR_MASK;
3955 		data_len = 0;
3956 		data_ptr = NULL;
3957 	}
3958 	cam_fill_ctio(csio, 0, isptarg_done, flags, MSG_SIMPLE_Q_TAG, atio->tag_id, atio->init_id, status, data_ptr, data_len, 30 * hz);
3959 	iccb->ccb_h.target_id = atio->ccb_h.target_id;
3960 	iccb->ccb_h.target_lun = return_lun;
3961 	iccb->ccb_h.ccb_atio = atio;
3962 	CTIO_SEQ(iccb) = ATIO_PPD(atio)->sequence++;
3963 	ATIO_PPD(atio)->ctio_cnt++;
3964 	if (flags & CAM_SEND_STATUS) {
3965 		KASSERT((ATIO_PPD(atio)->status_sent == 0), ("we have already sent status for 0x%x in %s", atio->tag_id, __func__));
3966 		ATIO_PPD(atio)->status_sent = 1;
3967 	}
3968 	ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, atio->ccb_h.path, "%s: sending downstream for  0x%x sequence %u len %u flags %x\n", __func__, atio->tag_id, CTIO_SEQ(iccb), data_len, flags);
3969 	xpt_action(iccb);
3970 
3971 	if ((atio->ccb_h.status & CAM_DEV_QFRZN) != 0) {
3972 		cam_release_devq(periph->path, 0, 0, 0, 0);
3973 		atio->ccb_h.status &= ~CAM_DEV_QFRZN;
3974 	}
3975 #ifdef	ISP_MULTI_CCBS
3976 	if (is_data_cmd && ATIO_PPD(atio)->status_sent == 0 && ATIO_PPD(atio)->ctio_cnt < MULTI_CCB_DATA_CNT && ATIO_PPD(atio)->on_queue == 0) {
3977 		ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, atio->ccb_h.path, "%s: more still to do for 0x%x\n", __func__, atio->tag_id);
3978 		TAILQ_INSERT_TAIL(&softc->rework_queue, &atio->ccb_h, periph_links.tqe);
3979 		ATIO_PPD(atio)->on_queue = 1;
3980 		more = 1;
3981 	}
3982 #endif
3983 	if (more) {
3984 		xpt_schedule(periph, 1);
3985 	}
3986 }
3987 
3988 static cam_status
3989 isptargctor(struct cam_periph *periph, void *arg)
3990 {
3991 	struct isptarg_softc *softc;
3992 
3993 	softc = (struct isptarg_softc *)arg;
3994 	periph->softc = softc;
3995 	softc->periph = periph;
3996 	softc->path = periph->path;
3997 	ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG1, periph->path, "%s called\n", __func__);
3998 	return (CAM_REQ_CMP);
3999 }
4000 
4001 static void
4002 isptargdtor(struct cam_periph *periph)
4003 {
4004 	struct isptarg_softc *softc;
4005 	softc = (struct isptarg_softc *)periph->softc;
4006 	ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG1, periph->path, "%s called\n", __func__);
4007 	softc->periph = NULL;
4008 	softc->path = NULL;
4009 	periph->softc = NULL;
4010 }
4011 
4012 static void
4013 isptarg_done(struct cam_periph *periph, union ccb *ccb)
4014 {
4015 	struct isptarg_softc *softc;
4016 	ispsoftc_t *isp;
4017 	uint32_t newoff;
4018 	struct ccb_accept_tio *atio;
4019 	struct ccb_immediate_notify *inot;
4020 	cam_status status;
4021 
4022 	softc = (struct isptarg_softc *)periph->softc;
4023 	isp = softc->isp;
4024 	status = ccb->ccb_h.status & CAM_STATUS_MASK;
4025 
4026 	switch (ccb->ccb_h.func_code) {
4027 	case XPT_ACCEPT_TARGET_IO:
4028 		atio = (struct ccb_accept_tio *) ccb;
4029 		ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] ATIO seen in %s\n", atio->tag_id, __func__);
4030 		memset(ATIO_PPD(atio), 0, sizeof (ppd_t));
4031 		TAILQ_INSERT_TAIL(&softc->work_queue, &ccb->ccb_h, periph_links.tqe);
4032 		ATIO_PPD(atio)->on_queue = 1;
4033 		xpt_schedule(periph, 1);
4034 		break;
4035 	case XPT_IMMEDIATE_NOTIFY:
4036 		inot = (struct ccb_immediate_notify *) ccb;
4037 		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__);
4038 		TAILQ_INSERT_TAIL(&softc->inot_queue, &ccb->ccb_h, periph_links.tqe);
4039 		xpt_schedule(periph, 1);
4040 		break;
4041 	case XPT_CONT_TARGET_IO:
4042 		atio = ccb->ccb_h.ccb_atio;
4043 		KASSERT((ATIO_PPD(atio)->ctio_cnt != 0), ("ctio zero when finishing a CTIO"));
4044 		ATIO_PPD(atio)->ctio_cnt--;
4045 		if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
4046 			switch (ccb->ccb_h.status & CAM_STATUS_MASK) {
4047 			case CAM_MESSAGE_RECV:
4048 				newoff = (ccb->csio.msg_ptr[3] << 24) | (ccb->csio.msg_ptr[4] << 16) | (ccb->csio.msg_ptr[5] << 8) | (ccb->csio.msg_ptr[6]);
4049 				ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "[0x%x] got message to return to reset offset to 0x%x at sequence %u\n", atio->tag_id, newoff, CTIO_SEQ(ccb));
4050 				ATIO_PPD(atio)->offset = newoff;
4051 				ATIO_PPD(atio)->status_sent = 0;
4052 				if (ATIO_PPD(atio)->on_queue == 0) {
4053 					TAILQ_INSERT_TAIL(&softc->rework_queue, &atio->ccb_h, periph_links.tqe);
4054 					ATIO_PPD(atio)->on_queue = 1;
4055 				}
4056 				xpt_schedule(periph, 1);
4057 				break;
4058 			default:
4059 				cam_error_print(ccb, CAM_ESF_ALL, CAM_EPF_ALL);
4060 				xpt_action((union ccb *)atio);
4061 				break;
4062 			}
4063 		} else if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
4064 			ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] MID CTIO sequence %u seen in %s\n", atio->tag_id, CTIO_SEQ(ccb), __func__);
4065 			if (ATIO_PPD(atio)->status_sent == 0 && ATIO_PPD(atio)->on_queue == 0) {
4066 				TAILQ_INSERT_TAIL(&softc->rework_queue, &atio->ccb_h, periph_links.tqe);
4067 				ATIO_PPD(atio)->on_queue = 1;
4068 			}
4069 			xpt_schedule(periph, 1);
4070 		} else {
4071 			KASSERT((ATIO_PPD(atio)->ctio_cnt == 0), ("ctio count still %d when we think we've sent the STATUS ctio", ATIO_PPD(atio)->ctio_cnt));
4072 			ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] FINAL CTIO sequence %u seen in %s\n", atio->tag_id, CTIO_SEQ(ccb), __func__);
4073 			xpt_action((union ccb *)atio);
4074 		}
4075 		if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
4076 			cam_release_devq(ccb->ccb_h.path, 0, 0, 0, 0);
4077 			ccb->ccb_h.status &= ~CAM_DEV_QFRZN;
4078 		}
4079 		xpt_release_ccb(ccb);
4080 		break;
4081 	case XPT_NOTIFY_ACKNOWLEDGE:
4082 		if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
4083 			cam_release_devq(ccb->ccb_h.path, 0, 0, 0, 0);
4084 			ccb->ccb_h.status &= ~CAM_DEV_QFRZN;
4085 		}
4086 		inot = ccb->ccb_h.ccb_inot;
4087 		ISP_PATH_PRT(isp, ISP_LOGTDEBUG1, inot->ccb_h.path, "[0x%x] recycle notify for tag 0x%x\n", inot->tag_id, inot->seq_id);
4088 		xpt_release_ccb(ccb);
4089 		xpt_action((union ccb *)inot);
4090 		break;
4091 	default:
4092 		xpt_print(ccb->ccb_h.path, "unexpected code 0x%x\n", ccb->ccb_h.func_code);
4093 		break;
4094 	}
4095 }
4096 
4097 static void
4098 isptargasync(void *callback_arg, u_int32_t code, struct cam_path *path, void *arg)
4099 {
4100 	struct ac_contract *acp = arg;
4101 	struct ac_device_changed *fc = (struct ac_device_changed *) acp->contract_data;
4102 
4103 	if (code != AC_CONTRACT) {
4104 		return;
4105 	}
4106 	xpt_print(path, "0x%016llx Port ID 0x%06x %s\n", (unsigned long long) fc->wwpn, fc->port, fc->arrived? "arrived" : "departed");
4107 }
4108 
4109 static void
4110 isp_target_thread(ispsoftc_t *isp, int chan)
4111 {
4112 	union ccb *ccb = NULL;
4113 	int i;
4114 	void *wchan;
4115 	cam_status status;
4116 	struct isptarg_softc *softc = NULL;
4117 	struct cam_periph *periph = NULL, *wperiph = NULL;
4118 	struct cam_path *path, *wpath;
4119 	struct cam_sim *sim;
4120 
4121 	if (disk_data == NULL) {
4122 		disk_size = roundup2(vm_kmem_size >> 1, (1ULL << 20));
4123 		if (disk_size < (50 << 20)) {
4124 			disk_size = 50 << 20;
4125 		}
4126 		disk_data = malloc(disk_size, M_ISPTARG, M_WAITOK | M_ZERO);
4127 		if (disk_data == NULL) {
4128 			isp_prt(isp, ISP_LOGERR, "%s: could not allocate disk data", __func__);
4129 			goto out;
4130 		}
4131 		isp_prt(isp, ISP_LOGINFO, "allocated a %ju MiB disk", (uintmax_t) (disk_size >> 20));
4132 	}
4133 	junk_data = malloc(JUNK_SIZE, M_ISPTARG, M_WAITOK | M_ZERO);
4134 	if (junk_data == NULL) {
4135 		isp_prt(isp, ISP_LOGERR, "%s: could not allocate junk", __func__);
4136 		goto out;
4137 	}
4138 
4139 
4140 	softc = malloc(sizeof (*softc), M_ISPTARG, M_WAITOK | M_ZERO);
4141 	if (softc == NULL) {
4142 		isp_prt(isp, ISP_LOGERR, "%s: could not allocate softc", __func__);
4143 		goto out;
4144 	}
4145 	TAILQ_INIT(&softc->work_queue);
4146 	TAILQ_INIT(&softc->rework_queue);
4147 	TAILQ_INIT(&softc->running_queue);
4148 	TAILQ_INIT(&softc->inot_queue);
4149 	softc->isp = isp;
4150 
4151 	periphdriver_register(&isptargdriver);
4152 	ISP_GET_PC(isp, chan, sim, sim);
4153 	ISP_GET_PC(isp, chan, path,  path);
4154 	status = xpt_create_path(&wpath, NULL, cam_sim_path(sim), CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD);
4155 	if (status != CAM_REQ_CMP) {
4156 		isp_prt(isp, ISP_LOGERR, "%s: could not allocate wildcard path", __func__);
4157 		return;
4158 	}
4159 	status = xpt_create_path(&path, NULL, cam_sim_path(sim), 0, 0);
4160 	if (status != CAM_REQ_CMP) {
4161 		xpt_free_path(wpath);
4162 		isp_prt(isp, ISP_LOGERR, "%s: could not allocate path", __func__);
4163 		return;
4164 	}
4165 
4166 	ISP_LOCK(isp);
4167 	status = cam_periph_alloc(isptargctor, NULL, isptargdtor, isptargstart, "isptarg", CAM_PERIPH_BIO, wpath, NULL, 0, softc);
4168 	if (status != CAM_REQ_CMP) {
4169 		ISP_UNLOCK(isp);
4170 		isp_prt(isp, ISP_LOGERR, "%s: cam_periph_alloc for wildcard failed", __func__);
4171 		goto out;
4172 	}
4173 	wperiph = cam_periph_find(wpath, "isptarg");
4174 	if (wperiph == NULL) {
4175 		ISP_UNLOCK(isp);
4176 		isp_prt(isp, ISP_LOGERR, "%s: wildcard periph already allocated but doesn't exist", __func__);
4177 		goto out;
4178 	}
4179 
4180 	status = cam_periph_alloc(isptargctor, NULL, isptargdtor, isptargstart, "isptarg", CAM_PERIPH_BIO, path, NULL, 0, softc);
4181 	if (status != CAM_REQ_CMP) {
4182 		ISP_UNLOCK(isp);
4183 		isp_prt(isp, ISP_LOGERR, "%s: cam_periph_alloc failed", __func__);
4184 		goto out;
4185 	}
4186 
4187 	periph = cam_periph_find(path, "isptarg");
4188 	if (periph == NULL) {
4189 		ISP_UNLOCK(isp);
4190 		isp_prt(isp, ISP_LOGERR, "%s: periph already allocated but doesn't exist", __func__);
4191 		goto out;
4192 	}
4193 
4194 	status = xpt_register_async(AC_CONTRACT, isptargasync, isp, wpath);
4195 	if (status != CAM_REQ_CMP) {
4196 		ISP_UNLOCK(isp);
4197 		isp_prt(isp, ISP_LOGERR, "%s: xpt_register_async failed", __func__);
4198 		goto out;
4199 	}
4200 
4201 	ISP_UNLOCK(isp);
4202 
4203 	ccb = xpt_alloc_ccb();
4204 
4205 	/*
4206 	 * Make sure role is none.
4207 	 */
4208 	xpt_setup_ccb(&ccb->ccb_h, periph->path, 10);
4209 	ccb->ccb_h.func_code = XPT_SET_SIM_KNOB;
4210 	ccb->knob.xport_specific.fc.role = KNOB_ROLE_NONE;
4211 	ccb->knob.xport_specific.fc.valid = KNOB_VALID_ROLE;
4212 
4213 	ISP_LOCK(isp);
4214 	xpt_action(ccb);
4215 	ISP_UNLOCK(isp);
4216 
4217 	/*
4218 	 * Now enable luns
4219 	 */
4220 	xpt_setup_ccb(&ccb->ccb_h, periph->path, 10);
4221 	ccb->ccb_h.func_code = XPT_EN_LUN;
4222 	ccb->cel.enable = 1;
4223 	ISP_LOCK(isp);
4224 	xpt_action(ccb);
4225 	ISP_UNLOCK(isp);
4226 	if (ccb->ccb_h.status != CAM_REQ_CMP) {
4227 		xpt_free_ccb(ccb);
4228 		xpt_print(periph->path, "failed to enable lun (0x%x)\n", ccb->ccb_h.status);
4229 		goto out;
4230 	}
4231 
4232 	xpt_setup_ccb(&ccb->ccb_h, wperiph->path, 10);
4233 	ccb->ccb_h.func_code = XPT_EN_LUN;
4234 	ccb->cel.enable = 1;
4235 	ISP_LOCK(isp);
4236 	xpt_action(ccb);
4237 	ISP_UNLOCK(isp);
4238 	if (ccb->ccb_h.status != CAM_REQ_CMP) {
4239 		xpt_free_ccb(ccb);
4240 		xpt_print(wperiph->path, "failed to enable lun (0x%x)\n", ccb->ccb_h.status);
4241 		goto out;
4242 	}
4243 	xpt_free_ccb(ccb);
4244 
4245 	/*
4246 	 * Add resources
4247 	 */
4248 	ISP_GET_PC(isp, chan, target_proc, wchan);
4249 	for (i = 0; i < 4; i++) {
4250 		ccb = malloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
4251 		xpt_setup_ccb(&ccb->ccb_h, wperiph->path, 1);
4252 		ccb->ccb_h.func_code = XPT_ACCEPT_TARGET_IO;
4253 		ccb->ccb_h.cbfcnp = isptarg_done;
4254 		ccb->ccb_h.ppriv_ptr0 = malloc(sizeof (ppd_t), M_ISPTARG, M_WAITOK | M_ZERO);
4255 		ISP_LOCK(isp);
4256 		xpt_action(ccb);
4257 		ISP_UNLOCK(isp);
4258 	}
4259 	for (i = 0; i < NISP_TARG_CMDS; i++) {
4260 		ccb = malloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
4261 		xpt_setup_ccb(&ccb->ccb_h, periph->path, 1);
4262 		ccb->ccb_h.func_code = XPT_ACCEPT_TARGET_IO;
4263 		ccb->ccb_h.cbfcnp = isptarg_done;
4264 		ccb->ccb_h.ppriv_ptr0 = malloc(sizeof (ppd_t), M_ISPTARG, M_WAITOK | M_ZERO);
4265 		ISP_LOCK(isp);
4266 		xpt_action(ccb);
4267 		ISP_UNLOCK(isp);
4268 	}
4269 	for (i = 0; i < 4; i++) {
4270 		ccb = malloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
4271 		xpt_setup_ccb(&ccb->ccb_h, wperiph->path, 1);
4272 		ccb->ccb_h.func_code = XPT_IMMEDIATE_NOTIFY;
4273 		ccb->ccb_h.cbfcnp = isptarg_done;
4274 		ISP_LOCK(isp);
4275 		xpt_action(ccb);
4276 		ISP_UNLOCK(isp);
4277 	}
4278 	for (i = 0; i < NISP_TARG_NOTIFIES; i++) {
4279 		ccb = malloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
4280 		xpt_setup_ccb(&ccb->ccb_h, periph->path, 1);
4281 		ccb->ccb_h.func_code = XPT_IMMEDIATE_NOTIFY;
4282 		ccb->ccb_h.cbfcnp = isptarg_done;
4283 		ISP_LOCK(isp);
4284 		xpt_action(ccb);
4285 		ISP_UNLOCK(isp);
4286 	}
4287 
4288 	/*
4289 	 * Now turn it all back on
4290 	 */
4291 	xpt_setup_ccb(&ccb->ccb_h, periph->path, 10);
4292 	ccb->ccb_h.func_code = XPT_SET_SIM_KNOB;
4293 	ccb->knob.xport_specific.fc.valid = KNOB_VALID_ROLE;
4294 	ccb->knob.xport_specific.fc.role = KNOB_ROLE_TARGET;
4295 	ISP_LOCK(isp);
4296 	xpt_action(ccb);
4297 	ISP_UNLOCK(isp);
4298 
4299 	/*
4300 	 * Okay, while things are still active, sleep...
4301 	 */
4302 	ISP_LOCK(isp);
4303 	for (;;) {
4304 		ISP_GET_PC(isp, chan, proc_active, i);
4305 		if (i == 0) {
4306 			break;
4307 		}
4308 		msleep(wchan, &isp->isp_lock, PUSER, "tsnooze", 0);
4309 	}
4310 	ISP_UNLOCK(isp);
4311 
4312 out:
4313 	if (wperiph) {
4314 		cam_periph_invalidate(wperiph);
4315 	}
4316 	if (periph) {
4317 		cam_periph_invalidate(periph);
4318 	}
4319 	if (junk_data) {
4320 		free(junk_data, M_ISPTARG);
4321 	}
4322 	if (disk_data) {
4323 		free(disk_data, M_ISPTARG);
4324 	}
4325 	if (softc) {
4326 		free(softc, M_ISPTARG);
4327 	}
4328 	xpt_free_path(path);
4329 	xpt_free_path(wpath);
4330 }
4331 
4332 static void
4333 isp_target_thread_pi(void *arg)
4334 {
4335 	struct isp_spi *pi = arg;
4336 	ispsoftc_t *isp = cam_sim_softc(pi->sim);
4337 	int chan = cam_sim_bus(pi->sim);
4338 
4339 	isp_target_thread(isp, chan);
4340 	ISP_SPI_PC(isp, chan)->num_threads -= 1;
4341 	kthread_exit();
4342 }
4343 
4344 static void
4345 isp_target_thread_fc(void *arg)
4346 {
4347 	struct isp_fc *fc = arg;
4348 	ispsoftc_t *isp = cam_sim_softc(pi->sim);
4349 	int chan = cam_sim_bus(pi->sim);
4350 
4351 	isp_target_thread(isp, chan);
4352 	ISP_FC_PC(isp, chan)->num_threads -= 1;
4353 	kthread_exit();
4354 }
4355 
4356 static int
4357 isptarg_rwparm(uint8_t *cdb, uint8_t *dp, uint64_t dl, uint32_t offset, uint8_t **kp, uint32_t *tl, int *lp)
4358 {
4359 	uint32_t cnt, curcnt;
4360 	uint64_t lba;
4361 
4362 	switch (cdb[0]) {
4363 	case WRITE_16:
4364 	case READ_16:
4365 		cnt =	(((uint32_t)cdb[10]) <<  24) |
4366 			(((uint32_t)cdb[11]) <<  16) |
4367 			(((uint32_t)cdb[12]) <<   8) |
4368 			((uint32_t)cdb[13]);
4369 
4370 		lba =	(((uint64_t)cdb[2]) << 56) |
4371 			(((uint64_t)cdb[3]) << 48) |
4372 			(((uint64_t)cdb[4]) << 40) |
4373 			(((uint64_t)cdb[5]) << 32) |
4374 			(((uint64_t)cdb[6]) << 24) |
4375 			(((uint64_t)cdb[7]) << 16) |
4376 			(((uint64_t)cdb[8]) <<  8) |
4377 			((uint64_t)cdb[9]);
4378 		break;
4379 	case WRITE_12:
4380 	case READ_12:
4381 		cnt =	(((uint32_t)cdb[6]) <<  16) |
4382 			(((uint32_t)cdb[7]) <<   8) |
4383 			((u_int32_t)cdb[8]);
4384 
4385 		lba =	(((uint32_t)cdb[2]) << 24) |
4386 			(((uint32_t)cdb[3]) << 16) |
4387 			(((uint32_t)cdb[4]) <<  8) |
4388 			((uint32_t)cdb[5]);
4389 		break;
4390 	case WRITE_10:
4391 	case READ_10:
4392 		cnt =	(((uint32_t)cdb[7]) <<  8) |
4393 			((u_int32_t)cdb[8]);
4394 
4395 		lba =	(((uint32_t)cdb[2]) << 24) |
4396 			(((uint32_t)cdb[3]) << 16) |
4397 			(((uint32_t)cdb[4]) <<  8) |
4398 			((uint32_t)cdb[5]);
4399 		break;
4400 	case WRITE_6:
4401 	case READ_6:
4402 		cnt = cdb[4];
4403 		if (cnt == 0) {
4404 			cnt = 256;
4405 		}
4406 		lba =	(((uint32_t)cdb[1] & 0x1f) << 16) |
4407 			(((uint32_t)cdb[2]) << 8) |
4408 			((uint32_t)cdb[3]);
4409 		break;
4410 	default:
4411 		return (-1);
4412 	}
4413 
4414 	cnt <<= DISK_SHIFT;
4415 	lba <<= DISK_SHIFT;
4416 
4417 	if (offset == cnt) {
4418 		*lp = 1;
4419 		return (0);
4420 	}
4421 
4422 	if (lba + cnt > dl) {
4423 		return (-2);
4424 	}
4425 
4426 	curcnt = MAX_ISP_TARG_TRANSFER;
4427 	if (offset + curcnt >= cnt) {
4428 		curcnt = cnt - offset;
4429 		*lp = 1;
4430 	} else {
4431 		*lp = 0;
4432 	}
4433 #ifdef	ISP_MULTI_CCBS
4434 	if (curcnt > MULTI_CCB_DATA_LIM)
4435 		curcnt = MULTI_CCB_DATA_LIM;
4436 #endif
4437 	*tl = curcnt;
4438 	*kp = &dp[lba + offset];
4439 	return (0);
4440 }
4441 
4442 #endif
4443 #endif
4444 
4445 static void
4446 isp_cam_async(void *cbarg, uint32_t code, struct cam_path *path, void *arg)
4447 {
4448 	struct cam_sim *sim;
4449 	int bus, tgt;
4450 	ispsoftc_t *isp;
4451 
4452 	sim = (struct cam_sim *)cbarg;
4453 	isp = (ispsoftc_t *) cam_sim_softc(sim);
4454 	bus = cam_sim_bus(sim);
4455 	tgt = xpt_path_target_id(path);
4456 
4457 	switch (code) {
4458 	case AC_LOST_DEVICE:
4459 		if (IS_SCSI(isp)) {
4460 			uint16_t oflags, nflags;
4461 			sdparam *sdp = SDPARAM(isp, bus);
4462 
4463 			if (tgt >= 0) {
4464 				nflags = sdp->isp_devparam[tgt].nvrm_flags;
4465 #ifndef	ISP_TARGET_MODE
4466 				nflags &= DPARM_SAFE_DFLT;
4467 				if (isp->isp_loaded_fw) {
4468 					nflags |= DPARM_NARROW | DPARM_ASYNC;
4469 				}
4470 #else
4471 				nflags = DPARM_DEFAULT;
4472 #endif
4473 				oflags = sdp->isp_devparam[tgt].goal_flags;
4474 				sdp->isp_devparam[tgt].goal_flags = nflags;
4475 				sdp->isp_devparam[tgt].dev_update = 1;
4476 				sdp->update = 1;
4477 				(void) isp_control(isp, ISPCTL_UPDATE_PARAMS, bus);
4478 				sdp->isp_devparam[tgt].goal_flags = oflags;
4479 			}
4480 		}
4481 		break;
4482 	default:
4483 		isp_prt(isp, ISP_LOGWARN, "isp_cam_async: Code 0x%x", code);
4484 		break;
4485 	}
4486 }
4487 
4488 static void
4489 isp_poll(struct cam_sim *sim)
4490 {
4491 	ispsoftc_t *isp = cam_sim_softc(sim);
4492 	uint32_t isr;
4493 	uint16_t sema, mbox;
4494 
4495 	if (ISP_READ_ISR(isp, &isr, &sema, &mbox)) {
4496 		isp_intr(isp, isr, sema, mbox);
4497 	}
4498 }
4499 
4500 
4501 static void
4502 isp_watchdog(void *arg)
4503 {
4504 	struct ccb_scsiio *xs = arg;
4505 	ispsoftc_t *isp;
4506 	uint32_t ohandle = ISP_HANDLE_FREE, handle;
4507 
4508 	isp = XS_ISP(xs);
4509 
4510 	handle = isp_find_handle(isp, xs);
4511 
4512 	/*
4513 	 * Hand crank the interrupt code just to be sure the command isn't stuck somewhere.
4514 	 */
4515 	if (handle != ISP_HANDLE_FREE) {
4516 		uint32_t isr;
4517 		uint16_t sema, mbox;
4518 		if (ISP_READ_ISR(isp, &isr, &sema, &mbox) != 0) {
4519 			isp_intr(isp, isr, sema, mbox);
4520 		}
4521 		ohandle = handle;
4522 		handle = isp_find_handle(isp, xs);
4523 	}
4524 	if (handle != ISP_HANDLE_FREE) {
4525 		/*
4526 		 * Try and make sure the command is really dead before
4527 		 * we release the handle (and DMA resources) for reuse.
4528 		 *
4529 		 * If we are successful in aborting the command then
4530 		 * we're done here because we'll get the command returned
4531 		 * back separately.
4532 		 */
4533 		if (isp_control(isp, ISPCTL_ABORT_CMD, xs) == 0) {
4534 			return;
4535 		}
4536 
4537 		/*
4538 		 * Note that after calling the above, the command may in
4539 		 * fact have been completed.
4540 		 */
4541 		xs = isp_find_xs(isp, handle);
4542 
4543 		/*
4544 		 * If the command no longer exists, then we won't
4545 		 * be able to find the xs again with this handle.
4546 		 */
4547 		if (xs == NULL) {
4548 			return;
4549 		}
4550 
4551 		/*
4552 		 * After this point, the command is really dead.
4553 		 */
4554 		if (XS_XFRLEN(xs)) {
4555 			ISP_DMAFREE(isp, xs, handle);
4556 		}
4557 		isp_destroy_handle(isp, handle);
4558 		isp_prt(isp, ISP_LOGERR, "%s: timeout for handle 0x%x", __func__, handle);
4559 		xs->ccb_h.status &= ~CAM_STATUS_MASK;
4560 		xs->ccb_h.status |= CAM_CMD_TIMEOUT;
4561 		isp_prt_endcmd(isp, xs);
4562 		isp_done(xs);
4563 	} else {
4564 		if (ohandle != ISP_HANDLE_FREE) {
4565 			isp_prt(isp, ISP_LOGWARN, "%s: timeout for handle 0x%x, recovered during interrupt", __func__, ohandle);
4566 		} else {
4567 			isp_prt(isp, ISP_LOGWARN, "%s: timeout for handle already free", __func__);
4568 		}
4569 	}
4570 }
4571 
4572 static void
4573 isp_make_here(ispsoftc_t *isp, fcportdb_t *fcp, int chan, int tgt)
4574 {
4575 	union ccb *ccb;
4576 	struct isp_fc *fc = ISP_FC_PC(isp, chan);
4577 
4578 	if (isp_autoconfig == 0) {
4579 		return;
4580 	}
4581 
4582 	/*
4583 	 * Allocate a CCB, create a wildcard path for this target and schedule a rescan.
4584 	 */
4585 	ccb = xpt_alloc_ccb_nowait();
4586 	if (ccb == NULL) {
4587 		isp_prt(isp, ISP_LOGWARN, "Chan %d unable to alloc CCB for rescan", chan);
4588 		return;
4589 	}
4590 	if (xpt_create_path(&ccb->ccb_h.path, NULL, cam_sim_path(fc->sim),
4591 	    tgt, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
4592 		isp_prt(isp, ISP_LOGWARN, "unable to create path for rescan");
4593 		xpt_free_ccb(ccb);
4594 		return;
4595 	}
4596 	xpt_rescan(ccb);
4597 }
4598 
4599 static void
4600 isp_make_gone(ispsoftc_t *isp, fcportdb_t *fcp, int chan, int tgt)
4601 {
4602 	struct cam_path *tp;
4603 	struct isp_fc *fc = ISP_FC_PC(isp, chan);
4604 
4605 	if (isp_autoconfig == 0) {
4606 		return;
4607 	}
4608 	if (xpt_create_path(&tp, NULL, cam_sim_path(fc->sim), tgt, CAM_LUN_WILDCARD) == CAM_REQ_CMP) {
4609 		xpt_async(AC_LOST_DEVICE, tp, NULL);
4610 		xpt_free_path(tp);
4611 	}
4612 }
4613 
4614 /*
4615  * Gone Device Timer Function- when we have decided that a device has gone
4616  * away, we wait a specific period of time prior to telling the OS it has
4617  * gone away.
4618  *
4619  * This timer function fires once a second and then scans the port database
4620  * for devices that are marked dead but still have a virtual target assigned.
4621  * We decrement a counter for that port database entry, and when it hits zero,
4622  * we tell the OS the device has gone away.
4623  */
4624 static void
4625 isp_gdt(void *arg)
4626 {
4627 	struct isp_fc *fc = arg;
4628 	taskqueue_enqueue(taskqueue_thread, &fc->gtask);
4629 }
4630 
4631 static void
4632 isp_gdt_task(void *arg, int pending)
4633 {
4634 	struct isp_fc *fc = arg;
4635 	ispsoftc_t *isp = fc->isp;
4636 	int chan = fc - isp->isp_osinfo.pc.fc;
4637 	fcportdb_t *lp;
4638 	struct ac_contract ac;
4639 	struct ac_device_changed *adc;
4640 	int dbidx, more_to_do = 0;
4641 
4642 	ISP_LOCK(isp);
4643 	isp_prt(isp, ISP_LOGDEBUG0, "Chan %d GDT timer expired", chan);
4644 	for (dbidx = 0; dbidx < MAX_FC_TARG; dbidx++) {
4645 		lp = &FCPARAM(isp, chan)->portdb[dbidx];
4646 
4647 		if (lp->state != FC_PORTDB_STATE_ZOMBIE) {
4648 			continue;
4649 		}
4650 		if (lp->gone_timer != 0) {
4651 			lp->gone_timer -= 1;
4652 			more_to_do++;
4653 			continue;
4654 		}
4655 		isp_prt(isp, ISP_LOGCONFIG, prom3, chan, dbidx, lp->portid, "Gone Device Timeout");
4656 		if (lp->is_target) {
4657 			lp->is_target = 0;
4658 			isp_make_gone(isp, lp, chan, dbidx);
4659 		}
4660 		if (lp->is_initiator) {
4661 			lp->is_initiator = 0;
4662 			ac.contract_number = AC_CONTRACT_DEV_CHG;
4663 			adc = (struct ac_device_changed *) ac.contract_data;
4664 			adc->wwpn = lp->port_wwn;
4665 			adc->port = lp->portid;
4666 			adc->target = dbidx;
4667 			adc->arrived = 0;
4668 			xpt_async(AC_CONTRACT, fc->path, &ac);
4669 		}
4670 		lp->state = FC_PORTDB_STATE_NIL;
4671 	}
4672 	if (fc->ready) {
4673 		if (more_to_do) {
4674 			callout_reset(&fc->gdt, hz, isp_gdt, fc);
4675 		} else {
4676 			callout_deactivate(&fc->gdt);
4677 			isp_prt(isp, ISP_LOG_SANCFG, "Chan %d Stopping Gone Device Timer @ %lu", chan, (unsigned long) time_uptime);
4678 		}
4679 	}
4680 	ISP_UNLOCK(isp);
4681 }
4682 
4683 /*
4684  * Loop Down Timer Function- when loop goes down, a timer is started and
4685  * and after it expires we come here and take all probational devices that
4686  * the OS knows about and the tell the OS that they've gone away.
4687  *
4688  * We don't clear the devices out of our port database because, when loop
4689  * come back up, we have to do some actual cleanup with the chip at that
4690  * point (implicit PLOGO, e.g., to get the chip's port database state right).
4691  */
4692 static void
4693 isp_ldt(void *arg)
4694 {
4695 	struct isp_fc *fc = arg;
4696 	taskqueue_enqueue(taskqueue_thread, &fc->ltask);
4697 }
4698 
4699 static void
4700 isp_ldt_task(void *arg, int pending)
4701 {
4702 	struct isp_fc *fc = arg;
4703 	ispsoftc_t *isp = fc->isp;
4704 	int chan = fc - isp->isp_osinfo.pc.fc;
4705 	fcportdb_t *lp;
4706 	struct ac_contract ac;
4707 	struct ac_device_changed *adc;
4708 	int dbidx, i;
4709 
4710 	ISP_LOCK(isp);
4711 	isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Loop Down Timer expired @ %lu", chan, (unsigned long) time_uptime);
4712 	callout_deactivate(&fc->ldt);
4713 
4714 	/*
4715 	 * Notify to the OS all targets who we now consider have departed.
4716 	 */
4717 	for (dbidx = 0; dbidx < MAX_FC_TARG; dbidx++) {
4718 		lp = &FCPARAM(isp, chan)->portdb[dbidx];
4719 
4720 		if (lp->state == FC_PORTDB_STATE_NIL)
4721 			continue;
4722 
4723 		/*
4724 		 * XXX: CLEAN UP AND COMPLETE ANY PENDING COMMANDS FIRST!
4725 		 */
4726 		for (i = 0; i < isp->isp_maxcmds; i++) {
4727 			struct ccb_scsiio *xs;
4728 
4729 			if (!ISP_VALID_HANDLE(isp, isp->isp_xflist[i].handle)) {
4730 				continue;
4731 			}
4732 			if ((xs = isp->isp_xflist[i].cmd) == NULL) {
4733 				continue;
4734                         }
4735 			if (dbidx != XS_TGT(xs)) {
4736 				continue;
4737 			}
4738 			isp_prt(isp, ISP_LOGWARN, "command handle 0x%x for %d.%d.%d orphaned by loop down timeout",
4739 			    isp->isp_xflist[i].handle, chan, XS_TGT(xs), XS_LUN(xs));
4740 		}
4741 
4742 		isp_prt(isp, ISP_LOGCONFIG, prom3, chan, dbidx, lp->portid, "Loop Down Timeout");
4743 		if (lp->is_target) {
4744 			lp->is_target = 0;
4745 			isp_make_gone(isp, lp, chan, dbidx);
4746 		}
4747 		if (lp->is_initiator) {
4748 			lp->is_initiator = 0;
4749 			ac.contract_number = AC_CONTRACT_DEV_CHG;
4750 			adc = (struct ac_device_changed *) ac.contract_data;
4751 			adc->wwpn = lp->port_wwn;
4752 			adc->port = lp->portid;
4753 			adc->target = dbidx;
4754 			adc->arrived = 0;
4755 			xpt_async(AC_CONTRACT, fc->path, &ac);
4756 		}
4757 	}
4758 
4759 	isp_unfreeze_loopdown(isp, chan);
4760 	/*
4761 	 * The loop down timer has expired. Wake up the kthread
4762 	 * to notice that fact (or make it false).
4763 	 */
4764 	fc->loop_dead = 1;
4765 	fc->loop_down_time = fc->loop_down_limit+1;
4766 	wakeup(fc);
4767 	ISP_UNLOCK(isp);
4768 }
4769 
4770 static void
4771 isp_kthread(void *arg)
4772 {
4773 	struct isp_fc *fc = arg;
4774 	ispsoftc_t *isp = fc->isp;
4775 	int chan = fc - isp->isp_osinfo.pc.fc;
4776 	int slp = 0;
4777 
4778 	mtx_lock(&isp->isp_osinfo.lock);
4779 
4780 	while (isp->isp_osinfo.is_exiting == 0) {
4781 		int lb, lim;
4782 
4783 		isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "%s: Chan %d checking FC state", __func__, chan);
4784 		lb = isp_fc_runstate(isp, chan, 250000);
4785 
4786 		/*
4787 		 * Our action is different based upon whether we're supporting
4788 		 * Initiator mode or not. If we are, we might freeze the simq
4789 		 * when loop is down and set all sorts of different delays to
4790 		 * check again.
4791 		 *
4792 		 * If not, we simply just wait for loop to come up.
4793 		 */
4794 		if (lb && (FCPARAM(isp, chan)->role & ISP_ROLE_INITIATOR)) {
4795 			/*
4796 			 * Increment loop down time by the last sleep interval
4797 			 */
4798 			fc->loop_down_time += slp;
4799 
4800 			if (lb < 0) {
4801 				isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "%s: Chan %d FC loop not up (down count %d)", __func__, chan, fc->loop_down_time);
4802 			} else {
4803 				isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "%s: Chan %d FC got to %d (down count %d)", __func__, chan, lb, fc->loop_down_time);
4804 			}
4805 
4806 			/*
4807 			 * If we've never seen loop up and we've waited longer
4808 			 * than quickboot time, or we've seen loop up but we've
4809 			 * waited longer than loop_down_limit, give up and go
4810 			 * to sleep until loop comes up.
4811 			 */
4812 			if (FCPARAM(isp, chan)->loop_seen_once == 0) {
4813 				lim = isp_quickboot_time;
4814 			} else {
4815 				lim = fc->loop_down_limit;
4816 			}
4817 			if (fc->loop_down_time >= lim) {
4818 				isp_freeze_loopdown(isp, chan, "loop limit hit");
4819 				slp = 0;
4820 			} else if (fc->loop_down_time < 10) {
4821 				slp = 1;
4822 			} else if (fc->loop_down_time < 30) {
4823 				slp = 5;
4824 			} else if (fc->loop_down_time < 60) {
4825 				slp = 10;
4826 			} else if (fc->loop_down_time < 120) {
4827 				slp = 20;
4828 			} else {
4829 				slp = 30;
4830 			}
4831 
4832 		} else if (lb) {
4833 			isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "%s: Chan %d FC Loop Down", __func__, chan);
4834 			fc->loop_down_time += slp;
4835 			if (fc->loop_down_time > 300)
4836 				slp = 0;
4837 			else
4838 				slp = 60;
4839 		} else {
4840 			isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "%s: Chan %d FC state OK", __func__, chan);
4841 			fc->loop_down_time = 0;
4842 			slp = 0;
4843 		}
4844 
4845 
4846 		/*
4847 		 * If this is past the first loop up or the loop is dead and if we'd frozen the simq, unfreeze it
4848 		 * now so that CAM can start sending us commands.
4849 		 *
4850 		 * If the FC state isn't okay yet, they'll hit that in isp_start which will freeze the queue again
4851 		 * or kill the commands, as appropriate.
4852 		 */
4853 
4854 		if (FCPARAM(isp, chan)->loop_seen_once || fc->loop_dead) {
4855 			isp_unfreeze_loopdown(isp, chan);
4856 		}
4857 
4858 		isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "%s: Chan %d sleep time %d", __func__, chan, slp);
4859 
4860 		msleep(fc, &isp->isp_osinfo.lock, PRIBIO, "ispf", slp * hz);
4861 
4862 		/*
4863 		 * If slp is zero, we're waking up for the first time after
4864 		 * things have been okay. In this case, we set a deferral state
4865 		 * for all commands and delay hysteresis seconds before starting
4866 		 * the FC state evaluation. This gives the loop/fabric a chance
4867 		 * to settle.
4868 		 */
4869 		if (slp == 0 && fc->hysteresis) {
4870 			isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "%s: Chan %d sleep hysteresis ticks %d", __func__, chan, fc->hysteresis * hz);
4871 			mtx_unlock(&isp->isp_osinfo.lock);
4872 			pause("ispt", fc->hysteresis * hz);
4873 			mtx_lock(&isp->isp_osinfo.lock);
4874 		}
4875 	}
4876 	fc->num_threads -= 1;
4877 	mtx_unlock(&isp->isp_osinfo.lock);
4878 	kthread_exit();
4879 }
4880 
4881 static void
4882 isp_action(struct cam_sim *sim, union ccb *ccb)
4883 {
4884 	int bus, tgt, ts, error, lim;
4885 	ispsoftc_t *isp;
4886 	struct ccb_trans_settings *cts;
4887 
4888 	CAM_DEBUG(ccb->ccb_h.path, CAM_DEBUG_TRACE, ("isp_action\n"));
4889 
4890 	isp = (ispsoftc_t *)cam_sim_softc(sim);
4891 	mtx_assert(&isp->isp_lock, MA_OWNED);
4892 	isp_prt(isp, ISP_LOGDEBUG2, "isp_action code %x", ccb->ccb_h.func_code);
4893 	ISP_PCMD(ccb) = NULL;
4894 
4895 	if (isp->isp_state != ISP_RUNSTATE && ccb->ccb_h.func_code == XPT_SCSI_IO) {
4896 		isp_init(isp);
4897 		if (isp->isp_state != ISP_INITSTATE) {
4898 			/*
4899 			 * Lie. Say it was a selection timeout.
4900 			 */
4901 			ccb->ccb_h.status = CAM_SEL_TIMEOUT;
4902 			isp_done((struct ccb_scsiio *) ccb);
4903 			return;
4904 		}
4905 		isp->isp_state = ISP_RUNSTATE;
4906 	}
4907 
4908 	switch (ccb->ccb_h.func_code) {
4909 	case XPT_SCSI_IO:	/* Execute the requested I/O operation */
4910 		bus = XS_CHANNEL(ccb);
4911 		/*
4912 		 * Do a couple of preliminary checks...
4913 		 */
4914 		if ((ccb->ccb_h.flags & CAM_CDB_POINTER) != 0) {
4915 			if ((ccb->ccb_h.flags & CAM_CDB_PHYS) != 0) {
4916 				ccb->ccb_h.status = CAM_REQ_INVALID;
4917 				isp_done((struct ccb_scsiio *) ccb);
4918 				break;
4919 			}
4920 		}
4921 		ccb->csio.req_map = NULL;
4922 #ifdef	DIAGNOSTIC
4923 		if (ccb->ccb_h.target_id > (ISP_MAX_TARGETS(isp) - 1)) {
4924 			xpt_print(ccb->ccb_h.path, "invalid target\n");
4925 			ccb->ccb_h.status = CAM_PATH_INVALID;
4926 		} else if (ccb->ccb_h.target_lun > (ISP_MAX_LUNS(isp) - 1)) {
4927 			xpt_print(ccb->ccb_h.path, "invalid lun\n");
4928 			ccb->ccb_h.status = CAM_PATH_INVALID;
4929 		}
4930 		if (ccb->ccb_h.status == CAM_PATH_INVALID) {
4931 			xpt_done(ccb);
4932 			break;
4933 		}
4934 #endif
4935 		ccb->csio.scsi_status = SCSI_STATUS_OK;
4936 		if (isp_get_pcmd(isp, ccb)) {
4937 			isp_prt(isp, ISP_LOGWARN, "out of PCMDs");
4938 			cam_freeze_devq(ccb->ccb_h.path);
4939 			cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 250, 0);
4940 			ccb->ccb_h.status = CAM_REQUEUE_REQ;
4941 			xpt_done(ccb);
4942 			break;
4943 		}
4944 		error = isp_start((XS_T *) ccb);
4945 		switch (error) {
4946 		case CMD_QUEUED:
4947 			ccb->ccb_h.status |= CAM_SIM_QUEUED;
4948 			if (ccb->ccb_h.timeout == CAM_TIME_INFINITY) {
4949 				break;
4950 			}
4951 			ts = ccb->ccb_h.timeout;
4952 			if (ts == CAM_TIME_DEFAULT) {
4953 				ts = 60*1000;
4954 			}
4955 			ts = isp_mstohz(ts);
4956 			callout_reset(&PISP_PCMD(ccb)->wdog, ts, isp_watchdog, ccb);
4957 			break;
4958 		case CMD_RQLATER:
4959 			/*
4960 			 * We get this result for FC devices if the loop state isn't ready yet
4961 			 * or if the device in question has gone zombie on us.
4962 			 *
4963 			 * If we've never seen Loop UP at all, we requeue this request and wait
4964 			 * for the initial loop up delay to expire.
4965 			 */
4966 			lim = ISP_FC_PC(isp, bus)->loop_down_limit;
4967 			if (FCPARAM(isp, bus)->loop_seen_once == 0 || ISP_FC_PC(isp, bus)->loop_down_time >= lim) {
4968 				if (FCPARAM(isp, bus)->loop_seen_once == 0) {
4969 					isp_prt(isp, ISP_LOGDEBUG0, "%d.%d loop not seen yet @ %lu", XS_TGT(ccb), XS_LUN(ccb), (unsigned long) time_uptime);
4970 				} else {
4971 					isp_prt(isp, ISP_LOGDEBUG0, "%d.%d downtime (%d) > lim (%d)", XS_TGT(ccb), XS_LUN(ccb), ISP_FC_PC(isp, bus)->loop_down_time, lim);
4972 				}
4973 				ccb->ccb_h.status = CAM_SEL_TIMEOUT;
4974 				isp_done((struct ccb_scsiio *) ccb);
4975 				break;
4976 			}
4977 			isp_prt(isp, ISP_LOGDEBUG0, "%d.%d retry later", XS_TGT(ccb), XS_LUN(ccb));
4978 			cam_freeze_devq(ccb->ccb_h.path);
4979 			cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 1000, 0);
4980 			ccb->ccb_h.status = CAM_REQUEUE_REQ;
4981 			isp_free_pcmd(isp, ccb);
4982 			xpt_done(ccb);
4983 			break;
4984 		case CMD_EAGAIN:
4985 			isp_free_pcmd(isp, ccb);
4986 			cam_freeze_devq(ccb->ccb_h.path);
4987 			cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 100, 0);
4988 			ccb->ccb_h.status = CAM_REQUEUE_REQ;
4989 			xpt_done(ccb);
4990 			break;
4991 		case CMD_COMPLETE:
4992 			isp_done((struct ccb_scsiio *) ccb);
4993 			break;
4994 		default:
4995 			isp_prt(isp, ISP_LOGERR, "What's this? 0x%x at %d in file %s", error, __LINE__, __FILE__);
4996 			ccb->ccb_h.status = CAM_REQUEUE_REQ;
4997 			isp_free_pcmd(isp, ccb);
4998 			xpt_done(ccb);
4999 		}
5000 		break;
5001 
5002 #ifdef	ISP_TARGET_MODE
5003 	case XPT_EN_LUN:		/* Enable/Disable LUN as a target */
5004 		if (ccb->cel.enable) {
5005 			isp_enable_lun(isp, ccb);
5006 		} else {
5007 			isp_disable_lun(isp, ccb);
5008 		}
5009 		break;
5010 	case XPT_IMMED_NOTIFY:
5011 	case XPT_IMMEDIATE_NOTIFY:	/* Add Immediate Notify Resource */
5012 	case XPT_ACCEPT_TARGET_IO:	/* Add Accept Target IO Resource */
5013 	{
5014 		tstate_t *tptr = get_lun_statep(isp, XS_CHANNEL(ccb), ccb->ccb_h.target_lun);
5015 		if (tptr == NULL) {
5016 			tptr = get_lun_statep(isp, XS_CHANNEL(ccb), CAM_LUN_WILDCARD);
5017 		}
5018 		if (tptr == NULL) {
5019 			const char *str;
5020 			uint32_t tag;
5021 
5022 			if (ccb->ccb_h.func_code == XPT_IMMEDIATE_NOTIFY) {
5023 				str = "XPT_IMMEDIATE_NOTIFY";
5024 				tag = ccb->cin1.seq_id;
5025 			} else {
5026 				tag = ccb->atio.tag_id;
5027 				str = "XPT_ACCEPT_TARGET_IO";
5028 			}
5029 			ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "%s: [0x%x] no state pointer found for %s\n", __func__, tag, str);
5030 			dump_tstates(isp, XS_CHANNEL(ccb));
5031 			ccb->ccb_h.status = CAM_DEV_NOT_THERE;
5032 			break;
5033 		}
5034 		ccb->ccb_h.spriv_field0 = 0;
5035 		ccb->ccb_h.spriv_ptr1 = isp;
5036 
5037 		if (ccb->ccb_h.func_code == XPT_ACCEPT_TARGET_IO) {
5038 			if (ccb->atio.tag_id) {
5039 				atio_private_data_t *atp = isp_find_atpd(isp, tptr, ccb->atio.tag_id);
5040 				if (atp) {
5041 					isp_put_atpd(isp, tptr, atp);
5042 				}
5043 			}
5044 			tptr->atio_count++;
5045 			SLIST_INSERT_HEAD(&tptr->atios, &ccb->ccb_h, sim_links.sle);
5046 			ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, ccb->ccb_h.path, "Put FREE ATIO (tag id 0x%x), count now %d\n",
5047 			    ccb->atio.tag_id, tptr->atio_count);
5048 			ccb->atio.tag_id = 0;
5049 		} else if (ccb->ccb_h.func_code == XPT_IMMEDIATE_NOTIFY) {
5050 			if (ccb->cin1.tag_id) {
5051 				inot_private_data_t *ntp = isp_find_ntpd(isp, tptr, ccb->cin1.tag_id, ccb->cin1.seq_id);
5052 				if (ntp) {
5053 					isp_put_ntpd(isp, tptr, ntp);
5054 				}
5055 			}
5056 			tptr->inot_count++;
5057 			SLIST_INSERT_HEAD(&tptr->inots, &ccb->ccb_h, sim_links.sle);
5058 			ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, ccb->ccb_h.path, "Put FREE INOT, (seq id 0x%x) count now %d\n",
5059 			    ccb->cin1.seq_id, tptr->inot_count);
5060 			ccb->cin1.seq_id = 0;
5061 		} else if (ccb->ccb_h.func_code == XPT_IMMED_NOTIFY) {
5062 			tptr->inot_count++;
5063 			SLIST_INSERT_HEAD(&tptr->inots, &ccb->ccb_h, sim_links.sle);
5064 			ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, ccb->ccb_h.path, "Put FREE INOT, (seq id 0x%x) count now %d\n",
5065 			    ccb->cin1.seq_id, tptr->inot_count);
5066 			ccb->cin1.seq_id = 0;
5067 		}
5068 		rls_lun_statep(isp, tptr);
5069 		ccb->ccb_h.status = CAM_REQ_INPROG;
5070 		break;
5071 	}
5072 	case XPT_NOTIFY_ACK:
5073 		ccb->ccb_h.status = CAM_REQ_CMP_ERR;
5074 		break;
5075 	case XPT_NOTIFY_ACKNOWLEDGE:		/* notify ack */
5076 	{
5077 		tstate_t *tptr;
5078 		inot_private_data_t *ntp;
5079 
5080 		/*
5081 		 * XXX: Because we cannot guarantee that the path information in the notify acknowledge ccb
5082 		 * XXX: matches that for the immediate notify, we have to *search* for the notify structure
5083 		 */
5084 		/*
5085 		 * All the relevant path information is in the associated immediate notify
5086 		 */
5087 		ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: [0x%x] NOTIFY ACKNOWLEDGE for 0x%x seen\n", __func__, ccb->cna2.tag_id, ccb->cna2.seq_id);
5088 		ntp = get_ntp_from_tagdata(isp, ccb->cna2.tag_id, ccb->cna2.seq_id, &tptr);
5089 		if (ntp == NULL) {
5090 			ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "%s: [0x%x] XPT_NOTIFY_ACKNOWLEDGE of 0x%x cannot find ntp private data\n", __func__,
5091 			     ccb->cna2.tag_id, ccb->cna2.seq_id);
5092 			ccb->ccb_h.status = CAM_DEV_NOT_THERE;
5093 			xpt_done(ccb);
5094 			break;
5095 		}
5096 		if (isp_handle_platform_target_notify_ack(isp, &ntp->rd.nt)) {
5097 			rls_lun_statep(isp, tptr);
5098 			cam_freeze_devq(ccb->ccb_h.path);
5099 			cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 1000, 0);
5100 			ccb->ccb_h.status &= ~CAM_STATUS_MASK;
5101 			ccb->ccb_h.status |= CAM_REQUEUE_REQ;
5102 			break;
5103 		}
5104 		isp_put_ntpd(isp, tptr, ntp);
5105 		rls_lun_statep(isp, tptr);
5106 		ccb->ccb_h.status = CAM_REQ_CMP;
5107 		ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: [0x%x] calling xpt_done for tag 0x%x\n", __func__, ccb->cna2.tag_id, ccb->cna2.seq_id);
5108 		xpt_done(ccb);
5109 		break;
5110 	}
5111 	case XPT_CONT_TARGET_IO:
5112 		isp_target_start_ctio(isp, ccb, FROM_CAM);
5113 		break;
5114 #endif
5115 	case XPT_RESET_DEV:		/* BDR the specified SCSI device */
5116 	{
5117 		struct isp_fc *fc;
5118 
5119 		bus = cam_sim_bus(xpt_path_sim(ccb->ccb_h.path));
5120 		tgt = ccb->ccb_h.target_id;
5121 		tgt |= (bus << 16);
5122 		if (IS_FC(isp))
5123 			fc = ISP_FC_PC(isp, bus);
5124 		else
5125 			fc = NULL;
5126 
5127 		error = isp_control(isp, ISPCTL_RESET_DEV, bus, tgt);
5128 		if (error) {
5129 			ccb->ccb_h.status = CAM_REQ_CMP_ERR;
5130 		} else {
5131 			/*
5132 			 * If we have a FC device, reset the Command
5133 			 * Reference Number, because the target will expect
5134 			 * that we re-start the CRN at 1 after a reset.
5135 			 */
5136 			if (fc != NULL)
5137 				isp_fcp_reset_crn(fc, tgt, /*tgt_set*/ 1);
5138 
5139 			ccb->ccb_h.status = CAM_REQ_CMP;
5140 		}
5141 		xpt_done(ccb);
5142 		break;
5143 	}
5144 	case XPT_ABORT:			/* Abort the specified CCB */
5145 	{
5146 		union ccb *accb = ccb->cab.abort_ccb;
5147 		switch (accb->ccb_h.func_code) {
5148 #ifdef	ISP_TARGET_MODE
5149 		case XPT_ACCEPT_TARGET_IO:
5150 			isp_target_mark_aborted(isp, ccb);
5151 			break;
5152 #endif
5153 		case XPT_SCSI_IO:
5154 			error = isp_control(isp, ISPCTL_ABORT_CMD, accb);
5155 			if (error) {
5156 				ccb->ccb_h.status = CAM_UA_ABORT;
5157 			} else {
5158 				ccb->ccb_h.status = CAM_REQ_CMP;
5159 			}
5160 			break;
5161 		default:
5162 			ccb->ccb_h.status = CAM_REQ_INVALID;
5163 			break;
5164 		}
5165 		/*
5166 		 * This is not a queued CCB, so the caller expects it to be
5167 		 * complete when control is returned.
5168 		 */
5169 		break;
5170 	}
5171 #define	IS_CURRENT_SETTINGS(c)	(c->type == CTS_TYPE_CURRENT_SETTINGS)
5172 	case XPT_SET_TRAN_SETTINGS:	/* Nexus Settings */
5173 		cts = &ccb->cts;
5174 		if (!IS_CURRENT_SETTINGS(cts)) {
5175 			ccb->ccb_h.status = CAM_REQ_INVALID;
5176 			xpt_done(ccb);
5177 			break;
5178 		}
5179 		tgt = cts->ccb_h.target_id;
5180 		bus = cam_sim_bus(xpt_path_sim(cts->ccb_h.path));
5181 		if (IS_SCSI(isp)) {
5182 			struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
5183 			struct ccb_trans_settings_spi *spi = &cts->xport_specific.spi;
5184 			sdparam *sdp = SDPARAM(isp, bus);
5185 			uint16_t *dptr;
5186 
5187 			if (spi->valid == 0 && scsi->valid == 0) {
5188 				ccb->ccb_h.status = CAM_REQ_CMP;
5189 				xpt_done(ccb);
5190 				break;
5191 			}
5192 
5193 			/*
5194 			 * We always update (internally) from goal_flags
5195 			 * so any request to change settings just gets
5196 			 * vectored to that location.
5197 			 */
5198 			dptr = &sdp->isp_devparam[tgt].goal_flags;
5199 
5200 			if ((spi->valid & CTS_SPI_VALID_DISC) != 0) {
5201 				if ((spi->flags & CTS_SPI_FLAGS_DISC_ENB) != 0)
5202 					*dptr |= DPARM_DISC;
5203 				else
5204 					*dptr &= ~DPARM_DISC;
5205 			}
5206 
5207 			if ((scsi->valid & CTS_SCSI_VALID_TQ) != 0) {
5208 				if ((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0)
5209 					*dptr |= DPARM_TQING;
5210 				else
5211 					*dptr &= ~DPARM_TQING;
5212 			}
5213 
5214 			if ((spi->valid & CTS_SPI_VALID_BUS_WIDTH) != 0) {
5215 				if (spi->bus_width == MSG_EXT_WDTR_BUS_16_BIT)
5216 					*dptr |= DPARM_WIDE;
5217 				else
5218 					*dptr &= ~DPARM_WIDE;
5219 			}
5220 
5221 			/*
5222 			 * XXX: FIX ME
5223 			 */
5224 			if ((spi->valid & CTS_SPI_VALID_SYNC_OFFSET) && (spi->valid & CTS_SPI_VALID_SYNC_RATE) && (spi->sync_period && spi->sync_offset)) {
5225 				*dptr |= DPARM_SYNC;
5226 				/*
5227 				 * XXX: CHECK FOR LEGALITY
5228 				 */
5229 				sdp->isp_devparam[tgt].goal_period = spi->sync_period;
5230 				sdp->isp_devparam[tgt].goal_offset = spi->sync_offset;
5231 			} else {
5232 				*dptr &= ~DPARM_SYNC;
5233 			}
5234 			isp_prt(isp, ISP_LOGDEBUG0, "SET (%d.%d.%jx) to flags %x off %x per %x", bus, tgt, (uintmax_t)cts->ccb_h.target_lun, sdp->isp_devparam[tgt].goal_flags,
5235 			    sdp->isp_devparam[tgt].goal_offset, sdp->isp_devparam[tgt].goal_period);
5236 			sdp->isp_devparam[tgt].dev_update = 1;
5237 			sdp->update = 1;
5238 		}
5239 		ccb->ccb_h.status = CAM_REQ_CMP;
5240 		xpt_done(ccb);
5241 		break;
5242 	case XPT_GET_TRAN_SETTINGS:
5243 		cts = &ccb->cts;
5244 		tgt = cts->ccb_h.target_id;
5245 		bus = cam_sim_bus(xpt_path_sim(cts->ccb_h.path));
5246 		if (IS_FC(isp)) {
5247 			fcparam *fcp = FCPARAM(isp, bus);
5248 			struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
5249 			struct ccb_trans_settings_fc *fc = &cts->xport_specific.fc;
5250 
5251 			cts->protocol = PROTO_SCSI;
5252 			cts->protocol_version = SCSI_REV_2;
5253 			cts->transport = XPORT_FC;
5254 			cts->transport_version = 0;
5255 
5256 			scsi->valid = CTS_SCSI_VALID_TQ;
5257 			scsi->flags = CTS_SCSI_FLAGS_TAG_ENB;
5258 			fc->valid = CTS_FC_VALID_SPEED;
5259 			fc->bitrate = 100000;
5260 			fc->bitrate *= fcp->isp_gbspeed;
5261 			if (tgt < MAX_FC_TARG) {
5262 				fcportdb_t *lp = &fcp->portdb[tgt];
5263 				fc->wwnn = lp->node_wwn;
5264 				fc->wwpn = lp->port_wwn;
5265 				fc->port = lp->portid;
5266 				fc->valid |= CTS_FC_VALID_WWNN | CTS_FC_VALID_WWPN | CTS_FC_VALID_PORT;
5267 			}
5268 		} else {
5269 			struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
5270 			struct ccb_trans_settings_spi *spi = &cts->xport_specific.spi;
5271 			sdparam *sdp = SDPARAM(isp, bus);
5272 			uint16_t dval, pval, oval;
5273 
5274 			if (IS_CURRENT_SETTINGS(cts)) {
5275 				sdp->isp_devparam[tgt].dev_refresh = 1;
5276 				sdp->update = 1;
5277 				(void) isp_control(isp, ISPCTL_UPDATE_PARAMS, bus);
5278 				dval = sdp->isp_devparam[tgt].actv_flags;
5279 				oval = sdp->isp_devparam[tgt].actv_offset;
5280 				pval = sdp->isp_devparam[tgt].actv_period;
5281 			} else {
5282 				dval = sdp->isp_devparam[tgt].nvrm_flags;
5283 				oval = sdp->isp_devparam[tgt].nvrm_offset;
5284 				pval = sdp->isp_devparam[tgt].nvrm_period;
5285 			}
5286 
5287 			cts->protocol = PROTO_SCSI;
5288 			cts->protocol_version = SCSI_REV_2;
5289 			cts->transport = XPORT_SPI;
5290 			cts->transport_version = 2;
5291 
5292 			spi->valid = 0;
5293 			scsi->valid = 0;
5294 			spi->flags = 0;
5295 			scsi->flags = 0;
5296 			if (dval & DPARM_DISC) {
5297 				spi->flags |= CTS_SPI_FLAGS_DISC_ENB;
5298 			}
5299 			if ((dval & DPARM_SYNC) && oval && pval) {
5300 				spi->sync_offset = oval;
5301 				spi->sync_period = pval;
5302 			} else {
5303 				spi->sync_offset = 0;
5304 				spi->sync_period = 0;
5305 			}
5306 			spi->valid |= CTS_SPI_VALID_SYNC_OFFSET;
5307 			spi->valid |= CTS_SPI_VALID_SYNC_RATE;
5308 			spi->valid |= CTS_SPI_VALID_BUS_WIDTH;
5309 			if (dval & DPARM_WIDE) {
5310 				spi->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
5311 			} else {
5312 				spi->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
5313 			}
5314 			if (cts->ccb_h.target_lun != CAM_LUN_WILDCARD) {
5315 				scsi->valid = CTS_SCSI_VALID_TQ;
5316 				if (dval & DPARM_TQING) {
5317 					scsi->flags |= CTS_SCSI_FLAGS_TAG_ENB;
5318 				}
5319 				spi->valid |= CTS_SPI_VALID_DISC;
5320 			}
5321 			isp_prt(isp, ISP_LOGDEBUG0, "GET %s (%d.%d.%jx) to flags %x off %x per %x", IS_CURRENT_SETTINGS(cts)? "ACTIVE" : "NVRAM",
5322 			    bus, tgt, (uintmax_t)cts->ccb_h.target_lun, dval, oval, pval);
5323 		}
5324 		ccb->ccb_h.status = CAM_REQ_CMP;
5325 		xpt_done(ccb);
5326 		break;
5327 
5328 	case XPT_CALC_GEOMETRY:
5329 		cam_calc_geometry(&ccb->ccg, 1);
5330 		xpt_done(ccb);
5331 		break;
5332 
5333 	case XPT_RESET_BUS:		/* Reset the specified bus */
5334 		bus = cam_sim_bus(sim);
5335 		error = isp_control(isp, ISPCTL_RESET_BUS, bus);
5336 		if (error) {
5337 			ccb->ccb_h.status = CAM_REQ_CMP_ERR;
5338 			xpt_done(ccb);
5339 			break;
5340 		}
5341 		if (bootverbose) {
5342 			xpt_print(ccb->ccb_h.path, "reset bus on channel %d\n", bus);
5343 		}
5344 		if (IS_FC(isp)) {
5345 			xpt_async(AC_BUS_RESET, ISP_FC_PC(isp, bus)->path, 0);
5346 		} else {
5347 			xpt_async(AC_BUS_RESET, ISP_SPI_PC(isp, bus)->path, 0);
5348 		}
5349 		ccb->ccb_h.status = CAM_REQ_CMP;
5350 		xpt_done(ccb);
5351 		break;
5352 
5353 	case XPT_TERM_IO:		/* Terminate the I/O process */
5354 		ccb->ccb_h.status = CAM_REQ_INVALID;
5355 		xpt_done(ccb);
5356 		break;
5357 
5358 	case XPT_SET_SIM_KNOB:		/* Set SIM knobs */
5359 	{
5360 		struct ccb_sim_knob *kp = &ccb->knob;
5361 		fcparam *fcp;
5362 
5363 		if (!IS_FC(isp)) {
5364 			ccb->ccb_h.status = CAM_REQ_INVALID;
5365 			xpt_done(ccb);
5366 			break;
5367 		}
5368 
5369 		bus = cam_sim_bus(xpt_path_sim(kp->ccb_h.path));
5370 		fcp = FCPARAM(isp, bus);
5371 
5372 		if (kp->xport_specific.fc.valid & KNOB_VALID_ADDRESS) {
5373 			fcp->isp_wwnn = ISP_FC_PC(isp, bus)->def_wwnn = kp->xport_specific.fc.wwnn;
5374 			fcp->isp_wwpn = ISP_FC_PC(isp, bus)->def_wwpn = kp->xport_specific.fc.wwpn;
5375 			isp_prt(isp, ISP_LOGALL, "Setting Channel %d wwns to 0x%jx 0x%jx", bus, fcp->isp_wwnn, fcp->isp_wwpn);
5376 		}
5377 		ccb->ccb_h.status = CAM_REQ_CMP;
5378 		if (kp->xport_specific.fc.valid & KNOB_VALID_ROLE) {
5379 			int rchange = 0;
5380 			int newrole = 0;
5381 
5382 			switch (kp->xport_specific.fc.role) {
5383 			case KNOB_ROLE_NONE:
5384 				if (fcp->role != ISP_ROLE_NONE) {
5385 					rchange = 1;
5386 					newrole = ISP_ROLE_NONE;
5387 				}
5388 				break;
5389 			case KNOB_ROLE_TARGET:
5390 				if (fcp->role != ISP_ROLE_TARGET) {
5391 					rchange = 1;
5392 					newrole = ISP_ROLE_TARGET;
5393 				}
5394 				break;
5395 			case KNOB_ROLE_INITIATOR:
5396 				if (fcp->role != ISP_ROLE_INITIATOR) {
5397 					rchange = 1;
5398 					newrole = ISP_ROLE_INITIATOR;
5399 				}
5400 				break;
5401 			case KNOB_ROLE_BOTH:
5402 				if (fcp->role != ISP_ROLE_BOTH) {
5403 					rchange = 1;
5404 					newrole = ISP_ROLE_BOTH;
5405 				}
5406 				break;
5407 			}
5408 			if (rchange) {
5409 				ISP_PATH_PRT(isp, ISP_LOGCONFIG, ccb->ccb_h.path, "changing role on from %d to %d\n", fcp->role, newrole);
5410 #ifdef	ISP_TARGET_MODE
5411 				ISP_SET_PC(isp, bus, tm_enabled, 0);
5412 				ISP_SET_PC(isp, bus, tm_luns_enabled, 0);
5413 #endif
5414 				if (isp_control(isp, ISPCTL_CHANGE_ROLE,
5415 				    bus, newrole) != 0) {
5416 					ccb->ccb_h.status = CAM_REQ_CMP_ERR;
5417 					xpt_done(ccb);
5418 					break;
5419 				}
5420 #ifdef	ISP_TARGET_MODE
5421 				if (newrole == ISP_ROLE_TARGET || newrole == ISP_ROLE_BOTH) {
5422 					/*
5423 					 * Give the new role a chance to complain and settle
5424 					 */
5425 					msleep(isp, &isp->isp_lock, PRIBIO, "taking a breather", 2);
5426 					ccb->ccb_h.status = isp_enable_deferred_luns(isp, bus);
5427 				}
5428 #endif
5429 			}
5430 		}
5431 		xpt_done(ccb);
5432 		break;
5433 	}
5434 	case XPT_GET_SIM_KNOB:		/* Get SIM knobs */
5435 	{
5436 		struct ccb_sim_knob *kp = &ccb->knob;
5437 
5438 		if (IS_FC(isp)) {
5439 			fcparam *fcp;
5440 
5441 			bus = cam_sim_bus(xpt_path_sim(kp->ccb_h.path));
5442 			fcp = FCPARAM(isp, bus);
5443 
5444 			kp->xport_specific.fc.wwnn = fcp->isp_wwnn;
5445 			kp->xport_specific.fc.wwpn = fcp->isp_wwpn;
5446 			switch (fcp->role) {
5447 			case ISP_ROLE_NONE:
5448 				kp->xport_specific.fc.role = KNOB_ROLE_NONE;
5449 				break;
5450 			case ISP_ROLE_TARGET:
5451 				kp->xport_specific.fc.role = KNOB_ROLE_TARGET;
5452 				break;
5453 			case ISP_ROLE_INITIATOR:
5454 				kp->xport_specific.fc.role = KNOB_ROLE_INITIATOR;
5455 				break;
5456 			case ISP_ROLE_BOTH:
5457 				kp->xport_specific.fc.role = KNOB_ROLE_BOTH;
5458 				break;
5459 			}
5460 			kp->xport_specific.fc.valid = KNOB_VALID_ADDRESS | KNOB_VALID_ROLE;
5461 			ccb->ccb_h.status = CAM_REQ_CMP;
5462 		} else {
5463 			ccb->ccb_h.status = CAM_REQ_INVALID;
5464 		}
5465 		xpt_done(ccb);
5466 		break;
5467 	}
5468 	case XPT_PATH_INQ:		/* Path routing inquiry */
5469 	{
5470 		struct ccb_pathinq *cpi = &ccb->cpi;
5471 
5472 		cpi->version_num = 1;
5473 #ifdef	ISP_TARGET_MODE
5474 		cpi->target_sprt = PIT_PROCESSOR | PIT_DISCONNECT | PIT_TERM_IO;
5475 #else
5476 		cpi->target_sprt = 0;
5477 #endif
5478 		cpi->hba_eng_cnt = 0;
5479 		cpi->max_target = ISP_MAX_TARGETS(isp) - 1;
5480 		cpi->max_lun = ISP_MAX_LUNS(isp) - 1;
5481 		cpi->bus_id = cam_sim_bus(sim);
5482 		if (isp->isp_osinfo.sixtyfourbit)
5483 			cpi->maxio = (ISP_NSEG64_MAX - 1) * PAGE_SIZE;
5484 		else
5485 			cpi->maxio = (ISP_NSEG_MAX - 1) * PAGE_SIZE;
5486 
5487 		bus = cam_sim_bus(xpt_path_sim(cpi->ccb_h.path));
5488 		if (IS_FC(isp)) {
5489 			fcparam *fcp = FCPARAM(isp, bus);
5490 
5491 			cpi->hba_misc = PIM_NOBUSRESET | PIM_UNMAPPED;
5492 
5493 			/*
5494 			 * Because our loop ID can shift from time to time,
5495 			 * make our initiator ID out of range of our bus.
5496 			 */
5497 			cpi->initiator_id = cpi->max_target + 1;
5498 
5499 			/*
5500 			 * Set base transfer capabilities for Fibre Channel, for this HBA.
5501 			 */
5502 			if (IS_25XX(isp)) {
5503 				cpi->base_transfer_speed = 8000000;
5504 			} else if (IS_24XX(isp)) {
5505 				cpi->base_transfer_speed = 4000000;
5506 			} else if (IS_23XX(isp)) {
5507 				cpi->base_transfer_speed = 2000000;
5508 			} else {
5509 				cpi->base_transfer_speed = 1000000;
5510 			}
5511 			cpi->hba_inquiry = PI_TAG_ABLE;
5512 			cpi->transport = XPORT_FC;
5513 			cpi->transport_version = 0;
5514 			cpi->xport_specific.fc.wwnn = fcp->isp_wwnn;
5515 			cpi->xport_specific.fc.wwpn = fcp->isp_wwpn;
5516 			cpi->xport_specific.fc.port = fcp->isp_portid;
5517 			cpi->xport_specific.fc.bitrate = fcp->isp_gbspeed * 1000;
5518 		} else {
5519 			sdparam *sdp = SDPARAM(isp, bus);
5520 			cpi->hba_inquiry = PI_SDTR_ABLE|PI_TAG_ABLE|PI_WIDE_16;
5521 			cpi->hba_misc = PIM_UNMAPPED;
5522 			cpi->initiator_id = sdp->isp_initiator_id;
5523 			cpi->base_transfer_speed = 3300;
5524 			cpi->transport = XPORT_SPI;
5525 			cpi->transport_version = 2;
5526 		}
5527 		cpi->protocol = PROTO_SCSI;
5528 		cpi->protocol_version = SCSI_REV_2;
5529 		strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
5530 		strncpy(cpi->hba_vid, "Qlogic", HBA_IDLEN);
5531 		strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
5532 		cpi->unit_number = cam_sim_unit(sim);
5533 		cpi->ccb_h.status = CAM_REQ_CMP;
5534 		xpt_done(ccb);
5535 		break;
5536 	}
5537 	default:
5538 		ccb->ccb_h.status = CAM_REQ_INVALID;
5539 		xpt_done(ccb);
5540 		break;
5541 	}
5542 }
5543 
5544 #define	ISPDDB	(CAM_DEBUG_INFO|CAM_DEBUG_TRACE|CAM_DEBUG_CDB)
5545 
5546 void
5547 isp_done(XS_T *sccb)
5548 {
5549 	ispsoftc_t *isp = XS_ISP(sccb);
5550 	uint32_t status;
5551 
5552 	if (XS_NOERR(sccb))
5553 		XS_SETERR(sccb, CAM_REQ_CMP);
5554 
5555 	if ((sccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP && (sccb->scsi_status != SCSI_STATUS_OK)) {
5556 		sccb->ccb_h.status &= ~CAM_STATUS_MASK;
5557 		if ((sccb->scsi_status == SCSI_STATUS_CHECK_COND) && (sccb->ccb_h.status & CAM_AUTOSNS_VALID) == 0) {
5558 			sccb->ccb_h.status |= CAM_AUTOSENSE_FAIL;
5559 		} else {
5560 			sccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR;
5561 		}
5562 	}
5563 
5564 	sccb->ccb_h.status &= ~CAM_SIM_QUEUED;
5565 	status = sccb->ccb_h.status & CAM_STATUS_MASK;
5566 	if (status != CAM_REQ_CMP) {
5567 		if (status != CAM_SEL_TIMEOUT)
5568 			isp_prt(isp, ISP_LOGDEBUG0, "target %d lun %d CAM status 0x%x SCSI status 0x%x", XS_TGT(sccb), XS_LUN(sccb), sccb->ccb_h.status, sccb->scsi_status);
5569 		else if ((IS_FC(isp))
5570 		      && (XS_TGT(sccb) < MAX_FC_TARG)) {
5571 			fcparam *fcp;
5572 
5573 			fcp = FCPARAM(isp, XS_CHANNEL(sccb));
5574 			fcp->portdb[XS_TGT(sccb)].is_target = 0;
5575 		}
5576 		if ((sccb->ccb_h.status & CAM_DEV_QFRZN) == 0) {
5577 			sccb->ccb_h.status |= CAM_DEV_QFRZN;
5578 			xpt_freeze_devq(sccb->ccb_h.path, 1);
5579 		}
5580 	}
5581 
5582 	if ((CAM_DEBUGGED(sccb->ccb_h.path, ISPDDB)) && (sccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
5583 		xpt_print(sccb->ccb_h.path, "cam completion status 0x%x\n", sccb->ccb_h.status);
5584 	}
5585 
5586 	if (ISP_PCMD(sccb)) {
5587 		if (callout_active(&PISP_PCMD(sccb)->wdog))
5588 			callout_stop(&PISP_PCMD(sccb)->wdog);
5589 		isp_free_pcmd(isp, (union ccb *) sccb);
5590 	}
5591 	xpt_done((union ccb *) sccb);
5592 }
5593 
5594 void
5595 isp_async(ispsoftc_t *isp, ispasync_t cmd, ...)
5596 {
5597 	int bus;
5598 	static const char prom[] = "Chan %d [%d] WWPN 0x%16jx PortID 0x%06x handle 0x%x %s %s";
5599 	char buf[64];
5600 	char *msg = NULL;
5601 	target_id_t tgt;
5602 	fcportdb_t *lp;
5603 	struct isp_fc *fc;
5604 	struct cam_path *tmppath;
5605 	struct ac_contract ac;
5606 	struct ac_device_changed *adc;
5607 	va_list ap;
5608 
5609 	switch (cmd) {
5610 	case ISPASYNC_NEW_TGT_PARAMS:
5611 	{
5612 		struct ccb_trans_settings_scsi *scsi;
5613 		struct ccb_trans_settings_spi *spi;
5614 		int flags, tgt;
5615 		sdparam *sdp;
5616 		struct ccb_trans_settings cts;
5617 
5618 		memset(&cts, 0, sizeof (struct ccb_trans_settings));
5619 
5620 		va_start(ap, cmd);
5621 		bus = va_arg(ap, int);
5622 		tgt = va_arg(ap, int);
5623 		va_end(ap);
5624 		sdp = SDPARAM(isp, bus);
5625 
5626 		if (xpt_create_path(&tmppath, NULL, cam_sim_path(ISP_SPI_PC(isp, bus)->sim), tgt, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
5627 			isp_prt(isp, ISP_LOGWARN, "isp_async cannot make temp path for %d.%d", tgt, bus);
5628 			break;
5629 		}
5630 		flags = sdp->isp_devparam[tgt].actv_flags;
5631 		cts.type = CTS_TYPE_CURRENT_SETTINGS;
5632 		cts.protocol = PROTO_SCSI;
5633 		cts.transport = XPORT_SPI;
5634 
5635 		scsi = &cts.proto_specific.scsi;
5636 		spi = &cts.xport_specific.spi;
5637 
5638 		if (flags & DPARM_TQING) {
5639 			scsi->valid |= CTS_SCSI_VALID_TQ;
5640 			scsi->flags |= CTS_SCSI_FLAGS_TAG_ENB;
5641 		}
5642 
5643 		if (flags & DPARM_DISC) {
5644 			spi->valid |= CTS_SPI_VALID_DISC;
5645 			spi->flags |= CTS_SPI_FLAGS_DISC_ENB;
5646 		}
5647 		spi->flags |= CTS_SPI_VALID_BUS_WIDTH;
5648 		if (flags & DPARM_WIDE) {
5649 			spi->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
5650 		} else {
5651 			spi->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
5652 		}
5653 		if (flags & DPARM_SYNC) {
5654 			spi->valid |= CTS_SPI_VALID_SYNC_RATE;
5655 			spi->valid |= CTS_SPI_VALID_SYNC_OFFSET;
5656 			spi->sync_period = sdp->isp_devparam[tgt].actv_period;
5657 			spi->sync_offset = sdp->isp_devparam[tgt].actv_offset;
5658 		}
5659 		isp_prt(isp, ISP_LOGDEBUG2, "NEW_TGT_PARAMS bus %d tgt %d period %x offset %x flags %x", bus, tgt, sdp->isp_devparam[tgt].actv_period, sdp->isp_devparam[tgt].actv_offset, flags);
5660 		xpt_setup_ccb(&cts.ccb_h, tmppath, 1);
5661 		xpt_async(AC_TRANSFER_NEG, tmppath, &cts);
5662 		xpt_free_path(tmppath);
5663 		break;
5664 	}
5665 	case ISPASYNC_BUS_RESET:
5666 	{
5667 		va_start(ap, cmd);
5668 		bus = va_arg(ap, int);
5669 		va_end(ap);
5670 		isp_prt(isp, ISP_LOGINFO, "SCSI bus reset on bus %d detected", bus);
5671 		if (IS_FC(isp)) {
5672 			xpt_async(AC_BUS_RESET, ISP_FC_PC(isp, bus)->path, NULL);
5673 		} else {
5674 			xpt_async(AC_BUS_RESET, ISP_SPI_PC(isp, bus)->path, NULL);
5675 		}
5676 		break;
5677 	}
5678 	case ISPASYNC_LIP:
5679 		if (msg == NULL) {
5680 			msg = "LIP Received";
5681 		}
5682 		/* FALLTHROUGH */
5683 	case ISPASYNC_LOOP_RESET:
5684 		if (msg == NULL) {
5685 			msg = "LOOP Reset";
5686 		}
5687 		/* FALLTHROUGH */
5688 	case ISPASYNC_LOOP_DOWN:
5689 	{
5690 		if (msg == NULL) {
5691 			msg = "LOOP Down";
5692 		}
5693 		va_start(ap, cmd);
5694 		bus = va_arg(ap, int);
5695 		va_end(ap);
5696 
5697 		FCPARAM(isp, bus)->link_active = 0;
5698 
5699 		fc = ISP_FC_PC(isp, bus);
5700 		if (cmd == ISPASYNC_LOOP_DOWN && fc->ready) {
5701 			/*
5702 			 * We don't do any simq freezing if we are only in target mode
5703 			 */
5704 			if (FCPARAM(isp, bus)->role & ISP_ROLE_INITIATOR) {
5705 				if (fc->path) {
5706 					isp_freeze_loopdown(isp, bus, msg);
5707 				}
5708 			}
5709 			if (!callout_active(&fc->ldt)) {
5710 				callout_reset(&fc->ldt, fc->loop_down_limit * hz, isp_ldt, fc);
5711 				isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Starting Loop Down Timer @ %lu", (unsigned long) time_uptime);
5712 			}
5713 		}
5714 		isp_fcp_reset_crn(fc, /*tgt*/0, /*tgt_set*/ 0);
5715 
5716 		isp_prt(isp, ISP_LOGINFO, "Chan %d: %s", bus, msg);
5717 		break;
5718 	}
5719 	case ISPASYNC_LOOP_UP:
5720 		va_start(ap, cmd);
5721 		bus = va_arg(ap, int);
5722 		va_end(ap);
5723 		fc = ISP_FC_PC(isp, bus);
5724 		/*
5725 		 * Now we just note that Loop has come up. We don't
5726 		 * actually do anything because we're waiting for a
5727 		 * Change Notify before activating the FC cleanup
5728 		 * thread to look at the state of the loop again.
5729 		 */
5730 		FCPARAM(isp, bus)->link_active = 1;
5731 		fc->loop_dead = 0;
5732 		fc->loop_down_time = 0;
5733 		isp_prt(isp, ISP_LOGINFO, "Chan %d Loop UP", bus);
5734 		break;
5735 	case ISPASYNC_DEV_ARRIVED:
5736 		va_start(ap, cmd);
5737 		bus = va_arg(ap, int);
5738 		lp = va_arg(ap, fcportdb_t *);
5739 		va_end(ap);
5740 		fc = ISP_FC_PC(isp, bus);
5741 		tgt = FC_PORTDB_TGT(isp, bus, lp);
5742 		isp_gen_role_str(buf, sizeof (buf), lp->prli_word3);
5743 		isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "arrived");
5744 		if ((FCPARAM(isp, bus)->role & ISP_ROLE_INITIATOR) &&
5745 		    (lp->prli_word3 & PRLI_WD3_TARGET_FUNCTION)) {
5746 			lp->is_target = 1;
5747 			isp_fcp_reset_crn(fc, tgt, /*tgt_set*/ 1);
5748 			isp_make_here(isp, lp, bus, tgt);
5749 		}
5750 		if ((FCPARAM(isp, bus)->role & ISP_ROLE_TARGET) &&
5751 		    (lp->prli_word3 & PRLI_WD3_INITIATOR_FUNCTION)) {
5752 			lp->is_initiator = 1;
5753 			ac.contract_number = AC_CONTRACT_DEV_CHG;
5754 			adc = (struct ac_device_changed *) ac.contract_data;
5755 			adc->wwpn = lp->port_wwn;
5756 			adc->port = lp->portid;
5757 			adc->target = tgt;
5758 			adc->arrived = 1;
5759 			xpt_async(AC_CONTRACT, fc->path, &ac);
5760 		}
5761 		break;
5762 	case ISPASYNC_DEV_CHANGED:
5763 		va_start(ap, cmd);
5764 		bus = va_arg(ap, int);
5765 		lp = va_arg(ap, fcportdb_t *);
5766 		va_end(ap);
5767 		fc = ISP_FC_PC(isp, bus);
5768 		tgt = FC_PORTDB_TGT(isp, bus, lp);
5769 		isp_gen_role_str(buf, sizeof (buf), lp->new_prli_word3);
5770 		isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->new_portid, lp->handle, buf, "changed");
5771 changed:
5772 		if (lp->is_target !=
5773 		    ((FCPARAM(isp, bus)->role & ISP_ROLE_INITIATOR) &&
5774 		     (lp->new_prli_word3 & PRLI_WD3_TARGET_FUNCTION))) {
5775 			lp->is_target = !lp->is_target;
5776 			if (lp->is_target) {
5777 				isp_fcp_reset_crn(fc, tgt, /*tgt_set*/ 1);
5778 				isp_make_here(isp, lp, bus, tgt);
5779 			} else {
5780 				isp_make_gone(isp, lp, bus, tgt);
5781 				isp_fcp_reset_crn(fc, tgt, /*tgt_set*/ 1);
5782 			}
5783 		}
5784 		if (lp->is_initiator !=
5785 		    ((FCPARAM(isp, bus)->role & ISP_ROLE_TARGET) &&
5786 		     (lp->new_prli_word3 & PRLI_WD3_INITIATOR_FUNCTION))) {
5787 			lp->is_initiator = !lp->is_initiator;
5788 			ac.contract_number = AC_CONTRACT_DEV_CHG;
5789 			adc = (struct ac_device_changed *) ac.contract_data;
5790 			adc->wwpn = lp->port_wwn;
5791 			adc->port = lp->portid;
5792 			adc->target = tgt;
5793 			adc->arrived = lp->is_initiator;
5794 			xpt_async(AC_CONTRACT, fc->path, &ac);
5795 		}
5796 		break;
5797 	case ISPASYNC_DEV_STAYED:
5798 		va_start(ap, cmd);
5799 		bus = va_arg(ap, int);
5800 		lp = va_arg(ap, fcportdb_t *);
5801 		va_end(ap);
5802 		fc = ISP_FC_PC(isp, bus);
5803 		tgt = FC_PORTDB_TGT(isp, bus, lp);
5804 		isp_gen_role_str(buf, sizeof (buf), lp->prli_word3);
5805 		isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "stayed");
5806 		goto changed;
5807 	case ISPASYNC_DEV_GONE:
5808 		va_start(ap, cmd);
5809 		bus = va_arg(ap, int);
5810 		lp = va_arg(ap, fcportdb_t *);
5811 		va_end(ap);
5812 		fc = ISP_FC_PC(isp, bus);
5813 		tgt = FC_PORTDB_TGT(isp, bus, lp);
5814 		/*
5815 		 * If this has a virtual target or initiator set the isp_gdt
5816 		 * timer running on it to delay its departure.
5817 		 */
5818 		isp_gen_role_str(buf, sizeof (buf), lp->prli_word3);
5819 		if (lp->is_target || lp->is_initiator) {
5820 			lp->state = FC_PORTDB_STATE_ZOMBIE;
5821 			lp->gone_timer = fc->gone_device_time;
5822 			isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "gone zombie");
5823 			if (fc->ready && !callout_active(&fc->gdt)) {
5824 				isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Starting Gone Device Timer with %u seconds time now %lu", bus, lp->gone_timer, (unsigned long)time_uptime);
5825 				callout_reset(&fc->gdt, hz, isp_gdt, fc);
5826 			}
5827 			break;
5828 		}
5829 		isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "gone");
5830 		break;
5831 	case ISPASYNC_CHANGE_NOTIFY:
5832 	{
5833 		char *msg;
5834 		int evt, nphdl, nlstate, reason;
5835 
5836 		va_start(ap, cmd);
5837 		bus = va_arg(ap, int);
5838 		evt = va_arg(ap, int);
5839 		if (IS_24XX(isp) && evt == ISPASYNC_CHANGE_PDB) {
5840 			nphdl = va_arg(ap, int);
5841 			nlstate = va_arg(ap, int);
5842 			reason = va_arg(ap, int);
5843 		} else {
5844 			nphdl = NIL_HANDLE;
5845 			nlstate = reason = 0;
5846 		}
5847 		va_end(ap);
5848 		fc = ISP_FC_PC(isp, bus);
5849 
5850 		if (evt == ISPASYNC_CHANGE_PDB) {
5851 			msg = "Chan %d Port Database Changed";
5852 		} else if (evt == ISPASYNC_CHANGE_SNS) {
5853 			msg = "Chan %d Name Server Database Changed";
5854 		} else {
5855 			msg = "Chan %d Other Change Notify";
5856 		}
5857 
5858 		/*
5859 		 * If the loop down timer is running, cancel it.
5860 		 */
5861 		if (fc->ready && callout_active(&fc->ldt)) {
5862 			isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Stopping Loop Down Timer @ %lu", (unsigned long) time_uptime);
5863 			callout_stop(&fc->ldt);
5864 		}
5865 		isp_prt(isp, ISP_LOGINFO, msg, bus);
5866 		if (FCPARAM(isp, bus)->role & ISP_ROLE_INITIATOR) {
5867 			isp_freeze_loopdown(isp, bus, msg);
5868 		}
5869 		wakeup(fc);
5870 		break;
5871 	}
5872 #ifdef	ISP_TARGET_MODE
5873 	case ISPASYNC_TARGET_NOTIFY:
5874 	{
5875 		isp_notify_t *notify;
5876 		va_start(ap, cmd);
5877 		notify = va_arg(ap, isp_notify_t *);
5878 		va_end(ap);
5879 		switch (notify->nt_ncode) {
5880 		case NT_ABORT_TASK:
5881 		case NT_ABORT_TASK_SET:
5882 		case NT_CLEAR_ACA:
5883 		case NT_CLEAR_TASK_SET:
5884 		case NT_LUN_RESET:
5885 		case NT_TARGET_RESET:
5886 			/*
5887 			 * These are task management functions.
5888 			 */
5889 			isp_handle_platform_target_tmf(isp, notify);
5890 			break;
5891 		case NT_BUS_RESET:
5892 		case NT_LIP_RESET:
5893 		case NT_LINK_UP:
5894 		case NT_LINK_DOWN:
5895 		case NT_HBA_RESET:
5896 			/*
5897 			 * No action need be taken here.
5898 			 */
5899 			break;
5900 		case NT_GLOBAL_LOGOUT:
5901 		case NT_LOGOUT:
5902 			/*
5903 			 * This is device arrival/departure notification
5904 			 */
5905 			isp_handle_platform_target_notify_ack(isp, notify);
5906 			break;
5907 		default:
5908 			isp_prt(isp, ISP_LOGALL, "target notify code 0x%x", notify->nt_ncode);
5909 			isp_handle_platform_target_notify_ack(isp, notify);
5910 			break;
5911 		}
5912 		break;
5913 	}
5914 	case ISPASYNC_TARGET_NOTIFY_ACK:
5915 	{
5916 		void *inot;
5917 		va_start(ap, cmd);
5918 		inot = va_arg(ap, void *);
5919 		va_end(ap);
5920 		if (isp_notify_ack(isp, inot)) {
5921 			isp_tna_t *tp = malloc(sizeof (*tp), M_DEVBUF, M_NOWAIT);
5922 			if (tp) {
5923 				tp->isp = isp;
5924 				if (inot) {
5925 					memcpy(tp->data, inot, sizeof (tp->data));
5926 					tp->not = tp->data;
5927 				} else {
5928 					tp->not = NULL;
5929 				}
5930 				callout_init_mtx(&tp->timer, &isp->isp_lock, 0);
5931 				callout_reset(&tp->timer, 5,
5932 				    isp_refire_notify_ack, tp);
5933 			} else {
5934 				isp_prt(isp, ISP_LOGERR, "you lose- cannot allocate a notify refire");
5935 			}
5936 		}
5937 		break;
5938 	}
5939 	case ISPASYNC_TARGET_ACTION:
5940 	{
5941 		isphdr_t *hp;
5942 
5943 		va_start(ap, cmd);
5944 		hp = va_arg(ap, isphdr_t *);
5945 		va_end(ap);
5946 		switch (hp->rqs_entry_type) {
5947 		default:
5948 			isp_prt(isp, ISP_LOGWARN, "%s: unhandled target action 0x%x", __func__, hp->rqs_entry_type);
5949 			break;
5950 		case RQSTYPE_NOTIFY:
5951 			if (IS_SCSI(isp)) {
5952 				isp_handle_platform_notify_scsi(isp, (in_entry_t *) hp);
5953 			} else if (IS_24XX(isp)) {
5954 				isp_handle_platform_notify_24xx(isp, (in_fcentry_24xx_t *) hp);
5955 			} else {
5956 				isp_handle_platform_notify_fc(isp, (in_fcentry_t *) hp);
5957 			}
5958 			break;
5959 		case RQSTYPE_ATIO:
5960 			if (IS_24XX(isp)) {
5961 				isp_handle_platform_atio7(isp, (at7_entry_t *) hp);
5962 			} else {
5963 				isp_handle_platform_atio(isp, (at_entry_t *) hp);
5964 			}
5965 			break;
5966 		case RQSTYPE_ATIO2:
5967 			isp_handle_platform_atio2(isp, (at2_entry_t *) hp);
5968 			break;
5969 		case RQSTYPE_CTIO7:
5970 		case RQSTYPE_CTIO3:
5971 		case RQSTYPE_CTIO2:
5972 		case RQSTYPE_CTIO:
5973 			isp_handle_platform_ctio(isp, hp);
5974 			break;
5975 		case RQSTYPE_ABTS_RCVD:
5976 		{
5977 			abts_t *abts = (abts_t *)hp;
5978 			isp_notify_t notify, *nt = &notify;
5979 			tstate_t *tptr;
5980 			fcportdb_t *lp;
5981 			uint16_t chan;
5982 			uint32_t sid, did;
5983 
5984 			did = (abts->abts_did_hi << 16) | abts->abts_did_lo;
5985 			sid = (abts->abts_sid_hi << 16) | abts->abts_sid_lo;
5986 			ISP_MEMZERO(nt, sizeof (isp_notify_t));
5987 
5988 			nt->nt_hba = isp;
5989 			nt->nt_did = did;
5990 			nt->nt_nphdl = abts->abts_nphdl;
5991 			nt->nt_sid = sid;
5992 			isp_find_chan_by_did(isp, did, &chan);
5993 			if (chan == ISP_NOCHAN) {
5994 				nt->nt_tgt = TGT_ANY;
5995 			} else {
5996 				nt->nt_tgt = FCPARAM(isp, chan)->isp_wwpn;
5997 				if (isp_find_pdb_by_handle(isp, chan, abts->abts_nphdl, &lp)) {
5998 					nt->nt_wwn = lp->port_wwn;
5999 				} else {
6000 					nt->nt_wwn = INI_ANY;
6001 				}
6002 			}
6003 			/*
6004 			 * Try hard to find the lun for this command.
6005 			 */
6006 			tptr = get_lun_statep_from_tag(isp, chan, abts->abts_rxid_task);
6007 			if (tptr) {
6008 				nt->nt_lun = tptr->ts_lun;
6009 				rls_lun_statep(isp, tptr);
6010 			} else {
6011 				nt->nt_lun = LUN_ANY;
6012 			}
6013 			nt->nt_need_ack = 1;
6014 			nt->nt_tagval = abts->abts_rxid_task;
6015 			nt->nt_tagval |= (((uint64_t) abts->abts_rxid_abts) << 32);
6016 			if (abts->abts_rxid_task == ISP24XX_NO_TASK) {
6017 				isp_prt(isp, ISP_LOGTINFO, "[0x%x] ABTS from N-Port handle 0x%x Port 0x%06x has no task id (rx_id 0x%04x ox_id 0x%04x)",
6018 				    abts->abts_rxid_abts, abts->abts_nphdl, sid, abts->abts_rx_id, abts->abts_ox_id);
6019 			} else {
6020 				isp_prt(isp, ISP_LOGTINFO, "[0x%x] ABTS from N-Port handle 0x%x Port 0x%06x for task 0x%x (rx_id 0x%04x ox_id 0x%04x)",
6021 				    abts->abts_rxid_abts, abts->abts_nphdl, sid, abts->abts_rxid_task, abts->abts_rx_id, abts->abts_ox_id);
6022 			}
6023 			nt->nt_channel = chan;
6024 			nt->nt_ncode = NT_ABORT_TASK;
6025 			nt->nt_lreserved = hp;
6026 			isp_handle_platform_target_tmf(isp, nt);
6027 			break;
6028 		}
6029 		case RQSTYPE_ENABLE_LUN:
6030 		case RQSTYPE_MODIFY_LUN:
6031 			isp_ledone(isp, (lun_entry_t *) hp);
6032 			break;
6033 		}
6034 		break;
6035 	}
6036 #endif
6037 	case ISPASYNC_FW_CRASH:
6038 	{
6039 		uint16_t mbox1, mbox6;
6040 		mbox1 = ISP_READ(isp, OUTMAILBOX1);
6041 		if (IS_DUALBUS(isp)) {
6042 			mbox6 = ISP_READ(isp, OUTMAILBOX6);
6043 		} else {
6044 			mbox6 = 0;
6045 		}
6046 		isp_prt(isp, ISP_LOGERR, "Internal Firmware Error on bus %d @ RISC Address 0x%x", mbox6, mbox1);
6047 		mbox1 = isp->isp_osinfo.mbox_sleep_ok;
6048 		isp->isp_osinfo.mbox_sleep_ok = 0;
6049 		isp_reinit(isp, 1);
6050 		isp->isp_osinfo.mbox_sleep_ok = mbox1;
6051 		isp_async(isp, ISPASYNC_FW_RESTARTED, NULL);
6052 		break;
6053 	}
6054 	default:
6055 		isp_prt(isp, ISP_LOGERR, "unknown isp_async event %d", cmd);
6056 		break;
6057 	}
6058 }
6059 
6060 
6061 /*
6062  * Locks are held before coming here.
6063  */
6064 void
6065 isp_uninit(ispsoftc_t *isp)
6066 {
6067 	if (IS_24XX(isp)) {
6068 		ISP_WRITE(isp, BIU2400_HCCR, HCCR_2400_CMD_RESET);
6069 	} else {
6070 		ISP_WRITE(isp, HCCR, HCCR_CMD_RESET);
6071 	}
6072 	ISP_DISABLE_INTS(isp);
6073 }
6074 
6075 /*
6076  * When we want to get the 'default' WWNs (when lacking NVRAM), we pick them
6077  * up from our platform default (defww{p|n}n) and morph them based upon
6078  * channel.
6079  *
6080  * When we want to get the 'active' WWNs, we get NVRAM WWNs and then morph them
6081  * based upon channel.
6082  */
6083 
6084 uint64_t
6085 isp_default_wwn(ispsoftc_t * isp, int chan, int isactive, int iswwnn)
6086 {
6087 	uint64_t seed;
6088 	struct isp_fc *fc = ISP_FC_PC(isp, chan);
6089 
6090 	/*
6091 	 * If we're asking for a active WWN, the default overrides get
6092 	 * returned, otherwise the NVRAM value is picked.
6093 	 *
6094 	 * If we're asking for a default WWN, we just pick the default override.
6095 	 */
6096 	if (isactive) {
6097 		seed = iswwnn ? fc->def_wwnn : fc->def_wwpn;
6098 		if (seed) {
6099 			return (seed);
6100 		}
6101 		seed = iswwnn ? FCPARAM(isp, chan)->isp_wwnn_nvram : FCPARAM(isp, chan)->isp_wwpn_nvram;
6102 		if (seed) {
6103 			return (seed);
6104 		}
6105 		return (0x400000007F000009ull);
6106 	}
6107 
6108 	seed = iswwnn ? fc->def_wwnn : fc->def_wwpn;
6109 
6110 	/*
6111 	 * For channel zero just return what we have. For either ACTIVE or
6112 	 * DEFAULT cases, we depend on default override of NVRAM values for
6113 	 * channel zero.
6114 	 */
6115 	if (chan == 0) {
6116 		return (seed);
6117 	}
6118 
6119 	/*
6120 	 * For other channels, we are doing one of three things:
6121 	 *
6122 	 * 1. If what we have now is non-zero, return it. Otherwise we morph
6123 	 * values from channel 0. 2. If we're here for a WWPN we synthesize
6124 	 * it if Channel 0's wwpn has a type 2 NAA. 3. If we're here for a
6125 	 * WWNN we synthesize it if Channel 0's wwnn has a type 2 NAA.
6126 	 */
6127 
6128 	if (seed) {
6129 		return (seed);
6130 	}
6131 	seed = iswwnn ? ISP_FC_PC(isp, 0)->def_wwnn : ISP_FC_PC(isp, 0)->def_wwpn;
6132 	if (seed == 0)
6133 		seed = iswwnn ? FCPARAM(isp, 0)->isp_wwnn_nvram : FCPARAM(isp, 0)->isp_wwpn_nvram;
6134 
6135 	if (((seed >> 60) & 0xf) == 2) {
6136 		/*
6137 		 * The type 2 NAA fields for QLogic cards appear be laid out
6138 		 * thusly:
6139 		 *
6140 		 * bits 63..60 NAA == 2 bits 59..57 unused/zero bit 56
6141 		 * port (1) or node (0) WWN distinguishor bit 48
6142 		 * physical port on dual-port chips (23XX/24XX)
6143 		 *
6144 		 * This is somewhat nutty, particularly since bit 48 is
6145 		 * irrelevant as they assign separate serial numbers to
6146 		 * different physical ports anyway.
6147 		 *
6148 		 * We'll stick our channel number plus one first into bits
6149 		 * 57..59 and thence into bits 52..55 which allows for 8 bits
6150 		 * of channel which is comfortably more than our maximum
6151 		 * (126) now.
6152 		 */
6153 		seed &= ~0x0FF0000000000000ULL;
6154 		if (iswwnn == 0) {
6155 			seed |= ((uint64_t) (chan + 1) & 0xf) << 56;
6156 			seed |= ((uint64_t) ((chan + 1) >> 4) & 0xf) << 52;
6157 		}
6158 	} else {
6159 		seed = 0;
6160 	}
6161 	return (seed);
6162 }
6163 
6164 void
6165 isp_prt(ispsoftc_t *isp, int level, const char *fmt, ...)
6166 {
6167 	int loc;
6168 	char lbuf[200];
6169 	va_list ap;
6170 
6171 	if (level != ISP_LOGALL && (level & isp->isp_dblev) == 0) {
6172 		return;
6173 	}
6174 	snprintf(lbuf, sizeof (lbuf), "%s: ", device_get_nameunit(isp->isp_dev));
6175 	loc = strlen(lbuf);
6176 	va_start(ap, fmt);
6177 	vsnprintf(&lbuf[loc], sizeof (lbuf) - loc - 1, fmt, ap);
6178 	va_end(ap);
6179 	printf("%s\n", lbuf);
6180 }
6181 
6182 void
6183 isp_xs_prt(ispsoftc_t *isp, XS_T *xs, int level, const char *fmt, ...)
6184 {
6185 	va_list ap;
6186 	if (level != ISP_LOGALL && (level & isp->isp_dblev) == 0) {
6187 		return;
6188 	}
6189 	xpt_print_path(xs->ccb_h.path);
6190 	va_start(ap, fmt);
6191 	vprintf(fmt, ap);
6192 	va_end(ap);
6193 	printf("\n");
6194 }
6195 
6196 uint64_t
6197 isp_nanotime_sub(struct timespec *b, struct timespec *a)
6198 {
6199 	uint64_t elapsed;
6200 	struct timespec x = *b;
6201 	timespecsub(&x, a);
6202 	elapsed = GET_NANOSEC(&x);
6203 	if (elapsed == 0)
6204 		elapsed++;
6205 	return (elapsed);
6206 }
6207 
6208 int
6209 isp_mbox_acquire(ispsoftc_t *isp)
6210 {
6211 	if (isp->isp_osinfo.mboxbsy) {
6212 		return (1);
6213 	} else {
6214 		isp->isp_osinfo.mboxcmd_done = 0;
6215 		isp->isp_osinfo.mboxbsy = 1;
6216 		return (0);
6217 	}
6218 }
6219 
6220 void
6221 isp_mbox_wait_complete(ispsoftc_t *isp, mbreg_t *mbp)
6222 {
6223 	unsigned int usecs = mbp->timeout;
6224 	unsigned int max, olim, ilim;
6225 
6226 	if (usecs == 0) {
6227 		usecs = MBCMD_DEFAULT_TIMEOUT;
6228 	}
6229 	max = isp->isp_mbxwrk0 + 1;
6230 
6231 	if (isp->isp_osinfo.mbox_sleep_ok) {
6232 		unsigned int ms = (usecs + 999) / 1000;
6233 
6234 		isp->isp_osinfo.mbox_sleep_ok = 0;
6235 		isp->isp_osinfo.mbox_sleeping = 1;
6236 		for (olim = 0; olim < max; olim++) {
6237 			msleep(&isp->isp_mbxworkp, &isp->isp_osinfo.lock, PRIBIO, "ispmbx_sleep", isp_mstohz(ms));
6238 			if (isp->isp_osinfo.mboxcmd_done) {
6239 				break;
6240 			}
6241 		}
6242 		isp->isp_osinfo.mbox_sleep_ok = 1;
6243 		isp->isp_osinfo.mbox_sleeping = 0;
6244 	} else {
6245 		for (olim = 0; olim < max; olim++) {
6246 			for (ilim = 0; ilim < usecs; ilim += 100) {
6247 				uint32_t isr;
6248 				uint16_t sema, mbox;
6249 				if (isp->isp_osinfo.mboxcmd_done) {
6250 					break;
6251 				}
6252 				if (ISP_READ_ISR(isp, &isr, &sema, &mbox)) {
6253 					isp_intr(isp, isr, sema, mbox);
6254 					if (isp->isp_osinfo.mboxcmd_done) {
6255 						break;
6256 					}
6257 				}
6258 				ISP_DELAY(100);
6259 			}
6260 			if (isp->isp_osinfo.mboxcmd_done) {
6261 				break;
6262 			}
6263 		}
6264 	}
6265 	if (isp->isp_osinfo.mboxcmd_done == 0) {
6266 		isp_prt(isp, ISP_LOGWARN, "%s Mailbox Command (0x%x) Timeout (%uus) (started @ %s:%d)",
6267 		    isp->isp_osinfo.mbox_sleep_ok? "Interrupting" : "Polled", isp->isp_lastmbxcmd, usecs, mbp->func, mbp->lineno);
6268 		mbp->param[0] = MBOX_TIMEOUT;
6269 		isp->isp_osinfo.mboxcmd_done = 1;
6270 	}
6271 }
6272 
6273 void
6274 isp_mbox_notify_done(ispsoftc_t *isp)
6275 {
6276 	if (isp->isp_osinfo.mbox_sleeping) {
6277 		wakeup(&isp->isp_mbxworkp);
6278 	}
6279 	isp->isp_osinfo.mboxcmd_done = 1;
6280 }
6281 
6282 void
6283 isp_mbox_release(ispsoftc_t *isp)
6284 {
6285 	isp->isp_osinfo.mboxbsy = 0;
6286 }
6287 
6288 int
6289 isp_fc_scratch_acquire(ispsoftc_t *isp, int chan)
6290 {
6291 	int ret = 0;
6292 	if (isp->isp_osinfo.pc.fc[chan].fcbsy) {
6293 		ret = -1;
6294 	} else {
6295 		isp->isp_osinfo.pc.fc[chan].fcbsy = 1;
6296 	}
6297 	return (ret);
6298 }
6299 
6300 int
6301 isp_mstohz(int ms)
6302 {
6303 	int hz;
6304 	struct timeval t;
6305 	t.tv_sec = ms / 1000;
6306 	t.tv_usec = (ms % 1000) * 1000;
6307 	hz = tvtohz(&t);
6308 	if (hz < 0) {
6309 		hz = 0x7fffffff;
6310 	}
6311 	if (hz == 0) {
6312 		hz = 1;
6313 	}
6314 	return (hz);
6315 }
6316 
6317 void
6318 isp_platform_intr(void *arg)
6319 {
6320 	ispsoftc_t *isp = arg;
6321 	uint32_t isr;
6322 	uint16_t sema, mbox;
6323 
6324 	ISP_LOCK(isp);
6325 	isp->isp_intcnt++;
6326 	if (ISP_READ_ISR(isp, &isr, &sema, &mbox) == 0) {
6327 		isp->isp_intbogus++;
6328 	} else {
6329 		isp_intr(isp, isr, sema, mbox);
6330 	}
6331 	ISP_UNLOCK(isp);
6332 }
6333 
6334 void
6335 isp_common_dmateardown(ispsoftc_t *isp, struct ccb_scsiio *csio, uint32_t hdl)
6336 {
6337 	if ((csio->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
6338 		bus_dmamap_sync(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap, BUS_DMASYNC_POSTREAD);
6339 	} else {
6340 		bus_dmamap_sync(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap, BUS_DMASYNC_POSTWRITE);
6341 	}
6342 	bus_dmamap_unload(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap);
6343 }
6344 
6345 /*
6346  * Reset the command reference number for all LUNs on a specific target
6347  * (needed when a target arrives again) or for all targets on a port
6348  * (needed for events like a LIP).
6349  */
6350 void
6351 isp_fcp_reset_crn(struct isp_fc *fc, uint32_t tgt, int tgt_set)
6352 {
6353 	int i;
6354 	struct isp_nexus *nxp;
6355 
6356 	if (tgt_set == 0)
6357 		isp_prt(fc->isp, ISP_LOG_SANCFG, "resetting CRN on all targets");
6358 	else
6359 		isp_prt(fc->isp, ISP_LOG_SANCFG, "resetting CRN target %u", tgt);
6360 
6361 	for (i = 0; i < NEXUS_HASH_WIDTH; i++) {
6362 		nxp = fc->nexus_hash[i];
6363 		while (nxp) {
6364 			if ((tgt_set != 0) && (tgt == nxp->tgt))
6365 				nxp->crnseed = 0;
6366 
6367 			nxp = nxp->next;
6368 		}
6369 	}
6370 }
6371 
6372 int
6373 isp_fcp_next_crn(ispsoftc_t *isp, uint8_t *crnp, XS_T *cmd)
6374 {
6375 	uint32_t chan, tgt, lun;
6376 	struct isp_fc *fc;
6377 	struct isp_nexus *nxp;
6378 	int idx;
6379 
6380 	if (isp->isp_type < ISP_HA_FC_2300)
6381 		return (0);
6382 
6383 	chan = XS_CHANNEL(cmd);
6384 	tgt = XS_TGT(cmd);
6385 	lun = XS_LUN(cmd);
6386 	fc = &isp->isp_osinfo.pc.fc[chan];
6387 	idx = NEXUS_HASH(tgt, lun);
6388 	nxp = fc->nexus_hash[idx];
6389 
6390 	while (nxp) {
6391 		if (nxp->tgt == tgt && nxp->lun == lun)
6392 			break;
6393 		nxp = nxp->next;
6394 	}
6395 	if (nxp == NULL) {
6396 		nxp = fc->nexus_free_list;
6397 		if (nxp == NULL) {
6398 			nxp = malloc(sizeof (struct isp_nexus), M_DEVBUF, M_ZERO|M_NOWAIT);
6399 			if (nxp == NULL) {
6400 				return (-1);
6401 			}
6402 		} else {
6403 			fc->nexus_free_list = nxp->next;
6404 		}
6405 		nxp->tgt = tgt;
6406 		nxp->lun = lun;
6407 		nxp->next = fc->nexus_hash[idx];
6408 		fc->nexus_hash[idx] = nxp;
6409 	}
6410 	if (nxp) {
6411 		if (nxp->crnseed == 0)
6412 			nxp->crnseed = 1;
6413 		if (cmd)
6414 			PISP_PCMD(cmd)->crn = nxp->crnseed;
6415 		*crnp = nxp->crnseed++;
6416 		return (0);
6417 	}
6418 	return (-1);
6419 }
6420 
6421 /*
6422  * We enter with the lock held
6423  */
6424 void
6425 isp_timer(void *arg)
6426 {
6427 	ispsoftc_t *isp = arg;
6428 #ifdef	ISP_TARGET_MODE
6429 	isp_tmcmd_restart(isp);
6430 #endif
6431 	callout_reset(&isp->isp_osinfo.tmo, isp_timer_count, isp_timer, isp);
6432 }
6433 
6434 isp_ecmd_t *
6435 isp_get_ecmd(ispsoftc_t *isp)
6436 {
6437 	isp_ecmd_t *ecmd = isp->isp_osinfo.ecmd_free;
6438 	if (ecmd) {
6439 		isp->isp_osinfo.ecmd_free = ecmd->next;
6440 	}
6441 	return (ecmd);
6442 }
6443 
6444 void
6445 isp_put_ecmd(ispsoftc_t *isp, isp_ecmd_t *ecmd)
6446 {
6447 	ecmd->next = isp->isp_osinfo.ecmd_free;
6448 	isp->isp_osinfo.ecmd_free = ecmd;
6449 }
6450