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