The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/isp/isp_freebsd.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

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

Cache object: 886643b8b4f28df37222320ac4ccfd4e


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.