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