sys/dev/isp/isp_freebsd.c

   1 /*-
   2  * Copyright (c) 1997-2009 by Matthew Jacob
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice immediately at the beginning of the file, without modification,
  10  *    this list of conditions, and the following disclaimer.
  11  * 2. The name of the author may not be used to endorse or promote products
  12  *    derived from this software without specific prior written permission.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
  18  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  */
  26
  27 /*
  28  * Platform (FreeBSD) dependent common attachment code for Qlogic adapters.
  29  */
  30 #include <sys/cdefs.h>
  31 __FBSDID("$FreeBSD$");
  32 #include <dev/isp/isp_freebsd.h>
  33 #include <sys/unistd.h>
  34 #include <sys/kthread.h>
  35 #include <sys/conf.h>
  36 #include <sys/module.h>
  37 #include <sys/ioccom.h>
  38 #include <dev/isp/isp_ioctl.h>
  39 #include <sys/devicestat.h>
  40 #include <cam/cam_periph.h>
  41 #include <cam/cam_xpt_periph.h>
  42
  43 #if     __FreeBSD_version < 800002
  44 #define THREAD_CREATE   kthread_create
  45 #else
  46 #define THREAD_CREATE   kproc_create
  47 #endif
  48
  49 MODULE_VERSION(isp, 1);
  50 MODULE_DEPEND(isp, cam, 1, 1, 1);
  51 int isp_announced = 0;
  52 int isp_fabric_hysteresis = 3;
  53 int isp_loop_down_limit = 60;   /* default loop down limit */
  54 int isp_change_is_bad = 0;      /* "changed" devices are bad */
  55 int isp_quickboot_time = 7;     /* don't wait more than N secs for loop up */
  56 int isp_gone_device_time = 30;  /* grace time before reporting device lost */
  57 int isp_autoconfig = 1;         /* automatically attach/detach devices */
  58 static const char *roles[4] = {
  59     "(none)", "Target", "Initiator", "Target/Initiator"
  60 };
  61 static const char prom3[] = "Chan %d PortID 0x%06x Departed from Target %u because of %s";
  62 static const char rqo[] = "%s: Request Queue Overflow\n";
  63
  64 static void isp_freeze_loopdown(ispsoftc_t *, int, char *);
  65 static d_ioctl_t ispioctl;
  66 static void isp_intr_enable(void *);
  67 static void isp_cam_async(void *, uint32_t, struct cam_path *, void *);
  68 static void isp_poll(struct cam_sim *);
  69 static timeout_t isp_watchdog;
  70 static timeout_t isp_ldt;
  71 static void isp_kthread(void *);
  72 static void isp_action(struct cam_sim *, union ccb *);
  73 #ifdef  ISP_INTERNAL_TARGET
  74 static void isp_target_thread_pi(void *);
  75 static void isp_target_thread_fc(void *);
  76 #endif
  77 static void isp_timer(void *);
  78
  79 static struct cdevsw isp_cdevsw = {
  80         .d_version =    D_VERSION,
  81         .d_ioctl =      ispioctl,
  82         .d_name =       "isp",
  83 };
  84
  85 static int
  86 isp_attach_chan(ispsoftc_t *isp, struct cam_devq *devq, int chan)
  87 {
  88         struct ccb_setasync csa;
  89         struct cam_sim *sim;
  90         struct cam_path *path;
  91
  92         /*
  93          * Construct our SIM entry.
  94          */
  95         sim = cam_sim_alloc(isp_action, isp_poll, "isp", isp, device_get_unit(isp->isp_dev), &isp->isp_osinfo.lock, isp->isp_maxcmds, isp->isp_maxcmds, devq);
  96
  97         if (sim == NULL) {
  98                 return (ENOMEM);
  99         }
 100
 101         ISP_LOCK(isp);
 102         if (xpt_bus_register(sim, isp->isp_dev, chan) != CAM_SUCCESS) {
 103                 ISP_UNLOCK(isp);
 104                 cam_sim_free(sim, FALSE);
 105                 return (EIO);
 106         }
 107         ISP_UNLOCK(isp);
 108
 109         if (xpt_create_path(&path, NULL, cam_sim_path(sim), CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
 110                 ISP_LOCK(isp);
 111                 xpt_bus_deregister(cam_sim_path(sim));
 112                 ISP_UNLOCK(isp);
 113                 cam_sim_free(sim, FALSE);
 114                 return (ENXIO);
 115         }
 116
 117         xpt_setup_ccb(&csa.ccb_h, path, 5);
 118         csa.ccb_h.func_code = XPT_SASYNC_CB;
 119         csa.event_enable = AC_LOST_DEVICE;
 120         csa.callback = isp_cam_async;
 121         csa.callback_arg = sim;
 122         xpt_action((union ccb *)&csa);
 123
 124         if (IS_SCSI(isp)) {
 125                 struct isp_spi *spi = ISP_SPI_PC(isp, chan);
 126                 spi->sim = sim;
 127                 spi->path = path;
 128 #ifdef  ISP_INTERNAL_TARGET
 129                 ISP_SET_PC(isp, chan, proc_active, 1);
 130                 if (THREAD_CREATE(isp_target_thread_pi, spi, &spi->target_proc, 0, 0, "%s: isp_test_tgt%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
 131                         ISP_SET_PC(isp, chan, proc_active, 0);
 132                         isp_prt(isp, ISP_LOGERR, "cannot create test target thread");
 133                 }
 134 #endif
 135         } else {
 136                 struct isp_fc *fc = ISP_FC_PC(isp, chan);
 137
 138                 fc->sim = sim;
 139                 fc->path = path;
 140                 fc->isp = isp;
 141
 142                 callout_init_mtx(&fc->ldt, &isp->isp_osinfo.lock, 0);
 143                 callout_init_mtx(&fc->gdt, &isp->isp_osinfo.lock, 0);
 144
 145                 if (THREAD_CREATE(isp_kthread, fc, &fc->kproc, 0, 0, "%s: fc_thrd%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
 146                         xpt_free_path(fc->path);
 147                         ISP_LOCK(isp);
 148                         xpt_bus_deregister(cam_sim_path(fc->sim));
 149                         ISP_UNLOCK(isp);
 150                         cam_sim_free(fc->sim, FALSE);
 151                 }
 152                 /*
 153                  * We start by being "loop down" if we have an initiator role
 154                  */
 155                 ISP_LOCK(isp);
 156                 if ((FCPARAM(isp, chan)->role & ISP_ROLE_INITIATOR) && fc->ldt_running == 0) {
 157                         isp_freeze_loopdown(isp, chan, "isp_attach");
 158                         fc->ldt_running = 1;
 159                         callout_reset(&fc->ldt, isp_quickboot_time * hz, isp_ldt, fc);
 160                         isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "Starting Initial Loop Down Timer @ %lu", (unsigned long) time_uptime);
 161                 }
 162                 ISP_UNLOCK(isp);
 163 #ifdef  ISP_INTERNAL_TARGET
 164                 ISP_SET_PC(isp, chan, proc_active, 1);
 165                 if (THREAD_CREATE(isp_target_thread_fc, fc, &fc->target_proc, 0, 0, "%s: isp_test_tgt%d", device_get_nameunit(isp->isp_osinfo.dev), chan)) {
 166                         ISP_SET_PC(isp, chan, proc_active, 0);
 167                         isp_prt(isp, ISP_LOGERR, "cannot create test target thread");
 168                 }
 169 #endif
 170         }
 171         return (0);
 172 }
 173
 174 int
 175 isp_attach(ispsoftc_t *isp)
 176 {
 177         const char *nu = device_get_nameunit(isp->isp_osinfo.dev);
 178         int du = device_get_unit(isp->isp_dev);
 179         int chan;
 180
 181         isp->isp_osinfo.ehook.ich_func = isp_intr_enable;
 182         isp->isp_osinfo.ehook.ich_arg = isp;
 183         if (config_intrhook_establish(&isp->isp_osinfo.ehook) != 0) {
 184                 isp_prt(isp, ISP_LOGERR, "could not establish interrupt enable hook");
 185                 return (-EIO);
 186         }
 187         isp->isp_osinfo.ehook_active = 1;
 188
 189
 190         /*
 191          * Create the device queue for our SIM(s).
 192          */
 193         isp->isp_osinfo.devq = cam_simq_alloc(isp->isp_maxcmds);
 194         if (isp->isp_osinfo.devq == NULL) {
 195                 config_intrhook_disestablish(&isp->isp_osinfo.ehook);
 196                 return (EIO);
 197         }
 198
 199         for (chan = 0; chan < isp->isp_nchan; chan++) {
 200                 if (isp_attach_chan(isp, isp->isp_osinfo.devq, chan)) {
 201                         goto unwind;
 202                 }
 203         }
 204
 205         callout_init_mtx(&isp->isp_osinfo.tmo, &isp->isp_osinfo.lock, 0);
 206         callout_reset(&isp->isp_osinfo.tmo, hz, isp_timer, isp);
 207         isp->isp_osinfo.timer_active = 1;
 208
 209         isp->isp_osinfo.cdev = make_dev(&isp_cdevsw, du, UID_ROOT, GID_OPERATOR, 0600, "%s", nu);
 210         if (isp->isp_osinfo.cdev) {
 211                 isp->isp_osinfo.cdev->si_drv1 = isp;
 212         }
 213         return (0);
 214
 215 unwind:
 216         while (--chan >= 0) {
 217                 struct cam_sim *sim;
 218                 struct cam_path *path;
 219                 if (IS_FC(isp)) {
 220                         sim = ISP_FC_PC(isp, chan)->sim;
 221                         path = ISP_FC_PC(isp, chan)->path;
 222                 } else {
 223                         sim = ISP_SPI_PC(isp, chan)->sim;
 224                         path = ISP_SPI_PC(isp, chan)->path;
 225                 }
 226                 xpt_free_path(path);
 227                 ISP_LOCK(isp);
 228                 xpt_bus_deregister(cam_sim_path(sim));
 229                 ISP_UNLOCK(isp);
 230                 cam_sim_free(sim, FALSE);
 231         }
 232         if (isp->isp_osinfo.ehook_active) {
 233                 config_intrhook_disestablish(&isp->isp_osinfo.ehook);
 234                 isp->isp_osinfo.ehook_active = 0;
 235         }
 236         if (isp->isp_osinfo.cdev) {
 237                 destroy_dev(isp->isp_osinfo.cdev);
 238                 isp->isp_osinfo.cdev = NULL;
 239         }
 240         cam_simq_free(isp->isp_osinfo.devq);
 241         isp->isp_osinfo.devq = NULL;
 242         return (-1);
 243 }
 244
 245 void
 246 isp_detach(ispsoftc_t *isp)
 247 {
 248         int chan;
 249
 250         ISP_LOCK(isp);
 251         if (isp->isp_osinfo.timer_active) {
 252                 callout_stop(&isp->isp_osinfo.tmo);
 253                 isp->isp_osinfo.timer_active = 0;
 254         }
 255         ISP_UNLOCK(isp);
 256         for (chan = isp->isp_nchan - 1; chan >= 0; chan -= 1) {
 257                 struct cam_sim *sim;
 258                 struct cam_path *path;
 259                 if (IS_FC(isp)) {
 260                         sim = ISP_FC_PC(isp, chan)->sim;
 261                         path = ISP_FC_PC(isp, chan)->path;
 262                 } else {
 263                         sim = ISP_SPI_PC(isp, chan)->sim;
 264                         path = ISP_SPI_PC(isp, chan)->path;
 265                 }
 266                 xpt_free_path(path);
 267                 ISP_LOCK(isp);
 268                 xpt_bus_deregister(cam_sim_path(sim));
 269                 ISP_UNLOCK(isp);
 270                 cam_sim_free(sim, FALSE);
 271         }
 272         if (isp->isp_osinfo.cdev) {
 273                 destroy_dev(isp->isp_osinfo.cdev);
 274                 isp->isp_osinfo.cdev = NULL;
 275         }
 276         if (isp->isp_osinfo.ehook_active) {
 277                 config_intrhook_disestablish(&isp->isp_osinfo.ehook);
 278                 isp->isp_osinfo.ehook_active = 0;
 279         }
 280         if (isp->isp_osinfo.devq == NULL) {
 281                 cam_simq_free(isp->isp_osinfo.devq);
 282                 isp->isp_osinfo.devq = NULL;
 283         }
 284 }
 285
 286 static void
 287 isp_freeze_loopdown(ispsoftc_t *isp, int chan, char *msg)
 288 {
 289         if (IS_FC(isp)) {
 290                 struct isp_fc *fc = ISP_FC_PC(isp, chan);
 291                 if (fc->simqfrozen == 0) {
 292                         isp_prt(isp, ISP_LOGDEBUG0, "%s: freeze simq (loopdown) chan %d", msg, chan);
 293                         fc->simqfrozen = SIMQFRZ_LOOPDOWN;
 294                         xpt_freeze_simq(fc->sim, 1);
 295                 } else {
 296                         isp_prt(isp, ISP_LOGDEBUG0, "%s: mark frozen (loopdown) chan %d", msg, chan);
 297                         fc->simqfrozen |= SIMQFRZ_LOOPDOWN;
 298                 }
 299         }
 300 }
 301
 302
 303 static int
 304 ispioctl(struct cdev *dev, u_long c, caddr_t addr, int flags, struct thread *td)
 305 {
 306         ispsoftc_t *isp;
 307         int nr, chan, retval = ENOTTY;
 308
 309         isp = dev->si_drv1;
 310
 311         switch (c) {
 312         case ISP_SDBLEV:
 313         {
 314                 int olddblev = isp->isp_dblev;
 315                 isp->isp_dblev = *(int *)addr;
 316                 *(int *)addr = olddblev;
 317                 retval = 0;
 318                 break;
 319         }
 320         case ISP_GETROLE:
 321                 chan = *(int *)addr;
 322                 if (chan < 0 || chan >= isp->isp_nchan) {
 323                         retval = -ENXIO;
 324                         break;
 325                 }
 326                 if (IS_FC(isp)) {
 327                         *(int *)addr = FCPARAM(isp, chan)->role;
 328                 } else {
 329                         *(int *)addr = SDPARAM(isp, chan)->role;
 330                 }
 331                 retval = 0;
 332                 break;
 333         case ISP_SETROLE:
 334                 nr = *(int *)addr;
 335                 chan = nr >> 8;
 336                 if (chan < 0 || chan >= isp->isp_nchan) {
 337                         retval = -ENXIO;
 338                         break;
 339                 }
 340                 nr &= 0xff;
 341                 if (nr & ~(ISP_ROLE_INITIATOR|ISP_ROLE_TARGET)) {
 342                         retval = EINVAL;
 343                         break;
 344                 }
 345                 if (IS_FC(isp)) {
 346                         *(int *)addr = FCPARAM(isp, chan)->role;
 347 #ifdef  ISP_INTERNAL_TARGET
 348                         ISP_LOCK(isp);
 349                         retval = isp_fc_change_role(isp, chan, nr);
 350                         ISP_UNLOCK(isp);
 351 #else
 352                         FCPARAM(isp, chan)->role = nr;
 353 #endif
 354                 } else {
 355                         *(int *)addr = SDPARAM(isp, chan)->role;
 356                         SDPARAM(isp, chan)->role = nr;
 357                 }
 358                 retval = 0;
 359                 break;
 360
 361         case ISP_RESETHBA:
 362                 ISP_LOCK(isp);
 363 #ifdef  ISP_TARGET_MODE
 364                 isp_del_all_wwn_entries(isp, ISP_NOCHAN);
 365 #endif
 366                 isp_reinit(isp, 0);
 367                 ISP_UNLOCK(isp);
 368                 retval = 0;
 369                 break;
 370
 371         case ISP_RESCAN:
 372                 if (IS_FC(isp)) {
 373                         chan = *(int *)addr;
 374                         if (chan < 0 || chan >= isp->isp_nchan) {
 375                                 retval = -ENXIO;
 376                                 break;
 377                         }
 378                         ISP_LOCK(isp);
 379                         if (isp_fc_runstate(isp, chan, 5 * 1000000)) {
 380                                 retval = EIO;
 381                         } else {
 382                                 retval = 0;
 383                         }
 384                         ISP_UNLOCK(isp);
 385                 }
 386                 break;
 387
 388         case ISP_FC_LIP:
 389                 if (IS_FC(isp)) {
 390                         chan = *(int *)addr;
 391                         if (chan < 0 || chan >= isp->isp_nchan) {
 392                                 retval = -ENXIO;
 393                                 break;
 394                         }
 395                         ISP_LOCK(isp);
 396                         if (isp_control(isp, ISPCTL_SEND_LIP, chan)) {
 397                                 retval = EIO;
 398                         } else {
 399                                 retval = 0;
 400                         }
 401                         ISP_UNLOCK(isp);
 402                 }
 403                 break;
 404         case ISP_FC_GETDINFO:
 405         {
 406                 struct isp_fc_device *ifc = (struct isp_fc_device *) addr;
 407                 fcportdb_t *lp;
 408
 409                 if (IS_SCSI(isp)) {
 410                         break;
 411                 }
 412                 if (ifc->loopid >= MAX_FC_TARG) {
 413                         retval = EINVAL;
 414                         break;
 415                 }
 416                 lp = &FCPARAM(isp, ifc->chan)->portdb[ifc->loopid];
 417                 if (lp->state == FC_PORTDB_STATE_VALID || lp->target_mode) {
 418                         ifc->role = lp->roles;
 419                         ifc->loopid = lp->handle;
 420                         ifc->portid = lp->portid;
 421                         ifc->node_wwn = lp->node_wwn;
 422                         ifc->port_wwn = lp->port_wwn;
 423                         retval = 0;
 424                 } else {
 425                         retval = ENODEV;
 426                 }
 427                 break;
 428         }
 429         case ISP_GET_STATS:
 430         {
 431                 isp_stats_t *sp = (isp_stats_t *) addr;
 432
 433                 ISP_MEMZERO(sp, sizeof (*sp));
 434                 sp->isp_stat_version = ISP_STATS_VERSION;
 435                 sp->isp_type = isp->isp_type;
 436                 sp->isp_revision = isp->isp_revision;
 437                 ISP_LOCK(isp);
 438                 sp->isp_stats[ISP_INTCNT] = isp->isp_intcnt;
 439                 sp->isp_stats[ISP_INTBOGUS] = isp->isp_intbogus;
 440                 sp->isp_stats[ISP_INTMBOXC] = isp->isp_intmboxc;
 441                 sp->isp_stats[ISP_INGOASYNC] = isp->isp_intoasync;
 442                 sp->isp_stats[ISP_RSLTCCMPLT] = isp->isp_rsltccmplt;
 443                 sp->isp_stats[ISP_FPHCCMCPLT] = isp->isp_fphccmplt;
 444                 sp->isp_stats[ISP_RSCCHIWAT] = isp->isp_rscchiwater;
 445                 sp->isp_stats[ISP_FPCCHIWAT] = isp->isp_fpcchiwater;
 446                 ISP_UNLOCK(isp);
 447                 retval = 0;
 448                 break;
 449         }
 450         case ISP_CLR_STATS:
 451                 ISP_LOCK(isp);
 452                 isp->isp_intcnt = 0;
 453                 isp->isp_intbogus = 0;
 454                 isp->isp_intmboxc = 0;
 455                 isp->isp_intoasync = 0;
 456                 isp->isp_rsltccmplt = 0;
 457                 isp->isp_fphccmplt = 0;
 458                 isp->isp_rscchiwater = 0;
 459                 isp->isp_fpcchiwater = 0;
 460                 ISP_UNLOCK(isp);
 461                 retval = 0;
 462                 break;
 463         case ISP_FC_GETHINFO:
 464         {
 465                 struct isp_hba_device *hba = (struct isp_hba_device *) addr;
 466                 int chan = hba->fc_channel;
 467
 468                 if (chan < 0 || chan >= isp->isp_nchan) {
 469                         retval = ENXIO;
 470                         break;
 471                 }
 472                 hba->fc_fw_major = ISP_FW_MAJORX(isp->isp_fwrev);
 473                 hba->fc_fw_minor = ISP_FW_MINORX(isp->isp_fwrev);
 474                 hba->fc_fw_micro = ISP_FW_MICROX(isp->isp_fwrev);
 475                 hba->fc_nchannels = isp->isp_nchan;
 476                 if (IS_FC(isp)) {
 477                         hba->fc_nports = MAX_FC_TARG;
 478                         hba->fc_speed = FCPARAM(isp, hba->fc_channel)->isp_gbspeed;
 479                         hba->fc_topology = FCPARAM(isp, chan)->isp_topo + 1;
 480                         hba->fc_loopid = FCPARAM(isp, chan)->isp_loopid;
 481                         hba->nvram_node_wwn = FCPARAM(isp, chan)->isp_wwnn_nvram;
 482                         hba->nvram_port_wwn = FCPARAM(isp, chan)->isp_wwpn_nvram;
 483                         hba->active_node_wwn = FCPARAM(isp, chan)->isp_wwnn;
 484                         hba->active_port_wwn = FCPARAM(isp, chan)->isp_wwpn;
 485                 } else {
 486                         hba->fc_nports = MAX_TARGETS;
 487                         hba->fc_speed = 0;
 488                         hba->fc_topology = 0;
 489                         hba->nvram_node_wwn = 0ull;
 490                         hba->nvram_port_wwn = 0ull;
 491                         hba->active_node_wwn = 0ull;
 492                         hba->active_port_wwn = 0ull;
 493                 }
 494                 retval = 0;
 495                 break;
 496         }
 497         case ISP_TSK_MGMT:
 498         {
 499                 int needmarker;
 500                 struct isp_fc_tsk_mgmt *fct = (struct isp_fc_tsk_mgmt *) addr;
 501                 uint16_t loopid;
 502                 mbreg_t mbs;
 503
 504                 if (IS_SCSI(isp)) {
 505                         break;
 506                 }
 507
 508                 chan = fct->chan;
 509                 if (chan < 0 || chan >= isp->isp_nchan) {
 510                         retval = -ENXIO;
 511                         break;
 512                 }
 513
 514                 needmarker = retval = 0;
 515                 loopid = fct->loopid;
 516                 ISP_LOCK(isp);
 517                 if (IS_24XX(isp)) {
 518                         uint8_t local[QENTRY_LEN];
 519                         isp24xx_tmf_t *tmf;
 520                         isp24xx_statusreq_t *sp;
 521                         fcparam *fcp = FCPARAM(isp, chan);
 522                         fcportdb_t *lp;
 523                         int i;
 524
 525                         for (i = 0; i < MAX_FC_TARG; i++) {
 526                                 lp = &fcp->portdb[i];
 527                                 if (lp->handle == loopid) {
 528                                         break;
 529                                 }
 530                         }
 531                         if (i == MAX_FC_TARG) {
 532                                 retval = ENXIO;
 533                                 ISP_UNLOCK(isp);
 534                                 break;
 535                         }
 536                         /* XXX VALIDATE LP XXX */
 537                         tmf = (isp24xx_tmf_t *) local;
 538                         ISP_MEMZERO(tmf, QENTRY_LEN);
 539                         tmf->tmf_header.rqs_entry_type = RQSTYPE_TSK_MGMT;
 540                         tmf->tmf_header.rqs_entry_count = 1;
 541                         tmf->tmf_nphdl = lp->handle;
 542                         tmf->tmf_delay = 2;
 543                         tmf->tmf_timeout = 2;
 544                         tmf->tmf_tidlo = lp->portid;
 545                         tmf->tmf_tidhi = lp->portid >> 16;
 546                         tmf->tmf_vpidx = ISP_GET_VPIDX(isp, chan);
 547                         tmf->tmf_lun[1] = fct->lun & 0xff;
 548                         if (fct->lun >= 256) {
 549                                 tmf->tmf_lun[0] = 0x40 | (fct->lun >> 8);
 550                         }
 551                         switch (fct->action) {
 552                         case IPT_CLEAR_ACA:
 553                                 tmf->tmf_flags = ISP24XX_TMF_CLEAR_ACA;
 554                                 break;
 555                         case IPT_TARGET_RESET:
 556                                 tmf->tmf_flags = ISP24XX_TMF_TARGET_RESET;
 557                                 needmarker = 1;
 558                                 break;
 559                         case IPT_LUN_RESET:
 560                                 tmf->tmf_flags = ISP24XX_TMF_LUN_RESET;
 561                                 needmarker = 1;
 562                                 break;
 563                         case IPT_CLEAR_TASK_SET:
 564                                 tmf->tmf_flags = ISP24XX_TMF_CLEAR_TASK_SET;
 565                                 needmarker = 1;
 566                                 break;
 567                         case IPT_ABORT_TASK_SET:
 568                                 tmf->tmf_flags = ISP24XX_TMF_ABORT_TASK_SET;
 569                                 needmarker = 1;
 570                                 break;
 571                         default:
 572                                 retval = EINVAL;
 573                                 break;
 574                         }
 575                         if (retval) {
 576                                 ISP_UNLOCK(isp);
 577                                 break;
 578                         }
 579                         MBSINIT(&mbs, MBOX_EXEC_COMMAND_IOCB_A64, MBLOGALL, 5000000);
 580                         mbs.param[1] = QENTRY_LEN;
 581                         mbs.param[2] = DMA_WD1(fcp->isp_scdma);
 582                         mbs.param[3] = DMA_WD0(fcp->isp_scdma);
 583                         mbs.param[6] = DMA_WD3(fcp->isp_scdma);
 584                         mbs.param[7] = DMA_WD2(fcp->isp_scdma);
 585
 586                         if (FC_SCRATCH_ACQUIRE(isp, chan)) {
 587                                 ISP_UNLOCK(isp);
 588                                 retval = ENOMEM;
 589                                 break;
 590                         }
 591                         isp_put_24xx_tmf(isp, tmf, fcp->isp_scratch);
 592                         MEMORYBARRIER(isp, SYNC_SFORDEV, 0, QENTRY_LEN);
 593                         sp = (isp24xx_statusreq_t *) local;
 594                         sp->req_completion_status = 1;
 595                         retval = isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs);
 596                         MEMORYBARRIER(isp, SYNC_SFORCPU, QENTRY_LEN, QENTRY_LEN);
 597                         isp_get_24xx_response(isp, &((isp24xx_statusreq_t *)fcp->isp_scratch)[1], sp);
 598                         FC_SCRATCH_RELEASE(isp, chan);
 599                         if (retval || sp->req_completion_status != 0) {
 600                                 FC_SCRATCH_RELEASE(isp, chan);
 601                                 retval = EIO;
 602                         }
 603                         if (retval == 0) {
 604                                 if (needmarker) {
 605                                         fcp->sendmarker = 1;
 606                                 }
 607                         }
 608                 } else {
 609                         MBSINIT(&mbs, 0, MBLOGALL, 0);
 610                         if (ISP_CAP_2KLOGIN(isp) == 0) {
 611                                 loopid <<= 8;
 612                         }
 613                         switch (fct->action) {
 614                         case IPT_CLEAR_ACA:
 615                                 mbs.param[0] = MBOX_CLEAR_ACA;
 616                                 mbs.param[1] = loopid;
 617                                 mbs.param[2] = fct->lun;
 618                                 break;
 619                         case IPT_TARGET_RESET:
 620                                 mbs.param[0] = MBOX_TARGET_RESET;
 621                                 mbs.param[1] = loopid;
 622                                 needmarker = 1;
 623                                 break;
 624                         case IPT_LUN_RESET:
 625                                 mbs.param[0] = MBOX_LUN_RESET;
 626                                 mbs.param[1] = loopid;
 627                                 mbs.param[2] = fct->lun;
 628                                 needmarker = 1;
 629                                 break;
 630                         case IPT_CLEAR_TASK_SET:
 631                                 mbs.param[0] = MBOX_CLEAR_TASK_SET;
 632                                 mbs.param[1] = loopid;
 633                                 mbs.param[2] = fct->lun;
 634                                 needmarker = 1;
 635                                 break;
 636                         case IPT_ABORT_TASK_SET:
 637                                 mbs.param[0] = MBOX_ABORT_TASK_SET;
 638                                 mbs.param[1] = loopid;
 639                                 mbs.param[2] = fct->lun;
 640                                 needmarker = 1;
 641                                 break;
 642                         default:
 643                                 retval = EINVAL;
 644                                 break;
 645                         }
 646                         if (retval == 0) {
 647                                 if (needmarker) {
 648                                         FCPARAM(isp, chan)->sendmarker = 1;
 649                                 }
 650                                 retval = isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs);
 651                                 if (retval) {
 652                                         retval = EIO;
 653                                 }
 654                         }
 655                 }
 656                 ISP_UNLOCK(isp);
 657                 break;
 658         }
 659         default:
 660                 break;
 661         }
 662         return (retval);
 663 }
 664
 665 static void
 666 isp_intr_enable(void *arg)
 667 {
 668         int chan;
 669         ispsoftc_t *isp = arg;
 670         ISP_LOCK(isp);
 671         for (chan = 0; chan < isp->isp_nchan; chan++) {
 672                 if (IS_FC(isp)) {
 673                         if (FCPARAM(isp, chan)->role != ISP_ROLE_NONE) {
 674                                 ISP_ENABLE_INTS(isp);
 675                                 break;
 676                         }
 677                 } else {
 678                         if (SDPARAM(isp, chan)->role != ISP_ROLE_NONE) {
 679                                 ISP_ENABLE_INTS(isp);
 680                                 break;
 681                         }
 682                 }
 683         }
 684         ISP_UNLOCK(isp);
 685         /* Release our hook so that the boot can continue. */
 686         config_intrhook_disestablish(&isp->isp_osinfo.ehook);
 687 }
 688
 689 /*
 690  * Local Inlines
 691  */
 692
 693 static ISP_INLINE int isp_get_pcmd(ispsoftc_t *, union ccb *);
 694 static ISP_INLINE void isp_free_pcmd(ispsoftc_t *, union ccb *);
 695
 696 static ISP_INLINE int
 697 isp_get_pcmd(ispsoftc_t *isp, union ccb *ccb)
 698 {
 699         ISP_PCMD(ccb) = isp->isp_osinfo.pcmd_free;
 700         if (ISP_PCMD(ccb) == NULL) {
 701                 return (-1);
 702         }
 703         isp->isp_osinfo.pcmd_free = ((struct isp_pcmd *)ISP_PCMD(ccb))->next;
 704         return (0);
 705 }
 706
 707 static ISP_INLINE void
 708 isp_free_pcmd(ispsoftc_t *isp, union ccb *ccb)
 709 {
 710         ((struct isp_pcmd *)ISP_PCMD(ccb))->next = isp->isp_osinfo.pcmd_free;
 711         isp->isp_osinfo.pcmd_free = ISP_PCMD(ccb);
 712         ISP_PCMD(ccb) = NULL;
 713 }
 714 /*
 715  * Put the target mode functions here, because some are inlines
 716  */
 717
 718 #ifdef  ISP_TARGET_MODE
 719 static ISP_INLINE int is_lun_enabled(ispsoftc_t *, int, lun_id_t);
 720 static ISP_INLINE tstate_t *get_lun_statep(ispsoftc_t *, int, lun_id_t);
 721 static ISP_INLINE tstate_t *get_lun_statep_from_tag(ispsoftc_t *, int, uint32_t);
 722 static ISP_INLINE void rls_lun_statep(ispsoftc_t *, tstate_t *);
 723 static ISP_INLINE inot_private_data_t *get_ntp_from_tagdata(ispsoftc_t *, uint32_t, uint32_t, tstate_t **);
 724 static ISP_INLINE atio_private_data_t *isp_get_atpd(ispsoftc_t *, tstate_t *, uint32_t);
 725 static ISP_INLINE void isp_put_atpd(ispsoftc_t *, tstate_t *, atio_private_data_t *);
 726 static ISP_INLINE inot_private_data_t *isp_get_ntpd(ispsoftc_t *, tstate_t *);
 727 static ISP_INLINE inot_private_data_t *isp_find_ntpd(ispsoftc_t *, tstate_t *, uint32_t, uint32_t);
 728 static ISP_INLINE void isp_put_ntpd(ispsoftc_t *, tstate_t *, inot_private_data_t *);
 729 static cam_status create_lun_state(ispsoftc_t *, int, struct cam_path *, tstate_t **);
 730 static void destroy_lun_state(ispsoftc_t *, tstate_t *);
 731 static void isp_enable_lun(ispsoftc_t *, union ccb *);
 732 static void isp_enable_deferred_luns(ispsoftc_t *, int);
 733 static cam_status isp_enable_deferred(ispsoftc_t *, int, lun_id_t);
 734 static void isp_disable_lun(ispsoftc_t *, union ccb *);
 735 static int isp_enable_target_mode(ispsoftc_t *, int);
 736 static void isp_ledone(ispsoftc_t *, lun_entry_t *);
 737 static timeout_t isp_refire_putback_atio;
 738 static void isp_complete_ctio(union ccb *);
 739 static void isp_target_putback_atio(union ccb *);
 740 static void isp_target_start_ctio(ispsoftc_t *, union ccb *);
 741 static void isp_handle_platform_atio(ispsoftc_t *, at_entry_t *);
 742 static void isp_handle_platform_atio2(ispsoftc_t *, at2_entry_t *);
 743 static void isp_handle_platform_atio7(ispsoftc_t *, at7_entry_t *);
 744 static void isp_handle_platform_ctio(ispsoftc_t *, void *);
 745 static void isp_handle_platform_notify_scsi(ispsoftc_t *, in_entry_t *);
 746 static void isp_handle_platform_notify_fc(ispsoftc_t *, in_fcentry_t *);
 747 static void isp_handle_platform_notify_24xx(ispsoftc_t *, in_fcentry_24xx_t *);
 748 static int isp_handle_platform_target_notify_ack(ispsoftc_t *, isp_notify_t *);
 749 static void isp_handle_platform_target_tmf(ispsoftc_t *, isp_notify_t *);
 750 static void isp_target_mark_aborted(ispsoftc_t *, union ccb *);
 751 static void isp_target_mark_aborted_early(ispsoftc_t *, tstate_t *, uint32_t);
 752
 753 static ISP_INLINE int
 754 is_lun_enabled(ispsoftc_t *isp, int bus, lun_id_t lun)
 755 {
 756         tstate_t *tptr;
 757         struct tslist *lhp;
 758
 759         ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(lun)], lhp);
 760         SLIST_FOREACH(tptr, lhp, next) {
 761                 if (xpt_path_lun_id(tptr->owner) == lun) {
 762                         return (1);
 763                 }
 764         }
 765         return (0);
 766 }
 767
 768 static void
 769 dump_tstates(ispsoftc_t *isp, int bus)
 770 {
 771         int i, j;
 772         struct tslist *lhp;
 773         tstate_t *tptr = NULL;
 774
 775         if (bus >= isp->isp_nchan) {
 776                 return;
 777         }
 778         for (i = 0; i < LUN_HASH_SIZE; i++) {
 779                 ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
 780                 j = 0;
 781                 SLIST_FOREACH(tptr, lhp, next) {
 782                         xpt_print(tptr->owner, "[%d, %d] atio_cnt=%d inot_cnt=%d\n", i, j, tptr->atio_count, tptr->inot_count);
 783                         j++;
 784                 }
 785         }
 786 }
 787
 788 static ISP_INLINE tstate_t *
 789 get_lun_statep(ispsoftc_t *isp, int bus, lun_id_t lun)
 790 {
 791         tstate_t *tptr = NULL;
 792         struct tslist *lhp;
 793         int i;
 794
 795         if (bus < isp->isp_nchan) {
 796                 for (i = 0; i < LUN_HASH_SIZE; i++) {
 797                         ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
 798                         SLIST_FOREACH(tptr, lhp, next) {
 799                                 if (xpt_path_lun_id(tptr->owner) == lun) {
 800                                         tptr->hold++;
 801                                         return (tptr);
 802                                 }
 803                         }
 804                 }
 805         }
 806         return (NULL);
 807 }
 808
 809 static ISP_INLINE tstate_t *
 810 get_lun_statep_from_tag(ispsoftc_t *isp, int bus, uint32_t tagval)
 811 {
 812         tstate_t *tptr = NULL;
 813         atio_private_data_t *atp;
 814         struct tslist *lhp;
 815         int i;
 816
 817         if (bus < isp->isp_nchan && tagval != 0) {
 818                 for (i = 0; i < LUN_HASH_SIZE; i++) {
 819                         ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
 820                         SLIST_FOREACH(tptr, lhp, next) {
 821                                 atp = isp_get_atpd(isp, tptr, tagval);
 822                                 if (atp && atp->tag == tagval) {
 823                                         tptr->hold++;
 824                                         return (tptr);
 825                                 }
 826                         }
 827                 }
 828         }
 829         return (NULL);
 830 }
 831
 832 static ISP_INLINE inot_private_data_t *
 833 get_ntp_from_tagdata(ispsoftc_t *isp, uint32_t tag_id, uint32_t seq_id, tstate_t **rslt)
 834 {
 835         inot_private_data_t *ntp;
 836         tstate_t *tptr;
 837         struct tslist *lhp;
 838         int bus, i;
 839
 840         for (bus = 0; bus < isp->isp_nchan; bus++) {
 841                 for (i = 0; i < LUN_HASH_SIZE; i++) {
 842                         ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
 843                         SLIST_FOREACH(tptr, lhp, next) {
 844                                 ntp = isp_find_ntpd(isp, tptr, tag_id, seq_id);
 845                                 if (ntp) {
 846                                         *rslt = tptr;
 847                                         tptr->hold++;
 848                                         return (ntp);
 849                                 }
 850                         }
 851                 }
 852         }
 853         return (NULL);
 854 }
 855 static ISP_INLINE void
 856 rls_lun_statep(ispsoftc_t *isp, tstate_t *tptr)
 857 {
 858         KASSERT((tptr->hold), ("tptr not held"));
 859         tptr->hold--;
 860 }
 861
 862 static void
 863 isp_tmcmd_restart(ispsoftc_t *isp)
 864 {
 865         inot_private_data_t *ntp;
 866         tstate_t *tptr;
 867         struct tslist *lhp;
 868         int bus, i;
 869
 870         for (bus = 0; bus < isp->isp_nchan; bus++) {
 871                 for (i = 0; i < LUN_HASH_SIZE; i++) {
 872                         ISP_GET_PC_ADDR(isp, bus, lun_hash[i], lhp);
 873                         SLIST_FOREACH(tptr, lhp, next) {
 874                                 inot_private_data_t *restart_queue = tptr->restart_queue;
 875                                 tptr->restart_queue = NULL;
 876                                 while (restart_queue) {
 877                                         ntp = restart_queue;
 878                                         restart_queue = ntp->rd.nt.nt_hba;
 879                                         if (IS_24XX(isp)) {
 880                                                 isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at7_entry_t *)ntp->rd.data)->at_rxid);
 881                                                 isp_handle_platform_atio7(isp, (at7_entry_t *) ntp->rd.data);
 882                                         } else {
 883                                                 isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at2_entry_t *)ntp->rd.data)->at_rxid);
 884                                                 isp_handle_platform_atio2(isp, (at2_entry_t *) ntp->rd.data);
 885                                         }
 886                                         isp_put_ntpd(isp, tptr, ntp);
 887                                         if (tptr->restart_queue && restart_queue != NULL) {
 888                                                 ntp = tptr->restart_queue;
 889                                                 tptr->restart_queue = restart_queue;
 890                                                 while (restart_queue->rd.nt.nt_hba) {
 891                                                         restart_queue = restart_queue->rd.nt.nt_hba;
 892                                                 }
 893                                                 restart_queue->rd.nt.nt_hba = ntp;
 894                                                 break;
 895                                         }
 896                                 }
 897                         }
 898                 }
 899         }
 900 }
 901
 902 static ISP_INLINE atio_private_data_t *
 903 isp_get_atpd(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag)
 904 {
 905         atio_private_data_t *atp;
 906
 907         if (tag == 0) {
 908                 atp = tptr->atfree;
 909                 if (atp) {
 910                         tptr->atfree = atp->next;
 911                 }
 912                 return (atp);
 913         }
 914         for (atp = tptr->atpool; atp < &tptr->atpool[ATPDPSIZE]; atp++) {
 915                 if (atp->tag == tag) {
 916                         return (atp);
 917                 }
 918         }
 919         return (NULL);
 920 }
 921
 922 static ISP_INLINE void
 923 isp_put_atpd(ispsoftc_t *isp, tstate_t *tptr, atio_private_data_t *atp)
 924 {
 925         atp->tag = 0;
 926         atp->dead = 0;
 927         atp->next = tptr->atfree;
 928         tptr->atfree = atp;
 929 }
 930
 931 static void
 932 isp_dump_atpd(ispsoftc_t *isp, tstate_t *tptr)
 933 {
 934         atio_private_data_t *atp;
 935         const char *states[8] = { "Free", "ATIO", "CAM", "CTIO", "LAST_CTIO", "PDON", "?6", "7" };
 936
 937         for (atp = tptr->atpool; atp < &tptr->atpool[ATPDPSIZE]; atp++) {
 938                 if (atp->tag == 0) {
 939                         continue;
 940                 }
 941                 xpt_print(tptr->owner, "ATP: [0x%x] origdlen %u bytes_xfrd %u last_xfr %u lun %u nphdl 0x%04x s_id 0x%06x d_id 0x%06x oxid 0x%04x state %s\n",
 942                     atp->tag, atp->orig_datalen, atp->bytes_xfered, atp->last_xframt, atp->lun, atp->nphdl, atp->sid, atp->portid, atp->oxid, states[atp->state & 0x7]);
 943         }
 944 }
 945
 946
 947 static ISP_INLINE inot_private_data_t *
 948 isp_get_ntpd(ispsoftc_t *isp, tstate_t *tptr)
 949 {
 950         inot_private_data_t *ntp;
 951         ntp = tptr->ntfree;
 952         if (ntp) {
 953                 tptr->ntfree = ntp->next;
 954         }
 955         return (ntp);
 956 }
 957
 958 static ISP_INLINE inot_private_data_t *
 959 isp_find_ntpd(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag_id, uint32_t seq_id)
 960 {
 961         inot_private_data_t *ntp;
 962         for (ntp = tptr->ntpool; ntp < &tptr->ntpool[ATPDPSIZE]; ntp++) {
 963                 if (ntp->rd.tag_id == tag_id && ntp->rd.seq_id == seq_id) {
 964                         return (ntp);
 965                 }
 966         }
 967         return (NULL);
 968 }
 969
 970 static ISP_INLINE void
 971 isp_put_ntpd(ispsoftc_t *isp, tstate_t *tptr, inot_private_data_t *ntp)
 972 {
 973         ntp->rd.tag_id = ntp->rd.seq_id = 0;
 974         ntp->next = tptr->ntfree;
 975         tptr->ntfree = ntp;
 976 }
 977
 978 static cam_status
 979 create_lun_state(ispsoftc_t *isp, int bus, struct cam_path *path, tstate_t **rslt)
 980 {
 981         cam_status status;
 982         lun_id_t lun;
 983         struct tslist *lhp;
 984         tstate_t *tptr;
 985         int i;
 986
 987         lun = xpt_path_lun_id(path);
 988         if (lun != CAM_LUN_WILDCARD) {
 989                 if (lun >= ISP_MAX_LUNS(isp)) {
 990                         return (CAM_LUN_INVALID);
 991                 }
 992         }
 993         if (is_lun_enabled(isp, bus, lun)) {
 994                 return (CAM_LUN_ALRDY_ENA);
 995         }
 996         tptr = (tstate_t *) malloc(sizeof (tstate_t), M_DEVBUF, M_NOWAIT|M_ZERO);
 997         if (tptr == NULL) {
 998                 return (CAM_RESRC_UNAVAIL);
 999         }
1000         status = xpt_create_path(&tptr->owner, NULL, xpt_path_path_id(path), xpt_path_target_id(path), lun);
1001         if (status != CAM_REQ_CMP) {
1002                 free(tptr, M_DEVBUF);
1003                 return (status);
1004         }
1005         SLIST_INIT(&tptr->atios);
1006         SLIST_INIT(&tptr->inots);
1007         for (i = 0; i < ATPDPSIZE-1; i++) {
1008                 tptr->atpool[i].next = &tptr->atpool[i+1];
1009                 tptr->ntpool[i].next = &tptr->ntpool[i+1];
1010         }
1011         tptr->atfree = tptr->atpool;
1012         tptr->ntfree = tptr->ntpool;
1013         tptr->hold = 1;
1014         ISP_GET_PC_ADDR(isp, bus, lun_hash[LUN_HASH_FUNC(xpt_path_lun_id(tptr->owner))], lhp);
1015         SLIST_INSERT_HEAD(lhp, tptr, next);
1016         *rslt = tptr;
1017         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, path, "created tstate\n");
1018         return (CAM_REQ_CMP);
1019 }
1020
1021 static ISP_INLINE void
1022 destroy_lun_state(ispsoftc_t *isp, tstate_t *tptr)
1023 {
1024         struct tslist *lhp;
1025         KASSERT((tptr->hold == 0), ("tptr still held"));
1026         ISP_GET_PC_ADDR(isp, xpt_path_path_id(tptr->owner), lun_hash[LUN_HASH_FUNC(xpt_path_lun_id(tptr->owner))], lhp);
1027         SLIST_REMOVE(lhp, tptr, tstate, next);
1028         xpt_free_path(tptr->owner);
1029         free(tptr, M_DEVBUF);
1030 }
1031
1032 /*
1033  * Enable a lun.
1034  */
1035 static void
1036 isp_enable_lun(ispsoftc_t *isp, union ccb *ccb)
1037 {
1038         tstate_t *tptr = NULL;
1039         int bus, tm_enabled, target_role;
1040         target_id_t target;
1041         lun_id_t lun;
1042
1043         /*
1044          * We only support either a wildcard target/lun or a target ID of zero and a non-wildcard lun
1045          */
1046         bus = XS_CHANNEL(ccb);
1047         target = ccb->ccb_h.target_id;
1048         lun = ccb->ccb_h.target_lun;
1049         if (target != CAM_TARGET_WILDCARD && target != 0) {
1050                 ccb->ccb_h.status = CAM_TID_INVALID;
1051                 xpt_done(ccb);
1052                 return;
1053         }
1054         if (target == CAM_TARGET_WILDCARD && lun != CAM_LUN_WILDCARD) {
1055                 ccb->ccb_h.status = CAM_LUN_INVALID;
1056                 xpt_done(ccb);
1057                 return;
1058         }
1059
1060         if (target != CAM_TARGET_WILDCARD && lun == CAM_LUN_WILDCARD) {
1061                 ccb->ccb_h.status = CAM_LUN_INVALID;
1062                 xpt_done(ccb);
1063                 return;
1064         }
1065         if (isp->isp_dblev & ISP_LOGTDEBUG0) {
1066                 xpt_print(ccb->ccb_h.path, "enabling lun 0x%x on channel %d\n", lun, bus);
1067         }
1068
1069         /*
1070          * Wait until we're not busy with the lun enables subsystem
1071          */
1072         while (isp->isp_osinfo.tmbusy) {
1073                 isp->isp_osinfo.tmwanted = 1;
1074                 mtx_sleep(isp, &isp->isp_lock, PRIBIO, "want_isp_enable_lun", 0);
1075         }
1076         isp->isp_osinfo.tmbusy = 1;
1077
1078         /*
1079          * This is as a good a place as any to check f/w capabilities.
1080          */
1081
1082         if (IS_FC(isp)) {
1083                 if (ISP_CAP_TMODE(isp) == 0) {
1084                         xpt_print(ccb->ccb_h.path, "firmware does not support target mode\n");
1085                         ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
1086                         goto done;
1087                 }
1088                 /*
1089                  * We *could* handle non-SCCLUN f/w, but we'd have to
1090                  * dork with our already fragile enable/disable code.
1091                  */
1092                 if (ISP_CAP_SCCFW(isp) == 0) {
1093                         xpt_print(ccb->ccb_h.path, "firmware not SCCLUN capable\n");
1094                         ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
1095                         goto done;
1096                 }
1097
1098                 target_role = (FCPARAM(isp, bus)->role & ISP_ROLE_TARGET) != 0;
1099
1100         } else {
1101                 target_role = (SDPARAM(isp, bus)->role & ISP_ROLE_TARGET) != 0;
1102         }
1103
1104         /*
1105          * Create the state pointer.
1106          * It should not already exist.
1107          */
1108         tptr = get_lun_statep(isp, bus, lun);
1109         if (tptr) {
1110                 ccb->ccb_h.status = CAM_LUN_ALRDY_ENA;
1111                 goto done;
1112         }
1113         ccb->ccb_h.status = create_lun_state(isp, bus, ccb->ccb_h.path, &tptr);
1114         if (ccb->ccb_h.status != CAM_REQ_CMP) {
1115                 goto done;
1116         }
1117
1118         /*
1119          * We have a tricky maneuver to perform here.
1120          *
1121          * If target mode isn't already enabled here,
1122          * *and* our current role includes target mode,
1123          * we enable target mode here.
1124          *
1125          */
1126         ISP_GET_PC(isp, bus, tm_enabled, tm_enabled);
1127         if (tm_enabled == 0 && target_role != 0) {
1128                 if (isp_enable_target_mode(isp, bus)) {
1129                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1130                         destroy_lun_state(isp, tptr);
1131                         tptr = NULL;
1132                         goto done;
1133                 }
1134                 tm_enabled = 1;
1135         }
1136
1137         /*
1138          * Now check to see whether this bus is in target mode already.
1139          *
1140          * If not, a later role change into target mode will finish the job.
1141          */
1142         if (tm_enabled == 0) {
1143                 ISP_SET_PC(isp, bus, tm_enable_defer, 1);
1144                 ccb->ccb_h.status = CAM_REQ_CMP;
1145                 xpt_print(ccb->ccb_h.path, "Target Mode Not Enabled Yet- Lun Enables Deferred\n");
1146                 goto done;
1147         }
1148
1149         /*
1150          * Enable the lun.
1151          */
1152         ccb->ccb_h.status = isp_enable_deferred(isp, bus, lun);
1153
1154 done:
1155         if (ccb->ccb_h.status != CAM_REQ_CMP && tptr) {
1156                 destroy_lun_state(isp, tptr);
1157                 tptr = NULL;
1158         }
1159         if (tptr) {
1160                 rls_lun_statep(isp, tptr);
1161         }
1162         isp->isp_osinfo.tmbusy = 0;
1163         if (isp->isp_osinfo.tmwanted) {
1164                 isp->isp_osinfo.tmwanted = 0;
1165                 wakeup(isp);
1166         }
1167         xpt_done(ccb);
1168 }
1169
1170 static void
1171 isp_enable_deferred_luns(ispsoftc_t *isp, int bus)
1172 {
1173         /*
1174          * XXX: not entirely implemented yet
1175          */
1176         (void) isp_enable_deferred(isp, bus, 0);
1177 }
1178
1179 static uint32_t
1180 isp_enable_deferred(ispsoftc_t *isp, int bus, lun_id_t lun)
1181 {
1182         cam_status status;
1183
1184         isp_prt(isp, ISP_LOGTINFO, "%s: bus %d lun %u", __func__, bus, lun);
1185         if (IS_24XX(isp) || (IS_FC(isp) && ISP_FC_PC(isp, bus)->tm_luns_enabled)) {
1186                 status = CAM_REQ_CMP;
1187         } else {
1188                 int cmd_cnt, not_cnt;
1189
1190                 if (IS_23XX(isp)) {
1191                         cmd_cnt = DFLT_CMND_CNT;
1192                         not_cnt = DFLT_INOT_CNT;
1193                 } else {
1194                         cmd_cnt = 64;
1195                         not_cnt = 8;
1196                 }
1197                 status = CAM_REQ_INPROG;
1198                 isp->isp_osinfo.rptr = &status;
1199                 if (isp_lun_cmd(isp, RQSTYPE_ENABLE_LUN, bus, lun, DFLT_CMND_CNT, DFLT_INOT_CNT)) {
1200                         status = CAM_RESRC_UNAVAIL;
1201                 } else {
1202                         mtx_sleep(&status, &isp->isp_lock, PRIBIO, "isp_enable_deferred", 0);
1203                 }
1204                 isp->isp_osinfo.rptr = NULL;
1205         }
1206
1207         if (status == CAM_REQ_CMP) {
1208                 ISP_SET_PC(isp, bus, tm_luns_enabled, 1);
1209                 isp_prt(isp, ISP_LOGTINFO, "bus %d lun %u now enabled for target mode", bus, lun);
1210         }
1211         return (status);
1212 }
1213
1214 static void
1215 isp_disable_lun(ispsoftc_t *isp, union ccb *ccb)
1216 {
1217         tstate_t *tptr = NULL;
1218         int bus;
1219         cam_status status;
1220         target_id_t target;
1221         lun_id_t lun;
1222
1223         bus = XS_CHANNEL(ccb);
1224         target = ccb->ccb_h.target_id;
1225         lun = ccb->ccb_h.target_lun;
1226         if (target != CAM_TARGET_WILDCARD && target != 0) {
1227                 ccb->ccb_h.status = CAM_TID_INVALID;
1228                 xpt_done(ccb);
1229                 return;
1230         }
1231         if (target == CAM_TARGET_WILDCARD && lun != CAM_LUN_WILDCARD) {
1232                 ccb->ccb_h.status = CAM_LUN_INVALID;
1233                 xpt_done(ccb);
1234                 return;
1235         }
1236
1237         if (target != CAM_TARGET_WILDCARD && lun == CAM_LUN_WILDCARD) {
1238                 ccb->ccb_h.status = CAM_LUN_INVALID;
1239                 xpt_done(ccb);
1240                 return;
1241         }
1242         if (isp->isp_dblev & ISP_LOGTDEBUG0) {
1243                 xpt_print(ccb->ccb_h.path, "enabling lun 0x%x on channel %d\n", lun, bus);
1244         }
1245
1246         /*
1247          * See if we're busy disabling a lun now.
1248          */
1249         while (isp->isp_osinfo.tmbusy) {
1250                 isp->isp_osinfo.tmwanted = 1;
1251                 mtx_sleep(isp, &isp->isp_lock, PRIBIO, "want_isp_disable_lun", 0);
1252         }
1253         isp->isp_osinfo.tmbusy = 1;
1254
1255         /*
1256          * Find the state pointer.
1257          */
1258         if ((tptr = get_lun_statep(isp, bus, lun)) == NULL) {
1259                 ccb->ccb_h.status = CAM_PATH_INVALID;
1260                 goto done;
1261         }
1262
1263         /*
1264          * If we're a 24XX card, we're done.
1265          */
1266         if (IS_24XX(isp)) {
1267                 status = CAM_REQ_CMP;
1268                 goto done;
1269         }
1270
1271         /*
1272          * For SCC FW, we only deal with lun zero.
1273          */
1274         if (IS_FC(isp)) {
1275                 lun = 0;
1276         }
1277
1278         isp->isp_osinfo.rptr = &status;
1279         status = CAM_REQ_INPROG;
1280         if (isp_lun_cmd(isp, RQSTYPE_ENABLE_LUN, bus, lun, 0, 0)) {
1281                 status = CAM_RESRC_UNAVAIL;
1282         } else {
1283                 mtx_sleep(ccb, &isp->isp_lock, PRIBIO, "isp_disable_lun", 0);
1284         }
1285 done:
1286         if (status == CAM_REQ_CMP) {
1287                 xpt_print(ccb->ccb_h.path, "now disabled for target mode\n");
1288         }
1289         if (tptr) {
1290                 rls_lun_statep(isp, tptr);
1291         }
1292         isp->isp_osinfo.rptr = NULL;
1293         isp->isp_osinfo.tmbusy = 0;
1294         if (isp->isp_osinfo.tmwanted) {
1295                 isp->isp_osinfo.tmwanted = 0;
1296                 wakeup(isp);
1297         }
1298         xpt_done(ccb);
1299 }
1300
1301 static int
1302 isp_enable_target_mode(ispsoftc_t *isp, int bus)
1303 {
1304         int ct;
1305
1306         ISP_GET_PC(isp, bus, tm_enabled, ct);
1307         if (ct != 0) {
1308                 return (0);
1309         }
1310
1311         if (IS_SCSI(isp)) {
1312                 mbreg_t mbs;
1313
1314                 MBSINIT(&mbs, MBOX_ENABLE_TARGET_MODE, MBLOGALL, 0);
1315                 mbs.param[0] = MBOX_ENABLE_TARGET_MODE;
1316                 mbs.param[1] = ENABLE_TARGET_FLAG|ENABLE_TQING_FLAG;
1317                 mbs.param[2] = bus << 7;
1318                 if (isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs) < 0 || mbs.param[0] != MBOX_COMMAND_COMPLETE) {
1319                         isp_prt(isp, ISP_LOGERR, "Unable to add Target Role to Bus %d", bus);
1320                         return (EIO);
1321                 }
1322                 SDPARAM(isp, bus)->role |= ISP_ROLE_TARGET;
1323         }
1324         ISP_SET_PC(isp, bus, tm_enabled, 1);
1325         isp_prt(isp, ISP_LOGINFO, "Target Role added to Bus %d", bus);
1326         return (0);
1327 }
1328
1329 #ifdef  NEEDED
1330 static int
1331 isp_disable_target_mode(ispsoftc_t *isp, int bus)
1332 {
1333         int ct;
1334
1335         ISP_GET_PC(isp, bus, tm_enabled, ct);
1336         if (ct == 0) {
1337                 return (0);
1338         }
1339
1340         if (IS_SCSI(isp)) {
1341                 mbreg_t mbs;
1342
1343                 MBSINIT(&mbs, MBOX_ENABLE_TARGET_MODE, MBLOGALL, 0);
1344                 mbs.param[2] = bus << 7;
1345                 if (isp_control(isp, ISPCTL_RUN_MBOXCMD, &mbs) < 0 || mbs.param[0] != MBOX_COMMAND_COMPLETE) {
1346                         isp_prt(isp, ISP_LOGERR, "Unable to subtract Target Role to Bus %d", bus);
1347                         return (EIO);
1348                 }
1349                 SDPARAM(isp, bus)->role &= ~ISP_ROLE_TARGET;
1350         }
1351         ISP_SET_PC(isp, bus, tm_enabled, 0);
1352         isp_prt(isp, ISP_LOGINFO, "Target Role subtracted from Bus %d", bus);
1353         return (0);
1354 }
1355 #endif
1356
1357 static void
1358 isp_ledone(ispsoftc_t *isp, lun_entry_t *lep)
1359 {
1360         uint32_t *rptr;
1361
1362         rptr = isp->isp_osinfo.rptr;
1363         if (lep->le_status != LUN_OK) {
1364                 isp_prt(isp, ISP_LOGERR, "ENABLE/MODIFY LUN returned 0x%x", lep->le_status);
1365                 if (rptr) {
1366                         *rptr = CAM_REQ_CMP_ERR;
1367                         wakeup_one(rptr);
1368                 }
1369         } else {
1370                 if (rptr) {
1371                         *rptr = CAM_REQ_CMP;
1372                         wakeup_one(rptr);
1373                 }
1374         }
1375 }
1376
1377 static void
1378 isp_target_start_ctio(ispsoftc_t *isp, union ccb *ccb)
1379 {
1380         void *qe;
1381         tstate_t *tptr;
1382         atio_private_data_t *atp;
1383         struct ccb_scsiio *cso = &ccb->csio;
1384         uint32_t dmaresult, handle;
1385         uint8_t local[QENTRY_LEN];
1386
1387         /*
1388          * Do some sanity checks.
1389          */
1390         if (cso->dxfer_len == 0) {
1391                 if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
1392                         xpt_print(ccb->ccb_h.path, "a data transfer length of zero but no status to send is wrong\n");
1393                         ccb->ccb_h.status = CAM_REQ_INVALID;
1394                         xpt_done(ccb);
1395                         return;
1396                 }
1397         }
1398
1399         tptr = get_lun_statep(isp, XS_CHANNEL(ccb), XS_LUN(ccb));
1400         if (tptr == NULL) {
1401                 tptr = get_lun_statep(isp, XS_CHANNEL(ccb), CAM_LUN_WILDCARD);
1402                 if (tptr == NULL) {
1403                         xpt_print(ccb->ccb_h.path, "%s: [0x%x] cannot find tstate pointer in %s\n", __func__, cso->tag_id);
1404                         dump_tstates(isp, XS_CHANNEL(ccb));
1405                         ccb->ccb_h.status = CAM_DEV_NOT_THERE;
1406                         xpt_done(ccb);
1407                         return;
1408                 }
1409         }
1410
1411         atp = isp_get_atpd(isp, tptr, cso->tag_id);
1412         if (atp == NULL) {
1413                 xpt_print(ccb->ccb_h.path, "%s: [0x%x] cannot find private data adjunct\n", __func__, cso->tag_id);
1414                 isp_dump_atpd(isp, tptr);
1415                 ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1416                 xpt_done(ccb);
1417                 return;
1418         }
1419         if (atp->dead) {
1420                 xpt_print(ccb->ccb_h.path, "%s: [0x%x] stopping sending a CTIO for a dead command\n", __func__, cso->tag_id);
1421                 ccb->ccb_h.status = CAM_REQ_ABORTED;
1422                 xpt_done(ccb);
1423                 return;
1424         }
1425
1426         /*
1427          * Check to make sure we're still in target mode.
1428          */
1429         if ((FCPARAM(isp, XS_CHANNEL(ccb))->role & ISP_ROLE_TARGET) == 0) {
1430                 xpt_print(ccb->ccb_h.path, "%s: [0x%x] stopping sending a CTIO because we're no longer in target mode\n", __func__, cso->tag_id);
1431                 ccb->ccb_h.status = CAM_PROVIDE_FAIL;
1432                 xpt_done(ccb);
1433                 return;
1434         }
1435
1436         /*
1437          * Get some resources
1438          */
1439         if (isp_get_pcmd(isp, ccb)) {
1440                 rls_lun_statep(isp, tptr);
1441                 xpt_print(ccb->ccb_h.path, "out of PCMDs\n");
1442                 cam_freeze_devq(ccb->ccb_h.path);
1443                 cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 250, 0);
1444                 ccb->ccb_h.status = CAM_REQUEUE_REQ;
1445                 xpt_done(ccb);
1446                 return;
1447         }
1448         qe = isp_getrqentry(isp);
1449         if (qe == NULL) {
1450                 xpt_print(ccb->ccb_h.path, rqo, __func__);
1451                 cam_freeze_devq(ccb->ccb_h.path);
1452                 cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 250, 0);
1453                 ccb->ccb_h.status = CAM_REQUEUE_REQ;
1454                 goto out;
1455         }
1456         memset(local, 0, QENTRY_LEN);
1457
1458         /*
1459          * We're either moving data or completing a command here.
1460          */
1461         if (IS_24XX(isp)) {
1462                 ct7_entry_t *cto = (ct7_entry_t *) local;
1463
1464                 cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
1465                 cto->ct_header.rqs_entry_count = 1;
1466                 cto->ct_header.rqs_seqno = 1;
1467                 cto->ct_nphdl = atp->nphdl;
1468                 cto->ct_rxid = atp->tag;
1469                 cto->ct_iid_lo = atp->portid;
1470                 cto->ct_iid_hi = atp->portid >> 16;
1471                 cto->ct_oxid = atp->oxid;
1472                 cto->ct_vpidx = ISP_GET_VPIDX(isp, XS_CHANNEL(ccb));
1473                 cto->ct_scsi_status = cso->scsi_status;
1474                 cto->ct_timeout = 120;
1475                 cto->ct_flags = atp->tattr << CT7_TASK_ATTR_SHIFT;
1476                 if (ccb->ccb_h.flags & CAM_SEND_STATUS) {
1477                         cto->ct_flags |= CT7_SENDSTATUS;
1478                 }
1479                 if (cso->dxfer_len == 0) {
1480                         cto->ct_flags |= CT7_FLAG_MODE1 | CT7_NO_DATA;
1481                         if ((ccb->ccb_h.flags & CAM_SEND_SENSE) != 0) {
1482                                 int m = min(cso->sense_len, sizeof (struct scsi_sense_data));
1483                                 cto->rsp.m1.ct_resplen = cto->ct_senselen = min(m, MAXRESPLEN_24XX);
1484                                 memcpy(cto->rsp.m1.ct_resp, &cso->sense_data, cto->ct_senselen);
1485                                 cto->ct_scsi_status |= (FCP_SNSLEN_VALID << 8);
1486                         }
1487                 } else {
1488                         cto->ct_flags |= CT7_FLAG_MODE0;
1489                         if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1490                                 cto->ct_flags |= CT7_DATA_IN;
1491                         } else {
1492                                 cto->ct_flags |= CT7_DATA_OUT;
1493                         }
1494                         cto->rsp.m0.reloff = atp->bytes_xfered;
1495                         /*
1496                          * Don't overrun the limits placed on us
1497                          */
1498                         if (atp->bytes_xfered + cso->dxfer_len > atp->orig_datalen) {
1499                                 cso->dxfer_len = atp->orig_datalen - atp->bytes_xfered;
1500                         }
1501                         atp->last_xframt = cso->dxfer_len;
1502                         cto->rsp.m0.ct_xfrlen = cso->dxfer_len;
1503                 }
1504                 if (cto->ct_flags & CT7_SENDSTATUS) {
1505                         int lvl = (cso->scsi_status)? ISP_LOGTINFO : ISP_LOGTDEBUG0;
1506                         cto->ct_resid = atp->orig_datalen - (atp->bytes_xfered + cso->dxfer_len);
1507                         if (cto->ct_resid < 0) {
1508                                 cto->ct_scsi_status |= (FCP_RESID_OVERFLOW << 8);
1509                         } else if (cto->ct_resid > 0) {
1510                                 cto->ct_scsi_status |= (FCP_RESID_UNDERFLOW << 8);
1511                         }
1512                         atp->state = ATPD_STATE_LAST_CTIO;
1513                         ISP_PATH_PRT(isp, lvl, cso->ccb_h.path, "%s: CTIO7[%x] CDB0=%x scsi status %x flags %x resid %d xfrlen %u offset %u\n", __func__, cto->ct_rxid,
1514                             atp->cdb0, cto->ct_scsi_status, cto->ct_flags, cto->ct_resid, cso->dxfer_len, atp->bytes_xfered);
1515                 } else {
1516                         cto->ct_resid = 0;
1517                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, cso->ccb_h.path, "%s: CTIO7[%x] flags %x xfrlen %u offset %u\n", __func__, cto->ct_rxid, cto->ct_flags,
1518                             cso->dxfer_len, atp->bytes_xfered);
1519                         atp->state = ATPD_STATE_CTIO;
1520                 }
1521         } else if (IS_FC(isp)) {
1522                 ct2_entry_t *cto = (ct2_entry_t *) local;
1523
1524                 cto->ct_header.rqs_entry_type = RQSTYPE_CTIO2;
1525                 cto->ct_header.rqs_entry_count = 1;
1526                 cto->ct_header.rqs_seqno = 1;
1527                 if (ISP_CAP_2KLOGIN(isp) == 0) {
1528                         ((ct2e_entry_t *)cto)->ct_iid = cso->init_id;
1529                 } else {
1530                         cto->ct_iid = cso->init_id;
1531                         if (ISP_CAP_SCCFW(isp) == 0) {
1532                                 cto->ct_lun = ccb->ccb_h.target_lun;
1533                         }
1534                 }
1535
1536
1537                 cto->ct_rxid = cso->tag_id;
1538                 if (cso->dxfer_len == 0) {
1539                         cto->ct_flags |= CT2_FLAG_MODE1 | CT2_NO_DATA | CT2_SENDSTATUS;
1540                         cto->rsp.m1.ct_scsi_status = cso->scsi_status;
1541                         cto->ct_resid = atp->orig_datalen - atp->bytes_xfered;
1542                         if (cto->ct_resid < 0) {
1543                                 cto->rsp.m1.ct_scsi_status |= CT2_DATA_OVER;
1544                         } else if (cto->ct_resid > 0) {
1545                                 cto->rsp.m1.ct_scsi_status |= CT2_DATA_UNDER;
1546                         }
1547                         if ((ccb->ccb_h.flags & CAM_SEND_SENSE) != 0) {
1548                                 int m = min(cso->sense_len, MAXRESPLEN);
1549                                 memcpy(cto->rsp.m1.ct_resp, &cso->sense_data, m);
1550                                 cto->rsp.m1.ct_senselen = m;
1551                                 cto->rsp.m1.ct_scsi_status |= CT2_SNSLEN_VALID;
1552                         } else if (cso->scsi_status == SCSI_STATUS_CHECK_COND) {
1553                                 /*
1554                                  * XXX: DEBUG
1555                                  */
1556                                 xpt_print(ccb->ccb_h.path, "CHECK CONDITION being sent without associated SENSE DATA for CDB=0x%x\n", atp->cdb0);
1557                         }
1558                 } else {
1559                         cto->ct_flags |= CT2_FLAG_MODE0;
1560                         if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1561                                 cto->ct_flags |= CT2_DATA_IN;
1562                         } else {
1563                                 cto->ct_flags |= CT2_DATA_OUT;
1564                         }
1565                         cto->ct_reloff = atp->bytes_xfered;
1566                         cto->rsp.m0.ct_xfrlen = cso->dxfer_len;
1567                         /*
1568                          * Don't overrun the limits placed on us
1569                          */
1570                         if (atp->bytes_xfered + cso->dxfer_len > atp->orig_datalen) {
1571                                 cso->dxfer_len = atp->orig_datalen - atp->bytes_xfered;
1572                         }
1573                         if ((ccb->ccb_h.flags & CAM_SEND_STATUS) != 0) {
1574                                 cto->ct_flags |= CT2_SENDSTATUS;
1575                                 cto->rsp.m0.ct_scsi_status = cso->scsi_status;
1576                                 cto->ct_resid = atp->orig_datalen - (atp->bytes_xfered + cso->dxfer_len);
1577                                 if (cto->ct_resid < 0) {
1578                                         cto->rsp.m0.ct_scsi_status |= CT2_DATA_OVER;
1579                                 } else if (cto->ct_resid > 0) {
1580                                         cto->rsp.m0.ct_scsi_status |= CT2_DATA_UNDER;
1581                                 }
1582                         } else {
1583                                 atp->last_xframt = cso->dxfer_len;
1584                         }
1585                         /*
1586                          * If we're sending data and status back together,
1587                          * we can't also send back sense data as well.
1588                          */
1589                         ccb->ccb_h.flags &= ~CAM_SEND_SENSE;
1590                 }
1591
1592                 if (cto->ct_flags & CT2_SENDSTATUS) {
1593                         int lvl = (cso->scsi_status)? ISP_LOGTINFO : ISP_LOGTDEBUG0;
1594                         cto->ct_flags |= CT2_CCINCR;
1595                         atp->state = ATPD_STATE_LAST_CTIO;
1596                         ISP_PATH_PRT(isp, lvl, cso->ccb_h.path, "%s: CTIO2[%x] CDB0=%x scsi status %x flags %x resid %d xfrlen %u offset %u\n", __func__, cto->ct_rxid,
1597                             atp->cdb0, cto->rsp.m0.ct_scsi_status, cto->ct_flags, cto->ct_resid, cso->dxfer_len, atp->bytes_xfered);
1598                 } else {
1599                         cto->ct_resid = 0;
1600                         atp->state = ATPD_STATE_CTIO;
1601                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: CTIO2[%x] flags %x xfrlen %u offset %u\n", __func__, cto->ct_rxid, cto->ct_flags,
1602                             cso->dxfer_len, atp->bytes_xfered);
1603                 }
1604                 cto->ct_timeout = 10;
1605         } else {
1606                 ct_entry_t *cto = (ct_entry_t *) local;
1607
1608                 cto->ct_header.rqs_entry_type = RQSTYPE_CTIO;
1609                 cto->ct_header.rqs_entry_count = 1;
1610                 cto->ct_header.rqs_seqno = 1;
1611                 cto->ct_iid = cso->init_id;
1612                 cto->ct_iid |= XS_CHANNEL(ccb) << 7;
1613                 cto->ct_tgt = ccb->ccb_h.target_id;
1614                 cto->ct_lun = ccb->ccb_h.target_lun;
1615                 cto->ct_fwhandle = cso->tag_id >> 16;
1616                 if (AT_HAS_TAG(cso->tag_id)) {
1617                         cto->ct_tag_val = cso->tag_id;
1618                         cto->ct_flags |= CT_TQAE;
1619                 }
1620                 if (ccb->ccb_h.flags & CAM_DIS_DISCONNECT) {
1621                         cto->ct_flags |= CT_NODISC;
1622                 }
1623                 if (cso->dxfer_len == 0) {
1624                         cto->ct_flags |= CT_NO_DATA;
1625                 } else if ((cso->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1626                         cto->ct_flags |= CT_DATA_IN;
1627                 } else {
1628                         cto->ct_flags |= CT_DATA_OUT;
1629                 }
1630                 if (ccb->ccb_h.flags & CAM_SEND_STATUS) {
1631                         cto->ct_flags |= CT_SENDSTATUS|CT_CCINCR;
1632                         cto->ct_scsi_status = cso->scsi_status;
1633                         cto->ct_resid = cso->resid;
1634                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "%s: CTIO[%x] scsi status %x resid %d tag_id %x\n", __func__,
1635                             cto->ct_fwhandle, cso->scsi_status, cso->resid, cso->tag_id);
1636                 }
1637                 ccb->ccb_h.flags &= ~CAM_SEND_SENSE;
1638                 cto->ct_timeout = 10;
1639         }
1640
1641         if (isp_save_xs_tgt(isp, ccb, &handle)) {
1642                 xpt_print(ccb->ccb_h.path, "No XFLIST pointers for %s\n", __func__);
1643                 ccb->ccb_h.status = CAM_REQUEUE_REQ;
1644                 goto out;
1645         }
1646
1647
1648         /*
1649          * Call the dma setup routines for this entry (and any subsequent
1650          * CTIOs) if there's data to move, and then tell the f/w it's got
1651          * new things to play with. As with isp_start's usage of DMA setup,
1652          * any swizzling is done in the machine dependent layer. Because
1653          * of this, we put the request onto the queue area first in native
1654          * format.
1655          */
1656
1657         if (IS_24XX(isp)) {
1658                 ct7_entry_t *cto = (ct7_entry_t *) local;
1659                 cto->ct_syshandle = handle;
1660         } else if (IS_FC(isp)) {
1661                 ct2_entry_t *cto = (ct2_entry_t *) local;
1662                 cto->ct_syshandle = handle;
1663         } else {
1664                 ct_entry_t *cto = (ct_entry_t *) local;
1665                 cto->ct_syshandle = handle;
1666         }
1667
1668         dmaresult = ISP_DMASETUP(isp, cso, (ispreq_t *) local);
1669         if (dmaresult == CMD_QUEUED) {
1670                 isp->isp_nactive++;
1671                 ccb->ccb_h.status |= CAM_SIM_QUEUED;
1672                 rls_lun_statep(isp, tptr);
1673                 return;
1674         }
1675         if (dmaresult == CMD_EAGAIN) {
1676                 ccb->ccb_h.status = CAM_REQUEUE_REQ;
1677         } else {
1678                 ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1679         }
1680         isp_destroy_tgt_handle(isp, handle);
1681 out:
1682         rls_lun_statep(isp, tptr);
1683         isp_free_pcmd(isp, ccb);
1684         xpt_done(ccb);
1685 }
1686
1687 static void
1688 isp_refire_putback_atio(void *arg)
1689 {
1690         union ccb *ccb = arg;
1691         ispsoftc_t *isp = XS_ISP(ccb);
1692         ISP_LOCK(isp);
1693         isp_target_putback_atio(ccb);
1694         ISP_UNLOCK(isp);
1695 }
1696
1697 static void
1698 isp_target_putback_atio(union ccb *ccb)
1699 {
1700         ispsoftc_t *isp;
1701         struct ccb_scsiio *cso;
1702         void *qe;
1703
1704         isp = XS_ISP(ccb);
1705
1706         qe = isp_getrqentry(isp);
1707         if (qe == NULL) {
1708                 xpt_print(ccb->ccb_h.path, rqo, __func__);
1709                 (void) timeout(isp_refire_putback_atio, ccb, 10);
1710                 return;
1711         }
1712         memset(qe, 0, QENTRY_LEN);
1713         cso = &ccb->csio;
1714         if (IS_FC(isp)) {
1715                 at2_entry_t local, *at = &local;
1716                 ISP_MEMZERO(at, sizeof (at2_entry_t));
1717                 at->at_header.rqs_entry_type = RQSTYPE_ATIO2;
1718                 at->at_header.rqs_entry_count = 1;
1719                 if (ISP_CAP_SCCFW(isp)) {
1720                         at->at_scclun = (uint16_t) ccb->ccb_h.target_lun;
1721                 } else {
1722                         at->at_lun = (uint8_t) ccb->ccb_h.target_lun;
1723                 }
1724                 at->at_status = CT_OK;
1725                 at->at_rxid = cso->tag_id;
1726                 at->at_iid = cso->ccb_h.target_id;
1727                 isp_put_atio2(isp, at, qe);
1728         } else {
1729                 at_entry_t local, *at = &local;
1730                 ISP_MEMZERO(at, sizeof (at_entry_t));
1731                 at->at_header.rqs_entry_type = RQSTYPE_ATIO;
1732                 at->at_header.rqs_entry_count = 1;
1733                 at->at_iid = cso->init_id;
1734                 at->at_iid |= XS_CHANNEL(ccb) << 7;
1735                 at->at_tgt = cso->ccb_h.target_id;
1736                 at->at_lun = cso->ccb_h.target_lun;
1737                 at->at_status = CT_OK;
1738                 at->at_tag_val = AT_GET_TAG(cso->tag_id);
1739                 at->at_handle = AT_GET_HANDLE(cso->tag_id);
1740                 isp_put_atio(isp, at, qe);
1741         }
1742         ISP_TDQE(isp, "isp_target_putback_atio", isp->isp_reqidx, qe);
1743         ISP_SYNC_REQUEST(isp);
1744         isp_complete_ctio(ccb);
1745 }
1746
1747 static void
1748 isp_complete_ctio(union ccb *ccb)
1749 {
1750         if ((ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_INPROG) {
1751                 ccb->ccb_h.status |= CAM_REQ_CMP;
1752         }
1753         ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
1754         isp_free_pcmd(XS_ISP(ccb), ccb);
1755         xpt_done(ccb);
1756 }
1757
1758 /*
1759  * Handle ATIO stuff that the generic code can't.
1760  * This means handling CDBs.
1761  */
1762
1763 static void
1764 isp_handle_platform_atio(ispsoftc_t *isp, at_entry_t *aep)
1765 {
1766         tstate_t *tptr;
1767         int status, bus;
1768         struct ccb_accept_tio *atiop;
1769         atio_private_data_t *atp;
1770
1771         /*
1772          * The firmware status (except for the QLTM_SVALID bit)
1773          * indicates why this ATIO was sent to us.
1774          *
1775          * If QLTM_SVALID is set, the firware has recommended Sense Data.
1776          *
1777          * If the DISCONNECTS DISABLED bit is set in the flags field,
1778          * we're still connected on the SCSI bus.
1779          */
1780         status = aep->at_status;
1781         if ((status & ~QLTM_SVALID) == AT_PHASE_ERROR) {
1782                 /*
1783                  * Bus Phase Sequence error. We should have sense data
1784                  * suggested by the f/w. I'm not sure quite yet what
1785                  * to do about this for CAM.
1786                  */
1787                 isp_prt(isp, ISP_LOGWARN, "PHASE ERROR");
1788                 isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
1789                 return;
1790         }
1791         if ((status & ~QLTM_SVALID) != AT_CDB) {
1792                 isp_prt(isp, ISP_LOGWARN, "bad atio (0x%x) leaked to platform", status);
1793                 isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
1794                 return;
1795         }
1796
1797         bus = GET_BUS_VAL(aep->at_iid);
1798         tptr = get_lun_statep(isp, bus, aep->at_lun);
1799         if (tptr == NULL) {
1800                 tptr = get_lun_statep(isp, bus, CAM_LUN_WILDCARD);
1801                 if (tptr == NULL) {
1802                         /*
1803                          * Because we can't autofeed sense data back with
1804                          * a command for parallel SCSI, we can't give back
1805                          * a CHECK CONDITION. We'll give back a BUSY status
1806                          * instead. This works out okay because the only
1807                          * time we should, in fact, get this, is in the
1808                          * case that somebody configured us without the
1809                          * blackhole driver, so they get what they deserve.
1810                          */
1811                         isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
1812                         return;
1813                 }
1814         }
1815
1816         atp = isp_get_atpd(isp, tptr, 0);
1817         atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
1818         if (atiop == NULL || atp == NULL) {
1819                 /*
1820                  * Because we can't autofeed sense data back with
1821                  * a command for parallel SCSI, we can't give back
1822                  * a CHECK CONDITION. We'll give back a QUEUE FULL status
1823                  * instead. This works out okay because the only time we
1824                  * should, in fact, get this, is in the case that we've
1825                  * run out of ATIOS.
1826                  */
1827                 xpt_print(tptr->owner, "no %s for lun %d from initiator %d\n", (atp == NULL && atiop == NULL)? "ATIOs *or* ATPS" :
1828                     ((atp == NULL)? "ATPs" : "ATIOs"), aep->at_lun, aep->at_iid);
1829                 isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
1830                 if (atp) {
1831                         isp_put_atpd(isp, tptr, atp);
1832                 }
1833                 rls_lun_statep(isp, tptr);
1834                 return;
1835         }
1836         atp->tag = aep->at_tag_val;
1837         if (atp->tag == 0) {
1838                 atp->tag = ~0;
1839         }
1840         atp->state = ATPD_STATE_ATIO;
1841         SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
1842         tptr->atio_count--;
1843         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, atiop->ccb_h.path, "Take FREE ATIO count now %d\n", tptr->atio_count);
1844         atiop->ccb_h.target_id = aep->at_tgt;
1845         atiop->ccb_h.target_lun = aep->at_lun;
1846         if (aep->at_flags & AT_NODISC) {
1847                 atiop->ccb_h.flags = CAM_DIS_DISCONNECT;
1848         } else {
1849                 atiop->ccb_h.flags = 0;
1850         }
1851
1852         if (status & QLTM_SVALID) {
1853                 size_t amt = imin(QLTM_SENSELEN, sizeof (atiop->sense_data));
1854                 atiop->sense_len = amt;
1855                 ISP_MEMCPY(&atiop->sense_data, aep->at_sense, amt);
1856         } else {
1857                 atiop->sense_len = 0;
1858         }
1859
1860         atiop->init_id = GET_IID_VAL(aep->at_iid);
1861         atiop->cdb_len = aep->at_cdblen;
1862         ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cdb, aep->at_cdblen);
1863         atiop->ccb_h.status = CAM_CDB_RECVD;
1864         /*
1865          * Construct a tag 'id' based upon tag value (which may be 0..255)
1866          * and the handle (which we have to preserve).
1867          */
1868         atiop->tag_id = atp->tag;
1869         if (aep->at_flags & AT_TQAE) {
1870                 atiop->tag_action = aep->at_tag_type;
1871                 atiop->ccb_h.status |= CAM_TAG_ACTION_VALID;
1872         }
1873         atp->orig_datalen = 0;
1874         atp->bytes_xfered = 0;
1875         atp->last_xframt = 0;
1876         atp->lun = aep->at_lun;
1877         atp->nphdl = aep->at_iid;
1878         atp->portid = PORT_NONE;
1879         atp->oxid = 0;
1880         atp->cdb0 = atiop->cdb_io.cdb_bytes[0];
1881         atp->tattr = aep->at_tag_type;
1882         atp->state = ATPD_STATE_CAM;
1883         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, tptr->owner, "ATIO[%x] CDB=0x%x lun %d\n", aep->at_tag_val, atp->cdb0, atp->lun);
1884         rls_lun_statep(isp, tptr);
1885 }
1886
1887 static void
1888 isp_handle_platform_atio2(ispsoftc_t *isp, at2_entry_t *aep)
1889 {
1890         lun_id_t lun;
1891         fcportdb_t *lp;
1892         tstate_t *tptr;
1893         struct ccb_accept_tio *atiop;
1894         uint16_t nphdl;
1895         atio_private_data_t *atp = NULL;
1896         inot_private_data_t *ntp;
1897
1898         /*
1899          * The firmware status (except for the QLTM_SVALID bit)
1900          * indicates why this ATIO was sent to us.
1901          *
1902          * If QLTM_SVALID is set, the firware has recommended Sense Data.
1903          */
1904         if ((aep->at_status & ~QLTM_SVALID) != AT_CDB) {
1905                 isp_prt(isp, ISP_LOGWARN, "bogus atio (0x%x) leaked to platform", aep->at_status);
1906                 isp_endcmd(isp, aep, SCSI_STATUS_BUSY, 0);
1907                 return;
1908         }
1909
1910         if (ISP_CAP_SCCFW(isp)) {
1911                 lun = aep->at_scclun;
1912         } else {
1913                 lun = aep->at_lun;
1914         }
1915         if (ISP_CAP_2KLOGIN(isp)) {
1916                 nphdl = ((at2e_entry_t *)aep)->at_iid;
1917         } else {
1918                 nphdl = aep->at_iid;
1919         }
1920         tptr = get_lun_statep(isp, 0, lun);
1921         if (tptr == NULL) {
1922                 tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
1923                 if (tptr == NULL) {
1924                         isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] no state pointer for lun %d", aep->at_rxid, lun);
1925                         isp_endcmd(isp, aep, SCSI_STATUS_CHECK_COND | ECMD_SVALID | (0x5 << 12) | (0x25 << 16), 0);
1926                         return;
1927                 }
1928         }
1929
1930         /*
1931          * Start any commands pending resources first.
1932          */
1933         if (tptr->restart_queue) {
1934                 inot_private_data_t *restart_queue = tptr->restart_queue;
1935                 tptr->restart_queue = NULL;
1936                 while (restart_queue) {
1937                         ntp = restart_queue;
1938                         restart_queue = ntp->rd.nt.nt_hba;
1939                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at2_entry_t *)ntp->rd.data)->at_rxid);
1940                         isp_handle_platform_atio2(isp, (at2_entry_t *) ntp->rd.data);
1941                         isp_put_ntpd(isp, tptr, ntp);
1942                         /*
1943                          * If a recursion caused the restart queue to start to fill again,
1944                          * stop and splice the new list on top of the old list and restore
1945                          * it and go to noresrc.
1946                          */
1947                         if (tptr->restart_queue) {
1948                                 ntp = tptr->restart_queue;
1949                                 tptr->restart_queue = restart_queue;
1950                                 while (restart_queue->rd.nt.nt_hba) {
1951                                         restart_queue = restart_queue->rd.nt.nt_hba;
1952                                 }
1953                                 restart_queue->rd.nt.nt_hba = ntp;
1954                                 goto noresrc;
1955                         }
1956                 }
1957         }
1958
1959         atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
1960         if (atiop == NULL) {
1961                 goto noresrc;
1962         }
1963
1964         atp = isp_get_atpd(isp, tptr, 0);
1965         if (atp == NULL) {
1966                 goto noresrc;
1967         }
1968
1969         atp->tag = aep->at_rxid;
1970         atp->state = ATPD_STATE_ATIO;
1971         SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
1972         tptr->atio_count--;
1973         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, atiop->ccb_h.path, "Take FREE ATIO count now %d\n", tptr->atio_count);
1974         atiop->ccb_h.target_id = FCPARAM(isp, 0)->isp_loopid;
1975         atiop->ccb_h.target_lun = lun;
1976
1977         /*
1978          * We don't get 'suggested' sense data as we do with SCSI cards.
1979          */
1980         atiop->sense_len = 0;
1981         if (ISP_CAP_2KLOGIN(isp)) {
1982                 /*
1983                  * NB: We could not possibly have 2K logins if we
1984                  * NB: also did not have SCC FW.
1985                  */
1986                 atiop->init_id = ((at2e_entry_t *)aep)->at_iid;
1987         } else {
1988                 atiop->init_id = aep->at_iid;
1989         }
1990
1991         /*
1992          * If we're not in the port database, add ourselves.
1993          */
1994         if (!IS_2100(isp) && isp_find_pdb_by_loopid(isp, 0, atiop->init_id, &lp) == 0) {
1995                 uint64_t iid =
1996                         (((uint64_t) aep->at_wwpn[0]) << 48) |
1997                         (((uint64_t) aep->at_wwpn[1]) << 32) |
1998                         (((uint64_t) aep->at_wwpn[2]) << 16) |
1999                         (((uint64_t) aep->at_wwpn[3]) <<  0);
2000                 /*
2001                  * However, make sure we delete ourselves if otherwise
2002                  * we were there but at a different loop id.
2003                  */
2004                 if (isp_find_pdb_by_wwn(isp, 0, iid, &lp)) {
2005                         isp_del_wwn_entry(isp, 0, iid, lp->handle, lp->portid);
2006                 }
2007                 isp_add_wwn_entry(isp, 0, iid, atiop->init_id, PORT_ANY);
2008         }
2009         atiop->cdb_len = ATIO2_CDBLEN;
2010         ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cdb, ATIO2_CDBLEN);
2011         atiop->ccb_h.status = CAM_CDB_RECVD;
2012         atiop->tag_id = atp->tag;
2013         switch (aep->at_taskflags & ATIO2_TC_ATTR_MASK) {
2014         case ATIO2_TC_ATTR_SIMPLEQ:
2015                 atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
2016                 atiop->tag_action = MSG_SIMPLE_Q_TAG;
2017                 break;
2018         case ATIO2_TC_ATTR_HEADOFQ:
2019                 atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
2020                 atiop->tag_action = MSG_HEAD_OF_Q_TAG;
2021                 break;
2022         case ATIO2_TC_ATTR_ORDERED:
2023                 atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
2024                 atiop->tag_action = MSG_ORDERED_Q_TAG;
2025                 break;
2026         case ATIO2_TC_ATTR_ACAQ:                /* ?? */
2027         case ATIO2_TC_ATTR_UNTAGGED:
2028         default:
2029                 atiop->tag_action = 0;
2030                 break;
2031         }
2032
2033         atp->orig_datalen = aep->at_datalen;
2034         atp->bytes_xfered = 0;
2035         atp->last_xframt = 0;
2036         atp->lun = lun;
2037         atp->nphdl = atiop->init_id;
2038         atp->sid = PORT_ANY;
2039         atp->oxid = aep->at_oxid;
2040         atp->cdb0 = aep->at_cdb[0];
2041         atp->tattr = aep->at_taskflags & ATIO2_TC_ATTR_MASK;
2042         atp->state = ATPD_STATE_CAM;
2043         xpt_done((union ccb *)atiop);
2044         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, tptr->owner, "ATIO2[%x] CDB=0x%x lun %d datalen %u\n", aep->at_rxid, atp->cdb0, lun, atp->orig_datalen);
2045         rls_lun_statep(isp, tptr);
2046         return;
2047 noresrc:
2048         if (atp) {
2049                 isp_put_atpd(isp, tptr, atp);
2050         }
2051         ntp = isp_get_ntpd(isp, tptr);
2052         if (ntp == NULL) {
2053                 rls_lun_statep(isp, tptr);
2054                 isp_endcmd(isp, aep, nphdl, 0, SCSI_STATUS_BUSY, 0);
2055                 return;
2056         }
2057         memcpy(ntp->rd.data, aep, QENTRY_LEN);
2058         ntp->rd.nt.nt_hba = tptr->restart_queue;
2059         tptr->restart_queue = ntp;
2060         rls_lun_statep(isp, tptr);
2061 }
2062
2063 static void
2064 isp_handle_platform_atio7(ispsoftc_t *isp, at7_entry_t *aep)
2065 {
2066         int cdbxlen;
2067         uint16_t lun, chan, nphdl = NIL_HANDLE;
2068         uint32_t did, sid;
2069         uint64_t wwn = INI_NONE;
2070         fcportdb_t *lp;
2071         tstate_t *tptr;
2072         struct ccb_accept_tio *atiop;
2073         atio_private_data_t *atp = NULL;
2074         inot_private_data_t *ntp;
2075
2076         did = (aep->at_hdr.d_id[0] << 16) | (aep->at_hdr.d_id[1] << 8) | aep->at_hdr.d_id[2];
2077         sid = (aep->at_hdr.s_id[0] << 16) | (aep->at_hdr.s_id[1] << 8) | aep->at_hdr.s_id[2];
2078         lun = (aep->at_cmnd.fcp_cmnd_lun[0] << 8) | aep->at_cmnd.fcp_cmnd_lun[1];
2079
2080         /*
2081          * Find the N-port handle, and Virtual Port Index for this command.
2082          *
2083          * If we can't, we're somewhat in trouble because we can't actually respond w/o that information.
2084          * We also, as a matter of course, need to know the WWN of the initiator too.
2085          */
2086         if (ISP_CAP_MULTI_ID(isp)) {
2087                 /*
2088                  * Find the right channel based upon D_ID
2089                  */
2090                 isp_find_chan_by_did(isp, did, &chan);
2091
2092                 if (chan == ISP_NOCHAN) {
2093                         NANOTIME_T now;
2094
2095                         /*
2096                          * If we don't recognizer our own D_DID, terminate the exchange, unless we're within 2 seconds of startup
2097                          * It's a bit tricky here as we need to stash this command *somewhere*.
2098                          */
2099                         GET_NANOTIME(&now);
2100                         if (NANOTIME_SUB(&isp->isp_init_time, &now) > 2000000000ULL) {
2101                                 isp_prt(isp, ISP_LOGWARN, "%s: [RX_ID 0x%x] D_ID %x not found on any channel- dropping", __func__, aep->at_rxid, did);
2102                                 isp_endcmd(isp, aep, NIL_HANDLE, ISP_NOCHAN, ECMD_TERMINATE, 0);
2103                                 return;
2104                         }
2105                         tptr = get_lun_statep(isp, 0, 0);
2106                         if (tptr == NULL) {
2107                                 tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
2108                                 if (tptr == NULL) {
2109                                         isp_prt(isp, ISP_LOGWARN, "%s: [RX_ID 0x%x] D_ID %x not found on any channel and no tptr- dropping", __func__, aep->at_rxid, did);
2110                                         isp_endcmd(isp, aep, NIL_HANDLE, ISP_NOCHAN, ECMD_TERMINATE, 0);
2111                                         return;
2112                                 }
2113                         }
2114                         isp_prt(isp, ISP_LOGWARN, "%s: [RX_ID 0x%x] D_ID %x not found on any channel- deferring", __func__, aep->at_rxid, did);
2115                         goto noresrc;
2116                 }
2117                 isp_prt(isp, ISP_LOGTDEBUG0, "%s: [RX_ID 0x%x] D_ID 0x%06x found on Chan %d for S_ID 0x%06x", __func__, aep->at_rxid, did, chan, sid);
2118         } else {
2119                 chan = 0;
2120         }
2121
2122         /*
2123          * Find the PDB entry for this initiator
2124          */
2125         if (isp_find_pdb_by_sid(isp, chan, sid, &lp) == 0) {
2126                 /*
2127                  * If we're not in the port database terminate the exchange.
2128                  */
2129                 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",
2130                     __func__, aep->at_rxid, did, chan, sid);
2131                 isp_endcmd(isp, aep, NIL_HANDLE, chan, ECMD_TERMINATE, 0);
2132                 return;
2133         }
2134         nphdl = lp->handle;
2135         wwn = lp->port_wwn;
2136
2137         /*
2138          * Get the tstate pointer
2139          */
2140         tptr = get_lun_statep(isp, chan, lun);
2141         if (tptr == NULL) {
2142                 tptr = get_lun_statep(isp, chan, CAM_LUN_WILDCARD);
2143                 if (tptr == NULL) {
2144                         isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] no state pointer for lun %d or wildcard", aep->at_rxid, lun);
2145                         isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_CHECK_COND | ECMD_SVALID | (0x5 << 12) | (0x25 << 16), 0);
2146                         return;
2147                 }
2148         }
2149
2150         /*
2151          * Start any commands pending resources first.
2152          */
2153         if (tptr->restart_queue) {
2154                 inot_private_data_t *restart_queue = tptr->restart_queue;
2155                 tptr->restart_queue = NULL;
2156                 while (restart_queue) {
2157                         ntp = restart_queue;
2158                         restart_queue = ntp->rd.nt.nt_hba;
2159                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: restarting resrc deprived %x", __func__, ((at7_entry_t *)ntp->rd.data)->at_rxid);
2160                         isp_handle_platform_atio7(isp, (at7_entry_t *) ntp->rd.data);
2161                         isp_put_ntpd(isp, tptr, ntp);
2162                         /*
2163                          * If a recursion caused the restart queue to start to fill again,
2164                          * stop and splice the new list on top of the old list and restore
2165                          * it and go to noresrc.
2166                          */
2167                         if (tptr->restart_queue) {
2168                                 if (restart_queue) {
2169                                         ntp = tptr->restart_queue;
2170                                         tptr->restart_queue = restart_queue;
2171                                         while (restart_queue->rd.nt.nt_hba) {
2172                                                 restart_queue = restart_queue->rd.nt.nt_hba;
2173                                         }
2174                                         restart_queue->rd.nt.nt_hba = ntp;
2175                                 }
2176                                 goto noresrc;
2177                         }
2178                 }
2179         }
2180
2181         /*
2182          * If the f/w is out of resources, just send a BUSY status back.
2183          */
2184         if (aep->at_rxid == AT7_NORESRC_RXID) {
2185                 rls_lun_statep(isp, tptr);
2186                 isp_endcmd(isp, aep, nphdl, chan, SCSI_BUSY, 0);
2187                 return;
2188         }
2189
2190         /*
2191          * If we're out of resources, just send a BUSY status back.
2192          */
2193         atiop = (struct ccb_accept_tio *) SLIST_FIRST(&tptr->atios);
2194         if (atiop == NULL) {
2195                 isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] out of atios", aep->at_rxid);
2196                 goto noresrc;
2197         }
2198
2199         atp = isp_get_atpd(isp, tptr, 0);
2200         if (atp == NULL) {
2201                 isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] out of atps", aep->at_rxid);
2202                 goto noresrc;
2203         }
2204         if (isp_get_atpd(isp, tptr, aep->at_rxid)) {
2205                 isp_prt(isp, ISP_LOGTDEBUG0, "[0x%x] tag wraparound in isp_handle_platforms_atio7 (N-Port Handle 0x%04x S_ID 0x%04x OX_ID 0x%04x)\n",
2206                     aep->at_rxid, nphdl, sid, aep->at_hdr.ox_id);
2207                 /*
2208                  * It's not a "no resource" condition- but we can treat it like one
2209                  */
2210                 goto noresrc;
2211         }
2212
2213         atp->tag = aep->at_rxid;
2214         atp->state = ATPD_STATE_ATIO;
2215         SLIST_REMOVE_HEAD(&tptr->atios, sim_links.sle);
2216         tptr->atio_count--;
2217         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, atiop->ccb_h.path, "Take FREE ATIO count now %d\n", tptr->atio_count);
2218         atiop->init_id = nphdl;
2219         atiop->ccb_h.target_id = FCPARAM(isp, chan)->isp_loopid;
2220         atiop->ccb_h.target_lun = lun;
2221         atiop->sense_len = 0;
2222         cdbxlen = aep->at_cmnd.fcp_cmnd_alen_datadir >> FCP_CMND_ADDTL_CDBLEN_SHIFT;
2223         if (cdbxlen) {
2224                 isp_prt(isp, ISP_LOGWARN, "additional CDBLEN ignored");
2225         }
2226         cdbxlen = sizeof (aep->at_cmnd.cdb_dl.sf.fcp_cmnd_cdb);
2227         ISP_MEMCPY(atiop->cdb_io.cdb_bytes, aep->at_cmnd.cdb_dl.sf.fcp_cmnd_cdb, cdbxlen);
2228         atiop->cdb_len = cdbxlen;
2229         atiop->ccb_h.status = CAM_CDB_RECVD;
2230         atiop->tag_id = atp->tag;
2231         switch (aep->at_cmnd.fcp_cmnd_task_attribute & FCP_CMND_TASK_ATTR_MASK) {
2232         case FCP_CMND_TASK_ATTR_SIMPLE:
2233                 atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
2234                 atiop->tag_action = MSG_SIMPLE_Q_TAG;
2235                 break;
2236         case FCP_CMND_TASK_ATTR_HEAD:
2237                 atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
2238                 atiop->tag_action = MSG_HEAD_OF_Q_TAG;
2239                 break;
2240         case FCP_CMND_TASK_ATTR_ORDERED:
2241                 atiop->ccb_h.flags = CAM_TAG_ACTION_VALID;
2242                 atiop->tag_action = MSG_ORDERED_Q_TAG;
2243                 break;
2244         default:
2245                 /* FALLTHROUGH */
2246         case FCP_CMND_TASK_ATTR_ACA:
2247         case FCP_CMND_TASK_ATTR_UNTAGGED:
2248                 atiop->tag_action = 0;
2249                 break;
2250         }
2251         atp->orig_datalen = aep->at_cmnd.cdb_dl.sf.fcp_cmnd_dl;
2252         atp->bytes_xfered = 0;
2253         atp->last_xframt = 0;
2254         atp->lun = lun;
2255         atp->nphdl = nphdl;
2256         atp->portid = sid;
2257         atp->oxid = aep->at_hdr.ox_id;
2258         atp->cdb0 = atiop->cdb_io.cdb_bytes[0];
2259         atp->tattr = aep->at_cmnd.fcp_cmnd_task_attribute & FCP_CMND_TASK_ATTR_MASK;
2260         atp->state = ATPD_STATE_CAM;
2261         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, tptr->owner, "ATIO7[%x] CDB=0x%x lun %d datalen %u\n", aep->at_rxid, atp->cdb0, lun, atp->orig_datalen);
2262         xpt_done((union ccb *)atiop);
2263         rls_lun_statep(isp, tptr);
2264         return;
2265 noresrc:
2266         if (atp) {
2267                 isp_put_atpd(isp, tptr, atp);
2268         }
2269         ntp = isp_get_ntpd(isp, tptr);
2270         if (ntp == NULL) {
2271                 rls_lun_statep(isp, tptr);
2272                 isp_endcmd(isp, aep, nphdl, chan, SCSI_STATUS_BUSY, 0);
2273                 return;
2274         }
2275         memcpy(ntp->rd.data, aep, QENTRY_LEN);
2276         ntp->rd.nt.nt_hba = tptr->restart_queue;
2277         tptr->restart_queue = ntp;
2278         rls_lun_statep(isp, tptr);
2279 }
2280
2281 static void
2282 isp_handle_platform_ctio(ispsoftc_t *isp, void *arg)
2283 {
2284         union ccb *ccb;
2285         int sentstatus, ok, notify_cam, resid = 0;
2286         tstate_t *tptr = NULL;
2287         atio_private_data_t *atp = NULL;
2288         int bus;
2289         uint32_t tval, handle;
2290
2291         /*
2292          * CTIO, CTIO2 and CTIO7 are close enough....
2293          */
2294
2295         if (IS_SCSI(isp)) {
2296                 handle = ((ct_entry_t *)arg)->ct_syshandle;
2297         } else {
2298                 handle = ((ct2_entry_t *)arg)->ct_syshandle;
2299         }
2300         ccb = isp_find_xs_tgt(isp, handle);
2301         if (ccb == NULL) {
2302                 isp_print_bytes(isp, "null ccb in isp_handle_platform_ctio", QENTRY_LEN, arg);
2303                 return;
2304         }
2305         isp_destroy_tgt_handle(isp, handle);
2306         bus = XS_CHANNEL(ccb);
2307         tptr = get_lun_statep(isp, bus, XS_LUN(ccb));
2308         if (tptr == NULL) {
2309                 tptr = get_lun_statep(isp, bus, CAM_LUN_WILDCARD);
2310         }
2311         KASSERT((tptr != NULL), ("cannot get state pointer"));
2312         if (isp->isp_nactive) {
2313                 isp->isp_nactive++;
2314         }
2315         if (IS_24XX(isp)) {
2316                 ct7_entry_t *ct = arg;
2317
2318                 atp = isp_get_atpd(isp, tptr, ct->ct_rxid);
2319                 if (atp == NULL) {
2320                         rls_lun_statep(isp, tptr);
2321                         isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x after I/O", __func__, ct->ct_rxid);
2322                         return;
2323                 }
2324
2325                 sentstatus = ct->ct_flags & CT7_SENDSTATUS;
2326                 ok = (ct->ct_nphdl == CT7_OK);
2327                 if (ok && sentstatus && (ccb->ccb_h.flags & CAM_SEND_SENSE)) {
2328                         ccb->ccb_h.status |= CAM_SENT_SENSE;
2329                 }
2330                 notify_cam = ct->ct_header.rqs_seqno & 0x1;
2331                 if ((ct->ct_flags & CT7_DATAMASK) != CT7_NO_DATA) {
2332                         resid = ct->ct_resid;
2333                         atp->bytes_xfered += (atp->last_xframt - resid);
2334                         atp->last_xframt = 0;
2335                 }
2336                 if (ct->ct_nphdl == CT_HBA_RESET) {
2337                         ok = 0;
2338                         notify_cam = 1;
2339                         sentstatus = 1;
2340                         ccb->ccb_h.status |= CAM_UNREC_HBA_ERROR;
2341                 } else if (!ok) {
2342                         ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
2343                 }
2344                 tval = atp->tag;
2345                 isp_prt(isp, ok? ISP_LOGTDEBUG0 : ISP_LOGWARN, "%s: CTIO7[%x] sts 0x%x flg 0x%x sns %d resid %d %s", __func__,
2346                     ct->ct_rxid, ct->ct_nphdl, ct->ct_flags, (ccb->ccb_h.status & CAM_SENT_SENSE) != 0, resid, sentstatus? "FIN" : "MID");
2347                 atp->state = ATPD_STATE_PDON; /* XXX: should really come after isp_complete_ctio */
2348         } else if (IS_FC(isp)) {
2349                 ct2_entry_t *ct = arg;
2350
2351                 atp = isp_get_atpd(isp, tptr, ct->ct_rxid);
2352                 if (atp == NULL) {
2353                         rls_lun_statep(isp, tptr);
2354                         isp_prt(isp, ISP_LOGERR, "%s: cannot find adjunct for %x after I/O", __func__, ct->ct_rxid);
2355                         return;
2356                 }
2357                 sentstatus = ct->ct_flags & CT2_SENDSTATUS;
2358                 ok = (ct->ct_status & ~QLTM_SVALID) == CT_OK;
2359                 if (ok && sentstatus && (ccb->ccb_h.flags & CAM_SEND_SENSE)) {
2360                         ccb->ccb_h.status |= CAM_SENT_SENSE;
2361                 }
2362                 notify_cam = ct->ct_header.rqs_seqno & 0x1;
2363                 if ((ct->ct_flags & CT2_DATAMASK) != CT2_NO_DATA) {
2364                         resid = ct->ct_resid;
2365                         atp->bytes_xfered += (atp->last_xframt - resid);
2366                         atp->last_xframt = 0;
2367                 }
2368                 if (ct->ct_status == CT_HBA_RESET) {
2369                         ok = 0;
2370                         notify_cam = 1;
2371                         sentstatus = 1;
2372                         ccb->ccb_h.status |= CAM_UNREC_HBA_ERROR;
2373                 } else if (!ok) {
2374                         ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
2375                 }
2376                 isp_prt(isp, ok? ISP_LOGTDEBUG0 : ISP_LOGWARN, "%s: CTIO2[%x] sts 0x%x flg 0x%x sns %d resid %d %s", __func__,
2377                     ct->ct_rxid, ct->ct_status, ct->ct_flags, (ccb->ccb_h.status & CAM_SENT_SENSE) != 0, resid, sentstatus? "FIN" : "MID");
2378                 tval = atp->tag;
2379                 atp->state = ATPD_STATE_PDON; /* XXX: should really come after isp_complete_ctio */
2380         } else {
2381                 ct_entry_t *ct = arg;
2382                 sentstatus = ct->ct_flags & CT_SENDSTATUS;
2383                 ok = (ct->ct_status  & ~QLTM_SVALID) == CT_OK;
2384                 /*
2385                  * We *ought* to be able to get back to the original ATIO
2386                  * here, but for some reason this gets lost. It's just as
2387                  * well because it's squirrelled away as part of periph
2388                  * private data.
2389                  *
2390                  * We can live without it as long as we continue to use
2391                  * the auto-replenish feature for CTIOs.
2392                  */
2393                 notify_cam = ct->ct_header.rqs_seqno & 0x1;
2394                 if (ct->ct_status == (CT_HBA_RESET & 0xff)) {
2395                         ok = 0;
2396                         notify_cam = 1;
2397                         sentstatus = 1;
2398                         ccb->ccb_h.status |= CAM_UNREC_HBA_ERROR;
2399                 } else if (!ok) {
2400                         ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
2401                 } else if (ct->ct_status & QLTM_SVALID) {
2402                         char *sp = (char *)ct;
2403                         sp += CTIO_SENSE_OFFSET;
2404                         ccb->csio.sense_len = min(sizeof (ccb->csio.sense_data), QLTM_SENSELEN);
2405                         ISP_MEMCPY(&ccb->csio.sense_data, sp, ccb->csio.sense_len);
2406                         ccb->ccb_h.status |= CAM_AUTOSNS_VALID;
2407                 }
2408                 if ((ct->ct_flags & CT_DATAMASK) != CT_NO_DATA) {
2409                         resid = ct->ct_resid;
2410                 }
2411                 isp_prt(isp, ISP_LOGTDEBUG0, "%s: CTIO[%x] tag %x S_ID 0x%x lun %d sts %x flg %x resid %d %s", __func__,
2412                     ct->ct_fwhandle, ct->ct_tag_val, ct->ct_iid, ct->ct_lun, ct->ct_status, ct->ct_flags, resid, sentstatus? "FIN" : "MID");
2413                 tval = ct->ct_fwhandle;
2414         }
2415         ccb->csio.resid += resid;
2416
2417         /*
2418          * We're here either because intermediate data transfers are done
2419          * and/or the final status CTIO (which may have joined with a
2420          * Data Transfer) is done.
2421          *
2422          * In any case, for this platform, the upper layers figure out
2423          * what to do next, so all we do here is collect status and
2424          * pass information along. Any DMA handles have already been
2425          * freed.
2426          */
2427         if (notify_cam == 0) {
2428                 isp_prt(isp, ISP_LOGTDEBUG0, "  INTER CTIO[0x%x] done", tval);
2429                 return;
2430         }
2431         if (tptr) {
2432                 rls_lun_statep(isp, tptr);
2433         }
2434         isp_prt(isp, ISP_LOGTDEBUG0, "%s CTIO[0x%x] done", (sentstatus)? "  FINAL " : "MIDTERM ", tval);
2435
2436         if (!ok && !IS_24XX(isp)) {
2437                 isp_target_putback_atio(ccb);
2438         } else {
2439                 isp_complete_ctio(ccb);
2440         }
2441 }
2442
2443 static void
2444 isp_handle_platform_notify_scsi(ispsoftc_t *isp, in_entry_t *inot)
2445 {
2446         (void) isp_notify_ack(isp, inot);
2447 }
2448
2449 static void
2450 isp_handle_platform_notify_fc(ispsoftc_t *isp, in_fcentry_t *inp)
2451 {
2452         int needack = 1;
2453         switch (inp->in_status) {
2454         case IN_PORT_LOGOUT:
2455                 /*
2456                  * XXX: Need to delete this initiator's WWN from the database
2457                  * XXX: Need to send this LOGOUT upstream
2458                  */
2459                 isp_prt(isp, ISP_LOGWARN, "port logout of S_ID 0x%x", inp->in_iid);
2460                 break;
2461         case IN_PORT_CHANGED:
2462                 isp_prt(isp, ISP_LOGWARN, "port changed for S_ID 0x%x", inp->in_iid);
2463                 break;
2464         case IN_GLOBAL_LOGO:
2465                 isp_del_all_wwn_entries(isp, 0);
2466                 isp_prt(isp, ISP_LOGINFO, "all ports logged out");
2467                 break;
2468         case IN_ABORT_TASK:
2469         {
2470                 tstate_t *tptr;
2471                 uint16_t lun;
2472                 uint32_t loopid;
2473                 uint64_t wwn;
2474                 atio_private_data_t *atp;
2475                 fcportdb_t *lp;
2476                 struct ccb_immediate_notify *inot = NULL;
2477
2478                 if (ISP_CAP_SCCFW(isp)) {
2479                         lun = inp->in_scclun;
2480                 } else {
2481                         lun = inp->in_lun;
2482                 }
2483                 if (ISP_CAP_2KLOGIN(isp)) {
2484                         loopid = ((in_fcentry_e_t *)inot)->in_iid;
2485                 } else {
2486                         loopid = inp->in_iid;
2487                 }
2488                 if (isp_find_pdb_by_loopid(isp, 0, loopid, &lp)) {
2489                         wwn = lp->port_wwn;
2490                 } else {
2491                         wwn = INI_ANY;
2492                 }
2493                 tptr = get_lun_statep(isp, 0, lun);
2494                 if (tptr == NULL) {
2495                         tptr = get_lun_statep(isp, 0, CAM_LUN_WILDCARD);
2496                         if (tptr == NULL) {
2497                                 isp_prt(isp, ISP_LOGWARN, "ABORT TASK for lun %u- but no tstate", lun);
2498                                 return;
2499                         }
2500                 }
2501                 atp = isp_get_atpd(isp, tptr, inp->in_seqid);
2502
2503                 if (atp) {
2504                         inot = (struct ccb_immediate_notify *) SLIST_FIRST(&tptr->inots);
2505                         isp_prt(isp, ISP_LOGTDEBUG0, "ABORT TASK RX_ID %x WWN 0x%016llx state %d", inp->in_seqid, (unsigned long long) wwn, atp->state);
2506                         if (inot) {
2507                                 tptr->inot_count--;
2508                                 SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
2509                                 ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, inot->ccb_h.path, "%s: Take FREE INOT count now %d\n", __func__, tptr->inot_count);
2510                         } else {
2511                                 ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, tptr->owner, "out of INOT structures\n");
2512                         }
2513                 } else {
2514                         ISP_PATH_PRT(isp, ISP_LOGWARN, tptr->owner, "abort task RX_ID %x from wwn 0x%016llx, state unknown\n", inp->in_seqid, wwn);
2515                 }
2516                 if (inot) {
2517                         isp_notify_t tmp, *nt = &tmp;
2518                         ISP_MEMZERO(nt, sizeof (isp_notify_t));
2519                         nt->nt_hba = isp;
2520                         nt->nt_tgt = FCPARAM(isp, 0)->isp_wwpn;
2521                         nt->nt_wwn = wwn;
2522                         nt->nt_nphdl = loopid;
2523                         nt->nt_sid = PORT_ANY;
2524                         nt->nt_did = PORT_ANY;
2525                         nt->nt_lun = lun;
2526                         nt->nt_need_ack = 1;
2527                         nt->nt_channel = 0;
2528                         nt->nt_ncode = NT_ABORT_TASK;
2529                         nt->nt_lreserved = inot;
2530                         isp_handle_platform_target_tmf(isp, nt);
2531                         needack = 0;
2532                 }
2533                 rls_lun_statep(isp, tptr);
2534                 break;
2535         }
2536         default:
2537                 break;
2538         }
2539         if (needack) {
2540                 (void) isp_notify_ack(isp, inp);
2541         }
2542 }
2543
2544 static void
2545 isp_handle_platform_notify_24xx(ispsoftc_t *isp, in_fcentry_24xx_t *inot)
2546 {
2547         uint16_t nphdl;
2548         uint32_t portid;
2549         fcportdb_t *lp;
2550         uint8_t *ptr = NULL;
2551         uint64_t wwn;
2552
2553         nphdl = inot->in_nphdl;
2554         if (nphdl != NIL_HANDLE) {
2555                 portid = inot->in_portid_hi << 16 | inot->in_portid_lo;
2556         } else {
2557                 portid = PORT_ANY;
2558         }
2559
2560         switch (inot->in_status) {
2561         case IN24XX_ELS_RCVD:
2562         {
2563                 char buf[16], *msg;
2564                 int chan = ISP_GET_VPIDX(isp, inot->in_vpidx);
2565
2566                 /*
2567                  * Note that we're just getting notification that an ELS was received
2568                  * (possibly with some associcated information sent upstream). This is
2569                  * *not* the same as being given the ELS frame to accept or reject.
2570                  */
2571                 switch (inot->in_status_subcode) {
2572                 case LOGO:
2573                         msg = "LOGO";
2574                         if (ISP_FW_NEWER_THAN(isp, 4, 0, 25)) {
2575                                 ptr = (uint8_t *)inot;  /* point to unswizzled entry! */
2576                                 wwn =   (((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF])   << 56) |
2577                                         (((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+1]) << 48) |
2578                                         (((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+2]) << 40) |
2579                                         (((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+3]) << 32) |
2580                                         (((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+4]) << 24) |
2581                                         (((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+5]) << 16) |
2582                                         (((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+6]) <<  8) |
2583                                         (((uint64_t) ptr[IN24XX_LOGO_WWPN_OFF+7]));
2584                         } else {
2585                                 wwn = INI_ANY;
2586                         }
2587                         isp_del_wwn_entry(isp, chan, wwn, nphdl, portid);
2588                         break;
2589                 case PRLO:
2590                         msg = "PRLO";
2591                         break;
2592                 case PLOGI:
2593                         msg = "PLOGI";
2594                         if (ISP_FW_NEWER_THAN(isp, 4, 0, 25)) {
2595                                 ptr = (uint8_t *)inot;  /* point to unswizzled entry! */
2596                                 wwn =   (((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF])   << 56) |
2597                                         (((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+1]) << 48) |
2598                                         (((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+2]) << 40) |
2599                                         (((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+3]) << 32) |
2600                                         (((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+4]) << 24) |
2601                                         (((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+5]) << 16) |
2602                                         (((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+6]) <<  8) |
2603                                         (((uint64_t) ptr[IN24XX_PLOGI_WWPN_OFF+7]));
2604                         } else {
2605                                 wwn = INI_NONE;
2606                         }
2607                         isp_add_wwn_entry(isp, chan, wwn, nphdl, portid);
2608                         break;
2609                 case PRLI:
2610                         msg = "PRLI";
2611                         break;
2612                 case PDISC:
2613                         msg = "PDISC";
2614                         break;
2615                 case ADISC:
2616                         msg = "ADISC";
2617                         break;
2618                 default:
2619                         ISP_SNPRINTF(buf, sizeof (buf), "ELS 0x%x", inot->in_status_subcode);
2620                         msg = buf;
2621                         break;
2622                 }
2623                 if (inot->in_flags & IN24XX_FLAG_PUREX_IOCB) {
2624                         isp_prt(isp, ISP_LOGERR, "%s Chan %d ELS N-port handle %x PortID 0x%06x marked as needing a PUREX response", msg, chan, nphdl, portid);
2625                         break;
2626                 }
2627                 isp_prt(isp, ISP_LOGTDEBUG0, "%s Chan %d ELS N-port handle %x PortID 0x%06x RX_ID 0x%x OX_ID 0x%x", msg, chan, nphdl, portid,
2628                     inot->in_rxid, inot->in_oxid);
2629                 (void) isp_notify_ack(isp, inot);
2630                 break;
2631         }
2632
2633         case IN24XX_PORT_LOGOUT:
2634                 ptr = "PORT LOGOUT";
2635                 if (isp_find_pdb_by_loopid(isp, ISP_GET_VPIDX(isp, inot->in_vpidx), nphdl, &lp)) {
2636                         isp_del_wwn_entry(isp, ISP_GET_VPIDX(isp, inot->in_vpidx), lp->port_wwn, nphdl, lp->portid);
2637                 }
2638                 /* FALLTHROUGH */
2639         case IN24XX_PORT_CHANGED:
2640                 if (ptr == NULL) {
2641                         ptr = "PORT CHANGED";
2642                 }
2643                 /* FALLTHROUGH */
2644         case IN24XX_LIP_RESET:
2645                 if (ptr == NULL) {
2646                         ptr = "LIP RESET";
2647                 }
2648                 isp_prt(isp, ISP_LOGINFO, "Chan %d %s (sub-status 0x%x) for N-port handle 0x%x", ISP_GET_VPIDX(isp, inot->in_vpidx), ptr, inot->in_status_subcode, nphdl);
2649
2650                 /*
2651                  * All subcodes here are irrelevant. What is relevant
2652                  * is that we need to terminate all active commands from
2653                  * this initiator (known by N-port handle).
2654                  */
2655                 /* XXX IMPLEMENT XXX */
2656                 (void) isp_notify_ack(isp, inot);
2657                 break;
2658
2659         case IN24XX_LINK_RESET:
2660         case IN24XX_LINK_FAILED:
2661         case IN24XX_SRR_RCVD:
2662         default:
2663                 (void) isp_notify_ack(isp, inot);
2664                 break;
2665         }
2666 }
2667
2668 static int
2669 isp_handle_platform_target_notify_ack(ispsoftc_t *isp, isp_notify_t *mp)
2670 {
2671
2672         if (isp->isp_state != ISP_RUNSTATE) {
2673                 isp_prt(isp, ISP_LOGTINFO, "Notify Code 0x%x (qevalid=%d) acked- h/w not ready (dropping)", mp->nt_ncode, mp->nt_lreserved != NULL);
2674                 return (0);
2675         }
2676
2677         /*
2678          * This case is for a Task Management Function, which shows up as an ATIO7 entry.
2679          */
2680         if (IS_24XX(isp) && mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ATIO) {
2681                 ct7_entry_t local, *cto = &local;
2682                 at7_entry_t *aep = (at7_entry_t *)mp->nt_lreserved;
2683                 fcportdb_t *lp;
2684                 uint32_t sid;
2685                 uint16_t nphdl;
2686
2687                 sid = (aep->at_hdr.s_id[0] << 16) | (aep->at_hdr.s_id[1] << 8) | aep->at_hdr.s_id[2];
2688                 if (isp_find_pdb_by_sid(isp, mp->nt_channel, sid, &lp)) {
2689                         nphdl = lp->handle;
2690                 } else {
2691                         nphdl = NIL_HANDLE;
2692                 }
2693                 ISP_MEMZERO(&local, sizeof (local));
2694                 cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
2695                 cto->ct_header.rqs_entry_count = 1;
2696                 cto->ct_nphdl = nphdl;
2697                 cto->ct_rxid = aep->at_rxid;
2698                 cto->ct_vpidx = mp->nt_channel;
2699                 cto->ct_iid_lo = sid;
2700                 cto->ct_iid_hi = sid >> 16;
2701                 cto->ct_oxid = aep->at_hdr.ox_id;
2702                 cto->ct_flags = CT7_SENDSTATUS|CT7_NOACK|CT7_NO_DATA|CT7_FLAG_MODE1;
2703                 cto->ct_flags |= (aep->at_ta_len >> 12) << CT7_TASK_ATTR_SHIFT;
2704                 return (isp_target_put_entry(isp, &local));
2705         }
2706
2707         /*
2708          * This case is for a responding to an ABTS frame
2709          */
2710         if (IS_24XX(isp) && mp->nt_lreserved && ((isphdr_t *)mp->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD) {
2711
2712                 /*
2713                  * Overload nt_need_ack here to mark whether we've terminated the associated command.
2714                  */
2715                 if (mp->nt_need_ack) {
2716                         uint8_t storage[QENTRY_LEN];
2717                         ct7_entry_t *cto = (ct7_entry_t *) storage;
2718                         abts_t *abts = (abts_t *)mp->nt_lreserved;
2719
2720                         ISP_MEMZERO(cto, sizeof (ct7_entry_t));
2721                         isp_prt(isp, ISP_LOGTDEBUG0, "%s: [%x] terminating after ABTS received", __func__, abts->abts_rxid_task);
2722                         cto->ct_header.rqs_entry_type = RQSTYPE_CTIO7;
2723                         cto->ct_header.rqs_entry_count = 1;
2724                         cto->ct_nphdl = mp->nt_nphdl;
2725                         cto->ct_rxid = abts->abts_rxid_task;
2726                         cto->ct_iid_lo = mp->nt_sid;
2727                         cto->ct_iid_hi = mp->nt_sid >> 16;
2728                         cto->ct_oxid = abts->abts_ox_id;
2729                         cto->ct_vpidx = mp->nt_channel;
2730                         cto->ct_flags = CT7_NOACK|CT7_TERMINATE;
2731                         if (isp_target_put_entry(isp, cto)) {
2732                                 return (ENOMEM);
2733                         }
2734                         mp->nt_need_ack = 0;
2735                 }
2736                 if (isp_acknak_abts(isp, mp->nt_lreserved, 0) == ENOMEM) {
2737                         return (ENOMEM);
2738                 } else {
2739                         return (0);
2740                 }
2741         }
2742
2743         /*
2744          * Handle logout cases here
2745          */
2746         if (mp->nt_ncode == NT_GLOBAL_LOGOUT) {
2747                 isp_del_all_wwn_entries(isp, mp->nt_channel);
2748         }
2749
2750         if (mp->nt_ncode == NT_LOGOUT) {
2751                 if (!IS_2100(isp) && IS_FC(isp)) {
2752                         isp_del_wwn_entries(isp, mp);
2753                 }
2754         }
2755
2756         /*
2757          * General purpose acknowledgement
2758          */
2759         if (mp->nt_need_ack) {
2760                 isp_prt(isp, ISP_LOGTINFO, "Notify Code 0x%x (qevalid=%d) being acked", mp->nt_ncode, mp->nt_lreserved != NULL);
2761                 return (isp_notify_ack(isp, mp->nt_lreserved));
2762         }
2763         return (0);
2764 }
2765
2766 /*
2767  * Handle task managment functions.
2768  *
2769  * We show up here with a notify structure filled out.
2770  *
2771  * The nt_lreserved tag points to the original queue entry
2772  */
2773 static void
2774 isp_handle_platform_target_tmf(ispsoftc_t *isp, isp_notify_t *notify)
2775 {
2776         tstate_t *tptr;
2777         fcportdb_t *lp;
2778         struct ccb_immediate_notify *inot;
2779         inot_private_data_t *ntp = NULL;
2780         lun_id_t lun;
2781
2782         isp_prt(isp, ISP_LOGTDEBUG0, "%s: code 0x%x sid  0x%x tagval 0x%016llx chan %d lun 0x%x", __func__, notify->nt_ncode,
2783             notify->nt_sid, (unsigned long long) notify->nt_tagval, notify->nt_channel, notify->nt_lun);
2784         /*
2785          * NB: This assignment is necessary because of tricky type conversion.
2786          * XXX: This is tricky and I need to check this. If the lun isn't known
2787          * XXX: for the task management function, it does not of necessity follow
2788          * XXX: that it should go up stream to the wildcard listener.
2789          */
2790         if (notify->nt_lun == LUN_ANY) {
2791                 lun = CAM_LUN_WILDCARD;
2792         } else {
2793                 lun = notify->nt_lun;
2794         }
2795         tptr = get_lun_statep(isp, notify->nt_channel, lun);
2796         if (tptr == NULL) {
2797                 tptr = get_lun_statep(isp, notify->nt_channel, CAM_LUN_WILDCARD);
2798                 if (tptr == NULL) {
2799                         isp_prt(isp, ISP_LOGWARN, "%s: no state pointer found for chan %d lun 0x%x", __func__, notify->nt_channel, lun);
2800                         goto bad;
2801                 }
2802         }
2803         inot = (struct ccb_immediate_notify *) SLIST_FIRST(&tptr->inots);
2804         if (inot == NULL) {
2805                 isp_prt(isp, ISP_LOGWARN, "%s: out of immediate notify structures for chan %d lun 0x%x", __func__, notify->nt_channel, lun);
2806                 goto bad;
2807         }
2808
2809         if (isp_find_pdb_by_sid(isp, notify->nt_channel, notify->nt_sid, &lp) == 0) {
2810                 inot->initiator_id = CAM_TARGET_WILDCARD;
2811         } else {
2812                 inot->initiator_id = lp->handle;
2813         }
2814         inot->seq_id = notify->nt_tagval;
2815         inot->tag_id = notify->nt_tagval >> 32;
2816
2817         switch (notify->nt_ncode) {
2818         case NT_ABORT_TASK:
2819                 isp_target_mark_aborted_early(isp, tptr, inot->tag_id);
2820                 inot->arg = MSG_ABORT_TASK;
2821                 break;
2822         case NT_ABORT_TASK_SET:
2823                 isp_target_mark_aborted_early(isp, tptr, TAG_ANY);
2824                 inot->arg = MSG_ABORT_TASK_SET;
2825                 break;
2826         case NT_CLEAR_ACA:
2827                 inot->arg = MSG_CLEAR_ACA;
2828                 break;
2829         case NT_CLEAR_TASK_SET:
2830                 inot->arg = MSG_CLEAR_TASK_SET;
2831                 break;
2832         case NT_LUN_RESET:
2833                 inot->arg = MSG_LOGICAL_UNIT_RESET;
2834                 break;
2835         case NT_TARGET_RESET:
2836                 inot->arg = MSG_TARGET_RESET;
2837                 break;
2838         default:
2839                 isp_prt(isp, ISP_LOGWARN, "%s: unknown TMF code 0x%x for chan %d lun 0x%x", __func__, notify->nt_ncode, notify->nt_channel, lun);
2840                 goto bad;
2841         }
2842
2843         ntp = isp_get_ntpd(isp, tptr);
2844         if (ntp == NULL) {
2845                 isp_prt(isp, ISP_LOGWARN, "%s: out of inotify private structures", __func__);
2846                 goto bad;
2847         }
2848         ISP_MEMCPY(&ntp->rd.nt, notify, sizeof (isp_notify_t));
2849         if (notify->nt_lreserved) {
2850                 ISP_MEMCPY(&ntp->rd.data, notify->nt_lreserved, QENTRY_LEN);
2851                 ntp->rd.nt.nt_lreserved = &ntp->rd.data;
2852         }
2853         ntp->rd.seq_id = notify->nt_tagval;
2854         ntp->rd.tag_id = notify->nt_tagval >> 32;
2855
2856         tptr->inot_count--;
2857         SLIST_REMOVE_HEAD(&tptr->inots, sim_links.sle);
2858         rls_lun_statep(isp, tptr);
2859         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, inot->ccb_h.path, "%s: Take FREE INOT count now %d\n", __func__, tptr->inot_count);
2860         inot->ccb_h.status = CAM_MESSAGE_RECV;
2861         xpt_done((union ccb *)inot);
2862         return;
2863 bad:
2864         if (tptr) {
2865                 rls_lun_statep(isp, tptr);
2866         }
2867         if (notify->nt_need_ack && notify->nt_lreserved) {
2868                 if (((isphdr_t *)notify->nt_lreserved)->rqs_entry_type == RQSTYPE_ABTS_RCVD) {
2869                         (void) isp_acknak_abts(isp, notify->nt_lreserved, ENOMEM);
2870                 } else {
2871                         (void) isp_notify_ack(isp, notify->nt_lreserved);
2872                 }
2873         }
2874 }
2875
2876 /*
2877  * Find the associated private data and makr it as dead so
2878  * we don't try to work on it any further.
2879  */
2880 static void
2881 isp_target_mark_aborted(ispsoftc_t *isp, union ccb *ccb)
2882 {
2883         tstate_t *tptr;
2884         atio_private_data_t *atp;
2885
2886         tptr = get_lun_statep(isp, XS_CHANNEL(ccb), XS_LUN(ccb));
2887         if (tptr == NULL) {
2888                 tptr = get_lun_statep(isp, XS_CHANNEL(ccb), CAM_LUN_WILDCARD);
2889                 if (tptr == NULL) {
2890                         ccb->ccb_h.status = CAM_REQ_INVALID;
2891                         return;
2892                 }
2893         }
2894
2895         atp = isp_get_atpd(isp, tptr, ccb->atio.tag_id);
2896         if (atp == NULL) {
2897                 ccb->ccb_h.status = CAM_REQ_INVALID;
2898                 return;
2899         }
2900         atp->dead = 1;
2901         ccb->ccb_h.status = CAM_REQ_CMP;
2902 }
2903
2904 static void
2905 isp_target_mark_aborted_early(ispsoftc_t *isp, tstate_t *tptr, uint32_t tag_id)
2906 {
2907         atio_private_data_t *atp;
2908         inot_private_data_t *restart_queue = tptr->restart_queue;
2909
2910         /*
2911          * First, clean any commands pending restart
2912          */
2913         tptr->restart_queue = NULL;
2914         while (restart_queue) {
2915                 uint32_t this_tag_id;
2916                 inot_private_data_t *ntp = restart_queue;
2917
2918                 restart_queue = ntp->rd.nt.nt_hba;
2919
2920                 if (IS_24XX(isp)) {
2921                         this_tag_id = ((at7_entry_t *)ntp->rd.data)->at_rxid;
2922                 } else {
2923                         this_tag_id = ((at2_entry_t *)ntp->rd.data)->at_rxid;
2924                 }
2925                 if ((uint64_t)tag_id == TAG_ANY || tag_id == this_tag_id) {
2926                         isp_put_ntpd(isp, tptr, ntp);
2927                 } else {
2928                         ntp->rd.nt.nt_hba = tptr->restart_queue;
2929                         tptr->restart_queue = ntp;
2930                 }
2931         }
2932
2933         /*
2934          * Now mark other ones dead as well.
2935          */
2936         for (atp = tptr->atpool; atp < &tptr->atpool[ATPDPSIZE]; atp++) {
2937                 if ((uint64_t)tag_id == TAG_ANY || atp->tag == tag_id) {
2938                         atp->dead = 1;
2939                 }
2940         }
2941 }
2942
2943
2944 #ifdef  ISP_INTERNAL_TARGET
2945 // #define      ISP_FORCE_TIMEOUT               1
2946 #define ISP_TEST_WWNS                   1
2947 #define ISP_TEST_SEPARATE_STATUS        1
2948
2949 #define ccb_data_offset         ppriv_field0
2950 #define ccb_atio                ppriv_ptr1
2951 #define ccb_inot                ppriv_ptr1
2952
2953 #define MAX_ISP_TARG_TRANSFER   (2 << 20)
2954 #define NISP_TARG_CMDS          1024
2955 #define NISP_TARG_NOTIFIES      1024
2956 #define DISK_SHIFT              9
2957 #define JUNK_SIZE               256
2958
2959 #ifndef VERIFY_10
2960 #define VERIFY_10       0x2f
2961 #endif
2962
2963 TAILQ_HEAD(ccb_queue, ccb_hdr);
2964 extern u_int vm_kmem_size;
2965 static int ca;
2966 static uint32_t disk_size;
2967 static uint8_t *disk_data = NULL;
2968 static uint8_t *junk_data;
2969 static MALLOC_DEFINE(M_ISPTARG, "ISPTARG", "ISP TARGET data");
2970 struct isptarg_softc {
2971         /* CCBs (CTIOs, ATIOs, INOTs) pending on the controller */
2972         struct ccb_queue        work_queue;
2973         struct ccb_queue        rework_queue;
2974         struct ccb_queue        running_queue;
2975         struct ccb_queue        inot_queue;
2976         struct cam_periph       *periph;
2977         struct cam_path         *path;
2978         ispsoftc_t              *isp;
2979 };
2980 static periph_ctor_t    isptargctor;
2981 static periph_dtor_t    isptargdtor;
2982 static periph_start_t   isptargstart;
2983 static periph_init_t    isptarginit;
2984 static void             isptarg_done(struct cam_periph *, union ccb *);
2985 static void             isptargasync(void *, u_int32_t, struct cam_path *, void *);
2986
2987
2988 static int isptarg_rwparm(uint8_t *, uint8_t *, uint64_t, uint32_t, uint8_t **, uint32_t *, int *);
2989
2990 static struct periph_driver isptargdriver =
2991 {
2992         isptarginit, "isptarg", TAILQ_HEAD_INITIALIZER(isptargdriver.units), /* generation */ 0
2993 };
2994
2995 static void
2996 isptarginit(void)
2997 {
2998 }
2999
3000 static void
3001 isptargnotify(ispsoftc_t *isp, union ccb *iccb, struct ccb_immediate_notify *inot)
3002 {
3003         struct ccb_notify_acknowledge *ack = &iccb->cna2;
3004
3005         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, inot->ccb_h.path, "%s: [0x%x] immediate notify for 0x%x from 0x%x status 0x%x arg 0x%x\n", __func__,
3006             inot->tag_id, inot->initiator_id, inot->seq_id, inot->ccb_h.status, inot->arg);
3007         ack->ccb_h.func_code = XPT_NOTIFY_ACKNOWLEDGE;
3008         ack->ccb_h.flags = 0;
3009         ack->ccb_h.retry_count = 0;
3010         ack->ccb_h.cbfcnp = isptarg_done;
3011         ack->ccb_h.timeout = 0;
3012         ack->ccb_h.ccb_inot = inot;
3013         ack->tag_id = inot->tag_id;
3014         ack->seq_id = inot->seq_id;
3015         ack->initiator_id = inot->initiator_id;
3016         xpt_action(iccb);
3017 }
3018
3019 static void
3020 isptargstart(struct cam_periph *periph, union ccb *iccb)
3021 {
3022         const uint8_t niliqd[SHORT_INQUIRY_LENGTH] = { 0x7f };
3023         const uint8_t iqd[SHORT_INQUIRY_LENGTH] = {
3024                 0, 0x0, 0x2, 0x2, 32, 0, 0, 0x32,
3025                 'F', 'R', 'E', 'E', 'B', 'S', 'D', ' ',
3026                 'S', 'C', 'S', 'I', ' ', 'M', 'E', 'M',
3027                 'O', 'R', 'Y', ' ', 'D', 'I', 'S', 'K',
3028                 '0', '0', '0', '1'
3029         };
3030         int i, more = 0, last;
3031         struct isptarg_softc *softc = periph->softc;
3032         struct ccb_scsiio *csio;
3033         lun_id_t return_lun;
3034         struct ccb_accept_tio *atio;
3035         uint8_t *cdb, *ptr, status;
3036         uint8_t *data_ptr;
3037         uint32_t data_len, flags;
3038         struct ccb_hdr *ccbh;
3039
3040         mtx_assert(periph->sim->mtx, MA_OWNED);
3041         ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, iccb->ccb_h.path, "%s: function code 0x%x INOTQ=%c WORKQ=%c REWORKQ=%c\n", __func__, iccb->ccb_h.func_code,
3042             TAILQ_FIRST(&softc->inot_queue)? 'y' : 'n', TAILQ_FIRST(&softc->work_queue)? 'y' : 'n', TAILQ_FIRST(&softc->rework_queue)? 'y' : 'n');
3043         /*
3044          * Check for immediate notifies first
3045          */
3046         ccbh = TAILQ_FIRST(&softc->inot_queue);
3047         if (ccbh) {
3048                 TAILQ_REMOVE(&softc->inot_queue, ccbh, periph_links.tqe);
3049                 if (TAILQ_FIRST(&softc->inot_queue) || TAILQ_FIRST(&softc->work_queue) || TAILQ_FIRST(&softc->rework_queue)) {
3050                         xpt_schedule(periph, 1);
3051                 }
3052                 isptargnotify(softc->isp, iccb, (struct ccb_immediate_notify *)ccbh);
3053                 return;
3054         }
3055
3056         /*
3057          * Check the rework (continuation) work queue first.
3058          */
3059         ccbh = TAILQ_FIRST(&softc->rework_queue);
3060         if (ccbh) {
3061                 atio = (struct ccb_accept_tio *)ccbh;
3062                 TAILQ_REMOVE(&softc->rework_queue, ccbh, periph_links.tqe);
3063                 more = TAILQ_FIRST(&softc->work_queue) || TAILQ_FIRST(&softc->rework_queue);
3064         } else {
3065                 ccbh = TAILQ_FIRST(&softc->work_queue);
3066                 if (ccbh == NULL) {
3067                         ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, iccb->ccb_h.path, "%s: woken up but no work?\n", __func__);
3068                         xpt_release_ccb(iccb);
3069                         return;
3070                 }
3071                 atio = (struct ccb_accept_tio *)ccbh;
3072                 TAILQ_REMOVE(&softc->work_queue, ccbh, periph_links.tqe);
3073                 more = TAILQ_FIRST(&softc->work_queue) != NULL;
3074                 atio->ccb_h.ccb_data_offset = 0;
3075         }
3076
3077         if (atio->tag_id == 0xffffffff || atio->ccb_h.func_code != XPT_ACCEPT_TARGET_IO) {
3078                 panic("BAD ATIO");
3079         }
3080
3081         data_ptr = NULL;
3082         data_len = 0;
3083         csio = &iccb->csio;
3084         status = SCSI_STATUS_OK;
3085         flags = CAM_SEND_STATUS;
3086         memset(&atio->sense_data, 0, sizeof (atio->sense_data));
3087         cdb = atio->cdb_io.cdb_bytes;
3088         ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, ccbh->path, "%s: [0x%x] processing ATIO from 0x%x CDB=0x%x data_offset=%u\n", __func__, atio->tag_id, atio->init_id,
3089             cdb[0], atio->ccb_h.ccb_data_offset);
3090
3091         return_lun = XS_LUN(atio);
3092         if (return_lun != 0) {
3093                 xpt_print(atio->ccb_h.path, "[0x%x] Non-Zero Lun %d: cdb0=0x%x\n", atio->tag_id, return_lun, cdb[0]);
3094                 if (cdb[0] != INQUIRY && cdb[0] != REPORT_LUNS && cdb[0] != REQUEST_SENSE) {
3095                         status = SCSI_STATUS_CHECK_COND;
3096                         atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_ILLEGAL_REQUEST;
3097                         atio->sense_data.add_sense_code = 0x25;
3098                         atio->sense_data.add_sense_code_qual = 0x0;
3099                         atio->sense_len = sizeof (atio->sense_data);
3100                 }
3101                 return_lun = CAM_LUN_WILDCARD;
3102         }
3103
3104         switch (cdb[0]) {
3105         case REQUEST_SENSE:
3106                 flags |= CAM_DIR_IN;
3107                 data_len = sizeof (atio->sense_data);
3108                 junk_data[0] = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_NO_SENSE;
3109                 memset(junk_data+1, 0, data_len-1);
3110                 if (data_len > cdb[4]) {
3111                         data_len = cdb[4];
3112                 }
3113                 if (data_len) {
3114                         data_ptr = junk_data;
3115                 }
3116                 break;
3117         case READ_6:
3118         case READ_10:
3119         case READ_12:
3120         case READ_16:
3121                 if (isptarg_rwparm(cdb, disk_data, disk_size, atio->ccb_h.ccb_data_offset, &data_ptr, &data_len, &last)) {
3122                         status = SCSI_STATUS_CHECK_COND;
3123                         atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
3124                         atio->sense_data.add_sense_code = 0x5;
3125                         atio->sense_data.add_sense_code_qual = 0x24;
3126                         atio->sense_len = sizeof (atio->sense_data);
3127                 } else {
3128 #ifdef  ISP_FORCE_TIMEOUT
3129                         {
3130                                 static int foo;
3131                                 if (foo++ == 500) {
3132                                         if (more) {
3133                                                 xpt_schedule(periph, 1);
3134                                         }
3135                                         foo = 0;
3136                                         return;
3137                                 }
3138                         }
3139 #endif
3140 #ifdef  ISP_TEST_SEPARATE_STATUS
3141                         if (last && data_len) {
3142                                 last = 0;
3143                         }
3144 #endif
3145                         if (last == 0) {
3146                                 flags &= ~CAM_SEND_STATUS;
3147                         }
3148                         if (data_len) {
3149                                 atio->ccb_h.ccb_data_offset += data_len;
3150                                 flags |= CAM_DIR_IN;
3151                         } else {
3152                                 flags |= CAM_DIR_NONE;
3153                         }
3154                 }
3155                 break;
3156         case WRITE_6:
3157         case WRITE_10:
3158         case WRITE_12:
3159         case WRITE_16:
3160                 if (isptarg_rwparm(cdb, disk_data, disk_size, atio->ccb_h.ccb_data_offset, &data_ptr, &data_len, &last)) {
3161                         status = SCSI_STATUS_CHECK_COND;
3162                         atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
3163                         atio->sense_data.add_sense_code = 0x5;
3164                         atio->sense_data.add_sense_code_qual = 0x24;
3165                         atio->sense_len = sizeof (atio->sense_data);
3166                 } else {
3167 #ifdef  ISP_FORCE_TIMEOUT
3168                         {
3169                                 static int foo;
3170                                 if (foo++ == 500) {
3171                                         if (more) {
3172                                                 xpt_schedule(periph, 1);
3173                                         }
3174                                         foo = 0;
3175                                         return;
3176                                 }
3177                         }
3178 #endif
3179 #ifdef  ISP_TEST_SEPARATE_STATUS
3180                         if (last && data_len) {
3181                                 last = 0;
3182                         }
3183 #endif
3184                         if (last == 0) {
3185                                 flags &= ~CAM_SEND_STATUS;
3186                         }
3187                         if (data_len) {
3188                                 atio->ccb_h.ccb_data_offset += data_len;
3189                                 flags |= CAM_DIR_OUT;
3190                         } else {
3191                                 flags |= CAM_DIR_NONE;
3192                         }
3193                 }
3194                 break;
3195         case INQUIRY:
3196                 flags |= CAM_DIR_IN;
3197                 if (cdb[1] || cdb[2] || cdb[3]) {
3198                         status = SCSI_STATUS_CHECK_COND;
3199                         atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
3200                         atio->sense_data.add_sense_code = 0x5;
3201                         atio->sense_data.add_sense_code_qual = 0x20;
3202                         atio->sense_len = sizeof (atio->sense_data);
3203                         break;
3204                 }
3205                 data_len = sizeof (iqd);
3206                 if (data_len > cdb[4]) {
3207                         data_len = cdb[4];
3208                 }
3209                 if (data_len) {
3210                         if (XS_LUN(iccb) != 0) {
3211                                 memcpy(junk_data, niliqd, sizeof (iqd));
3212                         } else {
3213                                 memcpy(junk_data, iqd, sizeof (iqd));
3214                         }
3215                         data_ptr = junk_data;
3216                 }
3217                 break;
3218         case TEST_UNIT_READY:
3219                 flags |= CAM_DIR_NONE;
3220                 if (ca) {
3221                         ca = 0;
3222                         status = SCSI_STATUS_CHECK_COND;
3223                         atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
3224                         atio->sense_data.add_sense_code = 0x28;
3225                         atio->sense_data.add_sense_code_qual = 0x0;
3226                         atio->sense_len = sizeof (atio->sense_data);
3227                 }
3228                 break;
3229         case SYNCHRONIZE_CACHE:
3230         case START_STOP:
3231         case RESERVE:
3232         case RELEASE:
3233         case VERIFY_10:
3234                 flags |= CAM_DIR_NONE;
3235                 break;
3236
3237         case READ_CAPACITY:
3238                 flags |= CAM_DIR_IN;
3239                 if (cdb[2] || cdb[3] || cdb[4] || cdb[5]) {
3240                         status = SCSI_STATUS_CHECK_COND;
3241                         atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
3242                         atio->sense_data.add_sense_code = 0x5;
3243                         atio->sense_data.add_sense_code_qual = 0x24;
3244                         atio->sense_len = sizeof (atio->sense_data);
3245                         break;
3246                 }
3247                 if (cdb[8] & 0x1) { /* PMI */
3248                         junk_data[0] = 0xff;
3249                         junk_data[1] = 0xff;
3250                         junk_data[2] = 0xff;
3251                         junk_data[3] = 0xff;
3252                 } else {
3253                         uint64_t last_blk = (disk_size >> DISK_SHIFT) - 1;
3254                         if (last_blk < 0xffffffffULL) {
3255                             junk_data[0] = (last_blk >> 24) & 0xff;
3256                             junk_data[1] = (last_blk >> 16) & 0xff;
3257                             junk_data[2] = (last_blk >>  8) & 0xff;
3258                             junk_data[3] = (last_blk) & 0xff;
3259                         } else {
3260                             junk_data[0] = 0xff;
3261                             junk_data[1] = 0xff;
3262                             junk_data[2] = 0xff;
3263                             junk_data[3] = 0xff;
3264                         }
3265                 }
3266                 junk_data[4] = ((1 << DISK_SHIFT) >> 24) & 0xff;
3267                 junk_data[5] = ((1 << DISK_SHIFT) >> 16) & 0xff;
3268                 junk_data[6] = ((1 << DISK_SHIFT) >>  8) & 0xff;
3269                 junk_data[7] = ((1 << DISK_SHIFT)) & 0xff;
3270                 data_ptr = junk_data;
3271                 data_len = 8;
3272                 break;
3273         case REPORT_LUNS:
3274                 flags |= CAM_DIR_IN;
3275                 memset(junk_data, 0, JUNK_SIZE);
3276                 junk_data[0] = (1 << 3) >> 24;
3277                 junk_data[1] = (1 << 3) >> 16;
3278                 junk_data[2] = (1 << 3) >> 8;
3279                 junk_data[3] = (1 << 3);
3280                 ptr = NULL;
3281                 for (i = 0; i < 1; i++) {
3282                         ptr = &junk_data[8 + (1 << 3)];
3283                         if (i >= 256) {
3284                                 ptr[0] = 0x40 | ((i >> 8) & 0x3f);
3285                         }
3286                         ptr[1] = i;
3287                 }
3288                 data_ptr = junk_data;
3289                 data_len = (ptr + 8) - junk_data;
3290                 break;
3291
3292         default:
3293                 flags |= CAM_DIR_NONE;
3294                 status = SCSI_STATUS_CHECK_COND;
3295                 atio->sense_data.error_code = SSD_ERRCODE_VALID|SSD_CURRENT_ERROR|SSD_KEY_UNIT_ATTENTION;
3296                 atio->sense_data.add_sense_code = 0x5;
3297                 atio->sense_data.add_sense_code_qual = 0x20;
3298                 atio->sense_len = sizeof (atio->sense_data);
3299                 break;
3300         }
3301
3302         /*
3303          * If we are done with the transaction, tell the
3304          * controller to send status and perform a CMD_CMPLT.
3305          * If we have associated sense data, see if we can
3306          * send that too.
3307          */
3308         if (status == SCSI_STATUS_CHECK_COND) {
3309                 flags |= CAM_SEND_SENSE;
3310                 csio->sense_len = atio->sense_len;
3311                 csio->sense_data = atio->sense_data;
3312                 flags &= ~CAM_DIR_MASK;
3313                 data_len = 0;
3314                 data_ptr = NULL;
3315         }
3316         cam_fill_ctio(csio, 0, isptarg_done, flags, MSG_SIMPLE_Q_TAG, atio->tag_id, atio->init_id, status, data_ptr, data_len, 0);
3317         iccb->ccb_h.target_id = atio->ccb_h.target_id;
3318         iccb->ccb_h.target_lun = return_lun;
3319         iccb->ccb_h.ccb_atio = atio;
3320         xpt_action(iccb);
3321
3322         if ((atio->ccb_h.status & CAM_DEV_QFRZN) != 0) {
3323                 cam_release_devq(periph->path, 0, 0, 0, 0);
3324                 atio->ccb_h.status &= ~CAM_DEV_QFRZN;
3325         }
3326         if (more) {
3327                 xpt_schedule(periph, 1);
3328         }
3329 }
3330
3331 static cam_status
3332 isptargctor(struct cam_periph *periph, void *arg)
3333 {
3334         struct isptarg_softc *softc;
3335
3336         softc = (struct isptarg_softc *)arg;
3337         periph->softc = softc;
3338         softc->periph = periph;
3339         softc->path = periph->path;
3340         ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, periph->path, "%s called\n", __func__);
3341         return (CAM_REQ_CMP);
3342 }
3343
3344 static void
3345 isptargdtor(struct cam_periph *periph)
3346 {
3347         struct isptarg_softc *softc;
3348         softc = (struct isptarg_softc *)periph->softc;
3349         ISP_PATH_PRT(softc->isp, ISP_LOGTDEBUG0, periph->path, "%s called\n", __func__);
3350         softc->periph = NULL;
3351         softc->path = NULL;
3352         periph->softc = NULL;
3353 }
3354
3355 static void
3356 isptarg_done(struct cam_periph *periph, union ccb *ccb)
3357 {
3358         struct isptarg_softc *softc;
3359         ispsoftc_t *isp;
3360         struct ccb_accept_tio *atio;
3361         struct ccb_immediate_notify *inot;
3362         cam_status status;
3363
3364         softc = (struct isptarg_softc *)periph->softc;
3365         isp = softc->isp;
3366         status = ccb->ccb_h.status & CAM_STATUS_MASK;
3367
3368         switch (ccb->ccb_h.func_code) {
3369         case XPT_ACCEPT_TARGET_IO:
3370                 atio = (struct ccb_accept_tio *) ccb;
3371                 ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] ATIO seen in %s\n", atio->tag_id, __func__);
3372                 TAILQ_INSERT_TAIL(&softc->work_queue, &ccb->ccb_h, periph_links.tqe);
3373                 xpt_schedule(periph, 1);
3374                 break;
3375         case XPT_IMMEDIATE_NOTIFY:
3376                 inot = (struct ccb_immediate_notify *) ccb;
3377                 ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] INOT for 0x%x seen in %s\n", inot->tag_id, inot->seq_id, __func__);
3378                 TAILQ_INSERT_TAIL(&softc->inot_queue, &ccb->ccb_h, periph_links.tqe);
3379                 xpt_schedule(periph, 1);
3380                 break;
3381         case XPT_CONT_TARGET_IO:
3382                 if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
3383                         cam_release_devq(ccb->ccb_h.path, 0, 0, 0, 0);
3384                         ccb->ccb_h.status &= ~CAM_DEV_QFRZN;
3385                 }
3386                 atio = ccb->ccb_h.ccb_atio;
3387                 if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
3388                         cam_error_print(ccb, CAM_ESF_ALL, CAM_EPF_ALL);
3389                         xpt_action((union ccb *)atio);
3390                 } else if ((ccb->ccb_h.flags & CAM_SEND_STATUS) == 0) {
3391                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] MID CTIO seen in %s\n", atio->tag_id, __func__);
3392                         TAILQ_INSERT_TAIL(&softc->rework_queue, &atio->ccb_h, periph_links.tqe);
3393                         xpt_schedule(periph, 1);
3394                 } else {
3395                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "[0x%x] FINAL CTIO seen in %s\n", atio->tag_id, __func__);
3396                         xpt_action((union ccb *)atio);
3397                 }
3398                 xpt_release_ccb(ccb);
3399                 break;
3400         case XPT_NOTIFY_ACKNOWLEDGE:
3401                 if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
3402                         cam_release_devq(ccb->ccb_h.path, 0, 0, 0, 0);
3403                         ccb->ccb_h.status &= ~CAM_DEV_QFRZN;
3404                 }
3405                 inot = ccb->ccb_h.ccb_inot;
3406                 ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, inot->ccb_h.path, "[0x%x] recycle notify for tag 0x%x\n", inot->tag_id, inot->seq_id);
3407                 xpt_release_ccb(ccb);
3408                 xpt_action((union ccb *)inot);
3409                 break;
3410         default:
3411                 xpt_print(ccb->ccb_h.path, "unexpected code 0x%x\n", ccb->ccb_h.func_code);
3412                 break;
3413         }
3414 }
3415
3416 static void
3417 isptargasync(void *callback_arg, u_int32_t code, struct cam_path *path, void *arg)
3418 {
3419         struct ac_contract *acp = arg;
3420         struct ac_device_changed *fc = (struct ac_device_changed *) acp->contract_data;
3421
3422         if (code != AC_CONTRACT) {
3423                 return;
3424         }
3425         xpt_print(path, "0x%016llx Port ID 0x%06x %s\n", (unsigned long long) fc->wwpn, fc->port, fc->arrived? "arrived" : "departed");
3426 }
3427
3428 static void
3429 isp_target_thread(ispsoftc_t *isp, int chan)
3430 {
3431         union ccb *ccb = NULL;
3432         int i;
3433         void *wchan;
3434         cam_status status;
3435         struct isptarg_softc *softc = NULL;
3436         struct cam_periph *periph = NULL, *wperiph = NULL;
3437         struct cam_path *path, *wpath;
3438         struct cam_sim *sim;
3439
3440         if (disk_data == NULL) {
3441                 disk_size = roundup2(vm_kmem_size >> 1, (1ULL << 20));
3442                 if (disk_size < (50 << 20)) {
3443                         disk_size = 50 << 20;
3444                 }
3445                 disk_data = malloc(disk_size, M_ISPTARG, M_WAITOK | M_ZERO);
3446                 if (disk_data == NULL) {
3447                         isp_prt(isp, ISP_LOGERR, "%s: could not allocate disk data", __func__);
3448                         goto out;
3449                 }
3450                 isp_prt(isp, ISP_LOGINFO, "allocated a %ju MiB disk", (uintmax_t) (disk_size >> 20));
3451         }
3452         junk_data = malloc(JUNK_SIZE, M_ISPTARG, M_WAITOK | M_ZERO);
3453         if (junk_data == NULL) {
3454                 isp_prt(isp, ISP_LOGERR, "%s: could not allocate junk", __func__);
3455                 goto out;
3456         }
3457
3458
3459         softc = malloc(sizeof (*softc), M_ISPTARG, M_WAITOK | M_ZERO);
3460         if (softc == NULL) {
3461                 isp_prt(isp, ISP_LOGERR, "%s: could not allocate softc", __func__);
3462                 goto out;
3463         }
3464         TAILQ_INIT(&softc->work_queue);
3465         TAILQ_INIT(&softc->rework_queue);
3466         TAILQ_INIT(&softc->running_queue);
3467         TAILQ_INIT(&softc->inot_queue);
3468         softc->isp = isp;
3469
3470         periphdriver_register(&isptargdriver);
3471         ISP_GET_PC(isp, chan, sim, sim);
3472         ISP_GET_PC(isp, chan, path,  path);
3473         status = xpt_create_path_unlocked(&wpath, NULL, cam_sim_path(sim), CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD);
3474         if (status != CAM_REQ_CMP) {
3475                 isp_prt(isp, ISP_LOGERR, "%s: could not allocate wildcard path", __func__);
3476                 return;
3477         }
3478         status = xpt_create_path_unlocked(&path, NULL, cam_sim_path(sim), 0, 0);
3479         if (status != CAM_REQ_CMP) {
3480                 xpt_free_path(wpath);
3481                 isp_prt(isp, ISP_LOGERR, "%s: could not allocate path", __func__);
3482                 return;
3483         }
3484
3485         ccb = xpt_alloc_ccb();
3486
3487         ISP_LOCK(isp);
3488         status = cam_periph_alloc(isptargctor, NULL, isptargdtor, isptargstart, "isptarg", CAM_PERIPH_BIO, wpath, NULL, 0, softc);
3489         if (status != CAM_REQ_CMP) {
3490                 ISP_UNLOCK(isp);
3491                 isp_prt(isp, ISP_LOGERR, "%s: cam_periph_alloc for wildcard failed", __func__);
3492                 goto out;
3493         }
3494         wperiph = cam_periph_find(wpath, "isptarg");
3495         if (wperiph == NULL) {
3496                 ISP_UNLOCK(isp);
3497                 isp_prt(isp, ISP_LOGERR, "%s: wildcard periph already allocated but doesn't exist", __func__);
3498                 goto out;
3499         }
3500
3501         status = cam_periph_alloc(isptargctor, NULL, isptargdtor, isptargstart, "isptarg", CAM_PERIPH_BIO, path, NULL, 0, softc);
3502         if (status != CAM_REQ_CMP) {
3503                 ISP_UNLOCK(isp);
3504                 isp_prt(isp, ISP_LOGERR, "%s: cam_periph_alloc failed", __func__);
3505                 goto out;
3506         }
3507
3508         periph = cam_periph_find(path, "isptarg");
3509         if (periph == NULL) {
3510                 ISP_UNLOCK(isp);
3511                 isp_prt(isp, ISP_LOGERR, "%s: periph already allocated but doesn't exist", __func__);
3512                 goto out;
3513         }
3514
3515         status = xpt_register_async(AC_CONTRACT, isptargasync, isp, wpath);
3516         if (status != CAM_REQ_CMP) {
3517                 ISP_UNLOCK(isp);
3518                 isp_prt(isp, ISP_LOGERR, "%s: xpt_register_async failed", __func__);
3519                 goto out;
3520         }
3521
3522         ISP_UNLOCK(isp);
3523
3524         ccb = xpt_alloc_ccb();
3525
3526         /*
3527          * Make sure role is none.
3528          */
3529         xpt_setup_ccb(&ccb->ccb_h, periph->path, 10);
3530         ccb->ccb_h.func_code = XPT_SET_SIM_KNOB;
3531         ccb->knob.xport_specific.fc.role = KNOB_ROLE_NONE;
3532 #ifdef  ISP_TEST_WWNS
3533         ccb->knob.xport_specific.fc.valid = KNOB_VALID_ROLE | KNOB_VALID_ADDRESS;
3534         ccb->knob.xport_specific.fc.wwnn = 0x508004d000000000ULL | (device_get_unit(isp->isp_osinfo.dev) << 8) | (chan << 16);
3535         ccb->knob.xport_specific.fc.wwpn = 0x508004d000000001ULL | (device_get_unit(isp->isp_osinfo.dev) << 8) | (chan << 16);
3536 #else
3537         ccb->knob.xport_specific.fc.valid = KNOB_VALID_ROLE;
3538 #endif
3539
3540         ISP_LOCK(isp);
3541         xpt_action(ccb);
3542         ISP_UNLOCK(isp);
3543
3544         /*
3545          * Now enable luns
3546          */
3547         xpt_setup_ccb(&ccb->ccb_h, periph->path, 10);
3548         ccb->ccb_h.func_code = XPT_EN_LUN;
3549         ccb->cel.enable = 1;
3550         ISP_LOCK(isp);
3551         xpt_action(ccb);
3552         ISP_UNLOCK(isp);
3553         if (ccb->ccb_h.status != CAM_REQ_CMP) {
3554                 xpt_free_ccb(ccb);
3555                 xpt_print(periph->path, "failed to enable lun (0x%x)\n", ccb->ccb_h.status);
3556                 goto out;
3557         }
3558
3559         xpt_setup_ccb(&ccb->ccb_h, wperiph->path, 10);
3560         ccb->ccb_h.func_code = XPT_EN_LUN;
3561         ccb->cel.enable = 1;
3562         ISP_LOCK(isp);
3563         xpt_action(ccb);
3564         ISP_UNLOCK(isp);
3565         if (ccb->ccb_h.status != CAM_REQ_CMP) {
3566                 xpt_free_ccb(ccb);
3567                 xpt_print(wperiph->path, "failed to enable lun (0x%x)\n", ccb->ccb_h.status);
3568                 goto out;
3569         }
3570         xpt_free_ccb(ccb);
3571
3572         /*
3573          * Add resources
3574          */
3575         ISP_GET_PC_ADDR(isp, chan, target_proc, wchan);
3576         for (i = 0; i < 4; i++) {
3577                 ccb = malloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
3578                 xpt_setup_ccb(&ccb->ccb_h, wperiph->path, 1);
3579                 ccb->ccb_h.func_code = XPT_ACCEPT_TARGET_IO;
3580                 ccb->ccb_h.cbfcnp = isptarg_done;
3581                 ISP_LOCK(isp);
3582                 xpt_action(ccb);
3583                 ISP_UNLOCK(isp);
3584         }
3585         for (i = 0; i < NISP_TARG_CMDS; i++) {
3586                 ccb = malloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
3587                 xpt_setup_ccb(&ccb->ccb_h, periph->path, 1);
3588                 ccb->ccb_h.func_code = XPT_ACCEPT_TARGET_IO;
3589                 ccb->ccb_h.cbfcnp = isptarg_done;
3590                 ISP_LOCK(isp);
3591                 xpt_action(ccb);
3592                 ISP_UNLOCK(isp);
3593         }
3594         for (i = 0; i < 4; i++) {
3595                 ccb = malloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
3596                 xpt_setup_ccb(&ccb->ccb_h, wperiph->path, 1);
3597                 ccb->ccb_h.func_code = XPT_IMMEDIATE_NOTIFY;
3598                 ccb->ccb_h.cbfcnp = isptarg_done;
3599                 ISP_LOCK(isp);
3600                 xpt_action(ccb);
3601                 ISP_UNLOCK(isp);
3602         }
3603         for (i = 0; i < NISP_TARG_NOTIFIES; i++) {
3604                 ccb = malloc(sizeof (*ccb), M_ISPTARG, M_WAITOK | M_ZERO);
3605                 xpt_setup_ccb(&ccb->ccb_h, periph->path, 1);
3606                 ccb->ccb_h.func_code = XPT_IMMEDIATE_NOTIFY;
3607                 ccb->ccb_h.cbfcnp = isptarg_done;
3608                 ISP_LOCK(isp);
3609                 xpt_action(ccb);
3610                 ISP_UNLOCK(isp);
3611         }
3612
3613         /*
3614          * Now turn it all back on
3615          */
3616         xpt_setup_ccb(&ccb->ccb_h, periph->path, 10);
3617         ccb->ccb_h.func_code = XPT_SET_SIM_KNOB;
3618         ccb->knob.xport_specific.fc.valid = KNOB_VALID_ROLE;
3619         ccb->knob.xport_specific.fc.role = KNOB_ROLE_TARGET;
3620         ISP_LOCK(isp);
3621         xpt_action(ccb);
3622         ISP_UNLOCK(isp);
3623
3624         /*
3625          * Okay, while things are still active, sleep...
3626          */
3627         ISP_LOCK(isp);
3628         for (;;) {
3629                 ISP_GET_PC(isp, chan, proc_active, i);
3630                 if (i == 0) {
3631                         break;
3632                 }
3633                 msleep(wchan, &isp->isp_lock, PUSER, "tsnooze", 0);
3634         }
3635         ISP_UNLOCK(isp);
3636
3637 out:
3638         if (wperiph) {
3639                 cam_periph_invalidate(wperiph);
3640         }
3641         if (periph) {
3642                 cam_periph_invalidate(periph);
3643         }
3644         if (junk_data) {
3645                 free(junk_data, M_ISPTARG);
3646         }
3647         if (disk_data) {
3648                 free(disk_data, M_ISPTARG);
3649         }
3650         if (softc) {
3651                 free(softc, M_ISPTARG);
3652         }
3653         xpt_free_path(path);
3654         xpt_free_path(wpath);
3655 }
3656
3657 static void
3658 isp_target_thread_pi(void *arg)
3659 {
3660         struct isp_spi *pi = arg;
3661         isp_target_thread(cam_sim_softc(pi->sim), cam_sim_bus(pi->sim));
3662 }
3663
3664 static void
3665 isp_target_thread_fc(void *arg)
3666 {
3667         struct isp_fc *fc = arg;
3668         isp_target_thread(cam_sim_softc(fc->sim), cam_sim_bus(fc->sim));
3669 }
3670
3671 static int
3672 isptarg_rwparm(uint8_t *cdb, uint8_t *dp, uint64_t dl, uint32_t offset, uint8_t **kp, uint32_t *tl, int *lp)
3673 {
3674         uint32_t cnt, curcnt;
3675         uint64_t lba;
3676
3677         switch (cdb[0]) {
3678         case WRITE_16:
3679         case READ_16:
3680                 cnt =   (((uint32_t)cdb[10]) <<  24) |
3681                         (((uint32_t)cdb[11]) <<  16) |
3682                         (((uint32_t)cdb[12]) <<   8) |
3683                         ((uint32_t)cdb[13]);
3684
3685                 lba =   (((uint64_t)cdb[2]) << 56) |
3686                         (((uint64_t)cdb[3]) << 48) |
3687                         (((uint64_t)cdb[4]) << 40) |
3688                         (((uint64_t)cdb[5]) << 32) |
3689                         (((uint64_t)cdb[6]) << 24) |
3690                         (((uint64_t)cdb[7]) << 16) |
3691                         (((uint64_t)cdb[8]) <<  8) |
3692                         ((uint64_t)cdb[9]);
3693                 break;
3694         case WRITE_12:
3695         case READ_12:
3696                 cnt =   (((uint32_t)cdb[6]) <<  16) |
3697                         (((uint32_t)cdb[7]) <<   8) |
3698                         ((u_int32_t)cdb[8]);
3699
3700                 lba =   (((uint32_t)cdb[2]) << 24) |
3701                         (((uint32_t)cdb[3]) << 16) |
3702                         (((uint32_t)cdb[4]) <<  8) |
3703                         ((uint32_t)cdb[5]);
3704                 break;
3705         case WRITE_10:
3706         case READ_10:
3707                 cnt =   (((uint32_t)cdb[7]) <<  8) |
3708                         ((u_int32_t)cdb[8]);
3709
3710                 lba =   (((uint32_t)cdb[2]) << 24) |
3711                         (((uint32_t)cdb[3]) << 16) |
3712                         (((uint32_t)cdb[4]) <<  8) |
3713                         ((uint32_t)cdb[5]);
3714                 break;
3715         case WRITE_6:
3716         case READ_6:
3717                 cnt = cdb[4];
3718                 if (cnt == 0) {
3719                         cnt = 256;
3720                 }
3721                 lba =   (((uint32_t)cdb[1] & 0x1f) << 16) |
3722                         (((uint32_t)cdb[2]) << 8) |
3723                         ((uint32_t)cdb[3]);
3724                 break;
3725         default:
3726                 return (-1);
3727         }
3728
3729         cnt <<= DISK_SHIFT;
3730         lba <<= DISK_SHIFT;
3731
3732         if (offset == cnt) {
3733                 *lp = 1;
3734                 return (0);
3735         }
3736
3737         if (lba + cnt > dl) {
3738                 return (-1);
3739         }
3740
3741
3742         curcnt = MAX_ISP_TARG_TRANSFER;
3743         if (offset + curcnt >= cnt) {
3744                 curcnt = cnt - offset;
3745                 *lp = 1;
3746         } else {
3747                 *lp = 0;
3748         }
3749         *tl = curcnt;
3750         *kp = &dp[lba + offset];
3751         return (0);
3752 }
3753
3754 #endif
3755 #endif
3756
3757 static void
3758 isp_cam_async(void *cbarg, uint32_t code, struct cam_path *path, void *arg)
3759 {
3760         struct cam_sim *sim;
3761         ispsoftc_t *isp;
3762
3763         sim = (struct cam_sim *)cbarg;
3764         isp = (ispsoftc_t *) cam_sim_softc(sim);
3765         switch (code) {
3766         case AC_LOST_DEVICE:
3767                 if (IS_SCSI(isp)) {
3768                         uint16_t oflags, nflags;
3769                         int bus = cam_sim_bus(sim);
3770                         sdparam *sdp = SDPARAM(isp, bus);
3771                         int tgt;
3772
3773                         tgt = xpt_path_target_id(path);
3774                         if (tgt >= 0) {
3775                                 nflags = sdp->isp_devparam[tgt].nvrm_flags;
3776 #ifndef ISP_TARGET_MODE
3777                                 nflags &= DPARM_SAFE_DFLT;
3778                                 if (isp->isp_loaded_fw) {
3779                                         nflags |= DPARM_NARROW | DPARM_ASYNC;
3780                                 }
3781 #else
3782                                 nflags = DPARM_DEFAULT;
3783 #endif
3784                                 oflags = sdp->isp_devparam[tgt].goal_flags;
3785                                 sdp->isp_devparam[tgt].goal_flags = nflags;
3786                                 sdp->isp_devparam[tgt].dev_update = 1;
3787                                 sdp->update = 1;
3788                                 (void) isp_control(isp, ISPCTL_UPDATE_PARAMS, bus);
3789                                 sdp->isp_devparam[tgt].goal_flags = oflags;
3790                         }
3791                 }
3792                 break;
3793         default:
3794                 isp_prt(isp, ISP_LOGWARN, "isp_cam_async: Code 0x%x", code);
3795                 break;
3796         }
3797 }
3798
3799 static void
3800 isp_poll(struct cam_sim *sim)
3801 {
3802         ispsoftc_t *isp = cam_sim_softc(sim);
3803         uint32_t isr;
3804         uint16_t sema, mbox;
3805
3806         if (ISP_READ_ISR(isp, &isr, &sema, &mbox)) {
3807                 isp_intr(isp, isr, sema, mbox);
3808         }
3809 }
3810
3811
3812 static void
3813 isp_watchdog(void *arg)
3814 {
3815         struct ccb_scsiio *xs = arg;
3816         ispsoftc_t *isp;
3817         uint32_t handle;
3818
3819         isp = XS_ISP(xs);
3820
3821         handle = isp_find_handle(isp, xs);
3822         if (handle) {
3823                 /*
3824                  * Make sure the command is *really* dead before we
3825                  * release the handle (and DMA resources) for reuse.
3826                  */
3827                 (void) isp_control(isp, ISPCTL_ABORT_CMD, xs);
3828
3829                 /*
3830                  * After this point, the comamnd is really dead.
3831                  */
3832                 if (XS_XFRLEN(xs)) {
3833                         ISP_DMAFREE(isp, xs, handle);
3834                 }
3835                 isp_destroy_handle(isp, handle);
3836                 xpt_print(xs->ccb_h.path, "watchdog timeout for handle 0x%x\n", handle);
3837                 XS_SETERR(xs, CAM_CMD_TIMEOUT);
3838                 isp_done(xs);
3839         }
3840 }
3841
3842 static void
3843 isp_make_here(ispsoftc_t *isp, int chan, int tgt)
3844 {
3845         union ccb *ccb;
3846         struct isp_fc *fc = ISP_FC_PC(isp, chan);
3847
3848         if (isp_autoconfig == 0) {
3849                 return;
3850         }
3851
3852         /*
3853          * Allocate a CCB, create a wildcard path for this bus/target and schedule a rescan.
3854          */
3855         ccb = xpt_alloc_ccb_nowait();
3856         if (ccb == NULL) {
3857                 isp_prt(isp, ISP_LOGWARN, "Chan %d unable to alloc CCB for rescan", chan);
3858                 return;
3859         }
3860         if (xpt_create_path(&ccb->ccb_h.path, xpt_periph, cam_sim_path(fc->sim), tgt, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
3861                 isp_prt(isp, ISP_LOGWARN, "unable to create path for rescan");
3862                 xpt_free_ccb(ccb);
3863                 return;
3864         }
3865         xpt_rescan(ccb);
3866 }
3867
3868 static void
3869 isp_make_gone(ispsoftc_t *isp, int chan, int tgt)
3870 {
3871         struct cam_path *tp;
3872         struct isp_fc *fc = ISP_FC_PC(isp, chan);
3873
3874         if (isp_autoconfig == 0) {
3875                 return;
3876         }
3877         if (xpt_create_path(&tp, NULL, cam_sim_path(fc->sim), tgt, CAM_LUN_WILDCARD) == CAM_REQ_CMP) {
3878                 xpt_async(AC_LOST_DEVICE, tp, NULL);
3879                 xpt_free_path(tp);
3880         }
3881 }
3882
3883 /*
3884  * Gone Device Timer Function- when we have decided that a device has gone
3885  * away, we wait a specific period of time prior to telling the OS it has
3886  * gone away.
3887  *
3888  * This timer function fires once a second and then scans the port database
3889  * for devices that are marked dead but still have a virtual target assigned.
3890  * We decrement a counter for that port database entry, and when it hits zero,
3891  * we tell the OS the device has gone away.
3892  */
3893 static void
3894 isp_gdt(void *arg)
3895 {
3896         struct isp_fc *fc = arg;
3897         ispsoftc_t *isp = fc->isp;
3898         int chan = fc - isp->isp_osinfo.pc.fc;
3899         fcportdb_t *lp;
3900         int dbidx, tgt, more_to_do = 0;
3901
3902         isp_prt(isp, ISP_LOGDEBUG0, "Chan %d GDT timer expired", chan);
3903         for (dbidx = 0; dbidx < MAX_FC_TARG; dbidx++) {
3904                 lp = &FCPARAM(isp, chan)->portdb[dbidx];
3905
3906                 if (lp->state != FC_PORTDB_STATE_ZOMBIE) {
3907                         continue;
3908                 }
3909                 if (lp->dev_map_idx == 0 || lp->target_mode) {
3910                         continue;
3911                 }
3912                 if (lp->new_reserved == 0) {
3913                         continue;
3914                 }
3915                 lp->new_reserved -= 1;
3916                 if (lp->new_reserved != 0) {
3917                         more_to_do++;
3918                         continue;
3919                 }
3920                 tgt = lp->dev_map_idx - 1;
3921                 FCPARAM(isp, chan)->isp_dev_map[tgt] = 0;
3922                 lp->dev_map_idx = 0;
3923                 lp->state = FC_PORTDB_STATE_NIL;
3924                 isp_prt(isp, ISP_LOGCONFIG, prom3, chan, lp->portid, tgt, "Gone Device Timeout");
3925                 isp_make_gone(isp, chan, tgt);
3926         }
3927         if (more_to_do) {
3928                 fc->gdt_running = 1;
3929                 callout_reset(&fc->gdt, hz, isp_gdt, fc);
3930         } else {
3931                 isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "Chan %d stopping Gone Device Timer", chan);
3932                 fc->gdt_running = 0;
3933         }
3934 }
3935
3936 /*
3937  * Loop Down Timer Function- when loop goes down, a timer is started and
3938  * and after it expires we come here and take all probational devices that
3939  * the OS knows about and the tell the OS that they've gone away.
3940  *
3941  * We don't clear the devices out of our port database because, when loop
3942  * come back up, we have to do some actual cleanup with the chip at that
3943  * point (implicit PLOGO, e.g., to get the chip's port database state right).
3944  */
3945 static void
3946 isp_ldt(void *arg)
3947 {
3948         struct isp_fc *fc = arg;
3949         ispsoftc_t *isp = fc->isp;
3950         int chan = fc - isp->isp_osinfo.pc.fc;
3951         fcportdb_t *lp;
3952         int dbidx, tgt;
3953
3954         isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "Chan %d Loop Down Timer expired @ %lu", chan, (unsigned long) time_uptime);
3955
3956         /*
3957          * Notify to the OS all targets who we now consider have departed.
3958          */
3959         for (dbidx = 0; dbidx < MAX_FC_TARG; dbidx++) {
3960                 lp = &FCPARAM(isp, chan)->portdb[dbidx];
3961
3962                 if (lp->state != FC_PORTDB_STATE_PROBATIONAL) {
3963                         continue;
3964                 }
3965                 if (lp->dev_map_idx == 0 || lp->target_mode) {
3966                         continue;
3967                 }
3968
3969                 /*
3970                  * XXX: CLEAN UP AND COMPLETE ANY PENDING COMMANDS FIRST!
3971                  */
3972
3973                 /*
3974                  * Mark that we've announced that this device is gone....
3975                  */
3976                 lp->reserved = 1;
3977
3978                 /*
3979                  * but *don't* change the state of the entry. Just clear
3980                  * any target id stuff and announce to CAM that the
3981                  * device is gone. This way any necessary PLOGO stuff
3982                  * will happen when loop comes back up.
3983                  */
3984
3985                 tgt = lp->dev_map_idx - 1;
3986                 FCPARAM(isp, chan)->isp_dev_map[tgt] = 0;
3987                 lp->dev_map_idx = 0;
3988                 lp->state = FC_PORTDB_STATE_NIL;
3989                 isp_prt(isp, ISP_LOGCONFIG, prom3, chan, lp->portid, tgt, "Loop Down Timeout");
3990                 isp_make_gone(isp, chan, tgt);
3991         }
3992
3993         /*
3994          * The loop down timer has expired. Wake up the kthread
3995          * to notice that fact (or make it false).
3996          */
3997         fc->loop_dead = 1;
3998         fc->loop_down_time = fc->loop_down_limit+1;
3999         wakeup(fc);
4000 }
4001
4002 static void
4003 isp_kthread(void *arg)
4004 {
4005         struct isp_fc *fc = arg;
4006         ispsoftc_t *isp = fc->isp;
4007         int chan = fc - isp->isp_osinfo.pc.fc;
4008         int slp = 0;
4009         mtx_lock(&isp->isp_osinfo.lock);
4010
4011         for (;;) {
4012                 int wasfrozen, lb, lim;
4013
4014                 isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "%s: Chan %d checking FC state", __func__, chan);
4015                 lb = isp_fc_runstate(isp, chan, 250000);
4016
4017                 /*
4018                  * Our action is different based upon whether we're supporting
4019                  * Initiator mode or not. If we are, we might freeze the simq
4020                  * when loop is down and set all sorts of different delays to
4021                  * check again.
4022                  *
4023                  * If not, we simply just wait for loop to come up.
4024                  */
4025                 if (lb && (fc->role & ISP_ROLE_INITIATOR)) {
4026                         /*
4027                          * Increment loop down time by the last sleep interval
4028                          */
4029                         fc->loop_down_time += slp;
4030
4031                         if (lb < 0) {
4032                                 isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "%s: Chan %d FC loop not up (down count %d)", __func__, chan, fc->loop_down_time);
4033                         } else {
4034                                 isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "%s: Chan %d FC got to %d (down count %d)", __func__, chan, lb, fc->loop_down_time);
4035                         }
4036
4037                         /*
4038                          * If we've never seen loop up and we've waited longer
4039                          * than quickboot time, or we've seen loop up but we've
4040                          * waited longer than loop_down_limit, give up and go
4041                          * to sleep until loop comes up.
4042                          */
4043                         if (FCPARAM(isp, chan)->loop_seen_once == 0) {
4044                                 lim = isp_quickboot_time;
4045                         } else {
4046                                 lim = fc->loop_down_limit;
4047                         }
4048                         if (fc->loop_down_time >= lim) {
4049                                 isp_freeze_loopdown(isp, chan, "loop limit hit");
4050                                 slp = 0;
4051                         } else if (fc->loop_down_time < 10) {
4052                                 slp = 1;
4053                         } else if (fc->loop_down_time < 30) {
4054                                 slp = 5;
4055                         } else if (fc->loop_down_time < 60) {
4056                                 slp = 10;
4057                         } else if (fc->loop_down_time < 120) {
4058                                 slp = 20;
4059                         } else {
4060                                 slp = 30;
4061                         }
4062
4063                 } else if (lb) {
4064                         isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "%s: Chan %d FC Loop Down", __func__, chan);
4065                         fc->loop_down_time += slp;
4066                         slp = 60;
4067                 } else {
4068                         isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "%s: Chan %d FC state OK", __func__, chan);
4069                         fc->loop_down_time = 0;
4070                         slp = 0;
4071                 }
4072
4073
4074                 /*
4075                  * If this is past the first loop up or the loop is dead and if we'd frozen the simq, unfreeze it
4076                  * now so that CAM can start sending us commands.
4077                  *
4078                  * If the FC state isn't okay yet, they'll hit that in isp_start which will freeze the queue again
4079                  * or kill the commands, as appropriate.
4080                  */
4081
4082                 if (FCPARAM(isp, chan)->loop_seen_once || fc->loop_dead) {
4083                         wasfrozen = fc->simqfrozen & SIMQFRZ_LOOPDOWN;
4084                         fc->simqfrozen &= ~SIMQFRZ_LOOPDOWN;
4085                         if (wasfrozen && fc->simqfrozen == 0) {
4086                                 isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "%s: Chan %d releasing simq", __func__, chan);
4087                                 xpt_release_simq(fc->sim, 1);
4088                         }
4089                 }
4090
4091                 isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "%s: Chan %d sleep time %d", __func__, chan, slp);
4092
4093                 msleep(fc, &isp->isp_osinfo.lock, PRIBIO, "ispf", slp * hz);
4094
4095                 /*
4096                  * If slp is zero, we're waking up for the first time after
4097                  * things have been okay. In this case, we set a deferral state
4098                  * for all commands and delay hysteresis seconds before starting
4099                  * the FC state evaluation. This gives the loop/fabric a chance
4100                  * to settle.
4101                  */
4102                 if (slp == 0 && fc->hysteresis) {
4103                         isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "%s: Chan %d sleep hysteresis ticks %d", __func__, chan, fc->hysteresis * hz);
4104                         (void) msleep(&isp_fabric_hysteresis, &isp->isp_osinfo.lock, PRIBIO, "ispT", (fc->hysteresis * hz));
4105                 }
4106         }
4107         mtx_unlock(&isp->isp_osinfo.lock);
4108 }
4109
4110 static void
4111 isp_action(struct cam_sim *sim, union ccb *ccb)
4112 {
4113         int bus, tgt, ts, error, lim;
4114         ispsoftc_t *isp;
4115         struct ccb_trans_settings *cts;
4116
4117         CAM_DEBUG(ccb->ccb_h.path, CAM_DEBUG_TRACE, ("isp_action\n"));
4118
4119         isp = (ispsoftc_t *)cam_sim_softc(sim);
4120         mtx_assert(&isp->isp_lock, MA_OWNED);
4121
4122         if (isp->isp_state != ISP_RUNSTATE && ccb->ccb_h.func_code == XPT_SCSI_IO) {
4123                 isp_init(isp);
4124                 if (isp->isp_state != ISP_INITSTATE) {
4125                         /*
4126                          * Lie. Say it was a selection timeout.
4127                          */
4128                         ccb->ccb_h.status = CAM_SEL_TIMEOUT | CAM_DEV_QFRZN;
4129                         xpt_freeze_devq(ccb->ccb_h.path, 1);
4130                         xpt_done(ccb);
4131                         return;
4132                 }
4133                 isp->isp_state = ISP_RUNSTATE;
4134         }
4135         isp_prt(isp, ISP_LOGDEBUG2, "isp_action code %x", ccb->ccb_h.func_code);
4136         ISP_PCMD(ccb) = NULL;
4137
4138         switch (ccb->ccb_h.func_code) {
4139         case XPT_SCSI_IO:       /* Execute the requested I/O operation */
4140                 bus = XS_CHANNEL(ccb);
4141                 /*
4142                  * Do a couple of preliminary checks...
4143                  */
4144                 if ((ccb->ccb_h.flags & CAM_CDB_POINTER) != 0) {
4145                         if ((ccb->ccb_h.flags & CAM_CDB_PHYS) != 0) {
4146                                 ccb->ccb_h.status = CAM_REQ_INVALID;
4147                                 xpt_done(ccb);
4148                                 break;
4149                         }
4150                 }
4151 #ifdef  DIAGNOSTIC
4152                 if (ccb->ccb_h.target_id > (ISP_MAX_TARGETS(isp) - 1)) {
4153                         xpt_print(ccb->ccb_h.path, "invalid target\n");
4154                         ccb->ccb_h.status = CAM_PATH_INVALID;
4155                 } else if (ccb->ccb_h.target_lun > (ISP_MAX_LUNS(isp) - 1)) {
4156                         xpt_print(ccb->ccb_h.path, "invalid lun\n");
4157                         ccb->ccb_h.status = CAM_PATH_INVALID;
4158                 }
4159                 if (ccb->ccb_h.status == CAM_PATH_INVALID) {
4160                         xpt_done(ccb);
4161                         break;
4162                 }
4163 #endif
4164                 ccb->csio.scsi_status = SCSI_STATUS_OK;
4165                 if (isp_get_pcmd(isp, ccb)) {
4166                         isp_prt(isp, ISP_LOGWARN, "out of PCMDs");
4167                         cam_freeze_devq(ccb->ccb_h.path);
4168                         cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 250, 0);
4169                         xpt_done(ccb);
4170                         break;
4171                 }
4172                 error = isp_start((XS_T *) ccb);
4173                 switch (error) {
4174                 case CMD_QUEUED:
4175                         XS_CMD_S_CLEAR(ccb);
4176                         ccb->ccb_h.status |= CAM_SIM_QUEUED;
4177                         if (ccb->ccb_h.timeout == CAM_TIME_INFINITY) {
4178                                 break;
4179                         }
4180                         ts = ccb->ccb_h.timeout;
4181                         if (ts == CAM_TIME_DEFAULT) {
4182                                 ts = 60*1000;
4183                         }
4184                         ts = isp_mstohz(ts);
4185                         callout_reset(&PISP_PCMD(ccb)->wdog, ts, isp_watchdog, ccb);
4186                         break;
4187                 case CMD_RQLATER:
4188                         /*
4189                          * We get this result for FC devices if the loop state isn't ready yet
4190                          * or if the device in question has gone zombie on us.
4191                          *
4192                          * If we've never seen Loop UP at all, we requeue this request and wait
4193                          * for the initial loop up delay to expire.
4194                          */
4195                         lim = ISP_FC_PC(isp, bus)->loop_down_limit;
4196                         if (FCPARAM(isp, bus)->loop_seen_once == 0 || ISP_FC_PC(isp, bus)->loop_down_time >= lim) {
4197                                 if (FCPARAM(isp, bus)->loop_seen_once == 0) {
4198                                         isp_prt(isp, ISP_LOGDEBUG0, "%d.%d loop not seen yet @ %lu", XS_TGT(ccb), XS_LUN(ccb), (unsigned long) time_uptime);
4199                                 } else {
4200                                         isp_prt(isp, ISP_LOGDEBUG0, "%d.%d downtime (%d) > lim (%d)", XS_TGT(ccb), XS_LUN(ccb), ISP_FC_PC(isp, bus)->loop_down_time, lim);
4201                                 }
4202                                 ccb->ccb_h.status = CAM_SEL_TIMEOUT|CAM_DEV_QFRZN;
4203                                 xpt_freeze_devq(ccb->ccb_h.path, 1);
4204                                 isp_free_pcmd(isp, ccb);
4205                                 xpt_done(ccb);
4206                                 break;
4207                         }
4208                         isp_prt(isp, ISP_LOGDEBUG0, "%d.%d retry later", XS_TGT(ccb), XS_LUN(ccb));
4209                         cam_freeze_devq(ccb->ccb_h.path);
4210                         cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 1000, 0);
4211                         XS_SETERR(ccb, CAM_REQUEUE_REQ);
4212                         isp_free_pcmd(isp, ccb);
4213                         xpt_done(ccb);
4214                         break;
4215                 case CMD_EAGAIN:
4216                         isp_free_pcmd(isp, ccb);
4217                         cam_freeze_devq(ccb->ccb_h.path);
4218                         cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 100, 0);
4219                         XS_SETERR(ccb, CAM_REQUEUE_REQ);
4220                         xpt_done(ccb);
4221                         break;
4222                 case CMD_COMPLETE:
4223                         isp_done((struct ccb_scsiio *) ccb);
4224                         break;
4225                 default:
4226                         isp_prt(isp, ISP_LOGERR, "What's this? 0x%x at %d in file %s", error, __LINE__, __FILE__);
4227                         XS_SETERR(ccb, CAM_REQ_CMP_ERR);
4228                         isp_free_pcmd(isp, ccb);
4229                         xpt_done(ccb);
4230                 }
4231                 break;
4232
4233 #ifdef  ISP_TARGET_MODE
4234         case XPT_EN_LUN:                /* Enable/Disable LUN as a target */
4235                 if (ccb->cel.enable) {
4236                         isp_enable_lun(isp, ccb);
4237                 } else {
4238                         isp_disable_lun(isp, ccb);
4239                 }
4240                 break;
4241         case XPT_IMMEDIATE_NOTIFY:      /* Add Immediate Notify Resource */
4242         case XPT_ACCEPT_TARGET_IO:      /* Add Accept Target IO Resource */
4243         {
4244                 tstate_t *tptr = get_lun_statep(isp, XS_CHANNEL(ccb), ccb->ccb_h.target_lun);
4245                 if (tptr == NULL) {
4246                         tptr = get_lun_statep(isp, XS_CHANNEL(ccb), CAM_LUN_WILDCARD);
4247                 }
4248                 if (tptr == NULL) {
4249                         const char *str;
4250                         uint32_t tag;
4251
4252                         if (ccb->ccb_h.func_code == XPT_IMMEDIATE_NOTIFY) {
4253                                 str = "XPT_IMMEDIATE_NOTIFY";
4254                                 tag = ccb->cin1.seq_id;
4255                         } else {
4256                                 tag = ccb->atio.tag_id;
4257                                 str = "XPT_ACCEPT_TARGET_IO";
4258                         }
4259                         ISP_PATH_PRT(isp, ISP_LOGWARN, ccb->ccb_h.path, "%s: [0x%x] no state pointer found for %s\n", __func__, tag, str);
4260                         dump_tstates(isp, XS_CHANNEL(ccb));
4261                         ccb->ccb_h.status = CAM_DEV_NOT_THERE;
4262                         break;
4263                 }
4264                 ccb->ccb_h.sim_priv.entries[0].field = 0;
4265                 ccb->ccb_h.sim_priv.entries[1].ptr = isp;
4266                 ccb->ccb_h.flags = 0;
4267
4268                 if (ccb->ccb_h.func_code == XPT_ACCEPT_TARGET_IO) {
4269                         if (ccb->atio.tag_id) {
4270                                 atio_private_data_t *atp = isp_get_atpd(isp, tptr, ccb->atio.tag_id);
4271                                 if (atp) {
4272                                         isp_put_atpd(isp, tptr, atp);
4273                                 }
4274                         }
4275                         tptr->atio_count++;
4276                         SLIST_INSERT_HEAD(&tptr->atios, &ccb->ccb_h, sim_links.sle);
4277                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "Put FREE ATIO (tag id 0x%x), count now %d\n",
4278                             ((struct ccb_accept_tio *)ccb)->tag_id, tptr->atio_count);
4279                 } else if (ccb->ccb_h.func_code == XPT_IMMEDIATE_NOTIFY) {
4280                         if (ccb->cin1.tag_id) {
4281                                 inot_private_data_t *ntp = isp_find_ntpd(isp, tptr, ccb->cin1.tag_id, ccb->cin1.seq_id);
4282                                 if (ntp) {
4283                                         isp_put_ntpd(isp, tptr, ntp);
4284                                 }
4285                         }
4286                         tptr->inot_count++;
4287                         SLIST_INSERT_HEAD(&tptr->inots, &ccb->ccb_h, sim_links.sle);
4288                         ISP_PATH_PRT(isp, ISP_LOGTDEBUG0, ccb->ccb_h.path, "Put FREE INOT, (seq id 0x%x) count now %d\n",
4289                             ((struct ccb_immediate_notify *)ccb)->seq_id, tptr->inot_count);
4290                 }
4291                 rls_lun_statep(isp, tptr);
4292                 ccb->ccb_h.status = CAM_REQ_INPROG;
4293                 break;
4294         }
4295         case XPT_NOTIFY_ACKNOWLEDGE:            /* notify ack */
4296         {
4297                 tstate_t *tptr;
4298                 inot_private_data_t *ntp;
4299
4300                 /*
4301                  * XXX: Because we cannot guarantee that the path information in the notify acknowledge ccb
4302                  * XXX: matches that for the immediate notify, we have to *search* for the notify structure
4303                  */
4304                 /*
4305                  * All the relevant path information is in the associated immediate notify
4306                  */
4307                 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);
4308                 ntp = get_ntp_from_tagdata(isp, ccb->cna2.tag_id, ccb->cna2.seq_id, &tptr);
4309                 if (ntp == NULL) {
4310                         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__,
4311                              ccb->cna2.tag_id, ccb->cna2.seq_id);
4312                         ccb->ccb_h.status = CAM_DEV_NOT_THERE;
4313                         xpt_done(ccb);
4314                         break;
4315                 }
4316                 if (isp_handle_platform_target_notify_ack(isp, &ntp->rd.nt)) {
4317                         rls_lun_statep(isp, tptr);
4318                         cam_freeze_devq(ccb->ccb_h.path);
4319                         cam_release_devq(ccb->ccb_h.path, RELSIM_RELEASE_AFTER_TIMEOUT, 0, 1000, 0);
4320                         XS_SETERR(ccb, CAM_REQUEUE_REQ);
4321                         break;
4322                 }
4323                 isp_put_ntpd(isp, tptr, ntp);
4324                 rls_lun_statep(isp, tptr);
4325                 ccb->ccb_h.status = CAM_REQ_CMP;
4326                 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);
4327                 xpt_done(ccb);
4328                 break;
4329         }
4330         case XPT_CONT_TARGET_IO:
4331                 isp_target_start_ctio(isp, ccb);
4332                 break;
4333 #endif
4334         case XPT_RESET_DEV:             /* BDR the specified SCSI device */
4335
4336                 bus = cam_sim_bus(xpt_path_sim(ccb->ccb_h.path));
4337                 tgt = ccb->ccb_h.target_id;
4338                 tgt |= (bus << 16);
4339
4340                 error = isp_control(isp, ISPCTL_RESET_DEV, bus, tgt);
4341                 if (error) {
4342                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
4343                 } else {
4344                         ccb->ccb_h.status = CAM_REQ_CMP;
4345                 }
4346                 xpt_done(ccb);
4347                 break;
4348         case XPT_ABORT:                 /* Abort the specified CCB */
4349         {
4350                 union ccb *accb = ccb->cab.abort_ccb;
4351                 switch (accb->ccb_h.func_code) {
4352 #ifdef  ISP_TARGET_MODE
4353                 case XPT_ACCEPT_TARGET_IO:
4354                         isp_target_mark_aborted(isp, accb);
4355                         break;
4356 #endif
4357                 case XPT_SCSI_IO:
4358                         error = isp_control(isp, ISPCTL_ABORT_CMD, ccb);
4359                         if (error) {
4360                                 ccb->ccb_h.status = CAM_UA_ABORT;
4361                         } else {
4362                                 ccb->ccb_h.status = CAM_REQ_CMP;
4363                         }
4364                         break;
4365                 default:
4366                         ccb->ccb_h.status = CAM_REQ_INVALID;
4367                         break;
4368                 }
4369                 xpt_done(ccb);
4370                 break;
4371         }
4372 #define IS_CURRENT_SETTINGS(c)  (c->type == CTS_TYPE_CURRENT_SETTINGS)
4373         case XPT_SET_TRAN_SETTINGS:     /* Nexus Settings */
4374                 cts = &ccb->cts;
4375                 if (!IS_CURRENT_SETTINGS(cts)) {
4376                         ccb->ccb_h.status = CAM_REQ_INVALID;
4377                         xpt_done(ccb);
4378                         break;
4379                 }
4380                 tgt = cts->ccb_h.target_id;
4381                 bus = cam_sim_bus(xpt_path_sim(cts->ccb_h.path));
4382                 if (IS_SCSI(isp)) {
4383                         struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
4384                         struct ccb_trans_settings_spi *spi = &cts->xport_specific.spi;
4385                         sdparam *sdp = SDPARAM(isp, bus);
4386                         uint16_t *dptr;
4387
4388                         if (spi->valid == 0 && scsi->valid == 0) {
4389                                 ccb->ccb_h.status = CAM_REQ_CMP;
4390                                 xpt_done(ccb);
4391                                 break;
4392                         }
4393
4394                         /*
4395                          * We always update (internally) from goal_flags
4396                          * so any request to change settings just gets
4397                          * vectored to that location.
4398                          */
4399                         dptr = &sdp->isp_devparam[tgt].goal_flags;
4400
4401                         if ((spi->valid & CTS_SPI_VALID_DISC) != 0) {
4402                                 if ((spi->flags & CTS_SPI_FLAGS_DISC_ENB) != 0)
4403                                         *dptr |= DPARM_DISC;
4404                                 else
4405                                         *dptr &= ~DPARM_DISC;
4406                         }
4407
4408                         if ((scsi->valid & CTS_SCSI_VALID_TQ) != 0) {
4409                                 if ((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0)
4410                                         *dptr |= DPARM_TQING;
4411                                 else
4412                                         *dptr &= ~DPARM_TQING;
4413                         }
4414
4415                         if ((spi->valid & CTS_SPI_VALID_BUS_WIDTH) != 0) {
4416                                 if (spi->bus_width == MSG_EXT_WDTR_BUS_16_BIT)
4417                                         *dptr |= DPARM_WIDE;
4418                                 else
4419                                         *dptr &= ~DPARM_WIDE;
4420                         }
4421
4422                         /*
4423                          * XXX: FIX ME
4424                          */
4425                         if ((spi->valid & CTS_SPI_VALID_SYNC_OFFSET) && (spi->valid & CTS_SPI_VALID_SYNC_RATE) && (spi->sync_period && spi->sync_offset)) {
4426                                 *dptr |= DPARM_SYNC;
4427                                 /*
4428                                  * XXX: CHECK FOR LEGALITY
4429                                  */
4430                                 sdp->isp_devparam[tgt].goal_period = spi->sync_period;
4431                                 sdp->isp_devparam[tgt].goal_offset = spi->sync_offset;
4432                         } else {
4433                                 *dptr &= ~DPARM_SYNC;
4434                         }
4435                         isp_prt(isp, ISP_LOGDEBUG0, "SET (%d.%d.%d) to flags %x off %x per %x", bus, tgt, cts->ccb_h.target_lun, sdp->isp_devparam[tgt].goal_flags,
4436                             sdp->isp_devparam[tgt].goal_offset, sdp->isp_devparam[tgt].goal_period);
4437                         sdp->isp_devparam[tgt].dev_update = 1;
4438                         sdp->update = 1;
4439                 }
4440                 ccb->ccb_h.status = CAM_REQ_CMP;
4441                 xpt_done(ccb);
4442                 break;
4443         case XPT_GET_TRAN_SETTINGS:
4444                 cts = &ccb->cts;
4445                 tgt = cts->ccb_h.target_id;
4446                 bus = cam_sim_bus(xpt_path_sim(cts->ccb_h.path));
4447                 if (IS_FC(isp)) {
4448                         fcparam *fcp = FCPARAM(isp, bus);
4449                         struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
4450                         struct ccb_trans_settings_fc *fc = &cts->xport_specific.fc;
4451
4452                         cts->protocol = PROTO_SCSI;
4453                         cts->protocol_version = SCSI_REV_2;
4454                         cts->transport = XPORT_FC;
4455                         cts->transport_version = 0;
4456
4457                         scsi->valid = CTS_SCSI_VALID_TQ;
4458                         scsi->flags = CTS_SCSI_FLAGS_TAG_ENB;
4459                         fc->valid = CTS_FC_VALID_SPEED;
4460                         fc->bitrate = 100000;
4461                         fc->bitrate *= fcp->isp_gbspeed;
4462                         if (tgt > 0 && tgt < MAX_FC_TARG) {
4463                                 fcportdb_t *lp = &fcp->portdb[tgt];
4464                                 fc->wwnn = lp->node_wwn;
4465                                 fc->wwpn = lp->port_wwn;
4466                                 fc->port = lp->portid;
4467                                 fc->valid |= CTS_FC_VALID_WWNN | CTS_FC_VALID_WWPN | CTS_FC_VALID_PORT;
4468                         }
4469                 } else {
4470                         struct ccb_trans_settings_scsi *scsi = &cts->proto_specific.scsi;
4471                         struct ccb_trans_settings_spi *spi = &cts->xport_specific.spi;
4472                         sdparam *sdp = SDPARAM(isp, bus);
4473                         uint16_t dval, pval, oval;
4474
4475                         if (IS_CURRENT_SETTINGS(cts)) {
4476                                 sdp->isp_devparam[tgt].dev_refresh = 1;
4477                                 sdp->update = 1;
4478                                 (void) isp_control(isp, ISPCTL_UPDATE_PARAMS, bus);
4479                                 dval = sdp->isp_devparam[tgt].actv_flags;
4480                                 oval = sdp->isp_devparam[tgt].actv_offset;
4481                                 pval = sdp->isp_devparam[tgt].actv_period;
4482                         } else {
4483                                 dval = sdp->isp_devparam[tgt].nvrm_flags;
4484                                 oval = sdp->isp_devparam[tgt].nvrm_offset;
4485                                 pval = sdp->isp_devparam[tgt].nvrm_period;
4486                         }
4487
4488                         cts->protocol = PROTO_SCSI;
4489                         cts->protocol_version = SCSI_REV_2;
4490                         cts->transport = XPORT_SPI;
4491                         cts->transport_version = 2;
4492
4493                         spi->valid = 0;
4494                         scsi->valid = 0;
4495                         spi->flags = 0;
4496                         scsi->flags = 0;
4497                         if (dval & DPARM_DISC) {
4498                                 spi->flags |= CTS_SPI_FLAGS_DISC_ENB;
4499                         }
4500                         if ((dval & DPARM_SYNC) && oval && pval) {
4501                                 spi->sync_offset = oval;
4502                                 spi->sync_period = pval;
4503                         } else {
4504                                 spi->sync_offset = 0;
4505                                 spi->sync_period = 0;
4506                         }
4507                         spi->valid |= CTS_SPI_VALID_SYNC_OFFSET;
4508                         spi->valid |= CTS_SPI_VALID_SYNC_RATE;
4509                         spi->valid |= CTS_SPI_VALID_BUS_WIDTH;
4510                         if (dval & DPARM_WIDE) {
4511                                 spi->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
4512                         } else {
4513                                 spi->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
4514                         }
4515                         if (cts->ccb_h.target_lun != CAM_LUN_WILDCARD) {
4516                                 scsi->valid = CTS_SCSI_VALID_TQ;
4517                                 if (dval & DPARM_TQING) {
4518                                         scsi->flags |= CTS_SCSI_FLAGS_TAG_ENB;
4519                                 }
4520                                 spi->valid |= CTS_SPI_VALID_DISC;
4521                         }
4522                         isp_prt(isp, ISP_LOGDEBUG0, "GET %s (%d.%d.%d) to flags %x off %x per %x", IS_CURRENT_SETTINGS(cts)? "ACTIVE" : "NVRAM",
4523                             bus, tgt, cts->ccb_h.target_lun, dval, oval, pval);
4524                 }
4525                 ccb->ccb_h.status = CAM_REQ_CMP;
4526                 xpt_done(ccb);
4527                 break;
4528
4529         case XPT_CALC_GEOMETRY:
4530                 cam_calc_geometry(&ccb->ccg, 1);
4531                 xpt_done(ccb);
4532                 break;
4533
4534         case XPT_RESET_BUS:             /* Reset the specified bus */
4535                 bus = cam_sim_bus(sim);
4536                 error = isp_control(isp, ISPCTL_RESET_BUS, bus);
4537                 if (error) {
4538                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
4539                         xpt_done(ccb);
4540                         break;
4541                 }
4542                 if (bootverbose) {
4543                         xpt_print(ccb->ccb_h.path, "reset bus on channel %d\n", bus);
4544                 }
4545                 if (IS_FC(isp)) {
4546                         xpt_async(AC_BUS_RESET, ISP_FC_PC(isp, bus)->path, 0);
4547                 } else {
4548                         xpt_async(AC_BUS_RESET, ISP_SPI_PC(isp, bus)->path, 0);
4549                 }
4550                 ccb->ccb_h.status = CAM_REQ_CMP;
4551                 xpt_done(ccb);
4552                 break;
4553
4554         case XPT_TERM_IO:               /* Terminate the I/O process */
4555                 ccb->ccb_h.status = CAM_REQ_INVALID;
4556                 xpt_done(ccb);
4557                 break;
4558
4559         case XPT_SET_SIM_KNOB:          /* Set SIM knobs */
4560         {
4561                 struct ccb_sim_knob *kp = &ccb->knob;
4562                 fcparam *fcp;
4563
4564
4565                 if (!IS_FC(isp)) {
4566                         ccb->ccb_h.status = CAM_REQ_INVALID;
4567                         xpt_done(ccb);
4568                         break;
4569                 }
4570
4571                 bus = cam_sim_bus(xpt_path_sim(kp->ccb_h.path));
4572                 fcp = FCPARAM(isp, bus);
4573
4574                 if (kp->xport_specific.fc.valid & KNOB_VALID_ADDRESS) {
4575                         fcp->isp_wwnn = ISP_FC_PC(isp, bus)->def_wwnn = kp->xport_specific.fc.wwnn;
4576                         fcp->isp_wwpn = ISP_FC_PC(isp, bus)->def_wwpn = kp->xport_specific.fc.wwpn;
4577 isp_prt(isp, ISP_LOGALL, "Setting Channel %d wwns to 0x%jx 0x%jx", bus, fcp->isp_wwnn, fcp->isp_wwpn);
4578                 }
4579                 ccb->ccb_h.status = CAM_REQ_CMP;
4580                 if (kp->xport_specific.fc.valid & KNOB_VALID_ROLE) {
4581                         int rchange = 0;
4582                         int newrole = 0;
4583
4584                         switch (kp->xport_specific.fc.role) {
4585                         case KNOB_ROLE_NONE:
4586                                 if (fcp->role != ISP_ROLE_NONE) {
4587                                         rchange = 1;
4588                                         newrole = ISP_ROLE_NONE;
4589                                 }
4590                                 break;
4591                         case KNOB_ROLE_TARGET:
4592                                 if (fcp->role != ISP_ROLE_TARGET) {
4593                                         rchange = 1;
4594                                         newrole = ISP_ROLE_TARGET;
4595                                 }
4596                                 break;
4597                         case KNOB_ROLE_INITIATOR:
4598                                 if (fcp->role != ISP_ROLE_INITIATOR) {
4599                                         rchange = 1;
4600                                         newrole = ISP_ROLE_INITIATOR;
4601                                 }
4602                                 break;
4603                         case KNOB_ROLE_BOTH:
4604                                 if (fcp->role != ISP_ROLE_BOTH) {
4605                                         rchange = 1;
4606                                         newrole = ISP_ROLE_BOTH;
4607                                 }
4608                                 break;
4609                         }
4610                         if (rchange) {
4611                                 if (isp_fc_change_role(isp, bus, newrole) != 0) {
4612                                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
4613 #ifdef  ISP_TARGET_MODE
4614                                 } else if (newrole == ISP_ROLE_TARGET || newrole == ISP_ROLE_BOTH) {
4615                                         isp_enable_deferred_luns(isp, bus);
4616 #endif
4617                                 }
4618                         }
4619                 }
4620                 xpt_done(ccb);
4621                 break;
4622         }
4623         case XPT_GET_SIM_KNOB:          /* Set SIM knobs */
4624         {
4625                 struct ccb_sim_knob *kp = &ccb->knob;
4626
4627                 if (IS_FC(isp)) {
4628                         fcparam *fcp;
4629
4630                         bus = cam_sim_bus(xpt_path_sim(kp->ccb_h.path));
4631                         fcp = FCPARAM(isp, bus);
4632
4633                         kp->xport_specific.fc.wwnn = fcp->isp_wwnn;
4634                         kp->xport_specific.fc.wwpn = fcp->isp_wwpn;
4635                         switch (fcp->role) {
4636                         case ISP_ROLE_NONE:
4637                                 kp->xport_specific.fc.role = KNOB_ROLE_NONE;
4638                                 break;
4639                         case ISP_ROLE_TARGET:
4640                                 kp->xport_specific.fc.role = KNOB_ROLE_TARGET;
4641                                 break;
4642                         case ISP_ROLE_INITIATOR:
4643                                 kp->xport_specific.fc.role = KNOB_ROLE_INITIATOR;
4644                                 break;
4645                         case ISP_ROLE_BOTH:
4646                                 kp->xport_specific.fc.role = KNOB_ROLE_BOTH;
4647                                 break;
4648                         }
4649                         kp->xport_specific.fc.valid = KNOB_VALID_ADDRESS | KNOB_VALID_ROLE;
4650                         ccb->ccb_h.status = CAM_REQ_CMP;
4651                 } else {
4652                         ccb->ccb_h.status = CAM_REQ_INVALID;
4653                 }
4654                 xpt_done(ccb);
4655                 break;
4656         }
4657         case XPT_PATH_INQ:              /* Path routing inquiry */
4658         {
4659                 struct ccb_pathinq *cpi = &ccb->cpi;
4660
4661                 cpi->version_num = 1;
4662 #ifdef  ISP_TARGET_MODE
4663                 cpi->target_sprt = PIT_PROCESSOR | PIT_DISCONNECT | PIT_TERM_IO;
4664 #else
4665                 cpi->target_sprt = 0;
4666 #endif
4667                 cpi->hba_eng_cnt = 0;
4668                 cpi->max_target = ISP_MAX_TARGETS(isp) - 1;
4669                 cpi->max_lun = ISP_MAX_LUNS(isp) - 1;
4670                 cpi->bus_id = cam_sim_bus(sim);
4671                 bus = cam_sim_bus(xpt_path_sim(cpi->ccb_h.path));
4672                 if (IS_FC(isp)) {
4673                         fcparam *fcp = FCPARAM(isp, bus);
4674
4675                         cpi->hba_misc = PIM_NOBUSRESET;
4676
4677                         /*
4678                          * Because our loop ID can shift from time to time,
4679                          * make our initiator ID out of range of our bus.
4680                          */
4681                         cpi->initiator_id = cpi->max_target + 1;
4682
4683                         /*
4684                          * Set base transfer capabilities for Fibre Channel, for this HBA.
4685                          */
4686                         if (IS_24XX(isp)) {
4687                                 cpi->base_transfer_speed = 4000000;
4688                         } else if (IS_23XX(isp)) {
4689                                 cpi->base_transfer_speed = 2000000;
4690                         } else {
4691                                 cpi->base_transfer_speed = 1000000;
4692                         }
4693                         cpi->hba_inquiry = PI_TAG_ABLE;
4694                         cpi->transport = XPORT_FC;
4695                         cpi->transport_version = 0;
4696                         cpi->xport_specific.fc.wwnn = fcp->isp_wwnn;
4697                         cpi->xport_specific.fc.wwpn = fcp->isp_wwpn;
4698                         cpi->xport_specific.fc.port = fcp->isp_portid;
4699                         cpi->xport_specific.fc.bitrate = fcp->isp_gbspeed * 1000;
4700                 } else {
4701                         sdparam *sdp = SDPARAM(isp, bus);
4702                         cpi->hba_inquiry = PI_SDTR_ABLE|PI_TAG_ABLE|PI_WIDE_16;
4703                         cpi->hba_misc = 0;
4704                         cpi->initiator_id = sdp->isp_initiator_id;
4705                         cpi->base_transfer_speed = 3300;
4706                         cpi->transport = XPORT_SPI;
4707                         cpi->transport_version = 2;
4708                 }
4709                 cpi->protocol = PROTO_SCSI;
4710                 cpi->protocol_version = SCSI_REV_2;
4711                 strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
4712                 strncpy(cpi->hba_vid, "Qlogic", HBA_IDLEN);
4713                 strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
4714                 cpi->unit_number = cam_sim_unit(sim);
4715                 cpi->ccb_h.status = CAM_REQ_CMP;
4716                 xpt_done(ccb);
4717                 break;
4718         }
4719         default:
4720                 ccb->ccb_h.status = CAM_REQ_INVALID;
4721                 xpt_done(ccb);
4722                 break;
4723         }
4724 }
4725
4726 #define ISPDDB  (CAM_DEBUG_INFO|CAM_DEBUG_TRACE|CAM_DEBUG_CDB)
4727
4728 void
4729 isp_done(XS_T *sccb)
4730 {
4731         ispsoftc_t *isp = XS_ISP(sccb);
4732
4733         if (XS_NOERR(sccb))
4734                 XS_SETERR(sccb, CAM_REQ_CMP);
4735
4736         if ((sccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP && (sccb->scsi_status != SCSI_STATUS_OK)) {
4737                 sccb->ccb_h.status &= ~CAM_STATUS_MASK;
4738                 if ((sccb->scsi_status == SCSI_STATUS_CHECK_COND) && (sccb->ccb_h.status & CAM_AUTOSNS_VALID) == 0) {
4739                         sccb->ccb_h.status |= CAM_AUTOSENSE_FAIL;
4740                 } else {
4741                         sccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR;
4742                 }
4743         }
4744
4745         sccb->ccb_h.status &= ~CAM_SIM_QUEUED;
4746         if ((sccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
4747                 isp_prt(isp, ISP_LOGDEBUG0, "target %d lun %d CAM status 0x%x SCSI status 0x%x", XS_TGT(sccb), XS_LUN(sccb), sccb->ccb_h.status, sccb->scsi_status);
4748                 if ((sccb->ccb_h.status & CAM_DEV_QFRZN) == 0) {
4749                         sccb->ccb_h.status |= CAM_DEV_QFRZN;
4750                         xpt_freeze_devq(sccb->ccb_h.path, 1);
4751                 }
4752         }
4753
4754         if ((CAM_DEBUGGED(sccb->ccb_h.path, ISPDDB)) && (sccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
4755                 xpt_print(sccb->ccb_h.path, "cam completion status 0x%x\n", sccb->ccb_h.status);
4756         }
4757
4758         XS_CMD_S_DONE(sccb);
4759         callout_stop(&PISP_PCMD(sccb)->wdog);
4760         XS_CMD_S_CLEAR(sccb);
4761         isp_free_pcmd(isp, (union ccb *) sccb);
4762         xpt_done((union ccb *) sccb);
4763 }
4764
4765 void
4766 isp_async(ispsoftc_t *isp, ispasync_t cmd, ...)
4767 {
4768         int bus;
4769         static const char prom[] = "Chan %d PortID 0x%06x handle 0x%x role %s %s WWPN 0x%08x%08x";
4770         static const char prom2[] = "Chan %d PortID 0x%06x handle 0x%x role %s %s tgt %u WWPN 0x%08x%08x";
4771         char *msg = NULL;
4772         target_id_t tgt;
4773         fcportdb_t *lp;
4774         struct cam_path *tmppath;
4775         va_list ap;
4776
4777         switch (cmd) {
4778         case ISPASYNC_NEW_TGT_PARAMS:
4779         {
4780                 struct ccb_trans_settings_scsi *scsi;
4781                 struct ccb_trans_settings_spi *spi;
4782                 int flags, tgt;
4783                 sdparam *sdp;
4784                 struct ccb_trans_settings cts;
4785
4786                 memset(&cts, 0, sizeof (struct ccb_trans_settings));
4787
4788                 va_start(ap, cmd);
4789                 bus = va_arg(ap, int);
4790                 tgt = va_arg(ap, int);
4791                 va_end(ap);
4792                 sdp = SDPARAM(isp, bus);
4793
4794                 if (xpt_create_path(&tmppath, NULL, cam_sim_path(ISP_SPI_PC(isp, bus)->sim), tgt, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
4795                         isp_prt(isp, ISP_LOGWARN, "isp_async cannot make temp path for %d.%d", tgt, bus);
4796                         break;
4797                 }
4798                 flags = sdp->isp_devparam[tgt].actv_flags;
4799                 cts.type = CTS_TYPE_CURRENT_SETTINGS;
4800                 cts.protocol = PROTO_SCSI;
4801                 cts.transport = XPORT_SPI;
4802
4803                 scsi = &cts.proto_specific.scsi;
4804                 spi = &cts.xport_specific.spi;
4805
4806                 if (flags & DPARM_TQING) {
4807                         scsi->valid |= CTS_SCSI_VALID_TQ;
4808                         scsi->flags |= CTS_SCSI_FLAGS_TAG_ENB;
4809                 }
4810
4811                 if (flags & DPARM_DISC) {
4812                         spi->valid |= CTS_SPI_VALID_DISC;
4813                         spi->flags |= CTS_SPI_FLAGS_DISC_ENB;
4814                 }
4815                 spi->flags |= CTS_SPI_VALID_BUS_WIDTH;
4816                 if (flags & DPARM_WIDE) {
4817                         spi->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
4818                 } else {
4819                         spi->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
4820                 }
4821                 if (flags & DPARM_SYNC) {
4822                         spi->valid |= CTS_SPI_VALID_SYNC_RATE;
4823                         spi->valid |= CTS_SPI_VALID_SYNC_OFFSET;
4824                         spi->sync_period = sdp->isp_devparam[tgt].actv_period;
4825                         spi->sync_offset = sdp->isp_devparam[tgt].actv_offset;
4826                 }
4827                 isp_prt(isp, ISP_LOGDEBUG2, "NEW_TGT_PARAMS bus %d tgt %d period %x offset %x flags %x", bus, tgt, sdp->isp_devparam[tgt].actv_period, sdp->isp_devparam[tgt].actv_offset, flags);
4828                 xpt_setup_ccb(&cts.ccb_h, tmppath, 1);
4829                 xpt_async(AC_TRANSFER_NEG, tmppath, &cts);
4830                 xpt_free_path(tmppath);
4831                 break;
4832         }
4833         case ISPASYNC_BUS_RESET:
4834         {
4835                 va_start(ap, cmd);
4836                 bus = va_arg(ap, int);
4837                 va_end(ap);
4838                 isp_prt(isp, ISP_LOGINFO, "SCSI bus reset on bus %d detected", bus);
4839                 if (IS_FC(isp)) {
4840                         xpt_async(AC_BUS_RESET, ISP_FC_PC(isp, bus)->path, NULL);
4841                 } else {
4842                         xpt_async(AC_BUS_RESET, ISP_SPI_PC(isp, bus)->path, NULL);
4843                 }
4844                 break;
4845         }
4846         case ISPASYNC_LIP:
4847                 if (msg == NULL) {
4848                         msg = "LIP Received";
4849                 }
4850                 /* FALLTHROUGH */
4851         case ISPASYNC_LOOP_RESET:
4852                 if (msg == NULL) {
4853                         msg = "LOOP Reset";
4854                 }
4855                 /* FALLTHROUGH */
4856         case ISPASYNC_LOOP_DOWN:
4857         {
4858                 struct isp_fc *fc;
4859                 if (msg == NULL) {
4860                         msg = "LOOP Down";
4861                 }
4862                 va_start(ap, cmd);
4863                 bus = va_arg(ap, int);
4864                 va_end(ap);
4865
4866                 FCPARAM(isp, bus)->link_active = 1;
4867
4868                 fc = ISP_FC_PC(isp, bus);
4869                 /*
4870                  * We don't do any simq freezing if we are only in target mode
4871                  */
4872                 if (fc->role & ISP_ROLE_INITIATOR) {
4873                         if (fc->path) {
4874                                 isp_freeze_loopdown(isp, bus, msg);
4875                         }
4876                         if (fc->ldt_running == 0) {
4877                                 fc->ldt_running = 1;
4878                                 callout_reset(&fc->ldt, fc->loop_down_limit * hz, isp_ldt, fc);
4879                                 isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "starting Loop Down Timer @ %lu", (unsigned long) time_uptime);
4880                         }
4881                 }
4882                 isp_prt(isp, ISP_LOGINFO, "Chan %d: %s", bus, msg);
4883                 break;
4884         }
4885         case ISPASYNC_LOOP_UP:
4886                 va_start(ap, cmd);
4887                 bus = va_arg(ap, int);
4888                 va_end(ap);
4889                 /*
4890                  * Now we just note that Loop has come up. We don't
4891                  * actually do anything because we're waiting for a
4892                  * Change Notify before activating the FC cleanup
4893                  * thread to look at the state of the loop again.
4894                  */
4895                 FCPARAM(isp, bus)->link_active = 1;
4896                 ISP_FC_PC(isp, bus)->loop_dead = 0;
4897                 ISP_FC_PC(isp, bus)->loop_down_time = 0;
4898                 isp_prt(isp, ISP_LOGINFO, "Chan %d Loop UP", bus);
4899                 break;
4900         case ISPASYNC_DEV_ARRIVED:
4901                 va_start(ap, cmd);
4902                 bus = va_arg(ap, int);
4903                 lp = va_arg(ap, fcportdb_t *);
4904                 va_end(ap);
4905                 lp->reserved = 0;
4906                 if ((ISP_FC_PC(isp, bus)->role & ISP_ROLE_INITIATOR) && (lp->roles & (SVC3_TGT_ROLE >> SVC3_ROLE_SHIFT))) {
4907                         int dbidx = lp - FCPARAM(isp, bus)->portdb;
4908                         int i;
4909
4910                         for (i = 0; i < MAX_FC_TARG; i++) {
4911                                 if (i >= FL_ID && i <= SNS_ID) {
4912                                         continue;
4913                                 }
4914                                 if (FCPARAM(isp, bus)->isp_dev_map[i] == 0) {
4915                                         break;
4916                                 }
4917                         }
4918                         if (i < MAX_FC_TARG) {
4919                                 FCPARAM(isp, bus)->isp_dev_map[i] = dbidx + 1;
4920                                 lp->dev_map_idx = i + 1;
4921                         } else {
4922                                 isp_prt(isp, ISP_LOGWARN, "out of target ids");
4923                                 isp_dump_portdb(isp, bus);
4924                         }
4925                 }
4926                 if (lp->dev_map_idx) {
4927                         tgt = lp->dev_map_idx - 1;
4928                         isp_prt(isp, ISP_LOGCONFIG, prom2, bus, lp->portid, lp->handle, roles[lp->roles], "arrived at", tgt, (uint32_t) (lp->port_wwn >> 32), (uint32_t) lp->port_wwn);
4929                         isp_make_here(isp, bus, tgt);
4930                 } else {
4931                         isp_prt(isp, ISP_LOGCONFIG, prom, bus, lp->portid, lp->handle, roles[lp->roles], "arrived", (uint32_t) (lp->port_wwn >> 32), (uint32_t) lp->port_wwn);
4932                 }
4933                 break;
4934         case ISPASYNC_DEV_CHANGED:
4935                 va_start(ap, cmd);
4936                 bus = va_arg(ap, int);
4937                 lp = va_arg(ap, fcportdb_t *);
4938                 va_end(ap);
4939                 lp->reserved = 0;
4940                 if (isp_change_is_bad) {
4941                         lp->state = FC_PORTDB_STATE_NIL;
4942                         if (lp->dev_map_idx) {
4943                                 tgt = lp->dev_map_idx - 1;
4944                                 FCPARAM(isp, bus)->isp_dev_map[tgt] = 0;
4945                                 lp->dev_map_idx = 0;
4946                                 isp_prt(isp, ISP_LOGCONFIG, prom3, bus, lp->portid, tgt, "change is bad");
4947                                 isp_make_gone(isp, bus, tgt);
4948                         } else {
4949                                 isp_prt(isp, ISP_LOGCONFIG, prom, bus, lp->portid, lp->handle, roles[lp->roles], "changed and departed",
4950                                     (uint32_t) (lp->port_wwn >> 32), (uint32_t) lp->port_wwn);
4951                         }
4952                 } else {
4953                         lp->portid = lp->new_portid;
4954                         lp->roles = lp->new_roles;
4955                         if (lp->dev_map_idx) {
4956                                 int t = lp->dev_map_idx - 1;
4957                                 FCPARAM(isp, bus)->isp_dev_map[t] = (lp - FCPARAM(isp, bus)->portdb) + 1;
4958                                 tgt = lp->dev_map_idx - 1;
4959                                 isp_prt(isp, ISP_LOGCONFIG, prom2, bus, lp->portid, lp->handle, roles[lp->roles], "changed at", tgt,
4960                                     (uint32_t) (lp->port_wwn >> 32), (uint32_t) lp->port_wwn);
4961                         } else {
4962                                 isp_prt(isp, ISP_LOGCONFIG, prom, bus, lp->portid, lp->handle, roles[lp->roles], "changed", (uint32_t) (lp->port_wwn >> 32), (uint32_t) lp->port_wwn);
4963                         }
4964                 }
4965                 break;
4966         case ISPASYNC_DEV_STAYED:
4967                 va_start(ap, cmd);
4968                 bus = va_arg(ap, int);
4969                 lp = va_arg(ap, fcportdb_t *);
4970                 va_end(ap);
4971                 if (lp->dev_map_idx) {
4972                         tgt = lp->dev_map_idx - 1;
4973                         isp_prt(isp, ISP_LOGCONFIG, prom2, bus, lp->portid, lp->handle, roles[lp->roles], "stayed at", tgt,
4974                             (uint32_t) (lp->port_wwn >> 32), (uint32_t) lp->port_wwn);
4975                 } else {
4976                         isp_prt(isp, ISP_LOGCONFIG, prom, bus, lp->portid, lp->handle, roles[lp->roles], "stayed",
4977                             (uint32_t) (lp->port_wwn >> 32), (uint32_t) lp->port_wwn);
4978                 }
4979                 break;
4980         case ISPASYNC_DEV_GONE:
4981                 va_start(ap, cmd);
4982                 bus = va_arg(ap, int);
4983                 lp = va_arg(ap, fcportdb_t *);
4984                 va_end(ap);
4985                 /*
4986                  * If this has a virtual target and we haven't marked it
4987                  * that we're going to have isp_gdt tell the OS it's gone,
4988                  * set the isp_gdt timer running on it.
4989                  *
4990                  * If it isn't marked that isp_gdt is going to get rid of it,
4991                  * announce that it's gone.
4992                  */
4993                 if (lp->dev_map_idx && lp->reserved == 0) {
4994                         lp->reserved = 1;
4995                         lp->new_reserved = ISP_FC_PC(isp, bus)->gone_device_time;
4996                         lp->state = FC_PORTDB_STATE_ZOMBIE;
4997                         if (ISP_FC_PC(isp, bus)->gdt_running == 0) {
4998                                 isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "Chan %d starting Gone Device Timer", bus);
4999                                 ISP_FC_PC(isp, bus)->gdt_running = 1;
5000                                 callout_reset(&ISP_FC_PC(isp, bus)->gdt, hz, isp_gdt, ISP_FC_PC(isp, bus));
5001                         }
5002                         tgt = lp->dev_map_idx - 1;
5003                         isp_prt(isp, ISP_LOGCONFIG, prom2, bus, lp->portid, lp->handle, roles[lp->roles], "gone zombie at", tgt, (uint32_t) (lp->port_wwn >> 32), (uint32_t) lp->port_wwn);
5004                 } else if (lp->reserved == 0) {
5005                         isp_prt(isp, ISP_LOGCONFIG, prom, bus, lp->portid, lp->handle, roles[lp->roles], "departed", (uint32_t) (lp->port_wwn >> 32), (uint32_t) lp->port_wwn);
5006                 }
5007                 break;
5008         case ISPASYNC_CHANGE_NOTIFY:
5009         {
5010                 char *msg;
5011                 int evt, nphdl, nlstate, reason;
5012
5013                 va_start(ap, cmd);
5014                 bus = va_arg(ap, int);
5015                 evt = va_arg(ap, int);
5016                 if (IS_24XX(isp) && evt == ISPASYNC_CHANGE_PDB) {
5017                         nphdl = va_arg(ap, int);
5018                         nlstate = va_arg(ap, int);
5019                         reason = va_arg(ap, int);
5020                 } else {
5021                         nphdl = NIL_HANDLE;
5022                         nlstate = reason = 0;
5023                 }
5024                 va_end(ap);
5025
5026                 if (evt == ISPASYNC_CHANGE_PDB) {
5027                         msg = "Chan %d Port Database Changed";
5028                 } else if (evt == ISPASYNC_CHANGE_SNS) {
5029                         msg = "Chan %d Name Server Database Changed";
5030                 } else {
5031                         msg = "Chan %d Other Change Notify";
5032                 }
5033
5034                 /*
5035                  * If the loop down timer is running, cancel it.
5036                  */
5037                 if (ISP_FC_PC(isp, bus)->ldt_running) {
5038                         isp_prt(isp, ISP_LOGSANCFG|ISP_LOGDEBUG0, "Stopping Loop Down Timer @ %lu", (unsigned long) time_uptime);
5039                         ISP_FC_PC(isp, bus)->ldt_running = 0;
5040                         callout_stop(&ISP_FC_PC(isp, bus)->ldt);
5041                 }
5042                 isp_prt(isp, ISP_LOGINFO, msg, bus);
5043                 if (ISP_FC_PC(isp, bus)->role & ISP_ROLE_INITIATOR) {
5044                         isp_freeze_loopdown(isp, bus, msg);
5045                 }
5046                 wakeup(ISP_FC_PC(isp, bus));
5047                 break;
5048         }
5049 #ifdef  ISP_TARGET_MODE
5050         case ISPASYNC_TARGET_NOTIFY:
5051         {
5052                 isp_notify_t *notify;
5053                 va_start(ap, cmd);
5054                 notify = va_arg(ap, isp_notify_t *);
5055                 va_end(ap);
5056                 switch (notify->nt_ncode) {
5057                 case NT_ABORT_TASK:
5058                 case NT_ABORT_TASK_SET:
5059                 case NT_CLEAR_ACA:
5060                 case NT_CLEAR_TASK_SET:
5061                 case NT_LUN_RESET:
5062                 case NT_TARGET_RESET:
5063                         /*
5064                          * These are task management functions.
5065                          */
5066                         isp_handle_platform_target_tmf(isp, notify);
5067                         break;
5068                 case NT_BUS_RESET:
5069                 case NT_LIP_RESET:
5070                 case NT_LINK_UP:
5071                 case NT_LINK_DOWN:
5072                         /*
5073                          * No action need be taken here.
5074                          */
5075                         break;
5076                 case NT_HBA_RESET:
5077                         isp_del_all_wwn_entries(isp, ISP_NOCHAN);
5078                         break;
5079                 case NT_LOGOUT:
5080                         /*
5081                          * This is device arrival/departure notification
5082                          */
5083                         isp_handle_platform_target_notify_ack(isp, notify);
5084                         break;
5085                 case NT_ARRIVED:
5086                 {
5087                         struct ac_contract ac;
5088                         struct ac_device_changed *fc;
5089
5090                         ac.contract_number = AC_CONTRACT_DEV_CHG;
5091                         fc = (struct ac_device_changed *) ac.contract_data;
5092                         fc->wwpn = notify->nt_wwn;
5093                         fc->port = notify->nt_sid;
5094                         fc->target = notify->nt_nphdl;
5095                         fc->arrived = 1;
5096                         xpt_async(AC_CONTRACT, ISP_FC_PC(isp, notify->nt_channel)->path, &ac);
5097                         break;
5098                 }
5099                 case NT_DEPARTED:
5100                 {
5101                         struct ac_contract ac;
5102                         struct ac_device_changed *fc;
5103
5104                         ac.contract_number = AC_CONTRACT_DEV_CHG;
5105                         fc = (struct ac_device_changed *) ac.contract_data;
5106                         fc->wwpn = notify->nt_wwn;
5107                         fc->port = notify->nt_sid;
5108                         fc->target = notify->nt_nphdl;
5109                         fc->arrived = 0;
5110                         xpt_async(AC_CONTRACT, ISP_FC_PC(isp, notify->nt_channel)->path, &ac);
5111                         break;
5112                 }
5113                 default:
5114                         isp_prt(isp, ISP_LOGALL, "target notify code 0x%x", notify->nt_ncode);
5115                         isp_handle_platform_target_notify_ack(isp, notify);
5116                         break;
5117                 }
5118                 break;
5119         }
5120         case ISPASYNC_TARGET_ACTION:
5121         {
5122                 isphdr_t *hp;
5123
5124                 va_start(ap, cmd);
5125                 hp = va_arg(ap, isphdr_t *);
5126                 va_end(ap);
5127                 switch (hp->rqs_entry_type) {
5128                 default:
5129                         isp_prt(isp, ISP_LOGWARN, "%s: unhandled target action 0x%x", __func__, hp->rqs_entry_type);
5130                         break;
5131                 case RQSTYPE_NOTIFY:
5132                         if (IS_SCSI(isp)) {
5133                                 isp_handle_platform_notify_scsi(isp, (in_entry_t *) hp);
5134                         } else if (IS_24XX(isp)) {
5135                                 isp_handle_platform_notify_24xx(isp, (in_fcentry_24xx_t *) hp);
5136                         } else {
5137                                 isp_handle_platform_notify_fc(isp, (in_fcentry_t *) hp);
5138                         }
5139                         break;
5140                 case RQSTYPE_ATIO:
5141                         if (IS_24XX(isp)) {
5142                                 isp_handle_platform_atio7(isp, (at7_entry_t *) hp);
5143                         } else {
5144                                 isp_handle_platform_atio(isp, (at_entry_t *) hp);
5145                         }
5146                         break;
5147                 case RQSTYPE_ATIO2:
5148                         isp_handle_platform_atio2(isp, (at2_entry_t *) hp);
5149                         break;
5150                 case RQSTYPE_CTIO7:
5151                 case RQSTYPE_CTIO3:
5152                 case RQSTYPE_CTIO2:
5153                 case RQSTYPE_CTIO:
5154                         isp_handle_platform_ctio(isp, hp);
5155                         break;
5156                 case RQSTYPE_ABTS_RCVD:
5157                 {
5158                         abts_t *abts = (abts_t *)hp;
5159                         isp_notify_t notify, *nt = &notify;
5160                         tstate_t *tptr;
5161                         fcportdb_t *lp;
5162                         uint16_t chan;
5163                         uint32_t sid, did;
5164
5165                         did = (abts->abts_did_hi << 16) | abts->abts_did_lo;
5166                         sid = (abts->abts_sid_hi << 16) | abts->abts_sid_lo;
5167                         ISP_MEMZERO(nt, sizeof (isp_notify_t));
5168
5169                         nt->nt_hba = isp;
5170                         nt->nt_did = did;
5171                         nt->nt_nphdl = abts->abts_nphdl;
5172                         nt->nt_sid = sid;
5173                         isp_find_chan_by_did(isp, did, &chan);
5174                         if (chan == ISP_NOCHAN) {
5175                                 nt->nt_tgt = TGT_ANY;
5176                         } else {
5177                                 nt->nt_tgt = FCPARAM(isp, chan)->isp_wwpn;
5178                                 if (isp_find_pdb_by_loopid(isp, chan, abts->abts_nphdl, &lp)) {
5179                                         nt->nt_wwn = lp->port_wwn;
5180                                 } else {
5181                                         nt->nt_wwn = INI_ANY;
5182                                 }
5183                         }
5184                         /*
5185                          * Try hard to find the lun for this command.
5186                          */
5187                         tptr = get_lun_statep_from_tag(isp, chan, abts->abts_rxid_task);
5188                         if (tptr) {
5189                                 nt->nt_lun = xpt_path_lun_id(tptr->owner);
5190                                 rls_lun_statep(isp, tptr);
5191                         } else {
5192                                 nt->nt_lun = LUN_ANY;
5193                         }
5194                         nt->nt_need_ack = 1;
5195                         nt->nt_tagval = abts->abts_rxid_task;
5196                         nt->nt_tagval |= (((uint64_t) abts->abts_rxid_abts) << 32);
5197                         if (abts->abts_rxid_task == ISP24XX_NO_TASK) {
5198                                 isp_prt(isp, ISP_LOGTINFO, "[0x%x] ABTS from N-Port handle 0x%x Port 0x%06x has no task id (rx_id 0x%04x ox_id 0x%04x)",
5199                                     abts->abts_rxid_abts, abts->abts_nphdl, sid, abts->abts_rx_id, abts->abts_ox_id);
5200                         } else {
5201                                 isp_prt(isp, ISP_LOGTINFO, "[0x%x] ABTS from N-Port handle 0x%x Port 0x%06x for task 0x%x (rx_id 0x%04x ox_id 0x%04x)",
5202                                     abts->abts_rxid_abts, abts->abts_nphdl, sid, abts->abts_rxid_task, abts->abts_rx_id, abts->abts_ox_id);
5203                         }
5204                         nt->nt_channel = chan;
5205                         nt->nt_ncode = NT_ABORT_TASK;
5206                         nt->nt_lreserved = hp;
5207                         isp_handle_platform_target_tmf(isp, nt);
5208                         break;
5209                 }
5210                 case RQSTYPE_ENABLE_LUN:
5211                 case RQSTYPE_MODIFY_LUN:
5212                         isp_ledone(isp, (lun_entry_t *) hp);
5213                         break;
5214                 }
5215                 break;
5216         }
5217 #endif
5218         case ISPASYNC_FW_CRASH:
5219         {
5220                 uint16_t mbox1, mbox6;
5221                 mbox1 = ISP_READ(isp, OUTMAILBOX1);
5222                 if (IS_DUALBUS(isp)) {
5223                         mbox6 = ISP_READ(isp, OUTMAILBOX6);
5224                 } else {
5225                         mbox6 = 0;
5226                 }
5227                 isp_prt(isp, ISP_LOGERR, "Internal Firmware Error on bus %d @ RISC Address 0x%x", mbox6, mbox1);
5228                 mbox1 = isp->isp_osinfo.mbox_sleep_ok;
5229                 isp->isp_osinfo.mbox_sleep_ok = 0;
5230                 isp_reinit(isp, 1);
5231                 isp->isp_osinfo.mbox_sleep_ok = mbox1;
5232                 isp_async(isp, ISPASYNC_FW_RESTARTED, NULL);
5233                 break;
5234         }
5235         default:
5236                 isp_prt(isp, ISP_LOGERR, "unknown isp_async event %d", cmd);
5237                 break;
5238         }
5239 }
5240
5241
5242 /*
5243  * Locks are held before coming here.
5244  */
5245 void
5246 isp_uninit(ispsoftc_t *isp)
5247 {
5248         if (IS_24XX(isp)) {
5249                 ISP_WRITE(isp, BIU2400_HCCR, HCCR_2400_CMD_RESET);
5250         } else {
5251                 ISP_WRITE(isp, HCCR, HCCR_CMD_RESET);
5252         }
5253         ISP_DISABLE_INTS(isp);
5254 }
5255
5256 /*
5257  * When we want to get the 'default' WWNs (when lacking NVRAM), we pick them
5258  * up from our platform default (defww{p|n}n) and morph them based upon
5259  * channel.
5260  *
5261  * When we want to get the 'active' WWNs, we get NVRAM WWNs and then morph them
5262  * based upon channel.
5263  */
5264
5265 uint64_t
5266 isp_default_wwn(ispsoftc_t * isp, int chan, int isactive, int iswwnn)
5267 {
5268         uint64_t seed;
5269         struct isp_fc *fc = ISP_FC_PC(isp, chan);
5270
5271         /*
5272          * If we're asking for a active WWN, the default overrides get
5273          * returned, otherwise the NVRAM value is picked.
5274          *
5275          * If we're asking for a default WWN, we just pick the default override.
5276          */
5277         if (isactive) {
5278                 seed = iswwnn ? fc->def_wwnn : fc->def_wwpn;
5279                 if (seed) {
5280                         return (seed);
5281                 }
5282                 seed = iswwnn ? FCPARAM(isp, chan)->isp_wwnn_nvram : FCPARAM(isp, chan)->isp_wwpn_nvram;
5283                 if (seed) {
5284                         return (seed);
5285                 }
5286                 return (0x400000007F000009ull);
5287         } else {
5288                 seed = iswwnn ? fc->def_wwnn : fc->def_wwpn;
5289         }
5290
5291
5292         /*
5293          * For channel zero just return what we have. For either ACIIVE or
5294          * DEFAULT cases, we depend on default override of NVRAM values for
5295          * channel zero.
5296          */
5297         if (chan == 0) {
5298                 return (seed);
5299         }
5300
5301         /*
5302          * For other channels, we are doing one of three things:
5303          *
5304          * 1. If what we have now is non-zero, return it. Otherwise we morph
5305          * values from channel 0. 2. If we're here for a WWPN we synthesize
5306          * it if Channel 0's wwpn has a type 2 NAA. 3. If we're here for a
5307          * WWNN we synthesize it if Channel 0's wwnn has a type 2 NAA.
5308          */
5309
5310         if (seed) {
5311                 return (seed);
5312         }
5313         if (isactive) {
5314                 seed = iswwnn ? FCPARAM(isp, 0)->isp_wwnn_nvram : FCPARAM(isp, 0)->isp_wwpn_nvram;
5315         } else {
5316                 seed = iswwnn ? ISP_FC_PC(isp, 0)->def_wwnn : ISP_FC_PC(isp, 0)->def_wwpn;
5317         }
5318
5319         if (((seed >> 60) & 0xf) == 2) {
5320                 /*
5321                  * The type 2 NAA fields for QLogic cards appear be laid out
5322                  * thusly:
5323                  *
5324                  * bits 63..60 NAA == 2 bits 59..57 unused/zero bit 56
5325                  * port (1) or node (0) WWN distinguishor bit 48
5326                  * physical port on dual-port chips (23XX/24XX)
5327                  *
5328                  * This is somewhat nutty, particularly since bit 48 is
5329                  * irrelevant as they assign seperate serial numbers to
5330                  * different physical ports anyway.
5331                  *
5332                  * We'll stick our channel number plus one first into bits
5333                  * 57..59 and thence into bits 52..55 which allows for 8 bits
5334                  * of channel which is comfortably more than our maximum
5335                  * (126) now.
5336                  */
5337                 seed &= ~0x0FF0000000000000ULL;
5338                 if (iswwnn == 0) {
5339                         seed |= ((uint64_t) (chan + 1) & 0xf) << 56;
5340                         seed |= ((uint64_t) ((chan + 1) >> 4) & 0xf) << 52;
5341                 }
5342         } else {
5343                 seed = 0;
5344         }
5345         return (seed);
5346 }
5347
5348 void
5349 isp_prt(ispsoftc_t *isp, int level, const char *fmt, ...)
5350 {
5351         va_list ap;
5352         if (level != ISP_LOGALL && (level & isp->isp_dblev) == 0) {
5353                 return;
5354         }
5355         printf("%s: ", device_get_nameunit(isp->isp_dev));
5356         va_start(ap, fmt);
5357         vprintf(fmt, ap);
5358         va_end(ap);
5359         printf("\n");
5360 }
5361
5362 uint64_t
5363 isp_nanotime_sub(struct timespec *b, struct timespec *a)
5364 {
5365         uint64_t elapsed;
5366         struct timespec x = *b;
5367         timespecsub(&x, a);
5368         elapsed = GET_NANOSEC(&x);
5369         if (elapsed == 0)
5370                 elapsed++;
5371         return (elapsed);
5372 }
5373
5374 int
5375 isp_mbox_acquire(ispsoftc_t *isp)
5376 {
5377         if (isp->isp_osinfo.mboxbsy) {
5378                 return (1);
5379         } else {
5380                 isp->isp_osinfo.mboxcmd_done = 0;
5381                 isp->isp_osinfo.mboxbsy = 1;
5382                 return (0);
5383         }
5384 }
5385
5386 void
5387 isp_mbox_wait_complete(ispsoftc_t *isp, mbreg_t *mbp)
5388 {
5389         unsigned int usecs = mbp->timeout;
5390         unsigned int max, olim, ilim;
5391
5392         if (usecs == 0) {
5393                 usecs = MBCMD_DEFAULT_TIMEOUT;
5394         }
5395         max = isp->isp_mbxwrk0 + 1;
5396
5397         if (isp->isp_osinfo.mbox_sleep_ok) {
5398                 unsigned int ms = (usecs + 999) / 1000;
5399
5400                 isp->isp_osinfo.mbox_sleep_ok = 0;
5401                 isp->isp_osinfo.mbox_sleeping = 1;
5402                 for (olim = 0; olim < max; olim++) {
5403                         msleep(&isp->isp_mbxworkp, &isp->isp_osinfo.lock, PRIBIO, "ispmbx_sleep", isp_mstohz(ms));
5404                         if (isp->isp_osinfo.mboxcmd_done) {
5405                                 break;
5406                         }
5407                 }
5408                 isp->isp_osinfo.mbox_sleep_ok = 1;
5409                 isp->isp_osinfo.mbox_sleeping = 0;
5410         } else {
5411                 for (olim = 0; olim < max; olim++) {
5412                         for (ilim = 0; ilim < usecs; ilim += 100) {
5413                                 uint32_t isr;
5414                                 uint16_t sema, mbox;
5415                                 if (isp->isp_osinfo.mboxcmd_done) {
5416                                         break;
5417                                 }
5418                                 if (ISP_READ_ISR(isp, &isr, &sema, &mbox)) {
5419                                         isp_intr(isp, isr, sema, mbox);
5420                                         if (isp->isp_osinfo.mboxcmd_done) {
5421                                                 break;
5422                                         }
5423                                 }
5424                                 ISP_DELAY(100);
5425                         }
5426                         if (isp->isp_osinfo.mboxcmd_done) {
5427                                 break;
5428                         }
5429                 }
5430         }
5431         if (isp->isp_osinfo.mboxcmd_done == 0) {
5432                 isp_prt(isp, ISP_LOGWARN, "%s Mailbox Command (0x%x) Timeout (%uus) (started @ %s:%d)",
5433                     isp->isp_osinfo.mbox_sleep_ok? "Interrupting" : "Polled", isp->isp_lastmbxcmd, usecs, mbp->func, mbp->lineno);
5434                 mbp->param[0] = MBOX_TIMEOUT;
5435                 isp->isp_osinfo.mboxcmd_done = 1;
5436         }
5437 }
5438
5439 void
5440 isp_mbox_notify_done(ispsoftc_t *isp)
5441 {
5442         if (isp->isp_osinfo.mbox_sleeping) {
5443                 wakeup(&isp->isp_mbxworkp);
5444         }
5445         isp->isp_osinfo.mboxcmd_done = 1;
5446 }
5447
5448 void
5449 isp_mbox_release(ispsoftc_t *isp)
5450 {
5451         isp->isp_osinfo.mboxbsy = 0;
5452 }
5453
5454 int
5455 isp_fc_scratch_acquire(ispsoftc_t *isp, int chan)
5456 {
5457         int ret = 0;
5458         if (isp->isp_osinfo.pc.fc[chan].fcbsy) {
5459                 ret = -1;
5460         } else {
5461                 isp->isp_osinfo.pc.fc[chan].fcbsy = 1;
5462         }
5463         return (ret);
5464 }
5465
5466 int
5467 isp_mstohz(int ms)
5468 {
5469         int hz;
5470         struct timeval t;
5471         t.tv_sec = ms / 1000;
5472         t.tv_usec = (ms % 1000) * 1000;
5473         hz = tvtohz(&t);
5474         if (hz < 0) {
5475                 hz = 0x7fffffff;
5476         }
5477         if (hz == 0) {
5478                 hz = 1;
5479         }
5480         return (hz);
5481 }
5482
5483 void
5484 isp_platform_intr(void *arg)
5485 {
5486         ispsoftc_t *isp = arg;
5487         uint32_t isr;
5488         uint16_t sema, mbox;
5489
5490         ISP_LOCK(isp);
5491         isp->isp_intcnt++;
5492         if (ISP_READ_ISR(isp, &isr, &sema, &mbox) == 0) {
5493                 isp->isp_intbogus++;
5494         } else {
5495                 isp_intr(isp, isr, sema, mbox);
5496         }
5497         ISP_UNLOCK(isp);
5498 }
5499
5500 void
5501 isp_common_dmateardown(ispsoftc_t *isp, struct ccb_scsiio *csio, uint32_t hdl)
5502 {
5503         if ((csio->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
5504                 bus_dmamap_sync(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap, BUS_DMASYNC_POSTREAD);
5505         } else {
5506                 bus_dmamap_sync(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap, BUS_DMASYNC_POSTWRITE);
5507         }
5508         bus_dmamap_unload(isp->isp_osinfo.dmat, PISP_PCMD(csio)->dmap);
5509 }
5510
5511 void
5512 isp_timer(void *arg)
5513 {
5514         ispsoftc_t *isp = arg;
5515 #ifdef  ISP_TARGET_MODE
5516         isp_tmcmd_restart(isp);
5517 #endif
5518         callout_reset(&isp->isp_osinfo.tmo, hz, isp_timer, isp);
5519 }