sys/dev/isp/isp_freebsd.c

   1 /*-
   2  * Copyright (c) 1997-2009 by Matthew Jacob
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice immediately at the beginning of the file, without modification,
  10  *    this list of conditions, and the following disclaimer.
  11  * 2. The name of the author may not be used to endorse or promote products
  12  *    derived from this software without specific prior written permission.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
  18  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  */
  26
  27 /*
  28  * Platform (FreeBSD) dependent common attachment code for Qlogic adapters.
  29  */
  30 #include <sys/cdefs.h>
  31 __FBSDID("$FreeBSD$");
  32
  33 #include <dev/isp/isp_freebsd.h>
  34 #include <sys/unistd.h>
  35 #include <sys/kthread.h>
  36 #include <sys/conf.h>
  37 #include <sys/module.h>
  38 #include <sys/ioccom.h>
  39 #include <dev/isp/isp_ioctl.h>
  40 #include <sys/devicestat.h>
  41 #include <cam/cam_periph.h>
  42 #include <cam/cam_xpt_periph.h>
  43
  44 MODULE_VERSION(isp, 1);
  45 MODULE_DEPEND(isp, cam, 1, 1, 1);
  46 int isp_announced = 0;
  47 int isp_loop_down_limit = 60;   /* default loop down limit */
  48 int isp_quickboot_time = 7;     /* don't wait more than N secs for loop up */
  49 int isp_gone_device_time = 30;  /* grace time before reporting device lost */
  50 static const char prom3[] = "Chan %d [%u] PortID 0x%06x Departed because of %s";
  51
  52 static void isp_freeze_loopdown(ispsoftc_t *, int);
  53 static void isp_loop_changed(ispsoftc_t *isp, int chan);
  54 static d_ioctl_t ispioctl;
  55 static void isp_cam_async(void *, uint32_t, struct cam_path *, void *);
  56 static void isp_poll(struct cam_sim *);
  57 static timeout_t isp_watchdog;
  58 static timeout_t isp_gdt;
  59 static task_fn_t isp_gdt_task;
  60 static void isp_kthread(void *);
  61 static void isp_action(struct cam_sim *, union ccb *);
  62 static int isp_timer_count;
  63 static void isp_timer(void *);
  64
  65 static struct cdevsw isp_cdevsw = {
  66         .d_version =    D_VERSION,
  67         .d_ioctl =      ispioctl,
  68         .d_name =       "isp",
  69 };
  70
  71 static int
  72 isp_role_sysctl(SYSCTL_HANDLER_ARGS)
  73 {
  74         ispsoftc_t *isp = (ispsoftc_t *)arg1;
  75         int chan = arg2;
  76         int error, old, value;
  77
  78         value = FCPARAM(isp, chan)->role;
  79
  80         error = sysctl_handle_int(oidp, &value, 0, req);
  81         if ((error != 0) || (req->newptr == NULL))
  82                 return (error);
  83
  84         if (value < ISP_ROLE_NONE || value > ISP_ROLE_BOTH)
  85                 return (EINVAL);
  86
  87         ISP_LOCK(isp);
  88         old = FCPARAM(isp, chan)->role;
  89
  90         /* We don't allow target mode switch from here. */
  91         value = (old & ISP_ROLE_TARGET) | (value & ISP_ROLE_INITIATOR);
  92
  93         /* If nothing has changed -- we are done. */
  94         if (value == old) {
  95                 ISP_UNLOCK(isp);
  96                 return (0);
  97         }
  98
  99         /* Actually change the role. */
 100         error = isp_control(isp, ISPCTL_CHANGE_ROLE, chan, value);
 101         ISP_UNLOCK(isp);
 102         return (error);
 103 }
 104
 105 static int
 106 isp_attach_chan(ispsoftc_t *isp, struct cam_devq *devq, int chan)
 107 {
 108         struct ccb_setasync csa;
 109         struct cam_sim *sim;
 110         struct cam_path *path;
 111 #ifdef  ISP_TARGET_MODE
 112         int i;
 113 #endif
 114
 115         sim = cam_sim_alloc(isp_action, isp_poll, "isp", isp,
 116             device_get_unit(isp->isp_dev), &isp->isp_lock,
 117             isp->isp_maxcmds, isp->isp_maxcmds, devq);
 118         if (sim == NULL)
 119                 return (ENOMEM);
 120
 121         ISP_LOCK(isp);
 122         if (xpt_bus_register(sim, isp->isp_dev, chan) != CAM_SUCCESS) {
 123                 ISP_UNLOCK(isp);
 124                 cam_sim_free(sim, FALSE);
 125                 return (EIO);
 126         }
 127         ISP_UNLOCK(isp);
 128         if (xpt_create_path(&path, NULL, cam_sim_path(sim), CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
 129                 ISP_LOCK(isp);
 130                 xpt_bus_deregister(cam_sim_path(sim));
 131                 ISP_UNLOCK(isp);
 132                 cam_sim_free(sim, FALSE);
 133                 return (ENXIO);
 134         }
 135         xpt_setup_ccb(&csa.ccb_h, path, 5);
 136         csa.ccb_h.func_code = XPT_SASYNC_CB;
 137         csa.event_enable = AC_LOST_DEVICE;
 138         csa.callback = isp_cam_async;
 139         csa.callback_arg = sim;
 140
 141         ISP_LOCK(isp);
 142         xpt_action((union ccb *)&csa);
 143         ISP_UNLOCK(isp);
 144
 145         if (IS_SCSI(isp)) {
 146                 struct isp_spi *spi = ISP_SPI_PC(isp, chan);
 147                 spi->sim = sim;
 148                 spi->path = path;
 149 #ifdef  ISP_TARGET_MODE
 150                 TAILQ_INIT(&spi->waitq);
 151                 STAILQ_INIT(&spi->ntfree);
 152                 for (i = 0; i < ATPDPSIZE; i++)
 153                         STAILQ_INSERT_TAIL(&spi->ntfree, &spi->ntpool[i], next);
 154                 LIST_INIT(&spi->atfree);
 155                 for (i = ATPDPSIZE-1; i >= 0; i--)
 156                         LIST_INSERT_HEAD(&spi->atfree, &spi->atpool[i], next);
 157                 for (i = 0; i < ATPDPHASHSIZE; i++)
 158                         LIST_INIT(&spi->atused[i]);
 159 #endif
 160         } else {
 161                 fcparam *fcp = FCPARAM(isp, chan);
 162                 struct isp_fc *fc = ISP_FC_PC(isp, chan);
 163                 struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(isp->isp_osinfo.dev);
 164                 struct sysctl_oid *tree = device_get_sysctl_tree(isp->isp_osinfo.dev);
 165                 char name[16];
 166
 167                 ISP_LOCK(isp);
 168                 fc->sim = sim;
 169                 fc->path = path;
 170                 fc->isp = isp;
 171                 fc->ready = 1;
 172
 173                 callout_init_mtx(&fc->gdt, &isp->isp_lock, 0);
 174                 TASK_INIT(&fc->gtask, 1, isp_gdt_task, fc);
 175 #ifdef  ISP_TARGET_MODE
 176                 TAILQ_INIT(&fc->waitq);
 177                 STAILQ_INIT(&fc->ntfree);
 178                 for (i = 0; i < ATPDPSIZE; i++)
 179                         STAILQ_INSERT_TAIL(&fc->ntfree, &fc->ntpool[i], next);
 180                 LIST_INIT(&fc->atfree);
 181                 for (i = ATPDPSIZE-1; i >= 0; i--)
 182                         LIST_INSERT_HEAD(&fc->atfree, &fc->atpool[i], next);
 183                 for (i = 0; i < ATPDPHASHSIZE; i++)
 184                         LIST_INIT(&fc->atused[i]);
 185 #endif
 186                 isp_loop_changed(isp, chan);
 187                 ISP_UNLOCK(isp);
 188                 if (kproc_create(isp_kthread, fc, &fc->kproc, 0, 0,
 189                     "%s_%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
 190                         xpt_free_path(fc->path);
 191                         ISP_LOCK(isp);
 192                         xpt_bus_deregister(cam_sim_path(fc->sim));
 193                         ISP_UNLOCK(isp);
 194                         cam_sim_free(fc->sim, FALSE);
 195                         return (ENOMEM);
 196                 }
 197                 fc->num_threads += 1;
 198                 if (chan > 0) {
 199                         snprintf(name, sizeof(name), "chan%d", chan);
 200                         tree = SYSCTL_ADD_NODE(ctx, SYSCTL_CHILDREN(tree),
 201                             OID_AUTO, name, CTLFLAG_RW, 0, "Virtual channel");
 202                 }
 203                 SYSCTL_ADD_QUAD(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 204                     "wwnn", CTLFLAG_RD, &fcp->isp_wwnn,
 205                     "World Wide Node Name");
 206                 SYSCTL_ADD_QUAD(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 207                     "wwpn", CTLFLAG_RD, &fcp->isp_wwpn,
 208                     "World Wide Port Name");
 209                 SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 210                     "loop_down_limit", CTLFLAG_RW, &fc->loop_down_limit, 0,
 211                     "Loop Down Limit");
 212                 SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 213                     "gone_device_time", CTLFLAG_RW, &fc->gone_device_time, 0,
 214                     "Gone Device Time");
 215 #if defined(ISP_TARGET_MODE) && defined(DEBUG)
 216                 SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 217                     "inject_lost_data_frame", CTLFLAG_RW, &fc->inject_lost_data_frame, 0,
 218                     "Cause a Lost Frame on a Read");
 219 #endif
 220                 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 221                     "role", CTLTYPE_INT | CTLFLAG_RW, isp, chan,
 222                     isp_role_sysctl, "I", "Current role");
 223                 SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 224                     "speed", CTLFLAG_RD, &fcp->isp_gbspeed, 0,
 225                     "Connection speed in gigabits");
 226                 SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 227                     "linkstate", CTLFLAG_RD, &fcp->isp_linkstate, 0,
 228                     "Link state");
 229                 SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 230                     "fwstate", CTLFLAG_RD, &fcp->isp_fwstate, 0,
 231                     "Firmware state");
 232                 SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 233                     "loopstate", CTLFLAG_RD, &fcp->isp_loopstate, 0,
 234                     "Loop state");
 235                 SYSCTL_ADD_UINT(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
 236                     "topo", CTLFLAG_RD, &fcp->isp_topo, 0,
 237                     "Connection topology");
 238         }
 239         return (0);
 240 }
 241
 242 static void
 243 isp_detach_chan(ispsoftc_t *isp, int chan)
 244 {
 245         struct cam_sim *sim;
 246         struct cam_path *path;
 247         struct ccb_setasync csa;
 248         int *num_threads;
 249
 250         ISP_GET_PC(isp, chan, sim, sim);
 251         ISP_GET_PC(isp, chan, path, path);
 252         ISP_GET_PC_ADDR(isp, chan, num_threads, num_threads);
 253
 254         xpt_setup_ccb(&csa.ccb_h, path, 5);
 255         csa.ccb_h.func_code = XPT_SASYNC_CB;
 256         csa.event_enable = 0;
 257         csa.callback = isp_cam_async;
 258         csa.callback_arg = sim;
 259         xpt_action((union ccb *)&csa);
 260         xpt_free_path(path);
 261         xpt_bus_deregister(cam_sim_path(sim));
 262         cam_sim_free(sim, FALSE);
 263
 264         /* Wait for the channel's spawned threads to exit. */
 265         wakeup(isp->isp_osinfo.pc.ptr);
 266         while (*num_threads != 0)
 267                 mtx_sleep(isp, &isp->isp_lock, PRIBIO, "isp_reap", 100);
 268 }
 269
 270 int
 271 isp_attach(ispsoftc_t *isp)
 272 {
 273         const char *nu = device_get_nameunit(isp->isp_osinfo.dev);
 274         int du = device_get_unit(isp->isp_dev);
 275         int chan;
 276
 277         /*
 278          * Create the device queue for our SIM(s).
 279          */
 280         isp->isp_osinfo.devq = cam_simq_alloc(isp->isp_maxcmds);
 281         if (isp->isp_osinfo.devq == NULL) {
 282                 return (EIO);
 283         }
 284
 285         for (chan = 0; chan < isp->isp_nchan; chan++) {
 286                 if (isp_attach_chan(isp, isp->isp_osinfo.devq, chan)) {
 287                         goto unwind;
 288                 }
 289         }
 290
 291         callout_init_mtx(&isp->isp_osinfo.tmo, &isp->isp_lock, 0);
 292         isp_timer_count = hz >> 2;
 293         callout_reset(&isp->isp_osinfo.tmo, isp_timer_count, isp_timer, isp);
 294
 295         isp->isp_osinfo.cdev = make_dev(&isp_cdevsw, du, UID_ROOT, GID_OPERATOR, 0600, "%s", nu);
 296         if (isp->isp_osinfo.cdev) {
 297                 isp->isp_osinfo.cdev->si_drv1 = isp;
 298         }
 299         return (0);
 300
 301 unwind:
 302         while (--chan >= 0) {
 303                 struct cam_sim *sim;
 304                 struct cam_path *path;
 305
 306                 ISP_GET_PC(isp, chan, sim, sim);
 307                 ISP_GET_PC(isp, chan, path, path);
 308                 xpt_free_path(path);
 309                 ISP_LOCK(isp);
 310                 xpt_bus_deregister(cam_sim_path(sim));
 311                 ISP_UNLOCK(isp);
 312                 cam_sim_free(sim, FALSE);
 313         }
 314         cam_simq_free(isp->isp_osinfo.devq);
 315         isp->isp_osinfo.devq = NULL;
 316         return (-1);
 317 }
 318
 319 int
 320 isp_detach(ispsoftc_t *isp)
 321 {
 322         int chan;
 323
 324         if (isp->isp_osinfo.cdev) {
 325                 destroy_dev(isp->isp_osinfo.cdev);
 326                 isp->isp_osinfo.cdev = NULL;
 327         }
 328         ISP_LOCK(isp);
 329         /* Tell spawned threads that we're exiting. */
 330         isp->isp_osinfo.is_exiting = 1;
 331         for (chan = isp->isp_nchan - 1; chan >= 0; chan -= 1)
 332                 isp_detach_chan(isp, chan);
 333         ISP_UNLOCK(isp);
 334         callout_drain(&isp->isp_osinfo.tmo);
 335         cam_simq_free(isp->isp_osinfo.devq);
 336         return (0);
 337 }
 338
 339 static void
 340 isp_freeze_loopdown(ispsoftc_t *isp, int chan)
 341 {
 342         struct isp_fc *fc = ISP_FC_PC(isp, chan);
 343
 344         if (fc->sim == NULL)
 345                 return;
 346         if (fc->simqfrozen == 0) {
 347                 isp_prt(isp, ISP_LOGDEBUG0,
 348                     "Chan %d Freeze simq (loopdown)", chan);
 349                 fc->simqfrozen = SIMQFRZ_LOOPDOWN;
 350                 xpt_hold_boot();
 351                 xpt_freeze_simq(fc->sim, 1);
 352         } else {
 353                 isp_prt(isp, ISP_LOGDEBUG0,
 354                     "Chan %d Mark simq frozen (loopdown)", chan);
 355                 fc->simqfrozen |= SIMQFRZ_LOOPDOWN;
 356         }
 357 }
 358
 359 static void
 360 isp_unfreeze_loopdown(ispsoftc_t *isp, int chan)
 361 {
 362         struct isp_fc *fc = ISP_FC_PC(isp, chan);
 363
 364         if (fc->sim == NULL)
 365                 return;
 366         int wasfrozen = fc->simqfrozen & SIMQFRZ_LOOPDOWN;
 367         fc->simqfrozen &= ~SIMQFRZ_LOOPDOWN;
 368         if (wasfrozen && fc->simqfrozen == 0) {
 369                 isp_prt(isp, ISP_LOGDEBUG0,
 370                     "Chan %d Release simq", chan);
 371                 xpt_release_simq(fc->sim, 1);
 372                 xpt_release_boot();
 373         }
 374 }
 375
 376 static int
 377 ispioctl(struct cdev *dev, u_long c, caddr_t addr, int flags, struct thread *td)
 378 {
 379         ispsoftc_t *isp;
 380         int nr, chan, retval = ENOTTY;
 381
 382         isp = dev->si_drv1;
 383
 384         switch (c) {
 385         case ISP_SDBLEV:
 386         {
 387                 int olddblev = isp->isp_dblev;
 388                 isp->isp_dblev = *(int *)addr;
 389                 *(int *)addr = olddblev;
 390                 retval = 0;
 391                 break;
 392         }
 393         case ISP_GETROLE:
 394                 chan = *(int *)addr;
 395                 if (chan < 0 || chan >= isp->isp_nchan) {
 396                         retval = -ENXIO;
 397                         break;
 398                 }
 399                 if (IS_FC(isp)) {
 400                         *(int *)addr = FCPARAM(isp, chan)->role;
 401                 } else {
 402                         *(int *)addr = ISP_ROLE_INITIATOR;
 403                 }
 404                 retval = 0;
 405                 break;
 406         case ISP_SETROLE:
 407                 if (IS_SCSI(isp))
 408                         break;
 409                 nr = *(int *)addr;
 410                 chan = nr >> 8;
 411                 if (chan < 0 || chan >= isp->isp_nchan) {
 412                         retval = -ENXIO;
 413                         break;
 414                 }
 415                 nr &= 0xff;
 416                 if (nr & ~(ISP_ROLE_INITIATOR|ISP_ROLE_TARGET)) {
 417                         retval = EINVAL;
 418                         break;
 419                 }
 420                 ISP_LOCK(isp);
 421                 *(int *)addr = FCPARAM(isp, chan)->role;
 422                 retval = isp_control(isp, ISPCTL_CHANGE_ROLE, chan, nr);
 423                 ISP_UNLOCK(isp);
 424                 retval = 0;
 425                 break;
 426
 427         case ISP_RESETHBA:
 428                 ISP_LOCK(isp);
 429                 isp_reinit(isp, 0);
 430                 ISP_UNLOCK(isp);
 431                 retval = 0;
 432                 break;
 433
 434         case ISP_RESCAN:
 435                 if (IS_FC(isp)) {
 436                         chan = *(int *)addr;
 437                         if (chan < 0 || chan >= isp->isp_nchan) {
 438                                 retval = -ENXIO;
 439                                 break;
 440                         }
 441                         ISP_LOCK(isp);
 442                         if (isp_fc_runstate(isp, chan, 5 * 1000000) != LOOP_READY) {
 443                                 retval = EIO;
 444                         } else {
 445                                 retval = 0;
 446                         }
 447                         ISP_UNLOCK(isp);
 448                 }
 449                 break;
 450
 451         case ISP_FC_LIP:
 452                 if (IS_FC(isp)) {
 453                         chan = *(int *)addr;
 454                         if (chan < 0 || chan >= isp->isp_nchan) {
 455                                 retval = -ENXIO;
 456                                 break;
 457                         }
 458                         ISP_LOCK(isp);
 459                         if (isp_control(isp, ISPCTL_SEND_LIP, chan)) {
 460                                 retval = EIO;
 461                         } else {
 462                                 retval = 0;
 463                         }
 464                         ISP_UNLOCK(isp);
 465                 }
 466                 break;
 467         case ISP_FC_GETDINFO:
 468         {
 469                 struct isp_fc_device *ifc = (struct isp_fc_device *) addr;
 470                 fcportdb_t *lp;
 471
 472                 if (IS_SCSI(isp)) {
 473                         break;
 474                 }
 475                 if (ifc->loopid >= MAX_FC_TARG) {
 476                         retval = EINVAL;
 477                         break;
 478                 }
 479                 lp = &FCPARAM(isp, ifc->chan)->portdb[ifc->loopid];
 480                 if (lp->state != FC_PORTDB_STATE_NIL) {
 481                         ifc->role = (lp->prli_word3 & SVC3_ROLE_MASK) >> SVC3_ROLE_SHIFT;
 482                         ifc->loopid = lp->handle;
 483                         ifc->portid = lp->portid;
 484                         ifc->node_wwn = lp->node_wwn;
 485                         ifc->port_wwn = lp->port_wwn;
 486                         retval = 0;
 487                 } else {
 488                         retval = ENODEV;
 489                 }
 490                 break;
 491         }
 492         case ISP_FC_GETHINFO:
 493         {
 494                 struct isp_hba_device *hba = (struct isp_hba_device *) addr;
 495                 int chan = hba->fc_channel;
 496
 497                 if (chan < 0 || chan >= isp->isp_nchan) {
 498                         retval = ENXIO;
 499                         break;
 500                 }
 501                 hba->fc_fw_major = ISP_FW_MAJORX(isp->isp_fwrev);
 502                 hba->fc_fw_minor = ISP_FW_MINORX(isp->isp_fwrev);
 503                 hba->fc_fw_micro = ISP_FW_MICROX(isp->isp_fwrev);
 504                 hba->fc_nchannels = isp->isp_nchan;
 505                 if (IS_FC(isp)) {
 506                         hba->fc_nports = MAX_FC_TARG;
 507                         hba->fc_speed = FCPARAM(isp, hba->fc_channel)->isp_gbspeed;
 508                         hba->fc_topology = FCPARAM(isp, chan)->isp_topo + 1;
 509                         hba->fc_loopid = FCPARAM(isp, chan)->isp_loopid;
 510                         hba->nvram_node_wwn = FCPARAM(isp, chan)->isp_wwnn_nvram;
 511                         hba->nvram_port_wwn = FCPARAM(isp, chan)->isp_wwpn_nvram;
 512                         hba->active_node_wwn = FCPARAM(isp, chan)->isp_wwnn;
 513                         hba->active_port_wwn = FCPARAM(isp, chan)->isp_wwpn;
 514                 } else {
 515                         hba->fc_nports = MAX_TARGETS;
 516                         hba->fc_speed = 0;
 517                         hba->fc_topology = 0;
 518                         hba->nvram_node_wwn = 0ull;
 519                         hba->nvram_port_wwn = 0ull;
 520                         hba->active_node_wwn = 0ull;
 521                         hba->active_port_wwn = 0ull;
 522                 }
 523                 retval = 0;
 524                 break;
 525         }
 526         case ISP_TSK_MGMT:
 527         {
 528                 int needmarker;
 529                 struct isp_fc_tsk_mgmt *fct = (struct isp_fc_tsk_mgmt *) addr;
 530                 uint16_t nphdl;
 531                 mbreg_t mbs;
 532
 533                 if (IS_SCSI(isp)) {
 534                         break;
 535                 }
 536
 537                 chan = fct->chan;
 538                 if (chan < 0 || chan >= isp->isp_nchan) {
 539                         retval = -ENXIO;
 540                         break;
 541                 }
 542
 543                 needmarker = retval = 0;
 544                 nphdl = fct->loopid;
 545                 ISP_LOCK(isp);
 546                 if (IS_24XX(isp)) {
 547                         void *reqp;
 548                         uint8_t resp[QENTRY_LEN];
 549                         isp24xx_tmf_t tmf;
 550                         isp24xx_statusreq_t sp;
 551                         fcparam *fcp = FCPARAM(isp, chan);
 552                         fcportdb_t *lp;
 553                         int i;
 554
 555                         for (i = 0; i < MAX_FC_TARG; i++) {
 556                                 lp = &fcp->portdb[i];
 557                                 if (lp->handle == nphdl) {
 558                                         break;
 559                                 }
 560                         }
 561                         if (i == MAX_FC_TARG) {
 562                                 retval = ENXIO;
 563                                 ISP_UNLOCK(isp);
 564                                 break;
 565                         }
 566                         ISP_MEMZERO(&tmf, sizeof(tmf));
 567                         tmf.tmf_header.rqs_entry_type = RQSTYPE_TSK_MGMT;
 568                         tmf.tmf_header.rqs_entry_count = 1;
 569                         tmf.tmf_nphdl = lp->handle;
 570                         tmf.tmf_delay = 2;
 571                         tmf.tmf_timeout = 4;
 572                         tmf.tmf_tidlo = lp->portid;
 573                         tmf.tmf_tidhi = lp->portid >> 16;
 574                         tmf.tmf_vpidx = ISP_GET_VPIDX(isp, chan);
 575                         tmf.tmf_lun[1] = fct->lun & 0xff;
 576                         if (fct->lun >= 256) {
 577                                 tmf.tmf_lun[0] = 0x40 | (fct->lun >> 8);
 578                         }
 579                         switch (fct->action) {
 580                         case IPT_CLEAR_ACA:
 581                                 tmf.tmf_flags = ISP24XX_TMF_CLEAR_ACA;
 582                                 break;
 583                         case IPT_TARGET_RESET:
 584                                 tmf.tmf_flags = ISP24XX_TMF_TARGET_RESET;
 585                                 needmarker = 1;
 586                                 break;
 587                         case IPT_LUN_RESET:
 588                                 tmf.tmf_flags = ISP24XX_TMF_LUN_RESET;
 589                                 needmarker = 1;
 590                                 break;
 591                         case IPT_CLEAR_TASK_SET:
 592                                 tmf.tmf_flags = ISP24XX_TMF_CLEAR_TASK_SET;
 593                                 needmarker = 1;
 594                                 break;
 595                         case IPT_ABORT_TASK_SET:
 596                                 tmf.tmf_flags = ISP24XX_TMF_ABORT_TASK_SET;
 597                                 needmarker = 1;
 598                                 break;
 599                         default:
 600                                 retval = EINVAL;
 601                                 break;
 602                         }
 603                         if (retval) {
 604                                 ISP_UNLOCK(isp);
 605                                 break;
 606                         }
 607
 608                         /* Prepare space for response in memory */
 609                         memset(resp, 0xff, sizeof(resp));
 610                         tmf.tmf_handle = isp_allocate_handle(isp, resp,
 611                             ISP_HANDLE_CTRL);
 612                         if (tmf.tmf_handle == 0) {
 613                                 isp_prt(isp, ISP_LOGERR,
 614                                     "%s: TMF of Chan %d out of handles",
 615                                     __func__, chan);
 616                                 ISP_UNLOCK(isp);
 617                                 retval = ENOMEM;
 618                                 break;
 619                         }
 620
 621                         /* Send request and wait for response. */
 622                         reqp = isp_getrqentry(isp);
 623                         if (reqp == NULL) {
 624                                 isp_prt(isp, ISP_LOGERR,
 625                                     "%s: TMF of Chan %d out of rqent",
 626                                     __func__, chan);
 627                                 isp_destroy_handle(isp, tmf.tmf_handle);
 628                                 ISP_UNLOCK(isp);
 629                                 retval = EIO;
 630                                 break;
 631                         }
 632                         isp_put_24xx_tmf(isp, &tmf, (isp24xx_tmf_t *)reqp);
 633                         if (isp->isp_dblev & ISP_LOGDEBUG1)
 634                                 isp_print_bytes(isp, "IOCB TMF", QENTRY_LEN, reqp);
 635                         ISP_SYNC_REQUEST(isp);
 636                         if (msleep(resp, &isp->isp_lock, 0, "TMF", 5*hz) == EWOULDBLOCK) {
 637                                 isp_prt(isp, ISP_LOGERR,
 638                                     "%s: TMF of Chan %d timed out",
 639                                     __func__, chan);
 640                                 isp_destroy_handle(isp, tmf.tmf_handle);
 641                                 ISP_UNLOCK(isp);
 642                                 retval = EIO;
 643                                 break;
 644                         }
 645                         if (isp->isp_dblev & ISP_LOGDEBUG1)
 646                                 isp_print_bytes(isp, "IOCB TMF response", QENTRY_LEN, resp);
 647                         isp_get_24xx_response(isp, (isp24xx_statusreq_t *)resp, &sp);
 648
 649                         if (sp.req_completion_status != 0)
 650                                 retval = EIO;
 651                         else if (needmarker)
 652                                 fcp->sendmarker = 1;
 653                 } else {
 654                         MBSINIT(&mbs, 0, MBLOGALL, 0);
 655                         if (ISP_CAP_2KLOGIN(isp) == 0) {
 656                                 nphdl <<= 8;
 657                         }
 658                         switch (fct->action) {
 659                         case IPT_CLEAR_ACA:
 660                                 mbs.param[0] = MBOX_CLEAR_ACA;
 661                                 mbs.param[1] = nphdl;
 662                                 mbs.param[2] = fct->lun;
 663                                 break;
 664                         case IPT_TARGET_RESET:
 665                                 mbs.param[0] = MBOX_TARGET_RESET;
 666                                 mbs.param[1] = nphdl;
 667                                 needmarker = 1;
 668                                 break;
 669                         case IPT_LUN_RESET:
 670                                 mbs.param[0] = MBOX_LUN_RESET;
 671                                 mbs.param[1] = nphdl;
 672                                 mbs.param[2] = fct->lun;
 673                                 needmarker = 1;
 674                                 break;
 675                         case IPT_CLEAR_TASK_SET:
 676                                 mbs.param[0] = MBOX_CLEAR_TASK_SET;
 677                                 mbs.param[1] = nphdl;
 678                                 mbs.param[2] = fct->lun;
 679                                 needmarker = 1;
 680                                 break;
 681                         case IPT_ABORT_TASK_SET:
 682                                 mbs.param[0] = MBOX_ABORT_TASK_SET;
 683                                 mbs.param[1] = nphdl;
 684                                 mbs.param[2] = fct->lun;
 685                                 needmarker = 1;
 686                                 break;
 687                         default:
 688                                 retval = EINVAL;
 689                                 break;
 690                         }
 691                         if (retval == 0) {
 692                                 if (needmarker) {
 693                                         FCPARAM(isp, chan)->sendmarker = 1;
 694                                 }
 695                                 retval = isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs);
 696                                 if (retval) {
 697                                         retval = EIO;
 698                                 }
 699                         }
 700                 }
 701                 ISP_UNLOCK(isp);
 702                 break;
 703         }
 704         default:
 705                 break;
 706         }
 707         return (retval);
 708 }
 709
 710 /*
 711  * Local Inlines
 712  */
 713
 714 static ISP_INLINE int isp_get_pcmd(ispsoftc_t *, union ccb *);
 715 static ISP_INLINE void isp_free_pcmd(ispsoftc_t *, union ccb *);
 716
 717 static ISP_INLINE int
 718 isp_get_pcmd(ispsoftc_t *isp, union ccb *ccb)
 719 {
 720         ISP_PCMD(ccb) = isp->isp_osinfo.pcmd_free;
 721         if (ISP_PCMD(ccb) == NULL) {
 722                 return (-1);
 723         }
 724         isp->isp_osinfo.pcmd_free = ((struct isp_pcmd *)ISP_PCMD(ccb))->next;
 725         return (0);
 726 }
 727
 728 static ISP_INLINE void
 729 isp_free_pcmd(ispsoftc_t *isp, union ccb *ccb)
 730 {
 731         if (ISP_PCMD(ccb)) {
 732 #ifdef  ISP_TARGET_MODE
 733                 PISP_PCMD(ccb)->datalen = 0;
 734 #endif
 735                 PISP_PCMD(ccb)->next = isp->isp_osinfo.pcmd_free;
 736                 isp->isp_osinfo.pcmd_free = ISP_PCMD(ccb);
 737                 ISP_PCMD(ccb) = NULL;
 738         }
 739 }
 740
 741 /*
 742  * Put the target mode functions here, because some are inlines
 743  */
 744 #ifdef  ISP_TARGET_MODE
 745 static ISP_INLINE tstate_t *get_lun_statep(ispsoftc_t *, int, lun_id_t);
 746 static atio_private_data_t *isp_get_atpd(ispsoftc_t *, int, uint32_t);
 747 static atio_private_data_t *isp_find_atpd(ispsoftc_t *, int, uint32_t);
 748 static void isp_put_atpd(ispsoftc_t *, int, atio_private_data_t *);
 749 static inot_private_data_t *isp_get_ntpd(ispsoftc_t *, int);
 750 static inot_private_data_t *isp_find_ntpd(ispsoftc_t *, int, uint32_t, uint32_t);
 751 static void isp_put_ntpd(ispsoftc_t *, int, inot_private_data_t *);
 752 static cam_status create_lun_state(ispsoftc_t *, int, struct cam_path *, tstate_t **);
 753 static void destroy_lun_state(ispsoftc_t *, int, tstate_t *);
 754 static void isp_enable_lun(ispsoftc_t *, union ccb *);
 755 static void isp_disable_lun(ispsoftc_t *, union ccb *);
 756 static timeout_t isp_refire_putback_atio;
 757 static timeout_t isp_refire_notify_ack;
 758 static void isp_complete_ctio(union ccb *);
 759 static void isp_target_putback_atio(union ccb *);
 760 enum Start_Ctio_How { FROM_CAM, FROM_TIMER, FROM_SRR, FROM_CTIO_DONE };
 761 static void isp_target_start_ctio(ispsoftc_t *, union ccb *, enum Start_Ctio_How);
 762 static void isp_handle_platform_atio2(ispsoftc_t *, at2_entry_t *);
 763 static void isp_handle_platform_atio7(ispsoftc_t *, at7_entry_t *);
 764 static void isp_handle_platform_ctio(ispsoftc_t *, void *);
 765 static int isp_handle_platform_target_notify_ack(ispsoftc_t *, isp_notify_t *, uint32_t rsp);
 766 static void isp_handle_platform_target_tmf(ispsoftc_t *, isp_notify_t *);
 767 static void isp_target_mark_aborted_early(ispsoftc_t *, int chan, tstate_t *, uint32_t);
 768
 769 static ISP_INLINE tstate_t *
 770 get_lun_statep(ispsoftc_t *isp, int bus, lun_id_t lun)
 771 {
 772         tstate_t *tptr = NULL;
 773         struct tslist *lhp;
 774
 775         if (bus < isp->isp_nchan) {
 776                 ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(lun)], lhp);
 777                 SLIST_FOREACH(tptr, lhp, next) {
 778                         if (tptr->ts_lun == lun)
 779                                 return (tptr);
 780                 }
 781         }
 782         return (NULL);
 783 }
 784
 785 static int
 786 isp_atio_restart(ispsoftc_t *isp, int bus, tstate_t *tptr)
 787 {
 788         inot_private_data_t *ntp;
 789         struct ntpdlist rq;
 790
 791         if (STAILQ_EMPTY(&tptr->restart_queue))
 792                 return (0);
 793         STAILQ_INIT(&rq);
 794         STAILQ_CONCAT(&rq, &tptr->restart_queue);
 795         while ((ntp = STAILQ_FIRST(&rq)) != NULL) {
 796                 STAILQ_REMOVE_HEAD(&rq, next);
 797                 if (IS_24XX(isp)) {
 798                         isp_prt(isp, ISP_LOGTDEBUG0,
 799                             "%s: restarting resrc deprived %x", __func__,
 800                             ((at7_entry_t *)ntp->data)->at_rxid);
 801                         isp_handle_platform_atio7(isp, (at7_entry_t *) ntp->data);
 802                 } else {
 803                         isp_prt(isp, ISP_LOGTDEBUG0,
 804                             "%s: restarting resrc deprived %x", __func__,
 805                             ((at2_entry_t *)ntp->data)->at_rxid);
 806                         isp_handle_platform_atio2(isp, (at2_entry_t *) ntp->data);
 807                 }
 808                 isp_put_ntpd(isp, bus, ntp);
 809                 if (!STAILQ_EMPTY(&tptr->restart_queue))
 810                         break;
 811         }
 812         if (!STAILQ_EMPTY(&rq)) {
 813                 STAILQ_CONCAT(&rq, &tptr->restart_queue);
 814                 STAILQ_CONCAT(&tptr->restart_queue, &rq);
 815         }
 816         return (!STAILQ_EMPTY(&tptr->restart_queue));
 817 }
 818
 819 static void
 820 isp_tmcmd_restart(ispsoftc_t *isp)
 821 {
 822         tstate_t *tptr;
 823         union ccb *ccb;
 824         struct tslist *lhp;
 825         struct isp_ccbq *waitq;
 826         int bus, i;
 827
 828         for (bus = 0; bus < isp->isp_nchan; bus++) {
 829                 for (i = 0; i < LUN_HASH_SIZE; i++) {
 830                         ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
 831                         SLIST_FOREACH(tptr, lhp, next)
 832                                 isp_atio_restart(isp, bus, tptr);
 833                 }
 834
 835                 /*
 836                  * We only need to do this once per channel.
 837                  */
 838                 ISP_GET_PC_ADDR(isp, bus, waitq, waitq);
 839                 ccb = (union ccb *)TAILQ_FIRST(waitq);
 840                 if (ccb != NULL) {
 841                         TAILQ_REMOVE(waitq, &ccb->ccb_h, sim_links.tqe);
 842                         isp_target_start_ctio(isp, ccb, FROM_TIMER);
 843                 }
 844         }
 845 }
 846
 847 static atio_private_data_t *
 848 isp_get_atpd(ispsoftc_t *isp, int chan, uint32_t tag)
 849 {
 850         struct atpdlist *atfree;
 851         struct atpdlist *atused;
 852         atio_private_data_t *atp;
 853
 854         ISP_GET_PC_ADDR(isp, chan, atfree, atfree);
 855         atp = LIST_FIRST(atfree);
 856         if (atp) {
 857                 LIST_REMOVE(atp, next);
 858                 atp->tag = tag;
 859                 ISP_GET_PC(isp, chan, atused, atused);
 860                 LIST_INSERT_HEAD(&atused[ATPDPHASH(tag)], atp, next);
 861         }
 862         return (atp);
 863 }
 864
 865 static atio_private_data_t *
 866 isp_find_atpd(ispsoftc_t *isp, int chan, uint32_t tag)
 867 {
 868         struct atpdlist *atused;
 869         atio_private_data_t *atp;
 870
 871         ISP_GET_PC(isp, chan, atused, atused);
 872         LIST_FOREACH(atp, &atused[ATPDPHASH(tag)], next) {
 873                 if (atp->tag == tag)
 874                         return (atp);
 875         }
 876         return (NULL);
 877 }
 878
 879 static void
 880 isp_put_atpd(ispsoftc_t *isp, int chan, atio_private_data_t *atp)
 881 {
 882         struct atpdlist *atfree;
 883
 884         if (atp->ests) {
 885                 isp_put_ecmd(isp, atp->ests);
 886         }
 887         LIST_REMOVE(atp, next);
 888         memset(atp, 0, sizeof (*atp));
 889         ISP_GET_PC_ADDR(isp, chan, atfree, atfree);
 890         LIST_INSERT_HEAD(atfree, atp, next);
 891 }
 892
 893 static void
 894 isp_dump_atpd(ispsoftc_t *isp, int chan)
 895 {
 896         atio_private_data_t *atp, *atpool;
 897         const char *states[8] = { "Free", "ATIO", "CAM", "CTIO", "LAST_CTIO", "PDON", "?6", "7" };
 898
 899         ISP_GET_PC(isp, chan, atpool, atpool);
 900         for (atp = atpool; atp < &atpool[ATPDPSIZE]; atp++) {
 901                 if (atp->state == ATPD_STATE_FREE)
 902                         continue;
 903                 isp_prt(isp, ISP_LOGALL, "Chan %d ATP [0x%x] origdlen %u bytes_xfrd %u lun %jx nphdl 0x%04x s_id 0x%06x d_id 0x%06x oxid 0x%04x state %s",
 904                     chan, atp->tag, atp->orig_datalen, atp->bytes_xfered, (uintmax_t)atp->lun, atp->nphdl, atp->sid, atp->did, atp->oxid, states[atp->state & 0x7]);
 905         }
 906 }
 907
 908 static inot_private_data_t *
 909 isp_get_ntpd(ispsoftc_t *isp, int chan)
 910 {
 911         struct ntpdlist *ntfree;
 912         inot_private_data_t *ntp;
 913
 914         ISP_GET_PC_ADDR(isp, chan, ntfree, ntfree);
 915         ntp = STAILQ_FIRST(ntfree);
 916         if (ntp)
 917                 STAILQ_REMOVE_HEAD(ntfree, next);
 918         return (ntp);
 919 }
 920
 921 static inot_private_data_t *
 922 isp_find_ntpd(ispsoftc_t *isp, int chan, uint32_t tag_id, uint32_t seq_id)
 923 {
 924         inot_private_data_t *ntp, *ntp2;
 925
 926         ISP_GET_PC(isp, chan, ntpool, ntp);
 927         ISP_GET_PC_ADDR(isp, chan, ntpool[ATPDPSIZE], ntp2);
 928         for (; ntp < ntp2; ntp++) {
 929                 if (ntp->tag_id == tag_id && ntp->seq_id == seq_id)
 930                         return (ntp);
 931         }
 932         return (NULL);
 933 }
 934
 935 static void
 936 isp_put_ntpd(ispsoftc_t *isp, int chan, inot_private_data_t *ntp)
 937 {
 938         struct ntpdlist *ntfree;
 939
 940         ntp->tag_id = ntp->seq_id = 0;
 941         ISP_GET_PC_ADDR(isp, chan, ntfree, ntfree);
 942         STAILQ_INSERT_HEAD(ntfree, ntp, next);
 943 }
 944
 945 static cam_status
 946 create_lun_state(ispsoftc_t *isp, int bus, struct cam_path *path, tstate_t **rslt)
 947 {
 948         lun_id_t lun;
 949         struct tslist *lhp;
 950         tstate_t *tptr;
 951
 952         lun = xpt_path_lun_id(path);
 953         if (lun != CAM_LUN_WILDCARD) {
 954                 if (ISP_MAX_LUNS(isp) > 0 && lun >= ISP_MAX_LUNS(isp)) {
 955                         return (CAM_LUN_INVALID);
 956                 }
 957         }
 958         tptr = malloc(sizeof (tstate_t), M_DEVBUF, M_NOWAIT|M_ZERO);
 959         if (tptr == NULL) {
 960                 return (CAM_RESRC_UNAVAIL);
 961         }
 962         tptr->ts_lun = lun;
 963         SLIST_INIT(&tptr->atios);
 964         SLIST_INIT(&tptr->inots);
 965         ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(lun)], lhp);
 966         SLIST_INSERT_HEAD(lhp, tptr, next);
 967         *rslt = tptr;
 968         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, path, "created tstate\n");
 969         return (CAM_REQ_CMP);
 970 }
 971
 972 static void
 973 destroy_lun_state(ispsoftc_t *isp, int bus, tstate_t *tptr)
 974 {
 975         union ccb *ccb;
 976         struct tslist *lhp;
 977         inot_private_data_t *ntp;
 978
 979         while ((ccb = (union ccb *)SLIST_FIRST(&tptr->atios)) != NULL) {
 980                 SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
 981                 ccb->ccb_h.status = CAM_REQ_ABORTED;
 982                 xpt_done(ccb);
 983         };
 984         while ((ccb = (union ccb *)SLIST_FIRST(&tptr->inots)) != NULL) {
 985                 SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
 986                 ccb->ccb_h.status = CAM_REQ_ABORTED;
 987                 xpt_done(ccb);
 988         }
 989         while ((ntp = STAILQ_FIRST(&tptr->restart_queue)) != NULL) {
 990                 isp_endcmd(isp, ntp->data, NIL_HANDLE, bus, SCSI_STATUS_BUSY, 0);
 991                 STAILQ_REMOVE_HEAD(&tptr->restart_queue, next);
 992                 isp_put_ntpd(isp, bus, ntp);
 993         }
 994         ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(tptr->ts_lun)], lhp);
 995         SLIST_REMOVE(lhp, tptr, tstate, next);
 996         free(tptr, M_DEVBUF);
 997 }
 998
 999 static void
1000 isp_enable_lun(ispsoftc_t *isp, union ccb *ccb)
1001 {
1002         tstate_t *tptr;
1003         int bus;
1004         target_id_t target;
1005         lun_id_t lun;
1006
1007         if (!IS_FC(isp) || !ISP_CAP_TMODE(isp) || !ISP_CAP_SCCFW(isp)) {
1008                 xpt_print(ccb->ccb_h.path, "Target mode is not supported\n");
1009                 ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
1010                 xpt_done(ccb);
1011                 return;
1012         }
1013
1014         /*
1015          * We only support either target and lun both wildcard
1016          * or target and lun both non-wildcard.
1017          */
1018         bus = XS_CHANNEL(ccb);
1019         target = ccb->ccb_h.target_id;
1020         lun = ccb->ccb_h.target_lun;
1021         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0|ISP_LOGCONFIG, ccb->ccb_h.path,
1022             "enabling lun %jx\n", (uintmax_t)lun);
1023         if ((target == CAM_TARGET_WILDCARD) != (lun == CAM_LUN_WILDCARD)) {
1024                 ccb->ccb_h.status = CAM_LUN_INVALID;
1025                 xpt_done(ccb);
1026                 return;
1027         }
1028
1029         /* Create the state pointer. It should not already exist. */
1030         tptr = get_lun_statep(isp, bus, lun);
1031         if (tptr) {
1032                 ccb->ccb_h.status = CAM_LUN_ALRDY_ENA;
1033                 xpt_done(ccb);
1034                 return;
1035         }
1036         ccb->ccb_h.status = create_lun_state(isp, bus, ccb->ccb_h.path, &tptr);
1037         if (ccb->ccb_h.status != CAM_REQ_CMP) {
1038                 xpt_done(ccb);
1039                 return;
1040         }
1041
1042         ccb->ccb_h.status = CAM_REQ_CMP;
1043         xpt_done(ccb);
1044 }
1045
1046 static void
1047 isp_disable_lun(ispsoftc_t *isp, union ccb *ccb)
1048 {
1049         tstate_t *tptr = NULL;
1050         int bus;
1051         target_id_t target;
1052         lun_id_t lun;
1053
1054         bus = XS_CHANNEL(ccb);
1055         target = ccb->ccb_h.target_id;
1056         lun = ccb->ccb_h.target_lun;
1057         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0|ISP_LOGCONFIG, ccb->ccb_h.path,
1058             "disabling lun %jx\n", (uintmax_t)lun);
1059         if ((target == CAM_TARGET_WILDCARD) != (lun == CAM_LUN_WILDCARD)) {
1060                 ccb->ccb_h.status = CAM_LUN_INVALID;
1061                 xpt_done(ccb);
1062                 return;
1063         }
1064
1065         /* Find the state pointer. */
1066         if ((tptr = get_lun_statep(isp, bus, lun)) == NULL) {
1067                 ccb->ccb_h.status = CAM_PATH_INVALID;
1068                 xpt_done(ccb);
1069                 return;
1070         }
1071
1072         destroy_lun_state(isp, bus, tptr);
1073         ccb->ccb_h.status = CAM_REQ_CMP;
1074         xpt_done(ccb);
1075 }
1076
1077 static void
1078 isp_target_start_ctio(ispsoftc_t *isp, union ccb *ccb, enum Start_Ctio_How how)
1079 {
1080         int fctape, sendstatus, resid;
1081         fcparam *fcp;
1082         atio_private_data_t *atp;
1083         struct ccb_scsiio *cso;
1084         struct isp_ccbq *waitq;
1085         uint32_t dmaresult, handle, xfrlen, sense_length, tmp;
1086         uint8_t local[QENTRY_LEN];
1087
1088         isp_prt(isp, ISP_LOGTDEBUG0, "%s: ENTRY[0x%x] how %u xfrlen %u sendstatus %d sense_len %u", __func__, ccb->csio.tag_id, how, ccb->csio.dxfer_len,
1089             (ccb->ccb_h.flags & CAM_SEND_STATUS) != 0, ((ccb->ccb_h.flags & CAM_SEND_SENSE)? ccb->csio.sense_len : 0));
1090
1091         ISP_GET_PC_ADDR(isp, XS_CHANNEL(ccb), waitq, waitq);
1092         switch (how) {
1093         case FROM_CAM:
1094                 /*
1095                  * Insert at the tail of the list, if any, waiting CTIO CCBs
1096                  */
1097                 TAILQ_INSERT_TAIL(waitq, &ccb->ccb_h, sim_links.tqe);
1098                 break;
1099         case FROM_TIMER:
1100         case FROM_SRR:
1101         case FROM_CTIO_DONE:
1102                 TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
1103                 break;
1104         }
1105
1106         while ((ccb = (union ccb *) TAILQ_FIRST(waitq)) != NULL) {
1107                 TAILQ_REMOVE(waitq, &ccb->ccb_h, sim_links.tqe);
1108
1109                 cso = &ccb->csio;
1110                 xfrlen = cso->dxfer_len;
1111                 if (xfrlen == 0) {
1112                         if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
1113                                 ISP_PATH_PRT(isp, ISP_LOGERR, ccb->ccb_h.path, "a data transfer length of zero but no status to send is wrong\n");
1114                                 ccb->ccb_h.status = CAM_REQ_INVALID;
1115                                 xpt_done(ccb);
1116                                 continue;
1117                         }
1118                 }
1119
1120                 atp = isp_find_atpd(isp, XS_CHANNEL(ccb), cso->tag_id);
1121                 if (atp == NULL) {
1122                         isp_prt(isp, ISP_LOGERR, "%s: [0x%x] cannot find private data adjunct in %s", __func__, cso->tag_id, __func__);
1123                         isp_dump_atpd(isp, XS_CHANNEL(ccb));
1124                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1125                         xpt_done(ccb);
1126                         continue;
1127                 }
1128
1129                 /*
1130                  * Is this command a dead duck?
1131                  */
1132                 if (atp->dead) {
1133                         isp_prt(isp, ISP_LOGERR, "%s: [0x%x] not sending a CTIO for a dead command", __func__, cso->tag_id);
1134                         ccb->ccb_h.status = CAM_REQ_ABORTED;
1135                         xpt_done(ccb);
1136                         continue;
1137                 }
1138
1139                 /*
1140                  * Check to make sure we're still in target mode.
1141                  */
1142                 fcp = FCPARAM(isp, XS_CHANNEL(ccb));
1143                 if ((fcp->role & ISP_ROLE_TARGET) == 0) {
1144                         isp_prt(isp, ISP_LOGERR, "%s: [0x%x] stopping sending a CTIO because we're no longer in target mode", __func__, cso->tag_id);
1145                         ccb->ccb_h.status = CAM_PROVIDE_FAIL;
1146                         xpt_done(ccb);
1147                         continue;
1148                 }
1149
1150                 /*
1151                  * We're only handling ATPD_CCB_OUTSTANDING outstanding CCB at a time (one of which
1152                  * could be split into two CTIOs to split data and status).
1153                  */
1154                 if (atp->ctcnt >= ATPD_CCB_OUTSTANDING) {
1155                         isp_prt(isp, ISP_LOGTINFO, "[0x%x] handling only %d CCBs at a time (flags for this ccb: 0x%x)", cso->tag_id, ATPD_CCB_OUTSTANDING, ccb->ccb_h.flags);
1156                         TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
1157                         break;
1158                 }
1159
1160                 /*
1161                  * Does the initiator expect FC-Tape style responses?
1162                  */
1163                 if ((atp->word3 & PRLI_WD3_RETRY) && fcp->fctape_enabled) {
1164                         fctape = 1;
1165                 } else {
1166                         fctape = 0;
1167                 }
1168
1169                 /*
1170                  * If we already did the data xfer portion of a CTIO that sends data
1171                  * and status, don't do it again and do the status portion now.
1172                  */
1173                 if (atp->sendst) {
1174                         isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] now sending synthesized status orig_dl=%u xfered=%u bit=%u",
1175                             cso->tag_id, atp->orig_datalen, atp->bytes_xfered, atp->bytes_in_transit);
1176                         xfrlen = 0;     /* we already did the data transfer */
1177                         atp->sendst = 0;
1178                 }
1179                 if (ccb->ccb_h.flags & CAM_SEND_STATUS) {
1180                         sendstatus = 1;
1181                 } else {
1182                         sendstatus = 0;
1183                 }
1184
1185                 if (ccb->ccb_h.flags & CAM_SEND_SENSE) {
1186                         KASSERT((sendstatus != 0), ("how can you have CAM_SEND_SENSE w/o CAM_SEND_STATUS?"));
1187                         /*
1188                          * Sense length is not the entire sense data structure size. Periph
1189                          * drivers don't seem to be setting sense_len to reflect the actual
1190                          * size. We'll peek inside to get the right amount.
1191                          */
1192                         sense_length = cso->sense_len;
1193
1194                         /*
1195                          * This 'cannot' happen
1196                          */
1197                         if (sense_length > (XCMD_SIZE - MIN_FCP_RESPONSE_SIZE)) {
1198                                 sense_length = XCMD_SIZE - MIN_FCP_RESPONSE_SIZE;
1199                         }
1200                 } else {
1201                         sense_length = 0;
1202                 }
1203
1204                 memset(local, 0, QENTRY_LEN);
1205
1206                 /*
1207                  * Check for overflow
1208                  */
1209                 tmp = atp->bytes_xfered + atp->bytes_in_transit;
1210                 if (xfrlen > 0 && tmp > atp->orig_datalen) {
1211                         isp_prt(isp, ISP_LOGERR,
1212                             "%s: [0x%x] data overflow by %u bytes", __func__,
1213                             cso->tag_id, tmp + xfrlen - atp->orig_datalen);
1214                         ccb->ccb_h.status = CAM_DATA_RUN_ERR;
1215                         xpt_done(ccb);
1216                         continue;
1217                 }
1218                 if (xfrlen > atp->orig_datalen - tmp) {
1219                         xfrlen = atp->orig_datalen - tmp;
1220                         if (xfrlen == 0 && !sendstatus) {
1221                                 cso->resid = cso->dxfer_len;
1222                                 ccb->ccb_h.status = CAM_REQ_CMP;
1223                                 xpt_done(ccb);
1224                                 continue;
1225                         }
1226                 }
1227
1228                 if (IS_24XX(isp)) {
1229                         ct7_entry_t *cto = (ct7_entry_t *) local;
1230
1231                         cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
1232                         cto->ct_header.rqs_entry_count = 1;
1233                         cto->ct_header.rqs_seqno |= ATPD_SEQ_NOTIFY_CAM;
1234                         ATPD_SET_SEQNO(cto, atp);
1235                         cto->ct_nphdl = atp->nphdl;
1236                         cto->ct_rxid = atp->tag;
1237                         cto->ct_iid_lo = atp->sid;
1238                         cto->ct_iid_hi = atp->sid >> 16;
1239                         cto->ct_oxid = atp->oxid;
1240                         cto->ct_vpidx = ISP_GET_VPIDX(isp, XS_CHANNEL(ccb));
1241                         cto->ct_timeout = XS_TIME(ccb);
1242                         cto->ct_flags = atp->tattr << CT7_TASK_ATTR_SHIFT;
1243
1244                         /*
1245                          * Mode 1, status, no data. Only possible when we are sending status, have
1246                          * no data to transfer, and any sense data can fit into a ct7_entry_t.
1247                          *
1248                          * Mode 2, status, no data. We have to use this in the case that
1249                          * the sense data won't fit into a ct7_entry_t.
1250                          *
1251                          */
1252                         if (sendstatus && xfrlen == 0) {
1253                                 cto->ct_flags |= CT7_SENDSTATUS | CT7_NO_DATA;
1254                                 resid = atp->orig_datalen - atp->bytes_xfered - atp->bytes_in_transit;
1255                                 if (sense_length <= MAXRESPLEN_24XX) {
1256                                         cto->ct_flags |= CT7_FLAG_MODE1;
1257                                         cto->ct_scsi_status = cso->scsi_status;
1258                                         if (resid < 0) {
1259                                                 cto->ct_resid = -resid;
1260                                                 cto->ct_scsi_status |= (FCP_RESID_OVERFLOW << 8);
1261                                         } else if (resid > 0) {
1262                                                 cto->ct_resid = resid;
1263                                                 cto->ct_scsi_status |= (FCP_RESID_UNDERFLOW << 8);
1264                                         }
1265                                         if (fctape) {
1266                                                 cto->ct_flags |= CT7_CONFIRM|CT7_EXPLCT_CONF;
1267                                         }
1268                                         if (sense_length) {
1269                                                 cto->ct_scsi_status |= (FCP_SNSLEN_VALID << 8);
1270                                                 cto->rsp.m1.ct_resplen = cto->ct_senselen = sense_length;
1271                                                 memcpy(cto->rsp.m1.ct_resp, &cso->sense_data, sense_length);
1272                                         }
1273                                 } else {
1274                                         bus_addr_t addr;
1275                                         char buf[XCMD_SIZE];
1276                                         fcp_rsp_iu_t *rp;
1277
1278                                         if (atp->ests == NULL) {
1279                                                 atp->ests = isp_get_ecmd(isp);
1280                                                 if (atp->ests == NULL) {
1281                                                         TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
1282                                                         break;
1283                                                 }
1284                                         }
1285                                         memset(buf, 0, sizeof (buf));
1286                                         rp = (fcp_rsp_iu_t *)buf;
1287                                         if (fctape) {
1288                                                 cto->ct_flags |= CT7_CONFIRM|CT7_EXPLCT_CONF;
1289                                                 rp->fcp_rsp_bits |= FCP_CONF_REQ;
1290                                         }
1291                                         cto->ct_flags |= CT7_FLAG_MODE2;
1292                                         rp->fcp_rsp_scsi_status = cso->scsi_status;
1293                                         if (resid < 0) {
1294                                                 rp->fcp_rsp_resid = -resid;
1295                                                 rp->fcp_rsp_bits |= FCP_RESID_OVERFLOW;
1296                                         } else if (resid > 0) {
1297                                                 rp->fcp_rsp_resid = resid;
1298                                                 rp->fcp_rsp_bits |= FCP_RESID_UNDERFLOW;
1299                                         }
1300                                         if (sense_length) {
1301                                                 rp->fcp_rsp_snslen = sense_length;
1302                                                 cto->ct_senselen = sense_length;
1303                                                 rp->fcp_rsp_bits |= FCP_SNSLEN_VALID;
1304                                                 isp_put_fcp_rsp_iu(isp, rp, atp->ests);
1305                                                 memcpy(((fcp_rsp_iu_t *)atp->ests)->fcp_rsp_extra, &cso->sense_data, sense_length);
1306                                         } else {
1307                                                 isp_put_fcp_rsp_iu(isp, rp, atp->ests);
1308                                         }
1309                                         if (isp->isp_dblev & ISP_LOGTDEBUG1) {
1310                                                 isp_print_bytes(isp, "FCP Response Frame After Swizzling", MIN_FCP_RESPONSE_SIZE + sense_length, atp->ests);
1311                                         }
1312                                         addr = isp->isp_osinfo.ecmd_dma;
1313                                         addr += ((((isp_ecmd_t *)atp->ests) - isp->isp_osinfo.ecmd_base) * XCMD_SIZE);
1314                                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: ests base %p vaddr %p ecmd_dma %jx addr %jx len %u", __func__, isp->isp_osinfo.ecmd_base, atp->ests,
1315                                             (uintmax_t) isp->isp_osinfo.ecmd_dma, (uintmax_t)addr, MIN_FCP_RESPONSE_SIZE + sense_length);
1316                                         cto->rsp.m2.ct_datalen = MIN_FCP_RESPONSE_SIZE + sense_length;
1317                                         cto->rsp.m2.ct_fcp_rsp_iudata.ds_base = DMA_LO32(addr);
1318                                         cto->rsp.m2.ct_fcp_rsp_iudata.ds_basehi = DMA_HI32(addr);
1319                                         cto->rsp.m2.ct_fcp_rsp_iudata.ds_count = MIN_FCP_RESPONSE_SIZE + sense_length;
1320                                 }
1321                                 if (sense_length) {
1322                                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO7[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d slen %u sense: %x %x/%x/%x", __func__,
1323                                             cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cto->ct_scsi_status, cto->ct_flags, cto->ct_resid, sense_length,
1324                                             cso->sense_data.error_code, cso->sense_data.sense_buf[1], cso->sense_data.sense_buf[11], cso->sense_data.sense_buf[12]);
1325                                 } else {
1326                                         isp_prt(isp, ISP_LOGDEBUG0, "%s: CTIO7[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d", __func__,
1327                                             cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cto->ct_scsi_status, cto->ct_flags, cto->ct_resid);
1328                                 }
1329                                 atp->state = ATPD_STATE_LAST_CTIO;
1330                         }
1331
1332                         /*
1333                          * Mode 0 data transfers, *possibly* with status.
1334                          */
1335                         if (xfrlen != 0) {
1336                                 cto->ct_flags |= CT7_FLAG_MODE0;
1337                                 if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1338                                         cto->ct_flags |= CT7_DATA_IN;
1339                                 } else {
1340                                         cto->ct_flags |= CT7_DATA_OUT;
1341                                 }
1342
1343                                 cto->rsp.m0.reloff = atp->bytes_xfered + atp->bytes_in_transit;
1344                                 cto->rsp.m0.ct_xfrlen = xfrlen;
1345
1346 #ifdef  DEBUG
1347                                 if (ISP_FC_PC(isp, XS_CHANNEL(ccb))->inject_lost_data_frame && xfrlen > ISP_FC_PC(isp, XS_CHANNEL(ccb))->inject_lost_data_frame) {
1348                                         isp_prt(isp, ISP_LOGWARN, "%s: truncating data frame with xfrlen %d to %d", __func__, xfrlen, xfrlen - (xfrlen >> 2));
1349                                         ISP_FC_PC(isp, XS_CHANNEL(ccb))->inject_lost_data_frame = 0;
1350                                         cto->rsp.m0.ct_xfrlen -= xfrlen >> 2;
1351                                 }
1352 #endif
1353                                 if (sendstatus) {
1354                                         resid = atp->orig_datalen - atp->bytes_xfered - xfrlen;
1355                                         if (cso->scsi_status == SCSI_STATUS_OK && resid == 0 /* && fctape == 0 */) {
1356                                                 cto->ct_flags |= CT7_SENDSTATUS;
1357                                                 atp->state = ATPD_STATE_LAST_CTIO;
1358                                                 if (fctape) {
1359                                                         cto->ct_flags |= CT7_CONFIRM|CT7_EXPLCT_CONF;
1360                                                 }
1361                                         } else {
1362                                                 atp->sendst = 1;        /* send status later */
1363                                                 cto->ct_header.rqs_seqno &= ~ATPD_SEQ_NOTIFY_CAM;
1364                                                 atp->state = ATPD_STATE_CTIO;
1365                                         }
1366                                 } else {
1367                                         atp->state = ATPD_STATE_CTIO;
1368                                 }
1369                                 isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO7[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x xfrlen=%u off=%u", __func__,
1370                                     cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cto->ct_scsi_status, cto->ct_flags, xfrlen, atp->bytes_xfered);
1371                         }
1372                 } else {
1373                         ct2_entry_t *cto = (ct2_entry_t *) local;
1374
1375                         if (isp->isp_osinfo.sixtyfourbit)
1376                                 cto->ct_header.rqs_entry_type = RQSTYPE_CTIO3;
1377                         else
1378                                 cto->ct_header.rqs_entry_type = RQSTYPE_CTIO2;
1379                         cto->ct_header.rqs_entry_count = 1;
1380                         cto->ct_header.rqs_seqno |= ATPD_SEQ_NOTIFY_CAM;
1381                         ATPD_SET_SEQNO(cto, atp);
1382                         if (ISP_CAP_2KLOGIN(isp)) {
1383                                 ((ct2e_entry_t *)cto)->ct_iid = atp->nphdl;
1384                         } else {
1385                                 cto->ct_iid = atp->nphdl;
1386                                 if (ISP_CAP_SCCFW(isp) == 0) {
1387                                         cto->ct_lun = ccb->ccb_h.target_lun;
1388                                 }
1389                         }
1390                         cto->ct_timeout = XS_TIME(ccb);
1391                         cto->ct_rxid = cso->tag_id;
1392
1393                         /*
1394                          * Mode 1, status, no data. Only possible when we are sending status, have
1395                          * no data to transfer, and the sense length can fit in the ct7_entry.
1396                          *
1397                          * Mode 2, status, no data. We have to use this in the case the response
1398                          * length won't fit into a ct2_entry_t.
1399                          *
1400                          * We'll fill out this structure with information as if this were a
1401                          * Mode 1. The hardware layer will create the Mode 2 FCP RSP IU as
1402                          * needed based upon this.
1403                          */
1404                         if (sendstatus && xfrlen == 0) {
1405                                 cto->ct_flags |= CT2_SENDSTATUS | CT2_NO_DATA;
1406                                 resid = atp->orig_datalen - atp->bytes_xfered - atp->bytes_in_transit;
1407                                 if (sense_length <= MAXRESPLEN) {
1408                                         if (resid < 0) {
1409                                                 cto->ct_resid = -resid;
1410                                         } else if (resid > 0) {
1411                                                 cto->ct_resid = resid;
1412                                         }
1413                                         cto->ct_flags |= CT2_FLAG_MODE1;
1414                                         cto->rsp.m1.ct_scsi_status = cso->scsi_status;
1415                                         if (resid < 0) {
1416                                                 cto->rsp.m1.ct_scsi_status |= CT2_DATA_OVER;
1417                                         } else if (resid > 0) {
1418                                                 cto->rsp.m1.ct_scsi_status |= CT2_DATA_UNDER;
1419                                         }
1420                                         if (fctape) {
1421                                                 cto->ct_flags |= CT2_CONFIRM;
1422                                         }
1423                                         if (sense_length) {
1424                                                 cto->rsp.m1.ct_scsi_status |= CT2_SNSLEN_VALID;
1425                                                 cto->rsp.m1.ct_resplen = cto->rsp.m1.ct_senselen = sense_length;
1426                                                 memcpy(cto->rsp.m1.ct_resp, &cso->sense_data, sense_length);
1427                                         }
1428                                 } else {
1429                                         bus_addr_t addr;
1430                                         char buf[XCMD_SIZE];
1431                                         fcp_rsp_iu_t *rp;
1432
1433                                         if (atp->ests == NULL) {
1434                                                 atp->ests = isp_get_ecmd(isp);
1435                                                 if (atp->ests == NULL) {
1436                                                         TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
1437                                                         break;
1438                                                 }
1439                                         }
1440                                         memset(buf, 0, sizeof (buf));
1441                                         rp = (fcp_rsp_iu_t *)buf;
1442                                         if (fctape) {
1443                                                 cto->ct_flags |= CT2_CONFIRM;
1444                                                 rp->fcp_rsp_bits |= FCP_CONF_REQ;
1445                                         }
1446                                         cto->ct_flags |= CT2_FLAG_MODE2;
1447                                         rp->fcp_rsp_scsi_status = cso->scsi_status;
1448                                         if (resid < 0) {
1449                                                 rp->fcp_rsp_resid = -resid;
1450                                                 rp->fcp_rsp_bits |= FCP_RESID_OVERFLOW;
1451                                         } else if (resid > 0) {
1452                                                 rp->fcp_rsp_resid = resid;
1453                                                 rp->fcp_rsp_bits |= FCP_RESID_UNDERFLOW;
1454                                         }
1455                                         if (sense_length) {
1456                                                 rp->fcp_rsp_snslen = sense_length;
1457                                                 rp->fcp_rsp_bits |= FCP_SNSLEN_VALID;
1458                                                 isp_put_fcp_rsp_iu(isp, rp, atp->ests);
1459                                                 memcpy(((fcp_rsp_iu_t *)atp->ests)->fcp_rsp_extra, &cso->sense_data, sense_length);
1460                                         } else {
1461                                                 isp_put_fcp_rsp_iu(isp, rp, atp->ests);
1462                                         }
1463                                         if (isp->isp_dblev & ISP_LOGTDEBUG1) {
1464                                                 isp_print_bytes(isp, "FCP Response Frame After Swizzling", MIN_FCP_RESPONSE_SIZE + sense_length, atp->ests);
1465                                         }
1466                                         addr = isp->isp_osinfo.ecmd_dma;
1467                                         addr += ((((isp_ecmd_t *)atp->ests) - isp->isp_osinfo.ecmd_base) * XCMD_SIZE);
1468                                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: ests base %p vaddr %p ecmd_dma %jx addr %jx len %u", __func__, isp->isp_osinfo.ecmd_base, atp->ests,
1469                                             (uintmax_t) isp->isp_osinfo.ecmd_dma, (uintmax_t)addr, MIN_FCP_RESPONSE_SIZE + sense_length);
1470                                         cto->rsp.m2.ct_datalen = MIN_FCP_RESPONSE_SIZE + sense_length;
1471                                         if (cto->ct_header.rqs_entry_type == RQSTYPE_CTIO3) {
1472                                                 cto->rsp.m2.u.ct_fcp_rsp_iudata_64.ds_base = DMA_LO32(addr);
1473                                                 cto->rsp.m2.u.ct_fcp_rsp_iudata_64.ds_basehi = DMA_HI32(addr);
1474                                                 cto->rsp.m2.u.ct_fcp_rsp_iudata_64.ds_count = MIN_FCP_RESPONSE_SIZE + sense_length;
1475                                         } else {
1476                                                 cto->rsp.m2.u.ct_fcp_rsp_iudata_32.ds_base = DMA_LO32(addr);
1477                                                 cto->rsp.m2.u.ct_fcp_rsp_iudata_32.ds_count = MIN_FCP_RESPONSE_SIZE + sense_length;
1478                                         }
1479                                 }
1480                                 if (sense_length) {
1481                                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO2[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d sense: %x %x/%x/%x", __func__,
1482                                             cto->ct_rxid, ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cso->scsi_status, cto->ct_flags, cto->ct_resid,
1483                                             cso->sense_data.error_code, cso->sense_data.sense_buf[1], cso->sense_data.sense_buf[11], cso->sense_data.sense_buf[12]);
1484                                 } else {
1485                                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO2[0x%x] seq %u nc %d CDB0=%x sstatus=0x%x flags=0x%x resid=%d", __func__, cto->ct_rxid,
1486                                             ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cso->scsi_status, cto->ct_flags, cto->ct_resid);
1487                                 }
1488                                 atp->state = ATPD_STATE_LAST_CTIO;
1489                         }
1490
1491                         if (xfrlen != 0) {
1492                                 cto->ct_flags |= CT2_FLAG_MODE0;
1493                                 if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1494                                         cto->ct_flags |= CT2_DATA_IN;
1495                                 } else {
1496                                         cto->ct_flags |= CT2_DATA_OUT;
1497                                 }
1498
1499                                 cto->ct_reloff = atp->bytes_xfered + atp->bytes_in_transit;
1500                                 cto->rsp.m0.ct_xfrlen = xfrlen;
1501
1502                                 if (sendstatus) {
1503                                         resid = atp->orig_datalen - atp->bytes_xfered - xfrlen;
1504                                         if (cso->scsi_status == SCSI_STATUS_OK && resid == 0 /*&& fctape == 0*/) {
1505                                                 cto->ct_flags |= CT2_SENDSTATUS;
1506                                                 atp->state = ATPD_STATE_LAST_CTIO;
1507                                                 if (fctape) {
1508                                                         cto->ct_flags |= CT2_CONFIRM;
1509                                                 }
1510                                         } else {
1511                                                 atp->sendst = 1;        /* send status later */
1512                                                 cto->ct_header.rqs_seqno &= ~ATPD_SEQ_NOTIFY_CAM;
1513                                                 atp->state = ATPD_STATE_CTIO;
1514                                         }
1515                                 } else {
1516                                         atp->state = ATPD_STATE_CTIO;
1517                                 }
1518                         }
1519                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO2[%x] seq %u nc %d CDB0=%x scsi status %x flags %x resid %d xfrlen %u offset %u", __func__, cto->ct_rxid,
1520                             ATPD_GET_SEQNO(cto), ATPD_GET_NCAM(cto), atp->cdb0, cso->scsi_status, cto->ct_flags, cto->ct_resid, cso->dxfer_len, atp->bytes_xfered);
1521                 }
1522
1523                 if (isp_get_pcmd(isp, ccb)) {
1524                         ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "out of PCMDs\n");
1525                         TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
1526                         break;
1527                 }
1528                 handle = isp_allocate_handle(isp, ccb, ISP_HANDLE_TARGET);
1529                 if (handle == 0) {
1530                         ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "No XFLIST pointers for %s\n", __func__);
1531                         TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
1532                         isp_free_pcmd(isp, ccb);
1533                         break;
1534                 }
1535                 atp->bytes_in_transit += xfrlen;
1536                 PISP_PCMD(ccb)->datalen = xfrlen;
1537
1538
1539                 /*
1540                  * Call the dma setup routines for this entry (and any subsequent
1541                  * CTIOs) if there's data to move, and then tell the f/w it's got
1542                  * new things to play with. As with isp_start's usage of DMA setup,
1543                  * any swizzling is done in the machine dependent layer. Because
1544                  * of this, we put the request onto the queue area first in native
1545                  * format.
1546                  */
1547
1548                 if (IS_24XX(isp)) {
1549                         ct7_entry_t *cto = (ct7_entry_t *) local;
1550                         cto->ct_syshandle = handle;
1551                 } else {
1552                         ct2_entry_t *cto = (ct2_entry_t *) local;
1553                         cto->ct_syshandle = handle;
1554                 }
1555
1556                 dmaresult = ISP_DMASETUP(isp, cso, (ispreq_t *) local);
1557                 if (dmaresult != CMD_QUEUED) {
1558                         isp_destroy_handle(isp, handle);
1559                         isp_free_pcmd(isp, ccb);
1560                         if (dmaresult == CMD_EAGAIN) {
1561                                 TAILQ_INSERT_HEAD(waitq, &ccb->ccb_h, sim_links.tqe);
1562                                 break;
1563                         }
1564                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1565                         xpt_done(ccb);
1566                         continue;
1567                 }
1568                 ccb->ccb_h.status = CAM_REQ_INPROG | CAM_SIM_QUEUED;
1569                 if (xfrlen) {
1570                         ccb->ccb_h.spriv_field0 = atp->bytes_xfered;
1571                 } else {
1572                         ccb->ccb_h.spriv_field0 = ~0;
1573                 }
1574                 atp->ctcnt++;
1575                 atp->seqno++;
1576         }
1577 }
1578
1579 static void
1580 isp_refire_putback_atio(void *arg)
1581 {
1582         union ccb *ccb = arg;
1583
1584         ISP_ASSERT_LOCKED((ispsoftc_t *)XS_ISP(ccb));
1585         isp_target_putback_atio(ccb);
1586 }
1587
1588 static void
1589 isp_refire_notify_ack(void *arg)
1590 {
1591         isp_tna_t *tp  = arg;
1592         ispsoftc_t *isp = tp->isp;
1593
1594         ISP_ASSERT_LOCKED(isp);
1595         if (isp_notify_ack(isp, tp->not)) {
1596                 callout_schedule(&tp->timer, 5);
1597         } else {
1598                 free(tp, M_DEVBUF);
1599         }
1600 }
1601
1602
1603 static void
1604 isp_target_putback_atio(union ccb *ccb)
1605 {
1606         ispsoftc_t *isp = XS_ISP(ccb);
1607         struct ccb_scsiio *cso = &ccb->csio;
1608         at2_entry_t local, *at = &local;
1609
1610         ISP_MEMZERO(at, sizeof (at2_entry_t));
1611         at->at_header.rqs_entry_type = RQSTYPE_ATIO2;
1612         at->at_header.rqs_entry_count = 1;
1613         if (ISP_CAP_SCCFW(isp)) {
1614                 at->at_scclun = (uint16_t) ccb->ccb_h.target_lun;
1615         } else {
1616                 at->at_lun = (uint8_t) ccb->ccb_h.target_lun;
1617         }
1618         at->at_status = CT_OK;
1619         at->at_rxid = cso->tag_id;
1620         at->at_iid = cso->ccb_h.target_id;
1621         if (isp_target_put_entry(isp, at)) {
1622                 callout_reset(&PISP_PCMD(ccb)->wdog, 10,
1623                     isp_refire_putback_atio, ccb);
1624         } else
1625                 isp_complete_ctio(ccb);
1626 }
1627
1628 static void
1629 isp_complete_ctio(union ccb *ccb)
1630 {
1631         if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_INPROG) {
1632                 ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
1633                 xpt_done(ccb);
1634         }
1635 }
1636
1637 static void
1638 isp_handle_platform_atio2(ispsoftc_t *isp, at2_entry_t *aep)
1639 {
1640         fcparam *fcp;
1641         lun_id_t lun;
1642         fcportdb_t *lp;
1643         tstate_t *tptr;
1644         struct ccb_accept_tio *atiop;
1645         uint16_t nphdl;
1646         atio_private_data_t *atp;
1647         inot_private_data_t *ntp;
1648
1649         /*
1650          * The firmware status (except for the QLTM_SVALID bit)
1651          * indicates why this ATIO was sent to us.
1652          *
1653          * If QLTM_SVALID is set, the firmware has recommended Sense Data.
1654          */
1655         if ((aep->at_status & ~QLTM_SVALID) != AT_CDB) {
1656                 isp_prt(isp, ISP_LOGWARN, "bogus atio (0x%x) leaked to platform", aep->at_status);
1657                 isp_endcmd(isp, aep, NIL_HANDLE, 0, SCSI_STATUS_BUSY, 0);
1658                 return;
1659         }
1660
1661         fcp = FCPARAM(isp, 0);
1662         if (ISP_CAP_SCCFW(isp)) {
1663                 lun = aep->at_scclun;
1664         } else {
1665                 lun = aep->at_lun;
1666         }
1667         if (ISP_CAP_2KLOGIN(isp)) {
1668                 nphdl = ((at2e_entry_t *)aep)->at_iid;
1669         } else {
1670                 nphdl = aep->at_iid;
1671         }
1672         tptr = get_lun_statep(isp, 0, lun);
1673         if (tptr == NULL) {
1674                 tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
1675                 if (tptr == NULL) {
1676                         isp_prt(isp, ISP_LOGWARN, "%s: [0x%x] no state pointer for lun %d or wildcard", __func__, aep->at_rxid, lun);
1677                         if (lun == 0) {
1678                                 isp_endcmd(isp, aep, nphdl, 0, SCSI_STATUS_BUSY, 0);
1679                         } else {
1680                                 isp_endcmd(isp, aep, nphdl, 0, SCSI_STATUS_CHECK_COND | ECMD_SVALID | (0x5 << 12) | (0x25 << 16), 0);
1681                         }
1682                         return;
1683                 }
1684         }
1685
1686         /*
1687          * Start any commands pending resources first.
1688          */
1689         if (isp_atio_restart(isp, 0, tptr))
1690                 goto noresrc;
1691
1692         atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
1693         if (atiop == NULL) {
1694                 goto noresrc;
1695         }
1696
1697         atp = isp_get_atpd(isp, 0, aep->at_rxid);
1698         if (atp == NULL) {
1699                 goto noresrc;
1700         }
1701
1702         atp->state = ATPD_STATE_ATIO;
1703         SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
1704         ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, atiop->ccb_h.path, "Take FREE ATIO\n");
1705         atiop->ccb_h.target_id = fcp->isp_loopid;
1706         atiop->ccb_h.target_lun = lun;
1707
1708         /*
1709          * We don't get 'suggested' sense data as we do with SCSI cards.
1710          */
1711         atiop->sense_len = 0;
1712
1713         /*
1714          * If we're not in the port database, add ourselves.
1715          */
1716         if (IS_2100(isp))
1717                 atiop->init_id = nphdl;
1718         else {
1719                 if (isp_find_pdb_by_handle(isp, 0, nphdl, &lp)) {
1720                         atiop->init_id = FC_PORTDB_TGT(isp, 0, lp);
1721                 } else {
1722                         isp_prt(isp, ISP_LOGTINFO, "%s: port %x isn't in PDB",
1723                             __func__, nphdl);
1724                         isp_dump_portdb(isp, 0);
1725                         isp_endcmd(isp, aep, NIL_HANDLE, 0, ECMD_TERMINATE, 0);
1726                         return;
1727                 }
1728         }
1729         atiop->cdb_len = ATIO2_CDBLEN;
1730         ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cdb, ATIO2_CDBLEN);
1731         atiop->ccb_h.status = CAM_CDB_RECVD;
1732         atiop->tag_id = atp->tag;
1733         switch (aep->at_taskflags & ATIO2_TC_ATTR_MASK) {
1734         case ATIO2_TC_ATTR_SIMPLEQ:
1735                 atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
1736                 atiop->tag_action = MSG_SIMPLE_Q_TAG;
1737                 break;
1738         case ATIO2_TC_ATTR_HEADOFQ:
1739                 atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
1740                 atiop->tag_action = MSG_HEAD_OF_Q_TAG;
1741                 break;
1742         case ATIO2_TC_ATTR_ORDERED:
1743                 atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
1744                 atiop->tag_action = MSG_ORDERED_Q_TAG;
1745                 break;
1746         case ATIO2_TC_ATTR_ACAQ:                /* ?? */
1747         case ATIO2_TC_ATTR_UNTAGGED:
1748         default:
1749                 atiop->tag_action = 0;
1750                 break;
1751         }
1752
1753         atp->orig_datalen = aep->at_datalen;
1754         atp->bytes_xfered = 0;
1755         atp->lun = lun;
1756         atp->nphdl = nphdl;
1757         atp->sid = PORT_ANY;
1758         atp->oxid = aep->at_oxid;
1759         atp->cdb0 = aep->at_cdb[0];
1760         atp->tattr = aep->at_taskflags & ATIO2_TC_ATTR_MASK;
1761         atp->state = ATPD_STATE_CAM;
1762         xpt_done((union ccb *)atiop);
1763         isp_prt(isp, ISP_LOGTDEBUG0, "ATIO2[0x%x] CDB=0x%x lun %d datalen %u", aep->at_rxid, atp->cdb0, lun, atp->orig_datalen);
1764         return;
1765 noresrc:
1766         ntp = isp_get_ntpd(isp, 0);
1767         if (ntp == NULL) {
1768                 isp_endcmd(isp, aep, nphdl, 0, SCSI_STATUS_BUSY, 0);
1769                 return;
1770         }
1771         memcpy(ntp->data, aep, QENTRY_LEN);
1772         STAILQ_INSERT_TAIL(&tptr->restart_queue, ntp, next);
1773 }
1774
1775 static void
1776 isp_handle_platform_atio7(ispsoftc_t *isp, at7_entry_t *aep)
1777 {
1778         int cdbxlen;
1779         lun_id_t lun;
1780         uint16_t chan, nphdl = NIL_HANDLE;
1781         uint32_t did, sid;
1782         fcportdb_t *lp;
1783         tstate_t *tptr;
1784         struct ccb_accept_tio *atiop;
1785         atio_private_data_t *atp = NULL;
1786         atio_private_data_t *oatp;
1787         inot_private_data_t *ntp;
1788
1789         did = (aep->at_hdr.d_id[0] << 16) | (aep->at_hdr.d_id[1] << 8) | aep->at_hdr.d_id[2];
1790         sid = (aep->at_hdr.s_id[0] << 16) | (aep->at_hdr.s_id[1] << 8) | aep->at_hdr.s_id[2];
1791         lun = CAM_EXTLUN_BYTE_SWIZZLE(be64dec(aep->at_cmnd.fcp_cmnd_lun));
1792
1793         if (ISP_CAP_MULTI_ID(isp) && isp->isp_nchan > 1) {
1794                 /* Channel has to be derived from D_ID */
1795                 isp_find_chan_by_did(isp, did, &chan);
1796                 if (chan == ISP_NOCHAN) {
1797                         isp_prt(isp, ISP_LOGWARN,
1798                             "%s: [RX_ID 0x%x] D_ID %x not found on any channel",
1799                             __func__, aep->at_rxid, did);
1800                         isp_endcmd(isp, aep, NIL_HANDLE, ISP_NOCHAN,
1801                             ECMD_TERMINATE, 0);
1802                         return;
1803                 }
1804         } else {
1805                 chan = 0;
1806         }
1807
1808         /*
1809          * Find the PDB entry for this initiator
1810          */
1811         if (isp_find_pdb_by_portid(isp, chan, sid, &lp) == 0) {
1812                 /*
1813                  * If we're not in the port database terminate the exchange.
1814                  */
1815                 isp_prt(isp, ISP_LOGTINFO, "%s: [RX_ID 0x%x] D_ID 0x%06x found on Chan %d for S_ID 0x%06x wasn't in PDB already",
1816                     __func__, aep->at_rxid, did, chan, sid);
1817                 isp_dump_portdb(isp, chan);
1818                 isp_endcmd(isp, aep, NIL_HANDLE, chan, ECMD_TERMINATE, 0);
1819                 return;
1820         }
1821         nphdl = lp->handle;
1822
1823         /*
1824          * Get the tstate pointer
1825          */
1826         tptr = get_lun_statep(isp, chan, lun);
1827         if (tptr == NULL) {
1828                 tptr = get_lun_statep(isp, chan, CAM_LUN_WILDCARD);
1829                 if (tptr == NULL) {
1830                         isp_prt(isp, ISP_LOGWARN,
1831                             "%s: [0x%x] no state pointer for lun %jx or wildcard",
1832                             __func__, aep->at_rxid, (uintmax_t)lun);
1833                         if (lun == 0) {
1834                                 isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_BUSY, 0);
1835                         } else {
1836                                 isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_CHECK_COND | ECMD_SVALID | (0x5 << 12) | (0x25 << 16), 0);
1837                         }
1838                         return;
1839                 }
1840         }
1841
1842         /*
1843          * Start any commands pending resources first.
1844          */
1845         if (isp_atio_restart(isp, chan, tptr))
1846                 goto noresrc;
1847
1848         /*
1849          * If the f/w is out of resources, just send a BUSY status back.
1850          */
1851         if (aep->at_rxid == AT7_NORESRC_RXID) {
1852                 isp_endcmd(isp, aep, nphdl, chan, SCSI_BUSY, 0);
1853                 return;
1854         }
1855
1856         /*
1857          * If we're out of resources, just send a BUSY status back.
1858          */
1859         atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
1860         if (atiop == NULL) {
1861                 isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] out of atios", aep->at_rxid);
1862                 goto noresrc;
1863         }
1864
1865         oatp = isp_find_atpd(isp, chan, aep->at_rxid);
1866         if (oatp) {
1867                 isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] tag wraparound in isp_handle_platforms_atio7 (N-Port Handle 0x%04x S_ID 0x%04x OX_ID 0x%04x) oatp state %d",
1868                     aep->at_rxid, nphdl, sid, aep->at_hdr.ox_id, oatp->state);
1869                 /*
1870                  * It's not a "no resource" condition- but we can treat it like one
1871                  */
1872                 goto noresrc;
1873         }
1874         atp = isp_get_atpd(isp, chan, aep->at_rxid);
1875         if (atp == NULL) {
1876                 isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] out of atps", aep->at_rxid);
1877                 goto noresrc;
1878         }
1879         atp->word3 = lp->prli_word3;
1880         atp->state = ATPD_STATE_ATIO;
1881         SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
1882         ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, atiop->ccb_h.path, "Take FREE ATIO\n");
1883         atiop->init_id = FC_PORTDB_TGT(isp, chan, lp);
1884         atiop->ccb_h.target_id = FCPARAM(isp, chan)->isp_loopid;
1885         atiop->ccb_h.target_lun = lun;
1886         atiop->sense_len = 0;
1887         cdbxlen = aep->at_cmnd.fcp_cmnd_alen_datadir >> FCP_CMND_ADDTL_CDBLEN_SHIFT;
1888         if (cdbxlen) {
1889                 isp_prt(isp, ISP_LOGWARN, "additional CDBLEN ignored");
1890         }
1891         cdbxlen = sizeof (aep->at_cmnd.cdb_dl.sf.fcp_cmnd_cdb);
1892         ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cmnd.cdb_dl.sf.fcp_cmnd_cdb, cdbxlen);
1893         atiop->cdb_len = cdbxlen;
1894         atiop->ccb_h.status = CAM_CDB_RECVD;
1895         atiop->tag_id = atp->tag;
1896         switch (aep->at_cmnd.fcp_cmnd_task_attribute & FCP_CMND_TASK_ATTR_MASK) {
1897         case FCP_CMND_TASK_ATTR_SIMPLE:
1898                 atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
1899                 atiop->tag_action = MSG_SIMPLE_Q_TAG;
1900                 break;
1901         case FCP_CMND_TASK_ATTR_HEAD:
1902                 atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
1903                 atiop->tag_action = MSG_HEAD_OF_Q_TAG;
1904                 break;
1905         case FCP_CMND_TASK_ATTR_ORDERED:
1906                 atiop->ccb_h.flags |= CAM_TAG_ACTION_VALID;
1907                 atiop->tag_action = MSG_ORDERED_Q_TAG;
1908                 break;
1909         default:
1910                 /* FALLTHROUGH */
1911         case FCP_CMND_TASK_ATTR_ACA:
1912         case FCP_CMND_TASK_ATTR_UNTAGGED:
1913                 atiop->tag_action = 0;
1914                 break;
1915         }
1916         atp->orig_datalen = aep->at_cmnd.cdb_dl.sf.fcp_cmnd_dl;
1917         atp->bytes_xfered = 0;
1918         atp->lun = lun;
1919         atp->nphdl = nphdl;
1920         atp->sid = sid;
1921         atp->did = did;
1922         atp->oxid = aep->at_hdr.ox_id;
1923         atp->rxid = aep->at_hdr.rx_id;
1924         atp->cdb0 = atiop->cdb_io.cdb_bytes[0];
1925         atp->tattr = aep->at_cmnd.fcp_cmnd_task_attribute & FCP_CMND_TASK_ATTR_MASK;
1926         atp->state = ATPD_STATE_CAM;
1927         isp_prt(isp, ISP_LOGTDEBUG0, "ATIO7[0x%x] CDB=0x%x lun %jx datalen %u",
1928             aep->at_rxid, atp->cdb0, (uintmax_t)lun, atp->orig_datalen);
1929         xpt_done((union ccb *)atiop);
1930         return;
1931 noresrc:
1932         if (atp)
1933                 isp_put_atpd(isp, chan, atp);
1934         ntp = isp_get_ntpd(isp, chan);
1935         if (ntp == NULL) {
1936                 isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_BUSY, 0);
1937                 return;
1938         }
1939         memcpy(ntp->data, aep, QENTRY_LEN);
1940         STAILQ_INSERT_TAIL(&tptr->restart_queue, ntp, next);
1941 }
1942
1943
1944 /*
1945  * Handle starting an SRR (sequence retransmit request)
1946  * We get here when we've gotten the immediate notify
1947  * and the return of all outstanding CTIOs for this
1948  * transaction.
1949  */
1950 static void
1951 isp_handle_srr_start(ispsoftc_t *isp, atio_private_data_t *atp)
1952 {
1953         in_fcentry_24xx_t *inot;
1954         uint32_t srr_off, ccb_off, ccb_len, ccb_end;
1955         union ccb *ccb;
1956
1957         inot = (in_fcentry_24xx_t *)atp->srr;
1958         srr_off = inot->in_srr_reloff_lo | (inot->in_srr_reloff_hi << 16);
1959         ccb = atp->srr_ccb;
1960         atp->srr_ccb = NULL;
1961         atp->nsrr++;
1962         if (ccb == NULL) {
1963                 isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] null ccb", atp->tag);
1964                 goto fail;
1965         }
1966
1967         ccb_off = ccb->ccb_h.spriv_field0;
1968         ccb_len = ccb->csio.dxfer_len;
1969         ccb_end = (ccb_off == ~0)? ~0 : ccb_off + ccb_len;
1970
1971         switch (inot->in_srr_iu) {
1972         case R_CTL_INFO_SOLICITED_DATA:
1973                 /*
1974                  * We have to restart a FCP_DATA data out transaction
1975                  */
1976                 atp->sendst = 0;
1977                 atp->bytes_xfered = srr_off;
1978                 if (ccb_len == 0) {
1979                         isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] SRR offset 0x%x but current CCB doesn't transfer data", atp->tag, srr_off);
1980                         goto mdp;
1981                 }
1982                 if (srr_off < ccb_off || ccb_off > srr_off + ccb_len) {
1983                         isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] SRR offset 0x%x not covered by current CCB data range [0x%x..0x%x]", atp->tag, srr_off, ccb_off, ccb_end);
1984                         goto mdp;
1985                 }
1986                 isp_prt(isp, ISP_LOGWARN, "SRR[0x%x] SRR offset 0x%x covered by current CCB data range [0x%x..0x%x]", atp->tag, srr_off, ccb_off, ccb_end);
1987                 break;
1988         case R_CTL_INFO_COMMAND_STATUS:
1989                 isp_prt(isp, ISP_LOGTINFO, "SRR[0x%x] Got an FCP RSP SRR- resending status", atp->tag);
1990                 atp->sendst = 1;
1991                 /*
1992                  * We have to restart a FCP_RSP IU transaction
1993                  */
1994                 break;
1995         case R_CTL_INFO_DATA_DESCRIPTOR:
1996                 /*
1997                  * We have to restart an FCP DATA in transaction
1998                  */
1999                 isp_prt(isp, ISP_LOGWARN, "Got an FCP DATA IN SRR- dropping");
2000                 goto fail;
2001
2002         default:
2003                 isp_prt(isp, ISP_LOGWARN, "Got an unknown information (%x) SRR- dropping", inot->in_srr_iu);
2004                 goto fail;
2005         }
2006
2007         /*
2008          * We can't do anything until this is acked, so we might as well start it now.
2009          * We aren't going to do the usual asynchronous ack issue because we need
2010          * to make sure this gets on the wire first.
2011          */
2012         if (isp_notify_ack(isp, inot)) {
2013                 isp_prt(isp, ISP_LOGWARN, "could not push positive ack for SRR- you lose");
2014                 goto fail;
2015         }
2016         isp_target_start_ctio(isp, ccb, FROM_SRR);
2017         return;
2018 fail:
2019         inot->in_reserved = 1;
2020         isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
2021         ccb->ccb_h.status &= ~CAM_STATUS_MASK;
2022         ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
2023         isp_complete_ctio(ccb);
2024         return;
2025 mdp:
2026         if (isp_notify_ack(isp, inot)) {
2027                 isp_prt(isp, ISP_LOGWARN, "could not push positive ack for SRR- you lose");
2028                 goto fail;
2029         }
2030         ccb->ccb_h.status &= ~CAM_STATUS_MASK;
2031         ccb->ccb_h.status = CAM_MESSAGE_RECV;
2032         /*
2033          * This is not a strict interpretation of MDP, but it's close
2034          */
2035         ccb->csio.msg_ptr = &ccb->csio.sense_data.sense_buf[SSD_FULL_SIZE - 16];
2036         ccb->csio.msg_len = 7;
2037         ccb->csio.msg_ptr[0] = MSG_EXTENDED;
2038         ccb->csio.msg_ptr[1] = 5;
2039         ccb->csio.msg_ptr[2] = 0;       /* modify data pointer */
2040         ccb->csio.msg_ptr[3] = srr_off >> 24;
2041         ccb->csio.msg_ptr[4] = srr_off >> 16;
2042         ccb->csio.msg_ptr[5] = srr_off >> 8;
2043         ccb->csio.msg_ptr[6] = srr_off;
2044         isp_complete_ctio(ccb);
2045 }
2046
2047
2048 static void
2049 isp_handle_platform_srr(ispsoftc_t *isp, isp_notify_t *notify)
2050 {
2051         in_fcentry_24xx_t *inot = notify->nt_lreserved;
2052         atio_private_data_t *atp;
2053         uint32_t tag = notify->nt_tagval & 0xffffffff;
2054
2055         atp = isp_find_atpd(isp, notify->nt_channel, tag);
2056         if (atp == NULL) {
2057                 isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x in SRR Notify",
2058                     __func__, tag);
2059                 isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, inot);
2060                 return;
2061         }
2062         atp->srr_notify_rcvd = 1;
2063         memcpy(atp->srr, inot, sizeof (atp->srr));
2064         isp_prt(isp, ISP_LOGTINFO, "SRR[0x%x] flags 0x%x srr_iu %x reloff 0x%x",
2065             inot->in_rxid, inot->in_flags, inot->in_srr_iu,
2066             ((uint32_t)inot->in_srr_reloff_hi << 16) | inot->in_srr_reloff_lo);
2067         if (atp->srr_ccb)
2068                 isp_handle_srr_start(isp, atp);
2069 }
2070
2071 static void
2072 isp_handle_platform_ctio(ispsoftc_t *isp, void *arg)
2073 {
2074         union ccb *ccb;
2075         int sentstatus = 0, ok = 0, notify_cam = 0, failure = 0;
2076         atio_private_data_t *atp = NULL;
2077         int bus;
2078         uint32_t handle, data_requested, resid;
2079
2080         handle = ((ct2_entry_t *)arg)->ct_syshandle;
2081         ccb = isp_find_xs(isp, handle);
2082         if (ccb == NULL) {
2083                 isp_print_bytes(isp, "null ccb in isp_handle_platform_ctio", QENTRY_LEN, arg);
2084                 return;
2085         }
2086         isp_destroy_handle(isp, handle);
2087         resid = data_requested = PISP_PCMD(ccb)->datalen;
2088         isp_free_pcmd(isp, ccb);
2089
2090         bus = XS_CHANNEL(ccb);
2091         if (IS_24XX(isp)) {
2092                 atp = isp_find_atpd(isp, bus, ((ct7_entry_t *)arg)->ct_rxid);
2093         } else {
2094                 atp = isp_find_atpd(isp, bus, ((ct2_entry_t *)arg)->ct_rxid);
2095         }
2096         if (atp == NULL) {
2097                 /*
2098                  * XXX: isp_clear_commands() generates fake CTIO with zero
2099                  * ct_rxid value, filling only ct_syshandle.  Workaround
2100                  * that using tag_id from the CCB, pointed by ct_syshandle.
2101                  */
2102                 atp = isp_find_atpd(isp, bus, ccb->csio.tag_id);
2103         }
2104         if (atp == NULL) {
2105                 isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x after I/O", __func__, ccb->csio.tag_id);
2106                 return;
2107         }
2108         KASSERT((atp->ctcnt > 0), ("ctio count not greater than zero"));
2109         atp->bytes_in_transit -= data_requested;
2110         atp->ctcnt -= 1;
2111         ccb->ccb_h.status &= ~CAM_STATUS_MASK;
2112
2113         if (IS_24XX(isp)) {
2114                 ct7_entry_t *ct = arg;
2115
2116                 if (ct->ct_nphdl == CT7_SRR) {
2117                         atp->srr_ccb = ccb;
2118                         if (atp->srr_notify_rcvd)
2119                                 isp_handle_srr_start(isp, atp);
2120                         return;
2121                 }
2122                 if (ct->ct_nphdl == CT_HBA_RESET) {
2123                         sentstatus = (ccb->ccb_h.flags & CAM_SEND_STATUS) &&
2124                             (atp->sendst == 0);
2125                         failure = CAM_UNREC_HBA_ERROR;
2126                 } else {
2127                         sentstatus = ct->ct_flags & CT7_SENDSTATUS;
2128                         ok = (ct->ct_nphdl == CT7_OK);
2129                         notify_cam = (ct->ct_header.rqs_seqno & ATPD_SEQ_NOTIFY_CAM) != 0;
2130                         if ((ct->ct_flags & CT7_DATAMASK) != CT7_NO_DATA)
2131                                 resid = ct->ct_resid;
2132                 }
2133                 isp_prt(isp, ok? ISP_LOGTDEBUG0 : ISP_LOGWARN, "%s: CTIO7[%x] seq %u nc %d sts 0x%x flg 0x%x sns %d resid %d %s", __func__, ct->ct_rxid, ATPD_GET_SEQNO(ct),
2134                    notify_cam, ct->ct_nphdl, ct->ct_flags, (ccb->ccb_h.status & CAM_SENT_SENSE) != 0, resid, sentstatus? "FIN" : "MID");
2135         } else {
2136                 ct2_entry_t *ct = arg;
2137                 if (ct->ct_status == CT_SRR) {
2138                         atp->srr_ccb = ccb;
2139                         if (atp->srr_notify_rcvd)
2140                                 isp_handle_srr_start(isp, atp);
2141                         isp_target_putback_atio(ccb);
2142                         return;
2143                 }
2144                 if (ct->ct_status == CT_HBA_RESET) {
2145                         sentstatus = (ccb->ccb_h.flags & CAM_SEND_STATUS) &&
2146                             (atp->sendst == 0);
2147                         failure = CAM_UNREC_HBA_ERROR;
2148                 } else {
2149                         sentstatus = ct->ct_flags & CT2_SENDSTATUS;
2150                         ok = (ct->ct_status & ~QLTM_SVALID) == CT_OK;
2151                         notify_cam = (ct->ct_header.rqs_seqno & ATPD_SEQ_NOTIFY_CAM) != 0;
2152                         if ((ct->ct_flags & CT2_DATAMASK) != CT2_NO_DATA)
2153                                 resid = ct->ct_resid;
2154                 }
2155                 isp_prt(isp, ok? ISP_LOGTDEBUG0 : ISP_LOGWARN, "%s: CTIO2[%x] seq %u nc %d sts 0x%x flg 0x%x sns %d resid %d %s", __func__, ct->ct_rxid, ATPD_GET_SEQNO(ct),
2156                     notify_cam, ct->ct_status, ct->ct_flags, (ccb->ccb_h.status & CAM_SENT_SENSE) != 0, resid, sentstatus? "FIN" : "MID");
2157         }
2158         if (ok) {
2159                 if (data_requested > 0) {
2160                         atp->bytes_xfered += data_requested - resid;
2161                         ccb->csio.resid = ccb->csio.dxfer_len -
2162                             (data_requested - resid);
2163                 }
2164                 if (sentstatus && (ccb->ccb_h.flags & CAM_SEND_SENSE))
2165                         ccb->ccb_h.status |= CAM_SENT_SENSE;
2166                 ccb->ccb_h.status |= CAM_REQ_CMP;
2167         } else {
2168                 notify_cam = 1;
2169                 if (failure == CAM_UNREC_HBA_ERROR)
2170                         ccb->ccb_h.status |= CAM_UNREC_HBA_ERROR;
2171                 else
2172                         ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
2173         }
2174         atp->state = ATPD_STATE_PDON;
2175
2176         /*
2177          * We never *not* notify CAM when there has been any error (ok == 0),
2178          * so we never need to do an ATIO putback if we're not notifying CAM.
2179          */
2180         isp_prt(isp, ISP_LOGTDEBUG0, "%s CTIO[0x%x] done (ok=%d nc=%d nowsendstatus=%d ccb ss=%d)",
2181             (sentstatus)? "  FINAL " : "MIDTERM ", atp->tag, ok, notify_cam, atp->sendst, (ccb->ccb_h.flags & CAM_SEND_STATUS) != 0);
2182         if (notify_cam == 0) {
2183                 if (atp->sendst) {
2184                         isp_target_start_ctio(isp, ccb, FROM_CTIO_DONE);
2185                 }
2186                 return;
2187         }
2188
2189         /*
2190          * We are done with this ATIO if we successfully sent status.
2191          * In all other cases expect either another CTIO or XPT_ABORT.
2192          */
2193         if (ok && sentstatus)
2194                 isp_put_atpd(isp, bus, atp);
2195
2196         /*
2197          * We're telling CAM we're done with this CTIO transaction.
2198          *
2199          * 24XX cards never need an ATIO put back.
2200          *
2201          * Other cards need one put back only on error.
2202          * In the latter case, a timeout will re-fire
2203          * and try again in case we didn't have
2204          * queue resources to do so at first. In any case,
2205          * once the putback is done we do the completion
2206          * call.
2207          */
2208         if (ok || IS_24XX(isp)) {
2209                 isp_complete_ctio(ccb);
2210         } else {
2211                 isp_target_putback_atio(ccb);
2212         }
2213 }
2214
2215 static int
2216 isp_handle_platform_target_notify_ack(ispsoftc_t *isp, isp_notify_t *mp, uint32_t rsp)
2217 {
2218
2219         if (isp->isp_state != ISP_RUNSTATE) {
2220                 isp_prt(isp, ISP_LOGTINFO, "Notify Code 0x%x (qevalid=%d) acked- h/w not ready (dropping)", mp->nt_ncode, mp->nt_lreserved != NULL);
2221                 return (0);
2222         }
2223
2224         /*
2225          * This case is for a Task Management Function, which shows up as an ATIO7 entry.
2226          */
2227         if (IS_24XX(isp) && mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ATIO) {
2228                 ct7_entry_t local, *cto = &local;
2229                 at7_entry_t *aep = (at7_entry_t *)mp->nt_lreserved;
2230                 fcportdb_t *lp;
2231                 uint32_t sid;
2232                 uint16_t nphdl;
2233
2234                 sid = (aep->at_hdr.s_id[0] << 16) | (aep->at_hdr.s_id[1] << 8) | aep->at_hdr.s_id[2];
2235                 if (isp_find_pdb_by_portid(isp, mp->nt_channel, sid, &lp)) {
2236                         nphdl = lp->handle;
2237                 } else {
2238                         nphdl = NIL_HANDLE;
2239                 }
2240                 ISP_MEMZERO(&local, sizeof (local));
2241                 cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
2242                 cto->ct_header.rqs_entry_count = 1;
2243                 cto->ct_nphdl = nphdl;
2244                 cto->ct_rxid = aep->at_rxid;
2245                 cto->ct_vpidx = mp->nt_channel;
2246                 cto->ct_iid_lo = sid;
2247                 cto->ct_iid_hi = sid >> 16;
2248                 cto->ct_oxid = aep->at_hdr.ox_id;
2249                 cto->ct_flags = CT7_SENDSTATUS|CT7_NOACK|CT7_NO_DATA|CT7_FLAG_MODE1;
2250                 cto->ct_flags |= (aep->at_ta_len >> 12) << CT7_TASK_ATTR_SHIFT;
2251                 if (rsp != 0) {
2252                         cto->ct_scsi_status |= (FCP_RSPLEN_VALID << 8);
2253                         cto->rsp.m1.ct_resplen = 4;
2254                         ISP_MEMZERO(cto->rsp.m1.ct_resp, sizeof (cto->rsp.m1.ct_resp));
2255                         cto->rsp.m1.ct_resp[0] = rsp & 0xff;
2256                         cto->rsp.m1.ct_resp[1] = (rsp >> 8) & 0xff;
2257                         cto->rsp.m1.ct_resp[2] = (rsp >> 16) & 0xff;
2258                         cto->rsp.m1.ct_resp[3] = (rsp >> 24) & 0xff;
2259                 }
2260                 return (isp_target_put_entry(isp, &local));
2261         }
2262
2263         /*
2264          * This case is for a responding to an ABTS frame
2265          */
2266         if (IS_24XX(isp) && mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD) {
2267
2268                 /*
2269                  * Overload nt_need_ack here to mark whether we've terminated the associated command.
2270                  */
2271                 if (mp->nt_need_ack) {
2272                         uint8_t storage[QENTRY_LEN];
2273                         ct7_entry_t *cto = (ct7_entry_t *) storage;
2274                         abts_t *abts = (abts_t *)mp->nt_lreserved;
2275
2276                         ISP_MEMZERO(cto, sizeof (ct7_entry_t));
2277                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: [%x] terminating after ABTS received", __func__, abts->abts_rxid_task);
2278                         cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
2279                         cto->ct_header.rqs_entry_count = 1;
2280                         cto->ct_nphdl = mp->nt_nphdl;
2281                         cto->ct_rxid = abts->abts_rxid_task;
2282                         cto->ct_iid_lo = mp->nt_sid;
2283                         cto->ct_iid_hi = mp->nt_sid >> 16;
2284                         cto->ct_oxid = abts->abts_ox_id;
2285                         cto->ct_vpidx = mp->nt_channel;
2286                         cto->ct_flags = CT7_NOACK|CT7_TERMINATE;
2287                         if (isp_target_put_entry(isp, cto)) {
2288                                 return (ENOMEM);
2289                         }
2290                         mp->nt_need_ack = 0;
2291                 }
2292                 if (isp_acknak_abts(isp, mp->nt_lreserved, 0) == ENOMEM) {
2293                         return (ENOMEM);
2294                 } else {
2295                         return (0);
2296                 }
2297         }
2298
2299         /*
2300          * Handle logout cases here
2301          */
2302         if (mp->nt_ncode == NT_GLOBAL_LOGOUT) {
2303                 isp_del_all_wwn_entries(isp, mp->nt_channel);
2304         }
2305
2306         if (mp->nt_ncode == NT_LOGOUT) {
2307                 if (!IS_2100(isp) && IS_FC(isp)) {
2308                         isp_del_wwn_entries(isp, mp);
2309                 }
2310         }
2311
2312         /*
2313          * General purpose acknowledgement
2314          */
2315         if (mp->nt_need_ack) {
2316                 isp_prt(isp, ISP_LOGTINFO, "Notify Code 0x%x (qevalid=%d) being acked", mp->nt_ncode, mp->nt_lreserved != NULL);
2317                 /*
2318                  * Don't need to use the guaranteed send because the caller can retry
2319                  */
2320                 return (isp_notify_ack(isp, mp->nt_lreserved));
2321         }
2322         return (0);
2323 }
2324
2325 /*
2326  * Handle task management functions.
2327  *
2328  * We show up here with a notify structure filled out.
2329  *
2330  * The nt_lreserved tag points to the original queue entry
2331  */
2332 static void
2333 isp_handle_platform_target_tmf(ispsoftc_t *isp, isp_notify_t *notify)
2334 {
2335         tstate_t *tptr;
2336         fcportdb_t *lp;
2337         struct ccb_immediate_notify *inot;
2338         inot_private_data_t *ntp = NULL;
2339         atio_private_data_t *atp;
2340         lun_id_t lun;
2341
2342         isp_prt(isp, ISP_LOGTDEBUG0, "%s: code 0x%x sid  0x%x tagval 0x%016llx chan %d lun %x", __func__, notify->nt_ncode,
2343             notify->nt_sid, (unsigned long long) notify->nt_tagval, notify->nt_channel, notify->nt_lun);
2344         if (notify->nt_lun == LUN_ANY) {
2345                 if (notify->nt_tagval == TAG_ANY) {
2346                         lun = CAM_LUN_WILDCARD;
2347                 } else {
2348                         atp = isp_find_atpd(isp, notify->nt_channel,
2349                             notify->nt_tagval & 0xffffffff);
2350                         lun = atp ? atp->lun : CAM_LUN_WILDCARD;
2351                 }
2352         } else {
2353                 lun = notify->nt_lun;
2354         }
2355         tptr = get_lun_statep(isp, notify->nt_channel, lun);
2356         if (tptr == NULL) {
2357                 tptr = get_lun_statep(isp, notify->nt_channel, CAM_LUN_WILDCARD);
2358                 if (tptr == NULL) {
2359                         isp_prt(isp, ISP_LOGWARN, "%s: no state pointer found for chan %d lun 0x%x", __func__, notify->nt_channel, lun);
2360                         goto bad;
2361                 }
2362         }
2363         inot = (struct ccb_immediate_notify *) SLIST_FIRST(&tptr->inots);
2364         if (inot == NULL) {
2365                 isp_prt(isp, ISP_LOGWARN, "%s: out of immediate notify structures for chan %d lun 0x%x", __func__, notify->nt_channel, lun);
2366                 goto bad;
2367         }
2368
2369         if (isp_find_pdb_by_portid(isp, notify->nt_channel, notify->nt_sid, &lp) == 0 &&
2370             isp_find_pdb_by_handle(isp, notify->nt_channel, notify->nt_nphdl, &lp) == 0) {
2371                 inot->initiator_id = CAM_TARGET_WILDCARD;
2372         } else {
2373                 inot->initiator_id = FC_PORTDB_TGT(isp, notify->nt_channel, lp);
2374         }
2375         inot->seq_id = notify->nt_tagval;
2376         inot->tag_id = notify->nt_tagval >> 32;
2377
2378         switch (notify->nt_ncode) {
2379         case NT_ABORT_TASK:
2380                 isp_target_mark_aborted_early(isp, notify->nt_channel, tptr, inot->tag_id);
2381                 inot->arg = MSG_ABORT_TASK;
2382                 break;
2383         case NT_ABORT_TASK_SET:
2384                 isp_target_mark_aborted_early(isp, notify->nt_channel, tptr, TAG_ANY);
2385                 inot->arg = MSG_ABORT_TASK_SET;
2386                 break;
2387         case NT_CLEAR_ACA:
2388                 inot->arg = MSG_CLEAR_ACA;
2389                 break;
2390         case NT_CLEAR_TASK_SET:
2391                 inot->arg = MSG_CLEAR_TASK_SET;
2392                 break;
2393         case NT_LUN_RESET:
2394                 inot->arg = MSG_LOGICAL_UNIT_RESET;
2395                 break;
2396         case NT_TARGET_RESET:
2397                 inot->arg = MSG_TARGET_RESET;
2398                 break;
2399         case NT_QUERY_TASK_SET:
2400                 inot->arg = MSG_QUERY_TASK_SET;
2401                 break;
2402         case NT_QUERY_ASYNC_EVENT:
2403                 inot->arg = MSG_QUERY_ASYNC_EVENT;
2404                 break;
2405         default:
2406                 isp_prt(isp, ISP_LOGWARN, "%s: unknown TMF code 0x%x for chan %d lun 0x%x", __func__, notify->nt_ncode, notify->nt_channel, lun);
2407                 goto bad;
2408         }
2409
2410         ntp = isp_get_ntpd(isp, notify->nt_channel);
2411         if (ntp == NULL) {
2412                 isp_prt(isp, ISP_LOGWARN, "%s: out of inotify private structures", __func__);
2413                 goto bad;
2414         }
2415         ISP_MEMCPY(&ntp->nt, notify, sizeof (isp_notify_t));
2416         if (notify->nt_lreserved) {
2417                 ISP_MEMCPY(&ntp->data, notify->nt_lreserved, QENTRY_LEN);
2418                 ntp->nt.nt_lreserved = &ntp->data;
2419         }
2420         ntp->seq_id = notify->nt_tagval;
2421         ntp->tag_id = notify->nt_tagval >> 32;
2422
2423         SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
2424         ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, inot->ccb_h.path, "Take FREE INOT\n");
2425         inot->ccb_h.status = CAM_MESSAGE_RECV;
2426         xpt_done((union ccb *)inot);
2427         return;
2428 bad:
2429         if (notify->nt_need_ack) {
2430                 if (((isphdr_t *)notify->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD) {
2431                         if (isp_acknak_abts(isp, notify->nt_lreserved, ENOMEM)) {
2432                                 isp_prt(isp, ISP_LOGWARN, "you lose- unable to send an ACKNAK");
2433                         }
2434                 } else {
2435                         isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK, notify->nt_lreserved);
2436                 }
2437         }
2438 }
2439
2440 static void
2441 isp_target_mark_aborted_early(ispsoftc_t *isp, int chan, tstate_t *tptr, uint32_t tag_id)
2442 {
2443         atio_private_data_t *atp, *atpool;
2444         inot_private_data_t *ntp, *tmp;
2445         uint32_t this_tag_id;
2446
2447         /*
2448          * First, clean any commands pending restart
2449          */
2450         STAILQ_FOREACH_SAFE(ntp, &tptr->restart_queue, next, tmp) {
2451                 if (IS_24XX(isp))
2452                         this_tag_id = ((at7_entry_t *)ntp->data)->at_rxid;
2453                 else
2454                         this_tag_id = ((at2_entry_t *)ntp->data)->at_rxid;
2455                 if ((uint64_t)tag_id == TAG_ANY || tag_id == this_tag_id) {
2456                         isp_endcmd(isp, ntp->data, NIL_HANDLE, chan,
2457                             ECMD_TERMINATE, 0);
2458                         isp_put_ntpd(isp, chan, ntp);
2459                         STAILQ_REMOVE(&tptr->restart_queue, ntp,
2460                             inot_private_data, next);
2461                 }
2462         }
2463
2464         /*
2465          * Now mark other ones dead as well.
2466          */
2467         ISP_GET_PC(isp, chan, atpool, atpool);
2468         for (atp = atpool; atp < &atpool[ATPDPSIZE]; atp++) {
2469                 if (atp->lun != tptr->ts_lun)
2470                         continue;
2471                 if ((uint64_t)tag_id == TAG_ANY || atp->tag == tag_id)
2472                         atp->dead = 1;
2473         }
2474 }
2475 #endif
2476
2477 static void
2478 isp_cam_async(void *cbarg, uint32_t code, struct cam_path *path, void *arg)
2479 {
2480         struct cam_sim *sim;
2481         int bus, tgt;
2482         ispsoftc_t *isp;
2483
2484         sim = (struct cam_sim *)cbarg;
2485         isp = (ispsoftc_t *) cam_sim_softc(sim);
2486         bus = cam_sim_bus(sim);
2487         tgt = xpt_path_target_id(path);
2488
2489         switch (code) {
2490         case AC_LOST_DEVICE:
2491                 if (IS_SCSI(isp)) {
2492                         uint16_t oflags, nflags;
2493                         sdparam *sdp = SDPARAM(isp, bus);
2494
2495                         if (tgt >= 0) {
2496                                 nflags = sdp->isp_devparam[tgt].nvrm_flags;
2497                                 nflags &= DPARM_SAFE_DFLT;
2498                                 if (isp->isp_loaded_fw) {
2499                                         nflags |= DPARM_NARROW | DPARM_ASYNC;
2500                                 }
2501                                 oflags = sdp->isp_devparam[tgt].goal_flags;
2502                                 sdp->isp_devparam[tgt].goal_flags = nflags;
2503                                 sdp->isp_devparam[tgt].dev_update = 1;
2504                                 sdp->update = 1;
2505                                 (void) isp_control(isp, ISPCTL_UPDATE_PARAMS, bus);
2506                                 sdp->isp_devparam[tgt].goal_flags = oflags;
2507                         }
2508                 }
2509                 break;
2510         default:
2511                 isp_prt(isp, ISP_LOGWARN, "isp_cam_async: Code 0x%x", code);
2512                 break;
2513         }
2514 }
2515
2516 static void
2517 isp_poll(struct cam_sim *sim)
2518 {
2519         ispsoftc_t *isp = cam_sim_softc(sim);
2520
2521         ISP_RUN_ISR(isp);
2522 }
2523
2524
2525 static void
2526 isp_watchdog(void *arg)
2527 {
2528         struct ccb_scsiio *xs = arg;
2529         ispsoftc_t *isp;
2530         uint32_t ohandle = ISP_HANDLE_FREE, handle;
2531
2532         isp = XS_ISP(xs);
2533
2534         handle = isp_find_handle(isp, xs);
2535
2536         /*
2537          * Hand crank the interrupt code just to be sure the command isn't stuck somewhere.
2538          */
2539         if (handle != ISP_HANDLE_FREE) {
2540                 ISP_RUN_ISR(isp);
2541                 ohandle = handle;
2542                 handle = isp_find_handle(isp, xs);
2543         }
2544         if (handle != ISP_HANDLE_FREE) {
2545                 /*
2546                  * Try and make sure the command is really dead before
2547                  * we release the handle (and DMA resources) for reuse.
2548                  *
2549                  * If we are successful in aborting the command then
2550                  * we're done here because we'll get the command returned
2551                  * back separately.
2552                  */
2553                 if (isp_control(isp, ISPCTL_ABORT_CMD, xs) == 0) {
2554                         return;
2555                 }
2556
2557                 /*
2558                  * Note that after calling the above, the command may in
2559                  * fact have been completed.
2560                  */
2561                 xs = isp_find_xs(isp, handle);
2562
2563                 /*
2564                  * If the command no longer exists, then we won't
2565                  * be able to find the xs again with this handle.
2566                  */
2567                 if (xs == NULL) {
2568                         return;
2569                 }
2570
2571                 /*
2572                  * After this point, the command is really dead.
2573                  */
2574                 if (XS_XFRLEN(xs)) {
2575                         ISP_DMAFREE(isp, xs, handle);
2576                 }
2577                 isp_destroy_handle(isp, handle);
2578                 isp_prt(isp, ISP_LOGERR, "%s: timeout for handle 0x%x", __func__, handle);
2579                 xs->ccb_h.status &= ~CAM_STATUS_MASK;
2580                 xs->ccb_h.status |= CAM_CMD_TIMEOUT;
2581                 isp_done(xs);
2582         } else {
2583                 if (ohandle != ISP_HANDLE_FREE) {
2584                         isp_prt(isp, ISP_LOGWARN, "%s: timeout for handle 0x%x, recovered during interrupt", __func__, ohandle);
2585                 } else {
2586                         isp_prt(isp, ISP_LOGWARN, "%s: timeout for handle already free", __func__);
2587                 }
2588         }
2589 }
2590
2591 static void
2592 isp_make_here(ispsoftc_t *isp, fcportdb_t *fcp, int chan, int tgt)
2593 {
2594         union ccb *ccb;
2595         struct isp_fc *fc = ISP_FC_PC(isp, chan);
2596
2597         /*
2598          * Allocate a CCB, create a wildcard path for this target and schedule a rescan.
2599          */
2600         ccb = xpt_alloc_ccb_nowait();
2601         if (ccb == NULL) {
2602                 isp_prt(isp, ISP_LOGWARN, "Chan %d unable to alloc CCB for rescan", chan);
2603                 return;
2604         }
2605         if (xpt_create_path(&ccb->ccb_h.path, NULL, cam_sim_path(fc->sim),
2606             tgt, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
2607                 isp_prt(isp, ISP_LOGWARN, "unable to create path for rescan");
2608                 xpt_free_ccb(ccb);
2609                 return;
2610         }
2611         xpt_rescan(ccb);
2612 }
2613
2614 static void
2615 isp_make_gone(ispsoftc_t *isp, fcportdb_t *fcp, int chan, int tgt)
2616 {
2617         struct cam_path *tp;
2618         struct isp_fc *fc = ISP_FC_PC(isp, chan);
2619
2620         if (xpt_create_path(&tp, NULL, cam_sim_path(fc->sim), tgt, CAM_LUN_WILDCARD) == CAM_REQ_CMP) {
2621                 xpt_async(AC_LOST_DEVICE, tp, NULL);
2622                 xpt_free_path(tp);
2623         }
2624 }
2625
2626 /*
2627  * Gone Device Timer Function- when we have decided that a device has gone
2628  * away, we wait a specific period of time prior to telling the OS it has
2629  * gone away.
2630  *
2631  * This timer function fires once a second and then scans the port database
2632  * for devices that are marked dead but still have a virtual target assigned.
2633  * We decrement a counter for that port database entry, and when it hits zero,
2634  * we tell the OS the device has gone away.
2635  */
2636 static void
2637 isp_gdt(void *arg)
2638 {
2639         struct isp_fc *fc = arg;
2640         taskqueue_enqueue(taskqueue_thread, &fc->gtask);
2641 }
2642
2643 static void
2644 isp_gdt_task(void *arg, int pending)
2645 {
2646         struct isp_fc *fc = arg;
2647         ispsoftc_t *isp = fc->isp;
2648         int chan = fc - isp->isp_osinfo.pc.fc;
2649         fcportdb_t *lp;
2650         struct ac_contract ac;
2651         struct ac_device_changed *adc;
2652         int dbidx, more_to_do = 0;
2653
2654         ISP_LOCK(isp);
2655         isp_prt(isp, ISP_LOGDEBUG0, "Chan %d GDT timer expired", chan);
2656         for (dbidx = 0; dbidx < MAX_FC_TARG; dbidx++) {
2657                 lp = &FCPARAM(isp, chan)->portdb[dbidx];
2658
2659                 if (lp->state != FC_PORTDB_STATE_ZOMBIE) {
2660                         continue;
2661                 }
2662                 if (lp->gone_timer != 0) {
2663                         lp->gone_timer -= 1;
2664                         more_to_do++;
2665                         continue;
2666                 }
2667                 isp_prt(isp, ISP_LOGCONFIG, prom3, chan, dbidx, lp->portid, "Gone Device Timeout");
2668                 if (lp->is_target) {
2669                         lp->is_target = 0;
2670                         isp_make_gone(isp, lp, chan, dbidx);
2671                 }
2672                 if (lp->is_initiator) {
2673                         lp->is_initiator = 0;
2674                         ac.contract_number = AC_CONTRACT_DEV_CHG;
2675                         adc = (struct ac_device_changed *) ac.contract_data;
2676                         adc->wwpn = lp->port_wwn;
2677                         adc->port = lp->portid;
2678                         adc->target = dbidx;
2679                         adc->arrived = 0;
2680                         xpt_async(AC_CONTRACT, fc->path, &ac);
2681                 }
2682                 lp->state = FC_PORTDB_STATE_NIL;
2683         }
2684         if (fc->ready) {
2685                 if (more_to_do) {
2686                         callout_reset(&fc->gdt, hz, isp_gdt, fc);
2687                 } else {
2688                         callout_deactivate(&fc->gdt);
2689                         isp_prt(isp, ISP_LOG_SANCFG, "Chan %d Stopping Gone Device Timer @ %lu", chan, (unsigned long) time_uptime);
2690                 }
2691         }
2692         ISP_UNLOCK(isp);
2693 }
2694
2695 /*
2696  * When loop goes down we remember the time and freeze CAM command queue.
2697  * During some time period we are trying to reprobe the loop.  But if we
2698  * fail, we tell the OS that devices have gone away and drop the freeze.
2699  *
2700  * We don't clear the devices out of our port database because, when loop
2701  * come back up, we have to do some actual cleanup with the chip at that
2702  * point (implicit PLOGO, e.g., to get the chip's port database state right).
2703  */
2704 static void
2705 isp_loop_changed(ispsoftc_t *isp, int chan)
2706 {
2707         fcparam *fcp = FCPARAM(isp, chan);
2708         struct isp_fc *fc = ISP_FC_PC(isp, chan);
2709
2710         if (fc->loop_down_time)
2711                 return;
2712         isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Loop changed", chan);
2713         if (fcp->role & ISP_ROLE_INITIATOR)
2714                 isp_freeze_loopdown(isp, chan);
2715         fc->loop_down_time = time_uptime;
2716         wakeup(fc);
2717 }
2718
2719 static void
2720 isp_loop_up(ispsoftc_t *isp, int chan)
2721 {
2722         struct isp_fc *fc = ISP_FC_PC(isp, chan);
2723
2724         isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Loop is up", chan);
2725         fc->loop_seen_once = 1;
2726         fc->loop_down_time = 0;
2727         isp_unfreeze_loopdown(isp, chan);
2728 }
2729
2730 static void
2731 isp_loop_dead(ispsoftc_t *isp, int chan)
2732 {
2733         fcparam *fcp = FCPARAM(isp, chan);
2734         struct isp_fc *fc = ISP_FC_PC(isp, chan);
2735         fcportdb_t *lp;
2736         struct ac_contract ac;
2737         struct ac_device_changed *adc;
2738         int dbidx, i;
2739
2740         isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Loop is dead", chan);
2741
2742         /*
2743          * Notify to the OS all targets who we now consider have departed.
2744          */
2745         for (dbidx = 0; dbidx < MAX_FC_TARG; dbidx++) {
2746                 lp = &fcp->portdb[dbidx];
2747
2748                 if (lp->state == FC_PORTDB_STATE_NIL)
2749                         continue;
2750
2751                 /*
2752                  * XXX: CLEAN UP AND COMPLETE ANY PENDING COMMANDS FIRST!
2753                  */
2754                 for (i = 0; i < isp->isp_maxcmds; i++) {
2755                         struct ccb_scsiio *xs;
2756
2757                         if (ISP_H2HT(isp->isp_xflist[i].handle) != ISP_HANDLE_INITIATOR) {
2758                                 continue;
2759                         }
2760                         if ((xs = isp->isp_xflist[i].cmd) == NULL) {
2761                                 continue;
2762                         }
2763                         if (dbidx != XS_TGT(xs)) {
2764                                 continue;
2765                         }
2766                         isp_prt(isp, ISP_LOGWARN, "command handle 0x%x for %d.%d.%jx orphaned by loop down timeout",
2767                             isp->isp_xflist[i].handle, chan, XS_TGT(xs),
2768                             (uintmax_t)XS_LUN(xs));
2769                 }
2770
2771                 isp_prt(isp, ISP_LOGCONFIG, prom3, chan, dbidx, lp->portid, "Loop Down Timeout");
2772                 if (lp->is_target) {
2773                         lp->is_target = 0;
2774                         isp_make_gone(isp, lp, chan, dbidx);
2775                 }
2776                 if (lp->is_initiator) {
2777                         lp->is_initiator = 0;
2778                         ac.contract_number = AC_CONTRACT_DEV_CHG;
2779                         adc = (struct ac_device_changed *) ac.contract_data;
2780                         adc->wwpn = lp->port_wwn;
2781                         adc->port = lp->portid;
2782                         adc->target = dbidx;
2783                         adc->arrived = 0;
2784                         xpt_async(AC_CONTRACT, fc->path, &ac);
2785                 }
2786         }
2787
2788         isp_unfreeze_loopdown(isp, chan);
2789         fc->loop_down_time = 0;
2790 }
2791
2792 static void
2793 isp_kthread(void *arg)
2794 {
2795         struct isp_fc *fc = arg;
2796         ispsoftc_t *isp = fc->isp;
2797         int chan = fc - isp->isp_osinfo.pc.fc;
2798         int slp = 0, d;
2799         int lb, lim;
2800
2801         ISP_LOCK(isp);
2802         while (isp->isp_osinfo.is_exiting == 0) {
2803                 isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0,
2804                     "Chan %d Checking FC state", chan);
2805                 lb = isp_fc_runstate(isp, chan, 250000);
2806                 isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0,
2807                     "Chan %d FC got to %s state", chan,
2808                     isp_fc_loop_statename(lb));
2809
2810                 /*
2811                  * Our action is different based upon whether we're supporting
2812                  * Initiator mode or not. If we are, we might freeze the simq
2813                  * when loop is down and set all sorts of different delays to
2814                  * check again.
2815                  *
2816                  * If not, we simply just wait for loop to come up.
2817                  */
2818                 if (lb == LOOP_READY || lb < 0) {
2819                         slp = 0;
2820                 } else {
2821                         /*
2822                          * If we've never seen loop up and we've waited longer
2823                          * than quickboot time, or we've seen loop up but we've
2824                          * waited longer than loop_down_limit, give up and go
2825                          * to sleep until loop comes up.
2826                          */
2827                         if (fc->loop_seen_once == 0)
2828                                 lim = isp_quickboot_time;
2829                         else
2830                                 lim = fc->loop_down_limit;
2831                         d = time_uptime - fc->loop_down_time;
2832                         if (d >= lim)
2833                                 slp = 0;
2834                         else if (d < 10)
2835                                 slp = 1;
2836                         else if (d < 30)
2837                                 slp = 5;
2838                         else if (d < 60)
2839                                 slp = 10;
2840                         else if (d < 120)
2841                                 slp = 20;
2842                         else
2843                                 slp = 30;
2844                 }
2845
2846                 if (slp == 0) {
2847                         if (lb == LOOP_READY)
2848                                 isp_loop_up(isp, chan);
2849                         else
2850                                 isp_loop_dead(isp, chan);
2851                 }
2852
2853                 isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0,
2854                     "Chan %d sleep for %d seconds", chan, slp);
2855                 msleep(fc, &isp->isp_lock, PRIBIO, "ispf", slp * hz);
2856         }
2857         fc->num_threads -= 1;
2858         ISP_UNLOCK(isp);
2859         kthread_exit();
2860 }
2861
2862 #ifdef  ISP_TARGET_MODE
2863 static void
2864 isp_abort_atio(ispsoftc_t *isp, union ccb *ccb)
2865 {
2866         atio_private_data_t *atp;
2867         union ccb *accb = ccb->cab.abort_ccb;
2868         struct ccb_hdr *sccb;
2869         tstate_t *tptr;
2870
2871         tptr = get_lun_statep(isp, XS_CHANNEL(accb), XS_LUN(accb));
2872         if (tptr != NULL) {
2873                 /* Search for the ATIO among queueued. */
2874                 SLIST_FOREACH(sccb, &tptr->atios, sim_links.sle) {
2875                         if (sccb != &accb->ccb_h)
2876                                 continue;
2877                         SLIST_REMOVE(&tptr->atios, sccb, ccb_hdr, sim_links.sle);
2878                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, sccb->path,
2879                             "Abort FREE ATIO\n");
2880                         accb->ccb_h.status = CAM_REQ_ABORTED;
2881                         xpt_done(accb);
2882                         ccb->ccb_h.status = CAM_REQ_CMP;
2883                         return;
2884                 }
2885         }
2886
2887         /* Search for the ATIO among running. */
2888         atp = isp_find_atpd(isp, XS_CHANNEL(accb), accb->atio.tag_id);
2889         if (atp != NULL) {
2890                 /* Send TERMINATE to firmware. */
2891                 if (!atp->dead && IS_24XX(isp)) {
2892                         uint8_t storage[QENTRY_LEN];
2893                         ct7_entry_t *cto = (ct7_entry_t *) storage;
2894
2895                         ISP_MEMZERO(cto, sizeof (ct7_entry_t));
2896                         cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
2897                         cto->ct_header.rqs_entry_count = 1;
2898                         cto->ct_nphdl = atp->nphdl;
2899                         cto->ct_rxid = atp->tag;
2900                         cto->ct_iid_lo = atp->sid;
2901                         cto->ct_iid_hi = atp->sid >> 16;
2902                         cto->ct_oxid = atp->oxid;
2903                         cto->ct_vpidx = XS_CHANNEL(accb);
2904                         cto->ct_flags = CT7_NOACK|CT7_TERMINATE;
2905                         isp_target_put_entry(isp, cto);
2906                 }
2907                 isp_put_atpd(isp, XS_CHANNEL(accb), atp);
2908                 ccb->ccb_h.status = CAM_REQ_CMP;
2909         } else {
2910                 ccb->ccb_h.status = CAM_UA_ABORT;
2911         }
2912 }
2913
2914 static void
2915 isp_abort_inot(ispsoftc_t *isp, union ccb *ccb)
2916 {
2917         inot_private_data_t *ntp;
2918         union ccb *accb = ccb->cab.abort_ccb;
2919         struct ccb_hdr *sccb;
2920         tstate_t *tptr;
2921
2922         tptr = get_lun_statep(isp, XS_CHANNEL(accb), XS_LUN(accb));
2923         if (tptr != NULL) {
2924                 /* Search for the INOT among queueued. */
2925                 SLIST_FOREACH(sccb, &tptr->inots, sim_links.sle) {
2926                         if (sccb != &accb->ccb_h)
2927                                 continue;
2928                         SLIST_REMOVE(&tptr->inots, sccb, ccb_hdr, sim_links.sle);
2929                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, sccb->path,
2930                             "Abort FREE INOT\n");
2931                         accb->ccb_h.status = CAM_REQ_ABORTED;
2932                         xpt_done(accb);
2933                         ccb->ccb_h.status = CAM_REQ_CMP;
2934                         return;
2935                 }
2936         }
2937
2938         /* Search for the INOT among running. */
2939         ntp = isp_find_ntpd(isp, XS_CHANNEL(accb), accb->cin1.tag_id, accb->cin1.seq_id);
2940         if (ntp != NULL) {
2941                 if (ntp->nt.nt_need_ack) {
2942                         isp_async(isp, ISPASYNC_TARGET_NOTIFY_ACK,
2943                             ntp->nt.nt_lreserved);
2944                 }
2945                 isp_put_ntpd(isp, XS_CHANNEL(accb), ntp);
2946                 ccb->ccb_h.status = CAM_REQ_CMP;
2947         } else {
2948                 ccb->ccb_h.status = CAM_UA_ABORT;
2949                 return;
2950         }
2951 }
2952 #endif
2953
2954 static void
2955 isp_action(struct cam_sim *sim, union ccb *ccb)
2956 {
2957         int bus, tgt, error;
2958         ispsoftc_t *isp;
2959         struct ccb_trans_settings *cts;
2960         sbintime_t ts;
2961
2962         CAM_DEBUG(ccb->ccb_h.path, CAM_DEBUG_TRACE, ("isp_action\n"));
2963
2964         isp = (ispsoftc_t *)cam_sim_softc(sim);
2965         ISP_ASSERT_LOCKED(isp);
2966         bus = cam_sim_bus(sim);
2967         isp_prt(isp, ISP_LOGDEBUG2, "isp_action code %x", ccb->ccb_h.func_code);
2968         ISP_PCMD(ccb) = NULL;
2969
2970         switch (ccb->ccb_h.func_code) {
2971         case XPT_SCSI_IO:       /* Execute the requested I/O operation */
2972                 /*
2973                  * Do a couple of preliminary checks...
2974                  */
2975                 if ((ccb->ccb_h.flags & CAM_CDB_POINTER) != 0) {
2976                         if ((ccb->ccb_h.flags & CAM_CDB_PHYS) != 0) {
2977                                 ccb->ccb_h.status = CAM_REQ_INVALID;
2978                                 isp_done((struct ccb_scsiio *) ccb);
2979                                 break;
2980                         }
2981                 }
2982                 ccb->csio.req_map = NULL;
2983 #ifdef  DIAGNOSTIC
2984                 if (ccb->ccb_h.target_id >= ISP_MAX_TARGETS(isp)) {
2985                         xpt_print(ccb->ccb_h.path, "invalid target\n");
2986                         ccb->ccb_h.status = CAM_PATH_INVALID;
2987                 } else if (ISP_MAX_LUNS(isp) > 0 &&
2988                     ccb->ccb_h.target_lun >= ISP_MAX_LUNS(isp)) {
2989                         xpt_print(ccb->ccb_h.path, "invalid lun\n");
2990                         ccb->ccb_h.status = CAM_PATH_INVALID;
2991                 }
2992                 if (ccb->ccb_h.status == CAM_PATH_INVALID) {
2993                         xpt_done(ccb);
2994                         break;
2995                 }
2996 #endif
2997                 ccb->csio.scsi_status = SCSI_STATUS_OK;
2998                 if (isp_get_pcmd(isp, ccb)) {
2999                         isp_prt(isp, ISP_LOGWARN, "out of PCMDs");
3000                         cam_freeze_devq(ccb->ccb_h.path);
3001                         cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 250, 0);
3002                         ccb->ccb_h.status = CAM_REQUEUE_REQ;
3003                         xpt_done(ccb);
3004                         break;
3005                 }
3006                 error = isp_start((XS_T *) ccb);
3007                 switch (error) {
3008                 case CMD_QUEUED:
3009                         ccb->ccb_h.status |= CAM_SIM_QUEUED;
3010                         if (ccb->ccb_h.timeout == CAM_TIME_INFINITY)
3011                                 break;
3012                         /* Give firmware extra 10s to handle timeout. */
3013                         ts = SBT_1MS * ccb->ccb_h.timeout + 10 * SBT_1S;
3014                         callout_reset_sbt(&PISP_PCMD(ccb)->wdog, ts, 0,
3015                             isp_watchdog, ccb, 0);
3016                         break;
3017                 case CMD_RQLATER:
3018                         isp_prt(isp, ISP_LOGDEBUG0, "%d.%jx retry later",
3019                             XS_TGT(ccb), (uintmax_t)XS_LUN(ccb));
3020                         cam_freeze_devq(ccb->ccb_h.path);
3021                         cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 1000, 0);
3022                         ccb->ccb_h.status = CAM_REQUEUE_REQ;
3023                         isp_free_pcmd(isp, ccb);
3024                         xpt_done(ccb);
3025                         break;
3026                 case CMD_EAGAIN:
3027                         isp_free_pcmd(isp, ccb);
3028                         cam_freeze_devq(ccb->ccb_h.path);
3029                         cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 100, 0);
3030                         ccb->ccb_h.status = CAM_REQUEUE_REQ;
3031                         xpt_done(ccb);
3032                         break;
3033                 case CMD_COMPLETE:
3034                         isp_done((struct ccb_scsiio *) ccb);
3035                         break;
3036                 default:
3037                         isp_prt(isp, ISP_LOGERR, "What's this? 0x%x at %d in file %s", error, __LINE__, __FILE__);
3038                         ccb->ccb_h.status = CAM_REQUEUE_REQ;
3039                         isp_free_pcmd(isp, ccb);
3040                         xpt_done(ccb);
3041                 }
3042                 break;
3043
3044 #ifdef  ISP_TARGET_MODE
3045         case XPT_EN_LUN:                /* Enable/Disable LUN as a target */
3046                 if (ccb->cel.enable) {
3047                         isp_enable_lun(isp, ccb);
3048                 } else {
3049                         isp_disable_lun(isp, ccb);
3050                 }
3051                 break;
3052         case XPT_IMMEDIATE_NOTIFY:      /* Add Immediate Notify Resource */
3053         case XPT_ACCEPT_TARGET_IO:      /* Add Accept Target IO Resource */
3054         {
3055                 tstate_t *tptr = get_lun_statep(isp, XS_CHANNEL(ccb), ccb->ccb_h.target_lun);
3056                 if (tptr == NULL) {
3057                         const char *str;
3058
3059                         if (ccb->ccb_h.func_code == XPT_IMMEDIATE_NOTIFY)
3060                                 str = "XPT_IMMEDIATE_NOTIFY";
3061                         else
3062                                 str = "XPT_ACCEPT_TARGET_IO";
3063                         ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path,
3064                             "%s: no state pointer found for %s\n",
3065                             __func__, str);
3066                         ccb->ccb_h.status = CAM_DEV_NOT_THERE;
3067                         xpt_done(ccb);
3068                         break;
3069                 }
3070                 ccb->ccb_h.spriv_field0 = 0;
3071                 ccb->ccb_h.spriv_ptr1 = isp;
3072
3073                 if (ccb->ccb_h.func_code == XPT_ACCEPT_TARGET_IO) {
3074                         ccb->atio.tag_id = 0;
3075                         SLIST_INSERT_HEAD(&tptr->atios, &ccb->ccb_h, sim_links.sle);
3076                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, ccb->ccb_h.path,
3077                             "Put FREE ATIO\n");
3078                 } else if (ccb->ccb_h.func_code == XPT_IMMEDIATE_NOTIFY) {
3079                         ccb->cin1.seq_id = ccb->cin1.tag_id = 0;
3080                         SLIST_INSERT_HEAD(&tptr->inots, &ccb->ccb_h, sim_links.sle);
3081                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG2, ccb->ccb_h.path,
3082                             "Put FREE INOT\n");
3083                 }
3084                 ccb->ccb_h.status = CAM_REQ_INPROG;
3085                 break;
3086         }
3087         case XPT_NOTIFY_ACKNOWLEDGE:            /* notify ack */
3088         {
3089                 inot_private_data_t *ntp;
3090
3091                 /*
3092                  * XXX: Because we cannot guarantee that the path information in the notify acknowledge ccb
3093                  * XXX: matches that for the immediate notify, we have to *search* for the notify structure
3094                  */
3095                 /*
3096                  * All the relevant path information is in the associated immediate notify
3097                  */
3098                 ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: [0x%x] NOTIFY ACKNOWLEDGE for 0x%x seen\n", __func__, ccb->cna2.tag_id, ccb->cna2.seq_id);
3099                 ntp = isp_find_ntpd(isp, XS_CHANNEL(ccb), ccb->cna2.tag_id, ccb->cna2.seq_id);
3100                 if (ntp == NULL) {
3101                         ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "%s: [0x%x] XPT_NOTIFY_ACKNOWLEDGE of 0x%x cannot find ntp private data\n", __func__,
3102                              ccb->cna2.tag_id, ccb->cna2.seq_id);
3103                         ccb->ccb_h.status = CAM_DEV_NOT_THERE;
3104                         xpt_done(ccb);
3105                         break;
3106                 }
3107                 if (isp_handle_platform_target_notify_ack(isp, &ntp->nt,
3108                     (ccb->ccb_h.flags & CAM_SEND_STATUS) ? ccb->cna2.arg : 0)) {
3109                         cam_freeze_devq(ccb->ccb_h.path);
3110                         cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 1000, 0);
3111                         ccb->ccb_h.status &= ~CAM_STATUS_MASK;
3112                         ccb->ccb_h.status |= CAM_REQUEUE_REQ;
3113                         break;
3114                 }
3115                 isp_put_ntpd(isp, XS_CHANNEL(ccb), ntp);
3116                 ccb->ccb_h.status = CAM_REQ_CMP;
3117                 ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: [0x%x] calling xpt_done for tag 0x%x\n", __func__, ccb->cna2.tag_id, ccb->cna2.seq_id);
3118                 xpt_done(ccb);
3119                 break;
3120         }
3121         case XPT_CONT_TARGET_IO:
3122                 isp_target_start_ctio(isp, ccb, FROM_CAM);
3123                 break;
3124 #endif
3125         case XPT_RESET_DEV:             /* BDR the specified SCSI device */
3126                 tgt = ccb->ccb_h.target_id;
3127                 tgt |= (bus << 16);
3128
3129                 error = isp_control(isp, ISPCTL_RESET_DEV, bus, tgt);
3130                 if (error) {
3131                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
3132                 } else {
3133                         /*
3134                          * If we have a FC device, reset the Command
3135                          * Reference Number, because the target will expect
3136                          * that we re-start the CRN at 1 after a reset.
3137                          */
3138                         if (IS_FC(isp))
3139                                 isp_fcp_reset_crn(isp, bus, tgt, /*tgt_set*/ 1);
3140
3141                         ccb->ccb_h.status = CAM_REQ_CMP;
3142                 }
3143                 xpt_done(ccb);
3144                 break;
3145         case XPT_ABORT:                 /* Abort the specified CCB */
3146         {
3147                 union ccb *accb = ccb->cab.abort_ccb;
3148                 switch (accb->ccb_h.func_code) {
3149 #ifdef  ISP_TARGET_MODE
3150                 case XPT_ACCEPT_TARGET_IO:
3151                         isp_abort_atio(isp, ccb);
3152                         break;
3153                 case XPT_IMMEDIATE_NOTIFY:
3154                         isp_abort_inot(isp, ccb);
3155                         break;
3156 #endif
3157                 case XPT_SCSI_IO:
3158                         error = isp_control(isp, ISPCTL_ABORT_CMD, accb);
3159                         if (error) {
3160                                 ccb->ccb_h.status = CAM_UA_ABORT;
3161                         } else {
3162                                 ccb->ccb_h.status = CAM_REQ_CMP;
3163                         }
3164                         break;
3165                 default:
3166                         ccb->ccb_h.status = CAM_REQ_INVALID;
3167                         break;
3168                 }
3169                 /*
3170                  * This is not a queued CCB, so the caller expects it to be
3171                  * complete when control is returned.
3172                  */
3173                 break;
3174         }
3175 #define IS_CURRENT_SETTINGS(c)  (c->type == CTS_TYPE_CURRENT_SETTINGS)
3176         case XPT_SET_TRAN_SETTINGS:     /* Nexus Settings */
3177                 cts = &ccb->cts;
3178                 if (!IS_CURRENT_SETTINGS(cts)) {
3179                         ccb->ccb_h.status = CAM_REQ_INVALID;
3180                         xpt_done(ccb);
3181                         break;
3182                 }
3183                 tgt = cts->ccb_h.target_id;
3184                 if (IS_SCSI(isp)) {
3185                         struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
3186                         struct ccb_trans_settings_spi *spi = &cts->xport_specific.spi;
3187                         sdparam *sdp = SDPARAM(isp, bus);
3188                         uint16_t *dptr;
3189
3190                         if (spi->valid == 0 && scsi->valid == 0) {
3191                                 ccb->ccb_h.status = CAM_REQ_CMP;
3192                                 xpt_done(ccb);
3193                                 break;
3194                         }
3195
3196                         /*
3197                          * We always update (internally) from goal_flags
3198                          * so any request to change settings just gets
3199                          * vectored to that location.
3200                          */
3201                         dptr = &sdp->isp_devparam[tgt].goal_flags;
3202
3203                         if ((spi->valid & CTS_SPI_VALID_DISC) != 0) {
3204                                 if ((spi->flags & CTS_SPI_FLAGS_DISC_ENB) != 0)
3205                                         *dptr |= DPARM_DISC;
3206                                 else
3207                                         *dptr &= ~DPARM_DISC;
3208                         }
3209
3210                         if ((scsi->valid & CTS_SCSI_VALID_TQ) != 0) {
3211                                 if ((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0)
3212                                         *dptr |= DPARM_TQING;
3213                                 else
3214                                         *dptr &= ~DPARM_TQING;
3215                         }
3216
3217                         if ((spi->valid & CTS_SPI_VALID_BUS_WIDTH) != 0) {
3218                                 if (spi->bus_width == MSG_EXT_WDTR_BUS_16_BIT)
3219                                         *dptr |= DPARM_WIDE;
3220                                 else
3221                                         *dptr &= ~DPARM_WIDE;
3222                         }
3223
3224                         /*
3225                          * XXX: FIX ME
3226                          */
3227                         if ((spi->valid & CTS_SPI_VALID_SYNC_OFFSET) && (spi->valid & CTS_SPI_VALID_SYNC_RATE) && (spi->sync_period && spi->sync_offset)) {
3228                                 *dptr |= DPARM_SYNC;
3229                                 /*
3230                                  * XXX: CHECK FOR LEGALITY
3231                                  */
3232                                 sdp->isp_devparam[tgt].goal_period = spi->sync_period;
3233                                 sdp->isp_devparam[tgt].goal_offset = spi->sync_offset;
3234                         } else {
3235                                 *dptr &= ~DPARM_SYNC;
3236                         }
3237                         isp_prt(isp, ISP_LOGDEBUG0, "SET (%d.%d.%d) to flags %x off %x per %x", bus, tgt, cts->ccb_h.target_lun, sdp->isp_devparam[tgt].goal_flags,
3238                             sdp->isp_devparam[tgt].goal_offset, sdp->isp_devparam[tgt].goal_period);
3239                         sdp->isp_devparam[tgt].dev_update = 1;
3240                         sdp->update = 1;
3241                 }
3242                 ccb->ccb_h.status = CAM_REQ_CMP;
3243                 xpt_done(ccb);
3244                 break;
3245         case XPT_GET_TRAN_SETTINGS:
3246                 cts = &ccb->cts;
3247                 tgt = cts->ccb_h.target_id;
3248                 if (IS_FC(isp)) {
3249                         fcparam *fcp = FCPARAM(isp, bus);
3250                         struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
3251                         struct ccb_trans_settings_fc *fc = &cts->xport_specific.fc;
3252
3253                         cts->protocol = PROTO_SCSI;
3254                         cts->protocol_version = SCSI_REV_2;
3255                         cts->transport = XPORT_FC;
3256                         cts->transport_version = 0;
3257
3258                         scsi->valid = CTS_SCSI_VALID_TQ;
3259                         scsi->flags = CTS_SCSI_FLAGS_TAG_ENB;
3260                         fc->valid = CTS_FC_VALID_SPEED;
3261                         fc->bitrate = 100000;
3262                         fc->bitrate *= fcp->isp_gbspeed;
3263                         if (tgt < MAX_FC_TARG) {
3264                                 fcportdb_t *lp = &fcp->portdb[tgt];
3265                                 fc->wwnn = lp->node_wwn;
3266                                 fc->wwpn = lp->port_wwn;
3267                                 fc->port = lp->portid;
3268                                 fc->valid |= CTS_FC_VALID_WWNN | CTS_FC_VALID_WWPN | CTS_FC_VALID_PORT;
3269                         }
3270                 } else {
3271                         struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
3272                         struct ccb_trans_settings_spi *spi = &cts->xport_specific.spi;
3273                         sdparam *sdp = SDPARAM(isp, bus);
3274                         uint16_t dval, pval, oval;
3275
3276                         if (IS_CURRENT_SETTINGS(cts)) {
3277                                 sdp->isp_devparam[tgt].dev_refresh = 1;
3278                                 sdp->update = 1;
3279                                 (void) isp_control(isp, ISPCTL_UPDATE_PARAMS, bus);
3280                                 dval = sdp->isp_devparam[tgt].actv_flags;
3281                                 oval = sdp->isp_devparam[tgt].actv_offset;
3282                                 pval = sdp->isp_devparam[tgt].actv_period;
3283                         } else {
3284                                 dval = sdp->isp_devparam[tgt].nvrm_flags;
3285                                 oval = sdp->isp_devparam[tgt].nvrm_offset;
3286                                 pval = sdp->isp_devparam[tgt].nvrm_period;
3287                         }
3288
3289                         cts->protocol = PROTO_SCSI;
3290                         cts->protocol_version = SCSI_REV_2;
3291                         cts->transport = XPORT_SPI;
3292                         cts->transport_version = 2;
3293
3294                         spi->valid = 0;
3295                         scsi->valid = 0;
3296                         spi->flags = 0;
3297                         scsi->flags = 0;
3298                         if (dval & DPARM_DISC) {
3299                                 spi->flags |= CTS_SPI_FLAGS_DISC_ENB;
3300                         }
3301                         if ((dval & DPARM_SYNC) && oval && pval) {
3302                                 spi->sync_offset = oval;
3303                                 spi->sync_period = pval;
3304                         } else {
3305                                 spi->sync_offset = 0;
3306                                 spi->sync_period = 0;
3307                         }
3308                         spi->valid |= CTS_SPI_VALID_SYNC_OFFSET;
3309                         spi->valid |= CTS_SPI_VALID_SYNC_RATE;
3310                         spi->valid |= CTS_SPI_VALID_BUS_WIDTH;
3311                         if (dval & DPARM_WIDE) {
3312                                 spi->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
3313                         } else {
3314                                 spi->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
3315                         }
3316                         if (cts->ccb_h.target_lun != CAM_LUN_WILDCARD) {
3317                                 scsi->valid = CTS_SCSI_VALID_TQ;
3318                                 if (dval & DPARM_TQING) {
3319                                         scsi->flags |= CTS_SCSI_FLAGS_TAG_ENB;
3320                                 }
3321                                 spi->valid |= CTS_SPI_VALID_DISC;
3322                         }
3323                         isp_prt(isp, ISP_LOGDEBUG0, "GET %s (%d.%d.%d) to flags %x off %x per %x", IS_CURRENT_SETTINGS(cts)? "ACTIVE" : "NVRAM",
3324                             bus, tgt, cts->ccb_h.target_lun, dval, oval, pval);
3325                 }
3326                 ccb->ccb_h.status = CAM_REQ_CMP;
3327                 xpt_done(ccb);
3328                 break;
3329
3330         case XPT_CALC_GEOMETRY:
3331                 cam_calc_geometry(&ccb->ccg, 1);
3332                 xpt_done(ccb);
3333                 break;
3334
3335         case XPT_RESET_BUS:             /* Reset the specified bus */
3336                 error = isp_control(isp, ISPCTL_RESET_BUS, bus);
3337                 if (error) {
3338                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
3339                         xpt_done(ccb);
3340                         break;
3341                 }
3342                 if (bootverbose) {
3343                         xpt_print(ccb->ccb_h.path, "reset bus on channel %d\n", bus);
3344                 }
3345                 if (IS_FC(isp)) {
3346                         xpt_async(AC_BUS_RESET, ISP_FC_PC(isp, bus)->path, 0);
3347                 } else {
3348                         xpt_async(AC_BUS_RESET, ISP_SPI_PC(isp, bus)->path, 0);
3349                 }
3350                 ccb->ccb_h.status = CAM_REQ_CMP;
3351                 xpt_done(ccb);
3352                 break;
3353
3354         case XPT_TERM_IO:               /* Terminate the I/O process */
3355                 ccb->ccb_h.status = CAM_REQ_INVALID;
3356                 xpt_done(ccb);
3357                 break;
3358
3359         case XPT_SET_SIM_KNOB:          /* Set SIM knobs */
3360         {
3361                 struct ccb_sim_knob *kp = &ccb->knob;
3362                 fcparam *fcp;
3363
3364                 if (!IS_FC(isp)) {
3365                         ccb->ccb_h.status = CAM_REQ_INVALID;
3366                         xpt_done(ccb);
3367                         break;
3368                 }
3369
3370                 fcp = FCPARAM(isp, bus);
3371
3372                 if (kp->xport_specific.fc.valid & KNOB_VALID_ADDRESS) {
3373                         fcp->isp_wwnn = ISP_FC_PC(isp, bus)->def_wwnn = kp->xport_specific.fc.wwnn;
3374                         fcp->isp_wwpn = ISP_FC_PC(isp, bus)->def_wwpn = kp->xport_specific.fc.wwpn;
3375                         isp_prt(isp, ISP_LOGALL, "Setting Channel %d wwns to 0x%jx 0x%jx", bus, fcp->isp_wwnn, fcp->isp_wwpn);
3376                 }
3377                 ccb->ccb_h.status = CAM_REQ_CMP;
3378                 if (kp->xport_specific.fc.valid & KNOB_VALID_ROLE) {
3379                         int rchange = 0;
3380                         int newrole = 0;
3381
3382                         switch (kp->xport_specific.fc.role) {
3383                         case KNOB_ROLE_NONE:
3384                                 if (fcp->role != ISP_ROLE_NONE) {
3385                                         rchange = 1;
3386                                         newrole = ISP_ROLE_NONE;
3387                                 }
3388                                 break;
3389                         case KNOB_ROLE_TARGET:
3390                                 if (fcp->role != ISP_ROLE_TARGET) {
3391                                         rchange = 1;
3392                                         newrole = ISP_ROLE_TARGET;
3393                                 }
3394                                 break;
3395                         case KNOB_ROLE_INITIATOR:
3396                                 if (fcp->role != ISP_ROLE_INITIATOR) {
3397                                         rchange = 1;
3398                                         newrole = ISP_ROLE_INITIATOR;
3399                                 }
3400                                 break;
3401                         case KNOB_ROLE_BOTH:
3402                                 if (fcp->role != ISP_ROLE_BOTH) {
3403                                         rchange = 1;
3404                                         newrole = ISP_ROLE_BOTH;
3405                                 }
3406                                 break;
3407                         }
3408                         if (rchange) {
3409                                 ISP_PATH_PRT(isp, ISP_LOGCONFIG, ccb->ccb_h.path, "changing role on from %d to %d\n", fcp->role, newrole);
3410                                 if (isp_control(isp, ISPCTL_CHANGE_ROLE,
3411                                     bus, newrole) != 0) {
3412                                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
3413                                         xpt_done(ccb);
3414                                         break;
3415                                 }
3416                         }
3417                 }
3418                 xpt_done(ccb);
3419                 break;
3420         }
3421         case XPT_GET_SIM_KNOB:          /* Get SIM knobs */
3422         {
3423                 struct ccb_sim_knob *kp = &ccb->knob;
3424
3425                 if (IS_FC(isp)) {
3426                         fcparam *fcp;
3427
3428                         fcp = FCPARAM(isp, bus);
3429
3430                         kp->xport_specific.fc.wwnn = fcp->isp_wwnn;
3431                         kp->xport_specific.fc.wwpn = fcp->isp_wwpn;
3432                         switch (fcp->role) {
3433                         case ISP_ROLE_NONE:
3434                                 kp->xport_specific.fc.role = KNOB_ROLE_NONE;
3435                                 break;
3436                         case ISP_ROLE_TARGET:
3437                                 kp->xport_specific.fc.role = KNOB_ROLE_TARGET;
3438                                 break;
3439                         case ISP_ROLE_INITIATOR:
3440                                 kp->xport_specific.fc.role = KNOB_ROLE_INITIATOR;
3441                                 break;
3442                         case ISP_ROLE_BOTH:
3443                                 kp->xport_specific.fc.role = KNOB_ROLE_BOTH;
3444                                 break;
3445                         }
3446                         kp->xport_specific.fc.valid = KNOB_VALID_ADDRESS | KNOB_VALID_ROLE;
3447                         ccb->ccb_h.status = CAM_REQ_CMP;
3448                 } else {
3449                         ccb->ccb_h.status = CAM_REQ_INVALID;
3450                 }
3451                 xpt_done(ccb);
3452                 break;
3453         }
3454         case XPT_PATH_INQ:              /* Path routing inquiry */
3455         {
3456                 struct ccb_pathinq *cpi = &ccb->cpi;
3457
3458                 cpi->version_num = 1;
3459 #ifdef  ISP_TARGET_MODE
3460                 if (IS_FC(isp) && ISP_CAP_TMODE(isp) && ISP_CAP_SCCFW(isp))
3461                         cpi->target_sprt = PIT_PROCESSOR | PIT_DISCONNECT | PIT_TERM_IO;
3462                 else
3463 #endif
3464                         cpi->target_sprt = 0;
3465                 cpi->hba_eng_cnt = 0;
3466                 cpi->max_target = ISP_MAX_TARGETS(isp) - 1;
3467                 cpi->max_lun = ISP_MAX_LUNS(isp) == 0 ?
3468                     255 : ISP_MAX_LUNS(isp) - 1;
3469                 cpi->bus_id = cam_sim_bus(sim);
3470                 if (isp->isp_osinfo.sixtyfourbit)
3471                         cpi->maxio = (ISP_NSEG64_MAX - 1) * PAGE_SIZE;
3472                 else
3473                         cpi->maxio = (ISP_NSEG_MAX - 1) * PAGE_SIZE;
3474
3475                 if (IS_FC(isp)) {
3476                         fcparam *fcp = FCPARAM(isp, bus);
3477
3478                         cpi->hba_misc = PIM_NOBUSRESET | PIM_UNMAPPED;
3479                         cpi->hba_misc |= PIM_EXTLUNS | PIM_NOSCAN;
3480
3481                         /*
3482                          * Because our loop ID can shift from time to time,
3483                          * make our initiator ID out of range of our bus.
3484                          */
3485                         cpi->initiator_id = cpi->max_target + 1;
3486
3487                         /*
3488                          * Set base transfer capabilities for Fibre Channel, for this HBA.
3489                          */
3490                         if (IS_25XX(isp)) {
3491                                 cpi->base_transfer_speed = 8000000;
3492                         } else if (IS_24XX(isp)) {
3493                                 cpi->base_transfer_speed = 4000000;
3494                         } else if (IS_23XX(isp)) {
3495                                 cpi->base_transfer_speed = 2000000;
3496                         } else {
3497                                 cpi->base_transfer_speed = 1000000;
3498                         }
3499                         cpi->hba_inquiry = PI_TAG_ABLE;
3500                         cpi->transport = XPORT_FC;
3501                         cpi->transport_version = 0;
3502                         cpi->xport_specific.fc.wwnn = fcp->isp_wwnn;
3503                         cpi->xport_specific.fc.wwpn = fcp->isp_wwpn;
3504                         cpi->xport_specific.fc.port = fcp->isp_portid;
3505                         cpi->xport_specific.fc.bitrate = fcp->isp_gbspeed * 1000;
3506                 } else {
3507                         sdparam *sdp = SDPARAM(isp, bus);
3508                         cpi->hba_inquiry = PI_SDTR_ABLE|PI_TAG_ABLE|PI_WIDE_16;
3509                         cpi->hba_misc = PIM_UNMAPPED;
3510                         cpi->initiator_id = sdp->isp_initiator_id;
3511                         cpi->base_transfer_speed = 3300;
3512                         cpi->transport = XPORT_SPI;
3513                         cpi->transport_version = 2;
3514                 }
3515                 cpi->protocol = PROTO_SCSI;
3516                 cpi->protocol_version = SCSI_REV_2;
3517                 strlcpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
3518                 strlcpy(cpi->hba_vid, "Qlogic", HBA_IDLEN);
3519                 strlcpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
3520                 cpi->unit_number = cam_sim_unit(sim);
3521                 cpi->ccb_h.status = CAM_REQ_CMP;
3522                 xpt_done(ccb);
3523                 break;
3524         }
3525         default:
3526                 ccb->ccb_h.status = CAM_REQ_INVALID;
3527                 xpt_done(ccb);
3528                 break;
3529         }
3530 }
3531
3532 void
3533 isp_done(XS_T *sccb)
3534 {
3535         ispsoftc_t *isp = XS_ISP(sccb);
3536         uint32_t status;
3537
3538         if (XS_NOERR(sccb))
3539                 XS_SETERR(sccb, CAM_REQ_CMP);
3540
3541         if ((sccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP && (sccb->scsi_status != SCSI_STATUS_OK)) {
3542                 sccb->ccb_h.status &= ~CAM_STATUS_MASK;
3543                 if ((sccb->scsi_status == SCSI_STATUS_CHECK_COND) && (sccb->ccb_h.status & CAM_AUTOSNS_VALID) == 0) {
3544                         sccb->ccb_h.status |= CAM_AUTOSENSE_FAIL;
3545                 } else {
3546                         sccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR;
3547                 }
3548         }
3549
3550         sccb->ccb_h.status &= ~CAM_SIM_QUEUED;
3551         status = sccb->ccb_h.status & CAM_STATUS_MASK;
3552         if (status != CAM_REQ_CMP &&
3553             (sccb->ccb_h.status & CAM_DEV_QFRZN) == 0) {
3554                 sccb->ccb_h.status |= CAM_DEV_QFRZN;
3555                 xpt_freeze_devq(sccb->ccb_h.path, 1);
3556         }
3557
3558         if (ISP_PCMD(sccb)) {
3559                 if (callout_active(&PISP_PCMD(sccb)->wdog))
3560                         callout_stop(&PISP_PCMD(sccb)->wdog);
3561                 isp_free_pcmd(isp, (union ccb *) sccb);
3562         }
3563         xpt_done((union ccb *) sccb);
3564 }
3565
3566 void
3567 isp_async(ispsoftc_t *isp, ispasync_t cmd, ...)
3568 {
3569         int bus;
3570         static const char prom[] = "Chan %d [%d] WWPN 0x%16jx PortID 0x%06x handle 0x%x %s %s";
3571         char buf[64];
3572         char *msg = NULL;
3573         target_id_t tgt;
3574         fcportdb_t *lp;
3575         struct isp_fc *fc;
3576         struct cam_path *tmppath;
3577         struct ac_contract ac;
3578         struct ac_device_changed *adc;
3579         va_list ap;
3580
3581         switch (cmd) {
3582         case ISPASYNC_NEW_TGT_PARAMS:
3583         {
3584                 struct ccb_trans_settings_scsi *scsi;
3585                 struct ccb_trans_settings_spi *spi;
3586                 int flags, tgt;
3587                 sdparam *sdp;
3588                 struct ccb_trans_settings cts;
3589
3590                 memset(&cts, 0, sizeof (struct ccb_trans_settings));
3591
3592                 va_start(ap, cmd);
3593                 bus = va_arg(ap, int);
3594                 tgt = va_arg(ap, int);
3595                 va_end(ap);
3596                 sdp = SDPARAM(isp, bus);
3597
3598                 if (xpt_create_path(&tmppath, NULL, cam_sim_path(ISP_SPI_PC(isp, bus)->sim), tgt, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
3599                         isp_prt(isp, ISP_LOGWARN, "isp_async cannot make temp path for %d.%d", tgt, bus);
3600                         break;
3601                 }
3602                 flags = sdp->isp_devparam[tgt].actv_flags;
3603                 cts.type = CTS_TYPE_CURRENT_SETTINGS;
3604                 cts.protocol = PROTO_SCSI;
3605                 cts.transport = XPORT_SPI;
3606
3607                 scsi = &cts.proto_specific.scsi;
3608                 spi = &cts.xport_specific.spi;
3609
3610                 if (flags & DPARM_TQING) {
3611                         scsi->valid |= CTS_SCSI_VALID_TQ;
3612                         scsi->flags |= CTS_SCSI_FLAGS_TAG_ENB;
3613                 }
3614
3615                 if (flags & DPARM_DISC) {
3616                         spi->valid |= CTS_SPI_VALID_DISC;
3617                         spi->flags |= CTS_SPI_FLAGS_DISC_ENB;
3618                 }
3619                 spi->flags |= CTS_SPI_VALID_BUS_WIDTH;
3620                 if (flags & DPARM_WIDE) {
3621                         spi->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
3622                 } else {
3623                         spi->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
3624                 }
3625                 if (flags & DPARM_SYNC) {
3626                         spi->valid |= CTS_SPI_VALID_SYNC_RATE;
3627                         spi->valid |= CTS_SPI_VALID_SYNC_OFFSET;
3628                         spi->sync_period = sdp->isp_devparam[tgt].actv_period;
3629                         spi->sync_offset = sdp->isp_devparam[tgt].actv_offset;
3630                 }
3631                 isp_prt(isp, ISP_LOGDEBUG2, "NEW_TGT_PARAMS bus %d tgt %d period %x offset %x flags %x", bus, tgt, sdp->isp_devparam[tgt].actv_period, sdp->isp_devparam[tgt].actv_offset, flags);
3632                 xpt_setup_ccb(&cts.ccb_h, tmppath, 1);
3633                 xpt_async(AC_TRANSFER_NEG, tmppath, &cts);
3634                 xpt_free_path(tmppath);
3635                 break;
3636         }
3637         case ISPASYNC_BUS_RESET:
3638         {
3639                 va_start(ap, cmd);
3640                 bus = va_arg(ap, int);
3641                 va_end(ap);
3642                 isp_prt(isp, ISP_LOGINFO, "SCSI bus reset on bus %d detected", bus);
3643                 if (IS_FC(isp)) {
3644                         xpt_async(AC_BUS_RESET, ISP_FC_PC(isp, bus)->path, NULL);
3645                 } else {
3646                         xpt_async(AC_BUS_RESET, ISP_SPI_PC(isp, bus)->path, NULL);
3647                 }
3648                 break;
3649         }
3650         case ISPASYNC_LIP:
3651                 if (msg == NULL)
3652                         msg = "LIP Received";
3653                 /* FALLTHROUGH */
3654         case ISPASYNC_LOOP_RESET:
3655                 if (msg == NULL)
3656                         msg = "LOOP Reset";
3657                 /* FALLTHROUGH */
3658         case ISPASYNC_LOOP_DOWN:
3659                 if (msg == NULL)
3660                         msg = "LOOP Down";
3661                 va_start(ap, cmd);
3662                 bus = va_arg(ap, int);
3663                 va_end(ap);
3664                 isp_fcp_reset_crn(isp, bus, /*tgt*/0, /*tgt_set*/ 0);
3665                 isp_loop_changed(isp, bus);
3666                 isp_prt(isp, ISP_LOGINFO, "Chan %d %s", bus, msg);
3667                 break;
3668         case ISPASYNC_LOOP_UP:
3669                 va_start(ap, cmd);
3670                 bus = va_arg(ap, int);
3671                 va_end(ap);
3672                 isp_loop_changed(isp, bus);
3673                 isp_prt(isp, ISP_LOGINFO, "Chan %d Loop UP", bus);
3674                 break;
3675         case ISPASYNC_DEV_ARRIVED:
3676                 va_start(ap, cmd);
3677                 bus = va_arg(ap, int);
3678                 lp = va_arg(ap, fcportdb_t *);
3679                 va_end(ap);
3680                 fc = ISP_FC_PC(isp, bus);
3681                 tgt = FC_PORTDB_TGT(isp, bus, lp);
3682                 isp_gen_role_str(buf, sizeof (buf), lp->prli_word3);
3683                 isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "arrived");
3684                 if ((FCPARAM(isp, bus)->role & ISP_ROLE_INITIATOR) &&
3685                     (lp->prli_word3 & PRLI_WD3_TARGET_FUNCTION)) {
3686                         lp->is_target = 1;
3687                         isp_fcp_reset_crn(isp, bus, tgt, /*tgt_set*/ 1);
3688                         isp_make_here(isp, lp, bus, tgt);
3689                 }
3690                 if ((FCPARAM(isp, bus)->role & ISP_ROLE_TARGET) &&
3691                     (lp->prli_word3 & PRLI_WD3_INITIATOR_FUNCTION)) {
3692                         lp->is_initiator = 1;
3693                         ac.contract_number = AC_CONTRACT_DEV_CHG;
3694                         adc = (struct ac_device_changed *) ac.contract_data;
3695                         adc->wwpn = lp->port_wwn;
3696                         adc->port = lp->portid;
3697                         adc->target = tgt;
3698                         adc->arrived = 1;
3699                         xpt_async(AC_CONTRACT, fc->path, &ac);
3700                 }
3701                 break;
3702         case ISPASYNC_DEV_CHANGED:
3703                 va_start(ap, cmd);
3704                 bus = va_arg(ap, int);
3705                 lp = va_arg(ap, fcportdb_t *);
3706                 va_end(ap);
3707                 fc = ISP_FC_PC(isp, bus);
3708                 tgt = FC_PORTDB_TGT(isp, bus, lp);
3709                 isp_gen_role_str(buf, sizeof (buf), lp->new_prli_word3);
3710                 isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->new_portid, lp->handle, buf, "changed");
3711 changed:
3712                 if (lp->is_target !=
3713                     ((FCPARAM(isp, bus)->role & ISP_ROLE_INITIATOR) &&
3714                      (lp->new_prli_word3 & PRLI_WD3_TARGET_FUNCTION))) {
3715                         lp->is_target = !lp->is_target;
3716                         if (lp->is_target) {
3717                                 isp_fcp_reset_crn(isp, bus, tgt, /*tgt_set*/ 1);
3718                                 isp_make_here(isp, lp, bus, tgt);
3719                         } else {
3720                                 isp_make_gone(isp, lp, bus, tgt);
3721                                 isp_fcp_reset_crn(isp, bus, tgt, /*tgt_set*/ 1);
3722                         }
3723                 }
3724                 if (lp->is_initiator !=
3725                     ((FCPARAM(isp, bus)->role & ISP_ROLE_TARGET) &&
3726                      (lp->new_prli_word3 & PRLI_WD3_INITIATOR_FUNCTION))) {
3727                         lp->is_initiator = !lp->is_initiator;
3728                         ac.contract_number = AC_CONTRACT_DEV_CHG;
3729                         adc = (struct ac_device_changed *) ac.contract_data;
3730                         adc->wwpn = lp->port_wwn;
3731                         adc->port = lp->portid;
3732                         adc->target = tgt;
3733                         adc->arrived = lp->is_initiator;
3734                         xpt_async(AC_CONTRACT, fc->path, &ac);
3735                 }
3736                 break;
3737         case ISPASYNC_DEV_STAYED:
3738                 va_start(ap, cmd);
3739                 bus = va_arg(ap, int);
3740                 lp = va_arg(ap, fcportdb_t *);
3741                 va_end(ap);
3742                 fc = ISP_FC_PC(isp, bus);
3743                 tgt = FC_PORTDB_TGT(isp, bus, lp);
3744                 isp_gen_role_str(buf, sizeof (buf), lp->prli_word3);
3745                 isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "stayed");
3746                 goto changed;
3747         case ISPASYNC_DEV_GONE:
3748                 va_start(ap, cmd);
3749                 bus = va_arg(ap, int);
3750                 lp = va_arg(ap, fcportdb_t *);
3751                 va_end(ap);
3752                 fc = ISP_FC_PC(isp, bus);
3753                 tgt = FC_PORTDB_TGT(isp, bus, lp);
3754                 /*
3755                  * If this has a virtual target or initiator set the isp_gdt
3756                  * timer running on it to delay its departure.
3757                  */
3758                 isp_gen_role_str(buf, sizeof (buf), lp->prli_word3);
3759                 if (lp->is_target || lp->is_initiator) {
3760                         lp->state = FC_PORTDB_STATE_ZOMBIE;
3761                         lp->gone_timer = fc->gone_device_time;
3762                         isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "gone zombie");
3763                         if (fc->ready && !callout_active(&fc->gdt)) {
3764                                 isp_prt(isp, ISP_LOG_SANCFG|ISP_LOGDEBUG0, "Chan %d Starting Gone Device Timer with %u seconds time now %lu", bus, lp->gone_timer, (unsigned long)time_uptime);
3765                                 callout_reset(&fc->gdt, hz, isp_gdt, fc);
3766                         }
3767                         break;
3768                 }
3769                 isp_prt(isp, ISP_LOGCONFIG, prom, bus, tgt, lp->port_wwn, lp->portid, lp->handle, buf, "gone");
3770                 break;
3771         case ISPASYNC_CHANGE_NOTIFY:
3772         {
3773                 char *msg;
3774                 int evt, nphdl, nlstate, portid, reason;
3775
3776                 va_start(ap, cmd);
3777                 bus = va_arg(ap, int);
3778                 evt = va_arg(ap, int);
3779                 if (evt == ISPASYNC_CHANGE_PDB) {
3780                         nphdl = va_arg(ap, int);
3781                         nlstate = va_arg(ap, int);
3782                         reason = va_arg(ap, int);
3783                 } else if (evt == ISPASYNC_CHANGE_SNS) {
3784                         portid = va_arg(ap, int);
3785                 } else {
3786                         nphdl = NIL_HANDLE;
3787                         nlstate = reason = 0;
3788                 }
3789                 va_end(ap);
3790
3791                 if (evt == ISPASYNC_CHANGE_PDB) {
3792                         msg = "Port Database Changed";
3793                         isp_prt(isp, ISP_LOGINFO,
3794                             "Chan %d %s (nphdl 0x%x state 0x%x reason 0x%x)",
3795                             bus, msg, nphdl, nlstate, reason);
3796                 } else if (evt == ISPASYNC_CHANGE_SNS) {
3797                         msg = "Name Server Database Changed";
3798                         isp_prt(isp, ISP_LOGINFO, "Chan %d %s (PortID 0x%06x)",
3799                             bus, msg, portid);
3800                 } else {
3801                         msg = "Other Change Notify";
3802                         isp_prt(isp, ISP_LOGINFO, "Chan %d %s", bus, msg);
3803                 }
3804                 isp_loop_changed(isp, bus);
3805                 break;
3806         }
3807 #ifdef  ISP_TARGET_MODE
3808         case ISPASYNC_TARGET_NOTIFY:
3809         {
3810                 isp_notify_t *notify;
3811                 va_start(ap, cmd);
3812                 notify = va_arg(ap, isp_notify_t *);
3813                 va_end(ap);
3814                 switch (notify->nt_ncode) {
3815                 case NT_ABORT_TASK:
3816                 case NT_ABORT_TASK_SET:
3817                 case NT_CLEAR_ACA:
3818                 case NT_CLEAR_TASK_SET:
3819                 case NT_LUN_RESET:
3820                 case NT_TARGET_RESET:
3821                 case NT_QUERY_TASK_SET:
3822                 case NT_QUERY_ASYNC_EVENT:
3823                         /*
3824                          * These are task management functions.
3825                          */
3826                         isp_handle_platform_target_tmf(isp, notify);
3827                         break;
3828                 case NT_BUS_RESET:
3829                 case NT_LIP_RESET:
3830                 case NT_LINK_UP:
3831                 case NT_LINK_DOWN:
3832                 case NT_HBA_RESET:
3833                         /*
3834                          * No action need be taken here.
3835                          */
3836                         break;
3837                 case NT_GLOBAL_LOGOUT:
3838                 case NT_LOGOUT:
3839                         /*
3840                          * This is device arrival/departure notification
3841                          */
3842                         isp_handle_platform_target_notify_ack(isp, notify, 0);
3843                         break;
3844                 case NT_SRR:
3845                         isp_handle_platform_srr(isp, notify);
3846                         break;
3847                 default:
3848                         isp_prt(isp, ISP_LOGALL, "target notify code 0x%x", notify->nt_ncode);
3849                         isp_handle_platform_target_notify_ack(isp, notify, 0);
3850                         break;
3851                 }
3852                 break;
3853         }
3854         case ISPASYNC_TARGET_NOTIFY_ACK:
3855         {
3856                 void *inot;
3857                 va_start(ap, cmd);
3858                 inot = va_arg(ap, void *);
3859                 va_end(ap);
3860                 if (isp_notify_ack(isp, inot)) {
3861                         isp_tna_t *tp = malloc(sizeof (*tp), M_DEVBUF, M_NOWAIT);
3862                         if (tp) {
3863                                 tp->isp = isp;
3864                                 memcpy(tp->data, inot, sizeof (tp->data));
3865                                 tp->not = tp->data;
3866                                 callout_init_mtx(&tp->timer, &isp->isp_lock, 0);
3867                                 callout_reset(&tp->timer, 5,
3868                                     isp_refire_notify_ack, tp);
3869                         } else {
3870                                 isp_prt(isp, ISP_LOGERR, "you lose- cannot allocate a notify refire");
3871                         }
3872                 }
3873                 break;
3874         }
3875         case ISPASYNC_TARGET_ACTION:
3876         {
3877                 isphdr_t *hp;
3878
3879                 va_start(ap, cmd);
3880                 hp = va_arg(ap, isphdr_t *);
3881                 va_end(ap);
3882                 switch (hp->rqs_entry_type) {
3883                 case RQSTYPE_ATIO:
3884                         isp_handle_platform_atio7(isp, (at7_entry_t *) hp);
3885                         break;
3886                 case RQSTYPE_ATIO2:
3887                         isp_handle_platform_atio2(isp, (at2_entry_t *) hp);
3888                         break;
3889                 case RQSTYPE_CTIO7:
3890                 case RQSTYPE_CTIO3:
3891                 case RQSTYPE_CTIO2:
3892                 case RQSTYPE_CTIO:
3893                         isp_handle_platform_ctio(isp, hp);
3894                         break;
3895                 default:
3896                         isp_prt(isp, ISP_LOGWARN, "%s: unhandled target action 0x%x",
3897                             __func__, hp->rqs_entry_type);
3898                         break;
3899                 }
3900                 break;
3901         }
3902 #endif
3903         case ISPASYNC_FW_CRASH:
3904         {
3905                 uint16_t mbox1, mbox6;
3906                 mbox1 = ISP_READ(isp, OUTMAILBOX1);
3907                 if (IS_DUALBUS(isp)) {
3908                         mbox6 = ISP_READ(isp, OUTMAILBOX6);
3909                 } else {
3910                         mbox6 = 0;
3911                 }
3912                 isp_prt(isp, ISP_LOGERR, "Internal Firmware Error on bus %d @ RISC Address 0x%x", mbox6, mbox1);
3913 #if 0
3914                 mbox1 = isp->isp_osinfo.mbox_sleep_ok;
3915                 isp->isp_osinfo.mbox_sleep_ok = 0;
3916                 isp_reinit(isp, 1);
3917                 isp->isp_osinfo.mbox_sleep_ok = mbox1;
3918                 isp_async(isp, ISPASYNC_FW_RESTARTED, NULL);
3919 #endif
3920                 break;
3921         }
3922         default:
3923                 isp_prt(isp, ISP_LOGERR, "unknown isp_async event %d", cmd);
3924                 break;
3925         }
3926 }
3927
3928 uint64_t
3929 isp_default_wwn(ispsoftc_t * isp, int chan, int isactive, int iswwnn)
3930 {
3931         uint64_t seed;
3932         struct isp_fc *fc = ISP_FC_PC(isp, chan);
3933
3934         /* First try to use explicitly configured WWNs. */
3935         seed = iswwnn ? fc->def_wwnn : fc->def_wwpn;
3936         if (seed)
3937                 return (seed);
3938
3939         /* Otherwise try to use WWNs from NVRAM. */
3940         if (isactive) {
3941                 seed = iswwnn ? FCPARAM(isp, chan)->isp_wwnn_nvram :
3942                     FCPARAM(isp, chan)->isp_wwpn_nvram;
3943                 if (seed)
3944                         return (seed);
3945         }
3946
3947         /* If still no WWNs, try to steal them from the first channel. */
3948         if (chan > 0) {
3949                 seed = iswwnn ? ISP_FC_PC(isp, 0)->def_wwnn :
3950                     ISP_FC_PC(isp, 0)->def_wwpn;
3951                 if (seed == 0) {
3952                         seed = iswwnn ? FCPARAM(isp, 0)->isp_wwnn_nvram :
3953                             FCPARAM(isp, 0)->isp_wwpn_nvram;
3954                 }
3955         }
3956
3957         /* If still nothing -- improvise. */
3958         if (seed == 0) {
3959                 seed = 0x400000007F000000ull + device_get_unit(isp->isp_dev);
3960                 if (!iswwnn)
3961                         seed ^= 0x0100000000000000ULL;
3962         }
3963
3964         /* For additional channels we have to improvise even more. */
3965         if (!iswwnn && chan > 0) {
3966                 /*
3967                  * We'll stick our channel number plus one first into bits
3968                  * 57..59 and thence into bits 52..55 which allows for 8 bits
3969                  * of channel which is enough for our maximum of 255 channels.
3970                  */
3971                 seed ^= 0x0100000000000000ULL;
3972                 seed ^= ((uint64_t) (chan + 1) & 0xf) << 56;
3973                 seed ^= ((uint64_t) ((chan + 1) >> 4) & 0xf) << 52;
3974         }
3975         return (seed);
3976 }
3977
3978 void
3979 isp_prt(ispsoftc_t *isp, int level, const char *fmt, ...)
3980 {
3981         int loc;
3982         char lbuf[200];
3983         va_list ap;
3984
3985         if (level != ISP_LOGALL && (level & isp->isp_dblev) == 0) {
3986                 return;
3987         }
3988         snprintf(lbuf, sizeof (lbuf), "%s: ", device_get_nameunit(isp->isp_dev));
3989         loc = strlen(lbuf);
3990         va_start(ap, fmt);
3991         vsnprintf(&lbuf[loc], sizeof (lbuf) - loc - 1, fmt, ap);
3992         va_end(ap);
3993         printf("%s\n", lbuf);
3994 }
3995
3996 void
3997 isp_xs_prt(ispsoftc_t *isp, XS_T *xs, int level, const char *fmt, ...)
3998 {
3999         va_list ap;
4000         if (level != ISP_LOGALL && (level & isp->isp_dblev) == 0) {
4001                 return;
4002         }
4003         xpt_print_path(xs->ccb_h.path);
4004         va_start(ap, fmt);
4005         vprintf(fmt, ap);
4006         va_end(ap);
4007         printf("\n");
4008 }
4009
4010 uint64_t
4011 isp_nanotime_sub(struct timespec *b, struct timespec *a)
4012 {
4013         uint64_t elapsed;
4014         struct timespec x = *b;
4015         timespecsub(&x, a);
4016         elapsed = GET_NANOSEC(&x);
4017         if (elapsed == 0)
4018                 elapsed++;
4019         return (elapsed);
4020 }
4021
4022 int
4023 isp_mbox_acquire(ispsoftc_t *isp)
4024 {
4025         if (isp->isp_osinfo.mboxbsy) {
4026                 return (1);
4027         } else {
4028                 isp->isp_osinfo.mboxcmd_done = 0;
4029                 isp->isp_osinfo.mboxbsy = 1;
4030                 return (0);
4031         }
4032 }
4033
4034 void
4035 isp_mbox_wait_complete(ispsoftc_t *isp, mbreg_t *mbp)
4036 {
4037         u_int t, to;
4038
4039         to = (mbp->timeout == 0) ? MBCMD_DEFAULT_TIMEOUT : mbp->timeout;
4040         if (isp->isp_osinfo.mbox_sleep_ok) {
4041                 isp->isp_osinfo.mbox_sleep_ok = 0;
4042                 isp->isp_osinfo.mbox_sleeping = 1;
4043                 msleep_sbt(&isp->isp_osinfo.mboxcmd_done, &isp->isp_lock,
4044                     PRIBIO, "ispmbx_sleep", to * SBT_1US, 0, 0);
4045                 isp->isp_osinfo.mbox_sleep_ok = 1;
4046                 isp->isp_osinfo.mbox_sleeping = 0;
4047         } else {
4048                 for (t = 0; t < to; t += 100) {
4049                         if (isp->isp_osinfo.mboxcmd_done)
4050                                 break;
4051                         ISP_RUN_ISR(isp);
4052                         if (isp->isp_osinfo.mboxcmd_done)
4053                                 break;
4054                         ISP_DELAY(100);
4055                 }
4056         }
4057         if (isp->isp_osinfo.mboxcmd_done == 0) {
4058                 isp_prt(isp, ISP_LOGWARN, "%s Mailbox Command (0x%x) Timeout (%uus) (%s:%d)",
4059                     isp->isp_osinfo.mbox_sleep_ok? "Interrupting" : "Polled",
4060                     isp->isp_lastmbxcmd, to, mbp->func, mbp->lineno);
4061                 mbp->param[0] = MBOX_TIMEOUT;
4062                 isp->isp_osinfo.mboxcmd_done = 1;
4063         }
4064 }
4065
4066 void
4067 isp_mbox_notify_done(ispsoftc_t *isp)
4068 {
4069         isp->isp_osinfo.mboxcmd_done = 1;
4070         if (isp->isp_osinfo.mbox_sleeping)
4071                 wakeup(&isp->isp_osinfo.mboxcmd_done);
4072 }
4073
4074 void
4075 isp_mbox_release(ispsoftc_t *isp)
4076 {
4077         isp->isp_osinfo.mboxbsy = 0;
4078 }
4079
4080 int
4081 isp_fc_scratch_acquire(ispsoftc_t *isp, int chan)
4082 {
4083         int ret = 0;
4084         if (isp->isp_osinfo.pc.fc[chan].fcbsy) {
4085                 ret = -1;
4086         } else {
4087                 isp->isp_osinfo.pc.fc[chan].fcbsy = 1;
4088         }
4089         return (ret);
4090 }
4091
4092 void
4093 isp_platform_intr(void *arg)
4094 {
4095         ispsoftc_t *isp = arg;
4096
4097         ISP_LOCK(isp);
4098         ISP_RUN_ISR(isp);
4099         ISP_UNLOCK(isp);
4100 }
4101
4102 void
4103 isp_platform_intr_resp(void *arg)
4104 {
4105         ispsoftc_t *isp = arg;
4106
4107         ISP_LOCK(isp);
4108         isp_intr_respq(isp);
4109         ISP_UNLOCK(isp);
4110
4111         /* We have handshake enabled, so explicitly complete interrupt */
4112         ISP_WRITE(isp, BIU2400_HCCR, HCCR_2400_CMD_CLEAR_RISC_INT);
4113 }
4114
4115 void
4116 isp_platform_intr_atio(void *arg)
4117 {
4118         ispsoftc_t *isp = arg;
4119
4120         ISP_LOCK(isp);
4121 #ifdef  ISP_TARGET_MODE
4122         isp_intr_atioq(isp);
4123 #endif
4124         ISP_UNLOCK(isp);
4125
4126         /* We have handshake enabled, so explicitly complete interrupt */
4127         ISP_WRITE(isp, BIU2400_HCCR, HCCR_2400_CMD_CLEAR_RISC_INT);
4128 }
4129
4130 void
4131 isp_common_dmateardown(ispsoftc_t *isp, struct ccb_scsiio *csio, uint32_t hdl)
4132 {
4133         if ((csio->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
4134                 bus_dmamap_sync(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap, BUS_DMASYNC_POSTREAD);
4135         } else {
4136                 bus_dmamap_sync(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap, BUS_DMASYNC_POSTWRITE);
4137         }
4138         bus_dmamap_unload(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap);
4139 }
4140
4141 /*
4142  * Reset the command reference number for all LUNs on a specific target
4143  * (needed when a target arrives again) or for all targets on a port
4144  * (needed for events like a LIP).
4145  */
4146 void
4147 isp_fcp_reset_crn(ispsoftc_t *isp, int chan, uint32_t tgt, int tgt_set)
4148 {
4149         struct isp_fc *fc = ISP_FC_PC(isp, chan);
4150         struct isp_nexus *nxp;
4151         int i;
4152
4153         if (tgt_set == 0)
4154                 isp_prt(isp, ISP_LOGDEBUG0,
4155                     "Chan %d resetting CRN on all targets", chan);
4156         else
4157                 isp_prt(isp, ISP_LOGDEBUG0,
4158                     "Chan %d resetting CRN on target %u", chan, tgt);
4159
4160         for (i = 0; i < NEXUS_HASH_WIDTH; i++) {
4161                 for (nxp = fc->nexus_hash[i]; nxp != NULL; nxp = nxp->next) {
4162                         if (tgt_set == 0 || tgt == nxp->tgt)
4163                                 nxp->crnseed = 0;
4164                 }
4165         }
4166 }
4167
4168 int
4169 isp_fcp_next_crn(ispsoftc_t *isp, uint8_t *crnp, XS_T *cmd)
4170 {
4171         lun_id_t lun;
4172         uint32_t chan, tgt;
4173         struct isp_fc *fc;
4174         struct isp_nexus *nxp;
4175         int idx;
4176
4177         if (IS_2100(isp))
4178                 return (0);
4179
4180         chan = XS_CHANNEL(cmd);
4181         tgt = XS_TGT(cmd);
4182         lun = XS_LUN(cmd);
4183         fc = &isp->isp_osinfo.pc.fc[chan];
4184         idx = NEXUS_HASH(tgt, lun);
4185         nxp = fc->nexus_hash[idx];
4186
4187         while (nxp) {
4188                 if (nxp->tgt == tgt && nxp->lun == lun)
4189                         break;
4190                 nxp = nxp->next;
4191         }
4192         if (nxp == NULL) {
4193                 nxp = fc->nexus_free_list;
4194                 if (nxp == NULL) {
4195                         nxp = malloc(sizeof (struct isp_nexus), M_DEVBUF, M_ZERO|M_NOWAIT);
4196                         if (nxp == NULL) {
4197                                 return (-1);
4198                         }
4199                 } else {
4200                         fc->nexus_free_list = nxp->next;
4201                 }
4202                 nxp->tgt = tgt;
4203                 nxp->lun = lun;
4204                 nxp->next = fc->nexus_hash[idx];
4205                 fc->nexus_hash[idx] = nxp;
4206         }
4207         if (nxp->crnseed == 0)
4208                 nxp->crnseed = 1;
4209         *crnp = nxp->crnseed++;
4210         return (0);
4211 }
4212
4213 /*
4214  * We enter with the lock held
4215  */
4216 void
4217 isp_timer(void *arg)
4218 {
4219         ispsoftc_t *isp = arg;
4220 #ifdef  ISP_TARGET_MODE
4221         isp_tmcmd_restart(isp);
4222 #endif
4223         callout_reset(&isp->isp_osinfo.tmo, isp_timer_count, isp_timer, isp);
4224 }
4225
4226 isp_ecmd_t *
4227 isp_get_ecmd(ispsoftc_t *isp)
4228 {
4229         isp_ecmd_t *ecmd = isp->isp_osinfo.ecmd_free;
4230         if (ecmd) {
4231                 isp->isp_osinfo.ecmd_free = ecmd->next;
4232         }
4233         return (ecmd);
4234 }
4235
4236 void
4237 isp_put_ecmd(ispsoftc_t *isp, isp_ecmd_t *ecmd)
4238 {
4239         ecmd->next = isp->isp_osinfo.ecmd_free;
4240         isp->isp_osinfo.ecmd_free = ecmd;
4241 }