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