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