sys/dev/isp/isp_freebsd.c

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