xref: /freebsd/sys/dev/mpt/mpt_cam.c (revision d8b878873e7aa8df1972cc6a642804b17eb61087)
1 /*-
2  * FreeBSD/CAM specific routines for LSI '909 FC  adapters.
3  * FreeBSD Version.
4  *
5  * Copyright (c)  2000, 2001 by Greg Ansley
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice immediately at the beginning of the file, without modification,
12  *    this list of conditions, and the following disclaimer.
13  * 2. The name of the author may not be used to endorse or promote products
14  *    derived from this software without specific prior written permission.
15  *
16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
20  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26  * SUCH DAMAGE.
27  */
28 /*-
29  * Copyright (c) 2002, 2006 by Matthew Jacob
30  * All rights reserved.
31  *
32  * Redistribution and use in source and binary forms, with or without
33  * modification, are permitted provided that the following conditions are
34  * met:
35  * 1. Redistributions of source code must retain the above copyright
36  *    notice, this list of conditions and the following disclaimer.
37  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
38  *    substantially similar to the "NO WARRANTY" disclaimer below
39  *    ("Disclaimer") and any redistribution must be conditioned upon including
40  *    a substantially similar Disclaimer requirement for further binary
41  *    redistribution.
42  * 3. Neither the names of the above listed copyright holders nor the names
43  *    of any contributors may be used to endorse or promote products derived
44  *    from this software without specific prior written permission.
45  *
46  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
47  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
48  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
49  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
50  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
51  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
52  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
53  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
54  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
55  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF THE COPYRIGHT
56  * OWNER OR CONTRIBUTOR IS ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
57  *
58  * Support from Chris Ellsworth in order to make SAS adapters work
59  * is gratefully acknowledged.
60  *
61  * Support from LSI-Logic has also gone a great deal toward making this a
62  * workable subsystem and is gratefully acknowledged.
63  */
64 /*-
65  * Copyright (c) 2004, Avid Technology, Inc. and its contributors.
66  * Copyright (c) 2005, WHEEL Sp. z o.o.
67  * Copyright (c) 2004, 2005 Justin T. Gibbs
68  * All rights reserved.
69  *
70  * Redistribution and use in source and binary forms, with or without
71  * modification, are permitted provided that the following conditions are
72  * met:
73  * 1. Redistributions of source code must retain the above copyright
74  *    notice, this list of conditions and the following disclaimer.
75  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
76  *    substantially similar to the "NO WARRANTY" disclaimer below
77  *    ("Disclaimer") and any redistribution must be conditioned upon including
78  *    a substantially similar Disclaimer requirement for further binary
79  *    redistribution.
80  * 3. Neither the names of the above listed copyright holders nor the names
81  *    of any contributors may be used to endorse or promote products derived
82  *    from this software without specific prior written permission.
83  *
84  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
85  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
86  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
87  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
88  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
89  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
90  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
91  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
92  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
93  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF THE COPYRIGHT
94  * OWNER OR CONTRIBUTOR IS ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
95  */
96 #include <sys/cdefs.h>
97 __FBSDID("$FreeBSD$");
98 
99 #include <dev/mpt/mpt.h>
100 #include <dev/mpt/mpt_cam.h>
101 #include <dev/mpt/mpt_raid.h>
102 
103 #include "dev/mpt/mpilib/mpi_ioc.h" /* XXX Fix Event Handling!!! */
104 #include "dev/mpt/mpilib/mpi_init.h"
105 #include "dev/mpt/mpilib/mpi_targ.h"
106 #include "dev/mpt/mpilib/mpi_fc.h"
107 #include "dev/mpt/mpilib/mpi_sas.h"
108 #if __FreeBSD_version >= 500000
109 #include <sys/sysctl.h>
110 #endif
111 #include <sys/callout.h>
112 #include <sys/kthread.h>
113 
114 #if __FreeBSD_version >= 700025
115 #ifndef	CAM_NEW_TRAN_CODE
116 #define	CAM_NEW_TRAN_CODE	1
117 #endif
118 #endif
119 
120 static void mpt_poll(struct cam_sim *);
121 static timeout_t mpt_timeout;
122 static void mpt_action(struct cam_sim *, union ccb *);
123 static int
124 mpt_get_spi_settings(struct mpt_softc *, struct ccb_trans_settings *);
125 static void mpt_setwidth(struct mpt_softc *, int, int);
126 static void mpt_setsync(struct mpt_softc *, int, int, int);
127 static int mpt_update_spi_config(struct mpt_softc *, int);
128 static void mpt_calc_geometry(struct ccb_calc_geometry *ccg, int extended);
129 
130 static mpt_reply_handler_t mpt_scsi_reply_handler;
131 static mpt_reply_handler_t mpt_scsi_tmf_reply_handler;
132 static mpt_reply_handler_t mpt_fc_els_reply_handler;
133 static int mpt_scsi_reply_frame_handler(struct mpt_softc *, request_t *,
134 					MSG_DEFAULT_REPLY *);
135 static int mpt_bus_reset(struct mpt_softc *, target_id_t, lun_id_t, int);
136 static int mpt_fc_reset_link(struct mpt_softc *, int);
137 
138 static int mpt_spawn_recovery_thread(struct mpt_softc *mpt);
139 static void mpt_terminate_recovery_thread(struct mpt_softc *mpt);
140 static void mpt_recovery_thread(void *arg);
141 static void mpt_recover_commands(struct mpt_softc *mpt);
142 
143 static int mpt_scsi_send_tmf(struct mpt_softc *, u_int, u_int, u_int,
144     u_int, u_int, u_int, int);
145 
146 static void mpt_fc_post_els(struct mpt_softc *mpt, request_t *, int);
147 static void mpt_post_target_command(struct mpt_softc *, request_t *, int);
148 static int mpt_add_els_buffers(struct mpt_softc *mpt);
149 static int mpt_add_target_commands(struct mpt_softc *mpt);
150 static int mpt_enable_lun(struct mpt_softc *, target_id_t, lun_id_t);
151 static int mpt_disable_lun(struct mpt_softc *, target_id_t, lun_id_t);
152 static void mpt_target_start_io(struct mpt_softc *, union ccb *);
153 static cam_status mpt_abort_target_ccb(struct mpt_softc *, union ccb *);
154 static int mpt_abort_target_cmd(struct mpt_softc *, request_t *);
155 static void mpt_scsi_tgt_status(struct mpt_softc *, union ccb *, request_t *,
156     uint8_t, uint8_t const *);
157 static void
158 mpt_scsi_tgt_tsk_mgmt(struct mpt_softc *, request_t *, mpt_task_mgmt_t,
159     tgt_resource_t *, int);
160 static void mpt_tgt_dump_tgt_state(struct mpt_softc *, request_t *);
161 static void mpt_tgt_dump_req_state(struct mpt_softc *, request_t *);
162 static mpt_reply_handler_t mpt_scsi_tgt_reply_handler;
163 static mpt_reply_handler_t mpt_sata_pass_reply_handler;
164 
165 static uint32_t scsi_io_handler_id = MPT_HANDLER_ID_NONE;
166 static uint32_t scsi_tmf_handler_id = MPT_HANDLER_ID_NONE;
167 static uint32_t fc_els_handler_id = MPT_HANDLER_ID_NONE;
168 static uint32_t sata_pass_handler_id = MPT_HANDLER_ID_NONE;
169 
170 static mpt_probe_handler_t	mpt_cam_probe;
171 static mpt_attach_handler_t	mpt_cam_attach;
172 static mpt_enable_handler_t	mpt_cam_enable;
173 static mpt_ready_handler_t	mpt_cam_ready;
174 static mpt_event_handler_t	mpt_cam_event;
175 static mpt_reset_handler_t	mpt_cam_ioc_reset;
176 static mpt_detach_handler_t	mpt_cam_detach;
177 
178 static struct mpt_personality mpt_cam_personality =
179 {
180 	.name		= "mpt_cam",
181 	.probe		= mpt_cam_probe,
182 	.attach		= mpt_cam_attach,
183 	.enable		= mpt_cam_enable,
184 	.ready		= mpt_cam_ready,
185 	.event		= mpt_cam_event,
186 	.reset		= mpt_cam_ioc_reset,
187 	.detach		= mpt_cam_detach,
188 };
189 
190 DECLARE_MPT_PERSONALITY(mpt_cam, SI_ORDER_SECOND);
191 MODULE_DEPEND(mpt_cam, cam, 1, 1, 1);
192 
193 int mpt_enable_sata_wc = -1;
194 TUNABLE_INT("hw.mpt.enable_sata_wc", &mpt_enable_sata_wc);
195 
196 int
197 mpt_cam_probe(struct mpt_softc *mpt)
198 {
199 	int role;
200 
201 	/*
202 	 * Only attach to nodes that support the initiator or target role
203 	 * (or want to) or have RAID physical devices that need CAM pass-thru
204 	 * support.
205 	 */
206 	if (mpt->do_cfg_role) {
207 		role = mpt->cfg_role;
208 	} else {
209 		role = mpt->role;
210 	}
211 	if ((role & (MPT_ROLE_TARGET|MPT_ROLE_INITIATOR)) != 0 ||
212 	    (mpt->ioc_page2 != NULL && mpt->ioc_page2->MaxPhysDisks != 0)) {
213 		return (0);
214 	}
215 	return (ENODEV);
216 }
217 
218 int
219 mpt_cam_attach(struct mpt_softc *mpt)
220 {
221 	struct cam_devq *devq;
222 	mpt_handler_t	 handler;
223 	int		 maxq;
224 	int		 error;
225 
226 	MPT_LOCK(mpt);
227 	TAILQ_INIT(&mpt->request_timeout_list);
228 	maxq = (mpt->ioc_facts.GlobalCredits < MPT_MAX_REQUESTS(mpt))?
229 	    mpt->ioc_facts.GlobalCredits : MPT_MAX_REQUESTS(mpt);
230 
231 	handler.reply_handler = mpt_scsi_reply_handler;
232 	error = mpt_register_handler(mpt, MPT_HANDLER_REPLY, handler,
233 				     &scsi_io_handler_id);
234 	if (error != 0) {
235 		MPT_UNLOCK(mpt);
236 		goto cleanup;
237 	}
238 
239 	handler.reply_handler = mpt_scsi_tmf_reply_handler;
240 	error = mpt_register_handler(mpt, MPT_HANDLER_REPLY, handler,
241 				     &scsi_tmf_handler_id);
242 	if (error != 0) {
243 		MPT_UNLOCK(mpt);
244 		goto cleanup;
245 	}
246 
247 	/*
248 	 * If we're fibre channel and could support target mode, we register
249 	 * an ELS reply handler and give it resources.
250 	 */
251 	if (mpt->is_fc && (mpt->role & MPT_ROLE_TARGET) != 0) {
252 		handler.reply_handler = mpt_fc_els_reply_handler;
253 		error = mpt_register_handler(mpt, MPT_HANDLER_REPLY, handler,
254 		    &fc_els_handler_id);
255 		if (error != 0) {
256 			MPT_UNLOCK(mpt);
257 			goto cleanup;
258 		}
259 		if (mpt_add_els_buffers(mpt) == FALSE) {
260 			error = ENOMEM;
261 			MPT_UNLOCK(mpt);
262 			goto cleanup;
263 		}
264 		maxq -= mpt->els_cmds_allocated;
265 	}
266 
267 	/*
268 	 * If we support target mode, we register a reply handler for it,
269 	 * but don't add command resources until we actually enable target
270 	 * mode.
271 	 */
272 	if (mpt->is_fc && (mpt->role & MPT_ROLE_TARGET) != 0) {
273 		handler.reply_handler = mpt_scsi_tgt_reply_handler;
274 		error = mpt_register_handler(mpt, MPT_HANDLER_REPLY, handler,
275 		    &mpt->scsi_tgt_handler_id);
276 		if (error != 0) {
277 			MPT_UNLOCK(mpt);
278 			goto cleanup;
279 		}
280 	}
281 
282 	if (mpt->is_sas) {
283 		handler.reply_handler = mpt_sata_pass_reply_handler;
284 		error = mpt_register_handler(mpt, MPT_HANDLER_REPLY, handler,
285 		    &sata_pass_handler_id);
286 		if (error != 0) {
287 			MPT_UNLOCK(mpt);
288 			goto cleanup;
289 		}
290 	}
291 
292 	/*
293 	 * We keep one request reserved for timeout TMF requests.
294 	 */
295 	mpt->tmf_req = mpt_get_request(mpt, FALSE);
296 	if (mpt->tmf_req == NULL) {
297 		mpt_prt(mpt, "Unable to allocate dedicated TMF request!\n");
298 		error = ENOMEM;
299 		MPT_UNLOCK(mpt);
300 		goto cleanup;
301 	}
302 
303 	/*
304 	 * Mark the request as free even though not on the free list.
305 	 * There is only one TMF request allowed to be outstanding at
306 	 * a time and the TMF routines perform their own allocation
307 	 * tracking using the standard state flags.
308 	 */
309 	mpt->tmf_req->state = REQ_STATE_FREE;
310 	maxq--;
311 
312 	/*
313 	 * The rest of this is CAM foo, for which we need to drop our lock
314 	 */
315 	MPT_UNLOCK(mpt);
316 
317 	if (mpt_spawn_recovery_thread(mpt) != 0) {
318 		mpt_prt(mpt, "Unable to spawn recovery thread!\n");
319 		error = ENOMEM;
320 		goto cleanup;
321 	}
322 
323 	/*
324 	 * Create the device queue for our SIM(s).
325 	 */
326 	devq = cam_simq_alloc(maxq);
327 	if (devq == NULL) {
328 		mpt_prt(mpt, "Unable to allocate CAM SIMQ!\n");
329 		error = ENOMEM;
330 		goto cleanup;
331 	}
332 
333 	/*
334 	 * Construct our SIM entry.
335 	 */
336 	mpt->sim =
337 	    mpt_sim_alloc(mpt_action, mpt_poll, "mpt", mpt, 1, maxq, devq);
338 	if (mpt->sim == NULL) {
339 		mpt_prt(mpt, "Unable to allocate CAM SIM!\n");
340 		cam_simq_free(devq);
341 		error = ENOMEM;
342 		goto cleanup;
343 	}
344 
345 	/*
346 	 * Register exactly this bus.
347 	 */
348 	MPT_LOCK(mpt);
349 	if (mpt_xpt_bus_register(mpt->sim, mpt->dev, 0) != CAM_SUCCESS) {
350 		mpt_prt(mpt, "Bus registration Failed!\n");
351 		error = ENOMEM;
352 		MPT_UNLOCK(mpt);
353 		goto cleanup;
354 	}
355 
356 	if (xpt_create_path(&mpt->path, NULL, cam_sim_path(mpt->sim),
357 	    CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
358 		mpt_prt(mpt, "Unable to allocate Path!\n");
359 		error = ENOMEM;
360 		MPT_UNLOCK(mpt);
361 		goto cleanup;
362 	}
363 	MPT_UNLOCK(mpt);
364 
365 	/*
366 	 * Only register a second bus for RAID physical
367 	 * devices if the controller supports RAID.
368 	 */
369 	if (mpt->ioc_page2 == NULL || mpt->ioc_page2->MaxPhysDisks == 0) {
370 		return (0);
371 	}
372 
373 	/*
374 	 * Create a "bus" to export all hidden disks to CAM.
375 	 */
376 	mpt->phydisk_sim =
377 	    mpt_sim_alloc(mpt_action, mpt_poll, "mpt", mpt, 1, maxq, devq);
378 	if (mpt->phydisk_sim == NULL) {
379 		mpt_prt(mpt, "Unable to allocate Physical Disk CAM SIM!\n");
380 		error = ENOMEM;
381 		goto cleanup;
382 	}
383 
384 	/*
385 	 * Register this bus.
386 	 */
387 	MPT_LOCK(mpt);
388 	if (mpt_xpt_bus_register(mpt->phydisk_sim, mpt->dev, 1) !=
389 	    CAM_SUCCESS) {
390 		mpt_prt(mpt, "Physical Disk Bus registration Failed!\n");
391 		error = ENOMEM;
392 		MPT_UNLOCK(mpt);
393 		goto cleanup;
394 	}
395 
396 	if (xpt_create_path(&mpt->phydisk_path, NULL,
397 	    cam_sim_path(mpt->phydisk_sim),
398 	    CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
399 		mpt_prt(mpt, "Unable to allocate Physical Disk Path!\n");
400 		error = ENOMEM;
401 		MPT_UNLOCK(mpt);
402 		goto cleanup;
403 	}
404 	MPT_UNLOCK(mpt);
405 	mpt_lprt(mpt, MPT_PRT_DEBUG, "attached cam\n");
406 	return (0);
407 
408 cleanup:
409 	mpt_cam_detach(mpt);
410 	return (error);
411 }
412 
413 /*
414  * Read FC configuration information
415  */
416 static int
417 mpt_read_config_info_fc(struct mpt_softc *mpt)
418 {
419 	char *topology = NULL;
420 	int rv;
421 
422 	rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_FC_PORT, 0,
423 	    0, &mpt->mpt_fcport_page0.Header, FALSE, 5000);
424 	if (rv) {
425 		return (-1);
426 	}
427 	mpt_lprt(mpt, MPT_PRT_DEBUG, "FC Port Page 0 Header: %x %x %x %x\n",
428 		 mpt->mpt_fcport_page0.Header.PageVersion,
429 		 mpt->mpt_fcport_page0.Header.PageLength,
430 		 mpt->mpt_fcport_page0.Header.PageNumber,
431 		 mpt->mpt_fcport_page0.Header.PageType);
432 
433 
434 	rv = mpt_read_cur_cfg_page(mpt, 0, &mpt->mpt_fcport_page0.Header,
435 	    sizeof(mpt->mpt_fcport_page0), FALSE, 5000);
436 	if (rv) {
437 		mpt_prt(mpt, "failed to read FC Port Page 0\n");
438 		return (-1);
439 	}
440 	mpt2host_config_page_fc_port_0(&mpt->mpt_fcport_page0);
441 
442 	mpt->mpt_fcport_speed = mpt->mpt_fcport_page0.CurrentSpeed;
443 
444 	switch (mpt->mpt_fcport_page0.Flags &
445 	    MPI_FCPORTPAGE0_FLAGS_ATTACH_TYPE_MASK) {
446 	case MPI_FCPORTPAGE0_FLAGS_ATTACH_NO_INIT:
447 		mpt->mpt_fcport_speed = 0;
448 		topology = "<NO LOOP>";
449 		break;
450 	case MPI_FCPORTPAGE0_FLAGS_ATTACH_POINT_TO_POINT:
451 		topology = "N-Port";
452 		break;
453 	case MPI_FCPORTPAGE0_FLAGS_ATTACH_PRIVATE_LOOP:
454 		topology = "NL-Port";
455 		break;
456 	case MPI_FCPORTPAGE0_FLAGS_ATTACH_FABRIC_DIRECT:
457 		topology = "F-Port";
458 		break;
459 	case MPI_FCPORTPAGE0_FLAGS_ATTACH_PUBLIC_LOOP:
460 		topology = "FL-Port";
461 		break;
462 	default:
463 		mpt->mpt_fcport_speed = 0;
464 		topology = "?";
465 		break;
466 	}
467 
468 	mpt_lprt(mpt, MPT_PRT_INFO,
469 	    "FC Port Page 0: Topology <%s> WWNN 0x%08x%08x WWPN 0x%08x%08x "
470 	    "Speed %u-Gbit\n", topology,
471 	    mpt->mpt_fcport_page0.WWNN.High,
472 	    mpt->mpt_fcport_page0.WWNN.Low,
473 	    mpt->mpt_fcport_page0.WWPN.High,
474 	    mpt->mpt_fcport_page0.WWPN.Low,
475 	    mpt->mpt_fcport_speed);
476 #if __FreeBSD_version >= 500000
477 	MPT_UNLOCK(mpt);
478 	{
479 		struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(mpt->dev);
480 		struct sysctl_oid *tree = device_get_sysctl_tree(mpt->dev);
481 
482 		snprintf(mpt->scinfo.fc.wwnn,
483 		    sizeof (mpt->scinfo.fc.wwnn), "0x%08x%08x",
484 		    mpt->mpt_fcport_page0.WWNN.High,
485 		    mpt->mpt_fcport_page0.WWNN.Low);
486 
487 		snprintf(mpt->scinfo.fc.wwpn,
488 		    sizeof (mpt->scinfo.fc.wwpn), "0x%08x%08x",
489 		    mpt->mpt_fcport_page0.WWPN.High,
490 		    mpt->mpt_fcport_page0.WWPN.Low);
491 
492 		SYSCTL_ADD_STRING(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
493 		       "wwnn", CTLFLAG_RD, mpt->scinfo.fc.wwnn, 0,
494 		       "World Wide Node Name");
495 
496 		SYSCTL_ADD_STRING(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
497 		       "wwpn", CTLFLAG_RD, mpt->scinfo.fc.wwpn, 0,
498 		       "World Wide Port Name");
499 
500 	}
501 	MPT_LOCK(mpt);
502 #endif
503 	return (0);
504 }
505 
506 /*
507  * Set FC configuration information.
508  */
509 static int
510 mpt_set_initial_config_fc(struct mpt_softc *mpt)
511 {
512 
513 	CONFIG_PAGE_FC_PORT_1 fc;
514 	U32 fl;
515 	int r, doit = 0;
516 	int role;
517 
518 	r = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_FC_PORT, 1, 0,
519 	    &fc.Header, FALSE, 5000);
520 	if (r) {
521 		mpt_prt(mpt, "failed to read FC page 1 header\n");
522 		return (mpt_fc_reset_link(mpt, 1));
523 	}
524 
525 	r = mpt_read_cfg_page(mpt, MPI_CONFIG_ACTION_PAGE_READ_NVRAM, 0,
526 	    &fc.Header, sizeof (fc), FALSE, 5000);
527 	if (r) {
528 		mpt_prt(mpt, "failed to read FC page 1\n");
529 		return (mpt_fc_reset_link(mpt, 1));
530 	}
531 	mpt2host_config_page_fc_port_1(&fc);
532 
533 	/*
534 	 * Check our flags to make sure we support the role we want.
535 	 */
536 	doit = 0;
537 	role = 0;
538 	fl = fc.Flags;
539 
540 	if (fl & MPI_FCPORTPAGE1_FLAGS_PROT_FCP_INIT) {
541 		role |= MPT_ROLE_INITIATOR;
542 	}
543 	if (fl & MPI_FCPORTPAGE1_FLAGS_PROT_FCP_TARG) {
544 		role |= MPT_ROLE_TARGET;
545 	}
546 
547 	fl &= ~MPI_FCPORTPAGE1_FLAGS_PROT_MASK;
548 
549 	if (mpt->do_cfg_role == 0) {
550 		role = mpt->cfg_role;
551 	} else {
552 		mpt->do_cfg_role = 0;
553 	}
554 
555 	if (role != mpt->cfg_role) {
556 		if (mpt->cfg_role & MPT_ROLE_INITIATOR) {
557 			if ((role & MPT_ROLE_INITIATOR) == 0) {
558 				mpt_prt(mpt, "adding initiator role\n");
559 				fl |= MPI_FCPORTPAGE1_FLAGS_PROT_FCP_INIT;
560 				doit++;
561 			} else {
562 				mpt_prt(mpt, "keeping initiator role\n");
563 			}
564 		} else if (role & MPT_ROLE_INITIATOR) {
565 			mpt_prt(mpt, "removing initiator role\n");
566 			doit++;
567 		}
568 		if (mpt->cfg_role & MPT_ROLE_TARGET) {
569 			if ((role & MPT_ROLE_TARGET) == 0) {
570 				mpt_prt(mpt, "adding target role\n");
571 				fl |= MPI_FCPORTPAGE1_FLAGS_PROT_FCP_TARG;
572 				doit++;
573 			} else {
574 				mpt_prt(mpt, "keeping target role\n");
575 			}
576 		} else if (role & MPT_ROLE_TARGET) {
577 			mpt_prt(mpt, "removing target role\n");
578 			doit++;
579 		}
580 		mpt->role = mpt->cfg_role;
581 	}
582 
583 	if (fl & MPI_FCPORTPAGE1_FLAGS_PROT_FCP_TARG) {
584 		if ((fl & MPI_FCPORTPAGE1_FLAGS_TARGET_MODE_OXID) == 0) {
585 			mpt_prt(mpt, "adding OXID option\n");
586 			fl |= MPI_FCPORTPAGE1_FLAGS_TARGET_MODE_OXID;
587 			doit++;
588 		}
589 	}
590 
591 	if (doit) {
592 		fc.Flags = fl;
593 		host2mpt_config_page_fc_port_1(&fc);
594 		r = mpt_write_cfg_page(mpt,
595 		    MPI_CONFIG_ACTION_PAGE_WRITE_NVRAM, 0, &fc.Header,
596 		    sizeof(fc), FALSE, 5000);
597 		if (r != 0) {
598 			mpt_prt(mpt, "failed to update NVRAM with changes\n");
599 			return (0);
600 		}
601 		mpt_prt(mpt, "NOTE: NVRAM changes will not take "
602 		    "effect until next reboot or IOC reset\n");
603 	}
604 	return (0);
605 }
606 
607 static int
608 mptsas_sas_io_unit_pg0(struct mpt_softc *mpt, struct mptsas_portinfo *portinfo)
609 {
610 	ConfigExtendedPageHeader_t hdr;
611 	struct mptsas_phyinfo *phyinfo;
612 	SasIOUnitPage0_t *buffer;
613 	int error, len, i;
614 
615 	error = mpt_read_extcfg_header(mpt, MPI_SASIOUNITPAGE0_PAGEVERSION,
616 				       0, 0, MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT,
617 				       &hdr, 0, 10000);
618 	if (error)
619 		goto out;
620 	if (hdr.ExtPageLength == 0) {
621 		error = ENXIO;
622 		goto out;
623 	}
624 
625 	len = hdr.ExtPageLength * 4;
626 	buffer = malloc(len, M_DEVBUF, M_NOWAIT|M_ZERO);
627 	if (buffer == NULL) {
628 		error = ENOMEM;
629 		goto out;
630 	}
631 
632 	error = mpt_read_extcfg_page(mpt, MPI_CONFIG_ACTION_PAGE_READ_CURRENT,
633 				     0, &hdr, buffer, len, 0, 10000);
634 	if (error) {
635 		free(buffer, M_DEVBUF);
636 		goto out;
637 	}
638 
639 	portinfo->num_phys = buffer->NumPhys;
640 	portinfo->phy_info = malloc(sizeof(*portinfo->phy_info) *
641 	    portinfo->num_phys, M_DEVBUF, M_NOWAIT|M_ZERO);
642 	if (portinfo->phy_info == NULL) {
643 		free(buffer, M_DEVBUF);
644 		error = ENOMEM;
645 		goto out;
646 	}
647 
648 	for (i = 0; i < portinfo->num_phys; i++) {
649 		phyinfo = &portinfo->phy_info[i];
650 		phyinfo->phy_num = i;
651 		phyinfo->port_id = buffer->PhyData[i].Port;
652 		phyinfo->negotiated_link_rate =
653 		    buffer->PhyData[i].NegotiatedLinkRate;
654 		phyinfo->handle =
655 		    le16toh(buffer->PhyData[i].ControllerDevHandle);
656 	}
657 
658 	free(buffer, M_DEVBUF);
659 out:
660 	return (error);
661 }
662 
663 static int
664 mptsas_sas_phy_pg0(struct mpt_softc *mpt, struct mptsas_phyinfo *phy_info,
665 	uint32_t form, uint32_t form_specific)
666 {
667 	ConfigExtendedPageHeader_t hdr;
668 	SasPhyPage0_t *buffer;
669 	int error;
670 
671 	error = mpt_read_extcfg_header(mpt, MPI_SASPHY0_PAGEVERSION, 0, 0,
672 				       MPI_CONFIG_EXTPAGETYPE_SAS_PHY, &hdr,
673 				       0, 10000);
674 	if (error)
675 		goto out;
676 	if (hdr.ExtPageLength == 0) {
677 		error = ENXIO;
678 		goto out;
679 	}
680 
681 	buffer = malloc(sizeof(SasPhyPage0_t), M_DEVBUF, M_NOWAIT|M_ZERO);
682 	if (buffer == NULL) {
683 		error = ENOMEM;
684 		goto out;
685 	}
686 
687 	error = mpt_read_extcfg_page(mpt, MPI_CONFIG_ACTION_PAGE_READ_CURRENT,
688 				     form + form_specific, &hdr, buffer,
689 				     sizeof(SasPhyPage0_t), 0, 10000);
690 	if (error) {
691 		free(buffer, M_DEVBUF);
692 		goto out;
693 	}
694 
695 	phy_info->hw_link_rate = buffer->HwLinkRate;
696 	phy_info->programmed_link_rate = buffer->ProgrammedLinkRate;
697 	phy_info->identify.dev_handle = le16toh(buffer->OwnerDevHandle);
698 	phy_info->attached.dev_handle = le16toh(buffer->AttachedDevHandle);
699 
700 	free(buffer, M_DEVBUF);
701 out:
702 	return (error);
703 }
704 
705 static int
706 mptsas_sas_device_pg0(struct mpt_softc *mpt, struct mptsas_devinfo *device_info,
707 	uint32_t form, uint32_t form_specific)
708 {
709 	ConfigExtendedPageHeader_t hdr;
710 	SasDevicePage0_t *buffer;
711 	uint64_t sas_address;
712 	int error = 0;
713 
714 	bzero(device_info, sizeof(*device_info));
715 	error = mpt_read_extcfg_header(mpt, MPI_SASDEVICE0_PAGEVERSION, 0, 0,
716 				       MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE,
717 				       &hdr, 0, 10000);
718 	if (error)
719 		goto out;
720 	if (hdr.ExtPageLength == 0) {
721 		error = ENXIO;
722 		goto out;
723 	}
724 
725 	buffer = malloc(sizeof(SasDevicePage0_t), M_DEVBUF, M_NOWAIT|M_ZERO);
726 	if (buffer == NULL) {
727 		error = ENOMEM;
728 		goto out;
729 	}
730 
731 	error = mpt_read_extcfg_page(mpt, MPI_CONFIG_ACTION_PAGE_READ_CURRENT,
732 				     form + form_specific, &hdr, buffer,
733 				     sizeof(SasDevicePage0_t), 0, 10000);
734 	if (error) {
735 		free(buffer, M_DEVBUF);
736 		goto out;
737 	}
738 
739 	device_info->dev_handle = le16toh(buffer->DevHandle);
740 	device_info->parent_dev_handle = le16toh(buffer->ParentDevHandle);
741 	device_info->enclosure_handle = le16toh(buffer->EnclosureHandle);
742 	device_info->slot = le16toh(buffer->Slot);
743 	device_info->phy_num = buffer->PhyNum;
744 	device_info->physical_port = buffer->PhysicalPort;
745 	device_info->target_id = buffer->TargetID;
746 	device_info->bus = buffer->Bus;
747 	bcopy(&buffer->SASAddress, &sas_address, sizeof(uint64_t));
748 	device_info->sas_address = le64toh(sas_address);
749 	device_info->device_info = le32toh(buffer->DeviceInfo);
750 
751 	free(buffer, M_DEVBUF);
752 out:
753 	return (error);
754 }
755 
756 /*
757  * Read SAS configuration information. Nothing to do yet.
758  */
759 static int
760 mpt_read_config_info_sas(struct mpt_softc *mpt)
761 {
762 	struct mptsas_portinfo *portinfo;
763 	struct mptsas_phyinfo *phyinfo;
764 	int error, i;
765 
766 	portinfo = malloc(sizeof(*portinfo), M_DEVBUF, M_NOWAIT|M_ZERO);
767 	if (portinfo == NULL)
768 		return (ENOMEM);
769 
770 	error = mptsas_sas_io_unit_pg0(mpt, portinfo);
771 	if (error) {
772 		free(portinfo, M_DEVBUF);
773 		return (0);
774 	}
775 
776 	for (i = 0; i < portinfo->num_phys; i++) {
777 		phyinfo = &portinfo->phy_info[i];
778 		error = mptsas_sas_phy_pg0(mpt, phyinfo,
779 		    (MPI_SAS_PHY_PGAD_FORM_PHY_NUMBER <<
780 		    MPI_SAS_PHY_PGAD_FORM_SHIFT), i);
781 		if (error)
782 			break;
783 		error = mptsas_sas_device_pg0(mpt, &phyinfo->identify,
784 		    (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
785 		    MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
786 		    phyinfo->handle);
787 		if (error)
788 			break;
789 		phyinfo->identify.phy_num = phyinfo->phy_num = i;
790 		if (phyinfo->attached.dev_handle)
791 			error = mptsas_sas_device_pg0(mpt,
792 			    &phyinfo->attached,
793 			    (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
794 			    MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
795 			    phyinfo->attached.dev_handle);
796 		if (error)
797 			break;
798 	}
799 	mpt->sas_portinfo = portinfo;
800 	return (0);
801 }
802 
803 static void
804 mptsas_set_sata_wc(struct mpt_softc *mpt, struct mptsas_devinfo *devinfo,
805 	int enabled)
806 {
807 	SataPassthroughRequest_t	*pass;
808 	request_t *req;
809 	int error, status;
810 
811 	req = mpt_get_request(mpt, 0);
812 	if (req == NULL)
813 		return;
814 
815 	pass = req->req_vbuf;
816 	bzero(pass, sizeof(SataPassthroughRequest_t));
817 	pass->Function = MPI_FUNCTION_SATA_PASSTHROUGH;
818 	pass->TargetID = devinfo->target_id;
819 	pass->Bus = devinfo->bus;
820 	pass->PassthroughFlags = 0;
821 	pass->ConnectionRate = MPI_SATA_PT_REQ_CONNECT_RATE_NEGOTIATED;
822 	pass->DataLength = 0;
823 	pass->MsgContext = htole32(req->index | sata_pass_handler_id);
824 	pass->CommandFIS[0] = 0x27;
825 	pass->CommandFIS[1] = 0x80;
826 	pass->CommandFIS[2] = 0xef;
827 	pass->CommandFIS[3] = (enabled) ? 0x02 : 0x82;
828 	pass->CommandFIS[7] = 0x40;
829 	pass->CommandFIS[15] = 0x08;
830 
831 	mpt_check_doorbell(mpt);
832 	mpt_send_cmd(mpt, req);
833 	error = mpt_wait_req(mpt, req, REQ_STATE_DONE, REQ_STATE_DONE, 0,
834 			     10 * 1000);
835 	if (error) {
836 		mpt_free_request(mpt, req);
837 		printf("error %d sending passthrough\n", error);
838 		return;
839 	}
840 
841 	status = le16toh(req->IOCStatus);
842 	if (status != MPI_IOCSTATUS_SUCCESS) {
843 		mpt_free_request(mpt, req);
844 		printf("IOCSTATUS %d\n", status);
845 		return;
846 	}
847 
848 	mpt_free_request(mpt, req);
849 }
850 
851 /*
852  * Set SAS configuration information. Nothing to do yet.
853  */
854 static int
855 mpt_set_initial_config_sas(struct mpt_softc *mpt)
856 {
857 	struct mptsas_phyinfo *phyinfo;
858 	int i;
859 
860 	if ((mpt_enable_sata_wc != -1) && (mpt->sas_portinfo != NULL)) {
861 		for (i = 0; i < mpt->sas_portinfo->num_phys; i++) {
862 			phyinfo = &mpt->sas_portinfo->phy_info[i];
863 			if (phyinfo->attached.dev_handle == 0)
864 				continue;
865 			if ((phyinfo->attached.device_info &
866 			    MPI_SAS_DEVICE_INFO_SATA_DEVICE) == 0)
867 				continue;
868 			if (bootverbose)
869 				device_printf(mpt->dev,
870 				    "%sabling SATA WC on phy %d\n",
871 				    (mpt_enable_sata_wc) ? "En" : "Dis", i);
872 			mptsas_set_sata_wc(mpt, &phyinfo->attached,
873 					   mpt_enable_sata_wc);
874 		}
875 	}
876 
877 	return (0);
878 }
879 
880 static int
881 mpt_sata_pass_reply_handler(struct mpt_softc *mpt, request_t *req,
882  uint32_t reply_desc, MSG_DEFAULT_REPLY *reply_frame)
883 {
884 	if (req != NULL) {
885 
886 		if (reply_frame != NULL) {
887 			req->IOCStatus = le16toh(reply_frame->IOCStatus);
888 		}
889 		req->state &= ~REQ_STATE_QUEUED;
890 		req->state |= REQ_STATE_DONE;
891 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
892 		if ((req->state & REQ_STATE_NEED_WAKEUP) != 0) {
893 			wakeup(req);
894 		} else if ((req->state & REQ_STATE_TIMEDOUT) != 0) {
895 			/*
896 			 * Whew- we can free this request (late completion)
897 			 */
898 			mpt_free_request(mpt, req);
899 		}
900 	}
901 
902 	return (TRUE);
903 }
904 
905 /*
906  * Read SCSI configuration information
907  */
908 static int
909 mpt_read_config_info_spi(struct mpt_softc *mpt)
910 {
911 	int rv, i;
912 
913 	rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_SCSI_PORT, 0, 0,
914 	    &mpt->mpt_port_page0.Header, FALSE, 5000);
915 	if (rv) {
916 		return (-1);
917 	}
918 	mpt_lprt(mpt, MPT_PRT_DEBUG, "SPI Port Page 0 Header: %x %x %x %x\n",
919 	    mpt->mpt_port_page0.Header.PageVersion,
920 	    mpt->mpt_port_page0.Header.PageLength,
921 	    mpt->mpt_port_page0.Header.PageNumber,
922 	    mpt->mpt_port_page0.Header.PageType);
923 
924 	rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_SCSI_PORT, 1, 0,
925 	    &mpt->mpt_port_page1.Header, FALSE, 5000);
926 	if (rv) {
927 		return (-1);
928 	}
929 	mpt_lprt(mpt, MPT_PRT_DEBUG, "SPI Port Page 1 Header: %x %x %x %x\n",
930 	    mpt->mpt_port_page1.Header.PageVersion,
931 	    mpt->mpt_port_page1.Header.PageLength,
932 	    mpt->mpt_port_page1.Header.PageNumber,
933 	    mpt->mpt_port_page1.Header.PageType);
934 
935 	rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_SCSI_PORT, 2, 0,
936 	    &mpt->mpt_port_page2.Header, FALSE, 5000);
937 	if (rv) {
938 		return (-1);
939 	}
940 	mpt_lprt(mpt, MPT_PRT_DEBUG, "SPI Port Page 2 Header: %x %x %x %x\n",
941 	    mpt->mpt_port_page2.Header.PageVersion,
942 	    mpt->mpt_port_page2.Header.PageLength,
943 	    mpt->mpt_port_page2.Header.PageNumber,
944 	    mpt->mpt_port_page2.Header.PageType);
945 
946 	for (i = 0; i < 16; i++) {
947 		rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_SCSI_DEVICE,
948 		    0, i, &mpt->mpt_dev_page0[i].Header, FALSE, 5000);
949 		if (rv) {
950 			return (-1);
951 		}
952 		mpt_lprt(mpt, MPT_PRT_DEBUG,
953 		    "SPI Target %d Device Page 0 Header: %x %x %x %x\n", i,
954 		    mpt->mpt_dev_page0[i].Header.PageVersion,
955 		    mpt->mpt_dev_page0[i].Header.PageLength,
956 		    mpt->mpt_dev_page0[i].Header.PageNumber,
957 		    mpt->mpt_dev_page0[i].Header.PageType);
958 
959 		rv = mpt_read_cfg_header(mpt, MPI_CONFIG_PAGETYPE_SCSI_DEVICE,
960 		    1, i, &mpt->mpt_dev_page1[i].Header, FALSE, 5000);
961 		if (rv) {
962 			return (-1);
963 		}
964 		mpt_lprt(mpt, MPT_PRT_DEBUG,
965 		    "SPI Target %d Device Page 1 Header: %x %x %x %x\n", i,
966 		    mpt->mpt_dev_page1[i].Header.PageVersion,
967 		    mpt->mpt_dev_page1[i].Header.PageLength,
968 		    mpt->mpt_dev_page1[i].Header.PageNumber,
969 		    mpt->mpt_dev_page1[i].Header.PageType);
970 	}
971 
972 	/*
973 	 * At this point, we don't *have* to fail. As long as we have
974 	 * valid config header information, we can (barely) lurch
975 	 * along.
976 	 */
977 
978 	rv = mpt_read_cur_cfg_page(mpt, 0, &mpt->mpt_port_page0.Header,
979 	    sizeof(mpt->mpt_port_page0), FALSE, 5000);
980 	if (rv) {
981 		mpt_prt(mpt, "failed to read SPI Port Page 0\n");
982 	} else {
983 		mpt2host_config_page_scsi_port_0(&mpt->mpt_port_page0);
984 		mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
985 		    "SPI Port Page 0: Capabilities %x PhysicalInterface %x\n",
986 		    mpt->mpt_port_page0.Capabilities,
987 		    mpt->mpt_port_page0.PhysicalInterface);
988 	}
989 
990 	rv = mpt_read_cur_cfg_page(mpt, 0, &mpt->mpt_port_page1.Header,
991 	    sizeof(mpt->mpt_port_page1), FALSE, 5000);
992 	if (rv) {
993 		mpt_prt(mpt, "failed to read SPI Port Page 1\n");
994 	} else {
995 		mpt2host_config_page_scsi_port_1(&mpt->mpt_port_page1);
996 		mpt_lprt(mpt, MPT_PRT_DEBUG,
997 		    "SPI Port Page 1: Configuration %x OnBusTimerValue %x\n",
998 		    mpt->mpt_port_page1.Configuration,
999 		    mpt->mpt_port_page1.OnBusTimerValue);
1000 	}
1001 
1002 	rv = mpt_read_cur_cfg_page(mpt, 0, &mpt->mpt_port_page2.Header,
1003 	    sizeof(mpt->mpt_port_page2), FALSE, 5000);
1004 	if (rv) {
1005 		mpt_prt(mpt, "failed to read SPI Port Page 2\n");
1006 	} else {
1007 		mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
1008 		    "Port Page 2: Flags %x Settings %x\n",
1009 		    mpt->mpt_port_page2.PortFlags,
1010 		    mpt->mpt_port_page2.PortSettings);
1011 		mpt2host_config_page_scsi_port_2(&mpt->mpt_port_page2);
1012 		for (i = 0; i < 16; i++) {
1013 			mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
1014 		  	    " Port Page 2 Tgt %d: timo %x SF %x Flags %x\n",
1015 			    i, mpt->mpt_port_page2.DeviceSettings[i].Timeout,
1016 			    mpt->mpt_port_page2.DeviceSettings[i].SyncFactor,
1017 			    mpt->mpt_port_page2.DeviceSettings[i].DeviceFlags);
1018 		}
1019 	}
1020 
1021 	for (i = 0; i < 16; i++) {
1022 		rv = mpt_read_cur_cfg_page(mpt, i,
1023 		    &mpt->mpt_dev_page0[i].Header, sizeof(*mpt->mpt_dev_page0),
1024 		    FALSE, 5000);
1025 		if (rv) {
1026 			mpt_prt(mpt,
1027 			    "cannot read SPI Target %d Device Page 0\n", i);
1028 			continue;
1029 		}
1030 		mpt2host_config_page_scsi_device_0(&mpt->mpt_dev_page0[i]);
1031 		mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
1032 		    "target %d page 0: Negotiated Params %x Information %x\n",
1033 		    i, mpt->mpt_dev_page0[i].NegotiatedParameters,
1034 		    mpt->mpt_dev_page0[i].Information);
1035 
1036 		rv = mpt_read_cur_cfg_page(mpt, i,
1037 		    &mpt->mpt_dev_page1[i].Header, sizeof(*mpt->mpt_dev_page1),
1038 		    FALSE, 5000);
1039 		if (rv) {
1040 			mpt_prt(mpt,
1041 			    "cannot read SPI Target %d Device Page 1\n", i);
1042 			continue;
1043 		}
1044 		mpt2host_config_page_scsi_device_1(&mpt->mpt_dev_page1[i]);
1045 		mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
1046 		    "target %d page 1: Requested Params %x Configuration %x\n",
1047 		    i, mpt->mpt_dev_page1[i].RequestedParameters,
1048 		    mpt->mpt_dev_page1[i].Configuration);
1049 	}
1050 	return (0);
1051 }
1052 
1053 /*
1054  * Validate SPI configuration information.
1055  *
1056  * In particular, validate SPI Port Page 1.
1057  */
1058 static int
1059 mpt_set_initial_config_spi(struct mpt_softc *mpt)
1060 {
1061 	int error, i, pp1val;
1062 
1063 	mpt->mpt_disc_enable = 0xff;
1064 	mpt->mpt_tag_enable = 0;
1065 
1066 	pp1val = ((1 << mpt->mpt_ini_id) <<
1067 	    MPI_SCSIPORTPAGE1_CFG_SHIFT_PORT_RESPONSE_ID) | mpt->mpt_ini_id;
1068 	if (mpt->mpt_port_page1.Configuration != pp1val) {
1069 		CONFIG_PAGE_SCSI_PORT_1 tmp;
1070 
1071 		mpt_prt(mpt, "SPI Port Page 1 Config value bad (%x)- should "
1072 		    "be %x\n", mpt->mpt_port_page1.Configuration, pp1val);
1073 		tmp = mpt->mpt_port_page1;
1074 		tmp.Configuration = pp1val;
1075 		host2mpt_config_page_scsi_port_1(&tmp);
1076 		error = mpt_write_cur_cfg_page(mpt, 0,
1077 		    &tmp.Header, sizeof(tmp), FALSE, 5000);
1078 		if (error) {
1079 			return (-1);
1080 		}
1081 		error = mpt_read_cur_cfg_page(mpt, 0,
1082 		    &tmp.Header, sizeof(tmp), FALSE, 5000);
1083 		if (error) {
1084 			return (-1);
1085 		}
1086 		mpt2host_config_page_scsi_port_1(&tmp);
1087 		if (tmp.Configuration != pp1val) {
1088 			mpt_prt(mpt,
1089 			    "failed to reset SPI Port Page 1 Config value\n");
1090 			return (-1);
1091 		}
1092 		mpt->mpt_port_page1 = tmp;
1093 	}
1094 
1095 	/*
1096 	 * The purpose of this exercise is to get
1097 	 * all targets back to async/narrow.
1098 	 *
1099 	 * We skip this step if the BIOS has already negotiated
1100 	 * speeds with the targets.
1101 	 */
1102 	i = mpt->mpt_port_page2.PortSettings &
1103 	    MPI_SCSIPORTPAGE2_PORT_MASK_NEGO_MASTER_SETTINGS;
1104 	if (i == MPI_SCSIPORTPAGE2_PORT_ALL_MASTER_SETTINGS) {
1105 		mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
1106 		    "honoring BIOS transfer negotiations\n");
1107 	} else {
1108 		for (i = 0; i < 16; i++) {
1109 			mpt->mpt_dev_page1[i].RequestedParameters = 0;
1110 			mpt->mpt_dev_page1[i].Configuration = 0;
1111 			(void) mpt_update_spi_config(mpt, i);
1112 		}
1113 	}
1114 	return (0);
1115 }
1116 
1117 int
1118 mpt_cam_enable(struct mpt_softc *mpt)
1119 {
1120 	int error;
1121 
1122 	MPT_LOCK(mpt);
1123 
1124 	error = EIO;
1125 	if (mpt->is_fc) {
1126 		if (mpt_read_config_info_fc(mpt)) {
1127 			goto out;
1128 		}
1129 		if (mpt_set_initial_config_fc(mpt)) {
1130 			goto out;
1131 		}
1132 	} else if (mpt->is_sas) {
1133 		if (mpt_read_config_info_sas(mpt)) {
1134 			goto out;
1135 		}
1136 		if (mpt_set_initial_config_sas(mpt)) {
1137 			goto out;
1138 		}
1139 	} else if (mpt->is_spi) {
1140 		if (mpt_read_config_info_spi(mpt)) {
1141 			goto out;
1142 		}
1143 		if (mpt_set_initial_config_spi(mpt)) {
1144 			goto out;
1145 		}
1146 	}
1147 	error = 0;
1148 
1149 out:
1150 	MPT_UNLOCK(mpt);
1151 	return (error);
1152 }
1153 
1154 void
1155 mpt_cam_ready(struct mpt_softc *mpt)
1156 {
1157 	/*
1158 	 * If we're in target mode, hang out resources now
1159 	 * so we don't cause the world to hang talking to us.
1160 	 */
1161 	if (mpt->is_fc && (mpt->role & MPT_ROLE_TARGET)) {
1162 		/*
1163 		 * Try to add some target command resources
1164 		 */
1165 		MPT_LOCK(mpt);
1166 		if (mpt_add_target_commands(mpt) == FALSE) {
1167 			mpt_prt(mpt, "failed to add target commands\n");
1168 		}
1169 		MPT_UNLOCK(mpt);
1170 	}
1171 	mpt->ready = 1;
1172 }
1173 
1174 void
1175 mpt_cam_detach(struct mpt_softc *mpt)
1176 {
1177 	mpt_handler_t handler;
1178 
1179 	MPT_LOCK(mpt);
1180 	mpt->ready = 0;
1181 	mpt_terminate_recovery_thread(mpt);
1182 
1183 	handler.reply_handler = mpt_scsi_reply_handler;
1184 	mpt_deregister_handler(mpt, MPT_HANDLER_REPLY, handler,
1185 			       scsi_io_handler_id);
1186 	handler.reply_handler = mpt_scsi_tmf_reply_handler;
1187 	mpt_deregister_handler(mpt, MPT_HANDLER_REPLY, handler,
1188 			       scsi_tmf_handler_id);
1189 	handler.reply_handler = mpt_fc_els_reply_handler;
1190 	mpt_deregister_handler(mpt, MPT_HANDLER_REPLY, handler,
1191 			       fc_els_handler_id);
1192 	handler.reply_handler = mpt_scsi_tgt_reply_handler;
1193 	mpt_deregister_handler(mpt, MPT_HANDLER_REPLY, handler,
1194 			       mpt->scsi_tgt_handler_id);
1195 	handler.reply_handler = mpt_sata_pass_reply_handler;
1196 	mpt_deregister_handler(mpt, MPT_HANDLER_REPLY, handler,
1197 			       sata_pass_handler_id);
1198 
1199 	if (mpt->tmf_req != NULL) {
1200 		mpt->tmf_req->state = REQ_STATE_ALLOCATED;
1201 		mpt_free_request(mpt, mpt->tmf_req);
1202 		mpt->tmf_req = NULL;
1203 	}
1204 	if (mpt->sas_portinfo != NULL) {
1205 		free(mpt->sas_portinfo, M_DEVBUF);
1206 		mpt->sas_portinfo = NULL;
1207 	}
1208 	MPT_UNLOCK(mpt);
1209 
1210 	if (mpt->sim != NULL) {
1211 		xpt_free_path(mpt->path);
1212 		MPT_LOCK(mpt);
1213 		xpt_bus_deregister(cam_sim_path(mpt->sim));
1214 		MPT_UNLOCK(mpt);
1215 		cam_sim_free(mpt->sim, TRUE);
1216 		mpt->sim = NULL;
1217 	}
1218 
1219 	if (mpt->phydisk_sim != NULL) {
1220 		xpt_free_path(mpt->phydisk_path);
1221 		MPT_LOCK(mpt);
1222 		xpt_bus_deregister(cam_sim_path(mpt->phydisk_sim));
1223 		MPT_UNLOCK(mpt);
1224 		cam_sim_free(mpt->phydisk_sim, TRUE);
1225 		mpt->phydisk_sim = NULL;
1226 	}
1227 }
1228 
1229 /* This routine is used after a system crash to dump core onto the swap device.
1230  */
1231 static void
1232 mpt_poll(struct cam_sim *sim)
1233 {
1234 	struct mpt_softc *mpt;
1235 
1236 	mpt = (struct mpt_softc *)cam_sim_softc(sim);
1237 	mpt_intr(mpt);
1238 }
1239 
1240 /*
1241  * Watchdog timeout routine for SCSI requests.
1242  */
1243 static void
1244 mpt_timeout(void *arg)
1245 {
1246 	union ccb	 *ccb;
1247 	struct mpt_softc *mpt;
1248 	request_t	 *req;
1249 
1250 	ccb = (union ccb *)arg;
1251 	mpt = ccb->ccb_h.ccb_mpt_ptr;
1252 
1253 #if __FreeBSD_version < 500000
1254 	MPT_LOCK(mpt);
1255 #endif
1256 	MPT_LOCK_ASSERT(mpt);
1257 	req = ccb->ccb_h.ccb_req_ptr;
1258 	mpt_prt(mpt, "request %p:%u timed out for ccb %p (req->ccb %p)\n", req,
1259 	    req->serno, ccb, req->ccb);
1260 /* XXX: WHAT ARE WE TRYING TO DO HERE? */
1261 	if ((req->state & REQ_STATE_QUEUED) == REQ_STATE_QUEUED) {
1262 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
1263 		TAILQ_INSERT_TAIL(&mpt->request_timeout_list, req, links);
1264 		req->state |= REQ_STATE_TIMEDOUT;
1265 		mpt_wakeup_recovery_thread(mpt);
1266 	}
1267 #if __FreeBSD_version < 500000
1268 	MPT_UNLOCK(mpt);
1269 #endif
1270 }
1271 
1272 /*
1273  * Callback routine from "bus_dmamap_load" or, in simple cases, called directly.
1274  *
1275  * Takes a list of physical segments and builds the SGL for SCSI IO command
1276  * and forwards the commard to the IOC after one last check that CAM has not
1277  * aborted the transaction.
1278  */
1279 static void
1280 mpt_execute_req_a64(void *arg, bus_dma_segment_t *dm_segs, int nseg, int error)
1281 {
1282 	request_t *req, *trq;
1283 	char *mpt_off;
1284 	union ccb *ccb;
1285 	struct mpt_softc *mpt;
1286 	int seg, first_lim;
1287 	uint32_t flags, nxt_off;
1288 	void *sglp = NULL;
1289 	MSG_REQUEST_HEADER *hdrp;
1290 	SGE_SIMPLE64 *se;
1291 	SGE_CHAIN64 *ce;
1292 	int istgt = 0;
1293 
1294 	req = (request_t *)arg;
1295 	ccb = req->ccb;
1296 
1297 	mpt = ccb->ccb_h.ccb_mpt_ptr;
1298 	req = ccb->ccb_h.ccb_req_ptr;
1299 
1300 	hdrp = req->req_vbuf;
1301 	mpt_off = req->req_vbuf;
1302 
1303 	if (error == 0 && ((uint32_t)nseg) >= mpt->max_seg_cnt) {
1304 		error = EFBIG;
1305 	}
1306 
1307 	if (error == 0) {
1308 		switch (hdrp->Function) {
1309 		case MPI_FUNCTION_SCSI_IO_REQUEST:
1310 		case MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH:
1311 			istgt = 0;
1312 			sglp = &((PTR_MSG_SCSI_IO_REQUEST)hdrp)->SGL;
1313 			break;
1314 		case MPI_FUNCTION_TARGET_ASSIST:
1315 			istgt = 1;
1316 			sglp = &((PTR_MSG_TARGET_ASSIST_REQUEST)hdrp)->SGL;
1317 			break;
1318 		default:
1319 			mpt_prt(mpt, "bad fct 0x%x in mpt_execute_req_a64\n",
1320 			    hdrp->Function);
1321 			error = EINVAL;
1322 			break;
1323 		}
1324 	}
1325 
1326 	if (error == 0 && ((uint32_t)nseg) >= mpt->max_seg_cnt) {
1327 		error = EFBIG;
1328 		mpt_prt(mpt, "segment count %d too large (max %u)\n",
1329 		    nseg, mpt->max_seg_cnt);
1330 	}
1331 
1332 bad:
1333 	if (error != 0) {
1334 		if (error != EFBIG && error != ENOMEM) {
1335 			mpt_prt(mpt, "mpt_execute_req_a64: err %d\n", error);
1336 		}
1337 		if ((ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_INPROG) {
1338 			cam_status status;
1339 			mpt_freeze_ccb(ccb);
1340 			if (error == EFBIG) {
1341 				status = CAM_REQ_TOO_BIG;
1342 			} else if (error == ENOMEM) {
1343 				if (mpt->outofbeer == 0) {
1344 					mpt->outofbeer = 1;
1345 					xpt_freeze_simq(mpt->sim, 1);
1346 					mpt_lprt(mpt, MPT_PRT_DEBUG,
1347 					    "FREEZEQ\n");
1348 				}
1349 				status = CAM_REQUEUE_REQ;
1350 			} else {
1351 				status = CAM_REQ_CMP_ERR;
1352 			}
1353 			mpt_set_ccb_status(ccb, status);
1354 		}
1355 		if (hdrp->Function == MPI_FUNCTION_TARGET_ASSIST) {
1356 			request_t *cmd_req =
1357 				MPT_TAG_2_REQ(mpt, ccb->csio.tag_id);
1358 			MPT_TGT_STATE(mpt, cmd_req)->state = TGT_STATE_IN_CAM;
1359 			MPT_TGT_STATE(mpt, cmd_req)->ccb = NULL;
1360 			MPT_TGT_STATE(mpt, cmd_req)->req = NULL;
1361 		}
1362 		ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
1363 		KASSERT(ccb->ccb_h.status, ("zero ccb sts at %d\n", __LINE__));
1364 		xpt_done(ccb);
1365 		CAMLOCK_2_MPTLOCK(mpt);
1366 		mpt_free_request(mpt, req);
1367 		MPTLOCK_2_CAMLOCK(mpt);
1368 		return;
1369 	}
1370 
1371 	/*
1372 	 * No data to transfer?
1373 	 * Just make a single simple SGL with zero length.
1374 	 */
1375 
1376 	if (mpt->verbose >= MPT_PRT_DEBUG) {
1377 		int tidx = ((char *)sglp) - mpt_off;
1378 		memset(&mpt_off[tidx], 0xff, MPT_REQUEST_AREA - tidx);
1379 	}
1380 
1381 	if (nseg == 0) {
1382 		SGE_SIMPLE32 *se1 = (SGE_SIMPLE32 *) sglp;
1383 		MPI_pSGE_SET_FLAGS(se1,
1384 		    (MPI_SGE_FLAGS_LAST_ELEMENT | MPI_SGE_FLAGS_END_OF_BUFFER |
1385 		    MPI_SGE_FLAGS_SIMPLE_ELEMENT | MPI_SGE_FLAGS_END_OF_LIST));
1386 		se1->FlagsLength = htole32(se1->FlagsLength);
1387 		goto out;
1388 	}
1389 
1390 
1391 	flags = MPI_SGE_FLAGS_SIMPLE_ELEMENT | MPI_SGE_FLAGS_64_BIT_ADDRESSING;
1392 	if (istgt == 0) {
1393 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT) {
1394 			flags |= MPI_SGE_FLAGS_HOST_TO_IOC;
1395 		}
1396 	} else {
1397 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1398 			flags |= MPI_SGE_FLAGS_HOST_TO_IOC;
1399 		}
1400 	}
1401 
1402 	if (!(ccb->ccb_h.flags & (CAM_SG_LIST_PHYS|CAM_DATA_PHYS))) {
1403 		bus_dmasync_op_t op;
1404 		if (istgt == 0) {
1405 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1406 				op = BUS_DMASYNC_PREREAD;
1407 			} else {
1408 				op = BUS_DMASYNC_PREWRITE;
1409 			}
1410 		} else {
1411 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1412 				op = BUS_DMASYNC_PREWRITE;
1413 			} else {
1414 				op = BUS_DMASYNC_PREREAD;
1415 			}
1416 		}
1417 		bus_dmamap_sync(mpt->buffer_dmat, req->dmap, op);
1418 	}
1419 
1420 	/*
1421 	 * Okay, fill in what we can at the end of the command frame.
1422 	 * If we have up to MPT_NSGL_FIRST, we can fit them all into
1423 	 * the command frame.
1424 	 *
1425 	 * Otherwise, we fill up through MPT_NSGL_FIRST less one
1426 	 * SIMPLE64 pointers and start doing CHAIN64 entries after
1427 	 * that.
1428 	 */
1429 
1430 	if (nseg < MPT_NSGL_FIRST(mpt)) {
1431 		first_lim = nseg;
1432 	} else {
1433 		/*
1434 		 * Leave room for CHAIN element
1435 		 */
1436 		first_lim = MPT_NSGL_FIRST(mpt) - 1;
1437 	}
1438 
1439 	se = (SGE_SIMPLE64 *) sglp;
1440 	for (seg = 0; seg < first_lim; seg++, se++, dm_segs++) {
1441 		uint32_t tf;
1442 
1443 		memset(se, 0, sizeof (*se));
1444 		se->Address.Low = htole32(dm_segs->ds_addr & 0xffffffff);
1445 		if (sizeof(bus_addr_t) > 4) {
1446 			se->Address.High =
1447 			    htole32(((uint64_t)dm_segs->ds_addr) >> 32);
1448 		}
1449 		MPI_pSGE_SET_LENGTH(se, dm_segs->ds_len);
1450 		tf = flags;
1451 		if (seg == first_lim - 1) {
1452 			tf |= MPI_SGE_FLAGS_LAST_ELEMENT;
1453 		}
1454 		if (seg == nseg - 1) {
1455 			tf |=	MPI_SGE_FLAGS_END_OF_LIST |
1456 				MPI_SGE_FLAGS_END_OF_BUFFER;
1457 		}
1458 		MPI_pSGE_SET_FLAGS(se, tf);
1459 		se->FlagsLength = htole32(se->FlagsLength);
1460 	}
1461 
1462 	if (seg == nseg) {
1463 		goto out;
1464 	}
1465 
1466 	/*
1467 	 * Tell the IOC where to find the first chain element.
1468 	 */
1469 	hdrp->ChainOffset = ((char *)se - (char *)hdrp) >> 2;
1470 	nxt_off = MPT_RQSL(mpt);
1471 	trq = req;
1472 
1473 	/*
1474 	 * Make up the rest of the data segments out of a chain element
1475 	 * (contiained in the current request frame) which points to
1476 	 * SIMPLE64 elements in the next request frame, possibly ending
1477 	 * with *another* chain element (if there's more).
1478 	 */
1479 	while (seg < nseg) {
1480 		int this_seg_lim;
1481 		uint32_t tf, cur_off;
1482 		bus_addr_t chain_list_addr;
1483 
1484 		/*
1485 		 * Point to the chain descriptor. Note that the chain
1486 		 * descriptor is at the end of the *previous* list (whether
1487 		 * chain or simple).
1488 		 */
1489 		ce = (SGE_CHAIN64 *) se;
1490 
1491 		/*
1492 		 * Before we change our current pointer, make  sure we won't
1493 		 * overflow the request area with this frame. Note that we
1494 		 * test against 'greater than' here as it's okay in this case
1495 		 * to have next offset be just outside the request area.
1496 		 */
1497 		if ((nxt_off + MPT_RQSL(mpt)) > MPT_REQUEST_AREA) {
1498 			nxt_off = MPT_REQUEST_AREA;
1499 			goto next_chain;
1500 		}
1501 
1502 		/*
1503 		 * Set our SGE element pointer to the beginning of the chain
1504 		 * list and update our next chain list offset.
1505 		 */
1506 		se = (SGE_SIMPLE64 *) &mpt_off[nxt_off];
1507 		cur_off = nxt_off;
1508 		nxt_off += MPT_RQSL(mpt);
1509 
1510 		/*
1511 		 * Now initialized the chain descriptor.
1512 		 */
1513 		memset(ce, 0, sizeof (*ce));
1514 
1515 		/*
1516 		 * Get the physical address of the chain list.
1517 		 */
1518 		chain_list_addr = trq->req_pbuf;
1519 		chain_list_addr += cur_off;
1520 		if (sizeof (bus_addr_t) > 4) {
1521 			ce->Address.High =
1522 			    htole32(((uint64_t)chain_list_addr) >> 32);
1523 		}
1524 		ce->Address.Low = htole32(chain_list_addr & 0xffffffff);
1525 		ce->Flags = MPI_SGE_FLAGS_CHAIN_ELEMENT |
1526 			    MPI_SGE_FLAGS_64_BIT_ADDRESSING;
1527 
1528 		/*
1529 		 * If we have more than a frame's worth of segments left,
1530 		 * set up the chain list to have the last element be another
1531 		 * chain descriptor.
1532 		 */
1533 		if ((nseg - seg) > MPT_NSGL(mpt)) {
1534 			this_seg_lim = seg + MPT_NSGL(mpt) - 1;
1535 			/*
1536 			 * The length of the chain is the length in bytes of the
1537 			 * number of segments plus the next chain element.
1538 			 *
1539 			 * The next chain descriptor offset is the length,
1540 			 * in words, of the number of segments.
1541 			 */
1542 			ce->Length = (this_seg_lim - seg) *
1543 			    sizeof (SGE_SIMPLE64);
1544 			ce->NextChainOffset = ce->Length >> 2;
1545 			ce->Length += sizeof (SGE_CHAIN64);
1546 		} else {
1547 			this_seg_lim = nseg;
1548 			ce->Length = (this_seg_lim - seg) *
1549 			    sizeof (SGE_SIMPLE64);
1550 		}
1551 		ce->Length = htole16(ce->Length);
1552 
1553 		/*
1554 		 * Fill in the chain list SGE elements with our segment data.
1555 		 *
1556 		 * If we're the last element in this chain list, set the last
1557 		 * element flag. If we're the completely last element period,
1558 		 * set the end of list and end of buffer flags.
1559 		 */
1560 		while (seg < this_seg_lim) {
1561 			memset(se, 0, sizeof (*se));
1562 			se->Address.Low = htole32(dm_segs->ds_addr &
1563 			    0xffffffff);
1564 			if (sizeof (bus_addr_t) > 4) {
1565 				se->Address.High =
1566 				    htole32(((uint64_t)dm_segs->ds_addr) >> 32);
1567 			}
1568 			MPI_pSGE_SET_LENGTH(se, dm_segs->ds_len);
1569 			tf = flags;
1570 			if (seg ==  this_seg_lim - 1) {
1571 				tf |=	MPI_SGE_FLAGS_LAST_ELEMENT;
1572 			}
1573 			if (seg == nseg - 1) {
1574 				tf |=	MPI_SGE_FLAGS_END_OF_LIST |
1575 					MPI_SGE_FLAGS_END_OF_BUFFER;
1576 			}
1577 			MPI_pSGE_SET_FLAGS(se, tf);
1578 			se->FlagsLength = htole32(se->FlagsLength);
1579 			se++;
1580 			seg++;
1581 			dm_segs++;
1582 		}
1583 
1584     next_chain:
1585 		/*
1586 		 * If we have more segments to do and we've used up all of
1587 		 * the space in a request area, go allocate another one
1588 		 * and chain to that.
1589 		 */
1590 		if (seg < nseg && nxt_off >= MPT_REQUEST_AREA) {
1591 			request_t *nrq;
1592 
1593 			CAMLOCK_2_MPTLOCK(mpt);
1594 			nrq = mpt_get_request(mpt, FALSE);
1595 			MPTLOCK_2_CAMLOCK(mpt);
1596 
1597 			if (nrq == NULL) {
1598 				error = ENOMEM;
1599 				goto bad;
1600 			}
1601 
1602 			/*
1603 			 * Append the new request area on the tail of our list.
1604 			 */
1605 			if ((trq = req->chain) == NULL) {
1606 				req->chain = nrq;
1607 			} else {
1608 				while (trq->chain != NULL) {
1609 					trq = trq->chain;
1610 				}
1611 				trq->chain = nrq;
1612 			}
1613 			trq = nrq;
1614 			mpt_off = trq->req_vbuf;
1615 			if (mpt->verbose >= MPT_PRT_DEBUG) {
1616 				memset(mpt_off, 0xff, MPT_REQUEST_AREA);
1617 			}
1618 			nxt_off = 0;
1619 		}
1620 	}
1621 out:
1622 
1623 	/*
1624 	 * Last time we need to check if this CCB needs to be aborted.
1625 	 */
1626 	if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_INPROG) {
1627 		if (hdrp->Function == MPI_FUNCTION_TARGET_ASSIST) {
1628 			request_t *cmd_req =
1629 				MPT_TAG_2_REQ(mpt, ccb->csio.tag_id);
1630 			MPT_TGT_STATE(mpt, cmd_req)->state = TGT_STATE_IN_CAM;
1631 			MPT_TGT_STATE(mpt, cmd_req)->ccb = NULL;
1632 			MPT_TGT_STATE(mpt, cmd_req)->req = NULL;
1633 		}
1634 		mpt_prt(mpt,
1635 		    "mpt_execute_req_a64: I/O cancelled (status 0x%x)\n",
1636 		    ccb->ccb_h.status & CAM_STATUS_MASK);
1637 		if (nseg && (ccb->ccb_h.flags & CAM_SG_LIST_PHYS) == 0) {
1638 			bus_dmamap_unload(mpt->buffer_dmat, req->dmap);
1639 		}
1640 		ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
1641 		KASSERT(ccb->ccb_h.status, ("zero ccb sts at %d\n", __LINE__));
1642 		xpt_done(ccb);
1643 		CAMLOCK_2_MPTLOCK(mpt);
1644 		mpt_free_request(mpt, req);
1645 		MPTLOCK_2_CAMLOCK(mpt);
1646 		return;
1647 	}
1648 
1649 	ccb->ccb_h.status |= CAM_SIM_QUEUED;
1650 	if (ccb->ccb_h.timeout != CAM_TIME_INFINITY) {
1651 		mpt_req_timeout(req, (ccb->ccb_h.timeout * hz) / 1000,
1652 		    mpt_timeout, ccb);
1653 	}
1654 	if (mpt->verbose > MPT_PRT_DEBUG) {
1655 		int nc = 0;
1656 		mpt_print_request(req->req_vbuf);
1657 		for (trq = req->chain; trq; trq = trq->chain) {
1658 			printf("  Additional Chain Area %d\n", nc++);
1659 			mpt_dump_sgl(trq->req_vbuf, 0);
1660 		}
1661 	}
1662 
1663 	if (hdrp->Function == MPI_FUNCTION_TARGET_ASSIST) {
1664 		request_t *cmd_req = MPT_TAG_2_REQ(mpt, ccb->csio.tag_id);
1665 		mpt_tgt_state_t *tgt = MPT_TGT_STATE(mpt, cmd_req);
1666 #ifdef	WE_TRUST_AUTO_GOOD_STATUS
1667 		if ((ccb->ccb_h.flags & CAM_SEND_STATUS) &&
1668 		    csio->scsi_status == SCSI_STATUS_OK && tgt->resid == 0) {
1669 			tgt->state = TGT_STATE_MOVING_DATA_AND_STATUS;
1670 		} else {
1671 			tgt->state = TGT_STATE_MOVING_DATA;
1672 		}
1673 #else
1674 		tgt->state = TGT_STATE_MOVING_DATA;
1675 #endif
1676 	}
1677 	CAMLOCK_2_MPTLOCK(mpt);
1678 	mpt_send_cmd(mpt, req);
1679 	MPTLOCK_2_CAMLOCK(mpt);
1680 }
1681 
1682 static void
1683 mpt_execute_req(void *arg, bus_dma_segment_t *dm_segs, int nseg, int error)
1684 {
1685 	request_t *req, *trq;
1686 	char *mpt_off;
1687 	union ccb *ccb;
1688 	struct mpt_softc *mpt;
1689 	int seg, first_lim;
1690 	uint32_t flags, nxt_off;
1691 	void *sglp = NULL;
1692 	MSG_REQUEST_HEADER *hdrp;
1693 	SGE_SIMPLE32 *se;
1694 	SGE_CHAIN32 *ce;
1695 	int istgt = 0;
1696 
1697 	req = (request_t *)arg;
1698 	ccb = req->ccb;
1699 
1700 	mpt = ccb->ccb_h.ccb_mpt_ptr;
1701 	req = ccb->ccb_h.ccb_req_ptr;
1702 
1703 	hdrp = req->req_vbuf;
1704 	mpt_off = req->req_vbuf;
1705 
1706 
1707 	if (error == 0 && ((uint32_t)nseg) >= mpt->max_seg_cnt) {
1708 		error = EFBIG;
1709 	}
1710 
1711 	if (error == 0) {
1712 		switch (hdrp->Function) {
1713 		case MPI_FUNCTION_SCSI_IO_REQUEST:
1714 		case MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH:
1715 			sglp = &((PTR_MSG_SCSI_IO_REQUEST)hdrp)->SGL;
1716 			break;
1717 		case MPI_FUNCTION_TARGET_ASSIST:
1718 			istgt = 1;
1719 			sglp = &((PTR_MSG_TARGET_ASSIST_REQUEST)hdrp)->SGL;
1720 			break;
1721 		default:
1722 			mpt_prt(mpt, "bad fct 0x%x in mpt_execute_req\n",
1723 			    hdrp->Function);
1724 			error = EINVAL;
1725 			break;
1726 		}
1727 	}
1728 
1729 	if (error == 0 && ((uint32_t)nseg) >= mpt->max_seg_cnt) {
1730 		error = EFBIG;
1731 		mpt_prt(mpt, "segment count %d too large (max %u)\n",
1732 		    nseg, mpt->max_seg_cnt);
1733 	}
1734 
1735 bad:
1736 	if (error != 0) {
1737 		if (error != EFBIG && error != ENOMEM) {
1738 			mpt_prt(mpt, "mpt_execute_req: err %d\n", error);
1739 		}
1740 		if ((ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_INPROG) {
1741 			cam_status status;
1742 			mpt_freeze_ccb(ccb);
1743 			if (error == EFBIG) {
1744 				status = CAM_REQ_TOO_BIG;
1745 			} else if (error == ENOMEM) {
1746 				if (mpt->outofbeer == 0) {
1747 					mpt->outofbeer = 1;
1748 					xpt_freeze_simq(mpt->sim, 1);
1749 					mpt_lprt(mpt, MPT_PRT_DEBUG,
1750 					    "FREEZEQ\n");
1751 				}
1752 				status = CAM_REQUEUE_REQ;
1753 			} else {
1754 				status = CAM_REQ_CMP_ERR;
1755 			}
1756 			mpt_set_ccb_status(ccb, status);
1757 		}
1758 		if (hdrp->Function == MPI_FUNCTION_TARGET_ASSIST) {
1759 			request_t *cmd_req =
1760 				MPT_TAG_2_REQ(mpt, ccb->csio.tag_id);
1761 			MPT_TGT_STATE(mpt, cmd_req)->state = TGT_STATE_IN_CAM;
1762 			MPT_TGT_STATE(mpt, cmd_req)->ccb = NULL;
1763 			MPT_TGT_STATE(mpt, cmd_req)->req = NULL;
1764 		}
1765 		ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
1766 		KASSERT(ccb->ccb_h.status, ("zero ccb sts at %d\n", __LINE__));
1767 		xpt_done(ccb);
1768 		CAMLOCK_2_MPTLOCK(mpt);
1769 		mpt_free_request(mpt, req);
1770 		MPTLOCK_2_CAMLOCK(mpt);
1771 		return;
1772 	}
1773 
1774 	/*
1775 	 * No data to transfer?
1776 	 * Just make a single simple SGL with zero length.
1777 	 */
1778 
1779 	if (mpt->verbose >= MPT_PRT_DEBUG) {
1780 		int tidx = ((char *)sglp) - mpt_off;
1781 		memset(&mpt_off[tidx], 0xff, MPT_REQUEST_AREA - tidx);
1782 	}
1783 
1784 	if (nseg == 0) {
1785 		SGE_SIMPLE32 *se1 = (SGE_SIMPLE32 *) sglp;
1786 		MPI_pSGE_SET_FLAGS(se1,
1787 		    (MPI_SGE_FLAGS_LAST_ELEMENT | MPI_SGE_FLAGS_END_OF_BUFFER |
1788 		    MPI_SGE_FLAGS_SIMPLE_ELEMENT | MPI_SGE_FLAGS_END_OF_LIST));
1789 		se1->FlagsLength = htole32(se1->FlagsLength);
1790 		goto out;
1791 	}
1792 
1793 
1794 	flags = MPI_SGE_FLAGS_SIMPLE_ELEMENT;
1795 	if (istgt == 0) {
1796 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT) {
1797 			flags |= MPI_SGE_FLAGS_HOST_TO_IOC;
1798 		}
1799 	} else {
1800 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1801 			flags |= MPI_SGE_FLAGS_HOST_TO_IOC;
1802 		}
1803 	}
1804 
1805 	if (!(ccb->ccb_h.flags & (CAM_SG_LIST_PHYS|CAM_DATA_PHYS))) {
1806 		bus_dmasync_op_t op;
1807 		if (istgt) {
1808 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1809 				op = BUS_DMASYNC_PREREAD;
1810 			} else {
1811 				op = BUS_DMASYNC_PREWRITE;
1812 			}
1813 		} else {
1814 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1815 				op = BUS_DMASYNC_PREWRITE;
1816 			} else {
1817 				op = BUS_DMASYNC_PREREAD;
1818 			}
1819 		}
1820 		bus_dmamap_sync(mpt->buffer_dmat, req->dmap, op);
1821 	}
1822 
1823 	/*
1824 	 * Okay, fill in what we can at the end of the command frame.
1825 	 * If we have up to MPT_NSGL_FIRST, we can fit them all into
1826 	 * the command frame.
1827 	 *
1828 	 * Otherwise, we fill up through MPT_NSGL_FIRST less one
1829 	 * SIMPLE32 pointers and start doing CHAIN32 entries after
1830 	 * that.
1831 	 */
1832 
1833 	if (nseg < MPT_NSGL_FIRST(mpt)) {
1834 		first_lim = nseg;
1835 	} else {
1836 		/*
1837 		 * Leave room for CHAIN element
1838 		 */
1839 		first_lim = MPT_NSGL_FIRST(mpt) - 1;
1840 	}
1841 
1842 	se = (SGE_SIMPLE32 *) sglp;
1843 	for (seg = 0; seg < first_lim; seg++, se++, dm_segs++) {
1844 		uint32_t tf;
1845 
1846 		memset(se, 0,sizeof (*se));
1847 		se->Address = htole32(dm_segs->ds_addr);
1848 
1849 
1850 
1851 		MPI_pSGE_SET_LENGTH(se, dm_segs->ds_len);
1852 		tf = flags;
1853 		if (seg == first_lim - 1) {
1854 			tf |= MPI_SGE_FLAGS_LAST_ELEMENT;
1855 		}
1856 		if (seg == nseg - 1) {
1857 			tf |=	MPI_SGE_FLAGS_END_OF_LIST |
1858 				MPI_SGE_FLAGS_END_OF_BUFFER;
1859 		}
1860 		MPI_pSGE_SET_FLAGS(se, tf);
1861 		se->FlagsLength = htole32(se->FlagsLength);
1862 	}
1863 
1864 	if (seg == nseg) {
1865 		goto out;
1866 	}
1867 
1868 	/*
1869 	 * Tell the IOC where to find the first chain element.
1870 	 */
1871 	hdrp->ChainOffset = ((char *)se - (char *)hdrp) >> 2;
1872 	nxt_off = MPT_RQSL(mpt);
1873 	trq = req;
1874 
1875 	/*
1876 	 * Make up the rest of the data segments out of a chain element
1877 	 * (contiained in the current request frame) which points to
1878 	 * SIMPLE32 elements in the next request frame, possibly ending
1879 	 * with *another* chain element (if there's more).
1880 	 */
1881 	while (seg < nseg) {
1882 		int this_seg_lim;
1883 		uint32_t tf, cur_off;
1884 		bus_addr_t chain_list_addr;
1885 
1886 		/*
1887 		 * Point to the chain descriptor. Note that the chain
1888 		 * descriptor is at the end of the *previous* list (whether
1889 		 * chain or simple).
1890 		 */
1891 		ce = (SGE_CHAIN32 *) se;
1892 
1893 		/*
1894 		 * Before we change our current pointer, make  sure we won't
1895 		 * overflow the request area with this frame. Note that we
1896 		 * test against 'greater than' here as it's okay in this case
1897 		 * to have next offset be just outside the request area.
1898 		 */
1899 		if ((nxt_off + MPT_RQSL(mpt)) > MPT_REQUEST_AREA) {
1900 			nxt_off = MPT_REQUEST_AREA;
1901 			goto next_chain;
1902 		}
1903 
1904 		/*
1905 		 * Set our SGE element pointer to the beginning of the chain
1906 		 * list and update our next chain list offset.
1907 		 */
1908 		se = (SGE_SIMPLE32 *) &mpt_off[nxt_off];
1909 		cur_off = nxt_off;
1910 		nxt_off += MPT_RQSL(mpt);
1911 
1912 		/*
1913 		 * Now initialized the chain descriptor.
1914 		 */
1915 		memset(ce, 0, sizeof (*ce));
1916 
1917 		/*
1918 		 * Get the physical address of the chain list.
1919 		 */
1920 		chain_list_addr = trq->req_pbuf;
1921 		chain_list_addr += cur_off;
1922 
1923 
1924 
1925 		ce->Address = htole32(chain_list_addr);
1926 		ce->Flags = MPI_SGE_FLAGS_CHAIN_ELEMENT;
1927 
1928 
1929 		/*
1930 		 * If we have more than a frame's worth of segments left,
1931 		 * set up the chain list to have the last element be another
1932 		 * chain descriptor.
1933 		 */
1934 		if ((nseg - seg) > MPT_NSGL(mpt)) {
1935 			this_seg_lim = seg + MPT_NSGL(mpt) - 1;
1936 			/*
1937 			 * The length of the chain is the length in bytes of the
1938 			 * number of segments plus the next chain element.
1939 			 *
1940 			 * The next chain descriptor offset is the length,
1941 			 * in words, of the number of segments.
1942 			 */
1943 			ce->Length = (this_seg_lim - seg) *
1944 			    sizeof (SGE_SIMPLE32);
1945 			ce->NextChainOffset = ce->Length >> 2;
1946 			ce->Length += sizeof (SGE_CHAIN32);
1947 		} else {
1948 			this_seg_lim = nseg;
1949 			ce->Length = (this_seg_lim - seg) *
1950 			    sizeof (SGE_SIMPLE32);
1951 		}
1952 		ce->Length = htole16(ce->Length);
1953 
1954 		/*
1955 		 * Fill in the chain list SGE elements with our segment data.
1956 		 *
1957 		 * If we're the last element in this chain list, set the last
1958 		 * element flag. If we're the completely last element period,
1959 		 * set the end of list and end of buffer flags.
1960 		 */
1961 		while (seg < this_seg_lim) {
1962 			memset(se, 0, sizeof (*se));
1963 			se->Address = htole32(dm_segs->ds_addr);
1964 
1965 
1966 
1967 
1968 			MPI_pSGE_SET_LENGTH(se, dm_segs->ds_len);
1969 			tf = flags;
1970 			if (seg ==  this_seg_lim - 1) {
1971 				tf |=	MPI_SGE_FLAGS_LAST_ELEMENT;
1972 			}
1973 			if (seg == nseg - 1) {
1974 				tf |=	MPI_SGE_FLAGS_END_OF_LIST |
1975 					MPI_SGE_FLAGS_END_OF_BUFFER;
1976 			}
1977 			MPI_pSGE_SET_FLAGS(se, tf);
1978 			se->FlagsLength = htole32(se->FlagsLength);
1979 			se++;
1980 			seg++;
1981 			dm_segs++;
1982 		}
1983 
1984     next_chain:
1985 		/*
1986 		 * If we have more segments to do and we've used up all of
1987 		 * the space in a request area, go allocate another one
1988 		 * and chain to that.
1989 		 */
1990 		if (seg < nseg && nxt_off >= MPT_REQUEST_AREA) {
1991 			request_t *nrq;
1992 
1993 			CAMLOCK_2_MPTLOCK(mpt);
1994 			nrq = mpt_get_request(mpt, FALSE);
1995 			MPTLOCK_2_CAMLOCK(mpt);
1996 
1997 			if (nrq == NULL) {
1998 				error = ENOMEM;
1999 				goto bad;
2000 			}
2001 
2002 			/*
2003 			 * Append the new request area on the tail of our list.
2004 			 */
2005 			if ((trq = req->chain) == NULL) {
2006 				req->chain = nrq;
2007 			} else {
2008 				while (trq->chain != NULL) {
2009 					trq = trq->chain;
2010 				}
2011 				trq->chain = nrq;
2012 			}
2013 			trq = nrq;
2014 			mpt_off = trq->req_vbuf;
2015 			if (mpt->verbose >= MPT_PRT_DEBUG) {
2016 				memset(mpt_off, 0xff, MPT_REQUEST_AREA);
2017 			}
2018 			nxt_off = 0;
2019 		}
2020 	}
2021 out:
2022 
2023 	/*
2024 	 * Last time we need to check if this CCB needs to be aborted.
2025 	 */
2026 	if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_INPROG) {
2027 		if (hdrp->Function == MPI_FUNCTION_TARGET_ASSIST) {
2028 			request_t *cmd_req =
2029 				MPT_TAG_2_REQ(mpt, ccb->csio.tag_id);
2030 			MPT_TGT_STATE(mpt, cmd_req)->state = TGT_STATE_IN_CAM;
2031 			MPT_TGT_STATE(mpt, cmd_req)->ccb = NULL;
2032 			MPT_TGT_STATE(mpt, cmd_req)->req = NULL;
2033 		}
2034 		mpt_prt(mpt,
2035 		    "mpt_execute_req: I/O cancelled (status 0x%x)\n",
2036 		    ccb->ccb_h.status & CAM_STATUS_MASK);
2037 		if (nseg && (ccb->ccb_h.flags & CAM_SG_LIST_PHYS) == 0) {
2038 			bus_dmamap_unload(mpt->buffer_dmat, req->dmap);
2039 		}
2040 		ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
2041 		KASSERT(ccb->ccb_h.status, ("zero ccb sts at %d\n", __LINE__));
2042 		xpt_done(ccb);
2043 		CAMLOCK_2_MPTLOCK(mpt);
2044 		mpt_free_request(mpt, req);
2045 		MPTLOCK_2_CAMLOCK(mpt);
2046 		return;
2047 	}
2048 
2049 	ccb->ccb_h.status |= CAM_SIM_QUEUED;
2050 	if (ccb->ccb_h.timeout != CAM_TIME_INFINITY) {
2051 		mpt_req_timeout(req, (ccb->ccb_h.timeout * hz) / 1000,
2052 		    mpt_timeout, ccb);
2053 	}
2054 	if (mpt->verbose > MPT_PRT_DEBUG) {
2055 		int nc = 0;
2056 		mpt_print_request(req->req_vbuf);
2057 		for (trq = req->chain; trq; trq = trq->chain) {
2058 			printf("  Additional Chain Area %d\n", nc++);
2059 			mpt_dump_sgl(trq->req_vbuf, 0);
2060 		}
2061 	}
2062 
2063 	if (hdrp->Function == MPI_FUNCTION_TARGET_ASSIST) {
2064 		request_t *cmd_req = MPT_TAG_2_REQ(mpt, ccb->csio.tag_id);
2065 		mpt_tgt_state_t *tgt = MPT_TGT_STATE(mpt, cmd_req);
2066 #ifdef	WE_TRUST_AUTO_GOOD_STATUS
2067 		if ((ccb->ccb_h.flags & CAM_SEND_STATUS) &&
2068 		    csio->scsi_status == SCSI_STATUS_OK && tgt->resid == 0) {
2069 			tgt->state = TGT_STATE_MOVING_DATA_AND_STATUS;
2070 		} else {
2071 			tgt->state = TGT_STATE_MOVING_DATA;
2072 		}
2073 #else
2074 		tgt->state = TGT_STATE_MOVING_DATA;
2075 #endif
2076 	}
2077 	CAMLOCK_2_MPTLOCK(mpt);
2078 	mpt_send_cmd(mpt, req);
2079 	MPTLOCK_2_CAMLOCK(mpt);
2080 }
2081 
2082 static void
2083 mpt_start(struct cam_sim *sim, union ccb *ccb)
2084 {
2085 	request_t *req;
2086 	struct mpt_softc *mpt;
2087 	MSG_SCSI_IO_REQUEST *mpt_req;
2088 	struct ccb_scsiio *csio = &ccb->csio;
2089 	struct ccb_hdr *ccbh = &ccb->ccb_h;
2090 	bus_dmamap_callback_t *cb;
2091 	target_id_t tgt;
2092 	int raid_passthru;
2093 
2094 	/* Get the pointer for the physical addapter */
2095 	mpt = ccb->ccb_h.ccb_mpt_ptr;
2096 	raid_passthru = (sim == mpt->phydisk_sim);
2097 
2098 	CAMLOCK_2_MPTLOCK(mpt);
2099 	if ((req = mpt_get_request(mpt, FALSE)) == NULL) {
2100 		if (mpt->outofbeer == 0) {
2101 			mpt->outofbeer = 1;
2102 			xpt_freeze_simq(mpt->sim, 1);
2103 			mpt_lprt(mpt, MPT_PRT_DEBUG, "FREEZEQ\n");
2104 		}
2105 		ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
2106 		mpt_set_ccb_status(ccb, CAM_REQUEUE_REQ);
2107 		MPTLOCK_2_CAMLOCK(mpt);
2108 		xpt_done(ccb);
2109 		return;
2110 	}
2111 #ifdef	INVARIANTS
2112 	mpt_req_not_spcl(mpt, req, "mpt_start", __LINE__);
2113 #endif
2114 	MPTLOCK_2_CAMLOCK(mpt);
2115 
2116 	if (sizeof (bus_addr_t) > 4) {
2117 		cb = mpt_execute_req_a64;
2118 	} else {
2119 		cb = mpt_execute_req;
2120 	}
2121 
2122 	/*
2123 	 * Link the ccb and the request structure so we can find
2124 	 * the other knowing either the request or the ccb
2125 	 */
2126 	req->ccb = ccb;
2127 	ccb->ccb_h.ccb_req_ptr = req;
2128 
2129 	/* Now we build the command for the IOC */
2130 	mpt_req = req->req_vbuf;
2131 	memset(mpt_req, 0, sizeof (MSG_SCSI_IO_REQUEST));
2132 
2133 	mpt_req->Function = MPI_FUNCTION_SCSI_IO_REQUEST;
2134 	if (raid_passthru) {
2135 		mpt_req->Function = MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH;
2136 		CAMLOCK_2_MPTLOCK(mpt);
2137 		if (mpt_map_physdisk(mpt, ccb, &tgt) != 0) {
2138 			MPTLOCK_2_CAMLOCK(mpt);
2139 			ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
2140 			mpt_set_ccb_status(ccb, CAM_DEV_NOT_THERE);
2141 			xpt_done(ccb);
2142 			return;
2143 		}
2144 		MPTLOCK_2_CAMLOCK(mpt);
2145 		mpt_req->Bus = 0;	/* we never set bus here */
2146 	} else {
2147 		tgt = ccb->ccb_h.target_id;
2148 		mpt_req->Bus = 0;	/* XXX */
2149 
2150 	}
2151 	mpt_req->SenseBufferLength =
2152 		(csio->sense_len < MPT_SENSE_SIZE) ?
2153 		 csio->sense_len : MPT_SENSE_SIZE;
2154 
2155 	/*
2156 	 * We use the message context to find the request structure when we
2157 	 * Get the command completion interrupt from the IOC.
2158 	 */
2159 	mpt_req->MsgContext = htole32(req->index | scsi_io_handler_id);
2160 
2161 	/* Which physical device to do the I/O on */
2162 	mpt_req->TargetID = tgt;
2163 
2164 	/* We assume a single level LUN type */
2165 	if (ccb->ccb_h.target_lun >= MPT_MAX_LUNS) {
2166 		mpt_req->LUN[0] = 0x40 | ((ccb->ccb_h.target_lun >> 8) & 0x3f);
2167 		mpt_req->LUN[1] = ccb->ccb_h.target_lun & 0xff;
2168 	} else {
2169 		mpt_req->LUN[1] = ccb->ccb_h.target_lun;
2170 	}
2171 
2172 	/* Set the direction of the transfer */
2173 	if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
2174 		mpt_req->Control = MPI_SCSIIO_CONTROL_READ;
2175 	} else if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT) {
2176 		mpt_req->Control = MPI_SCSIIO_CONTROL_WRITE;
2177 	} else {
2178 		mpt_req->Control = MPI_SCSIIO_CONTROL_NODATATRANSFER;
2179 	}
2180 
2181 	if ((ccb->ccb_h.flags & CAM_TAG_ACTION_VALID) != 0) {
2182 		switch(ccb->csio.tag_action) {
2183 		case MSG_HEAD_OF_Q_TAG:
2184 			mpt_req->Control |= MPI_SCSIIO_CONTROL_HEADOFQ;
2185 			break;
2186 		case MSG_ACA_TASK:
2187 			mpt_req->Control |= MPI_SCSIIO_CONTROL_ACAQ;
2188 			break;
2189 		case MSG_ORDERED_Q_TAG:
2190 			mpt_req->Control |= MPI_SCSIIO_CONTROL_ORDEREDQ;
2191 			break;
2192 		case MSG_SIMPLE_Q_TAG:
2193 		default:
2194 			mpt_req->Control |= MPI_SCSIIO_CONTROL_SIMPLEQ;
2195 			break;
2196 		}
2197 	} else {
2198 		if (mpt->is_fc || mpt->is_sas) {
2199 			mpt_req->Control |= MPI_SCSIIO_CONTROL_SIMPLEQ;
2200 		} else {
2201 			/* XXX No such thing for a target doing packetized. */
2202 			mpt_req->Control |= MPI_SCSIIO_CONTROL_UNTAGGED;
2203 		}
2204 	}
2205 
2206 	if (mpt->is_spi) {
2207 		if (ccb->ccb_h.flags & CAM_DIS_DISCONNECT) {
2208 			mpt_req->Control |= MPI_SCSIIO_CONTROL_NO_DISCONNECT;
2209 		}
2210 	}
2211 	mpt_req->Control = htole32(mpt_req->Control);
2212 
2213 	/* Copy the scsi command block into place */
2214 	if ((ccb->ccb_h.flags & CAM_CDB_POINTER) != 0) {
2215 		bcopy(csio->cdb_io.cdb_ptr, mpt_req->CDB, csio->cdb_len);
2216 	} else {
2217 		bcopy(csio->cdb_io.cdb_bytes, mpt_req->CDB, csio->cdb_len);
2218 	}
2219 
2220 	mpt_req->CDBLength = csio->cdb_len;
2221 	mpt_req->DataLength = htole32(csio->dxfer_len);
2222 	mpt_req->SenseBufferLowAddr = htole32(req->sense_pbuf);
2223 
2224 	/*
2225 	 * Do a *short* print here if we're set to MPT_PRT_DEBUG
2226 	 */
2227 	if (mpt->verbose == MPT_PRT_DEBUG) {
2228 		U32 df;
2229 		mpt_prt(mpt, "mpt_start: %s op 0x%x ",
2230 		    (mpt_req->Function == MPI_FUNCTION_SCSI_IO_REQUEST)?
2231 		    "SCSI_IO_REQUEST" : "SCSI_IO_PASSTHRU", mpt_req->CDB[0]);
2232 		df = mpt_req->Control & MPI_SCSIIO_CONTROL_DATADIRECTION_MASK;
2233 		if (df != MPI_SCSIIO_CONTROL_NODATATRANSFER) {
2234 			mpt_prtc(mpt, "(%s %u byte%s ",
2235 			    (df == MPI_SCSIIO_CONTROL_READ)?
2236 			    "read" : "write",  csio->dxfer_len,
2237 			    (csio->dxfer_len == 1)? ")" : "s)");
2238 		}
2239 		mpt_prtc(mpt, "tgt %u lun %u req %p:%u\n", tgt,
2240 		    ccb->ccb_h.target_lun, req, req->serno);
2241 	}
2242 
2243 	/*
2244 	 * If we have any data to send with this command map it into bus space.
2245 	 */
2246 	if ((ccbh->flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
2247 		if ((ccbh->flags & CAM_SCATTER_VALID) == 0) {
2248 			/*
2249 			 * We've been given a pointer to a single buffer.
2250 			 */
2251 			if ((ccbh->flags & CAM_DATA_PHYS) == 0) {
2252 				/*
2253 				 * Virtual address that needs to translated into
2254 				 * one or more physical address ranges.
2255 				 */
2256 				int error;
2257 				int s = splsoftvm();
2258 				error = bus_dmamap_load(mpt->buffer_dmat,
2259 				    req->dmap, csio->data_ptr, csio->dxfer_len,
2260 				    cb, req, 0);
2261 				splx(s);
2262 				if (error == EINPROGRESS) {
2263 					/*
2264 					 * So as to maintain ordering,
2265 					 * freeze the controller queue
2266 					 * until our mapping is
2267 					 * returned.
2268 					 */
2269 					xpt_freeze_simq(mpt->sim, 1);
2270 					ccbh->status |= CAM_RELEASE_SIMQ;
2271 				}
2272 			} else {
2273 				/*
2274 				 * We have been given a pointer to single
2275 				 * physical buffer.
2276 				 */
2277 				struct bus_dma_segment seg;
2278 				seg.ds_addr =
2279 				    (bus_addr_t)(vm_offset_t)csio->data_ptr;
2280 				seg.ds_len = csio->dxfer_len;
2281 				(*cb)(req, &seg, 1, 0);
2282 			}
2283 		} else {
2284 			/*
2285 			 * We have been given a list of addresses.
2286 			 * This case could be easily supported but they are not
2287 			 * currently generated by the CAM subsystem so there
2288 			 * is no point in wasting the time right now.
2289 			 */
2290 			struct bus_dma_segment *segs;
2291 			if ((ccbh->flags & CAM_SG_LIST_PHYS) == 0) {
2292 				(*cb)(req, NULL, 0, EFAULT);
2293 			} else {
2294 				/* Just use the segments provided */
2295 				segs = (struct bus_dma_segment *)csio->data_ptr;
2296 				(*cb)(req, segs, csio->sglist_cnt, 0);
2297 			}
2298 		}
2299 	} else {
2300 		(*cb)(req, NULL, 0, 0);
2301 	}
2302 }
2303 
2304 static int
2305 mpt_bus_reset(struct mpt_softc *mpt, target_id_t tgt, lun_id_t lun,
2306     int sleep_ok)
2307 {
2308 	int   error;
2309 	uint16_t status;
2310 	uint8_t response;
2311 
2312 	error = mpt_scsi_send_tmf(mpt,
2313 	    (tgt != CAM_TARGET_WILDCARD || lun != CAM_LUN_WILDCARD) ?
2314 	    MPI_SCSITASKMGMT_TASKTYPE_TARGET_RESET :
2315 	    MPI_SCSITASKMGMT_TASKTYPE_RESET_BUS,
2316 	    mpt->is_fc ? MPI_SCSITASKMGMT_MSGFLAGS_LIP_RESET_OPTION : 0,
2317 	    0,	/* XXX How do I get the channel ID? */
2318 	    tgt != CAM_TARGET_WILDCARD ? tgt : 0,
2319 	    lun != CAM_LUN_WILDCARD ? lun : 0,
2320 	    0, sleep_ok);
2321 
2322 	if (error != 0) {
2323 		/*
2324 		 * mpt_scsi_send_tmf hard resets on failure, so no
2325 		 * need to do so here.
2326 		 */
2327 		mpt_prt(mpt,
2328 		    "mpt_bus_reset: mpt_scsi_send_tmf returned %d\n", error);
2329 		return (EIO);
2330 	}
2331 
2332 	/* Wait for bus reset to be processed by the IOC. */
2333 	error = mpt_wait_req(mpt, mpt->tmf_req, REQ_STATE_DONE,
2334 	    REQ_STATE_DONE, sleep_ok, 5000);
2335 
2336 	status = le16toh(mpt->tmf_req->IOCStatus);
2337 	response = mpt->tmf_req->ResponseCode;
2338 	mpt->tmf_req->state = REQ_STATE_FREE;
2339 
2340 	if (error) {
2341 		mpt_prt(mpt, "mpt_bus_reset: Reset timed-out. "
2342 		    "Resetting controller.\n");
2343 		mpt_reset(mpt, TRUE);
2344 		return (ETIMEDOUT);
2345 	}
2346 
2347 	if ((status & MPI_IOCSTATUS_MASK) != MPI_IOCSTATUS_SUCCESS) {
2348 		mpt_prt(mpt, "mpt_bus_reset: TMF IOC Status 0x%x. "
2349 		    "Resetting controller.\n", status);
2350 		mpt_reset(mpt, TRUE);
2351 		return (EIO);
2352 	}
2353 
2354 	if (response != MPI_SCSITASKMGMT_RSP_TM_SUCCEEDED &&
2355 	    response != MPI_SCSITASKMGMT_RSP_TM_COMPLETE) {
2356 		mpt_prt(mpt, "mpt_bus_reset: TMF Response 0x%x. "
2357 		    "Resetting controller.\n", response);
2358 		mpt_reset(mpt, TRUE);
2359 		return (EIO);
2360 	}
2361 	return (0);
2362 }
2363 
2364 static int
2365 mpt_fc_reset_link(struct mpt_softc *mpt, int dowait)
2366 {
2367 	int r = 0;
2368 	request_t *req;
2369 	PTR_MSG_FC_PRIMITIVE_SEND_REQUEST fc;
2370 
2371  	req = mpt_get_request(mpt, FALSE);
2372 	if (req == NULL) {
2373 		return (ENOMEM);
2374 	}
2375 	fc = req->req_vbuf;
2376 	memset(fc, 0, sizeof(*fc));
2377 	fc->SendFlags = MPI_FC_PRIM_SEND_FLAGS_RESET_LINK;
2378 	fc->Function = MPI_FUNCTION_FC_PRIMITIVE_SEND;
2379 	fc->MsgContext = htole32(req->index | fc_els_handler_id);
2380 	mpt_send_cmd(mpt, req);
2381 	if (dowait) {
2382 		r = mpt_wait_req(mpt, req, REQ_STATE_DONE,
2383 		    REQ_STATE_DONE, FALSE, 60 * 1000);
2384 		if (r == 0) {
2385 			mpt_free_request(mpt, req);
2386 		}
2387 	}
2388 	return (r);
2389 }
2390 
2391 static int
2392 mpt_cam_event(struct mpt_softc *mpt, request_t *req,
2393 	      MSG_EVENT_NOTIFY_REPLY *msg)
2394 {
2395 	uint32_t data0, data1;
2396 
2397 	data0 = le32toh(msg->Data[0]);
2398 	data1 = le32toh(msg->Data[1]);
2399 	switch(msg->Event & 0xFF) {
2400 	case MPI_EVENT_UNIT_ATTENTION:
2401 		mpt_prt(mpt, "UNIT ATTENTION: Bus: 0x%02x TargetID: 0x%02x\n",
2402 		    (data0 >> 8) & 0xff, data0 & 0xff);
2403 		break;
2404 
2405 	case MPI_EVENT_IOC_BUS_RESET:
2406 		/* We generated a bus reset */
2407 		mpt_prt(mpt, "IOC Generated Bus Reset Port: %d\n",
2408 		    (data0 >> 8) & 0xff);
2409 		xpt_async(AC_BUS_RESET, mpt->path, NULL);
2410 		break;
2411 
2412 	case MPI_EVENT_EXT_BUS_RESET:
2413 		/* Someone else generated a bus reset */
2414 		mpt_prt(mpt, "External Bus Reset Detected\n");
2415 		/*
2416 		 * These replies don't return EventData like the MPI
2417 		 * spec says they do
2418 		 */
2419 		xpt_async(AC_BUS_RESET, mpt->path, NULL);
2420 		break;
2421 
2422 	case MPI_EVENT_RESCAN:
2423 #if __FreeBSD_version >= 600000
2424 	{
2425 		union ccb *ccb;
2426 		uint32_t pathid;
2427 		/*
2428 		 * In general this means a device has been added to the loop.
2429 		 */
2430 		mpt_prt(mpt, "Rescan Port: %d\n", (data0 >> 8) & 0xff);
2431 		if (mpt->ready == 0) {
2432 			break;
2433 		}
2434 		if (mpt->phydisk_sim) {
2435 			pathid = cam_sim_path(mpt->phydisk_sim);
2436 		} else {
2437 			pathid = cam_sim_path(mpt->sim);
2438 		}
2439 		MPTLOCK_2_CAMLOCK(mpt);
2440 		/*
2441 		 * Allocate a CCB, create a wildcard path for this bus,
2442 		 * and schedule a rescan.
2443 		 */
2444 		ccb = xpt_alloc_ccb_nowait();
2445 		if (ccb == NULL) {
2446 			mpt_prt(mpt, "unable to alloc CCB for rescan\n");
2447 			CAMLOCK_2_MPTLOCK(mpt);
2448 			break;
2449 		}
2450 
2451 		if (xpt_create_path(&ccb->ccb_h.path, xpt_periph, pathid,
2452 		    CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
2453 			CAMLOCK_2_MPTLOCK(mpt);
2454 			mpt_prt(mpt, "unable to create path for rescan\n");
2455 			xpt_free_ccb(ccb);
2456 			break;
2457 		}
2458 		xpt_rescan(ccb);
2459 		CAMLOCK_2_MPTLOCK(mpt);
2460 		break;
2461 	}
2462 #else
2463 		mpt_prt(mpt, "Rescan Port: %d\n", (data0 >> 8) & 0xff);
2464 		break;
2465 #endif
2466 	case MPI_EVENT_LINK_STATUS_CHANGE:
2467 		mpt_prt(mpt, "Port %d: LinkState: %s\n",
2468 		    (data1 >> 8) & 0xff,
2469 		    ((data0 & 0xff) == 0)?  "Failed" : "Active");
2470 		break;
2471 
2472 	case MPI_EVENT_LOOP_STATE_CHANGE:
2473 		switch ((data0 >> 16) & 0xff) {
2474 		case 0x01:
2475 			mpt_prt(mpt,
2476 			    "Port 0x%x: FC LinkEvent: LIP(%02x,%02x) "
2477 			    "(Loop Initialization)\n",
2478 			    (data1 >> 8) & 0xff,
2479 			    (data0 >> 8) & 0xff,
2480 			    (data0     ) & 0xff);
2481 			switch ((data0 >> 8) & 0xff) {
2482 			case 0xF7:
2483 				if ((data0 & 0xff) == 0xF7) {
2484 					mpt_prt(mpt, "Device needs AL_PA\n");
2485 				} else {
2486 					mpt_prt(mpt, "Device %02x doesn't like "
2487 					    "FC performance\n",
2488 					    data0 & 0xFF);
2489 				}
2490 				break;
2491 			case 0xF8:
2492 				if ((data0 & 0xff) == 0xF7) {
2493 					mpt_prt(mpt, "Device had loop failure "
2494 					    "at its receiver prior to acquiring"
2495 					    " AL_PA\n");
2496 				} else {
2497 					mpt_prt(mpt, "Device %02x detected loop"
2498 					    " failure at its receiver\n",
2499 					    data0 & 0xFF);
2500 				}
2501 				break;
2502 			default:
2503 				mpt_prt(mpt, "Device %02x requests that device "
2504 				    "%02x reset itself\n",
2505 				    data0 & 0xFF,
2506 				    (data0 >> 8) & 0xFF);
2507 				break;
2508 			}
2509 			break;
2510 		case 0x02:
2511 			mpt_prt(mpt, "Port 0x%x: FC LinkEvent: "
2512 			    "LPE(%02x,%02x) (Loop Port Enable)\n",
2513 			    (data1 >> 8) & 0xff, /* Port */
2514 			    (data0 >>  8) & 0xff, /* Character 3 */
2515 			    (data0      ) & 0xff  /* Character 4 */);
2516 			break;
2517 		case 0x03:
2518 			mpt_prt(mpt, "Port 0x%x: FC LinkEvent: "
2519 			    "LPB(%02x,%02x) (Loop Port Bypass)\n",
2520 			    (data1 >> 8) & 0xff, /* Port */
2521 			    (data0 >> 8) & 0xff, /* Character 3 */
2522 			    (data0     ) & 0xff  /* Character 4 */);
2523 			break;
2524 		default:
2525 			mpt_prt(mpt, "Port 0x%x: FC LinkEvent: Unknown "
2526 			    "FC event (%02x %02x %02x)\n",
2527 			    (data1 >> 8) & 0xff, /* Port */
2528 			    (data0 >> 16) & 0xff, /* Event */
2529 			    (data0 >>  8) & 0xff, /* Character 3 */
2530 			    (data0      ) & 0xff  /* Character 4 */);
2531 		}
2532 		break;
2533 
2534 	case MPI_EVENT_LOGOUT:
2535 		mpt_prt(mpt, "FC Logout Port: %d N_PortID: %02x\n",
2536 		    (data1 >> 8) & 0xff, data0);
2537 		break;
2538 	case MPI_EVENT_QUEUE_FULL:
2539 	{
2540 		struct cam_sim *sim;
2541 		struct cam_path *tmppath;
2542 		struct ccb_relsim crs;
2543 		PTR_EVENT_DATA_QUEUE_FULL pqf;
2544 		lun_id_t lun_id;
2545 
2546 		pqf = (PTR_EVENT_DATA_QUEUE_FULL)msg->Data;
2547 		pqf->CurrentDepth = le16toh(pqf->CurrentDepth);
2548 		mpt_prt(mpt, "QUEUE FULL EVENT: Bus 0x%02x Target 0x%02x Depth "
2549 		    "%d\n", pqf->Bus, pqf->TargetID, pqf->CurrentDepth);
2550 		if (mpt->phydisk_sim) {
2551 			sim = mpt->phydisk_sim;
2552 		} else {
2553 			sim = mpt->sim;
2554 		}
2555 		MPTLOCK_2_CAMLOCK(mpt);
2556 		for (lun_id = 0; lun_id < MPT_MAX_LUNS; lun_id++) {
2557 			if (xpt_create_path(&tmppath, NULL, cam_sim_path(sim),
2558 			    pqf->TargetID, lun_id) != CAM_REQ_CMP) {
2559 				mpt_prt(mpt, "unable to create a path to send "
2560 				    "XPT_REL_SIMQ");
2561 				CAMLOCK_2_MPTLOCK(mpt);
2562 				break;
2563 			}
2564 			xpt_setup_ccb(&crs.ccb_h, tmppath, 5);
2565 			crs.ccb_h.func_code = XPT_REL_SIMQ;
2566 			crs.ccb_h.flags = CAM_DEV_QFREEZE;
2567 			crs.release_flags = RELSIM_ADJUST_OPENINGS;
2568 			crs.openings = pqf->CurrentDepth - 1;
2569 			xpt_action((union ccb *)&crs);
2570 			if (crs.ccb_h.status != CAM_REQ_CMP) {
2571 				mpt_prt(mpt, "XPT_REL_SIMQ failed\n");
2572 			}
2573 			xpt_free_path(tmppath);
2574 		}
2575 		CAMLOCK_2_MPTLOCK(mpt);
2576 		break;
2577 	}
2578 	case MPI_EVENT_EVENT_CHANGE:
2579 	case MPI_EVENT_INTEGRATED_RAID:
2580 	case MPI_EVENT_SAS_DEVICE_STATUS_CHANGE:
2581 	case MPI_EVENT_SAS_SES:
2582 		break;
2583 	default:
2584 		mpt_lprt(mpt, MPT_PRT_WARN, "mpt_cam_event: 0x%x\n",
2585 		    msg->Event & 0xFF);
2586 		return (0);
2587 	}
2588 	return (1);
2589 }
2590 
2591 /*
2592  * Reply path for all SCSI I/O requests, called from our
2593  * interrupt handler by extracting our handler index from
2594  * the MsgContext field of the reply from the IOC.
2595  *
2596  * This routine is optimized for the common case of a
2597  * completion without error.  All exception handling is
2598  * offloaded to non-inlined helper routines to minimize
2599  * cache footprint.
2600  */
2601 static int
2602 mpt_scsi_reply_handler(struct mpt_softc *mpt, request_t *req,
2603     uint32_t reply_desc, MSG_DEFAULT_REPLY *reply_frame)
2604 {
2605 	MSG_SCSI_IO_REQUEST *scsi_req;
2606 	union ccb *ccb;
2607 
2608 	if (req->state == REQ_STATE_FREE) {
2609 		mpt_prt(mpt, "mpt_scsi_reply_handler: req already free\n");
2610 		return (TRUE);
2611 	}
2612 
2613 	scsi_req = (MSG_SCSI_IO_REQUEST *)req->req_vbuf;
2614 	ccb = req->ccb;
2615 	if (ccb == NULL) {
2616 		mpt_prt(mpt, "mpt_scsi_reply_handler: req %p:%u with no ccb\n",
2617 		    req, req->serno);
2618 		return (TRUE);
2619 	}
2620 
2621 	mpt_req_untimeout(req, mpt_timeout, ccb);
2622 	ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
2623 
2624 	if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
2625 		bus_dmasync_op_t op;
2626 
2627 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN)
2628 			op = BUS_DMASYNC_POSTREAD;
2629 		else
2630 			op = BUS_DMASYNC_POSTWRITE;
2631 		bus_dmamap_sync(mpt->buffer_dmat, req->dmap, op);
2632 		bus_dmamap_unload(mpt->buffer_dmat, req->dmap);
2633 	}
2634 
2635 	if (reply_frame == NULL) {
2636 		/*
2637 		 * Context only reply, completion without error status.
2638 		 */
2639 		ccb->csio.resid = 0;
2640 		mpt_set_ccb_status(ccb, CAM_REQ_CMP);
2641 		ccb->csio.scsi_status = SCSI_STATUS_OK;
2642 	} else {
2643 		mpt_scsi_reply_frame_handler(mpt, req, reply_frame);
2644 	}
2645 
2646 	if (mpt->outofbeer) {
2647 		ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
2648 		mpt->outofbeer = 0;
2649 		mpt_lprt(mpt, MPT_PRT_DEBUG, "THAWQ\n");
2650 	}
2651 	if (scsi_req->CDB[0] == INQUIRY && (scsi_req->CDB[1] & SI_EVPD) == 0) {
2652 		struct scsi_inquiry_data *iq =
2653 		    (struct scsi_inquiry_data *)ccb->csio.data_ptr;
2654 		if (scsi_req->Function ==
2655 		    MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH) {
2656 			/*
2657 			 * Fake out the device type so that only the
2658 			 * pass-thru device will attach.
2659 			 */
2660 			iq->device &= ~0x1F;
2661 			iq->device |= T_NODEVICE;
2662 		}
2663 	}
2664 	if (mpt->verbose == MPT_PRT_DEBUG) {
2665 		mpt_prt(mpt, "mpt_scsi_reply_handler: %p:%u complete\n",
2666 		    req, req->serno);
2667 	}
2668 	KASSERT(ccb->ccb_h.status, ("zero ccb sts at %d\n", __LINE__));
2669 	MPTLOCK_2_CAMLOCK(mpt);
2670 	xpt_done(ccb);
2671 	CAMLOCK_2_MPTLOCK(mpt);
2672 	if ((req->state & REQ_STATE_TIMEDOUT) == 0) {
2673 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
2674 	} else {
2675 		mpt_prt(mpt, "completing timedout/aborted req %p:%u\n",
2676 		    req, req->serno);
2677 		TAILQ_REMOVE(&mpt->request_timeout_list, req, links);
2678 	}
2679 	KASSERT((req->state & REQ_STATE_NEED_WAKEUP) == 0,
2680 	    ("CCB req needed wakeup"));
2681 #ifdef	INVARIANTS
2682 	mpt_req_not_spcl(mpt, req, "mpt_scsi_reply_handler", __LINE__);
2683 #endif
2684 	mpt_free_request(mpt, req);
2685 	return (TRUE);
2686 }
2687 
2688 static int
2689 mpt_scsi_tmf_reply_handler(struct mpt_softc *mpt, request_t *req,
2690     uint32_t reply_desc, MSG_DEFAULT_REPLY *reply_frame)
2691 {
2692 	MSG_SCSI_TASK_MGMT_REPLY *tmf_reply;
2693 
2694 	KASSERT(req == mpt->tmf_req, ("TMF Reply not using mpt->tmf_req"));
2695 #ifdef	INVARIANTS
2696 	mpt_req_not_spcl(mpt, req, "mpt_scsi_tmf_reply_handler", __LINE__);
2697 #endif
2698 	tmf_reply = (MSG_SCSI_TASK_MGMT_REPLY *)reply_frame;
2699 	/* Record IOC Status and Response Code of TMF for any waiters. */
2700 	req->IOCStatus = le16toh(tmf_reply->IOCStatus);
2701 	req->ResponseCode = tmf_reply->ResponseCode;
2702 
2703 	mpt_lprt(mpt, MPT_PRT_DEBUG, "TMF complete: req %p:%u status 0x%x\n",
2704 	    req, req->serno, le16toh(tmf_reply->IOCStatus));
2705 	TAILQ_REMOVE(&mpt->request_pending_list, req, links);
2706 	if ((req->state & REQ_STATE_NEED_WAKEUP) != 0) {
2707 		req->state |= REQ_STATE_DONE;
2708 		wakeup(req);
2709 	} else {
2710 		mpt->tmf_req->state = REQ_STATE_FREE;
2711 	}
2712 	return (TRUE);
2713 }
2714 
2715 /*
2716  * XXX: Move to definitions file
2717  */
2718 #define	ELS	0x22
2719 #define	FC4LS	0x32
2720 #define	ABTS	0x81
2721 #define	BA_ACC	0x84
2722 
2723 #define	LS_RJT	0x01
2724 #define	LS_ACC	0x02
2725 #define	PLOGI	0x03
2726 #define	LOGO	0x05
2727 #define SRR	0x14
2728 #define PRLI	0x20
2729 #define PRLO	0x21
2730 #define ADISC	0x52
2731 #define RSCN	0x61
2732 
2733 static void
2734 mpt_fc_els_send_response(struct mpt_softc *mpt, request_t *req,
2735     PTR_MSG_LINK_SERVICE_BUFFER_POST_REPLY rp, U8 length)
2736 {
2737 	uint32_t fl;
2738 	MSG_LINK_SERVICE_RSP_REQUEST tmp;
2739 	PTR_MSG_LINK_SERVICE_RSP_REQUEST rsp;
2740 
2741 	/*
2742 	 * We are going to reuse the ELS request to send this response back.
2743 	 */
2744 	rsp = &tmp;
2745 	memset(rsp, 0, sizeof(*rsp));
2746 
2747 #ifdef	USE_IMMEDIATE_LINK_DATA
2748 	/*
2749 	 * Apparently the IMMEDIATE stuff doesn't seem to work.
2750 	 */
2751 	rsp->RspFlags = LINK_SERVICE_RSP_FLAGS_IMMEDIATE;
2752 #endif
2753 	rsp->RspLength = length;
2754 	rsp->Function = MPI_FUNCTION_FC_LINK_SRVC_RSP;
2755 	rsp->MsgContext = htole32(req->index | fc_els_handler_id);
2756 
2757 	/*
2758 	 * Copy over information from the original reply frame to
2759 	 * it's correct place in the response.
2760 	 */
2761 	memcpy((U8 *)rsp + 0x0c, (U8 *)rp + 0x1c, 24);
2762 
2763 	/*
2764 	 * And now copy back the temporary area to the original frame.
2765 	 */
2766 	memcpy(req->req_vbuf, rsp, sizeof (MSG_LINK_SERVICE_RSP_REQUEST));
2767 	rsp = req->req_vbuf;
2768 
2769 #ifdef	USE_IMMEDIATE_LINK_DATA
2770 	memcpy((U8 *)&rsp->SGL, &((U8 *)req->req_vbuf)[MPT_RQSL(mpt)], length);
2771 #else
2772 {
2773 	PTR_SGE_SIMPLE32 se = (PTR_SGE_SIMPLE32) &rsp->SGL;
2774 	bus_addr_t paddr = req->req_pbuf;
2775 	paddr += MPT_RQSL(mpt);
2776 
2777 	fl =
2778 		MPI_SGE_FLAGS_HOST_TO_IOC	|
2779 		MPI_SGE_FLAGS_SIMPLE_ELEMENT	|
2780 		MPI_SGE_FLAGS_LAST_ELEMENT	|
2781 		MPI_SGE_FLAGS_END_OF_LIST	|
2782 		MPI_SGE_FLAGS_END_OF_BUFFER;
2783 	fl <<= MPI_SGE_FLAGS_SHIFT;
2784 	fl |= (length);
2785 	se->FlagsLength = htole32(fl);
2786 	se->Address = htole32((uint32_t) paddr);
2787 }
2788 #endif
2789 
2790 	/*
2791 	 * Send it on...
2792 	 */
2793 	mpt_send_cmd(mpt, req);
2794 }
2795 
2796 static int
2797 mpt_fc_els_reply_handler(struct mpt_softc *mpt, request_t *req,
2798     uint32_t reply_desc, MSG_DEFAULT_REPLY *reply_frame)
2799 {
2800 	PTR_MSG_LINK_SERVICE_BUFFER_POST_REPLY rp =
2801 	    (PTR_MSG_LINK_SERVICE_BUFFER_POST_REPLY) reply_frame;
2802 	U8 rctl;
2803 	U8 type;
2804 	U8 cmd;
2805 	U16 status = le16toh(reply_frame->IOCStatus);
2806 	U32 *elsbuf;
2807 	int ioindex;
2808 	int do_refresh = TRUE;
2809 
2810 #ifdef	INVARIANTS
2811 	KASSERT(mpt_req_on_free_list(mpt, req) == 0,
2812 	    ("fc_els_reply_handler: req %p:%u for function %x on freelist!",
2813 	    req, req->serno, rp->Function));
2814 	if (rp->Function != MPI_FUNCTION_FC_PRIMITIVE_SEND) {
2815 		mpt_req_spcl(mpt, req, "fc_els_reply_handler", __LINE__);
2816 	} else {
2817 		mpt_req_not_spcl(mpt, req, "fc_els_reply_handler", __LINE__);
2818 	}
2819 #endif
2820 	mpt_lprt(mpt, MPT_PRT_DEBUG,
2821 	    "FC_ELS Complete: req %p:%u, reply %p function %x\n",
2822 	    req, req->serno, reply_frame, reply_frame->Function);
2823 
2824 	if  (status != MPI_IOCSTATUS_SUCCESS) {
2825 		mpt_prt(mpt, "ELS REPLY STATUS 0x%x for Function %x\n",
2826 		    status, reply_frame->Function);
2827 		if (status == MPI_IOCSTATUS_INVALID_STATE) {
2828 			/*
2829 			 * XXX: to get around shutdown issue
2830 			 */
2831 			mpt->disabled = 1;
2832 			return (TRUE);
2833 		}
2834 		return (TRUE);
2835 	}
2836 
2837 	/*
2838 	 * If the function of a link service response, we recycle the
2839 	 * response to be a refresh for a new link service request.
2840 	 *
2841 	 * The request pointer is bogus in this case and we have to fetch
2842 	 * it based upon the TransactionContext.
2843 	 */
2844 	if (rp->Function == MPI_FUNCTION_FC_LINK_SRVC_RSP) {
2845 		/* Freddie Uncle Charlie Katie */
2846 		/* We don't get the IOINDEX as part of the Link Svc Rsp */
2847 		for (ioindex = 0; ioindex < mpt->els_cmds_allocated; ioindex++)
2848 			if (mpt->els_cmd_ptrs[ioindex] == req) {
2849 				break;
2850 			}
2851 
2852 		KASSERT(ioindex < mpt->els_cmds_allocated,
2853 		    ("can't find my mommie!"));
2854 
2855 		/* remove from active list as we're going to re-post it */
2856 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
2857 		req->state &= ~REQ_STATE_QUEUED;
2858 		req->state |= REQ_STATE_DONE;
2859 		mpt_fc_post_els(mpt, req, ioindex);
2860 		return (TRUE);
2861 	}
2862 
2863 	if (rp->Function == MPI_FUNCTION_FC_PRIMITIVE_SEND) {
2864 		/* remove from active list as we're done */
2865 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
2866 		req->state &= ~REQ_STATE_QUEUED;
2867 		req->state |= REQ_STATE_DONE;
2868 		if (req->state & REQ_STATE_TIMEDOUT) {
2869 			mpt_lprt(mpt, MPT_PRT_DEBUG,
2870 			    "Sync Primitive Send Completed After Timeout\n");
2871 			mpt_free_request(mpt, req);
2872 		} else if ((req->state & REQ_STATE_NEED_WAKEUP) == 0) {
2873 			mpt_lprt(mpt, MPT_PRT_DEBUG,
2874 			    "Async Primitive Send Complete\n");
2875 			mpt_free_request(mpt, req);
2876 		} else {
2877 			mpt_lprt(mpt, MPT_PRT_DEBUG,
2878 			    "Sync Primitive Send Complete- Waking Waiter\n");
2879 			wakeup(req);
2880 		}
2881 		return (TRUE);
2882 	}
2883 
2884 	if (rp->Function != MPI_FUNCTION_FC_LINK_SRVC_BUF_POST) {
2885 		mpt_prt(mpt, "unexpected ELS_REPLY: Function 0x%x Flags %x "
2886 		    "Length %d Message Flags %x\n", rp->Function, rp->Flags,
2887 		    rp->MsgLength, rp->MsgFlags);
2888 		return (TRUE);
2889 	}
2890 
2891 	if (rp->MsgLength <= 5) {
2892 		/*
2893 		 * This is just a ack of an original ELS buffer post
2894 		 */
2895 		mpt_lprt(mpt, MPT_PRT_DEBUG,
2896 		    "RECV'd ACK of FC_ELS buf post %p:%u\n", req, req->serno);
2897 		return (TRUE);
2898 	}
2899 
2900 
2901 	rctl = (le32toh(rp->Rctl_Did) & MPI_FC_RCTL_MASK) >> MPI_FC_RCTL_SHIFT;
2902 	type = (le32toh(rp->Type_Fctl) & MPI_FC_TYPE_MASK) >> MPI_FC_TYPE_SHIFT;
2903 
2904 	elsbuf = &((U32 *)req->req_vbuf)[MPT_RQSL(mpt)/sizeof (U32)];
2905 	cmd = be32toh(elsbuf[0]) >> 24;
2906 
2907 	if (rp->Flags & MPI_LS_BUF_POST_REPLY_FLAG_NO_RSP_NEEDED) {
2908 		mpt_lprt(mpt, MPT_PRT_ALWAYS, "ELS_REPLY: response unneeded\n");
2909 		return (TRUE);
2910 	}
2911 
2912 	ioindex = le32toh(rp->TransactionContext);
2913 	req = mpt->els_cmd_ptrs[ioindex];
2914 
2915 	if (rctl == ELS && type == 1) {
2916 		switch (cmd) {
2917 		case PRLI:
2918 			/*
2919 			 * Send back a PRLI ACC
2920 			 */
2921 			mpt_prt(mpt, "PRLI from 0x%08x%08x\n",
2922 			    le32toh(rp->Wwn.PortNameHigh),
2923 			    le32toh(rp->Wwn.PortNameLow));
2924 			elsbuf[0] = htobe32(0x02100014);
2925 			elsbuf[1] |= htobe32(0x00000100);
2926 			elsbuf[4] = htobe32(0x00000002);
2927 			if (mpt->role & MPT_ROLE_TARGET)
2928 				elsbuf[4] |= htobe32(0x00000010);
2929 			if (mpt->role & MPT_ROLE_INITIATOR)
2930 				elsbuf[4] |= htobe32(0x00000020);
2931 			/* remove from active list as we're done */
2932 			TAILQ_REMOVE(&mpt->request_pending_list, req, links);
2933 			req->state &= ~REQ_STATE_QUEUED;
2934 			req->state |= REQ_STATE_DONE;
2935 			mpt_fc_els_send_response(mpt, req, rp, 20);
2936 			do_refresh = FALSE;
2937 			break;
2938 		case PRLO:
2939 			memset(elsbuf, 0, 5 * (sizeof (U32)));
2940 			elsbuf[0] = htobe32(0x02100014);
2941 			elsbuf[1] = htobe32(0x08000100);
2942 			mpt_prt(mpt, "PRLO from 0x%08x%08x\n",
2943 			    le32toh(rp->Wwn.PortNameHigh),
2944 			    le32toh(rp->Wwn.PortNameLow));
2945 			/* remove from active list as we're done */
2946 			TAILQ_REMOVE(&mpt->request_pending_list, req, links);
2947 			req->state &= ~REQ_STATE_QUEUED;
2948 			req->state |= REQ_STATE_DONE;
2949 			mpt_fc_els_send_response(mpt, req, rp, 20);
2950 			do_refresh = FALSE;
2951 			break;
2952 		default:
2953 			mpt_prt(mpt, "ELS TYPE 1 COMMAND: %x\n", cmd);
2954 			break;
2955 		}
2956 	} else if (rctl == ABTS && type == 0) {
2957 		uint16_t rx_id = le16toh(rp->Rxid);
2958 		uint16_t ox_id = le16toh(rp->Oxid);
2959 		request_t *tgt_req = NULL;
2960 
2961 		mpt_prt(mpt,
2962 		    "ELS: ABTS OX_ID 0x%x RX_ID 0x%x from 0x%08x%08x\n",
2963 		    ox_id, rx_id, le32toh(rp->Wwn.PortNameHigh),
2964 		    le32toh(rp->Wwn.PortNameLow));
2965 		if (rx_id >= mpt->mpt_max_tgtcmds) {
2966 			mpt_prt(mpt, "Bad RX_ID 0x%x\n", rx_id);
2967 		} else if (mpt->tgt_cmd_ptrs == NULL) {
2968 			mpt_prt(mpt, "No TGT CMD PTRS\n");
2969 		} else {
2970 			tgt_req = mpt->tgt_cmd_ptrs[rx_id];
2971 		}
2972 		if (tgt_req) {
2973 			mpt_tgt_state_t *tgt = MPT_TGT_STATE(mpt, tgt_req);
2974 			union ccb *ccb = tgt->ccb;
2975 			uint32_t ct_id;
2976 
2977 			/*
2978 			 * Check to make sure we have the correct command
2979 			 * The reply descriptor in the target state should
2980 			 * should contain an IoIndex that should match the
2981 			 * RX_ID.
2982 			 *
2983 			 * It'd be nice to have OX_ID to crosscheck with
2984 			 * as well.
2985 			 */
2986 			ct_id = GET_IO_INDEX(tgt->reply_desc);
2987 
2988 			if (ct_id != rx_id) {
2989 				mpt_lprt(mpt, MPT_PRT_ERROR, "ABORT Mismatch: "
2990 				    "RX_ID received=0x%x; RX_ID in cmd=0x%x\n",
2991 				    rx_id, ct_id);
2992 				goto skip;
2993 			}
2994 
2995 			ccb = tgt->ccb;
2996 			if (ccb) {
2997 				mpt_prt(mpt,
2998 				    "CCB (%p): lun %u flags %x status %x\n",
2999 				    ccb, ccb->ccb_h.target_lun,
3000 				    ccb->ccb_h.flags, ccb->ccb_h.status);
3001 			}
3002 			mpt_prt(mpt, "target state 0x%x resid %u xfrd %u rpwrd "
3003 			    "%x nxfers %x\n", tgt->state,
3004 			    tgt->resid, tgt->bytes_xfered, tgt->reply_desc,
3005 			    tgt->nxfers);
3006   skip:
3007 			if (mpt_abort_target_cmd(mpt, tgt_req)) {
3008 				mpt_prt(mpt, "unable to start TargetAbort\n");
3009 			}
3010 		} else {
3011 			mpt_prt(mpt, "no back pointer for RX_ID 0x%x\n", rx_id);
3012 		}
3013 		memset(elsbuf, 0, 5 * (sizeof (U32)));
3014 		elsbuf[0] = htobe32(0);
3015 		elsbuf[1] = htobe32((ox_id << 16) | rx_id);
3016 		elsbuf[2] = htobe32(0x000ffff);
3017 		/*
3018 		 * Dork with the reply frame so that the reponse to it
3019 		 * will be correct.
3020 		 */
3021 		rp->Rctl_Did += ((BA_ACC - ABTS) << MPI_FC_RCTL_SHIFT);
3022 		/* remove from active list as we're done */
3023 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
3024 		req->state &= ~REQ_STATE_QUEUED;
3025 		req->state |= REQ_STATE_DONE;
3026 		mpt_fc_els_send_response(mpt, req, rp, 12);
3027 		do_refresh = FALSE;
3028 	} else {
3029 		mpt_prt(mpt, "ELS: RCTL %x TYPE %x CMD %x\n", rctl, type, cmd);
3030 	}
3031 	if (do_refresh == TRUE) {
3032 		/* remove from active list as we're done */
3033 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
3034 		req->state &= ~REQ_STATE_QUEUED;
3035 		req->state |= REQ_STATE_DONE;
3036 		mpt_fc_post_els(mpt, req, ioindex);
3037 	}
3038 	return (TRUE);
3039 }
3040 
3041 /*
3042  * Clean up all SCSI Initiator personality state in response
3043  * to a controller reset.
3044  */
3045 static void
3046 mpt_cam_ioc_reset(struct mpt_softc *mpt, int type)
3047 {
3048 	/*
3049 	 * The pending list is already run down by
3050 	 * the generic handler.  Perform the same
3051 	 * operation on the timed out request list.
3052 	 */
3053 	mpt_complete_request_chain(mpt, &mpt->request_timeout_list,
3054 				   MPI_IOCSTATUS_INVALID_STATE);
3055 
3056 	/*
3057 	 * XXX: We need to repost ELS and Target Command Buffers?
3058 	 */
3059 
3060 	/*
3061 	 * Inform the XPT that a bus reset has occurred.
3062 	 */
3063 	xpt_async(AC_BUS_RESET, mpt->path, NULL);
3064 }
3065 
3066 /*
3067  * Parse additional completion information in the reply
3068  * frame for SCSI I/O requests.
3069  */
3070 static int
3071 mpt_scsi_reply_frame_handler(struct mpt_softc *mpt, request_t *req,
3072 			     MSG_DEFAULT_REPLY *reply_frame)
3073 {
3074 	union ccb *ccb;
3075 	MSG_SCSI_IO_REPLY *scsi_io_reply;
3076 	u_int ioc_status;
3077 	u_int sstate;
3078 
3079 	MPT_DUMP_REPLY_FRAME(mpt, reply_frame);
3080 	KASSERT(reply_frame->Function == MPI_FUNCTION_SCSI_IO_REQUEST
3081 	     || reply_frame->Function == MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH,
3082 		("MPT SCSI I/O Handler called with incorrect reply type"));
3083 	KASSERT((reply_frame->MsgFlags & MPI_MSGFLAGS_CONTINUATION_REPLY) == 0,
3084 		("MPT SCSI I/O Handler called with continuation reply"));
3085 
3086 	scsi_io_reply = (MSG_SCSI_IO_REPLY *)reply_frame;
3087 	ioc_status = le16toh(scsi_io_reply->IOCStatus);
3088 	ioc_status &= MPI_IOCSTATUS_MASK;
3089 	sstate = scsi_io_reply->SCSIState;
3090 
3091 	ccb = req->ccb;
3092 	ccb->csio.resid =
3093 	    ccb->csio.dxfer_len - le32toh(scsi_io_reply->TransferCount);
3094 
3095 	if ((sstate & MPI_SCSI_STATE_AUTOSENSE_VALID) != 0
3096 	 && (ccb->ccb_h.flags & (CAM_SENSE_PHYS | CAM_SENSE_PTR)) == 0) {
3097 		ccb->ccb_h.status |= CAM_AUTOSNS_VALID;
3098 		ccb->csio.sense_resid =
3099 		    ccb->csio.sense_len - le32toh(scsi_io_reply->SenseCount);
3100 		bcopy(req->sense_vbuf, &ccb->csio.sense_data,
3101 		    min(ccb->csio.sense_len,
3102 		    le32toh(scsi_io_reply->SenseCount)));
3103 	}
3104 
3105 	if ((sstate & MPI_SCSI_STATE_QUEUE_TAG_REJECTED) != 0) {
3106 		/*
3107 		 * Tag messages rejected, but non-tagged retry
3108 		 * was successful.
3109 XXXX
3110 		mpt_set_tags(mpt, devinfo, MPT_QUEUE_NONE);
3111 		 */
3112 	}
3113 
3114 	switch(ioc_status) {
3115 	case MPI_IOCSTATUS_SCSI_RESIDUAL_MISMATCH:
3116 		/*
3117 		 * XXX
3118 		 * Linux driver indicates that a zero
3119 		 * transfer length with this error code
3120 		 * indicates a CRC error.
3121 		 *
3122 		 * No need to swap the bytes for checking
3123 		 * against zero.
3124 		 */
3125 		if (scsi_io_reply->TransferCount == 0) {
3126 			mpt_set_ccb_status(ccb, CAM_UNCOR_PARITY);
3127 			break;
3128 		}
3129 		/* FALLTHROUGH */
3130 	case MPI_IOCSTATUS_SCSI_DATA_UNDERRUN:
3131 	case MPI_IOCSTATUS_SUCCESS:
3132 	case MPI_IOCSTATUS_SCSI_RECOVERED_ERROR:
3133 		if ((sstate & MPI_SCSI_STATE_NO_SCSI_STATUS) != 0) {
3134 			/*
3135 			 * Status was never returned for this transaction.
3136 			 */
3137 			mpt_set_ccb_status(ccb, CAM_UNEXP_BUSFREE);
3138 		} else if (scsi_io_reply->SCSIStatus != SCSI_STATUS_OK) {
3139 			ccb->csio.scsi_status = scsi_io_reply->SCSIStatus;
3140 			mpt_set_ccb_status(ccb, CAM_SCSI_STATUS_ERROR);
3141 			if ((sstate & MPI_SCSI_STATE_AUTOSENSE_FAILED) != 0)
3142 				mpt_set_ccb_status(ccb, CAM_AUTOSENSE_FAIL);
3143 		} else if ((sstate & MPI_SCSI_STATE_RESPONSE_INFO_VALID) != 0) {
3144 
3145 			/* XXX Handle SPI-Packet and FCP-2 reponse info. */
3146 			mpt_set_ccb_status(ccb, CAM_REQ_CMP_ERR);
3147 		} else
3148 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3149 		break;
3150 	case MPI_IOCSTATUS_SCSI_DATA_OVERRUN:
3151 		mpt_set_ccb_status(ccb, CAM_DATA_RUN_ERR);
3152 		break;
3153 	case MPI_IOCSTATUS_SCSI_IO_DATA_ERROR:
3154 		mpt_set_ccb_status(ccb, CAM_UNCOR_PARITY);
3155 		break;
3156 	case MPI_IOCSTATUS_SCSI_DEVICE_NOT_THERE:
3157 		/*
3158 		 * Since selection timeouts and "device really not
3159 		 * there" are grouped into this error code, report
3160 		 * selection timeout.  Selection timeouts are
3161 		 * typically retried before giving up on the device
3162 		 * whereas "device not there" errors are considered
3163 		 * unretryable.
3164 		 */
3165 		mpt_set_ccb_status(ccb, CAM_SEL_TIMEOUT);
3166 		break;
3167 	case MPI_IOCSTATUS_SCSI_PROTOCOL_ERROR:
3168 		mpt_set_ccb_status(ccb, CAM_SEQUENCE_FAIL);
3169 		break;
3170 	case MPI_IOCSTATUS_SCSI_INVALID_BUS:
3171 		mpt_set_ccb_status(ccb, CAM_PATH_INVALID);
3172 		break;
3173 	case MPI_IOCSTATUS_SCSI_INVALID_TARGETID:
3174 		mpt_set_ccb_status(ccb, CAM_TID_INVALID);
3175 		break;
3176 	case MPI_IOCSTATUS_SCSI_TASK_MGMT_FAILED:
3177 		ccb->ccb_h.status = CAM_UA_TERMIO;
3178 		break;
3179 	case MPI_IOCSTATUS_INVALID_STATE:
3180 		/*
3181 		 * The IOC has been reset.  Emulate a bus reset.
3182 		 */
3183 		/* FALLTHROUGH */
3184 	case MPI_IOCSTATUS_SCSI_EXT_TERMINATED:
3185 		ccb->ccb_h.status = CAM_SCSI_BUS_RESET;
3186 		break;
3187 	case MPI_IOCSTATUS_SCSI_TASK_TERMINATED:
3188 	case MPI_IOCSTATUS_SCSI_IOC_TERMINATED:
3189 		/*
3190 		 * Don't clobber any timeout status that has
3191 		 * already been set for this transaction.  We
3192 		 * want the SCSI layer to be able to differentiate
3193 		 * between the command we aborted due to timeout
3194 		 * and any innocent bystanders.
3195 		 */
3196 		if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_INPROG)
3197 			break;
3198 		mpt_set_ccb_status(ccb, CAM_REQ_TERMIO);
3199 		break;
3200 
3201 	case MPI_IOCSTATUS_INSUFFICIENT_RESOURCES:
3202 		mpt_set_ccb_status(ccb, CAM_RESRC_UNAVAIL);
3203 		break;
3204 	case MPI_IOCSTATUS_BUSY:
3205 		mpt_set_ccb_status(ccb, CAM_BUSY);
3206 		break;
3207 	case MPI_IOCSTATUS_INVALID_FUNCTION:
3208 	case MPI_IOCSTATUS_INVALID_SGL:
3209 	case MPI_IOCSTATUS_INTERNAL_ERROR:
3210 	case MPI_IOCSTATUS_INVALID_FIELD:
3211 	default:
3212 		/* XXX
3213 		 * Some of the above may need to kick
3214 		 * of a recovery action!!!!
3215 		 */
3216 		ccb->ccb_h.status = CAM_UNREC_HBA_ERROR;
3217 		break;
3218 	}
3219 
3220 	if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
3221 		mpt_freeze_ccb(ccb);
3222 	}
3223 
3224 	return (TRUE);
3225 }
3226 
3227 static void
3228 mpt_action(struct cam_sim *sim, union ccb *ccb)
3229 {
3230 	struct mpt_softc *mpt;
3231 	struct ccb_trans_settings *cts;
3232 	target_id_t tgt;
3233 	lun_id_t lun;
3234 	int raid_passthru;
3235 
3236 	CAM_DEBUG(ccb->ccb_h.path, CAM_DEBUG_TRACE, ("mpt_action\n"));
3237 
3238 	mpt = (struct mpt_softc *)cam_sim_softc(sim);
3239 	raid_passthru = (sim == mpt->phydisk_sim);
3240 	MPT_LOCK_ASSERT(mpt);
3241 
3242 	tgt = ccb->ccb_h.target_id;
3243 	lun = ccb->ccb_h.target_lun;
3244 	if (raid_passthru &&
3245 	    ccb->ccb_h.func_code != XPT_PATH_INQ &&
3246 	    ccb->ccb_h.func_code != XPT_RESET_BUS &&
3247 	    ccb->ccb_h.func_code != XPT_RESET_DEV) {
3248 		CAMLOCK_2_MPTLOCK(mpt);
3249 		if (mpt_map_physdisk(mpt, ccb, &tgt) != 0) {
3250 			MPTLOCK_2_CAMLOCK(mpt);
3251 			ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
3252 			mpt_set_ccb_status(ccb, CAM_DEV_NOT_THERE);
3253 			xpt_done(ccb);
3254 			return;
3255 		}
3256 		MPTLOCK_2_CAMLOCK(mpt);
3257 	}
3258 	ccb->ccb_h.ccb_mpt_ptr = mpt;
3259 
3260 	switch (ccb->ccb_h.func_code) {
3261 	case XPT_SCSI_IO:	/* Execute the requested I/O operation */
3262 		/*
3263 		 * Do a couple of preliminary checks...
3264 		 */
3265 		if ((ccb->ccb_h.flags & CAM_CDB_POINTER) != 0) {
3266 			if ((ccb->ccb_h.flags & CAM_CDB_PHYS) != 0) {
3267 				ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
3268 				mpt_set_ccb_status(ccb, CAM_REQ_INVALID);
3269 				break;
3270 			}
3271 		}
3272 		/* Max supported CDB length is 16 bytes */
3273 		/* XXX Unless we implement the new 32byte message type */
3274 		if (ccb->csio.cdb_len >
3275 		    sizeof (((PTR_MSG_SCSI_IO_REQUEST)0)->CDB)) {
3276 			ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
3277 			mpt_set_ccb_status(ccb, CAM_REQ_INVALID);
3278 			break;
3279 		}
3280 #ifdef	MPT_TEST_MULTIPATH
3281 		if (mpt->failure_id == ccb->ccb_h.target_id) {
3282 			ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
3283 			mpt_set_ccb_status(ccb, CAM_SEL_TIMEOUT);
3284 			break;
3285 		}
3286 #endif
3287 		ccb->csio.scsi_status = SCSI_STATUS_OK;
3288 		mpt_start(sim, ccb);
3289 		return;
3290 
3291 	case XPT_RESET_BUS:
3292 		if (raid_passthru) {
3293 			ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
3294 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3295 			break;
3296 		}
3297 	case XPT_RESET_DEV:
3298 		if (ccb->ccb_h.func_code == XPT_RESET_BUS) {
3299 			if (bootverbose) {
3300 				xpt_print(ccb->ccb_h.path, "reset bus\n");
3301 			}
3302 		} else {
3303 			xpt_print(ccb->ccb_h.path, "reset device\n");
3304 		}
3305 		CAMLOCK_2_MPTLOCK(mpt);
3306 		(void) mpt_bus_reset(mpt, tgt, lun, FALSE);
3307 		MPTLOCK_2_CAMLOCK(mpt);
3308 
3309 		/*
3310 		 * mpt_bus_reset is always successful in that it
3311 		 * will fall back to a hard reset should a bus
3312 		 * reset attempt fail.
3313 		 */
3314 		ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
3315 		mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3316 		break;
3317 
3318 	case XPT_ABORT:
3319 	{
3320 		union ccb *accb = ccb->cab.abort_ccb;
3321 		CAMLOCK_2_MPTLOCK(mpt);
3322 		switch (accb->ccb_h.func_code) {
3323 		case XPT_ACCEPT_TARGET_IO:
3324 		case XPT_IMMED_NOTIFY:
3325 			ccb->ccb_h.status = mpt_abort_target_ccb(mpt, ccb);
3326 			break;
3327 		case XPT_CONT_TARGET_IO:
3328 			mpt_prt(mpt, "cannot abort active CTIOs yet\n");
3329 			ccb->ccb_h.status = CAM_UA_ABORT;
3330 			break;
3331 		case XPT_SCSI_IO:
3332 			ccb->ccb_h.status = CAM_UA_ABORT;
3333 			break;
3334 		default:
3335 			ccb->ccb_h.status = CAM_REQ_INVALID;
3336 			break;
3337 		}
3338 		MPTLOCK_2_CAMLOCK(mpt);
3339 		break;
3340 	}
3341 
3342 #ifdef	CAM_NEW_TRAN_CODE
3343 #define	IS_CURRENT_SETTINGS(c)	((c)->type == CTS_TYPE_CURRENT_SETTINGS)
3344 #else
3345 #define	IS_CURRENT_SETTINGS(c)	((c)->flags & CCB_TRANS_CURRENT_SETTINGS)
3346 #endif
3347 #define	DP_DISC_ENABLE	0x1
3348 #define	DP_DISC_DISABL	0x2
3349 #define	DP_DISC		(DP_DISC_ENABLE|DP_DISC_DISABL)
3350 
3351 #define	DP_TQING_ENABLE	0x4
3352 #define	DP_TQING_DISABL	0x8
3353 #define	DP_TQING	(DP_TQING_ENABLE|DP_TQING_DISABL)
3354 
3355 #define	DP_WIDE		0x10
3356 #define	DP_NARROW	0x20
3357 #define	DP_WIDTH	(DP_WIDE|DP_NARROW)
3358 
3359 #define	DP_SYNC		0x40
3360 
3361 	case XPT_SET_TRAN_SETTINGS:	/* Nexus Settings */
3362 	{
3363 #ifdef	CAM_NEW_TRAN_CODE
3364 		struct ccb_trans_settings_scsi *scsi;
3365 		struct ccb_trans_settings_spi *spi;
3366 #endif
3367 		uint8_t dval;
3368 		u_int period;
3369 		u_int offset;
3370 		int i, j;
3371 
3372 		cts = &ccb->cts;
3373 
3374 		if (mpt->is_fc || mpt->is_sas) {
3375 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3376 			break;
3377 		}
3378 
3379 #ifdef	CAM_NEW_TRAN_CODE
3380 		scsi = &cts->proto_specific.scsi;
3381 		spi = &cts->xport_specific.spi;
3382 
3383 		/*
3384 		 * We can be called just to valid transport and proto versions
3385 		 */
3386 		if (scsi->valid == 0 && spi->valid == 0) {
3387 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3388 			break;
3389 		}
3390 #endif
3391 
3392 		/*
3393 		 * Skip attempting settings on RAID volume disks.
3394 		 * Other devices on the bus get the normal treatment.
3395 		 */
3396 		if (mpt->phydisk_sim && raid_passthru == 0 &&
3397 		    mpt_is_raid_volume(mpt, tgt) != 0) {
3398 			mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
3399 			    "no transfer settings for RAID vols\n");
3400 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3401 			break;
3402 		}
3403 
3404 		i = mpt->mpt_port_page2.PortSettings &
3405 		    MPI_SCSIPORTPAGE2_PORT_MASK_NEGO_MASTER_SETTINGS;
3406 		j = mpt->mpt_port_page2.PortFlags &
3407 		    MPI_SCSIPORTPAGE2_PORT_FLAGS_DV_MASK;
3408 		if (i == MPI_SCSIPORTPAGE2_PORT_ALL_MASTER_SETTINGS &&
3409 		    j == MPI_SCSIPORTPAGE2_PORT_FLAGS_OFF_DV) {
3410 			mpt_lprt(mpt, MPT_PRT_ALWAYS,
3411 			    "honoring BIOS transfer negotiations\n");
3412 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3413 			break;
3414 		}
3415 
3416 		dval = 0;
3417 		period = 0;
3418 		offset = 0;
3419 
3420 #ifndef	CAM_NEW_TRAN_CODE
3421 		if ((cts->valid & CCB_TRANS_DISC_VALID) != 0) {
3422 			dval |= (cts->flags & CCB_TRANS_DISC_ENB) ?
3423 			    DP_DISC_ENABLE : DP_DISC_DISABL;
3424 		}
3425 
3426 		if ((cts->valid & CCB_TRANS_TQ_VALID) != 0) {
3427 			dval |= (cts->flags & CCB_TRANS_TAG_ENB) ?
3428 			    DP_TQING_ENABLE : DP_TQING_DISABL;
3429 		}
3430 
3431 		if ((cts->valid & CCB_TRANS_BUS_WIDTH_VALID) != 0) {
3432 			dval |= cts->bus_width ? DP_WIDE : DP_NARROW;
3433 		}
3434 
3435 		if ((cts->valid & CCB_TRANS_SYNC_RATE_VALID) &&
3436 		    (cts->valid & CCB_TRANS_SYNC_OFFSET_VALID)) {
3437 			dval |= DP_SYNC;
3438 			period = cts->sync_period;
3439 			offset = cts->sync_offset;
3440 		}
3441 #else
3442 		if ((spi->valid & CTS_SPI_VALID_DISC) != 0) {
3443 			dval |= ((spi->flags & CTS_SPI_FLAGS_DISC_ENB) != 0) ?
3444 			    DP_DISC_ENABLE : DP_DISC_DISABL;
3445 		}
3446 
3447 		if ((scsi->valid & CTS_SCSI_VALID_TQ) != 0) {
3448 			dval |= ((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0) ?
3449 			    DP_TQING_ENABLE : DP_TQING_DISABL;
3450 		}
3451 
3452 		if ((spi->valid & CTS_SPI_VALID_BUS_WIDTH) != 0) {
3453 			dval |= (spi->bus_width == MSG_EXT_WDTR_BUS_16_BIT) ?
3454 			    DP_WIDE : DP_NARROW;
3455 		}
3456 
3457 		if (spi->valid & CTS_SPI_VALID_SYNC_OFFSET) {
3458 			dval |= DP_SYNC;
3459 			offset = spi->sync_offset;
3460 		} else {
3461 			PTR_CONFIG_PAGE_SCSI_DEVICE_1 ptr =
3462 			    &mpt->mpt_dev_page1[tgt];
3463 			offset = ptr->RequestedParameters;
3464 			offset &= MPI_SCSIDEVPAGE1_RP_MAX_SYNC_OFFSET_MASK;
3465 	    		offset >>= MPI_SCSIDEVPAGE1_RP_SHIFT_MAX_SYNC_OFFSET;
3466 		}
3467 		if (spi->valid & CTS_SPI_VALID_SYNC_RATE) {
3468 			dval |= DP_SYNC;
3469 			period = spi->sync_period;
3470 		} else {
3471 			PTR_CONFIG_PAGE_SCSI_DEVICE_1 ptr =
3472 			    &mpt->mpt_dev_page1[tgt];
3473 			period = ptr->RequestedParameters;
3474 			period &= MPI_SCSIDEVPAGE1_RP_MIN_SYNC_PERIOD_MASK;
3475 	    		period >>= MPI_SCSIDEVPAGE1_RP_SHIFT_MIN_SYNC_PERIOD;
3476 		}
3477 #endif
3478 		CAMLOCK_2_MPTLOCK(mpt);
3479 		if (dval & DP_DISC_ENABLE) {
3480 			mpt->mpt_disc_enable |= (1 << tgt);
3481 		} else if (dval & DP_DISC_DISABL) {
3482 			mpt->mpt_disc_enable &= ~(1 << tgt);
3483 		}
3484 		if (dval & DP_TQING_ENABLE) {
3485 			mpt->mpt_tag_enable |= (1 << tgt);
3486 		} else if (dval & DP_TQING_DISABL) {
3487 			mpt->mpt_tag_enable &= ~(1 << tgt);
3488 		}
3489 		if (dval & DP_WIDTH) {
3490 			mpt_setwidth(mpt, tgt, 1);
3491 		}
3492 		if (dval & DP_SYNC) {
3493 			mpt_setsync(mpt, tgt, period, offset);
3494 		}
3495 		if (dval == 0) {
3496 			MPTLOCK_2_CAMLOCK(mpt);
3497 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3498 			break;
3499 		}
3500 		mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
3501 		    "set [%d]: 0x%x period 0x%x offset %d\n",
3502 		    tgt, dval, period, offset);
3503 		if (mpt_update_spi_config(mpt, tgt)) {
3504 			mpt_set_ccb_status(ccb, CAM_REQ_CMP_ERR);
3505 		} else {
3506 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3507 		}
3508 		MPTLOCK_2_CAMLOCK(mpt);
3509 		break;
3510 	}
3511 	case XPT_GET_TRAN_SETTINGS:
3512 	{
3513 #ifdef	CAM_NEW_TRAN_CODE
3514 		struct ccb_trans_settings_scsi *scsi;
3515 		cts = &ccb->cts;
3516 		cts->protocol = PROTO_SCSI;
3517 		if (mpt->is_fc) {
3518 			struct ccb_trans_settings_fc *fc =
3519 			    &cts->xport_specific.fc;
3520 			cts->protocol_version = SCSI_REV_SPC;
3521 			cts->transport = XPORT_FC;
3522 			cts->transport_version = 0;
3523 			fc->valid = CTS_FC_VALID_SPEED;
3524 			fc->bitrate = 100000;
3525 		} else if (mpt->is_sas) {
3526 			struct ccb_trans_settings_sas *sas =
3527 			    &cts->xport_specific.sas;
3528 			cts->protocol_version = SCSI_REV_SPC2;
3529 			cts->transport = XPORT_SAS;
3530 			cts->transport_version = 0;
3531 			sas->valid = CTS_SAS_VALID_SPEED;
3532 			sas->bitrate = 300000;
3533 		} else {
3534 			cts->protocol_version = SCSI_REV_2;
3535 			cts->transport = XPORT_SPI;
3536 			cts->transport_version = 2;
3537 			if (mpt_get_spi_settings(mpt, cts) != 0) {
3538 				mpt_set_ccb_status(ccb, CAM_REQ_CMP_ERR);
3539 				break;
3540 			}
3541 		}
3542 		scsi = &cts->proto_specific.scsi;
3543 		scsi->valid = CTS_SCSI_VALID_TQ;
3544 		scsi->flags = CTS_SCSI_FLAGS_TAG_ENB;
3545 #else
3546 		cts = &ccb->cts;
3547 		if (mpt->is_fc) {
3548 			cts->flags = CCB_TRANS_TAG_ENB | CCB_TRANS_DISC_ENB;
3549 			cts->valid = CCB_TRANS_DISC_VALID | CCB_TRANS_TQ_VALID;
3550 			cts->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
3551 		} else if (mpt->is_sas) {
3552 			cts->flags = CCB_TRANS_TAG_ENB | CCB_TRANS_DISC_ENB;
3553 			cts->valid = CCB_TRANS_DISC_VALID | CCB_TRANS_TQ_VALID;
3554 			cts->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
3555 		} else if (mpt_get_spi_settings(mpt, cts) != 0) {
3556 			mpt_set_ccb_status(ccb, CAM_REQ_CMP_ERR);
3557 			break;
3558 		}
3559 #endif
3560 		mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3561 		break;
3562 	}
3563 	case XPT_CALC_GEOMETRY:
3564 	{
3565 		struct ccb_calc_geometry *ccg;
3566 
3567 		ccg = &ccb->ccg;
3568 		if (ccg->block_size == 0) {
3569 			ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
3570 			mpt_set_ccb_status(ccb, CAM_REQ_INVALID);
3571 			break;
3572 		}
3573 		mpt_calc_geometry(ccg, /*extended*/1);
3574 		KASSERT(ccb->ccb_h.status, ("zero ccb sts at %d\n", __LINE__));
3575 		break;
3576 	}
3577 	case XPT_PATH_INQ:		/* Path routing inquiry */
3578 	{
3579 		struct ccb_pathinq *cpi = &ccb->cpi;
3580 
3581 		cpi->version_num = 1;
3582 		cpi->target_sprt = 0;
3583 		cpi->hba_eng_cnt = 0;
3584 		cpi->max_target = mpt->port_facts[0].MaxDevices - 1;
3585 		/*
3586 		 * FC cards report MAX_DEVICES of 512, but
3587 		 * the MSG_SCSI_IO_REQUEST target id field
3588 		 * is only 8 bits. Until we fix the driver
3589 		 * to support 'channels' for bus overflow,
3590 		 * just limit it.
3591 		 */
3592 		if (cpi->max_target > 255) {
3593 			cpi->max_target = 255;
3594 		}
3595 
3596 		/*
3597 		 * VMware ESX reports > 16 devices and then dies when we probe.
3598 		 */
3599 		if (mpt->is_spi && cpi->max_target > 15) {
3600 			cpi->max_target = 15;
3601 		}
3602 		if (mpt->is_spi)
3603 			cpi->max_lun = 7;
3604 		else
3605 			cpi->max_lun = MPT_MAX_LUNS;
3606 		cpi->initiator_id = mpt->mpt_ini_id;
3607 		cpi->bus_id = cam_sim_bus(sim);
3608 
3609 		/*
3610 		 * The base speed is the speed of the underlying connection.
3611 		 */
3612 #ifdef	CAM_NEW_TRAN_CODE
3613 		cpi->protocol = PROTO_SCSI;
3614 		if (mpt->is_fc) {
3615 			cpi->hba_misc = PIM_NOBUSRESET;
3616 			cpi->base_transfer_speed = 100000;
3617 			cpi->hba_inquiry = PI_TAG_ABLE;
3618 			cpi->transport = XPORT_FC;
3619 			cpi->transport_version = 0;
3620 			cpi->protocol_version = SCSI_REV_SPC;
3621 		} else if (mpt->is_sas) {
3622 			cpi->hba_misc = PIM_NOBUSRESET;
3623 			cpi->base_transfer_speed = 300000;
3624 			cpi->hba_inquiry = PI_TAG_ABLE;
3625 			cpi->transport = XPORT_SAS;
3626 			cpi->transport_version = 0;
3627 			cpi->protocol_version = SCSI_REV_SPC2;
3628 		} else {
3629 			cpi->hba_misc = PIM_SEQSCAN;
3630 			cpi->base_transfer_speed = 3300;
3631 			cpi->hba_inquiry = PI_SDTR_ABLE|PI_TAG_ABLE|PI_WIDE_16;
3632 			cpi->transport = XPORT_SPI;
3633 			cpi->transport_version = 2;
3634 			cpi->protocol_version = SCSI_REV_2;
3635 		}
3636 #else
3637 		if (mpt->is_fc) {
3638 			cpi->hba_misc = PIM_NOBUSRESET;
3639 			cpi->base_transfer_speed = 100000;
3640 			cpi->hba_inquiry = PI_TAG_ABLE;
3641 		} else if (mpt->is_sas) {
3642 			cpi->hba_misc = PIM_NOBUSRESET;
3643 			cpi->base_transfer_speed = 300000;
3644 			cpi->hba_inquiry = PI_TAG_ABLE;
3645 		} else {
3646 			cpi->hba_misc = PIM_SEQSCAN;
3647 			cpi->base_transfer_speed = 3300;
3648 			cpi->hba_inquiry = PI_SDTR_ABLE|PI_TAG_ABLE|PI_WIDE_16;
3649 		}
3650 #endif
3651 
3652 		/*
3653 		 * We give our fake RAID passhtru bus a width that is MaxVolumes
3654 		 * wide and restrict it to one lun.
3655 		 */
3656 		if (raid_passthru) {
3657 			cpi->max_target = mpt->ioc_page2->MaxPhysDisks - 1;
3658 			cpi->initiator_id = cpi->max_target + 1;
3659 			cpi->max_lun = 0;
3660 		}
3661 
3662 		if ((mpt->role & MPT_ROLE_INITIATOR) == 0) {
3663 			cpi->hba_misc |= PIM_NOINITIATOR;
3664 		}
3665 		if (mpt->is_fc && (mpt->role & MPT_ROLE_TARGET)) {
3666 			cpi->target_sprt =
3667 			    PIT_PROCESSOR | PIT_DISCONNECT | PIT_TERM_IO;
3668 		} else {
3669 			cpi->target_sprt = 0;
3670 		}
3671 		strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
3672 		strncpy(cpi->hba_vid, "LSI", HBA_IDLEN);
3673 		strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
3674 		cpi->unit_number = cam_sim_unit(sim);
3675 		cpi->ccb_h.status = CAM_REQ_CMP;
3676 		break;
3677 	}
3678 	case XPT_EN_LUN:		/* Enable LUN as a target */
3679 	{
3680 		int result;
3681 
3682 		CAMLOCK_2_MPTLOCK(mpt);
3683 		if (ccb->cel.enable)
3684 			result = mpt_enable_lun(mpt,
3685 			    ccb->ccb_h.target_id, ccb->ccb_h.target_lun);
3686 		else
3687 			result = mpt_disable_lun(mpt,
3688 			    ccb->ccb_h.target_id, ccb->ccb_h.target_lun);
3689 		MPTLOCK_2_CAMLOCK(mpt);
3690 		if (result == 0) {
3691 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
3692 		} else {
3693 			mpt_set_ccb_status(ccb, CAM_REQ_CMP_ERR);
3694 		}
3695 		break;
3696 	}
3697 	case XPT_NOTIFY_ACK:		/* recycle notify ack */
3698 	case XPT_IMMED_NOTIFY:		/* Add Immediate Notify Resource */
3699 	case XPT_ACCEPT_TARGET_IO:	/* Add Accept Target IO Resource */
3700 	{
3701 		tgt_resource_t *trtp;
3702 		lun_id_t lun = ccb->ccb_h.target_lun;
3703 		ccb->ccb_h.sim_priv.entries[0].field = 0;
3704 		ccb->ccb_h.sim_priv.entries[1].ptr = mpt;
3705 		ccb->ccb_h.flags = 0;
3706 
3707 		if (lun == CAM_LUN_WILDCARD) {
3708 			if (ccb->ccb_h.target_id != CAM_TARGET_WILDCARD) {
3709 				mpt_set_ccb_status(ccb, CAM_REQ_INVALID);
3710 				break;
3711 			}
3712 			trtp = &mpt->trt_wildcard;
3713 		} else if (lun >= MPT_MAX_LUNS) {
3714 			mpt_set_ccb_status(ccb, CAM_REQ_INVALID);
3715 			break;
3716 		} else {
3717 			trtp = &mpt->trt[lun];
3718 		}
3719 		CAMLOCK_2_MPTLOCK(mpt);
3720 		if (ccb->ccb_h.func_code == XPT_ACCEPT_TARGET_IO) {
3721 			mpt_lprt(mpt, MPT_PRT_DEBUG1,
3722 			    "Put FREE ATIO %p lun %d\n", ccb, lun);
3723 			STAILQ_INSERT_TAIL(&trtp->atios, &ccb->ccb_h,
3724 			    sim_links.stqe);
3725 		} else if (ccb->ccb_h.func_code == XPT_IMMED_NOTIFY) {
3726 			mpt_lprt(mpt, MPT_PRT_DEBUG1,
3727 			    "Put FREE INOT lun %d\n", lun);
3728 			STAILQ_INSERT_TAIL(&trtp->inots, &ccb->ccb_h,
3729 			    sim_links.stqe);
3730 		} else {
3731 			mpt_lprt(mpt, MPT_PRT_ALWAYS, "Got Notify ACK\n");
3732 		}
3733 		mpt_set_ccb_status(ccb, CAM_REQ_INPROG);
3734 		MPTLOCK_2_CAMLOCK(mpt);
3735 		return;
3736 	}
3737 	case XPT_CONT_TARGET_IO:
3738 		CAMLOCK_2_MPTLOCK(mpt);
3739 		mpt_target_start_io(mpt, ccb);
3740 		MPTLOCK_2_CAMLOCK(mpt);
3741 		return;
3742 
3743 	default:
3744 		ccb->ccb_h.status = CAM_REQ_INVALID;
3745 		break;
3746 	}
3747 	xpt_done(ccb);
3748 }
3749 
3750 static int
3751 mpt_get_spi_settings(struct mpt_softc *mpt, struct ccb_trans_settings *cts)
3752 {
3753 #ifdef	CAM_NEW_TRAN_CODE
3754 	struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
3755 	struct ccb_trans_settings_spi *spi = &cts->xport_specific.spi;
3756 #endif
3757 	target_id_t tgt;
3758 	uint32_t dval, pval, oval;
3759 	int rv;
3760 
3761 	if (IS_CURRENT_SETTINGS(cts) == 0) {
3762 		tgt = cts->ccb_h.target_id;
3763 	} else if (xpt_path_sim(cts->ccb_h.path) == mpt->phydisk_sim) {
3764 		if (mpt_map_physdisk(mpt, (union ccb *)cts, &tgt)) {
3765 			return (-1);
3766 		}
3767 	} else {
3768 		tgt = cts->ccb_h.target_id;
3769 	}
3770 
3771 	/*
3772 	 * We aren't looking at Port Page 2 BIOS settings here-
3773 	 * sometimes these have been known to be bogus XXX.
3774 	 *
3775 	 * For user settings, we pick the max from port page 0
3776 	 *
3777 	 * For current settings we read the current settings out from
3778 	 * device page 0 for that target.
3779 	 */
3780 	if (IS_CURRENT_SETTINGS(cts)) {
3781 		CONFIG_PAGE_SCSI_DEVICE_0 tmp;
3782 		dval = 0;
3783 
3784 		CAMLOCK_2_MPTLOCK(mpt);
3785 		tmp = mpt->mpt_dev_page0[tgt];
3786 		rv = mpt_read_cur_cfg_page(mpt, tgt, &tmp.Header,
3787 		    sizeof(tmp), FALSE, 5000);
3788 		if (rv) {
3789 			MPTLOCK_2_CAMLOCK(mpt);
3790 			mpt_prt(mpt, "can't get tgt %d config page 0\n", tgt);
3791 			return (rv);
3792 		}
3793 		mpt2host_config_page_scsi_device_0(&tmp);
3794 
3795 		MPTLOCK_2_CAMLOCK(mpt);
3796 		mpt_lprt(mpt, MPT_PRT_DEBUG,
3797 		    "mpt_get_spi_settings[%d]: current NP %x Info %x\n", tgt,
3798 		    tmp.NegotiatedParameters, tmp.Information);
3799 		dval |= (tmp.NegotiatedParameters & MPI_SCSIDEVPAGE0_NP_WIDE) ?
3800 		    DP_WIDE : DP_NARROW;
3801 		dval |= (mpt->mpt_disc_enable & (1 << tgt)) ?
3802 		    DP_DISC_ENABLE : DP_DISC_DISABL;
3803 		dval |= (mpt->mpt_tag_enable & (1 << tgt)) ?
3804 		    DP_TQING_ENABLE : DP_TQING_DISABL;
3805 		oval = tmp.NegotiatedParameters;
3806 		oval &= MPI_SCSIDEVPAGE0_NP_NEG_SYNC_OFFSET_MASK;
3807 		oval >>= MPI_SCSIDEVPAGE0_NP_SHIFT_SYNC_OFFSET;
3808 		pval = tmp.NegotiatedParameters;
3809 		pval &= MPI_SCSIDEVPAGE0_NP_NEG_SYNC_PERIOD_MASK;
3810 		pval >>= MPI_SCSIDEVPAGE0_NP_SHIFT_SYNC_PERIOD;
3811 		mpt->mpt_dev_page0[tgt] = tmp;
3812 	} else {
3813 		dval = DP_WIDE|DP_DISC_ENABLE|DP_TQING_ENABLE|DP_SYNC;
3814 		oval = mpt->mpt_port_page0.Capabilities;
3815 		oval = MPI_SCSIPORTPAGE0_CAP_GET_MAX_SYNC_OFFSET(oval);
3816 		pval = mpt->mpt_port_page0.Capabilities;
3817 		pval = MPI_SCSIPORTPAGE0_CAP_GET_MIN_SYNC_PERIOD(pval);
3818 	}
3819 
3820 #ifndef	CAM_NEW_TRAN_CODE
3821 	cts->flags &= ~(CCB_TRANS_DISC_ENB|CCB_TRANS_TAG_ENB);
3822 	cts->valid = 0;
3823 	cts->sync_period = pval;
3824 	cts->sync_offset = oval;
3825 	cts->valid |= CCB_TRANS_SYNC_RATE_VALID;
3826 	cts->valid |= CCB_TRANS_SYNC_OFFSET_VALID;
3827 	cts->valid |= CCB_TRANS_BUS_WIDTH_VALID;
3828 	if (dval & DP_WIDE) {
3829 		cts->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
3830 	} else {
3831 		cts->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
3832 	}
3833 	if (cts->ccb_h.target_lun != CAM_LUN_WILDCARD) {
3834 		cts->valid |= CCB_TRANS_DISC_VALID | CCB_TRANS_TQ_VALID;
3835 		if (dval & DP_DISC_ENABLE) {
3836 			cts->flags |= CCB_TRANS_DISC_ENB;
3837 		}
3838 		if (dval & DP_TQING_ENABLE) {
3839 			cts->flags |= CCB_TRANS_TAG_ENB;
3840 		}
3841 	}
3842 #else
3843 	spi->valid = 0;
3844 	scsi->valid = 0;
3845 	spi->flags = 0;
3846 	scsi->flags = 0;
3847 	spi->sync_offset = oval;
3848 	spi->sync_period = pval;
3849 	spi->valid |= CTS_SPI_VALID_SYNC_OFFSET;
3850 	spi->valid |= CTS_SPI_VALID_SYNC_RATE;
3851 	spi->valid |= CTS_SPI_VALID_BUS_WIDTH;
3852 	if (dval & DP_WIDE) {
3853 		spi->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
3854 	} else {
3855 		spi->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
3856 	}
3857 	if (cts->ccb_h.target_lun != CAM_LUN_WILDCARD) {
3858 		scsi->valid = CTS_SCSI_VALID_TQ;
3859 		if (dval & DP_TQING_ENABLE) {
3860 			scsi->flags |= CTS_SCSI_FLAGS_TAG_ENB;
3861 		}
3862 		spi->valid |= CTS_SPI_VALID_DISC;
3863 		if (dval & DP_DISC_ENABLE) {
3864 			spi->flags |= CTS_SPI_FLAGS_DISC_ENB;
3865 		}
3866 	}
3867 #endif
3868 	mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
3869 	    "mpt_get_spi_settings[%d]: %s flags 0x%x per 0x%x off=%d\n", tgt,
3870 	    IS_CURRENT_SETTINGS(cts)? "ACTIVE" : "NVRAM ", dval, pval, oval);
3871 	return (0);
3872 }
3873 
3874 static void
3875 mpt_setwidth(struct mpt_softc *mpt, int tgt, int onoff)
3876 {
3877 	PTR_CONFIG_PAGE_SCSI_DEVICE_1 ptr;
3878 
3879 	ptr = &mpt->mpt_dev_page1[tgt];
3880 	if (onoff) {
3881 		ptr->RequestedParameters |= MPI_SCSIDEVPAGE1_RP_WIDE;
3882 	} else {
3883 		ptr->RequestedParameters &= ~MPI_SCSIDEVPAGE1_RP_WIDE;
3884 	}
3885 }
3886 
3887 static void
3888 mpt_setsync(struct mpt_softc *mpt, int tgt, int period, int offset)
3889 {
3890 	PTR_CONFIG_PAGE_SCSI_DEVICE_1 ptr;
3891 
3892 	ptr = &mpt->mpt_dev_page1[tgt];
3893 	ptr->RequestedParameters &= ~MPI_SCSIDEVPAGE1_RP_MIN_SYNC_PERIOD_MASK;
3894 	ptr->RequestedParameters &= ~MPI_SCSIDEVPAGE1_RP_MAX_SYNC_OFFSET_MASK;
3895 	ptr->RequestedParameters &= ~MPI_SCSIDEVPAGE1_RP_DT;
3896 	ptr->RequestedParameters &= ~MPI_SCSIDEVPAGE1_RP_QAS;
3897 	ptr->RequestedParameters &= ~MPI_SCSIDEVPAGE1_RP_IU;
3898 	if (period == 0) {
3899 		return;
3900 	}
3901 	ptr->RequestedParameters |=
3902 	    period << MPI_SCSIDEVPAGE1_RP_SHIFT_MIN_SYNC_PERIOD;
3903 	ptr->RequestedParameters |=
3904 	    offset << MPI_SCSIDEVPAGE1_RP_SHIFT_MAX_SYNC_OFFSET;
3905 	if (period < 0xa) {
3906 		ptr->RequestedParameters |= MPI_SCSIDEVPAGE1_RP_DT;
3907 	}
3908 	if (period < 0x9) {
3909 		ptr->RequestedParameters |= MPI_SCSIDEVPAGE1_RP_QAS;
3910 		ptr->RequestedParameters |= MPI_SCSIDEVPAGE1_RP_IU;
3911 	}
3912 }
3913 
3914 static int
3915 mpt_update_spi_config(struct mpt_softc *mpt, int tgt)
3916 {
3917 	CONFIG_PAGE_SCSI_DEVICE_1 tmp;
3918 	int rv;
3919 
3920 	mpt_lprt(mpt, MPT_PRT_NEGOTIATION,
3921 	    "mpt_update_spi_config[%d].page1: Requested Params 0x%08x\n",
3922 	    tgt, mpt->mpt_dev_page1[tgt].RequestedParameters);
3923 	tmp = mpt->mpt_dev_page1[tgt];
3924 	host2mpt_config_page_scsi_device_1(&tmp);
3925 	rv = mpt_write_cur_cfg_page(mpt, tgt,
3926 	    &tmp.Header, sizeof(tmp), FALSE, 5000);
3927 	if (rv) {
3928 		mpt_prt(mpt, "mpt_update_spi_config: write cur page failed\n");
3929 		return (-1);
3930 	}
3931 	return (0);
3932 }
3933 
3934 static void
3935 mpt_calc_geometry(struct ccb_calc_geometry *ccg, int extended)
3936 {
3937 #if __FreeBSD_version >= 500000
3938 	cam_calc_geometry(ccg, extended);
3939 #else
3940 	uint32_t size_mb;
3941 	uint32_t secs_per_cylinder;
3942 
3943 	if (ccg->block_size == 0) {
3944 		ccg->ccb_h.status = CAM_REQ_INVALID;
3945 		return;
3946 	}
3947 	size_mb = ccg->volume_size / ((1024L * 1024L) / ccg->block_size);
3948 	if (size_mb > 1024 && extended) {
3949 		ccg->heads = 255;
3950 		ccg->secs_per_track = 63;
3951 	} else {
3952 		ccg->heads = 64;
3953 		ccg->secs_per_track = 32;
3954 	}
3955 	secs_per_cylinder = ccg->heads * ccg->secs_per_track;
3956 	ccg->cylinders = ccg->volume_size / secs_per_cylinder;
3957 	ccg->ccb_h.status = CAM_REQ_CMP;
3958 #endif
3959 }
3960 
3961 /****************************** Timeout Recovery ******************************/
3962 static int
3963 mpt_spawn_recovery_thread(struct mpt_softc *mpt)
3964 {
3965 	int error;
3966 
3967 	error = mpt_kthread_create(mpt_recovery_thread, mpt,
3968 	    &mpt->recovery_thread, /*flags*/0,
3969 	    /*altstack*/0, "mpt_recovery%d", mpt->unit);
3970 	return (error);
3971 }
3972 
3973 static void
3974 mpt_terminate_recovery_thread(struct mpt_softc *mpt)
3975 {
3976 	if (mpt->recovery_thread == NULL) {
3977 		return;
3978 	}
3979 	mpt->shutdwn_recovery = 1;
3980 	wakeup(mpt);
3981 	/*
3982 	 * Sleep on a slightly different location
3983 	 * for this interlock just for added safety.
3984 	 */
3985 	mpt_sleep(mpt, &mpt->recovery_thread, PUSER, "thtrm", 0);
3986 }
3987 
3988 static void
3989 mpt_recovery_thread(void *arg)
3990 {
3991 	struct mpt_softc *mpt;
3992 
3993 	mpt = (struct mpt_softc *)arg;
3994 	MPT_LOCK(mpt);
3995 	for (;;) {
3996 		if (TAILQ_EMPTY(&mpt->request_timeout_list) != 0) {
3997 			if (mpt->shutdwn_recovery == 0) {
3998 				mpt_sleep(mpt, mpt, PUSER, "idle", 0);
3999 			}
4000 		}
4001 		if (mpt->shutdwn_recovery != 0) {
4002 			break;
4003 		}
4004 		mpt_recover_commands(mpt);
4005 	}
4006 	mpt->recovery_thread = NULL;
4007 	wakeup(&mpt->recovery_thread);
4008 	MPT_UNLOCK(mpt);
4009 	mpt_kthread_exit(0);
4010 }
4011 
4012 static int
4013 mpt_scsi_send_tmf(struct mpt_softc *mpt, u_int type, u_int flags,
4014     u_int channel, u_int target, u_int lun, u_int abort_ctx, int sleep_ok)
4015 {
4016 	MSG_SCSI_TASK_MGMT *tmf_req;
4017 	int		    error;
4018 
4019 	/*
4020 	 * Wait for any current TMF request to complete.
4021 	 * We're only allowed to issue one TMF at a time.
4022 	 */
4023 	error = mpt_wait_req(mpt, mpt->tmf_req, REQ_STATE_FREE, REQ_STATE_FREE,
4024 	    sleep_ok, MPT_TMF_MAX_TIMEOUT);
4025 	if (error != 0) {
4026 		mpt_reset(mpt, TRUE);
4027 		return (ETIMEDOUT);
4028 	}
4029 
4030 	mpt_assign_serno(mpt, mpt->tmf_req);
4031 	mpt->tmf_req->state = REQ_STATE_ALLOCATED|REQ_STATE_QUEUED;
4032 
4033 	tmf_req = (MSG_SCSI_TASK_MGMT *)mpt->tmf_req->req_vbuf;
4034 	memset(tmf_req, 0, sizeof(*tmf_req));
4035 	tmf_req->TargetID = target;
4036 	tmf_req->Bus = channel;
4037 	tmf_req->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
4038 	tmf_req->TaskType = type;
4039 	tmf_req->MsgFlags = flags;
4040 	tmf_req->MsgContext =
4041 	    htole32(mpt->tmf_req->index | scsi_tmf_handler_id);
4042 	if (lun > MPT_MAX_LUNS) {
4043 		tmf_req->LUN[0] = 0x40 | ((lun >> 8) & 0x3f);
4044 		tmf_req->LUN[1] = lun & 0xff;
4045 	} else {
4046 		tmf_req->LUN[1] = lun;
4047 	}
4048 	tmf_req->TaskMsgContext = abort_ctx;
4049 
4050 	mpt_lprt(mpt, MPT_PRT_DEBUG,
4051 	    "Issuing TMF %p:%u with MsgContext of 0x%x\n", mpt->tmf_req,
4052 	    mpt->tmf_req->serno, tmf_req->MsgContext);
4053 	if (mpt->verbose > MPT_PRT_DEBUG) {
4054 		mpt_print_request(tmf_req);
4055 	}
4056 
4057 	KASSERT(mpt_req_on_pending_list(mpt, mpt->tmf_req) == 0,
4058 	    ("mpt_scsi_send_tmf: tmf_req already on pending list"));
4059 	TAILQ_INSERT_HEAD(&mpt->request_pending_list, mpt->tmf_req, links);
4060 	error = mpt_send_handshake_cmd(mpt, sizeof(*tmf_req), tmf_req);
4061 	if (error != MPT_OK) {
4062 		TAILQ_REMOVE(&mpt->request_pending_list, mpt->tmf_req, links);
4063 		mpt->tmf_req->state = REQ_STATE_FREE;
4064 		mpt_reset(mpt, TRUE);
4065 	}
4066 	return (error);
4067 }
4068 
4069 /*
4070  * When a command times out, it is placed on the requeust_timeout_list
4071  * and we wake our recovery thread.  The MPT-Fusion architecture supports
4072  * only a single TMF operation at a time, so we serially abort/bdr, etc,
4073  * the timedout transactions.  The next TMF is issued either by the
4074  * completion handler of the current TMF waking our recovery thread,
4075  * or the TMF timeout handler causing a hard reset sequence.
4076  */
4077 static void
4078 mpt_recover_commands(struct mpt_softc *mpt)
4079 {
4080 	request_t	   *req;
4081 	union ccb	   *ccb;
4082 	int		    error;
4083 
4084 	if (TAILQ_EMPTY(&mpt->request_timeout_list) != 0) {
4085 		/*
4086 		 * No work to do- leave.
4087 		 */
4088 		mpt_prt(mpt, "mpt_recover_commands: no requests.\n");
4089 		return;
4090 	}
4091 
4092 	/*
4093 	 * Flush any commands whose completion coincides with their timeout.
4094 	 */
4095 	mpt_intr(mpt);
4096 
4097 	if (TAILQ_EMPTY(&mpt->request_timeout_list) != 0) {
4098 		/*
4099 		 * The timedout commands have already
4100 		 * completed.  This typically means
4101 		 * that either the timeout value was on
4102 		 * the hairy edge of what the device
4103 		 * requires or - more likely - interrupts
4104 		 * are not happening.
4105 		 */
4106 		mpt_prt(mpt, "Timedout requests already complete. "
4107 		    "Interrupts may not be functioning.\n");
4108 		mpt_enable_ints(mpt);
4109 		return;
4110 	}
4111 
4112 	/*
4113 	 * We have no visibility into the current state of the
4114 	 * controller, so attempt to abort the commands in the
4115 	 * order they timed-out. For initiator commands, we
4116 	 * depend on the reply handler pulling requests off
4117 	 * the timeout list.
4118 	 */
4119 	while ((req = TAILQ_FIRST(&mpt->request_timeout_list)) != NULL) {
4120 		uint16_t status;
4121 		uint8_t response;
4122 		MSG_REQUEST_HEADER *hdrp = req->req_vbuf;
4123 
4124 		mpt_prt(mpt, "attempting to abort req %p:%u function %x\n",
4125 		    req, req->serno, hdrp->Function);
4126 		ccb = req->ccb;
4127 		if (ccb == NULL) {
4128 			mpt_prt(mpt, "null ccb in timed out request. "
4129 			    "Resetting Controller.\n");
4130 			mpt_reset(mpt, TRUE);
4131 			continue;
4132 		}
4133 		mpt_set_ccb_status(ccb, CAM_CMD_TIMEOUT);
4134 
4135 		/*
4136 		 * Check to see if this is not an initiator command and
4137 		 * deal with it differently if it is.
4138 		 */
4139 		switch (hdrp->Function) {
4140 		case MPI_FUNCTION_SCSI_IO_REQUEST:
4141 		case MPI_FUNCTION_RAID_SCSI_IO_PASSTHROUGH:
4142 			break;
4143 		default:
4144 			/*
4145 			 * XXX: FIX ME: need to abort target assists...
4146 			 */
4147 			mpt_prt(mpt, "just putting it back on the pend q\n");
4148 			TAILQ_REMOVE(&mpt->request_timeout_list, req, links);
4149 			TAILQ_INSERT_HEAD(&mpt->request_pending_list, req,
4150 			    links);
4151 			continue;
4152 		}
4153 
4154 		error = mpt_scsi_send_tmf(mpt,
4155 		    MPI_SCSITASKMGMT_TASKTYPE_ABORT_TASK,
4156 		    0, 0, ccb->ccb_h.target_id, ccb->ccb_h.target_lun,
4157 		    htole32(req->index | scsi_io_handler_id), TRUE);
4158 
4159 		if (error != 0) {
4160 			/*
4161 			 * mpt_scsi_send_tmf hard resets on failure, so no
4162 			 * need to do so here.  Our queue should be emptied
4163 			 * by the hard reset.
4164 			 */
4165 			continue;
4166 		}
4167 
4168 		error = mpt_wait_req(mpt, mpt->tmf_req, REQ_STATE_DONE,
4169 		    REQ_STATE_DONE, TRUE, 500);
4170 
4171 		status = le16toh(mpt->tmf_req->IOCStatus);
4172 		response = mpt->tmf_req->ResponseCode;
4173 		mpt->tmf_req->state = REQ_STATE_FREE;
4174 
4175 		if (error != 0) {
4176 			/*
4177 			 * If we've errored out,, reset the controller.
4178 			 */
4179 			mpt_prt(mpt, "mpt_recover_commands: abort timed-out. "
4180 			    "Resetting controller\n");
4181 			mpt_reset(mpt, TRUE);
4182 			continue;
4183 		}
4184 
4185 		if ((status & MPI_IOCSTATUS_MASK) != MPI_IOCSTATUS_SUCCESS) {
4186 			mpt_prt(mpt, "mpt_recover_commands: IOC Status 0x%x. "
4187 			    "Resetting controller.\n", status);
4188 			mpt_reset(mpt, TRUE);
4189 			continue;
4190 		}
4191 
4192 		if (response != MPI_SCSITASKMGMT_RSP_TM_SUCCEEDED &&
4193 		    response != MPI_SCSITASKMGMT_RSP_TM_COMPLETE) {
4194 			mpt_prt(mpt, "mpt_recover_commands: TMF Response 0x%x. "
4195 			    "Resetting controller.\n", response);
4196 			mpt_reset(mpt, TRUE);
4197 			continue;
4198 		}
4199 		mpt_prt(mpt, "abort of req %p:%u completed\n", req, req->serno);
4200 	}
4201 }
4202 
4203 /************************ Target Mode Support ****************************/
4204 static void
4205 mpt_fc_post_els(struct mpt_softc *mpt, request_t *req, int ioindex)
4206 {
4207 	MSG_LINK_SERVICE_BUFFER_POST_REQUEST *fc;
4208 	PTR_SGE_TRANSACTION32 tep;
4209 	PTR_SGE_SIMPLE32 se;
4210 	bus_addr_t paddr;
4211 	uint32_t fl;
4212 
4213 	paddr = req->req_pbuf;
4214 	paddr += MPT_RQSL(mpt);
4215 
4216 	fc = req->req_vbuf;
4217 	memset(fc, 0, MPT_REQUEST_AREA);
4218 	fc->BufferCount = 1;
4219 	fc->Function = MPI_FUNCTION_FC_LINK_SRVC_BUF_POST;
4220 	fc->MsgContext = htole32(req->index | fc_els_handler_id);
4221 
4222 	/*
4223 	 * Okay, set up ELS buffer pointers. ELS buffer pointers
4224 	 * consist of a TE SGL element (with details length of zero)
4225 	 * followe by a SIMPLE SGL element which holds the address
4226 	 * of the buffer.
4227 	 */
4228 
4229 	tep = (PTR_SGE_TRANSACTION32) &fc->SGL;
4230 
4231 	tep->ContextSize = 4;
4232 	tep->Flags = 0;
4233 	tep->TransactionContext[0] = htole32(ioindex);
4234 
4235 	se = (PTR_SGE_SIMPLE32) &tep->TransactionDetails[0];
4236 	fl =
4237 		MPI_SGE_FLAGS_HOST_TO_IOC	|
4238 		MPI_SGE_FLAGS_SIMPLE_ELEMENT	|
4239 		MPI_SGE_FLAGS_LAST_ELEMENT	|
4240 		MPI_SGE_FLAGS_END_OF_LIST	|
4241 		MPI_SGE_FLAGS_END_OF_BUFFER;
4242 	fl <<= MPI_SGE_FLAGS_SHIFT;
4243 	fl |= (MPT_NRFM(mpt) - MPT_RQSL(mpt));
4244 	se->FlagsLength = htole32(fl);
4245 	se->Address = htole32((uint32_t) paddr);
4246 	mpt_lprt(mpt, MPT_PRT_DEBUG,
4247 	    "add ELS index %d ioindex %d for %p:%u\n",
4248 	    req->index, ioindex, req, req->serno);
4249 	KASSERT(((req->state & REQ_STATE_LOCKED) != 0),
4250 	    ("mpt_fc_post_els: request not locked"));
4251 	mpt_send_cmd(mpt, req);
4252 }
4253 
4254 static void
4255 mpt_post_target_command(struct mpt_softc *mpt, request_t *req, int ioindex)
4256 {
4257 	PTR_MSG_TARGET_CMD_BUFFER_POST_REQUEST fc;
4258 	PTR_CMD_BUFFER_DESCRIPTOR cb;
4259 	bus_addr_t paddr;
4260 
4261 	paddr = req->req_pbuf;
4262 	paddr += MPT_RQSL(mpt);
4263 	memset(req->req_vbuf, 0, MPT_REQUEST_AREA);
4264 	MPT_TGT_STATE(mpt, req)->state = TGT_STATE_LOADING;
4265 
4266 	fc = req->req_vbuf;
4267 	fc->BufferCount = 1;
4268 	fc->Function = MPI_FUNCTION_TARGET_CMD_BUFFER_POST;
4269 	fc->MsgContext = htole32(req->index | mpt->scsi_tgt_handler_id);
4270 
4271 	cb = &fc->Buffer[0];
4272 	cb->IoIndex = htole16(ioindex);
4273 	cb->u.PhysicalAddress32 = htole32((U32) paddr);
4274 
4275 	mpt_check_doorbell(mpt);
4276 	mpt_send_cmd(mpt, req);
4277 }
4278 
4279 static int
4280 mpt_add_els_buffers(struct mpt_softc *mpt)
4281 {
4282 	int i;
4283 
4284 	if (mpt->is_fc == 0) {
4285 		return (TRUE);
4286 	}
4287 
4288 	if (mpt->els_cmds_allocated) {
4289 		return (TRUE);
4290 	}
4291 
4292 	mpt->els_cmd_ptrs = malloc(MPT_MAX_ELS * sizeof (request_t *),
4293 	    M_DEVBUF, M_NOWAIT | M_ZERO);
4294 
4295 	if (mpt->els_cmd_ptrs == NULL) {
4296 		return (FALSE);
4297 	}
4298 
4299 	/*
4300 	 * Feed the chip some ELS buffer resources
4301 	 */
4302 	for (i = 0; i < MPT_MAX_ELS; i++) {
4303 		request_t *req = mpt_get_request(mpt, FALSE);
4304 		if (req == NULL) {
4305 			break;
4306 		}
4307 		req->state |= REQ_STATE_LOCKED;
4308 		mpt->els_cmd_ptrs[i] = req;
4309 		mpt_fc_post_els(mpt, req, i);
4310 	}
4311 
4312 	if (i == 0) {
4313 		mpt_prt(mpt, "unable to add ELS buffer resources\n");
4314 		free(mpt->els_cmd_ptrs, M_DEVBUF);
4315 		mpt->els_cmd_ptrs = NULL;
4316 		return (FALSE);
4317 	}
4318 	if (i != MPT_MAX_ELS) {
4319 		mpt_lprt(mpt, MPT_PRT_INFO,
4320 		    "only added %d of %d  ELS buffers\n", i, MPT_MAX_ELS);
4321 	}
4322 	mpt->els_cmds_allocated = i;
4323 	return(TRUE);
4324 }
4325 
4326 static int
4327 mpt_add_target_commands(struct mpt_softc *mpt)
4328 {
4329 	int i, max;
4330 
4331 	if (mpt->tgt_cmd_ptrs) {
4332 		return (TRUE);
4333 	}
4334 
4335 	max = MPT_MAX_REQUESTS(mpt) >> 1;
4336 	if (max > mpt->mpt_max_tgtcmds) {
4337 		max = mpt->mpt_max_tgtcmds;
4338 	}
4339 	mpt->tgt_cmd_ptrs =
4340 	    malloc(max * sizeof (request_t *), M_DEVBUF, M_NOWAIT | M_ZERO);
4341 	if (mpt->tgt_cmd_ptrs == NULL) {
4342 		mpt_prt(mpt,
4343 		    "mpt_add_target_commands: could not allocate cmd ptrs\n");
4344 		return (FALSE);
4345 	}
4346 
4347 	for (i = 0; i < max; i++) {
4348 		request_t *req;
4349 
4350 		req = mpt_get_request(mpt, FALSE);
4351 		if (req == NULL) {
4352 			break;
4353 		}
4354 		req->state |= REQ_STATE_LOCKED;
4355 		mpt->tgt_cmd_ptrs[i] = req;
4356 		mpt_post_target_command(mpt, req, i);
4357 	}
4358 
4359 
4360 	if (i == 0) {
4361 		mpt_lprt(mpt, MPT_PRT_ERROR, "could not add any target bufs\n");
4362 		free(mpt->tgt_cmd_ptrs, M_DEVBUF);
4363 		mpt->tgt_cmd_ptrs = NULL;
4364 		return (FALSE);
4365 	}
4366 
4367 	mpt->tgt_cmds_allocated = i;
4368 
4369 	if (i < max) {
4370 		mpt_lprt(mpt, MPT_PRT_INFO,
4371 		    "added %d of %d target bufs\n", i, max);
4372 	}
4373 	return (i);
4374 }
4375 
4376 static int
4377 mpt_enable_lun(struct mpt_softc *mpt, target_id_t tgt, lun_id_t lun)
4378 {
4379 	if (tgt == CAM_TARGET_WILDCARD && lun == CAM_LUN_WILDCARD) {
4380 		mpt->twildcard = 1;
4381 	} else if (lun >= MPT_MAX_LUNS) {
4382 		return (EINVAL);
4383 	} else if (tgt != CAM_TARGET_WILDCARD && tgt != 0) {
4384 		return (EINVAL);
4385 	}
4386 	if (mpt->tenabled == 0) {
4387 		if (mpt->is_fc) {
4388 			(void) mpt_fc_reset_link(mpt, 0);
4389 		}
4390 		mpt->tenabled = 1;
4391 	}
4392 	if (lun == CAM_LUN_WILDCARD) {
4393 		mpt->trt_wildcard.enabled = 1;
4394 	} else {
4395 		mpt->trt[lun].enabled = 1;
4396 	}
4397 	return (0);
4398 }
4399 
4400 static int
4401 mpt_disable_lun(struct mpt_softc *mpt, target_id_t tgt, lun_id_t lun)
4402 {
4403 	int i;
4404 	if (tgt == CAM_TARGET_WILDCARD && lun == CAM_LUN_WILDCARD) {
4405 		mpt->twildcard = 0;
4406 	} else if (lun >= MPT_MAX_LUNS) {
4407 		return (EINVAL);
4408 	} else if (tgt != CAM_TARGET_WILDCARD && tgt != 0) {
4409 		return (EINVAL);
4410 	}
4411 	if (lun == CAM_LUN_WILDCARD) {
4412 		mpt->trt_wildcard.enabled = 0;
4413 	} else {
4414 		mpt->trt[lun].enabled = 0;
4415 	}
4416 	for (i = 0; i < MPT_MAX_LUNS; i++) {
4417 		if (mpt->trt[lun].enabled) {
4418 			break;
4419 		}
4420 	}
4421 	if (i == MPT_MAX_LUNS && mpt->twildcard == 0) {
4422 		if (mpt->is_fc) {
4423 			(void) mpt_fc_reset_link(mpt, 0);
4424 		}
4425 		mpt->tenabled = 0;
4426 	}
4427 	return (0);
4428 }
4429 
4430 /*
4431  * Called with MPT lock held
4432  */
4433 static void
4434 mpt_target_start_io(struct mpt_softc *mpt, union ccb *ccb)
4435 {
4436 	struct ccb_scsiio *csio = &ccb->csio;
4437 	request_t *cmd_req = MPT_TAG_2_REQ(mpt, csio->tag_id);
4438 	mpt_tgt_state_t *tgt = MPT_TGT_STATE(mpt, cmd_req);
4439 
4440 	switch (tgt->state) {
4441 	case TGT_STATE_IN_CAM:
4442 		break;
4443 	case TGT_STATE_MOVING_DATA:
4444 		mpt_set_ccb_status(ccb, CAM_REQUEUE_REQ);
4445 		xpt_freeze_simq(mpt->sim, 1);
4446 		ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
4447 		tgt->ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
4448 		MPTLOCK_2_CAMLOCK(mpt);
4449 		xpt_done(ccb);
4450 		CAMLOCK_2_MPTLOCK(mpt);
4451 		return;
4452 	default:
4453 		mpt_prt(mpt, "ccb %p flags 0x%x tag 0x%08x had bad request "
4454 		    "starting I/O\n", ccb, csio->ccb_h.flags, csio->tag_id);
4455 		mpt_tgt_dump_req_state(mpt, cmd_req);
4456 		mpt_set_ccb_status(ccb, CAM_REQ_CMP_ERR);
4457 		MPTLOCK_2_CAMLOCK(mpt);
4458 		xpt_done(ccb);
4459 		CAMLOCK_2_MPTLOCK(mpt);
4460 		return;
4461 	}
4462 
4463 	if (csio->dxfer_len) {
4464 		bus_dmamap_callback_t *cb;
4465 		PTR_MSG_TARGET_ASSIST_REQUEST ta;
4466 		request_t *req;
4467 
4468 		KASSERT((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE,
4469 		    ("dxfer_len %u but direction is NONE\n", csio->dxfer_len));
4470 
4471 		if ((req = mpt_get_request(mpt, FALSE)) == NULL) {
4472 			if (mpt->outofbeer == 0) {
4473 				mpt->outofbeer = 1;
4474 				xpt_freeze_simq(mpt->sim, 1);
4475 				mpt_lprt(mpt, MPT_PRT_DEBUG, "FREEZEQ\n");
4476 			}
4477 			ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
4478 			mpt_set_ccb_status(ccb, CAM_REQUEUE_REQ);
4479 			MPTLOCK_2_CAMLOCK(mpt);
4480 			xpt_done(ccb);
4481 			CAMLOCK_2_MPTLOCK(mpt);
4482 			return;
4483 		}
4484 		ccb->ccb_h.status = CAM_SIM_QUEUED | CAM_REQ_INPROG;
4485 		if (sizeof (bus_addr_t) > 4) {
4486 			cb = mpt_execute_req_a64;
4487 		} else {
4488 			cb = mpt_execute_req;
4489 		}
4490 
4491 		req->ccb = ccb;
4492 		ccb->ccb_h.ccb_req_ptr = req;
4493 
4494 		/*
4495 		 * Record the currently active ccb and the
4496 		 * request for it in our target state area.
4497 		 */
4498 		tgt->ccb = ccb;
4499 		tgt->req = req;
4500 
4501 		memset(req->req_vbuf, 0, MPT_RQSL(mpt));
4502 		ta = req->req_vbuf;
4503 
4504 		if (mpt->is_sas) {
4505 			PTR_MPI_TARGET_SSP_CMD_BUFFER ssp =
4506 			     cmd_req->req_vbuf;
4507 			ta->QueueTag = ssp->InitiatorTag;
4508 		} else if (mpt->is_spi) {
4509 			PTR_MPI_TARGET_SCSI_SPI_CMD_BUFFER sp =
4510 			     cmd_req->req_vbuf;
4511 			ta->QueueTag = sp->Tag;
4512 		}
4513 		ta->Function = MPI_FUNCTION_TARGET_ASSIST;
4514 		ta->MsgContext = htole32(req->index | mpt->scsi_tgt_handler_id);
4515 		ta->ReplyWord = htole32(tgt->reply_desc);
4516 		if (csio->ccb_h.target_lun > MPT_MAX_LUNS) {
4517 			ta->LUN[0] =
4518 			    0x40 | ((csio->ccb_h.target_lun >> 8) & 0x3f);
4519 			ta->LUN[1] = csio->ccb_h.target_lun & 0xff;
4520 		} else {
4521 			ta->LUN[1] = csio->ccb_h.target_lun;
4522 		}
4523 
4524 		ta->RelativeOffset = tgt->bytes_xfered;
4525 		ta->DataLength = ccb->csio.dxfer_len;
4526 		if (ta->DataLength > tgt->resid) {
4527 			ta->DataLength = tgt->resid;
4528 		}
4529 
4530 		/*
4531 		 * XXX Should be done after data transfer completes?
4532 		 */
4533 		tgt->resid -= csio->dxfer_len;
4534 		tgt->bytes_xfered += csio->dxfer_len;
4535 
4536 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
4537 			ta->TargetAssistFlags |=
4538 			    TARGET_ASSIST_FLAGS_DATA_DIRECTION;
4539 		}
4540 
4541 #ifdef	WE_TRUST_AUTO_GOOD_STATUS
4542 		if ((ccb->ccb_h.flags & CAM_SEND_STATUS) &&
4543 		    csio->scsi_status == SCSI_STATUS_OK && tgt->resid == 0) {
4544 			ta->TargetAssistFlags |=
4545 			    TARGET_ASSIST_FLAGS_AUTO_STATUS;
4546 		}
4547 #endif
4548 		tgt->state = TGT_STATE_SETTING_UP_FOR_DATA;
4549 
4550 		mpt_lprt(mpt, MPT_PRT_DEBUG,
4551 		    "DATA_CCB %p tag %x %u bytes %u resid flg %x req %p:%u "
4552 		    "nxtstate=%d\n", csio, csio->tag_id, csio->dxfer_len,
4553 		    tgt->resid, ccb->ccb_h.flags, req, req->serno, tgt->state);
4554 
4555 		MPTLOCK_2_CAMLOCK(mpt);
4556 		if ((ccb->ccb_h.flags & CAM_SCATTER_VALID) == 0) {
4557 			if ((ccb->ccb_h.flags & CAM_DATA_PHYS) == 0) {
4558 				int error;
4559 				int s = splsoftvm();
4560 				error = bus_dmamap_load(mpt->buffer_dmat,
4561 				    req->dmap, csio->data_ptr, csio->dxfer_len,
4562 				    cb, req, 0);
4563 				splx(s);
4564 				if (error == EINPROGRESS) {
4565 					xpt_freeze_simq(mpt->sim, 1);
4566 					ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
4567 				}
4568 			} else {
4569 				/*
4570 				 * We have been given a pointer to single
4571 				 * physical buffer.
4572 				 */
4573 				struct bus_dma_segment seg;
4574 				seg.ds_addr = (bus_addr_t)
4575 				    (vm_offset_t)csio->data_ptr;
4576 				seg.ds_len = csio->dxfer_len;
4577 				(*cb)(req, &seg, 1, 0);
4578 			}
4579 		} else {
4580 			/*
4581 			 * We have been given a list of addresses.
4582 			 * This case could be easily supported but they are not
4583 			 * currently generated by the CAM subsystem so there
4584 			 * is no point in wasting the time right now.
4585 			 */
4586 			struct bus_dma_segment *sgs;
4587 			if ((ccb->ccb_h.flags & CAM_SG_LIST_PHYS) == 0) {
4588 				(*cb)(req, NULL, 0, EFAULT);
4589 			} else {
4590 				/* Just use the segments provided */
4591 				sgs = (struct bus_dma_segment *)csio->data_ptr;
4592 				(*cb)(req, sgs, csio->sglist_cnt, 0);
4593 			}
4594 		}
4595 		CAMLOCK_2_MPTLOCK(mpt);
4596 	} else {
4597 		uint8_t *sp = NULL, sense[MPT_SENSE_SIZE];
4598 
4599 		/*
4600 		 * XXX: I don't know why this seems to happen, but
4601 		 * XXX: completing the CCB seems to make things happy.
4602 		 * XXX: This seems to happen if the initiator requests
4603 		 * XXX: enough data that we have to do multiple CTIOs.
4604 		 */
4605 		if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
4606 			mpt_lprt(mpt, MPT_PRT_DEBUG,
4607 			    "Meaningless STATUS CCB (%p): flags %x status %x "
4608 			    "resid %d bytes_xfered %u\n", ccb, ccb->ccb_h.flags,
4609 			    ccb->ccb_h.status, tgt->resid, tgt->bytes_xfered);
4610 			mpt_set_ccb_status(ccb, CAM_REQ_CMP);
4611 			ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
4612 			MPTLOCK_2_CAMLOCK(mpt);
4613 			xpt_done(ccb);
4614 			CAMLOCK_2_MPTLOCK(mpt);
4615 			return;
4616 		}
4617 		if (ccb->ccb_h.flags & CAM_SEND_SENSE) {
4618 			sp = sense;
4619 			memcpy(sp, &csio->sense_data,
4620 			   min(csio->sense_len, MPT_SENSE_SIZE));
4621 		}
4622 		mpt_scsi_tgt_status(mpt, ccb, cmd_req, csio->scsi_status, sp);
4623 	}
4624 }
4625 
4626 static void
4627 mpt_scsi_tgt_local(struct mpt_softc *mpt, request_t *cmd_req,
4628     uint32_t lun, int send, uint8_t *data, size_t length)
4629 {
4630 	mpt_tgt_state_t *tgt;
4631 	PTR_MSG_TARGET_ASSIST_REQUEST ta;
4632 	SGE_SIMPLE32 *se;
4633 	uint32_t flags;
4634 	uint8_t *dptr;
4635 	bus_addr_t pptr;
4636 	request_t *req;
4637 
4638 	/*
4639 	 * We enter with resid set to the data load for the command.
4640 	 */
4641 	tgt = MPT_TGT_STATE(mpt, cmd_req);
4642 	if (length == 0 || tgt->resid == 0) {
4643 		tgt->resid = 0;
4644 		mpt_scsi_tgt_status(mpt, NULL, cmd_req, 0, NULL);
4645 		return;
4646 	}
4647 
4648 	if ((req = mpt_get_request(mpt, FALSE)) == NULL) {
4649 		mpt_prt(mpt, "out of resources- dropping local response\n");
4650 		return;
4651 	}
4652 	tgt->is_local = 1;
4653 
4654 
4655 	memset(req->req_vbuf, 0, MPT_RQSL(mpt));
4656 	ta = req->req_vbuf;
4657 
4658 	if (mpt->is_sas) {
4659 		PTR_MPI_TARGET_SSP_CMD_BUFFER ssp = cmd_req->req_vbuf;
4660 		ta->QueueTag = ssp->InitiatorTag;
4661 	} else if (mpt->is_spi) {
4662 		PTR_MPI_TARGET_SCSI_SPI_CMD_BUFFER sp = cmd_req->req_vbuf;
4663 		ta->QueueTag = sp->Tag;
4664 	}
4665 	ta->Function = MPI_FUNCTION_TARGET_ASSIST;
4666 	ta->MsgContext = htole32(req->index | mpt->scsi_tgt_handler_id);
4667 	ta->ReplyWord = htole32(tgt->reply_desc);
4668 	if (lun > MPT_MAX_LUNS) {
4669 		ta->LUN[0] = 0x40 | ((lun >> 8) & 0x3f);
4670 		ta->LUN[1] = lun & 0xff;
4671 	} else {
4672 		ta->LUN[1] = lun;
4673 	}
4674 	ta->RelativeOffset = 0;
4675 	ta->DataLength = length;
4676 
4677 	dptr = req->req_vbuf;
4678 	dptr += MPT_RQSL(mpt);
4679 	pptr = req->req_pbuf;
4680 	pptr += MPT_RQSL(mpt);
4681 	memcpy(dptr, data, min(length, MPT_RQSL(mpt)));
4682 
4683 	se = (SGE_SIMPLE32 *) &ta->SGL[0];
4684 	memset(se, 0,sizeof (*se));
4685 
4686 	flags = MPI_SGE_FLAGS_SIMPLE_ELEMENT;
4687 	if (send) {
4688 		ta->TargetAssistFlags |= TARGET_ASSIST_FLAGS_DATA_DIRECTION;
4689 		flags |= MPI_SGE_FLAGS_HOST_TO_IOC;
4690 	}
4691 	se->Address = pptr;
4692 	MPI_pSGE_SET_LENGTH(se, length);
4693 	flags |= MPI_SGE_FLAGS_LAST_ELEMENT;
4694 	flags |= MPI_SGE_FLAGS_END_OF_LIST | MPI_SGE_FLAGS_END_OF_BUFFER;
4695 	MPI_pSGE_SET_FLAGS(se, flags);
4696 
4697 	tgt->ccb = NULL;
4698 	tgt->req = req;
4699 	tgt->resid -= length;
4700 	tgt->bytes_xfered = length;
4701 #ifdef	WE_TRUST_AUTO_GOOD_STATUS
4702 	tgt->state = TGT_STATE_MOVING_DATA_AND_STATUS;
4703 #else
4704 	tgt->state = TGT_STATE_MOVING_DATA;
4705 #endif
4706 	mpt_send_cmd(mpt, req);
4707 }
4708 
4709 /*
4710  * Abort queued up CCBs
4711  */
4712 static cam_status
4713 mpt_abort_target_ccb(struct mpt_softc *mpt, union ccb *ccb)
4714 {
4715 	struct mpt_hdr_stailq *lp;
4716 	struct ccb_hdr *srch;
4717 	int found = 0;
4718 	union ccb *accb = ccb->cab.abort_ccb;
4719 	tgt_resource_t *trtp;
4720 
4721 	mpt_lprt(mpt, MPT_PRT_DEBUG, "aborting ccb %p\n", accb);
4722 
4723 	if (ccb->ccb_h.target_lun == CAM_LUN_WILDCARD) {
4724 		trtp = &mpt->trt_wildcard;
4725 	} else {
4726 		trtp = &mpt->trt[ccb->ccb_h.target_lun];
4727 	}
4728 
4729 	if (accb->ccb_h.func_code == XPT_ACCEPT_TARGET_IO) {
4730 		lp = &trtp->atios;
4731 	} else if (accb->ccb_h.func_code == XPT_IMMED_NOTIFY) {
4732 		lp = &trtp->inots;
4733 	} else {
4734 		return (CAM_REQ_INVALID);
4735 	}
4736 
4737 	STAILQ_FOREACH(srch, lp, sim_links.stqe) {
4738 		if (srch == &accb->ccb_h) {
4739 			found = 1;
4740 			STAILQ_REMOVE(lp, srch, ccb_hdr, sim_links.stqe);
4741 			break;
4742 		}
4743 	}
4744 	if (found) {
4745 		accb->ccb_h.status = CAM_REQ_ABORTED;
4746 		xpt_done(accb);
4747 		return (CAM_REQ_CMP);
4748 	}
4749 	mpt_prt(mpt, "mpt_abort_tgt_ccb: CCB %p not found\n", ccb);
4750 	return (CAM_PATH_INVALID);
4751 }
4752 
4753 /*
4754  * Ask the MPT to abort the current target command
4755  */
4756 static int
4757 mpt_abort_target_cmd(struct mpt_softc *mpt, request_t *cmd_req)
4758 {
4759 	int error;
4760 	request_t *req;
4761 	PTR_MSG_TARGET_MODE_ABORT abtp;
4762 
4763 	req = mpt_get_request(mpt, FALSE);
4764 	if (req == NULL) {
4765 		return (-1);
4766 	}
4767 	abtp = req->req_vbuf;
4768 	memset(abtp, 0, sizeof (*abtp));
4769 
4770 	abtp->MsgContext = htole32(req->index | mpt->scsi_tgt_handler_id);
4771 	abtp->AbortType = TARGET_MODE_ABORT_TYPE_EXACT_IO;
4772 	abtp->Function = MPI_FUNCTION_TARGET_MODE_ABORT;
4773 	abtp->ReplyWord = htole32(MPT_TGT_STATE(mpt, cmd_req)->reply_desc);
4774 	error = 0;
4775 	if (mpt->is_fc || mpt->is_sas) {
4776 		mpt_send_cmd(mpt, req);
4777 	} else {
4778 		error = mpt_send_handshake_cmd(mpt, sizeof(*req), req);
4779 	}
4780 	return (error);
4781 }
4782 
4783 /*
4784  * WE_TRUST_AUTO_GOOD_STATUS- I've found that setting
4785  * TARGET_STATUS_SEND_FLAGS_AUTO_GOOD_STATUS leads the
4786  * FC929 to set bogus FC_RSP fields (nonzero residuals
4787  * but w/o RESID fields set). This causes QLogic initiators
4788  * to think maybe that a frame was lost.
4789  *
4790  * WE_CAN_USE_AUTO_REPOST- we can't use AUTO_REPOST because
4791  * we use allocated requests to do TARGET_ASSIST and we
4792  * need to know when to release them.
4793  */
4794 
4795 static void
4796 mpt_scsi_tgt_status(struct mpt_softc *mpt, union ccb *ccb, request_t *cmd_req,
4797     uint8_t status, uint8_t const *sense_data)
4798 {
4799 	uint8_t *cmd_vbuf;
4800 	mpt_tgt_state_t *tgt;
4801 	PTR_MSG_TARGET_STATUS_SEND_REQUEST tp;
4802 	request_t *req;
4803 	bus_addr_t paddr;
4804 	int resplen = 0;
4805 	uint32_t fl;
4806 
4807 	cmd_vbuf = cmd_req->req_vbuf;
4808 	cmd_vbuf += MPT_RQSL(mpt);
4809 	tgt = MPT_TGT_STATE(mpt, cmd_req);
4810 
4811 	if ((req = mpt_get_request(mpt, FALSE)) == NULL) {
4812 		if (mpt->outofbeer == 0) {
4813 			mpt->outofbeer = 1;
4814 			xpt_freeze_simq(mpt->sim, 1);
4815 			mpt_lprt(mpt, MPT_PRT_DEBUG, "FREEZEQ\n");
4816 		}
4817 		if (ccb) {
4818 			ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
4819 			mpt_set_ccb_status(ccb, CAM_REQUEUE_REQ);
4820 			MPTLOCK_2_CAMLOCK(mpt);
4821 			xpt_done(ccb);
4822 			CAMLOCK_2_MPTLOCK(mpt);
4823 		} else {
4824 			mpt_prt(mpt,
4825 			    "could not allocate status request- dropping\n");
4826 		}
4827 		return;
4828 	}
4829 	req->ccb = ccb;
4830 	if (ccb) {
4831 		ccb->ccb_h.ccb_mpt_ptr = mpt;
4832 		ccb->ccb_h.ccb_req_ptr = req;
4833 	}
4834 
4835 	/*
4836 	 * Record the currently active ccb, if any, and the
4837 	 * request for it in our target state area.
4838 	 */
4839 	tgt->ccb = ccb;
4840 	tgt->req = req;
4841 	tgt->state = TGT_STATE_SENDING_STATUS;
4842 
4843 	tp = req->req_vbuf;
4844 	paddr = req->req_pbuf;
4845 	paddr += MPT_RQSL(mpt);
4846 
4847 	memset(tp, 0, sizeof (*tp));
4848 	tp->Function = MPI_FUNCTION_TARGET_STATUS_SEND;
4849 	if (mpt->is_fc) {
4850 		PTR_MPI_TARGET_FCP_CMD_BUFFER fc =
4851 		    (PTR_MPI_TARGET_FCP_CMD_BUFFER) cmd_vbuf;
4852 		uint8_t *sts_vbuf;
4853 		uint32_t *rsp;
4854 
4855 		sts_vbuf = req->req_vbuf;
4856 		sts_vbuf += MPT_RQSL(mpt);
4857 		rsp = (uint32_t *) sts_vbuf;
4858 		memcpy(tp->LUN, fc->FcpLun, sizeof (tp->LUN));
4859 
4860 		/*
4861 		 * The MPI_TARGET_FCP_RSP_BUFFER define is unfortunate.
4862 		 * It has to be big-endian in memory and is organized
4863 		 * in 32 bit words, which are much easier to deal with
4864 		 * as words which are swizzled as needed.
4865 		 *
4866 		 * All we're filling here is the FC_RSP payload.
4867 		 * We may just have the chip synthesize it if
4868 		 * we have no residual and an OK status.
4869 		 *
4870 		 */
4871 		memset(rsp, 0, sizeof (MPI_TARGET_FCP_RSP_BUFFER));
4872 
4873 		rsp[2] = status;
4874 		if (tgt->resid) {
4875 			rsp[2] |= 0x800;	/* XXXX NEED MNEMONIC!!!! */
4876 			rsp[3] = htobe32(tgt->resid);
4877 #ifdef	WE_TRUST_AUTO_GOOD_STATUS
4878 			resplen = sizeof (MPI_TARGET_FCP_RSP_BUFFER);
4879 #endif
4880 		}
4881 		if (status == SCSI_STATUS_CHECK_COND) {
4882 			int i;
4883 
4884 			rsp[2] |= 0x200;	/* XXXX NEED MNEMONIC!!!! */
4885 			rsp[4] = htobe32(MPT_SENSE_SIZE);
4886 			if (sense_data) {
4887 				memcpy(&rsp[8], sense_data, MPT_SENSE_SIZE);
4888 			} else {
4889 				mpt_prt(mpt, "mpt_scsi_tgt_status: CHECK CONDI"
4890 				    "TION but no sense data?\n");
4891 				memset(&rsp, 0, MPT_SENSE_SIZE);
4892 			}
4893 			for (i = 8; i < (8 + (MPT_SENSE_SIZE >> 2)); i++) {
4894 				rsp[i] = htobe32(rsp[i]);
4895 			}
4896 #ifdef	WE_TRUST_AUTO_GOOD_STATUS
4897 			resplen = sizeof (MPI_TARGET_FCP_RSP_BUFFER);
4898 #endif
4899 		}
4900 #ifndef	WE_TRUST_AUTO_GOOD_STATUS
4901 		resplen = sizeof (MPI_TARGET_FCP_RSP_BUFFER);
4902 #endif
4903 		rsp[2] = htobe32(rsp[2]);
4904 	} else if (mpt->is_sas) {
4905 		PTR_MPI_TARGET_SSP_CMD_BUFFER ssp =
4906 		    (PTR_MPI_TARGET_SSP_CMD_BUFFER) cmd_vbuf;
4907 		memcpy(tp->LUN, ssp->LogicalUnitNumber, sizeof (tp->LUN));
4908 	} else {
4909 		PTR_MPI_TARGET_SCSI_SPI_CMD_BUFFER sp =
4910 		    (PTR_MPI_TARGET_SCSI_SPI_CMD_BUFFER) cmd_vbuf;
4911 		tp->StatusCode = status;
4912 		tp->QueueTag = htole16(sp->Tag);
4913 		memcpy(tp->LUN, sp->LogicalUnitNumber, sizeof (tp->LUN));
4914 	}
4915 
4916 	tp->ReplyWord = htole32(tgt->reply_desc);
4917 	tp->MsgContext = htole32(req->index | mpt->scsi_tgt_handler_id);
4918 
4919 #ifdef	WE_CAN_USE_AUTO_REPOST
4920 	tp->MsgFlags = TARGET_STATUS_SEND_FLAGS_REPOST_CMD_BUFFER;
4921 #endif
4922 	if (status == SCSI_STATUS_OK && resplen == 0) {
4923 		tp->MsgFlags |= TARGET_STATUS_SEND_FLAGS_AUTO_GOOD_STATUS;
4924 	} else {
4925 		tp->StatusDataSGE.u.Address32 = htole32((uint32_t) paddr);
4926 		fl =
4927 			MPI_SGE_FLAGS_HOST_TO_IOC	|
4928 			MPI_SGE_FLAGS_SIMPLE_ELEMENT	|
4929 			MPI_SGE_FLAGS_LAST_ELEMENT	|
4930 			MPI_SGE_FLAGS_END_OF_LIST	|
4931 			MPI_SGE_FLAGS_END_OF_BUFFER;
4932 		fl <<= MPI_SGE_FLAGS_SHIFT;
4933 		fl |= resplen;
4934 		tp->StatusDataSGE.FlagsLength = htole32(fl);
4935 	}
4936 
4937 	mpt_lprt(mpt, MPT_PRT_DEBUG,
4938 	    "STATUS_CCB %p (wit%s sense) tag %x req %p:%u resid %u\n",
4939 	    ccb, sense_data?"h" : "hout", ccb? ccb->csio.tag_id : -1, req,
4940 	    req->serno, tgt->resid);
4941 	if (ccb) {
4942 		ccb->ccb_h.status = CAM_SIM_QUEUED | CAM_REQ_INPROG;
4943 		mpt_req_timeout(req, 60 * hz, mpt_timeout, ccb);
4944 	}
4945 	mpt_send_cmd(mpt, req);
4946 }
4947 
4948 static void
4949 mpt_scsi_tgt_tsk_mgmt(struct mpt_softc *mpt, request_t *req, mpt_task_mgmt_t fc,
4950     tgt_resource_t *trtp, int init_id)
4951 {
4952 	struct ccb_immed_notify *inot;
4953 	mpt_tgt_state_t *tgt;
4954 
4955 	tgt = MPT_TGT_STATE(mpt, req);
4956 	inot = (struct ccb_immed_notify *) STAILQ_FIRST(&trtp->inots);
4957 	if (inot == NULL) {
4958 		mpt_lprt(mpt, MPT_PRT_WARN, "no INOTSs- sending back BSY\n");
4959 		mpt_scsi_tgt_status(mpt, NULL, req, SCSI_STATUS_BUSY, NULL);
4960 		return;
4961 	}
4962 	STAILQ_REMOVE_HEAD(&trtp->inots, sim_links.stqe);
4963 	mpt_lprt(mpt, MPT_PRT_DEBUG1,
4964 	    "Get FREE INOT %p lun %d\n", inot, inot->ccb_h.target_lun);
4965 
4966 	memset(&inot->sense_data, 0, sizeof (inot->sense_data));
4967 	inot->sense_len = 0;
4968 	memset(inot->message_args, 0, sizeof (inot->message_args));
4969 	inot->initiator_id = init_id;	/* XXX */
4970 
4971 	/*
4972 	 * This is a somewhat grotesque attempt to map from task management
4973 	 * to old style SCSI messages. God help us all.
4974 	 */
4975 	switch (fc) {
4976 	case MPT_ABORT_TASK_SET:
4977 		inot->message_args[0] = MSG_ABORT_TAG;
4978 		break;
4979 	case MPT_CLEAR_TASK_SET:
4980 		inot->message_args[0] = MSG_CLEAR_TASK_SET;
4981 		break;
4982 	case MPT_TARGET_RESET:
4983 		inot->message_args[0] = MSG_TARGET_RESET;
4984 		break;
4985 	case MPT_CLEAR_ACA:
4986 		inot->message_args[0] = MSG_CLEAR_ACA;
4987 		break;
4988 	case MPT_TERMINATE_TASK:
4989 		inot->message_args[0] = MSG_ABORT_TAG;
4990 		break;
4991 	default:
4992 		inot->message_args[0] = MSG_NOOP;
4993 		break;
4994 	}
4995 	tgt->ccb = (union ccb *) inot;
4996 	inot->ccb_h.status = CAM_MESSAGE_RECV|CAM_DEV_QFRZN;
4997 	MPTLOCK_2_CAMLOCK(mpt);
4998 	xpt_done((union ccb *)inot);
4999 	CAMLOCK_2_MPTLOCK(mpt);
5000 }
5001 
5002 static void
5003 mpt_scsi_tgt_atio(struct mpt_softc *mpt, request_t *req, uint32_t reply_desc)
5004 {
5005 	static uint8_t null_iqd[SHORT_INQUIRY_LENGTH] = {
5006 	    0x7f, 0x00, 0x02, 0x02, 0x20, 0x00, 0x00, 0x32,
5007 	     'F',  'R',  'E',  'E',  'B',  'S',  'D',  ' ',
5008 	     'L',  'S',  'I',  '-',  'L',  'O',  'G',  'I',
5009 	     'C',  ' ',  'N',  'U',  'L',  'D',  'E',  'V',
5010 	     '0',  '0',  '0',  '1'
5011 	};
5012 	struct ccb_accept_tio *atiop;
5013 	lun_id_t lun;
5014 	int tag_action = 0;
5015 	mpt_tgt_state_t *tgt;
5016 	tgt_resource_t *trtp = NULL;
5017 	U8 *lunptr;
5018 	U8 *vbuf;
5019 	U16 itag;
5020 	U16 ioindex;
5021 	mpt_task_mgmt_t fct = MPT_NIL_TMT_VALUE;
5022 	uint8_t *cdbp;
5023 
5024 	/*
5025 	 * First, DMA sync the received command-
5026 	 * which is in the *request* * phys area.
5027 	 *
5028 	 * XXX: We could optimize this for a range
5029 	 */
5030 	bus_dmamap_sync(mpt->request_dmat, mpt->request_dmap,
5031 	    BUS_DMASYNC_POSTREAD);
5032 
5033 	/*
5034 	 * Stash info for the current command where we can get at it later.
5035 	 */
5036 	vbuf = req->req_vbuf;
5037 	vbuf += MPT_RQSL(mpt);
5038 
5039 	/*
5040 	 * Get our state pointer set up.
5041 	 */
5042 	tgt = MPT_TGT_STATE(mpt, req);
5043 	if (tgt->state != TGT_STATE_LOADED) {
5044 		mpt_tgt_dump_req_state(mpt, req);
5045 		panic("bad target state in mpt_scsi_tgt_atio");
5046 	}
5047 	memset(tgt, 0, sizeof (mpt_tgt_state_t));
5048 	tgt->state = TGT_STATE_IN_CAM;
5049 	tgt->reply_desc = reply_desc;
5050 	ioindex = GET_IO_INDEX(reply_desc);
5051 	if (mpt->verbose >= MPT_PRT_DEBUG) {
5052 		mpt_dump_data(mpt, "mpt_scsi_tgt_atio response", vbuf,
5053 		    max(sizeof (MPI_TARGET_FCP_CMD_BUFFER),
5054 		    max(sizeof (MPI_TARGET_SSP_CMD_BUFFER),
5055 		    sizeof (MPI_TARGET_SCSI_SPI_CMD_BUFFER))));
5056 	}
5057 	if (mpt->is_fc) {
5058 		PTR_MPI_TARGET_FCP_CMD_BUFFER fc;
5059 		fc = (PTR_MPI_TARGET_FCP_CMD_BUFFER) vbuf;
5060 		if (fc->FcpCntl[2]) {
5061 			/*
5062 			 * Task Management Request
5063 			 */
5064 			switch (fc->FcpCntl[2]) {
5065 			case 0x2:
5066 				fct = MPT_ABORT_TASK_SET;
5067 				break;
5068 			case 0x4:
5069 				fct = MPT_CLEAR_TASK_SET;
5070 				break;
5071 			case 0x20:
5072 				fct = MPT_TARGET_RESET;
5073 				break;
5074 			case 0x40:
5075 				fct = MPT_CLEAR_ACA;
5076 				break;
5077 			case 0x80:
5078 				fct = MPT_TERMINATE_TASK;
5079 				break;
5080 			default:
5081 				mpt_prt(mpt, "CORRUPTED TASK MGMT BITS: 0x%x\n",
5082 				    fc->FcpCntl[2]);
5083 				mpt_scsi_tgt_status(mpt, 0, req,
5084 				    SCSI_STATUS_OK, 0);
5085 				return;
5086 			}
5087 		} else {
5088 			switch (fc->FcpCntl[1]) {
5089 			case 0:
5090 				tag_action = MSG_SIMPLE_Q_TAG;
5091 				break;
5092 			case 1:
5093 				tag_action = MSG_HEAD_OF_Q_TAG;
5094 				break;
5095 			case 2:
5096 				tag_action = MSG_ORDERED_Q_TAG;
5097 				break;
5098 			default:
5099 				/*
5100 				 * Bah. Ignore Untagged Queing and ACA
5101 				 */
5102 				tag_action = MSG_SIMPLE_Q_TAG;
5103 				break;
5104 			}
5105 		}
5106 		tgt->resid = be32toh(fc->FcpDl);
5107 		cdbp = fc->FcpCdb;
5108 		lunptr = fc->FcpLun;
5109 		itag = be16toh(fc->OptionalOxid);
5110 	} else if (mpt->is_sas) {
5111 		PTR_MPI_TARGET_SSP_CMD_BUFFER ssp;
5112 		ssp = (PTR_MPI_TARGET_SSP_CMD_BUFFER) vbuf;
5113 		cdbp = ssp->CDB;
5114 		lunptr = ssp->LogicalUnitNumber;
5115 		itag = ssp->InitiatorTag;
5116 	} else {
5117 		PTR_MPI_TARGET_SCSI_SPI_CMD_BUFFER sp;
5118 		sp = (PTR_MPI_TARGET_SCSI_SPI_CMD_BUFFER) vbuf;
5119 		cdbp = sp->CDB;
5120 		lunptr = sp->LogicalUnitNumber;
5121 		itag = sp->Tag;
5122 	}
5123 
5124 	/*
5125 	 * Generate a simple lun
5126 	 */
5127 	switch (lunptr[0] & 0xc0) {
5128 	case 0x40:
5129 		lun = ((lunptr[0] & 0x3f) << 8) | lunptr[1];
5130 		break;
5131 	case 0:
5132 		lun = lunptr[1];
5133 		break;
5134 	default:
5135 		mpt_lprt(mpt, MPT_PRT_ERROR, "cannot handle this type lun\n");
5136 		lun = 0xffff;
5137 		break;
5138 	}
5139 
5140 	/*
5141 	 * Deal with non-enabled or bad luns here.
5142 	 */
5143 	if (lun >= MPT_MAX_LUNS || mpt->tenabled == 0 ||
5144 	    mpt->trt[lun].enabled == 0) {
5145 		if (mpt->twildcard) {
5146 			trtp = &mpt->trt_wildcard;
5147 		} else if (fct == MPT_NIL_TMT_VALUE) {
5148 			/*
5149 			 * In this case, we haven't got an upstream listener
5150 			 * for either a specific lun or wildcard luns. We
5151 			 * have to make some sensible response. For regular
5152 			 * inquiry, just return some NOT HERE inquiry data.
5153 			 * For VPD inquiry, report illegal field in cdb.
5154 			 * For REQUEST SENSE, just return NO SENSE data.
5155 			 * REPORT LUNS gets illegal command.
5156 			 * All other commands get 'no such device'.
5157 			 */
5158 			uint8_t *sp, cond, buf[MPT_SENSE_SIZE];
5159 			size_t len;
5160 
5161 			memset(buf, 0, MPT_SENSE_SIZE);
5162 			cond = SCSI_STATUS_CHECK_COND;
5163 			buf[0] = 0xf0;
5164 			buf[2] = 0x5;
5165 			buf[7] = 0x8;
5166 			sp = buf;
5167 			tgt->tag_id = MPT_MAKE_TAGID(mpt, req, ioindex);
5168 
5169 			switch (cdbp[0]) {
5170 			case INQUIRY:
5171 			{
5172 				if (cdbp[1] != 0) {
5173 					buf[12] = 0x26;
5174 					buf[13] = 0x01;
5175 					break;
5176 				}
5177 				len = min(tgt->resid, cdbp[4]);
5178 				len = min(len, sizeof (null_iqd));
5179 				mpt_lprt(mpt, MPT_PRT_DEBUG,
5180 				    "local inquiry %ld bytes\n", (long) len);
5181 				mpt_scsi_tgt_local(mpt, req, lun, 1,
5182 				    null_iqd, len);
5183 				return;
5184 			}
5185 			case REQUEST_SENSE:
5186 			{
5187 				buf[2] = 0x0;
5188 				len = min(tgt->resid, cdbp[4]);
5189 				len = min(len, sizeof (buf));
5190 				mpt_lprt(mpt, MPT_PRT_DEBUG,
5191 				    "local reqsense %ld bytes\n", (long) len);
5192 				mpt_scsi_tgt_local(mpt, req, lun, 1,
5193 				    buf, len);
5194 				return;
5195 			}
5196 			case REPORT_LUNS:
5197 				mpt_lprt(mpt, MPT_PRT_DEBUG, "REPORT LUNS\n");
5198 				buf[12] = 0x26;
5199 				return;
5200 			default:
5201 				mpt_lprt(mpt, MPT_PRT_DEBUG,
5202 				    "CMD 0x%x to unmanaged lun %u\n",
5203 				    cdbp[0], lun);
5204 				buf[12] = 0x25;
5205 				break;
5206 			}
5207 			mpt_scsi_tgt_status(mpt, NULL, req, cond, sp);
5208 			return;
5209 		}
5210 		/* otherwise, leave trtp NULL */
5211 	} else {
5212 		trtp = &mpt->trt[lun];
5213 	}
5214 
5215 	/*
5216 	 * Deal with any task management
5217 	 */
5218 	if (fct != MPT_NIL_TMT_VALUE) {
5219 		if (trtp == NULL) {
5220 			mpt_prt(mpt, "task mgmt function %x but no listener\n",
5221 			    fct);
5222 			mpt_scsi_tgt_status(mpt, 0, req,
5223 			    SCSI_STATUS_OK, 0);
5224 		} else {
5225 			mpt_scsi_tgt_tsk_mgmt(mpt, req, fct, trtp,
5226 			    GET_INITIATOR_INDEX(reply_desc));
5227 		}
5228 		return;
5229 	}
5230 
5231 
5232 	atiop = (struct ccb_accept_tio *) STAILQ_FIRST(&trtp->atios);
5233 	if (atiop == NULL) {
5234 		mpt_lprt(mpt, MPT_PRT_WARN,
5235 		    "no ATIOs for lun %u- sending back %s\n", lun,
5236 		    mpt->tenabled? "QUEUE FULL" : "BUSY");
5237 		mpt_scsi_tgt_status(mpt, NULL, req,
5238 		    mpt->tenabled? SCSI_STATUS_QUEUE_FULL : SCSI_STATUS_BUSY,
5239 		    NULL);
5240 		return;
5241 	}
5242 	STAILQ_REMOVE_HEAD(&trtp->atios, sim_links.stqe);
5243 	mpt_lprt(mpt, MPT_PRT_DEBUG1,
5244 	    "Get FREE ATIO %p lun %d\n", atiop, atiop->ccb_h.target_lun);
5245 	atiop->ccb_h.ccb_mpt_ptr = mpt;
5246 	atiop->ccb_h.status = CAM_CDB_RECVD;
5247 	atiop->ccb_h.target_lun = lun;
5248 	atiop->sense_len = 0;
5249 	atiop->init_id = GET_INITIATOR_INDEX(reply_desc);
5250 	atiop->cdb_len = mpt_cdblen(cdbp[0], 16);
5251 	memcpy(atiop->cdb_io.cdb_bytes, cdbp, atiop->cdb_len);
5252 
5253 	/*
5254 	 * The tag we construct here allows us to find the
5255 	 * original request that the command came in with.
5256 	 *
5257 	 * This way we don't have to depend on anything but the
5258 	 * tag to find things when CCBs show back up from CAM.
5259 	 */
5260 	atiop->tag_id = MPT_MAKE_TAGID(mpt, req, ioindex);
5261 	tgt->tag_id = atiop->tag_id;
5262 	if (tag_action) {
5263 		atiop->tag_action = tag_action;
5264 		atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
5265 	}
5266 	if (mpt->verbose >= MPT_PRT_DEBUG) {
5267 		int i;
5268 		mpt_prt(mpt, "START_CCB %p for lun %u CDB=<", atiop,
5269 		    atiop->ccb_h.target_lun);
5270 		for (i = 0; i < atiop->cdb_len; i++) {
5271 			mpt_prtc(mpt, "%02x%c", cdbp[i] & 0xff,
5272 			    (i == (atiop->cdb_len - 1))? '>' : ' ');
5273 		}
5274 		mpt_prtc(mpt, " itag %x tag %x rdesc %x dl=%u\n",
5275 	    	    itag, atiop->tag_id, tgt->reply_desc, tgt->resid);
5276 	}
5277 
5278 	MPTLOCK_2_CAMLOCK(mpt);
5279 	xpt_done((union ccb *)atiop);
5280 	CAMLOCK_2_MPTLOCK(mpt);
5281 }
5282 
5283 static void
5284 mpt_tgt_dump_tgt_state(struct mpt_softc *mpt, request_t *req)
5285 {
5286 	mpt_tgt_state_t *tgt = MPT_TGT_STATE(mpt, req);
5287 
5288 	mpt_prt(mpt, "req %p:%u tgt:rdesc 0x%x resid %u xfrd %u ccb %p treq %p "
5289 	    "nx %d tag 0x%08x state=%d\n", req, req->serno, tgt->reply_desc,
5290 	    tgt->resid, tgt->bytes_xfered, tgt->ccb, tgt->req, tgt->nxfers,
5291 	    tgt->tag_id, tgt->state);
5292 }
5293 
5294 static void
5295 mpt_tgt_dump_req_state(struct mpt_softc *mpt, request_t *req)
5296 {
5297 	mpt_prt(mpt, "req %p:%u index %u (%x) state %x\n", req, req->serno,
5298 	    req->index, req->index, req->state);
5299 	mpt_tgt_dump_tgt_state(mpt, req);
5300 }
5301 
5302 static int
5303 mpt_scsi_tgt_reply_handler(struct mpt_softc *mpt, request_t *req,
5304     uint32_t reply_desc, MSG_DEFAULT_REPLY *reply_frame)
5305 {
5306 	int dbg;
5307 	union ccb *ccb;
5308 	U16 status;
5309 
5310 	if (reply_frame == NULL) {
5311 		/*
5312 		 * Figure out what the state of the command is.
5313 		 */
5314 		mpt_tgt_state_t *tgt = MPT_TGT_STATE(mpt, req);
5315 
5316 #ifdef	INVARIANTS
5317 		mpt_req_spcl(mpt, req, "turbo scsi_tgt_reply", __LINE__);
5318 		if (tgt->req) {
5319 			mpt_req_not_spcl(mpt, tgt->req,
5320 			    "turbo scsi_tgt_reply associated req", __LINE__);
5321 		}
5322 #endif
5323 		switch(tgt->state) {
5324 		case TGT_STATE_LOADED:
5325 			/*
5326 			 * This is a new command starting.
5327 			 */
5328 			mpt_scsi_tgt_atio(mpt, req, reply_desc);
5329 			break;
5330 		case TGT_STATE_MOVING_DATA:
5331 		{
5332 			uint8_t *sp = NULL, sense[MPT_SENSE_SIZE];
5333 
5334 			ccb = tgt->ccb;
5335 			if (tgt->req == NULL) {
5336 				panic("mpt: turbo target reply with null "
5337 				    "associated request moving data");
5338 				/* NOTREACHED */
5339 			}
5340 			if (ccb == NULL) {
5341 				if (tgt->is_local == 0) {
5342 					panic("mpt: turbo target reply with "
5343 					    "null associated ccb moving data");
5344 					/* NOTREACHED */
5345 				}
5346 				mpt_lprt(mpt, MPT_PRT_DEBUG,
5347 				    "TARGET_ASSIST local done\n");
5348 				TAILQ_REMOVE(&mpt->request_pending_list,
5349 				    tgt->req, links);
5350 				mpt_free_request(mpt, tgt->req);
5351 				tgt->req = NULL;
5352 				mpt_scsi_tgt_status(mpt, NULL, req,
5353 				    0, NULL);
5354 				return (TRUE);
5355 			}
5356 			tgt->ccb = NULL;
5357 			tgt->nxfers++;
5358 			mpt_req_untimeout(req, mpt_timeout, ccb);
5359 			mpt_lprt(mpt, MPT_PRT_DEBUG,
5360 			    "TARGET_ASSIST %p (req %p:%u) done tag 0x%x\n",
5361 			    ccb, tgt->req, tgt->req->serno, ccb->csio.tag_id);
5362 			/*
5363 			 * Free the Target Assist Request
5364 			 */
5365 			KASSERT(tgt->req->ccb == ccb,
5366 			    ("tgt->req %p:%u tgt->req->ccb %p", tgt->req,
5367 			    tgt->req->serno, tgt->req->ccb));
5368 			TAILQ_REMOVE(&mpt->request_pending_list,
5369 			    tgt->req, links);
5370 			mpt_free_request(mpt, tgt->req);
5371 			tgt->req = NULL;
5372 
5373 			/*
5374 			 * Do we need to send status now? That is, are
5375 			 * we done with all our data transfers?
5376 			 */
5377 			if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
5378 				mpt_set_ccb_status(ccb, CAM_REQ_CMP);
5379 				ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
5380 				KASSERT(ccb->ccb_h.status,
5381 				    ("zero ccb sts at %d\n", __LINE__));
5382 				tgt->state = TGT_STATE_IN_CAM;
5383 				if (mpt->outofbeer) {
5384 					ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
5385 					mpt->outofbeer = 0;
5386 					mpt_lprt(mpt, MPT_PRT_DEBUG, "THAWQ\n");
5387 				}
5388 				MPTLOCK_2_CAMLOCK(mpt);
5389 				xpt_done(ccb);
5390 				CAMLOCK_2_MPTLOCK(mpt);
5391 				break;
5392 			}
5393 			/*
5394 			 * Otherwise, send status (and sense)
5395 			 */
5396 			if (ccb->ccb_h.flags & CAM_SEND_SENSE) {
5397 				sp = sense;
5398 				memcpy(sp, &ccb->csio.sense_data,
5399 				   min(ccb->csio.sense_len, MPT_SENSE_SIZE));
5400 			}
5401 			mpt_scsi_tgt_status(mpt, ccb, req,
5402 			    ccb->csio.scsi_status, sp);
5403 			break;
5404 		}
5405 		case TGT_STATE_SENDING_STATUS:
5406 		case TGT_STATE_MOVING_DATA_AND_STATUS:
5407 		{
5408 			int ioindex;
5409 			ccb = tgt->ccb;
5410 
5411 			if (tgt->req == NULL) {
5412 				panic("mpt: turbo target reply with null "
5413 				    "associated request sending status");
5414 				/* NOTREACHED */
5415 			}
5416 
5417 			if (ccb) {
5418 				tgt->ccb = NULL;
5419 				if (tgt->state ==
5420 				    TGT_STATE_MOVING_DATA_AND_STATUS) {
5421 					tgt->nxfers++;
5422 				}
5423 				mpt_req_untimeout(req, mpt_timeout, ccb);
5424 				if (ccb->ccb_h.flags & CAM_SEND_SENSE) {
5425 					ccb->ccb_h.status |= CAM_SENT_SENSE;
5426 				}
5427 				mpt_lprt(mpt, MPT_PRT_DEBUG,
5428 				    "TARGET_STATUS tag %x sts %x flgs %x req "
5429 				    "%p\n", ccb->csio.tag_id, ccb->ccb_h.status,
5430 				    ccb->ccb_h.flags, tgt->req);
5431 				/*
5432 				 * Free the Target Send Status Request
5433 				 */
5434 				KASSERT(tgt->req->ccb == ccb,
5435 				    ("tgt->req %p:%u tgt->req->ccb %p",
5436 				    tgt->req, tgt->req->serno, tgt->req->ccb));
5437 				/*
5438 				 * Notify CAM that we're done
5439 				 */
5440 				mpt_set_ccb_status(ccb, CAM_REQ_CMP);
5441 				ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
5442 				KASSERT(ccb->ccb_h.status,
5443 				    ("ZERO ccb sts at %d\n", __LINE__));
5444 				tgt->ccb = NULL;
5445 			} else {
5446 				mpt_lprt(mpt, MPT_PRT_DEBUG,
5447 				    "TARGET_STATUS non-CAM for  req %p:%u\n",
5448 				    tgt->req, tgt->req->serno);
5449 			}
5450 			TAILQ_REMOVE(&mpt->request_pending_list,
5451 			    tgt->req, links);
5452 			mpt_free_request(mpt, tgt->req);
5453 			tgt->req = NULL;
5454 
5455 			/*
5456 			 * And re-post the Command Buffer.
5457 			 * This will reset the state.
5458 			 */
5459 			ioindex = GET_IO_INDEX(reply_desc);
5460 			TAILQ_REMOVE(&mpt->request_pending_list, req, links);
5461 			tgt->is_local = 0;
5462 			mpt_post_target_command(mpt, req, ioindex);
5463 
5464 			/*
5465 			 * And post a done for anyone who cares
5466 			 */
5467 			if (ccb) {
5468 				if (mpt->outofbeer) {
5469 					ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
5470 					mpt->outofbeer = 0;
5471 					mpt_lprt(mpt, MPT_PRT_DEBUG, "THAWQ\n");
5472 				}
5473 				MPTLOCK_2_CAMLOCK(mpt);
5474 				xpt_done(ccb);
5475 				CAMLOCK_2_MPTLOCK(mpt);
5476 			}
5477 			break;
5478 		}
5479 		case TGT_STATE_NIL:	/* XXX This Never Happens XXX */
5480 			tgt->state = TGT_STATE_LOADED;
5481 			break;
5482 		default:
5483 			mpt_prt(mpt, "Unknown Target State 0x%x in Context "
5484 			    "Reply Function\n", tgt->state);
5485 		}
5486 		return (TRUE);
5487 	}
5488 
5489 	status = le16toh(reply_frame->IOCStatus);
5490 	if (status != MPI_IOCSTATUS_SUCCESS) {
5491 		dbg = MPT_PRT_ERROR;
5492 	} else {
5493 		dbg = MPT_PRT_DEBUG1;
5494 	}
5495 
5496 	mpt_lprt(mpt, dbg,
5497 	    "SCSI_TGT REPLY: req=%p:%u reply=%p func=%x IOCstatus 0x%x\n",
5498 	     req, req->serno, reply_frame, reply_frame->Function, status);
5499 
5500 	switch (reply_frame->Function) {
5501 	case MPI_FUNCTION_TARGET_CMD_BUFFER_POST:
5502 	{
5503 		mpt_tgt_state_t *tgt;
5504 #ifdef	INVARIANTS
5505 		mpt_req_spcl(mpt, req, "tgt reply BUFFER POST", __LINE__);
5506 #endif
5507 		if (status != MPI_IOCSTATUS_SUCCESS) {
5508 			/*
5509 			 * XXX What to do?
5510 			 */
5511 			break;
5512 		}
5513 		tgt = MPT_TGT_STATE(mpt, req);
5514 		KASSERT(tgt->state == TGT_STATE_LOADING,
5515 		    ("bad state 0x%x on reply to buffer post\n", tgt->state));
5516 		mpt_assign_serno(mpt, req);
5517 		tgt->state = TGT_STATE_LOADED;
5518 		break;
5519 	}
5520 	case MPI_FUNCTION_TARGET_ASSIST:
5521 #ifdef	INVARIANTS
5522 		mpt_req_not_spcl(mpt, req, "tgt reply TARGET ASSIST", __LINE__);
5523 #endif
5524 		mpt_prt(mpt, "target assist completion\n");
5525 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
5526 		mpt_free_request(mpt, req);
5527 		break;
5528 	case MPI_FUNCTION_TARGET_STATUS_SEND:
5529 #ifdef	INVARIANTS
5530 		mpt_req_not_spcl(mpt, req, "tgt reply STATUS SEND", __LINE__);
5531 #endif
5532 		mpt_prt(mpt, "status send completion\n");
5533 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
5534 		mpt_free_request(mpt, req);
5535 		break;
5536 	case MPI_FUNCTION_TARGET_MODE_ABORT:
5537 	{
5538 		PTR_MSG_TARGET_MODE_ABORT_REPLY abtrp =
5539 		    (PTR_MSG_TARGET_MODE_ABORT_REPLY) reply_frame;
5540 		PTR_MSG_TARGET_MODE_ABORT abtp =
5541 		    (PTR_MSG_TARGET_MODE_ABORT) req->req_vbuf;
5542 		uint32_t cc = GET_IO_INDEX(le32toh(abtp->ReplyWord));
5543 #ifdef	INVARIANTS
5544 		mpt_req_not_spcl(mpt, req, "tgt reply TMODE ABORT", __LINE__);
5545 #endif
5546 		mpt_prt(mpt, "ABORT RX_ID 0x%x Complete; status 0x%x cnt %u\n",
5547 		    cc, le16toh(abtrp->IOCStatus), le32toh(abtrp->AbortCount));
5548 		TAILQ_REMOVE(&mpt->request_pending_list, req, links);
5549 		mpt_free_request(mpt, req);
5550 		break;
5551 	}
5552 	default:
5553 		mpt_prt(mpt, "Unknown Target Address Reply Function code: "
5554 		    "0x%x\n", reply_frame->Function);
5555 		break;
5556 	}
5557 	return (TRUE);
5558 }
5559