sys/dev/disk/mpt/mpt_freebsd.c

   1 /* $FreeBSD: src/sys/dev/mpt/mpt_freebsd.c,v 1.3.2.3 2002/09/24 21:37:25 mjacob Exp $ */
   2 /* $DragonFly: src/sys/dev/disk/mpt/mpt_freebsd.c,v 1.6 2004/09/19 00:25:57 joerg Exp $ */
   3 /*
   4  * FreeBSD/CAM specific routines for LSI '909 FC  adapters.
   5  * FreeBSD Version.
   6  *
   7  * Copyright (c)  2000, 2001 by Greg Ansley
   8  *
   9  * Redistribution and use in source and binary forms, with or without
  10  * modification, are permitted provided that the following conditions
  11  * are met:
  12  * 1. Redistributions of source code must retain the above copyright
  13  *    notice immediately at the beginning of the file, without modification,
  14  *    this list of conditions, and the following disclaimer.
  15  * 2. The name of the author may not be used to endorse or promote products
  16  *    derived from this software without specific prior written permission.
  17  *
  18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  19  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  21  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
  22  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  23  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  24  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  26  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  27  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  28  * SUCH DAMAGE.
  29  */
  30 /*
  31  * Additional Copyright (c) 2002 by Matthew Jacob under same license.
  32  */
  33
  34 #include "mpt_freebsd.h"
  35
  36 static void mpt_poll(struct cam_sim *);
  37 static timeout_t mpttimeout;
  38 static timeout_t mpttimeout2;
  39 static void mpt_action(struct cam_sim *, union ccb *);
  40 static int mpt_setwidth(mpt_softc_t *, int, int);
  41 static int mpt_setsync(mpt_softc_t *, int, int, int);
  42
  43 void
  44 mpt_cam_attach(mpt_softc_t *mpt)
  45 {
  46         struct cam_sim *sim;
  47         int maxq;
  48
  49         mpt->bus = 0;
  50         maxq = (mpt->mpt_global_credits < MPT_MAX_REQUESTS(mpt))?
  51             mpt->mpt_global_credits : MPT_MAX_REQUESTS(mpt);
  52
  53
  54         /*
  55          * Construct our SIM entry.
  56          */
  57         sim = cam_sim_alloc(mpt_action, mpt_poll, "mpt", mpt,
  58             mpt->unit, 1, maxq, NULL);
  59         if (sim == NULL)
  60                 return;
  61
  62         /*
  63          * Register exactly the bus.
  64          */
  65
  66         if (xpt_bus_register(sim, 0) != CAM_SUCCESS) {
  67                 cam_sim_free(sim);
  68                 return;
  69         }
  70
  71         if (xpt_create_path(&mpt->path, NULL, cam_sim_path(sim),
  72             CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
  73                 xpt_bus_deregister(cam_sim_path(sim));
  74                 cam_sim_free(sim);
  75                 return;
  76         }
  77         mpt->sim = sim;
  78 }
  79
  80 void
  81 mpt_cam_detach(mpt_softc_t *mpt)
  82 {
  83         if (mpt->sim != NULL) {
  84                 xpt_free_path(mpt->path);
  85                 xpt_bus_deregister(cam_sim_path(mpt->sim));
  86                 cam_sim_free(mpt->sim);
  87                 mpt->sim = NULL;
  88         }
  89 }
  90
  91 /* This routine is used after a system crash to dump core onto the
  92  * swap device.
  93  */
  94 static void
  95 mpt_poll(struct cam_sim *sim)
  96 {
  97         mpt_softc_t *mpt = (mpt_softc_t *) cam_sim_softc(sim);
  98         MPT_LOCK(mpt);
  99         mpt_intr(mpt);
 100         MPT_UNLOCK(mpt);
 101 }
 102
 103 /*
 104  * This routine is called if the 9x9 does not return completion status
 105  * for a command after a CAM specified time.
 106  */
 107 static void
 108 mpttimeout(void *arg)
 109 {
 110         request_t *req;
 111         union ccb *ccb = arg;
 112         u_int32_t oseq;
 113         mpt_softc_t *mpt;
 114
 115         mpt = ccb->ccb_h.ccb_mpt_ptr;
 116         MPT_LOCK(mpt);
 117         req = ccb->ccb_h.ccb_req_ptr;
 118         oseq = req->sequence;
 119         mpt->timeouts++;
 120         if (mpt_intr(mpt)) {
 121                 if (req->sequence != oseq) {
 122                         device_printf(mpt->dev, "bullet missed in timeout\n");
 123                         MPT_UNLOCK(mpt);
 124                         return;
 125                 }
 126                 device_printf(mpt->dev, "bullet U-turned in timeout: got us\n");
 127         }
 128         device_printf(mpt->dev,
 129             "time out on request index = 0x%02x sequence = 0x%08x\n",
 130             req->index, req->sequence);
 131         mpt_check_doorbell(mpt);
 132         device_printf(mpt->dev, "Status %08X; Mask %08X; Doorbell %08X\n",
 133                 mpt_read(mpt, MPT_OFFSET_INTR_STATUS),
 134                 mpt_read(mpt, MPT_OFFSET_INTR_MASK),
 135                 mpt_read(mpt, MPT_OFFSET_DOORBELL) );
 136         printf("request state %s\n", mpt_req_state(req->debug));
 137         if (ccb != req->ccb) {
 138                 printf("time out: ccb %p != req->ccb %p\n",
 139                         ccb,req->ccb);
 140         }
 141         mpt_print_scsi_io_request((MSG_SCSI_IO_REQUEST *)req->req_vbuf);
 142         req->debug = REQ_TIMEOUT;
 143         req->ccb = NULL;
 144         req->link.sle_next = (void *) mpt;
 145         callout_reset(&req->timeout, hz / 10, mpttimeout2, req);
 146         ccb->ccb_h.status = CAM_CMD_TIMEOUT;
 147         ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
 148         mpt->outofbeer = 0;
 149         MPTLOCK_2_CAMLOCK(mpt);
 150         xpt_done(ccb);
 151         CAMLOCK_2_MPTLOCK(mpt);
 152         MPT_UNLOCK(mpt);
 153 }
 154
 155 static void
 156 mpttimeout2(void *arg)
 157 {
 158         request_t *req = arg;
 159         if (req->debug == REQ_TIMEOUT) {
 160                 mpt_softc_t *mpt = (mpt_softc_t *) req->link.sle_next;
 161                 MPT_LOCK(mpt);
 162                 mpt_free_request(mpt, req);
 163                 MPT_UNLOCK(mpt);
 164         }
 165 }
 166
 167 /*
 168  * Callback routine from "bus_dmamap_load" or in simple case called directly.
 169  *
 170  * Takes a list of physical segments and builds the SGL for SCSI IO command
 171  * and forwards the commard to the IOC after one last check that CAM has not
 172  * aborted the transaction.
 173  */
 174 static void
 175 mpt_execute_req(void *arg, bus_dma_segment_t *dm_segs, int nseg, int error)
 176 {
 177         request_t *req;
 178         union ccb *ccb;
 179         mpt_softc_t *mpt;
 180         MSG_SCSI_IO_REQUEST *mpt_req;
 181         SGE_SIMPLE32 *se;
 182
 183         req = (request_t *)arg;
 184         ccb = req->ccb;
 185
 186         mpt = ccb->ccb_h.ccb_mpt_ptr;
 187         req = ccb->ccb_h.ccb_req_ptr;
 188         mpt_req = req->req_vbuf;
 189
 190         if (error == 0 && nseg > MPT_SGL_MAX) {
 191                 error = EFBIG;
 192         }
 193
 194         if (error != 0) {
 195                 if (error != EFBIG)
 196                         device_printf(mpt->dev, "bus_dmamap_load returned %d\n",
 197                             error);
 198                 if (ccb->ccb_h.status == CAM_REQ_INPROG) {
 199                         xpt_freeze_devq(ccb->ccb_h.path, 1);
 200                         ccb->ccb_h.status = CAM_DEV_QFRZN;
 201                         if (error == EFBIG)
 202                                 ccb->ccb_h.status |= CAM_REQ_TOO_BIG;
 203                         else
 204                                 ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
 205                 }
 206                 ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
 207                 xpt_done(ccb);
 208                 CAMLOCK_2_MPTLOCK(mpt);
 209                 mpt_free_request(mpt, req);
 210                 MPTLOCK_2_CAMLOCK(mpt);
 211                 return;
 212         }
 213
 214         if (nseg > MPT_NSGL_FIRST(mpt)) {
 215                 int i, nleft = nseg;
 216                 u_int32_t flags;
 217                 bus_dmasync_op_t op;
 218                 SGE_CHAIN32 *ce;
 219
 220                 mpt_req->DataLength = ccb->csio.dxfer_len;
 221                 flags = MPI_SGE_FLAGS_SIMPLE_ELEMENT;
 222                 if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT)
 223                         flags |= MPI_SGE_FLAGS_HOST_TO_IOC;
 224
 225                 se = (SGE_SIMPLE32 *) &mpt_req->SGL;
 226                 for (i = 0; i < MPT_NSGL_FIRST(mpt) - 1; i++, se++, dm_segs++) {
 227                         u_int32_t tf;
 228
 229                         bzero(se, sizeof (*se));
 230                         se->Address = dm_segs->ds_addr;
 231                         MPI_pSGE_SET_LENGTH(se, dm_segs->ds_len);
 232                         tf = flags;
 233                         if (i == MPT_NSGL_FIRST(mpt) - 2) {
 234                                 tf |= MPI_SGE_FLAGS_LAST_ELEMENT;
 235                         }
 236                         MPI_pSGE_SET_FLAGS(se, tf);
 237                         nleft -= 1;
 238                 }
 239
 240                 /*
 241                  * Tell the IOC where to find the first chain element
 242                  */
 243                 mpt_req->ChainOffset = ((char *)se - (char *)mpt_req) >> 2;
 244
 245                 /*
 246                  * Until we're finished with all segments...
 247                  */
 248                 while (nleft) {
 249                         int ntodo;
 250                         /*
 251                          * Construct the chain element that point to the
 252                          * next segment.
 253                          */
 254                         ce = (SGE_CHAIN32 *) se++;
 255                         if (nleft > MPT_NSGL(mpt)) {
 256                                 ntodo = MPT_NSGL(mpt) - 1;
 257                                 ce->NextChainOffset = (MPT_RQSL(mpt) -
 258                                     sizeof (SGE_SIMPLE32)) >> 2;
 259                         } else {
 260                                 ntodo = nleft;
 261                                 ce->NextChainOffset = 0;
 262                         }
 263                         ce->Length = ntodo * sizeof (SGE_SIMPLE32);
 264                         ce->Address = req->req_pbuf +
 265                             ((char *)se - (char *)mpt_req);
 266                         ce->Flags = MPI_SGE_FLAGS_CHAIN_ELEMENT;
 267                         for (i = 0; i < ntodo; i++, se++, dm_segs++) {
 268                                 u_int32_t tf;
 269
 270                                 bzero(se, sizeof (*se));
 271                                 se->Address = dm_segs->ds_addr;
 272                                 MPI_pSGE_SET_LENGTH(se, dm_segs->ds_len);
 273                                 tf = flags;
 274                                 if (i == ntodo - 1) {
 275                                         tf |= MPI_SGE_FLAGS_LAST_ELEMENT;
 276                                         if (ce->NextChainOffset == 0) {
 277                                                 tf |=
 278                                                     MPI_SGE_FLAGS_END_OF_LIST |
 279                                                     MPI_SGE_FLAGS_END_OF_BUFFER;
 280                                         }
 281                                 }
 282                                 MPI_pSGE_SET_FLAGS(se, tf);
 283                                 nleft -= 1;
 284                         }
 285
 286                 }
 287
 288                 if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN)
 289                         op = BUS_DMASYNC_PREREAD;
 290                 else
 291                         op = BUS_DMASYNC_PREWRITE;
 292                 if (!(ccb->ccb_h.flags & (CAM_SG_LIST_PHYS|CAM_DATA_PHYS))) {
 293                         bus_dmamap_sync(mpt->buffer_dmat, req->dmap, op);
 294                 }
 295         } else if (nseg > 0) {
 296                 int i;
 297                 u_int32_t flags;
 298                 bus_dmasync_op_t op;
 299
 300                 mpt_req->DataLength = ccb->csio.dxfer_len;
 301                 flags = MPI_SGE_FLAGS_SIMPLE_ELEMENT;
 302                 if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT)
 303                         flags |= MPI_SGE_FLAGS_HOST_TO_IOC;
 304
 305                 /* Copy the segments into our SG list */
 306                 se = (SGE_SIMPLE32 *) &mpt_req->SGL;
 307                 for (i = 0; i < nseg; i++, se++, dm_segs++) {
 308                         u_int32_t tf;
 309
 310                         bzero(se, sizeof (*se));
 311                         se->Address = dm_segs->ds_addr;
 312                         MPI_pSGE_SET_LENGTH(se, dm_segs->ds_len);
 313                         tf = flags;
 314                         if (i == nseg - 1) {
 315                                 tf |=
 316                                     MPI_SGE_FLAGS_LAST_ELEMENT |
 317                                     MPI_SGE_FLAGS_END_OF_BUFFER |
 318                                     MPI_SGE_FLAGS_END_OF_LIST;
 319                         }
 320                         MPI_pSGE_SET_FLAGS(se, tf);
 321                 }
 322
 323                 if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN)
 324                         op = BUS_DMASYNC_PREREAD;
 325                 else
 326                         op = BUS_DMASYNC_PREWRITE;
 327                 if (!(ccb->ccb_h.flags & (CAM_SG_LIST_PHYS|CAM_DATA_PHYS))) {
 328                         bus_dmamap_sync(mpt->buffer_dmat, req->dmap, op);
 329                 }
 330         } else {
 331                 se = (SGE_SIMPLE32 *) &mpt_req->SGL;
 332                 /*
 333                  * No data to transfer so we just make a single simple SGL
 334                  * with zero length.
 335                  */
 336                 MPI_pSGE_SET_FLAGS(se,
 337                     (MPI_SGE_FLAGS_LAST_ELEMENT | MPI_SGE_FLAGS_END_OF_BUFFER |
 338                     MPI_SGE_FLAGS_SIMPLE_ELEMENT | MPI_SGE_FLAGS_END_OF_LIST));
 339         }
 340
 341         /*
 342          * Last time we need to check if this CCB needs to be aborted.
 343          */
 344         if (ccb->ccb_h.status != CAM_REQ_INPROG) {
 345                 if (nseg && (ccb->ccb_h.flags & CAM_SG_LIST_PHYS) == 0)
 346                         bus_dmamap_unload(mpt->buffer_dmat, req->dmap);
 347                 CAMLOCK_2_MPTLOCK(mpt);
 348                 mpt_free_request(mpt, req);
 349                 MPTLOCK_2_CAMLOCK(mpt);
 350                 xpt_done(ccb);
 351                 return;
 352         }
 353
 354         ccb->ccb_h.status |= CAM_SIM_QUEUED;
 355         MPTLOCK_2_CAMLOCK(mpt);
 356         if (ccb->ccb_h.timeout != CAM_TIME_INFINITY) {
 357                 callout_reset(&ccb->ccb_h.timeout_ch,
 358                     (ccb->ccb_h.timeout * hz) / 1000, mpttimeout, ccb);
 359         }
 360         if (mpt->verbose > 1)
 361                 mpt_print_scsi_io_request(mpt_req);
 362         mpt_send_cmd(mpt, req);
 363         MPTLOCK_2_CAMLOCK(mpt);
 364 }
 365
 366 static void
 367 mpt_start(union ccb *ccb)
 368 {
 369         request_t *req;
 370         struct mpt_softc *mpt;
 371         MSG_SCSI_IO_REQUEST *mpt_req;
 372         struct ccb_scsiio *csio = &ccb->csio;
 373         struct ccb_hdr *ccbh = &ccb->ccb_h;
 374
 375         /* Get the pointer for the physical addapter */
 376         mpt = ccb->ccb_h.ccb_mpt_ptr;
 377
 378         CAMLOCK_2_MPTLOCK(mpt);
 379         /* Get a request structure off the free list */
 380         if ((req = mpt_get_request(mpt)) == NULL) {
 381                 if (mpt->outofbeer == 0) {
 382                         mpt->outofbeer = 1;
 383                         xpt_freeze_simq(mpt->sim, 1);
 384                         if (mpt->verbose > 1) {
 385                                 device_printf(mpt->dev, "FREEZEQ\n");
 386                         }
 387                 }
 388                 MPTLOCK_2_CAMLOCK(mpt);
 389                 ccb->ccb_h.status = CAM_REQUEUE_REQ;
 390                 xpt_done(ccb);
 391                 return;
 392         }
 393         MPTLOCK_2_CAMLOCK(mpt);
 394
 395         /* Link the ccb and the request structure so we can find */
 396         /* the other knowing either the request or the ccb               */
 397         req->ccb = ccb;
 398         ccb->ccb_h.ccb_req_ptr = req;
 399
 400         /* Now we build the command for the IOC */
 401         mpt_req = req->req_vbuf;
 402         bzero(mpt_req, sizeof *mpt_req);
 403
 404         mpt_req->Function = MPI_FUNCTION_SCSI_IO_REQUEST;
 405         mpt_req->Bus = mpt->bus;
 406
 407         mpt_req->SenseBufferLength =
 408                 (csio->sense_len < MPT_SENSE_SIZE) ?
 409                  csio->sense_len : MPT_SENSE_SIZE;
 410
 411         /* We use the message context to find the request structure when we */
 412         /* Get the command competion interrupt from the FC IOC.                         */
 413         mpt_req->MsgContext = req->index;
 414
 415         /* Which physical device to do the I/O on */
 416         mpt_req->TargetID = ccb->ccb_h.target_id;
 417         mpt_req->LUN[1] = ccb->ccb_h.target_lun;
 418
 419         /* Set the direction of the transfer */
 420         if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN)
 421                 mpt_req->Control = MPI_SCSIIO_CONTROL_READ;
 422         else if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT)
 423                 mpt_req->Control = MPI_SCSIIO_CONTROL_WRITE;
 424         else
 425                 mpt_req->Control = MPI_SCSIIO_CONTROL_NODATATRANSFER;
 426
 427         if ((ccb->ccb_h.flags & CAM_TAG_ACTION_VALID) != 0) {
 428                 switch(ccb->csio.tag_action) {
 429                 case MSG_HEAD_OF_Q_TAG:
 430                         mpt_req->Control |= MPI_SCSIIO_CONTROL_HEADOFQ;
 431                         break;
 432                 case MSG_ACA_TASK:
 433                         mpt_req->Control |= MPI_SCSIIO_CONTROL_ACAQ;
 434                         break;
 435                 case MSG_ORDERED_Q_TAG:
 436                         mpt_req->Control |= MPI_SCSIIO_CONTROL_ORDEREDQ;
 437                         break;
 438                 case MSG_SIMPLE_Q_TAG:
 439                 default:
 440                         mpt_req->Control |= MPI_SCSIIO_CONTROL_SIMPLEQ;
 441                         break;
 442                 }
 443         } else {
 444                 if (mpt->is_fc)
 445                         mpt_req->Control |= MPI_SCSIIO_CONTROL_SIMPLEQ;
 446                 else
 447                         mpt_req->Control |= MPI_SCSIIO_CONTROL_UNTAGGED;
 448         }
 449
 450         if (mpt->is_fc == 0) {
 451                 if (ccb->ccb_h.flags & CAM_DIS_DISCONNECT) {
 452                         mpt_req->Control |= MPI_SCSIIO_CONTROL_NO_DISCONNECT;
 453                 }
 454         }
 455
 456         /* Copy the scsi command block into place */
 457         if ((ccb->ccb_h.flags & CAM_CDB_POINTER) != 0)
 458                 bcopy(csio->cdb_io.cdb_ptr, mpt_req->CDB, csio->cdb_len);
 459         else
 460                 bcopy(csio->cdb_io.cdb_bytes, mpt_req->CDB, csio->cdb_len);
 461
 462         mpt_req->CDBLength = csio->cdb_len;
 463         mpt_req->DataLength = csio->dxfer_len;
 464         mpt_req->SenseBufferLowAddr = req->sense_pbuf;
 465
 466         /*
 467          * If we have any data to send with this command,
 468          * map it into bus space.
 469          */
 470
 471         if ((ccbh->flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
 472                 if ((ccbh->flags & CAM_SCATTER_VALID) == 0) {
 473                         /*
 474                          * We've been given a pointer to a single buffer.
 475                          */
 476                         if ((ccbh->flags & CAM_DATA_PHYS) == 0) {
 477                                 /*
 478                                  * Virtual address that needs to translated into
 479                                  * one or more physical pages.
 480                                  */
 481                                 int error;
 482
 483                                 error = bus_dmamap_load(mpt->buffer_dmat,
 484                                     req->dmap, csio->data_ptr, csio->dxfer_len,
 485                                     mpt_execute_req, req, 0);
 486                                 if (error == EINPROGRESS) {
 487                                         /*
 488                                          * So as to maintain ordering,
 489                                          * freeze the controller queue
 490                                          * until our mapping is
 491                                          * returned.
 492                                          */
 493                                         xpt_freeze_simq(mpt->sim, 1);
 494                                         ccbh->status |= CAM_RELEASE_SIMQ;
 495                                 }
 496                         } else {
 497                                 /*
 498                                  * We have been given a pointer to single
 499                                  * physical buffer.
 500                                  */
 501                                 struct bus_dma_segment seg;
 502                                 seg.ds_addr = (bus_addr_t)csio->data_ptr;
 503                                 seg.ds_len = csio->dxfer_len;
 504                                 mpt_execute_req(req, &seg, 1, 0);
 505                         }
 506                 } else {
 507                         /*
 508                          * We have been given a list of addresses.
 509                          * These case could be easily done but they are not
 510                          * currently generated by the CAM subsystem so there
 511                          * is no point in wasting the time right now.
 512                          */
 513                         struct bus_dma_segment *segs;
 514                         if ((ccbh->flags & CAM_SG_LIST_PHYS) == 0) {
 515                                 mpt_execute_req(req, NULL, 0, EFAULT);
 516                         } else {
 517                                 /* Just use the segments provided */
 518                                 segs = (struct bus_dma_segment *)csio->data_ptr;
 519                                 mpt_execute_req(req, segs, csio->sglist_cnt,
 520                                     (csio->sglist_cnt < MPT_SGL_MAX)?
 521                                     0 : EFBIG);
 522                         }
 523                 }
 524         } else {
 525                 mpt_execute_req(req, NULL, 0, 0);
 526         }
 527 }
 528
 529 static int
 530 mpt_bus_reset(union ccb *ccb)
 531 {
 532         int error;
 533         request_t *req;
 534         mpt_softc_t *mpt;
 535         MSG_SCSI_TASK_MGMT *reset_req;
 536
 537         /* Get the pointer for the physical adapter */
 538         mpt = ccb->ccb_h.ccb_mpt_ptr;
 539
 540         /* Get a request structure off the free list */
 541         if ((req = mpt_get_request(mpt)) == NULL) {
 542                 return (CAM_REQUEUE_REQ);
 543         }
 544
 545         /* Link the ccb and the request structure so we can find */
 546         /* the other knowing either the request or the ccb               */
 547         req->ccb = ccb;
 548         ccb->ccb_h.ccb_req_ptr = req;
 549
 550         reset_req = req->req_vbuf;
 551         bzero(reset_req, sizeof *reset_req);
 552
 553         reset_req->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
 554         reset_req->MsgContext = req->index;
 555         reset_req->TaskType = MPI_SCSITASKMGMT_TASKTYPE_RESET_BUS;
 556         if (mpt->is_fc) {
 557                 /*
 558                  * Should really be TARGET_RESET_OPTION
 559                  */
 560                 reset_req->MsgFlags =
 561                     MPI_SCSITASKMGMT_MSGFLAGS_LIP_RESET_OPTION;
 562         }
 563         /* Which physical device Reset */
 564         reset_req->TargetID = ccb->ccb_h.target_id;
 565         reset_req->LUN[1] = ccb->ccb_h.target_lun;
 566
 567         ccb->ccb_h.status |= CAM_SIM_QUEUED;
 568
 569         error = mpt_send_handshake_cmd(mpt,
 570             sizeof (MSG_SCSI_TASK_MGMT), reset_req);
 571         if (error) {
 572                 device_printf(mpt->dev,
 573                     "mpt_bus_reset: mpt_send_handshake return %d\n", error);
 574                 return (CAM_REQ_CMP_ERR);
 575         } else {
 576                 return (CAM_REQ_CMP);
 577         }
 578 }
 579
 580 /*
 581  * Process an asynchronous event from the IOC.
 582  */
 583 static void mpt_ctlop(mpt_softc_t *, void *, u_int32_t);
 584 static void mpt_event_notify_reply(mpt_softc_t *mpt, MSG_EVENT_NOTIFY_REPLY *);
 585
 586 void
 587 mpt_ctlop(mpt_softc_t *mpt, void *vmsg, u_int32_t reply)
 588 {
 589         MSG_DEFAULT_REPLY *dmsg = vmsg;
 590
 591         if (dmsg->Function == MPI_FUNCTION_EVENT_NOTIFICATION) {
 592                 mpt_event_notify_reply(mpt, vmsg);
 593                 mpt_free_reply(mpt, (reply << 1));
 594         } else if (dmsg->Function == MPI_FUNCTION_EVENT_ACK) {
 595                 mpt_free_reply(mpt, (reply << 1));
 596         } else if (dmsg->Function == MPI_FUNCTION_PORT_ENABLE) {
 597                 MSG_PORT_ENABLE_REPLY *msg = vmsg;
 598                 int index = msg->MsgContext & ~0x80000000;
 599                 if (mpt->verbose > 1) {
 600                         device_printf(mpt->dev, "enable port reply idx %d\n",
 601                             index);
 602                 }
 603                 if (index >= 0 && index < MPT_MAX_REQUESTS(mpt)) {
 604                         request_t *req = &mpt->request_pool[index];
 605                         req->debug = REQ_DONE;
 606                 }
 607                 mpt_free_reply(mpt, (reply << 1));
 608         } else if (dmsg->Function == MPI_FUNCTION_CONFIG) {
 609                 MSG_CONFIG_REPLY *msg = vmsg;
 610                 int index = msg->MsgContext & ~0x80000000;
 611                 if (index >= 0 && index < MPT_MAX_REQUESTS(mpt)) {
 612                         request_t *req = &mpt->request_pool[index];
 613                         req->debug = REQ_DONE;
 614                         req->sequence = reply;
 615                 } else {
 616                         mpt_free_reply(mpt, (reply << 1));
 617                 }
 618         } else {
 619                 device_printf(mpt->dev, "unknown mpt_ctlop: %x\n",
 620                     dmsg->Function);
 621         }
 622 }
 623
 624 static void
 625 mpt_event_notify_reply(mpt_softc_t *mpt, MSG_EVENT_NOTIFY_REPLY *msg)
 626 {
 627         switch(msg->Event) {
 628         case MPI_EVENT_LOG_DATA:
 629                 /* Some error occured that LSI wants logged */
 630                 device_printf(mpt->dev,
 631                     "\tEvtLogData: IOCLogInfo: 0x%08x\n",
 632                     msg->IOCLogInfo);
 633                 device_printf(mpt->dev, "\tEvtLogData: Event Data:");
 634                 {
 635                         int i;
 636                         for (i = 0; i < msg->EventDataLength; i++) {
 637                                 device_printf(mpt->dev,
 638                                     "  %08X", msg->Data[i]);
 639                         }
 640                 }
 641                 device_printf(mpt->dev, "\n");
 642                 break;
 643
 644         case MPI_EVENT_UNIT_ATTENTION:
 645                 device_printf(mpt->dev,
 646                     "Bus: 0x%02x TargetID: 0x%02x\n",
 647                     (msg->Data[0] >> 8) & 0xff, msg->Data[0] & 0xff);
 648                 break;
 649
 650         case MPI_EVENT_IOC_BUS_RESET:
 651                 /* We generated a bus reset */
 652                 device_printf(mpt->dev, "IOC Bus Reset Port: %d\n",
 653                     (msg->Data[0] >> 8) & 0xff);
 654                 break;
 655
 656         case MPI_EVENT_EXT_BUS_RESET:
 657                 /* Someone else generated a bus reset */
 658                 device_printf(mpt->dev, "Ext Bus Reset\n");
 659                 /*
 660                  * These replies don't return EventData like the MPI
 661                  * spec says they do
 662                  */
 663 /*              xpt_async(AC_BUS_RESET, path, NULL);  */
 664                 break;
 665
 666         case MPI_EVENT_RESCAN:
 667                 /*
 668                  * In general this means a device has been added
 669                  * to the loop.
 670                  */
 671                 device_printf(mpt->dev,
 672                     "Rescan Port: %d\n", (msg->Data[0] >> 8) & 0xff);
 673 /*              xpt_async(AC_FOUND_DEVICE, path, NULL);  */
 674                 break;
 675
 676         case MPI_EVENT_LINK_STATUS_CHANGE:
 677                 device_printf(mpt->dev, "Port %d: LinkState: %s\n",
 678                     (msg->Data[1] >> 8) & 0xff,
 679                     ((msg->Data[0] & 0xff) == 0)?  "Failed" : "Active");
 680                 break;
 681
 682         case MPI_EVENT_LOOP_STATE_CHANGE:
 683                 switch ((msg->Data[0] >> 16) & 0xff) {
 684                 case 0x01:
 685                         device_printf(mpt->dev,
 686                             "Port 0x%x: FC LinkEvent: LIP(%02X,%02X) (Loop Initialization)\n",
 687                             (msg->Data[1] >> 8) & 0xff,
 688                             (msg->Data[0] >> 8) & 0xff,
 689                             (msg->Data[0]     ) & 0xff);
 690                         switch ((msg->Data[0] >> 8) & 0xff) {
 691                         case 0xF7:
 692                                 if ((msg->Data[0] & 0xff) == 0xF7) {
 693                                         printf("Device needs AL_PA\n");
 694                                 } else {
 695                                         printf("Device %02X doesn't like FC performance\n",
 696                                                                         msg->Data[0] & 0xFF);
 697                                 }
 698                                 break;
 699                         case 0xF8:
 700                                 if ((msg->Data[0] & 0xff) == 0xF7) {
 701                                         printf("Device had loop failure at its receiver prior to acquiring AL_PA\n");
 702                                 } else {
 703                                         printf("Device %02X detected loop failure at its receiver\n",
 704                                                                         msg->Data[0] & 0xFF);
 705                                 }
 706                                 break;
 707                         default:
 708                                 printf("Device %02X requests that device %02X reset itself\n",
 709                                         msg->Data[0] & 0xFF,
 710                                         (msg->Data[0] >> 8) & 0xFF);
 711                                 break;
 712                         }
 713                         break;
 714                 case 0x02:
 715                         device_printf(mpt->dev, "Port 0x%x: FC LinkEvent: LPE(%02X,%02X) (Loop Port Enable)\n",
 716                                 (msg->Data[1] >> 8) & 0xff, /* Port */
 717                                 (msg->Data[0] >>  8) & 0xff, /* Character 3 */
 718                                 (msg->Data[0]      ) & 0xff  /* Character 4 */
 719                                 );
 720                         break;
 721                 case 0x03:
 722                         device_printf(mpt->dev, "Port 0x%x: FC LinkEvent: LPB(%02X,%02X) (Loop Port Bypass)\n",
 723                                 (msg->Data[1] >> 8) & 0xff, /* Port */
 724                         (msg->Data[0] >> 8) & 0xff, /* Character 3 */
 725                         (msg->Data[0]     ) & 0xff  /* Character 4 */
 726                                 );
 727                         break;
 728                 default:
 729                         device_printf(mpt->dev, "Port 0x%x: FC LinkEvent: Unknown FC event (%02X %02X %02X)\n",
 730                                 (msg->Data[1] >> 8) & 0xff, /* Port */
 731                                 (msg->Data[0] >> 16) & 0xff, /* Event */
 732                                 (msg->Data[0] >>  8) & 0xff, /* Character 3 */
 733                                 (msg->Data[0]      ) & 0xff  /* Character 4 */
 734                                 );
 735                 }
 736                 break;
 737
 738         case MPI_EVENT_LOGOUT:
 739                 device_printf(mpt->dev, "FC Logout Port: %d N_PortID: %02X\n",
 740                         (msg->Data[1] >> 8) & 0xff,
 741                         msg->Data[0]);
 742                 break;
 743         case MPI_EVENT_EVENT_CHANGE:
 744                 /* This is just an acknowledgement of our
 745                    mpt_send_event_request */
 746                 break;
 747         default:
 748                 device_printf(mpt->dev, "Unknown event %X\n", msg->Event);
 749         }
 750         if (msg->AckRequired) {
 751                 MSG_EVENT_ACK *ackp;
 752                 request_t *req;
 753                 if ((req = mpt_get_request(mpt)) == NULL) {
 754                         panic("unable to get request to acknowledge notify");
 755                 }
 756                 ackp = (MSG_EVENT_ACK *) req->req_vbuf;
 757                 bzero(ackp, sizeof *ackp);
 758                 ackp->Function = MPI_FUNCTION_EVENT_ACK;
 759                 ackp->Event = msg->Event;
 760                 ackp->EventContext = msg->EventContext;
 761                 ackp->MsgContext = req->index | 0x80000000;
 762                 mpt_check_doorbell(mpt);
 763                 mpt_send_cmd(mpt, req);
 764         }
 765 }
 766
 767 void
 768 mpt_done(mpt_softc_t *mpt, u_int32_t reply)
 769 {
 770         int index;
 771         request_t *req;
 772         union ccb *ccb;
 773         MSG_REQUEST_HEADER *mpt_req;
 774         MSG_SCSI_IO_REPLY *mpt_reply;
 775
 776         index = -1; /* Shutup the complier */
 777
 778         if ((reply & MPT_CONTEXT_REPLY) == 0) {
 779                 /* context reply */
 780                 mpt_reply = NULL;
 781                 index = reply & MPT_CONTEXT_MASK;
 782         } else {
 783                 unsigned *pReply;
 784
 785                 bus_dmamap_sync(mpt->reply_dmat, mpt->reply_dmap,
 786                     BUS_DMASYNC_POSTREAD);
 787                 /* address reply (Error) */
 788                 mpt_reply = MPT_REPLY_PTOV(mpt, reply);
 789                 if (mpt->verbose > 1) {
 790                         pReply = (unsigned *) mpt_reply;
 791                         device_printf(mpt->dev, "Address Reply (index %u)\n",
 792                             mpt_reply->MsgContext & 0xffff);
 793                         device_printf(mpt->dev, "%08X %08X %08X %08X\n",
 794                             pReply[0], pReply[1], pReply[2], pReply[3]);
 795                         device_printf(mpt->dev, "%08X %08X %08X %08X\n",
 796                             pReply[4], pReply[5], pReply[6], pReply[7]);
 797                         device_printf(mpt->dev, "%08X %08X %08X %08X\n\n",
 798                             pReply[8], pReply[9], pReply[10], pReply[11]);
 799                 }
 800                 index = mpt_reply->MsgContext;
 801         }
 802
 803         /*
 804          * Address reply with MessageContext high bit set
 805          * This is most likely a notify message so we try
 806          * to process it then free it
 807          */
 808         if ((index & 0x80000000) != 0) {
 809                 if (mpt_reply != NULL) {
 810                         mpt_ctlop(mpt, mpt_reply, reply);
 811                 } else {
 812                         device_printf(mpt->dev,
 813                             "mpt_done: index 0x%x, NULL reply\n", index);
 814                 }
 815                 return;
 816         }
 817
 818         /* Did we end up with a valid index into the table? */
 819         if (index < 0 || index >= MPT_MAX_REQUESTS(mpt)) {
 820                 printf("mpt_done: invalid index (%x) in reply\n", index);
 821                 return;
 822         }
 823
 824         req = &mpt->request_pool[index];
 825
 826         /* Make sure memory hasn't been trashed */
 827         if (req->index != index) {
 828                 printf("mpt_done: corrupted request struct");
 829                 return;
 830         }
 831
 832         /* Short cut for task management replys; nothing more for us to do */
 833         mpt_req = req->req_vbuf;
 834         if (mpt_req->Function == MPI_FUNCTION_SCSI_TASK_MGMT) {
 835                 if (mpt->verbose > 1) {
 836                         device_printf(mpt->dev, "mpt_done: TASK MGMT\n");
 837                 }
 838                 goto done;
 839         }
 840
 841         if (mpt_req->Function == MPI_FUNCTION_PORT_ENABLE) {
 842                 goto done;
 843         }
 844
 845         /*
 846          * At this point it better be a SCSI IO command, but don't
 847          * crash if it isn't
 848          */
 849         if (mpt_req->Function != MPI_FUNCTION_SCSI_IO_REQUEST)  {
 850                 goto done;
 851         }
 852
 853         /* Recover the CAM control block from the request structure */
 854         ccb = req->ccb;
 855
 856         /* Can't have had a SCSI command with out a CAM control block */
 857         if (ccb == NULL || (ccb->ccb_h.status & CAM_SIM_QUEUED) == 0) {
 858                 device_printf(mpt->dev,
 859                     "mpt_done: corrupted ccb, index = 0x%02x seq = 0x%08x",
 860                     req->index, req->sequence);
 861                 printf(" request state %s\nmpt_request:\n",
 862                     mpt_req_state(req->debug));
 863                 mpt_print_scsi_io_request((MSG_SCSI_IO_REQUEST *)req->req_vbuf);
 864
 865                 if (mpt_reply != NULL) {
 866                         printf("\nmpt_done: reply:\n");
 867                         mpt_print_reply(MPT_REPLY_PTOV(mpt, reply));
 868                 } else {
 869                         printf("\nmpt_done: context reply: 0x%08x\n", reply);
 870                 }
 871                 goto done;
 872         }
 873
 874         callout_stop(&ccb->ccb_h.timeout_ch);
 875
 876         if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
 877                 bus_dmasync_op_t op;
 878
 879                 if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
 880                         op = BUS_DMASYNC_POSTREAD;
 881                 } else {
 882                         op = BUS_DMASYNC_POSTWRITE;
 883                 }
 884                 bus_dmamap_sync(mpt->buffer_dmat, req->dmap, op);
 885                 bus_dmamap_unload(mpt->buffer_dmat, req->dmap);
 886         }
 887         ccb->csio.resid = 0;
 888
 889         if (mpt_reply == NULL) {
 890                 /* Context reply; report that the command was successfull */
 891                 ccb->ccb_h.status = CAM_REQ_CMP;
 892                 ccb->csio.scsi_status = SCSI_STATUS_OK;
 893                 ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
 894                 if (mpt->outofbeer) {
 895                         ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
 896                         mpt->outofbeer = 0;
 897                         if (mpt->verbose > 1) {
 898                                 device_printf(mpt->dev, "THAWQ\n");
 899                         }
 900                 }
 901                 MPTLOCK_2_CAMLOCK(mpt);
 902                 xpt_done(ccb);
 903                 CAMLOCK_2_MPTLOCK(mpt);
 904                 goto done;
 905         }
 906
 907         ccb->csio.scsi_status = mpt_reply->SCSIStatus;
 908         switch(mpt_reply->IOCStatus) {
 909         case MPI_IOCSTATUS_SCSI_DATA_OVERRUN:
 910                 ccb->ccb_h.status = CAM_DATA_RUN_ERR;
 911                 break;
 912
 913         case MPI_IOCSTATUS_SCSI_DATA_UNDERRUN:
 914                 /*
 915                  * Yikes, Tagged queue full comes through this path!
 916                  *
 917                  * So we'll change it to a status error and anything
 918                  * that returns status should probably be a status
 919                  * error as well.
 920                  */
 921                 ccb->csio.resid =
 922                     ccb->csio.dxfer_len - mpt_reply->TransferCount;
 923                 if (mpt_reply->SCSIState & MPI_SCSI_STATE_NO_SCSI_STATUS) {
 924                         ccb->ccb_h.status = CAM_DATA_RUN_ERR;
 925                         break;
 926                 }
 927 #if     0
 928 device_printf(mpt->dev, "underrun, scsi status is %x\n", ccb->csio.scsi_status);
 929                 ccb->csio.scsi_status = SCSI_STATUS_QUEUE_FULL;
 930 #endif
 931                 /* Fall through */
 932         case MPI_IOCSTATUS_SUCCESS:
 933         case MPI_IOCSTATUS_SCSI_RECOVERED_ERROR:
 934                 switch (ccb->csio.scsi_status) {
 935                 case SCSI_STATUS_OK:
 936                         ccb->ccb_h.status = CAM_REQ_CMP;
 937                         break;
 938                 default:
 939                         ccb->ccb_h.status = CAM_SCSI_STATUS_ERROR;
 940                         break;
 941                 }
 942                 break;
 943         case MPI_IOCSTATUS_BUSY:
 944         case MPI_IOCSTATUS_INSUFFICIENT_RESOURCES:
 945                 ccb->ccb_h.status = CAM_BUSY;
 946                 break;
 947
 948         case MPI_IOCSTATUS_SCSI_INVALID_BUS:
 949         case MPI_IOCSTATUS_SCSI_INVALID_TARGETID:
 950         case MPI_IOCSTATUS_SCSI_DEVICE_NOT_THERE:
 951                 ccb->ccb_h.status = CAM_DEV_NOT_THERE;
 952                 break;
 953
 954         case MPI_IOCSTATUS_SCSI_RESIDUAL_MISMATCH:
 955                 ccb->ccb_h.status = CAM_DATA_RUN_ERR;
 956                 break;
 957
 958         case MPI_IOCSTATUS_SCSI_PROTOCOL_ERROR:
 959         case MPI_IOCSTATUS_SCSI_IO_DATA_ERROR:
 960                 ccb->ccb_h.status =  CAM_UNCOR_PARITY;
 961                 break;
 962
 963         case MPI_IOCSTATUS_SCSI_TASK_TERMINATED:
 964                 ccb->ccb_h.status = CAM_REQ_CMP;
 965                 break;
 966
 967         case MPI_IOCSTATUS_SCSI_TASK_MGMT_FAILED:
 968                 ccb->ccb_h.status = CAM_UA_TERMIO;
 969                 break;
 970
 971         case MPI_IOCSTATUS_SCSI_IOC_TERMINATED:
 972                 ccb->ccb_h.status = CAM_REQ_TERMIO;
 973                 break;
 974
 975         case MPI_IOCSTATUS_SCSI_EXT_TERMINATED:
 976                 ccb->ccb_h.status = CAM_SCSI_BUS_RESET;
 977                 break;
 978
 979         default:
 980                 ccb->ccb_h.status = CAM_UNREC_HBA_ERROR;
 981                 break;
 982         }
 983
 984         if ((mpt_reply->SCSIState & MPI_SCSI_STATE_AUTOSENSE_VALID) != 0) {
 985                 if (ccb->ccb_h.flags & (CAM_SENSE_PHYS | CAM_SENSE_PTR)) {
 986                         ccb->ccb_h.status |= CAM_AUTOSENSE_FAIL;
 987                 } else {
 988                         ccb->ccb_h.status |= CAM_AUTOSNS_VALID;
 989                         ccb->csio.sense_resid = mpt_reply->SenseCount;
 990                         bcopy(req->sense_vbuf, &ccb->csio.sense_data,
 991                             ccb->csio.sense_len);
 992                 }
 993         } else if (mpt_reply->SCSIState & MPI_SCSI_STATE_AUTOSENSE_FAILED) {
 994                 ccb->ccb_h.status &= ~CAM_STATUS_MASK;
 995                 ccb->ccb_h.status |= CAM_AUTOSENSE_FAIL;
 996         }
 997
 998         if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
 999                 if ((ccb->ccb_h.status & CAM_DEV_QFRZN) == 0) {
1000                         ccb->ccb_h.status |= CAM_DEV_QFRZN;
1001                         xpt_freeze_devq(ccb->ccb_h.path, 1);
1002                 }
1003         }
1004
1005
1006         ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
1007         if (mpt->outofbeer) {
1008                 ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
1009                 mpt->outofbeer = 0;
1010                 if (mpt->verbose > 1) {
1011                         device_printf(mpt->dev, "THAWQ\n");
1012                 }
1013         }
1014         MPTLOCK_2_CAMLOCK(mpt);
1015         xpt_done(ccb);
1016         CAMLOCK_2_MPTLOCK(mpt);
1017
1018 done:
1019         /* If IOC done with this request free it up */
1020         if (mpt_reply == NULL || (mpt_reply->MsgFlags & 0x80) == 0)
1021                 mpt_free_request(mpt, req);
1022
1023         /* If address reply; give the buffer back to the IOC */
1024         if (mpt_reply != NULL)
1025                 mpt_free_reply(mpt, (reply << 1));
1026 }
1027
1028 static void
1029 mpt_action(struct cam_sim *sim, union ccb *ccb)
1030 {
1031         int  tgt, error;
1032         mpt_softc_t *mpt;
1033         struct ccb_trans_settings *cts;
1034
1035         CAM_DEBUG(ccb->ccb_h.path, CAM_DEBUG_TRACE, ("mpt_action\n"));
1036
1037         mpt = (mpt_softc_t *)cam_sim_softc(sim);
1038
1039         ccb->ccb_h.ccb_mpt_ptr = mpt;
1040
1041         switch (ccb->ccb_h.func_code) {
1042         case XPT_RESET_BUS:
1043                 if (mpt->verbose > 1)
1044                     device_printf(mpt->dev, "XPT_RESET_BUS\n");
1045                 CAMLOCK_2_MPTLOCK(mpt);
1046                 error = mpt_bus_reset(ccb);
1047                 switch (error) {
1048                 case CAM_REQ_INPROG:
1049                         MPTLOCK_2_CAMLOCK(mpt);
1050                         break;
1051                 case CAM_REQUEUE_REQ:
1052                         if (mpt->outofbeer == 0) {
1053                                 mpt->outofbeer = 1;
1054                                 xpt_freeze_simq(sim, 1);
1055                                 if (mpt->verbose > 1) {
1056                                         device_printf(mpt->dev, "FREEZEQ\n");
1057                                 }
1058                         }
1059                         ccb->ccb_h.status = CAM_REQUEUE_REQ;
1060                         MPTLOCK_2_CAMLOCK(mpt);
1061                         xpt_done(ccb);
1062                         break;
1063
1064                 case CAM_REQ_CMP:
1065                         ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
1066                         ccb->ccb_h.status |= CAM_REQ_CMP;
1067                         if (mpt->outofbeer) {
1068                                 ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
1069                                 mpt->outofbeer = 0;
1070                                 if (mpt->verbose > 1) {
1071                                         device_printf(mpt->dev, "THAWQ\n");
1072                                 }
1073                         }
1074                         MPTLOCK_2_CAMLOCK(mpt);
1075                         xpt_done(ccb);
1076                         break;
1077
1078                 default:
1079                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1080                         MPTLOCK_2_CAMLOCK(mpt);
1081                         xpt_done(ccb);
1082                 }
1083                 break;
1084
1085         case XPT_SCSI_IO:       /* Execute the requested I/O operation */
1086                 /*
1087                  * Do a couple of preliminary checks...
1088                  */
1089                 if ((ccb->ccb_h.flags & CAM_CDB_POINTER) != 0) {
1090                         if ((ccb->ccb_h.flags & CAM_CDB_PHYS) != 0) {
1091                                 ccb->ccb_h.status = CAM_REQ_INVALID;
1092                                 xpt_done(ccb);
1093                                 break;
1094                         }
1095                 }
1096                 /* Max supported CDB length is 16 bytes */
1097                 if (ccb->csio.cdb_len >
1098                     sizeof (((PTR_MSG_SCSI_IO_REQUEST)0)->CDB)) {
1099                         ccb->ccb_h.status = CAM_REQ_INVALID;
1100                         xpt_done(ccb);
1101                         return;
1102                 }
1103                 ccb->csio.scsi_status = SCSI_STATUS_OK;
1104                 mpt_start(ccb);
1105                 break;
1106
1107         case XPT_ABORT:
1108                 /*
1109                  * XXX: Need to implement
1110                  */
1111                 ccb->ccb_h.status = CAM_UA_ABORT;
1112                 xpt_done(ccb);
1113                 break;
1114
1115 #ifdef  CAM_NEW_TRAN_CODE
1116 #define IS_CURRENT_SETTINGS(c)  (c->type == CTS_TYPE_CURRENT_SETTINGS)
1117 #else
1118 #define IS_CURRENT_SETTINGS(c)  (c->flags & CCB_TRANS_CURRENT_SETTINGS)
1119 #endif
1120 #define DP_DISC_ENABLE  0x1
1121 #define DP_DISC_DISABL  0x2
1122 #define DP_DISC         (DP_DISC_ENABLE|DP_DISC_DISABL)
1123
1124 #define DP_TQING_ENABLE 0x4
1125 #define DP_TQING_DISABL 0x8
1126 #define DP_TQING        (DP_TQING_ENABLE|DP_TQING_DISABL)
1127
1128 #define DP_WIDE         0x10
1129 #define DP_NARROW       0x20
1130 #define DP_WIDTH        (DP_WIDE|DP_NARROW)
1131
1132 #define DP_SYNC         0x40
1133
1134         case XPT_SET_TRAN_SETTINGS:     /* Nexus Settings */
1135                 cts = &ccb->cts;
1136                 if (!IS_CURRENT_SETTINGS(cts)) {
1137                         ccb->ccb_h.status = CAM_REQ_INVALID;
1138                         xpt_done(ccb);
1139                         break;
1140                 }
1141                 tgt = cts->ccb_h.target_id;
1142                 if (mpt->is_fc == 0) {
1143                         u_int8_t dval = 0;
1144                         u_int period = 0, offset = 0;
1145 #ifndef CAM_NEW_TRAN_CODE
1146                         if (cts->valid & CCB_TRANS_DISC_VALID) {
1147                                 dval |= DP_DISC_ENABLE;
1148                         }
1149                         if (cts->valid & CCB_TRANS_TQ_VALID) {
1150                                 dval |= DP_TQING_ENABLE;
1151                         }
1152                         if (cts->valid & CCB_TRANS_BUS_WIDTH_VALID) {
1153                                 if (cts->bus_width)
1154                                         dval |= DP_WIDE;
1155                                 else
1156                                         dval |= DP_NARROW;
1157                         }
1158                         /*
1159                          * Any SYNC RATE of nonzero and SYNC_OFFSET
1160                          * of nonzero will cause us to go to the
1161                          * selected (from NVRAM) maximum value for
1162                          * this device. At a later point, we'll
1163                          * allow finer control.
1164                          */
1165                         if ((cts->valid & CCB_TRANS_SYNC_RATE_VALID) &&
1166                             (cts->valid & CCB_TRANS_SYNC_OFFSET_VALID)) {
1167                                 dval |= DP_SYNC;
1168                                 period = cts->sync_period;
1169                                 offset = cts->sync_offset;
1170                         }
1171 #else
1172                         struct ccb_trans_settings_scsi *scsi =
1173                             &cts->proto_specific.scsi;
1174                         struct ccb_trans_settings_spi *spi =
1175                             &cts->xport_specific.spi;
1176
1177                         if ((spi->valid & CTS_SPI_VALID_DISC) != 0) {
1178                                 if ((spi->flags & CTS_SPI_FLAGS_DISC_ENB) != 0)
1179                                         dval |= DP_DISC_ENABLE;
1180                                 else
1181                                         dval |= DP_DISC_DISABL;
1182                         }
1183
1184                         if ((scsi->valid & CTS_SCSI_VALID_TQ) != 0) {
1185                                 if ((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0)
1186                                         dval |= DP_TQING_ENABLE;
1187                                 else
1188                                         dval |= DP_TQING_DISABL;
1189                         }
1190
1191                         if ((spi->valid & CTS_SPI_VALID_BUS_WIDTH) != 0) {
1192                                 if (spi->bus_width == MSG_EXT_WDTR_BUS_16_BIT)
1193                                         dval |= DP_WIDE;
1194                                 else
1195                                         dval |= DP_NARROW;
1196                         }
1197
1198                         if ((spi->valid & CTS_SPI_VALID_SYNC_OFFSET) &&
1199                             (spi->valid & CTS_SPI_VALID_SYNC_RATE) &&
1200                             (spi->sync_period && spi->sync_offset)) {
1201                                 dval |= DP_SYNC;
1202                                 period = spi->sync_period;
1203                                 offset = spi->sync_offset;
1204                         }
1205 #endif
1206                         CAMLOCK_2_MPTLOCK(mpt);
1207                         if (dval & DP_DISC_ENABLE) {
1208                                 mpt->mpt_disc_enable |= (1 << tgt);
1209                         } else if (dval & DP_DISC_DISABL) {
1210                                 mpt->mpt_disc_enable &= ~(1 << tgt);
1211                         }
1212                         if (dval & DP_TQING_ENABLE) {
1213                                 mpt->mpt_tag_enable |= (1 << tgt);
1214                         } else if (dval & DP_TQING_DISABL) {
1215                                 mpt->mpt_tag_enable &= ~(1 << tgt);
1216                         }
1217                         if (dval & DP_WIDTH) {
1218                                 if (mpt_setwidth(mpt, tgt, dval & DP_WIDE)) {
1219                                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1220                                         MPTLOCK_2_CAMLOCK(mpt);
1221                                         xpt_done(ccb);
1222                                         break;
1223                                 }
1224                         }
1225                         if (dval & DP_SYNC) {
1226                                 if (mpt_setsync(mpt, tgt, period, offset)) {
1227                                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1228                                         MPTLOCK_2_CAMLOCK(mpt);
1229                                         xpt_done(ccb);
1230                                         break;
1231                                 }
1232                         }
1233                         MPTLOCK_2_CAMLOCK(mpt);
1234                         if (mpt->verbose > 1) {
1235                                 device_printf(mpt->dev,
1236                                     "SET tgt %d flags %x period %x off %x\n",
1237                                     tgt, dval, period, offset);
1238                         }
1239                 }
1240                 ccb->ccb_h.status = CAM_REQ_CMP;
1241                 xpt_done(ccb);
1242                 break;
1243
1244         case XPT_GET_TRAN_SETTINGS:
1245                 cts = &ccb->cts;
1246                 tgt = cts->ccb_h.target_id;
1247                 if (mpt->is_fc) {
1248 #ifndef CAM_NEW_TRAN_CODE
1249                         /*
1250                          * a lot of normal SCSI things don't make sense.
1251                          */
1252                         cts->flags = CCB_TRANS_TAG_ENB | CCB_TRANS_DISC_ENB;
1253                         cts->valid = CCB_TRANS_DISC_VALID | CCB_TRANS_TQ_VALID;
1254                         /*
1255                          * How do you measure the width of a high
1256                          * speed serial bus? Well, in bytes.
1257                          *
1258                          * Offset and period make no sense, though, so we set
1259                          * (above) a 'base' transfer speed to be gigabit.
1260                          */
1261                         cts->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
1262 #else
1263                         struct ccb_trans_settings_fc *fc =
1264                             &cts->xport_specific.fc;
1265
1266                         cts->protocol = PROTO_SCSI;
1267                         cts->protocol_version = SCSI_REV_2;
1268                         cts->transport = XPORT_FC;
1269                         cts->transport_version = 0;
1270
1271                         fc->valid = CTS_FC_VALID_SPEED;
1272                         fc->bitrate = 100000;   /* XXX: Need for 2Gb/s */
1273                         /* XXX: need a port database for each target */
1274 #endif
1275                 } else {
1276 #ifdef  CAM_NEW_TRAN_CODE
1277                         struct ccb_trans_settings_scsi *scsi =
1278                             &cts->proto_specific.scsi;
1279                         struct ccb_trans_settings_spi *spi =
1280                             &cts->xport_specific.spi;
1281 #endif
1282                         u_int8_t dval, pval, oval;
1283
1284                         /*
1285                          * We aren't going off of Port PAGE2 params for
1286                          * tagged queuing or disconnect capabilities
1287                          * for current settings. For goal settings,
1288                          * we assert all capabilities- we've had some
1289                          * problems with reading NVRAM data.
1290                          */
1291                         if (IS_CURRENT_SETTINGS(cts)) {
1292                                 fCONFIG_PAGE_SCSI_DEVICE_0 tmp;
1293                                 dval = 0;
1294
1295                                 tmp = mpt->mpt_dev_page0[tgt];
1296                                 CAMLOCK_2_MPTLOCK(mpt);
1297                                 if (mpt_read_cfg_page(mpt, tgt, &tmp.Header)) {
1298                                         device_printf(mpt->dev,
1299                                             "cannot get target %d DP0\n", tgt);
1300                                 } else  {
1301                                         if (mpt->verbose > 1) {
1302                                                 device_printf(mpt->dev,
1303                             "SPI Tgt %d Page 0: NParms %x Information %x\n",
1304                                                     tgt,
1305                                                     tmp.NegotiatedParameters,
1306                                                     tmp.Information);
1307                                         }
1308                                 }
1309                                 MPTLOCK_2_CAMLOCK(mpt);
1310
1311                                 if (tmp.NegotiatedParameters &
1312                                     MPI_SCSIDEVPAGE0_NP_WIDE)
1313                                         dval |= DP_WIDE;
1314
1315                                 if (mpt->mpt_disc_enable & (1 << tgt)) {
1316                                         dval |= DP_DISC_ENABLE;
1317                                 }
1318                                 if (mpt->mpt_tag_enable & (1 << tgt)) {
1319                                         dval |= DP_TQING_ENABLE;
1320                                 }
1321                                 oval = (tmp.NegotiatedParameters >> 16) & 0xff;
1322                                 pval = (tmp.NegotiatedParameters >>  8) & 0xff;
1323                         } else {
1324                                 /*
1325                                  * XXX: Fix wrt NVRAM someday. Attempts
1326                                  * XXX: to read port page2 device data
1327                                  * XXX: just returns zero in these areas.
1328                                  */
1329                                 dval = DP_WIDE|DP_DISC|DP_TQING;
1330                                 oval = (mpt->mpt_port_page0.Capabilities >> 16);
1331                                 pval = (mpt->mpt_port_page0.Capabilities >>  8);
1332                         }
1333 #ifndef CAM_NEW_TRAN_CODE
1334                         cts->flags &= ~(CCB_TRANS_DISC_ENB|CCB_TRANS_TAG_ENB);
1335                         if (dval & DP_DISC_ENABLE) {
1336                                 cts->flags |= CCB_TRANS_DISC_ENB;
1337                         }
1338                         if (dval & DP_TQING_ENABLE) {
1339                                 cts->flags |= CCB_TRANS_TAG_ENB;
1340                         }
1341                         if (dval & DP_WIDE) {
1342                                 cts->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
1343                         } else {
1344                                 cts->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
1345                         }
1346                         cts->valid = CCB_TRANS_BUS_WIDTH_VALID |
1347                             CCB_TRANS_DISC_VALID | CCB_TRANS_TQ_VALID;
1348                         if (oval) {
1349                                 cts->sync_period = pval;
1350                                 cts->sync_offset = oval;
1351                                 cts->valid |=
1352                                     CCB_TRANS_SYNC_RATE_VALID |
1353                                     CCB_TRANS_SYNC_OFFSET_VALID;
1354                         }
1355 #else
1356                         cts->protocol = PROTO_SCSI;
1357                         cts->protocol_version = SCSI_REV_2;
1358                         cts->transport = XPORT_SPI;
1359                         cts->transport_version = 2;
1360
1361                         scsi->flags &= ~CTS_SCSI_FLAGS_TAG_ENB;
1362                         spi->flags &= ~CTS_SPI_FLAGS_DISC_ENB;
1363                         if (dval & DP_DISC_ENABLE) {
1364                                 spi->flags |= CTS_SPI_FLAGS_DISC_ENB;
1365                         }
1366                         if (dval & DP_TQING_ENABLE) {
1367                                 scsi->flags |= CTS_SCSI_FLAGS_TAG_ENB;
1368                         }
1369                         if (oval && pval) {
1370                                 spi->sync_offset = oval;
1371                                 spi->sync_period = pval;
1372                                 spi->valid |= CTS_SPI_VALID_SYNC_OFFSET;
1373                                 spi->valid |= CTS_SPI_VALID_SYNC_RATE;
1374                         }
1375                         spi->valid |= CTS_SPI_VALID_BUS_WIDTH;
1376                         if (dval & DP_WIDE) {
1377                                 spi->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
1378                         } else {
1379                                 spi->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
1380                         }
1381                         if (cts->ccb_h.target_lun != CAM_LUN_WILDCARD) {
1382                                 scsi->valid = CTS_SCSI_VALID_TQ;
1383                                 spi->valid |= CTS_SPI_VALID_DISC;
1384                         } else {
1385                                 scsi->valid = 0;
1386                         }
1387 #endif
1388                         if (mpt->verbose > 1) {
1389                                 device_printf(mpt->dev,
1390                                     "GET %s tgt %d flags %x period %x off %x\n",
1391                                     IS_CURRENT_SETTINGS(cts)? "ACTIVE" :
1392                                     "NVRAM", tgt, dval, pval, oval);
1393                         }
1394                 }
1395                 ccb->ccb_h.status = CAM_REQ_CMP;
1396                 xpt_done(ccb);
1397                 break;
1398
1399         case XPT_CALC_GEOMETRY:
1400         {
1401                 struct ccb_calc_geometry *ccg;
1402                 u_int32_t secs_per_cylinder;
1403                 u_int32_t size_mb;
1404
1405                 ccg = &ccb->ccg;
1406                 if (ccg->block_size == 0) {
1407                         ccb->ccb_h.status = CAM_REQ_INVALID;
1408                         xpt_done(ccb);
1409                         break;
1410                 }
1411
1412                 size_mb = ccg->volume_size /((1024L * 1024L) / ccg->block_size);
1413                 if (size_mb > 1024) {
1414                         ccg->heads = 255;
1415                         ccg->secs_per_track = 63;
1416                 } else {
1417                         ccg->heads = 64;
1418                         ccg->secs_per_track = 32;
1419                 }
1420                 secs_per_cylinder = ccg->heads * ccg->secs_per_track;
1421                 ccg->cylinders = ccg->volume_size / secs_per_cylinder;
1422                 ccb->ccb_h.status = CAM_REQ_CMP;
1423                 xpt_done(ccb);
1424                 break;
1425         }
1426         case XPT_PATH_INQ:              /* Path routing inquiry */
1427         {
1428                 struct ccb_pathinq *cpi = &ccb->cpi;
1429
1430                 cpi->version_num = 1;
1431                 cpi->target_sprt = 0;
1432                 cpi->hba_eng_cnt = 0;
1433                 cpi->max_lun = 7;
1434                 cpi->bus_id = cam_sim_bus(sim);
1435                 if (mpt->is_fc) {
1436                         cpi->max_target = 255;
1437                         cpi->hba_misc = PIM_NOBUSRESET;
1438                         cpi->initiator_id = cpi->max_target + 1;
1439                         cpi->base_transfer_speed = 100000;
1440                         cpi->hba_inquiry = PI_TAG_ABLE;
1441                 } else {
1442                         cpi->initiator_id = mpt->mpt_ini_id;
1443                         cpi->base_transfer_speed = 3300;
1444                         cpi->hba_inquiry = PI_SDTR_ABLE|PI_TAG_ABLE|PI_WIDE_16;
1445                         cpi->hba_misc = 0;
1446                         cpi->max_target = 15;
1447                 }
1448
1449                 strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
1450                 strncpy(cpi->hba_vid, "LSI", HBA_IDLEN);
1451                 strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
1452                 cpi->unit_number = cam_sim_unit(sim);
1453                 cpi->ccb_h.status = CAM_REQ_CMP;
1454                 xpt_done(ccb);
1455                 break;
1456         }
1457         default:
1458                 ccb->ccb_h.status = CAM_REQ_INVALID;
1459                 xpt_done(ccb);
1460                 break;
1461         }
1462 }
1463
1464 static int
1465 mpt_setwidth(mpt_softc_t *mpt, int tgt, int onoff)
1466 {
1467         fCONFIG_PAGE_SCSI_DEVICE_1 tmp;
1468         tmp = mpt->mpt_dev_page1[tgt];
1469         if (onoff) {
1470                 tmp.RequestedParameters |= MPI_SCSIDEVPAGE1_RP_WIDE;
1471         } else {
1472                 tmp.RequestedParameters &= ~MPI_SCSIDEVPAGE1_RP_WIDE;
1473         }
1474         if (mpt_write_cfg_page(mpt, tgt, &tmp.Header)) {
1475                 return (-1);
1476         }
1477         if (mpt_read_cfg_page(mpt, tgt, &tmp.Header)) {
1478                 return (-1);
1479         }
1480         mpt->mpt_dev_page1[tgt] = tmp;
1481         if (mpt->verbose > 1) {
1482                 device_printf(mpt->dev,
1483                     "SPI Target %d Page 1: RequestedParameters %x Config %x\n",
1484                     tgt, mpt->mpt_dev_page1[tgt].RequestedParameters,
1485                     mpt->mpt_dev_page1[tgt].Configuration);
1486         }
1487         return (0);
1488 }
1489
1490 static int
1491 mpt_setsync(mpt_softc_t *mpt, int tgt, int period, int offset)
1492 {
1493         fCONFIG_PAGE_SCSI_DEVICE_1 tmp;
1494         tmp = mpt->mpt_dev_page1[tgt];
1495         tmp.RequestedParameters &=
1496             ~MPI_SCSIDEVPAGE1_RP_MIN_SYNC_PERIOD_MASK;
1497         tmp.RequestedParameters &=
1498             ~MPI_SCSIDEVPAGE1_RP_MAX_SYNC_OFFSET_MASK;
1499         tmp.RequestedParameters &=
1500             ~MPI_SCSIDEVPAGE1_RP_DT;
1501         tmp.RequestedParameters &=
1502             ~MPI_SCSIDEVPAGE1_RP_QAS;
1503         tmp.RequestedParameters &=
1504             ~MPI_SCSIDEVPAGE1_RP_IU;
1505         /*
1506          * XXX: For now, we're ignoring specific settings
1507          */
1508         if (period && offset) {
1509                 int factor, offset, np;
1510                 factor = (mpt->mpt_port_page0.Capabilities >> 8) & 0xff;
1511                 offset = (mpt->mpt_port_page0.Capabilities >> 16) & 0xff;
1512                 np = 0;
1513                 if (factor < 0x9) {
1514                         np |= MPI_SCSIDEVPAGE1_RP_QAS;
1515                         np |= MPI_SCSIDEVPAGE1_RP_IU;
1516                 }
1517                 if (factor < 0xa) {
1518                         np |= MPI_SCSIDEVPAGE1_RP_DT;
1519                 }
1520                 np |= (factor << 8) | (offset << 16);
1521                 tmp.RequestedParameters |= np;
1522         }
1523         if (mpt_write_cfg_page(mpt, tgt, &tmp.Header)) {
1524                 return (-1);
1525         }
1526         if (mpt_read_cfg_page(mpt, tgt, &tmp.Header)) {
1527                 return (-1);
1528         }
1529         mpt->mpt_dev_page1[tgt] = tmp;
1530         if (mpt->verbose > 1) {
1531                 device_printf(mpt->dev,
1532                     "SPI Target %d Page 1: RParams %x Config %x\n",
1533                     tgt, mpt->mpt_dev_page1[tgt].RequestedParameters,
1534                     mpt->mpt_dev_page1[tgt].Configuration);
1535         }
1536         return (0);
1537 }