sys/dev/disk/mpt/mpt_cam.c

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