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