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