sys/dev/mpt/mpt_cam.c

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