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