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


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

FreeBSD/Linux Kernel Cross Reference
sys/dev/iir/iir.c

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

    1 /*-
    2  *       Copyright (c) 2000-04 ICP vortex GmbH
    3  *       Copyright (c) 2002-04 Intel Corporation
    4  *       Copyright (c) 2003-04 Adaptec Inc.
    5  *       All Rights Reserved
    6  *
    7  * Redistribution and use in source and binary forms, with or without
    8  * modification, are permitted provided that the following conditions
    9  * are met:
   10  * 1. Redistributions of source code must retain the above copyright
   11  *    notice, this list of conditions, and the following disclaimer,
   12  *    without modification, immediately at the beginning of the file.
   13  * 2. Redistributions in binary form must reproduce the above copyright
   14  *    notice, this list of conditions and the following disclaimer in the
   15  *    documentation and/or other materials provided with the distribution.
   16  * 3. The name of the author may not be used to endorse or promote products
   17  *    derived from this software without specific prior written permission.
   18  *
   19  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
   20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   22  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
   23  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   29  * SUCH DAMAGE.
   30  */
   31 
   32 /*
   33  * iir.c: SCSI dependant code for the Intel Integrated RAID Controller driver
   34  *
   35  * Written by: Achim Leubner <achim_leubner@adaptec.com>
   36  * Fixes/Additions: Boji Tony Kannanthanam <boji.t.kannanthanam@intel.com>
   37  *
   38  * credits:     Niklas Hallqvist;       OpenBSD driver for the ICP Controllers.
   39  *              Mike Smith;             Some driver source code.
   40  *              FreeBSD.ORG;            Great O/S to work on and for.
   41  *
   42  * $Id: iir.c 1.5 2004/03/30 10:17:53 achim Exp $"
   43  */
   44 
   45 #include <sys/cdefs.h>
   46 __FBSDID("$FreeBSD: releng/6.1/sys/dev/iir/iir.c 156595 2006-03-12 16:38:28Z scottl $");
   47 
   48 #define _IIR_C_
   49 
   50 /* #include "opt_iir.h" */
   51 #include <sys/param.h>
   52 #include <sys/systm.h>
   53 #include <sys/endian.h>
   54 #include <sys/eventhandler.h>
   55 #include <sys/malloc.h>
   56 #include <sys/kernel.h>
   57 #include <sys/bus.h>
   58 
   59 #include <machine/bus.h>
   60 #include <machine/clock.h>
   61 #include <machine/stdarg.h>
   62 
   63 #include <cam/cam.h>
   64 #include <cam/cam_ccb.h>
   65 #include <cam/cam_sim.h>
   66 #include <cam/cam_xpt_sim.h>
   67 #include <cam/cam_debug.h>
   68 #include <cam/scsi/scsi_all.h>
   69 #include <cam/scsi/scsi_message.h>
   70 
   71 #include <vm/vm.h>
   72 #include <vm/pmap.h>
   73 
   74 #include <dev/iir/iir.h>
   75 
   76 MALLOC_DEFINE(M_GDTBUF, "iirbuf", "iir driver buffer");
   77 
   78 struct gdt_softc *gdt_wait_gdt;
   79 int     gdt_wait_index;
   80 
   81 #ifdef GDT_DEBUG
   82 int     gdt_debug = GDT_DEBUG;
   83 #ifdef __SERIAL__
   84 #define MAX_SERBUF 160
   85 static void ser_init(void);
   86 static void ser_puts(char *str);
   87 static void ser_putc(int c);
   88 static char strbuf[MAX_SERBUF+1];
   89 #ifdef __COM2__
   90 #define COM_BASE 0x2f8
   91 #else
   92 #define COM_BASE 0x3f8
   93 #endif
   94 static void ser_init()
   95 {
   96     unsigned port=COM_BASE;
   97 
   98     outb(port+3, 0x80);
   99     outb(port+1, 0);
  100     /* 19200 Baud, if 9600: outb(12,port) */
  101     outb(port, 6);
  102     outb(port+3, 3);
  103     outb(port+1, 0);
  104 }
  105 
  106 static void ser_puts(char *str)
  107 {
  108     char *ptr;
  109 
  110     ser_init();
  111     for (ptr=str;*ptr;++ptr)
  112         ser_putc((int)(*ptr));
  113 }
  114 
  115 static void ser_putc(int c)
  116 {
  117     unsigned port=COM_BASE;
  118 
  119     while ((inb(port+5) & 0x20)==0);
  120     outb(port, c);
  121     if (c==0x0a)
  122     {
  123         while ((inb(port+5) & 0x20)==0);
  124         outb(port, 0x0d);
  125     }
  126 }
  127 
  128 int ser_printf(const char *fmt, ...)
  129 {
  130     va_list args;
  131     int i;
  132 
  133     va_start(args,fmt);
  134     i = vsprintf(strbuf,fmt,args);
  135     ser_puts(strbuf);
  136     va_end(args);
  137     return i;
  138 }
  139 #endif
  140 #endif
  141 
  142 /* The linked list of softc structures */
  143 struct gdt_softc_list gdt_softcs = TAILQ_HEAD_INITIALIZER(gdt_softcs);
  144 /* controller cnt. */
  145 int gdt_cnt = 0;
  146 /* event buffer */
  147 static gdt_evt_str ebuffer[GDT_MAX_EVENTS];
  148 static int elastidx, eoldidx;
  149 /* statistics */
  150 gdt_statist_t gdt_stat;
  151 
  152 /* Definitions for our use of the SIM private CCB area */
  153 #define ccb_sim_ptr     spriv_ptr0
  154 #define ccb_priority    spriv_field1
  155 
  156 static void     iir_action(struct cam_sim *sim, union ccb *ccb);
  157 static void     iir_poll(struct cam_sim *sim);
  158 static void     iir_shutdown(void *arg, int howto);
  159 static void     iir_timeout(void *arg);
  160 static void     iir_watchdog(void *arg);
  161 
  162 static void     gdt_eval_mapping(u_int32_t size, int *cyls, int *heads, 
  163                                  int *secs);
  164 static int      gdt_internal_cmd(struct gdt_softc *gdt, struct gdt_ccb *gccb, 
  165                                  u_int8_t service, u_int16_t opcode, 
  166                                  u_int32_t arg1, u_int32_t arg2, u_int32_t arg3);
  167 static int      gdt_wait(struct gdt_softc *gdt, struct gdt_ccb *ccb, 
  168                          int timeout);
  169 
  170 static struct gdt_ccb *gdt_get_ccb(struct gdt_softc *gdt);
  171 
  172 static int      gdt_sync_event(struct gdt_softc *gdt, int service, 
  173                                u_int8_t index, struct gdt_ccb *gccb);
  174 static int      gdt_async_event(struct gdt_softc *gdt, int service);
  175 static struct gdt_ccb *gdt_raw_cmd(struct gdt_softc *gdt, 
  176                                    union ccb *ccb, int *lock);
  177 static struct gdt_ccb *gdt_cache_cmd(struct gdt_softc *gdt, 
  178                                      union ccb *ccb, int *lock);
  179 static struct gdt_ccb *gdt_ioctl_cmd(struct gdt_softc *gdt, 
  180                                      gdt_ucmd_t *ucmd, int *lock);
  181 static void     gdt_internal_cache_cmd(struct gdt_softc *gdt,union ccb *ccb);
  182 
  183 static void     gdtmapmem(void *arg, bus_dma_segment_t *dm_segs,
  184                           int nseg, int error);
  185 static void     gdtexecuteccb(void *arg, bus_dma_segment_t *dm_segs,
  186                               int nseg, int error);
  187 
  188 int
  189 iir_init(struct gdt_softc *gdt)
  190 {
  191     u_int16_t cdev_cnt;
  192     int i, id, drv_cyls, drv_hds, drv_secs;
  193     struct gdt_ccb *gccb;
  194 
  195     GDT_DPRINTF(GDT_D_DEBUG, ("iir_init()\n"));
  196 
  197     gdt->sc_state = GDT_POLLING;
  198     gdt_clear_events(); 
  199     bzero(&gdt_stat, sizeof(gdt_statist_t));
  200 
  201     SLIST_INIT(&gdt->sc_free_gccb);
  202     SLIST_INIT(&gdt->sc_pending_gccb);
  203     TAILQ_INIT(&gdt->sc_ccb_queue);
  204     TAILQ_INIT(&gdt->sc_ucmd_queue);
  205     TAILQ_INSERT_TAIL(&gdt_softcs, gdt, links);
  206 
  207     /* DMA tag for mapping buffers into device visible space. */
  208     if (bus_dma_tag_create(gdt->sc_parent_dmat, /*alignment*/1, /*boundary*/0,
  209                            /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
  210                            /*highaddr*/BUS_SPACE_MAXADDR,
  211                            /*filter*/NULL, /*filterarg*/NULL,
  212                            /*maxsize*/MAXBSIZE, /*nsegments*/GDT_MAXSG,
  213                            /*maxsegsz*/BUS_SPACE_MAXSIZE_32BIT,
  214                            /*flags*/BUS_DMA_ALLOCNOW,
  215                            /*lockfunc*/busdma_lock_mutex, /*lockarg*/&Giant,
  216                            &gdt->sc_buffer_dmat) != 0) {
  217         printf("iir%d: bus_dma_tag_create(...,gdt->sc_buffer_dmat) failed\n",
  218                gdt->sc_hanum);
  219         return (1);
  220     }
  221     gdt->sc_init_level++;
  222 
  223     /* DMA tag for our ccb structures */
  224     if (bus_dma_tag_create(gdt->sc_parent_dmat,
  225                            /*alignment*/1,
  226                            /*boundary*/0,
  227                            /*lowaddr*/BUS_SPACE_MAXADDR_32BIT,
  228                            /*highaddr*/BUS_SPACE_MAXADDR,
  229                            /*filter*/NULL,
  230                            /*filterarg*/NULL,
  231                            GDT_MAXCMDS * GDT_SCRATCH_SZ, /* maxsize */
  232                            /*nsegments*/1,
  233                            /*maxsegsz*/BUS_SPACE_MAXSIZE_32BIT,
  234                            /*flags*/0, /*lockfunc*/busdma_lock_mutex,
  235                            /*lockarg*/&Giant, &gdt->sc_gcscratch_dmat) != 0) {
  236         printf("iir%d: bus_dma_tag_create(...,gdt->sc_gcscratch_dmat) failed\n",
  237                gdt->sc_hanum);
  238         return (1);
  239     }
  240     gdt->sc_init_level++;
  241 
  242     /* Allocation for our ccb scratch area */
  243     if (bus_dmamem_alloc(gdt->sc_gcscratch_dmat, (void **)&gdt->sc_gcscratch,
  244                          BUS_DMA_NOWAIT, &gdt->sc_gcscratch_dmamap) != 0) {
  245         printf("iir%d: bus_dmamem_alloc(...,&gdt->sc_gccbs,...) failed\n",
  246                gdt->sc_hanum);
  247         return (1);
  248     }
  249     gdt->sc_init_level++;
  250 
  251     /* And permanently map them */
  252     bus_dmamap_load(gdt->sc_gcscratch_dmat, gdt->sc_gcscratch_dmamap,
  253                     gdt->sc_gcscratch, GDT_MAXCMDS * GDT_SCRATCH_SZ,
  254                     gdtmapmem, &gdt->sc_gcscratch_busbase, /*flags*/0);
  255     gdt->sc_init_level++;
  256 
  257     /* Clear them out. */
  258     bzero(gdt->sc_gcscratch, GDT_MAXCMDS * GDT_SCRATCH_SZ);
  259 
  260     /* Initialize the ccbs */
  261     gdt->sc_gccbs = malloc(sizeof(struct gdt_ccb) * GDT_MAXCMDS, M_GDTBUF,
  262         M_NOWAIT | M_ZERO);
  263     if (gdt->sc_gccbs == NULL) {
  264         printf("iir%d: no memory for gccbs.\n", gdt->sc_hanum);
  265         return (1);
  266     }
  267     for (i = GDT_MAXCMDS-1; i >= 0; i--) {
  268         gccb = &gdt->sc_gccbs[i];
  269         gccb->gc_cmd_index = i + 2;
  270         gccb->gc_flags = GDT_GCF_UNUSED;
  271         gccb->gc_map_flag = FALSE;
  272         if (bus_dmamap_create(gdt->sc_buffer_dmat, /*flags*/0,
  273                               &gccb->gc_dmamap) != 0)
  274             return(1);
  275         gccb->gc_map_flag = TRUE;
  276         gccb->gc_scratch = &gdt->sc_gcscratch[GDT_SCRATCH_SZ * i];
  277         gccb->gc_scratch_busbase = gdt->sc_gcscratch_busbase + GDT_SCRATCH_SZ * i;
  278         SLIST_INSERT_HEAD(&gdt->sc_free_gccb, gccb, sle);
  279     }
  280     gdt->sc_init_level++;
  281 
  282     /* create the control device */
  283     gdt->sc_dev = gdt_make_dev(gdt->sc_hanum);
  284 
  285     /* allocate ccb for gdt_internal_cmd() */
  286     gccb = gdt_get_ccb(gdt);
  287     if (gccb == NULL) {
  288         printf("iir%d: No free command index found\n",
  289                gdt->sc_hanum);
  290         return (1);
  291     }
  292     bzero(gccb->gc_cmd, GDT_CMD_SZ);
  293 
  294     if (!gdt_internal_cmd(gdt, gccb, GDT_SCREENSERVICE, GDT_INIT, 
  295                           0, 0, 0)) {
  296         printf("iir%d: Screen service initialization error %d\n",
  297                gdt->sc_hanum, gdt->sc_status);
  298         gdt_free_ccb(gdt, gccb);
  299         return (1);
  300     }
  301 
  302     gdt_internal_cmd(gdt, gccb, GDT_CACHESERVICE, GDT_UNFREEZE_IO,
  303                      0, 0, 0);
  304 
  305     if (!gdt_internal_cmd(gdt, gccb, GDT_CACHESERVICE, GDT_INIT, 
  306                           GDT_LINUX_OS, 0, 0)) {
  307         printf("iir%d: Cache service initialization error %d\n",
  308                gdt->sc_hanum, gdt->sc_status);
  309         gdt_free_ccb(gdt, gccb);
  310         return (1);
  311     }
  312     cdev_cnt = (u_int16_t)gdt->sc_info;
  313     gdt->sc_fw_vers = gdt->sc_service;
  314 
  315     /* Detect number of buses */
  316     gdt_enc32(gccb->gc_scratch + GDT_IOC_VERSION, GDT_IOC_NEWEST);
  317     gccb->gc_scratch[GDT_IOC_LIST_ENTRIES] = GDT_MAXBUS;
  318     gccb->gc_scratch[GDT_IOC_FIRST_CHAN] = 0;
  319     gccb->gc_scratch[GDT_IOC_LAST_CHAN] = GDT_MAXBUS - 1;
  320     gdt_enc32(gccb->gc_scratch + GDT_IOC_LIST_OFFSET, GDT_IOC_HDR_SZ);
  321     if (gdt_internal_cmd(gdt, gccb, GDT_CACHESERVICE, GDT_IOCTL,
  322                          GDT_IOCHAN_RAW_DESC, GDT_INVALID_CHANNEL,
  323                          GDT_IOC_HDR_SZ + GDT_MAXBUS * GDT_RAWIOC_SZ)) {
  324         gdt->sc_bus_cnt = gccb->gc_scratch[GDT_IOC_CHAN_COUNT];
  325         for (i = 0; i < gdt->sc_bus_cnt; i++) {
  326             id = gccb->gc_scratch[GDT_IOC_HDR_SZ +
  327                                  i * GDT_RAWIOC_SZ + GDT_RAWIOC_PROC_ID];
  328             gdt->sc_bus_id[i] = id < GDT_MAXID_FC ? id : 0xff;
  329         }
  330     } else {
  331         /* New method failed, use fallback. */
  332         for (i = 0; i < GDT_MAXBUS; i++) {
  333             gdt_enc32(gccb->gc_scratch + GDT_GETCH_CHANNEL_NO, i);
  334             if (!gdt_internal_cmd(gdt, gccb, GDT_CACHESERVICE, GDT_IOCTL,
  335                                   GDT_SCSI_CHAN_CNT | GDT_L_CTRL_PATTERN,
  336                                   GDT_IO_CHANNEL | GDT_INVALID_CHANNEL,
  337                                   GDT_GETCH_SZ)) {
  338                 if (i == 0) {
  339                     printf("iir%d: Cannot get channel count, "
  340                            "error %d\n", gdt->sc_hanum, gdt->sc_status);
  341                     gdt_free_ccb(gdt, gccb);
  342                     return (1);
  343                 }
  344                 break;
  345             }
  346             gdt->sc_bus_id[i] =
  347                 (gccb->gc_scratch[GDT_GETCH_SIOP_ID] < GDT_MAXID_FC) ?
  348                 gccb->gc_scratch[GDT_GETCH_SIOP_ID] : 0xff;
  349         }
  350         gdt->sc_bus_cnt = i;
  351     }
  352     /* add one "virtual" channel for the host drives */
  353     gdt->sc_virt_bus = gdt->sc_bus_cnt;
  354     gdt->sc_bus_cnt++;
  355 
  356     if (!gdt_internal_cmd(gdt, gccb, GDT_SCSIRAWSERVICE, GDT_INIT, 
  357                           0, 0, 0)) {
  358             printf("iir%d: Raw service initialization error %d\n",
  359                    gdt->sc_hanum, gdt->sc_status);
  360             gdt_free_ccb(gdt, gccb);
  361             return (1);
  362     }
  363 
  364     /* Set/get features raw service (scatter/gather) */
  365     gdt->sc_raw_feat = 0;
  366     if (gdt_internal_cmd(gdt, gccb, GDT_SCSIRAWSERVICE, GDT_SET_FEAT,
  367                          GDT_SCATTER_GATHER, 0, 0)) {
  368         if (gdt_internal_cmd(gdt, gccb, GDT_SCSIRAWSERVICE, GDT_GET_FEAT, 
  369                              0, 0, 0)) {
  370             gdt->sc_raw_feat = gdt->sc_info;
  371             if (!(gdt->sc_info & GDT_SCATTER_GATHER)) {
  372                 panic("iir%d: Scatter/Gather Raw Service "
  373                       "required but not supported!\n", gdt->sc_hanum);
  374                 gdt_free_ccb(gdt, gccb);
  375                 return (1);
  376             }
  377         }
  378     }
  379 
  380     /* Set/get features cache service (scatter/gather) */
  381     gdt->sc_cache_feat = 0;
  382     if (gdt_internal_cmd(gdt, gccb, GDT_CACHESERVICE, GDT_SET_FEAT, 
  383                          0, GDT_SCATTER_GATHER, 0)) {
  384         if (gdt_internal_cmd(gdt, gccb, GDT_CACHESERVICE, GDT_GET_FEAT, 
  385                              0, 0, 0)) {
  386             gdt->sc_cache_feat = gdt->sc_info;
  387             if (!(gdt->sc_info & GDT_SCATTER_GATHER)) {
  388                 panic("iir%d: Scatter/Gather Cache Service "
  389                   "required but not supported!\n", gdt->sc_hanum);
  390                 gdt_free_ccb(gdt, gccb);
  391                 return (1);
  392             }
  393         }
  394     }
  395 
  396     /* OEM */
  397     gdt_enc32(gccb->gc_scratch + GDT_OEM_VERSION, 0x01);
  398     gdt_enc32(gccb->gc_scratch + GDT_OEM_BUFSIZE, sizeof(gdt_oem_record_t));
  399     if (gdt_internal_cmd(gdt, gccb, GDT_CACHESERVICE, GDT_IOCTL,
  400                          GDT_OEM_STR_RECORD, GDT_INVALID_CHANNEL,
  401                          sizeof(gdt_oem_str_record_t))) {
  402             strncpy(gdt->oem_name, ((gdt_oem_str_record_t *)
  403             gccb->gc_scratch)->text.scsi_host_drive_inquiry_vendor_id, 7);
  404                 gdt->oem_name[7]='\0';
  405         } else {
  406                 /* Old method, based on PCI ID */
  407                 if (gdt->sc_vendor == INTEL_VENDOR_ID)
  408             strcpy(gdt->oem_name,"Intel  ");
  409         else 
  410             strcpy(gdt->oem_name,"ICP    ");
  411     }
  412 
  413     /* Scan for cache devices */
  414     for (i = 0; i < cdev_cnt && i < GDT_MAX_HDRIVES; i++) {
  415         if (gdt_internal_cmd(gdt, gccb, GDT_CACHESERVICE, GDT_INFO, 
  416                              i, 0, 0)) {
  417             gdt->sc_hdr[i].hd_present = 1;
  418             gdt->sc_hdr[i].hd_size = gdt->sc_info;
  419             
  420             /*
  421              * Evaluate mapping (sectors per head, heads per cyl)
  422              */
  423             gdt->sc_hdr[i].hd_size &= ~GDT_SECS32;
  424             if (gdt->sc_info2 == 0)
  425                 gdt_eval_mapping(gdt->sc_hdr[i].hd_size,
  426                                  &drv_cyls, &drv_hds, &drv_secs);
  427             else {
  428                 drv_hds = gdt->sc_info2 & 0xff;
  429                 drv_secs = (gdt->sc_info2 >> 8) & 0xff;
  430                 drv_cyls = gdt->sc_hdr[i].hd_size / drv_hds /
  431                     drv_secs;
  432             }
  433             gdt->sc_hdr[i].hd_heads = drv_hds;
  434             gdt->sc_hdr[i].hd_secs = drv_secs;
  435             /* Round the size */
  436             gdt->sc_hdr[i].hd_size = drv_cyls * drv_hds * drv_secs;
  437             
  438             if (gdt_internal_cmd(gdt, gccb, GDT_CACHESERVICE,
  439                                  GDT_DEVTYPE, i, 0, 0))
  440                 gdt->sc_hdr[i].hd_devtype = gdt->sc_info;
  441         }
  442     }
  443     
  444     GDT_DPRINTF(GDT_D_INIT, ("dpmem %x %d-bus %d cache device%s\n", 
  445                              gdt->sc_dpmembase,
  446                              gdt->sc_bus_cnt, cdev_cnt, 
  447                              cdev_cnt == 1 ? "" : "s"));
  448     gdt_free_ccb(gdt, gccb);
  449 
  450     gdt_cnt++;
  451     return (0);
  452 }
  453 
  454 void
  455 iir_free(struct gdt_softc *gdt)
  456 {
  457     int i;
  458 
  459     GDT_DPRINTF(GDT_D_INIT, ("iir_free()\n"));
  460 
  461     switch (gdt->sc_init_level) {
  462       default:
  463         gdt_destroy_dev(gdt->sc_dev);
  464       case 5:
  465         for (i = GDT_MAXCMDS-1; i >= 0; i--) 
  466             if (gdt->sc_gccbs[i].gc_map_flag)
  467                 bus_dmamap_destroy(gdt->sc_buffer_dmat,
  468                                    gdt->sc_gccbs[i].gc_dmamap);
  469         bus_dmamap_unload(gdt->sc_gcscratch_dmat, gdt->sc_gcscratch_dmamap);
  470         free(gdt->sc_gccbs, M_GDTBUF);
  471       case 4:
  472         bus_dmamem_free(gdt->sc_gcscratch_dmat, gdt->sc_gcscratch, gdt->sc_gcscratch_dmamap);
  473       case 3:
  474         bus_dma_tag_destroy(gdt->sc_gcscratch_dmat);
  475       case 2:
  476         bus_dma_tag_destroy(gdt->sc_buffer_dmat);
  477       case 1:
  478         bus_dma_tag_destroy(gdt->sc_parent_dmat);
  479       case 0:
  480         break;
  481     }
  482     TAILQ_REMOVE(&gdt_softcs, gdt, links);
  483 }
  484 
  485 void
  486 iir_attach(struct gdt_softc *gdt)
  487 {
  488     struct cam_devq *devq;
  489     int i;
  490 
  491     GDT_DPRINTF(GDT_D_INIT, ("iir_attach()\n"));
  492 
  493     /*
  494      * Create the device queue for our SIM.
  495      * XXX Throttle this down since the card has problems under load.
  496      */
  497     devq = cam_simq_alloc(32);
  498     if (devq == NULL)
  499         return;
  500 
  501     for (i = 0; i < gdt->sc_bus_cnt; i++) {
  502         /*
  503          * Construct our SIM entry
  504          */
  505         gdt->sims[i] = cam_sim_alloc(iir_action, iir_poll, "iir",
  506                                      gdt, gdt->sc_hanum, /*untagged*/1,
  507                                      /*tagged*/GDT_MAXCMDS, devq);
  508         if (xpt_bus_register(gdt->sims[i], i) != CAM_SUCCESS) {
  509             cam_sim_free(gdt->sims[i], /*free_devq*/i == 0);
  510             break;
  511         }
  512 
  513         if (xpt_create_path(&gdt->paths[i], /*periph*/NULL,
  514                             cam_sim_path(gdt->sims[i]),
  515                             CAM_TARGET_WILDCARD,
  516                             CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
  517             xpt_bus_deregister(cam_sim_path(gdt->sims[i]));
  518             cam_sim_free(gdt->sims[i], /*free_devq*/i == 0);
  519             break;
  520         }
  521     }
  522     if (i > 0)
  523         EVENTHANDLER_REGISTER(shutdown_final, iir_shutdown,
  524                               gdt, SHUTDOWN_PRI_DEFAULT);
  525     /* iir_watchdog(gdt); */
  526     gdt->sc_state = GDT_NORMAL;
  527 }
  528 
  529 static void
  530 gdt_eval_mapping(u_int32_t size, int *cyls, int *heads, int *secs)
  531 {
  532     *cyls = size / GDT_HEADS / GDT_SECS;
  533     if (*cyls < GDT_MAXCYLS) {
  534         *heads = GDT_HEADS;
  535         *secs = GDT_SECS;
  536     } else {
  537         /* Too high for 64 * 32 */
  538         *cyls = size / GDT_MEDHEADS / GDT_MEDSECS;
  539         if (*cyls < GDT_MAXCYLS) {
  540             *heads = GDT_MEDHEADS;
  541             *secs = GDT_MEDSECS;
  542         } else {
  543             /* Too high for 127 * 63 */
  544             *cyls = size / GDT_BIGHEADS / GDT_BIGSECS;
  545             *heads = GDT_BIGHEADS;
  546             *secs = GDT_BIGSECS;
  547         }
  548     }
  549 }
  550 
  551 static int
  552 gdt_wait(struct gdt_softc *gdt, struct gdt_ccb *gccb, 
  553          int timeout)
  554 {
  555     int rv = 0;
  556 
  557     GDT_DPRINTF(GDT_D_INIT,
  558                 ("gdt_wait(%p, %p, %d)\n", gdt, gccb, timeout));
  559 
  560     gdt->sc_state |= GDT_POLL_WAIT;
  561     do {
  562         iir_intr(gdt);
  563         if (gdt == gdt_wait_gdt &&
  564             gccb->gc_cmd_index == gdt_wait_index) {
  565             rv = 1;
  566             break;
  567         }
  568         DELAY(1);
  569     } while (--timeout);
  570     gdt->sc_state &= ~GDT_POLL_WAIT;
  571     
  572     while (gdt->sc_test_busy(gdt))
  573         DELAY(1);               /* XXX correct? */
  574 
  575     return (rv);
  576 }
  577 
  578 static int
  579 gdt_internal_cmd(struct gdt_softc *gdt, struct gdt_ccb *gccb,
  580                  u_int8_t service, u_int16_t opcode, 
  581                  u_int32_t arg1, u_int32_t arg2, u_int32_t arg3)
  582 {
  583     int retries;
  584     
  585     GDT_DPRINTF(GDT_D_CMD, ("gdt_internal_cmd(%p, %d, %d, %d, %d, %d)\n",
  586                             gdt, service, opcode, arg1, arg2, arg3));
  587 
  588     bzero(gccb->gc_cmd, GDT_CMD_SZ);
  589 
  590     for (retries = GDT_RETRIES; ; ) {
  591         gccb->gc_service = service;
  592         gccb->gc_flags = GDT_GCF_INTERNAL;
  593         
  594         gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
  595                   gccb->gc_cmd_index);
  596         gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, opcode);
  597 
  598         switch (service) {
  599           case GDT_CACHESERVICE:
  600             if (opcode == GDT_IOCTL) {
  601                 gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION +
  602                           GDT_IOCTL_SUBFUNC, arg1);
  603                 gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION +
  604                           GDT_IOCTL_CHANNEL, arg2);
  605                 gdt_enc16(gccb->gc_cmd + GDT_CMD_UNION +
  606                           GDT_IOCTL_PARAM_SIZE, (u_int16_t)arg3);
  607                 gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_IOCTL_P_PARAM,
  608                           gccb->gc_scratch_busbase);
  609             } else {
  610                 gdt_enc16(gccb->gc_cmd + GDT_CMD_UNION +
  611                           GDT_CACHE_DEVICENO, (u_int16_t)arg1);
  612                 gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION +
  613                           GDT_CACHE_BLOCKNO, arg2);
  614             }
  615             break;
  616 
  617           case GDT_SCSIRAWSERVICE:
  618             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION +
  619                       GDT_RAW_DIRECTION, arg1);
  620             gccb->gc_cmd[GDT_CMD_UNION + GDT_RAW_BUS] =
  621                 (u_int8_t)arg2;
  622             gccb->gc_cmd[GDT_CMD_UNION + GDT_RAW_TARGET] =
  623                 (u_int8_t)arg3;
  624             gccb->gc_cmd[GDT_CMD_UNION + GDT_RAW_LUN] =
  625                 (u_int8_t)(arg3 >> 8);
  626         }
  627 
  628         gdt->sc_set_sema0(gdt);
  629         gccb->gc_cmd_len = GDT_CMD_SZ;
  630         gdt->sc_cmd_off = 0;
  631         gdt->sc_cmd_cnt = 0;
  632         gdt->sc_copy_cmd(gdt, gccb);
  633         gdt->sc_release_event(gdt);
  634         DELAY(20);
  635         if (!gdt_wait(gdt, gccb, GDT_POLL_TIMEOUT))
  636             return (0);
  637         if (gdt->sc_status != GDT_S_BSY || --retries == 0)
  638             break;
  639         DELAY(1);
  640     }
  641     return (gdt->sc_status == GDT_S_OK);
  642 }
  643 
  644 static struct gdt_ccb *
  645 gdt_get_ccb(struct gdt_softc *gdt)
  646 {
  647     struct gdt_ccb *gccb;
  648     int lock;
  649     
  650     GDT_DPRINTF(GDT_D_QUEUE, ("gdt_get_ccb(%p)\n", gdt));
  651 
  652     lock = splcam();
  653     gccb = SLIST_FIRST(&gdt->sc_free_gccb);
  654     if (gccb != NULL) {
  655         SLIST_REMOVE_HEAD(&gdt->sc_free_gccb, sle);
  656         SLIST_INSERT_HEAD(&gdt->sc_pending_gccb, gccb, sle);
  657         ++gdt_stat.cmd_index_act;
  658         if (gdt_stat.cmd_index_act > gdt_stat.cmd_index_max)
  659             gdt_stat.cmd_index_max = gdt_stat.cmd_index_act;
  660     }
  661     splx(lock);
  662     return (gccb);
  663 }
  664 
  665 void
  666 gdt_free_ccb(struct gdt_softc *gdt, struct gdt_ccb *gccb)
  667 {
  668     int lock;
  669 
  670     GDT_DPRINTF(GDT_D_QUEUE, ("gdt_free_ccb(%p, %p)\n", gdt, gccb));
  671     
  672     lock = splcam();
  673     gccb->gc_flags = GDT_GCF_UNUSED;
  674     SLIST_REMOVE(&gdt->sc_pending_gccb, gccb, gdt_ccb, sle);
  675     SLIST_INSERT_HEAD(&gdt->sc_free_gccb, gccb, sle);
  676     --gdt_stat.cmd_index_act;
  677     splx(lock);
  678     if (gdt->sc_state & GDT_SHUTDOWN)
  679         wakeup(gccb);
  680 }
  681 
  682 void    
  683 gdt_next(struct gdt_softc *gdt)
  684 {
  685     int lock;
  686     union ccb *ccb;
  687     gdt_ucmd_t *ucmd;
  688     struct cam_sim *sim;
  689     int bus, target, lun;
  690     int next_cmd;
  691 
  692     struct ccb_scsiio *csio;
  693     struct ccb_hdr *ccbh;
  694     struct gdt_ccb *gccb = NULL;
  695     u_int8_t cmd;
  696 
  697     GDT_DPRINTF(GDT_D_QUEUE, ("gdt_next(%p)\n", gdt));
  698 
  699     lock = splcam();
  700     if (gdt->sc_test_busy(gdt)) {
  701         if (!(gdt->sc_state & GDT_POLLING)) {
  702             splx(lock);
  703             return;
  704         }
  705         while (gdt->sc_test_busy(gdt))
  706             DELAY(1);
  707     }
  708 
  709     gdt->sc_cmd_cnt = gdt->sc_cmd_off = 0;
  710     next_cmd = TRUE;
  711     for (;;) {
  712         /* I/Os in queue? controller ready? */
  713         if (!TAILQ_FIRST(&gdt->sc_ucmd_queue) &&
  714             !TAILQ_FIRST(&gdt->sc_ccb_queue))
  715             break;
  716 
  717         /* 1.: I/Os without ccb (IOCTLs) */
  718         ucmd = TAILQ_FIRST(&gdt->sc_ucmd_queue);
  719         if (ucmd != NULL) {
  720             TAILQ_REMOVE(&gdt->sc_ucmd_queue, ucmd, links);
  721             if ((gccb = gdt_ioctl_cmd(gdt, ucmd, &lock)) == NULL) {
  722                 TAILQ_INSERT_HEAD(&gdt->sc_ucmd_queue, ucmd, links);
  723                 break;
  724             }
  725             break;      
  726             /* wenn mehrere Kdos. zulassen: if (!gdt_polling) continue; */
  727         }
  728 
  729         /* 2.: I/Os with ccb */
  730         ccb = (union ccb *)TAILQ_FIRST(&gdt->sc_ccb_queue); 
  731         /* ist dann immer != NULL, da oben getestet */
  732         sim = (struct cam_sim *)ccb->ccb_h.ccb_sim_ptr;
  733         bus = cam_sim_bus(sim);
  734         target = ccb->ccb_h.target_id;
  735         lun = ccb->ccb_h.target_lun;
  736     
  737         TAILQ_REMOVE(&gdt->sc_ccb_queue, &ccb->ccb_h, sim_links.tqe);
  738         --gdt_stat.req_queue_act;
  739         /* ccb->ccb_h.func_code is XPT_SCSI_IO */
  740         GDT_DPRINTF(GDT_D_QUEUE, ("XPT_SCSI_IO flags 0x%x)\n", 
  741                                   ccb->ccb_h.flags));
  742         csio = &ccb->csio;
  743         ccbh = &ccb->ccb_h;
  744         cmd  = csio->cdb_io.cdb_bytes[0];
  745         /* Max CDB length is 12 bytes */
  746         if (csio->cdb_len > 12) { 
  747             ccbh->status = CAM_REQ_INVALID;
  748             --gdt_stat.io_count_act;
  749             xpt_done(ccb);
  750         } else if (bus != gdt->sc_virt_bus) {
  751             /* raw service command */
  752             if ((gccb = gdt_raw_cmd(gdt, ccb, &lock)) == NULL) {
  753                 TAILQ_INSERT_HEAD(&gdt->sc_ccb_queue, &ccb->ccb_h, 
  754                                   sim_links.tqe);
  755                 ++gdt_stat.req_queue_act;
  756                 if (gdt_stat.req_queue_act > gdt_stat.req_queue_max)
  757                     gdt_stat.req_queue_max = gdt_stat.req_queue_act;
  758                 next_cmd = FALSE;
  759             }
  760         } else if (target >= GDT_MAX_HDRIVES || 
  761                    !gdt->sc_hdr[target].hd_present || lun != 0) {
  762             ccbh->status = CAM_DEV_NOT_THERE;
  763             --gdt_stat.io_count_act;
  764             xpt_done(ccb);
  765         } else {
  766             /* cache service command */
  767             if (cmd == READ_6  || cmd == WRITE_6 ||
  768                 cmd == READ_10 || cmd == WRITE_10) {
  769                 if ((gccb = gdt_cache_cmd(gdt, ccb, &lock)) == NULL) {
  770                     TAILQ_INSERT_HEAD(&gdt->sc_ccb_queue, &ccb->ccb_h, 
  771                                       sim_links.tqe);
  772                     ++gdt_stat.req_queue_act;
  773                     if (gdt_stat.req_queue_act > gdt_stat.req_queue_max)
  774                         gdt_stat.req_queue_max = gdt_stat.req_queue_act;
  775                     next_cmd = FALSE;
  776                 }
  777             } else {
  778                 splx(lock);
  779                 gdt_internal_cache_cmd(gdt, ccb);
  780                 lock = splcam();
  781             }
  782         }           
  783         if ((gdt->sc_state & GDT_POLLING) || !next_cmd)
  784             break;
  785     }
  786     if (gdt->sc_cmd_cnt > 0)
  787         gdt->sc_release_event(gdt);
  788 
  789     splx(lock);
  790 
  791     if ((gdt->sc_state & GDT_POLLING) && gdt->sc_cmd_cnt > 0) {
  792         gdt_wait(gdt, gccb, GDT_POLL_TIMEOUT);
  793     }
  794 }
  795 
  796 static struct gdt_ccb *
  797 gdt_raw_cmd(struct gdt_softc *gdt, union ccb *ccb, int *lock)
  798 {
  799     struct gdt_ccb *gccb;
  800     struct cam_sim *sim;
  801 
  802     GDT_DPRINTF(GDT_D_CMD, ("gdt_raw_cmd(%p, %p)\n", gdt, ccb));
  803 
  804     if (roundup(GDT_CMD_UNION + GDT_RAW_SZ, sizeof(u_int32_t)) +
  805         gdt->sc_cmd_off + GDT_DPMEM_COMMAND_OFFSET >
  806         gdt->sc_ic_all_size) {
  807         GDT_DPRINTF(GDT_D_INVALID, ("iir%d: gdt_raw_cmd(): DPMEM overflow\n", 
  808                                     gdt->sc_hanum));
  809         return (NULL);
  810     }
  811 
  812     gccb = gdt_get_ccb(gdt);
  813     if (gccb == NULL) {
  814         GDT_DPRINTF(GDT_D_INVALID, ("iir%d: No free command index found\n",
  815                                     gdt->sc_hanum));
  816         return (gccb);
  817     }
  818     bzero(gccb->gc_cmd, GDT_CMD_SZ);
  819     sim = (struct cam_sim *)ccb->ccb_h.ccb_sim_ptr;
  820     gccb->gc_ccb = ccb;
  821     gccb->gc_service = GDT_SCSIRAWSERVICE;
  822     gccb->gc_flags = GDT_GCF_SCSI;
  823         
  824     if (gdt->sc_cmd_cnt == 0)
  825         gdt->sc_set_sema0(gdt);
  826     splx(*lock);
  827     gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
  828               gccb->gc_cmd_index);
  829     gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, GDT_WRITE);
  830 
  831     gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_DIRECTION,
  832               (ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN ?
  833               GDT_DATA_IN : GDT_DATA_OUT);
  834     gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SDLEN,
  835               ccb->csio.dxfer_len);
  836     gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_CLEN,
  837               ccb->csio.cdb_len);
  838     bcopy(ccb->csio.cdb_io.cdb_bytes, gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_CMD,
  839           ccb->csio.cdb_len);
  840     gccb->gc_cmd[GDT_CMD_UNION + GDT_RAW_TARGET] = 
  841         ccb->ccb_h.target_id;
  842     gccb->gc_cmd[GDT_CMD_UNION + GDT_RAW_LUN] = 
  843         ccb->ccb_h.target_lun;
  844     gccb->gc_cmd[GDT_CMD_UNION + GDT_RAW_BUS] = 
  845         cam_sim_bus(sim);
  846     gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SENSE_LEN,
  847               sizeof(struct scsi_sense_data));
  848     gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SENSE_DATA,
  849               gccb->gc_scratch_busbase);
  850  
  851     /*
  852      * If we have any data to send with this command,
  853      * map it into bus space.
  854      */
  855     /* Only use S/G if there is a transfer */
  856     if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
  857         if ((ccb->ccb_h.flags & CAM_SCATTER_VALID) == 0) { 
  858             if ((ccb->ccb_h.flags & CAM_DATA_PHYS) == 0) {
  859                 int s;
  860                 int error;
  861             
  862                 /* vorher unlock von splcam() ??? */
  863                 s = splsoftvm();
  864                 error =
  865                     bus_dmamap_load(gdt->sc_buffer_dmat,
  866                                     gccb->gc_dmamap,
  867                                     ccb->csio.data_ptr,
  868                                     ccb->csio.dxfer_len,
  869                                     gdtexecuteccb,
  870                                     gccb, /*flags*/0);
  871                 if (error == EINPROGRESS) {
  872                     xpt_freeze_simq(sim, 1);
  873                     gccb->gc_ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
  874                 }
  875                 splx(s);
  876             } else {
  877                 panic("iir: CAM_DATA_PHYS not supported");
  878             }
  879         } else {
  880             struct bus_dma_segment *segs;
  881 
  882             if ((ccb->ccb_h.flags & CAM_DATA_PHYS) != 0)
  883                 panic("iir%d: iir_action - Physical "
  884                       "segment pointers unsupported", gdt->sc_hanum);
  885 
  886             if ((ccb->ccb_h.flags & CAM_SG_LIST_PHYS)==0)
  887                 panic("iir%d: iir_action - Virtual "
  888                       "segment addresses unsupported", gdt->sc_hanum);
  889 
  890             /* Just use the segments provided */
  891             segs = (struct bus_dma_segment *)ccb->csio.data_ptr;
  892             gdtexecuteccb(gccb, segs, ccb->csio.sglist_cnt, 0);
  893         }
  894     } else {
  895         gdtexecuteccb(gccb, NULL, 0, 0);
  896     }
  897 
  898     *lock = splcam();
  899     return (gccb);
  900 }
  901 
  902 static struct gdt_ccb *
  903 gdt_cache_cmd(struct gdt_softc *gdt, union ccb *ccb, int *lock)
  904 {
  905     struct gdt_ccb *gccb;
  906     struct cam_sim *sim;
  907     u_int8_t *cmdp;
  908     u_int16_t opcode;
  909     u_int32_t blockno, blockcnt;
  910 
  911     GDT_DPRINTF(GDT_D_CMD, ("gdt_cache_cmd(%p, %p)\n", gdt, ccb));
  912 
  913     if (roundup(GDT_CMD_UNION + GDT_CACHE_SZ, sizeof(u_int32_t)) +
  914         gdt->sc_cmd_off + GDT_DPMEM_COMMAND_OFFSET >
  915         gdt->sc_ic_all_size) {
  916         GDT_DPRINTF(GDT_D_INVALID, ("iir%d: gdt_cache_cmd(): DPMEM overflow\n", 
  917                                     gdt->sc_hanum));
  918         return (NULL);
  919     }
  920 
  921     gccb = gdt_get_ccb(gdt);
  922     if (gccb == NULL) {
  923         GDT_DPRINTF(GDT_D_DEBUG, ("iir%d: No free command index found\n",
  924                                   gdt->sc_hanum));
  925         return (gccb);
  926     }
  927     bzero(gccb->gc_cmd, GDT_CMD_SZ);
  928     sim = (struct cam_sim *)ccb->ccb_h.ccb_sim_ptr;
  929     gccb->gc_ccb = ccb;
  930     gccb->gc_service = GDT_CACHESERVICE;
  931     gccb->gc_flags = GDT_GCF_SCSI;
  932         
  933     if (gdt->sc_cmd_cnt == 0)
  934         gdt->sc_set_sema0(gdt);
  935     splx(*lock);
  936     gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
  937               gccb->gc_cmd_index);
  938     cmdp = ccb->csio.cdb_io.cdb_bytes;
  939     opcode = (*cmdp == WRITE_6 || *cmdp == WRITE_10) ? GDT_WRITE : GDT_READ;
  940     if ((gdt->sc_state & GDT_SHUTDOWN) && opcode == GDT_WRITE)
  941         opcode = GDT_WRITE_THR;
  942     gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, opcode);
  943  
  944     gdt_enc16(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_DEVICENO,
  945               ccb->ccb_h.target_id);
  946     if (ccb->csio.cdb_len == 6) {
  947         struct scsi_rw_6 *rw = (struct scsi_rw_6 *)cmdp;
  948         blockno = scsi_3btoul(rw->addr) & ((SRW_TOPADDR<<16) | 0xffff);
  949         blockcnt = rw->length ? rw->length : 0x100;
  950     } else {
  951         struct scsi_rw_10 *rw = (struct scsi_rw_10 *)cmdp;
  952         blockno = scsi_4btoul(rw->addr);
  953         blockcnt = scsi_2btoul(rw->length);
  954     }
  955     gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_BLOCKNO,
  956               blockno);
  957     gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_BLOCKCNT,
  958               blockcnt);
  959 
  960     /*
  961      * If we have any data to send with this command,
  962      * map it into bus space.
  963      */
  964     /* Only use S/G if there is a transfer */
  965     if ((ccb->ccb_h.flags & CAM_SCATTER_VALID) == 0) { 
  966         if ((ccb->ccb_h.flags & CAM_DATA_PHYS) == 0) {
  967             int s;
  968             int error;
  969             
  970             /* vorher unlock von splcam() ??? */
  971             s = splsoftvm();
  972             error =
  973                 bus_dmamap_load(gdt->sc_buffer_dmat,
  974                                 gccb->gc_dmamap,
  975                                 ccb->csio.data_ptr,
  976                                 ccb->csio.dxfer_len,
  977                                 gdtexecuteccb,
  978                                 gccb, /*flags*/0);
  979             if (error == EINPROGRESS) {
  980                 xpt_freeze_simq(sim, 1);
  981                 gccb->gc_ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
  982             }
  983             splx(s);
  984         } else {
  985             panic("iir: CAM_DATA_PHYS not supported");
  986         }
  987     } else {
  988         struct bus_dma_segment *segs;
  989 
  990         if ((ccb->ccb_h.flags & CAM_DATA_PHYS) != 0)
  991             panic("iir%d: iir_action - Physical "
  992                   "segment pointers unsupported", gdt->sc_hanum);
  993 
  994         if ((ccb->ccb_h.flags & CAM_SG_LIST_PHYS)==0)
  995             panic("iir%d: iir_action - Virtual "
  996                   "segment addresses unsupported", gdt->sc_hanum);
  997 
  998         /* Just use the segments provided */
  999         segs = (struct bus_dma_segment *)ccb->csio.data_ptr;
 1000         gdtexecuteccb(gccb, segs, ccb->csio.sglist_cnt, 0);
 1001     }
 1002 
 1003     *lock = splcam();
 1004     return (gccb);
 1005 }
 1006 
 1007 static struct gdt_ccb *
 1008 gdt_ioctl_cmd(struct gdt_softc *gdt, gdt_ucmd_t *ucmd, int *lock)
 1009 {
 1010     struct gdt_ccb *gccb;
 1011     u_int32_t cnt;
 1012 
 1013     GDT_DPRINTF(GDT_D_DEBUG, ("gdt_ioctl_cmd(%p, %p)\n", gdt, ucmd));
 1014 
 1015     gccb = gdt_get_ccb(gdt);
 1016     if (gccb == NULL) {
 1017         GDT_DPRINTF(GDT_D_DEBUG, ("iir%d: No free command index found\n",
 1018                                   gdt->sc_hanum));
 1019         return (gccb);
 1020     }
 1021     bzero(gccb->gc_cmd, GDT_CMD_SZ);
 1022     gccb->gc_ucmd = ucmd;
 1023     gccb->gc_service = ucmd->service;
 1024     gccb->gc_flags = GDT_GCF_IOCTL;
 1025         
 1026     /* check DPMEM space, copy data buffer from user space */
 1027     if (ucmd->service == GDT_CACHESERVICE) {
 1028         if (ucmd->OpCode == GDT_IOCTL) {
 1029             gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_IOCTL_SZ,
 1030                                       sizeof(u_int32_t));
 1031             cnt = ucmd->u.ioctl.param_size;
 1032             if (cnt > GDT_SCRATCH_SZ) {
 1033                 printf("iir%d: Scratch buffer too small (%d/%d)\n", 
 1034                        gdt->sc_hanum, GDT_SCRATCH_SZ, cnt);
 1035                 gdt_free_ccb(gdt, gccb);
 1036                 return (NULL);
 1037             }
 1038         } else {
 1039             gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_CACHE_SG_LST +
 1040                                       GDT_SG_SZ, sizeof(u_int32_t));
 1041             cnt = ucmd->u.cache.BlockCnt * GDT_SECTOR_SIZE;
 1042             if (cnt > GDT_SCRATCH_SZ) {
 1043                 printf("iir%d: Scratch buffer too small (%d/%d)\n", 
 1044                        gdt->sc_hanum, GDT_SCRATCH_SZ, cnt);
 1045                 gdt_free_ccb(gdt, gccb);
 1046                 return (NULL);
 1047             }
 1048         }
 1049     } else {
 1050         gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_RAW_SG_LST +
 1051                                   GDT_SG_SZ, sizeof(u_int32_t));
 1052         cnt = ucmd->u.raw.sdlen;
 1053         if (cnt + ucmd->u.raw.sense_len > GDT_SCRATCH_SZ) {
 1054             printf("iir%d: Scratch buffer too small (%d/%d)\n", 
 1055                    gdt->sc_hanum, GDT_SCRATCH_SZ, cnt + ucmd->u.raw.sense_len);
 1056             gdt_free_ccb(gdt, gccb);
 1057             return (NULL);
 1058         }
 1059     }
 1060     if (cnt != 0) 
 1061         bcopy(ucmd->data, gccb->gc_scratch, cnt);
 1062 
 1063     if (gdt->sc_cmd_off + gccb->gc_cmd_len + GDT_DPMEM_COMMAND_OFFSET >
 1064         gdt->sc_ic_all_size) {
 1065         GDT_DPRINTF(GDT_D_INVALID, ("iir%d: gdt_ioctl_cmd(): DPMEM overflow\n", 
 1066                                     gdt->sc_hanum));
 1067         gdt_free_ccb(gdt, gccb);
 1068         return (NULL);
 1069     }
 1070 
 1071     if (gdt->sc_cmd_cnt == 0)
 1072         gdt->sc_set_sema0(gdt);
 1073     splx(*lock);
 1074 
 1075     /* fill cmd structure */
 1076     gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
 1077               gccb->gc_cmd_index);
 1078     gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, 
 1079               ucmd->OpCode);
 1080 
 1081     if (ucmd->service == GDT_CACHESERVICE) {
 1082         if (ucmd->OpCode == GDT_IOCTL) {
 1083             /* IOCTL */
 1084             gdt_enc16(gccb->gc_cmd + GDT_CMD_UNION + GDT_IOCTL_PARAM_SIZE,
 1085                       ucmd->u.ioctl.param_size);
 1086             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_IOCTL_SUBFUNC,
 1087                       ucmd->u.ioctl.subfunc);
 1088             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_IOCTL_CHANNEL,
 1089                       ucmd->u.ioctl.channel);
 1090             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_IOCTL_P_PARAM,
 1091                       gccb->gc_scratch_busbase);
 1092         } else {
 1093             /* cache service command */
 1094             gdt_enc16(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_DEVICENO,
 1095                       ucmd->u.cache.DeviceNo);
 1096             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_BLOCKNO,
 1097                       ucmd->u.cache.BlockNo);
 1098             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_BLOCKCNT,
 1099                       ucmd->u.cache.BlockCnt);
 1100             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_DESTADDR,
 1101                       0xffffffffUL);
 1102             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_SG_CANZ,
 1103                       1);
 1104             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_SG_LST + 
 1105                       GDT_SG_PTR, gccb->gc_scratch_busbase);
 1106             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_SG_LST +
 1107                       GDT_SG_LEN, ucmd->u.cache.BlockCnt * GDT_SECTOR_SIZE);
 1108         }
 1109     } else {
 1110         /* raw service command */
 1111         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_DIRECTION,
 1112                   ucmd->u.raw.direction);
 1113         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SDATA,
 1114                   0xffffffffUL);
 1115         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SDLEN,
 1116                   ucmd->u.raw.sdlen);
 1117         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_CLEN,
 1118                   ucmd->u.raw.clen);
 1119         bcopy(ucmd->u.raw.cmd, gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_CMD,
 1120               12);
 1121         gccb->gc_cmd[GDT_CMD_UNION + GDT_RAW_TARGET] = 
 1122             ucmd->u.raw.target;
 1123         gccb->gc_cmd[GDT_CMD_UNION + GDT_RAW_LUN] = 
 1124             ucmd->u.raw.lun;
 1125         gccb->gc_cmd[GDT_CMD_UNION + GDT_RAW_BUS] = 
 1126             ucmd->u.raw.bus;
 1127         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SENSE_LEN,
 1128                   ucmd->u.raw.sense_len);
 1129         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SENSE_DATA,
 1130                   gccb->gc_scratch_busbase + ucmd->u.raw.sdlen);
 1131         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SG_RANZ,
 1132                   1);
 1133         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SG_LST + 
 1134                   GDT_SG_PTR, gccb->gc_scratch_busbase);
 1135         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SG_LST +
 1136                   GDT_SG_LEN, ucmd->u.raw.sdlen);
 1137     }
 1138 
 1139     *lock = splcam();
 1140     gdt_stat.sg_count_act = 1;
 1141     gdt->sc_copy_cmd(gdt, gccb);
 1142     return (gccb);
 1143 }
 1144 
 1145 static void 
 1146 gdt_internal_cache_cmd(struct gdt_softc *gdt,union ccb *ccb)
 1147 {
 1148     int t;
 1149 
 1150     t = ccb->ccb_h.target_id;
 1151     GDT_DPRINTF(GDT_D_CMD, ("gdt_internal_cache_cmd(%p, %p, 0x%x, %d)\n", 
 1152         gdt, ccb, ccb->csio.cdb_io.cdb_bytes[0], t));
 1153 
 1154     switch (ccb->csio.cdb_io.cdb_bytes[0]) {
 1155       case TEST_UNIT_READY:
 1156       case START_STOP:
 1157         break;
 1158       case REQUEST_SENSE:
 1159         GDT_DPRINTF(GDT_D_MISC, ("REQUEST_SENSE\n"));
 1160         break;
 1161       case INQUIRY:
 1162         {
 1163             struct scsi_inquiry_data *inq;
 1164 
 1165             inq = (struct scsi_inquiry_data *)ccb->csio.data_ptr;       
 1166             bzero(inq, sizeof(struct scsi_inquiry_data));
 1167             inq->device = (gdt->sc_hdr[t].hd_devtype & 4) ?
 1168                 T_CDROM : T_DIRECT;
 1169             inq->dev_qual2 = (gdt->sc_hdr[t].hd_devtype & 1) ? 0x80 : 0;
 1170             inq->version = SCSI_REV_2;
 1171             inq->response_format = 2; 
 1172             inq->additional_length = 32; 
 1173             inq->flags = SID_CmdQue | SID_Sync; 
 1174             strcpy(inq->vendor, gdt->oem_name);
 1175             sprintf(inq->product, "Host Drive   #%02d", t);
 1176             strcpy(inq->revision, "   ");
 1177             break;
 1178         }
 1179       case MODE_SENSE_6:
 1180         {
 1181             struct mpd_data {
 1182                 struct scsi_mode_hdr_6 hd;
 1183                 struct scsi_mode_block_descr bd;
 1184                 struct scsi_control_page cp;
 1185             } *mpd;
 1186             u_int8_t page;
 1187 
 1188             mpd = (struct mpd_data *)ccb->csio.data_ptr;        
 1189             bzero(mpd, sizeof(struct mpd_data));
 1190             mpd->hd.datalen = sizeof(struct scsi_mode_hdr_6) +
 1191                 sizeof(struct scsi_mode_block_descr);
 1192             mpd->hd.dev_specific = (gdt->sc_hdr[t].hd_devtype & 2) ? 0x80 : 0;
 1193             mpd->hd.block_descr_len = sizeof(struct scsi_mode_block_descr);
 1194             mpd->bd.block_len[0] = (GDT_SECTOR_SIZE & 0x00ff0000) >> 16;
 1195             mpd->bd.block_len[1] = (GDT_SECTOR_SIZE & 0x0000ff00) >> 8;
 1196             mpd->bd.block_len[2] = (GDT_SECTOR_SIZE & 0x000000ff);
 1197             page=((struct scsi_mode_sense_6 *)ccb->csio.cdb_io.cdb_bytes)->page;
 1198             switch (page) {
 1199               default:
 1200                 GDT_DPRINTF(GDT_D_MISC, ("MODE_SENSE_6: page 0x%x\n", page));
 1201                 break;
 1202             }
 1203             break;
 1204         }
 1205       case READ_CAPACITY:
 1206         {
 1207             struct scsi_read_capacity_data *rcd;
 1208               
 1209             rcd = (struct scsi_read_capacity_data *)ccb->csio.data_ptr; 
 1210             bzero(rcd, sizeof(struct scsi_read_capacity_data));
 1211             scsi_ulto4b(gdt->sc_hdr[t].hd_size - 1, rcd->addr);
 1212             scsi_ulto4b(GDT_SECTOR_SIZE, rcd->length);
 1213             break;
 1214         }
 1215       default:
 1216         GDT_DPRINTF(GDT_D_MISC, ("gdt_internal_cache_cmd(%d) unknown\n", 
 1217                                     ccb->csio.cdb_io.cdb_bytes[0]));
 1218         break;
 1219     }
 1220     ccb->ccb_h.status |= CAM_REQ_CMP;
 1221     --gdt_stat.io_count_act;
 1222     xpt_done(ccb);
 1223 }
 1224 
 1225 static void     
 1226 gdtmapmem(void *arg, bus_dma_segment_t *dm_segs, int nseg, int error)
 1227 {
 1228     bus_addr_t *busaddrp;
 1229     
 1230     busaddrp = (bus_addr_t *)arg;
 1231     *busaddrp = dm_segs->ds_addr;
 1232 }
 1233 
 1234 static void     
 1235 gdtexecuteccb(void *arg, bus_dma_segment_t *dm_segs, int nseg, int error)
 1236 {
 1237     struct gdt_ccb *gccb;
 1238     union ccb *ccb;
 1239     struct gdt_softc *gdt;
 1240     int i, lock;
 1241 
 1242     lock = splcam();
 1243 
 1244     gccb = (struct gdt_ccb *)arg;
 1245     ccb = gccb->gc_ccb;
 1246     gdt = cam_sim_softc((struct cam_sim *)ccb->ccb_h.ccb_sim_ptr);
 1247 
 1248     GDT_DPRINTF(GDT_D_CMD, ("gdtexecuteccb(%p, %p, %p, %d, %d)\n", 
 1249                             gdt, gccb, dm_segs, nseg, error));
 1250     gdt_stat.sg_count_act = nseg;
 1251     if (nseg > gdt_stat.sg_count_max)
 1252         gdt_stat.sg_count_max = nseg;
 1253 
 1254     /* Copy the segments into our SG list */
 1255     if (gccb->gc_service == GDT_CACHESERVICE) {
 1256         for (i = 0; i < nseg; ++i) {
 1257             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_SG_LST +
 1258                       i * GDT_SG_SZ + GDT_SG_PTR, dm_segs->ds_addr);
 1259             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_SG_LST +
 1260                       i * GDT_SG_SZ + GDT_SG_LEN, dm_segs->ds_len);
 1261             dm_segs++;
 1262         }
 1263         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_SG_CANZ,      
 1264                   nseg);
 1265         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_DESTADDR, 
 1266                   0xffffffffUL);
 1267 
 1268         gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_CACHE_SG_LST +
 1269                                   nseg * GDT_SG_SZ, sizeof(u_int32_t));
 1270     } else {
 1271         for (i = 0; i < nseg; ++i) {
 1272             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SG_LST +
 1273                       i * GDT_SG_SZ + GDT_SG_PTR, dm_segs->ds_addr);
 1274             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SG_LST +
 1275                       i * GDT_SG_SZ + GDT_SG_LEN, dm_segs->ds_len);
 1276             dm_segs++;
 1277         }
 1278         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SG_RANZ,        
 1279                   nseg);
 1280         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SDATA, 
 1281                   0xffffffffUL);
 1282 
 1283         gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_RAW_SG_LST +
 1284                                   nseg * GDT_SG_SZ, sizeof(u_int32_t));
 1285     }
 1286 
 1287     if (nseg != 0) {
 1288         bus_dmamap_sync(gdt->sc_buffer_dmat, gccb->gc_dmamap, 
 1289             (ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN ?
 1290             BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
 1291     }
 1292     
 1293     /* We must NOT abort the command here if CAM_REQ_INPROG is not set,
 1294      * because command semaphore is already set!
 1295      */
 1296     
 1297     ccb->ccb_h.status |= CAM_SIM_QUEUED;
 1298     /* timeout handling */
 1299     ccb->ccb_h.timeout_ch =
 1300         timeout(iir_timeout, (caddr_t)gccb,
 1301                 (ccb->ccb_h.timeout * hz) / 1000);
 1302 
 1303     gdt->sc_copy_cmd(gdt, gccb);
 1304     splx(lock);
 1305 }
 1306 
 1307 
 1308 static void     
 1309 iir_action( struct cam_sim *sim, union ccb *ccb )
 1310 {
 1311     struct gdt_softc *gdt;
 1312     int lock, bus, target, lun;
 1313 
 1314     gdt = (struct gdt_softc *)cam_sim_softc( sim );
 1315     ccb->ccb_h.ccb_sim_ptr = sim;
 1316     bus = cam_sim_bus(sim);
 1317     target = ccb->ccb_h.target_id;
 1318     lun = ccb->ccb_h.target_lun;
 1319     GDT_DPRINTF(GDT_D_CMD, 
 1320                 ("iir_action(%p) func 0x%x cmd 0x%x bus %d target %d lun %d\n", 
 1321                  gdt, ccb->ccb_h.func_code, ccb->csio.cdb_io.cdb_bytes[0], 
 1322                  bus, target, lun)); 
 1323     ++gdt_stat.io_count_act;
 1324     if (gdt_stat.io_count_act > gdt_stat.io_count_max)
 1325         gdt_stat.io_count_max = gdt_stat.io_count_act;
 1326 
 1327     switch (ccb->ccb_h.func_code) {
 1328       case XPT_SCSI_IO:
 1329         lock = splcam();
 1330         TAILQ_INSERT_TAIL(&gdt->sc_ccb_queue, &ccb->ccb_h, sim_links.tqe);
 1331         ++gdt_stat.req_queue_act;
 1332         if (gdt_stat.req_queue_act > gdt_stat.req_queue_max)
 1333             gdt_stat.req_queue_max = gdt_stat.req_queue_act;
 1334         splx(lock);
 1335         gdt_next(gdt);
 1336         break;
 1337       case XPT_RESET_DEV:   /* Bus Device Reset the specified SCSI device */
 1338       case XPT_ABORT:                       /* Abort the specified CCB */
 1339         /* XXX Implement */
 1340         ccb->ccb_h.status = CAM_REQ_INVALID;
 1341         --gdt_stat.io_count_act;
 1342         xpt_done(ccb);
 1343         break;
 1344       case XPT_SET_TRAN_SETTINGS:
 1345         ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
 1346         --gdt_stat.io_count_act;
 1347         xpt_done(ccb);  
 1348         break;
 1349       case XPT_GET_TRAN_SETTINGS:
 1350         /* Get default/user set transfer settings for the target */
 1351           {
 1352               struct        ccb_trans_settings *cts;
 1353               u_int target_mask;
 1354               
 1355               cts = &ccb->cts;
 1356               target_mask = 0x01 << target;
 1357               if ((cts->flags & CCB_TRANS_USER_SETTINGS) != 0) { 
 1358                   cts->flags = CCB_TRANS_DISC_ENB|CCB_TRANS_TAG_ENB;
 1359                   cts->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
 1360                   cts->sync_period = 25; /* 10MHz */
 1361                   if (cts->sync_period != 0)
 1362                       cts->sync_offset = 15;
 1363                   
 1364                   cts->valid = CCB_TRANS_SYNC_RATE_VALID
 1365                       | CCB_TRANS_SYNC_OFFSET_VALID
 1366                       | CCB_TRANS_BUS_WIDTH_VALID
 1367                       | CCB_TRANS_DISC_VALID
 1368                       | CCB_TRANS_TQ_VALID;
 1369                   ccb->ccb_h.status = CAM_REQ_CMP;
 1370               } else {
 1371                   ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
 1372               }
 1373               --gdt_stat.io_count_act;
 1374               xpt_done(ccb);
 1375               break;
 1376           }
 1377       case XPT_CALC_GEOMETRY:
 1378           {
 1379               struct ccb_calc_geometry *ccg;
 1380               u_int32_t secs_per_cylinder;
 1381 
 1382               ccg = &ccb->ccg;
 1383               ccg->heads = gdt->sc_hdr[target].hd_heads;
 1384               ccg->secs_per_track = gdt->sc_hdr[target].hd_secs;
 1385               secs_per_cylinder = ccg->heads * ccg->secs_per_track;
 1386               ccg->cylinders = ccg->volume_size / secs_per_cylinder;
 1387               ccb->ccb_h.status = CAM_REQ_CMP;
 1388               --gdt_stat.io_count_act;
 1389               xpt_done(ccb);
 1390               break;
 1391           }
 1392       case XPT_RESET_BUS:           /* Reset the specified SCSI bus */
 1393           {
 1394               /* XXX Implement */
 1395               ccb->ccb_h.status = CAM_REQ_CMP;
 1396               --gdt_stat.io_count_act;
 1397               xpt_done(ccb);
 1398               break;
 1399           }
 1400       case XPT_TERM_IO:             /* Terminate the I/O process */
 1401         /* XXX Implement */
 1402         ccb->ccb_h.status = CAM_REQ_INVALID;
 1403         --gdt_stat.io_count_act;
 1404         xpt_done(ccb);
 1405         break;
 1406       case XPT_PATH_INQ:            /* Path routing inquiry */
 1407           {
 1408               struct ccb_pathinq *cpi = &ccb->cpi;
 1409               
 1410               cpi->version_num = 1;
 1411               cpi->hba_inquiry = PI_SDTR_ABLE|PI_TAG_ABLE;
 1412               cpi->hba_inquiry |= PI_WIDE_16;
 1413               cpi->target_sprt = 1;
 1414               cpi->hba_misc = 0;
 1415               cpi->hba_eng_cnt = 0;
 1416               if (bus == gdt->sc_virt_bus)
 1417                   cpi->max_target = GDT_MAX_HDRIVES - 1;
 1418               else if (gdt->sc_class & GDT_FC)
 1419                   cpi->max_target = GDT_MAXID_FC - 1;
 1420               else
 1421                   cpi->max_target = GDT_MAXID - 1;
 1422               cpi->max_lun = 7;
 1423               cpi->unit_number = cam_sim_unit(sim);
 1424               cpi->bus_id = bus;
 1425               cpi->initiator_id = 
 1426                   (bus == gdt->sc_virt_bus ? 127 : gdt->sc_bus_id[bus]);
 1427               cpi->base_transfer_speed = 3300;
 1428               strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
 1429               if (gdt->sc_vendor == INTEL_VENDOR_ID)
 1430                   strncpy(cpi->hba_vid, "Intel Corp.", HBA_IDLEN);
 1431               else
 1432                   strncpy(cpi->hba_vid, "ICP vortex ", HBA_IDLEN);
 1433               strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
 1434               cpi->ccb_h.status = CAM_REQ_CMP;
 1435               --gdt_stat.io_count_act;
 1436               xpt_done(ccb);
 1437               break;
 1438           }
 1439       default:
 1440         GDT_DPRINTF(GDT_D_INVALID, ("gdt_next(%p) cmd 0x%x invalid\n", 
 1441                                     gdt, ccb->ccb_h.func_code));
 1442         ccb->ccb_h.status = CAM_REQ_INVALID;
 1443         --gdt_stat.io_count_act;
 1444         xpt_done(ccb);
 1445         break;
 1446     }
 1447 }
 1448 
 1449 static void     
 1450 iir_poll( struct cam_sim *sim )
 1451 {
 1452     struct gdt_softc *gdt;
 1453 
 1454     gdt = (struct gdt_softc *)cam_sim_softc( sim );
 1455     GDT_DPRINTF(GDT_D_CMD, ("iir_poll sim %p gdt %p\n", sim, gdt));
 1456     iir_intr(gdt);
 1457 }
 1458 
 1459 static void     
 1460 iir_timeout(void *arg)
 1461 {
 1462     GDT_DPRINTF(GDT_D_TIMEOUT, ("iir_timeout(%p)\n", gccb));
 1463 }
 1464 
 1465 static void
 1466 iir_watchdog(void *arg)
 1467 {
 1468     struct gdt_softc *gdt;
 1469 
 1470     gdt = (struct gdt_softc *)arg;
 1471     GDT_DPRINTF(GDT_D_DEBUG, ("iir_watchdog(%p)\n", gdt));
 1472 
 1473     {
 1474         int ccbs = 0, ucmds = 0, frees = 0, pends = 0;
 1475         struct gdt_ccb *p;
 1476         struct ccb_hdr *h;
 1477         struct gdt_ucmd *u;
 1478 
 1479         for (h = TAILQ_FIRST(&gdt->sc_ccb_queue); h != NULL; 
 1480              h = TAILQ_NEXT(h, sim_links.tqe))
 1481             ccbs++;
 1482         for (u = TAILQ_FIRST(&gdt->sc_ucmd_queue); u != NULL; 
 1483              u = TAILQ_NEXT(u, links))
 1484             ucmds++;
 1485         for (p = SLIST_FIRST(&gdt->sc_free_gccb); p != NULL; 
 1486              p = SLIST_NEXT(p, sle))
 1487             frees++;
 1488         for (p = SLIST_FIRST(&gdt->sc_pending_gccb); p != NULL; 
 1489              p = SLIST_NEXT(p, sle))
 1490             pends++;
 1491 
 1492         GDT_DPRINTF(GDT_D_TIMEOUT, ("ccbs %d ucmds %d frees %d pends %d\n",
 1493                ccbs, ucmds, frees, pends));
 1494     }
 1495 
 1496     timeout(iir_watchdog, (caddr_t)gdt, hz * 15);
 1497 }
 1498 
 1499 static void     
 1500 iir_shutdown( void *arg, int howto )
 1501 {
 1502     struct gdt_softc *gdt;
 1503     struct gdt_ccb *gccb;
 1504     gdt_ucmd_t *ucmd;
 1505     int lock, i;
 1506 
 1507     gdt = (struct gdt_softc *)arg;
 1508     GDT_DPRINTF(GDT_D_CMD, ("iir_shutdown(%p, %d)\n", gdt, howto));
 1509 
 1510     printf("iir%d: Flushing all Host Drives. Please wait ...  ",
 1511            gdt->sc_hanum);
 1512 
 1513     /* allocate ucmd buffer */
 1514     ucmd = malloc(sizeof(gdt_ucmd_t), M_GDTBUF, M_NOWAIT);
 1515     if (ucmd == NULL) {
 1516         printf("iir%d: iir_shutdown(): Cannot allocate resource\n",
 1517                gdt->sc_hanum);
 1518         return;
 1519     }
 1520     bzero(ucmd, sizeof(gdt_ucmd_t));
 1521 
 1522     /* wait for pending IOs */
 1523     lock = splcam();
 1524     gdt->sc_state = GDT_SHUTDOWN;
 1525     splx(lock);
 1526     if ((gccb = SLIST_FIRST(&gdt->sc_pending_gccb)) != NULL)
 1527         (void) tsleep((void *)gccb, PCATCH | PRIBIO, "iirshw", 100 * hz);
 1528 
 1529     /* flush */
 1530     for (i = 0; i < GDT_MAX_HDRIVES; ++i) {
 1531         if (gdt->sc_hdr[i].hd_present) {
 1532             ucmd->service = GDT_CACHESERVICE;
 1533             ucmd->OpCode = GDT_FLUSH;
 1534             ucmd->u.cache.DeviceNo = i;
 1535             lock = splcam();
 1536             TAILQ_INSERT_TAIL(&gdt->sc_ucmd_queue, ucmd, links);
 1537             ucmd->complete_flag = FALSE;
 1538             splx(lock);
 1539             gdt_next(gdt);
 1540             if (!ucmd->complete_flag)
 1541                 (void) tsleep((void *)ucmd, PCATCH|PRIBIO, "iirshw", 10*hz);
 1542         }
 1543     }
 1544 
 1545     free(ucmd, M_DEVBUF);
 1546     printf("Done.\n");
 1547 }
 1548 
 1549 void
 1550 iir_intr(void *arg)
 1551 {
 1552     struct gdt_softc *gdt = arg;
 1553     struct gdt_intr_ctx ctx;
 1554     int lock = 0;
 1555     struct gdt_ccb *gccb;
 1556     gdt_ucmd_t *ucmd;
 1557     u_int32_t cnt;
 1558 
 1559     GDT_DPRINTF(GDT_D_INTR, ("gdt_intr(%p)\n", gdt));
 1560 
 1561     /* If polling and we were not called from gdt_wait, just return */
 1562     if ((gdt->sc_state & GDT_POLLING) &&
 1563         !(gdt->sc_state & GDT_POLL_WAIT))
 1564         return;
 1565 
 1566     if (!(gdt->sc_state & GDT_POLLING)) 
 1567         lock = splcam();
 1568     gdt_wait_index = 0;
 1569 
 1570     ctx.istatus = gdt->sc_get_status(gdt);
 1571     if (ctx.istatus == 0x00) {
 1572         if (!(gdt->sc_state & GDT_POLLING)) 
 1573             splx(lock);
 1574         gdt->sc_status = GDT_S_NO_STATUS;
 1575         return;
 1576     }
 1577 
 1578     gdt->sc_intr(gdt, &ctx);
 1579 
 1580     gdt->sc_status = ctx.cmd_status;
 1581     gdt->sc_service = ctx.service;
 1582     gdt->sc_info = ctx.info;
 1583     gdt->sc_info2 = ctx.info2;
 1584 
 1585     if (gdt->sc_state & GDT_POLL_WAIT) { 
 1586         gdt_wait_gdt = gdt;
 1587         gdt_wait_index = ctx.istatus;
 1588     }
 1589 
 1590     if (ctx.istatus == GDT_ASYNCINDEX) {
 1591         gdt_async_event(gdt, ctx.service);
 1592         if (!(gdt->sc_state & GDT_POLLING)) 
 1593             splx(lock);
 1594         return;
 1595     }
 1596     if (ctx.istatus == GDT_SPEZINDEX) {
 1597         GDT_DPRINTF(GDT_D_INVALID, 
 1598                     ("iir%d: Service unknown or not initialized!\n", 
 1599                      gdt->sc_hanum));   
 1600         gdt->sc_dvr.size = sizeof(gdt->sc_dvr.eu.driver);
 1601         gdt->sc_dvr.eu.driver.ionode = gdt->sc_hanum;
 1602         gdt_store_event(GDT_ES_DRIVER, 4, &gdt->sc_dvr);
 1603         if (!(gdt->sc_state & GDT_POLLING)) 
 1604             splx(lock);
 1605         return;
 1606     }
 1607 
 1608     gccb = &gdt->sc_gccbs[ctx.istatus - 2];
 1609     ctx.service = gccb->gc_service;
 1610 
 1611     switch (gccb->gc_flags) {
 1612       case GDT_GCF_UNUSED:
 1613         GDT_DPRINTF(GDT_D_INVALID, ("iir%d: Index (%d) to unused command!\n",
 1614                     gdt->sc_hanum, ctx.istatus));
 1615         gdt->sc_dvr.size = sizeof(gdt->sc_dvr.eu.driver);
 1616         gdt->sc_dvr.eu.driver.ionode = gdt->sc_hanum;
 1617         gdt->sc_dvr.eu.driver.index = ctx.istatus;
 1618         gdt_store_event(GDT_ES_DRIVER, 1, &gdt->sc_dvr);
 1619         gdt_free_ccb(gdt, gccb);
 1620         /* fallthrough */
 1621 
 1622       case GDT_GCF_INTERNAL:
 1623         if (!(gdt->sc_state & GDT_POLLING)) 
 1624             splx(lock);
 1625         break;
 1626 
 1627       case GDT_GCF_IOCTL:
 1628         ucmd = gccb->gc_ucmd; 
 1629         if (gdt->sc_status == GDT_S_BSY) {
 1630             GDT_DPRINTF(GDT_D_DEBUG, ("iir_intr(%p) ioctl: gccb %p busy\n", 
 1631                                       gdt, gccb));
 1632             TAILQ_INSERT_HEAD(&gdt->sc_ucmd_queue, ucmd, links);
 1633             if (!(gdt->sc_state & GDT_POLLING)) 
 1634                 splx(lock);
 1635         } else {
 1636             ucmd->status = gdt->sc_status;
 1637             ucmd->info = gdt->sc_info;
 1638             ucmd->complete_flag = TRUE;
 1639             if (ucmd->service == GDT_CACHESERVICE) {
 1640                 if (ucmd->OpCode == GDT_IOCTL) {
 1641                     cnt = ucmd->u.ioctl.param_size;
 1642                     if (cnt != 0)
 1643                         bcopy(gccb->gc_scratch, ucmd->data, cnt);
 1644                 } else {
 1645                     cnt = ucmd->u.cache.BlockCnt * GDT_SECTOR_SIZE;
 1646                     if (cnt != 0)
 1647                         bcopy(gccb->gc_scratch, ucmd->data, cnt);
 1648                 }
 1649             } else {
 1650                 cnt = ucmd->u.raw.sdlen;
 1651                 if (cnt != 0)
 1652                     bcopy(gccb->gc_scratch, ucmd->data, cnt);
 1653                 if (ucmd->u.raw.sense_len != 0) 
 1654                     bcopy(gccb->gc_scratch, ucmd->data, cnt);
 1655             }
 1656             gdt_free_ccb(gdt, gccb);
 1657             if (!(gdt->sc_state & GDT_POLLING)) 
 1658                 splx(lock);
 1659             /* wakeup */
 1660             wakeup(ucmd);
 1661         }
 1662         gdt_next(gdt); 
 1663         break;
 1664 
 1665       default:
 1666         gdt_free_ccb(gdt, gccb);
 1667         gdt_sync_event(gdt, ctx.service, ctx.istatus, gccb);
 1668         if (!(gdt->sc_state & GDT_POLLING)) 
 1669             splx(lock);
 1670         gdt_next(gdt); 
 1671         break;
 1672     }
 1673 }
 1674 
 1675 int
 1676 gdt_async_event(struct gdt_softc *gdt, int service)
 1677 {
 1678     struct gdt_ccb *gccb;
 1679 
 1680     GDT_DPRINTF(GDT_D_INTR, ("gdt_async_event(%p, %d)\n", gdt, service));
 1681 
 1682     if (service == GDT_SCREENSERVICE) {
 1683         if (gdt->sc_status == GDT_MSG_REQUEST) {
 1684             while (gdt->sc_test_busy(gdt))
 1685                 DELAY(1);
 1686             gccb = gdt_get_ccb(gdt);
 1687             if (gccb == NULL) {
 1688                 printf("iir%d: No free command index found\n",
 1689                        gdt->sc_hanum);
 1690                 return (1);
 1691             }
 1692             bzero(gccb->gc_cmd, GDT_CMD_SZ);
 1693             gccb->gc_service = service;
 1694             gccb->gc_flags = GDT_GCF_SCREEN;
 1695             gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
 1696                       gccb->gc_cmd_index);
 1697             gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, GDT_READ);
 1698             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_HANDLE,
 1699                       GDT_MSG_INV_HANDLE);
 1700             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_ADDR,
 1701                       gccb->gc_scratch_busbase);
 1702             gdt->sc_set_sema0(gdt);
 1703             gdt->sc_cmd_off = 0;
 1704             gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_SCREEN_SZ, 
 1705                                       sizeof(u_int32_t));
 1706             gdt->sc_cmd_cnt = 0;
 1707             gdt->sc_copy_cmd(gdt, gccb);
 1708             printf("iir%d: [PCI %d/%d] ",
 1709                 gdt->sc_hanum,gdt->sc_bus,gdt->sc_slot);
 1710             gdt->sc_release_event(gdt);
 1711         }
 1712 
 1713     } else {
 1714         if ((gdt->sc_fw_vers & 0xff) >= 0x1a) {
 1715             gdt->sc_dvr.size = 0;
 1716             gdt->sc_dvr.eu.async.ionode = gdt->sc_hanum;
 1717             gdt->sc_dvr.eu.async.status  = gdt->sc_status;
 1718             /* severity and event_string already set! */
 1719         } else {        
 1720             gdt->sc_dvr.size = sizeof(gdt->sc_dvr.eu.async);
 1721             gdt->sc_dvr.eu.async.ionode   = gdt->sc_hanum;
 1722             gdt->sc_dvr.eu.async.service = service;
 1723             gdt->sc_dvr.eu.async.status  = gdt->sc_status;
 1724             gdt->sc_dvr.eu.async.info    = gdt->sc_info;
 1725             *(u_int32_t *)gdt->sc_dvr.eu.async.scsi_coord  = gdt->sc_info2;
 1726         }
 1727         gdt_store_event(GDT_ES_ASYNC, service, &gdt->sc_dvr);
 1728         printf("iir%d: %s\n", gdt->sc_hanum, gdt->sc_dvr.event_string);
 1729     }
 1730     
 1731     return (0);
 1732 }
 1733 
 1734 int
 1735 gdt_sync_event(struct gdt_softc *gdt, int service, 
 1736                u_int8_t index, struct gdt_ccb *gccb)
 1737 {
 1738     union ccb *ccb;
 1739 
 1740     GDT_DPRINTF(GDT_D_INTR,
 1741                 ("gdt_sync_event(%p, %d, %d, %p)\n", gdt,service,index,gccb));
 1742 
 1743     ccb = gccb->gc_ccb;
 1744 
 1745     if (service == GDT_SCREENSERVICE) {
 1746         u_int32_t msg_len;
 1747 
 1748         msg_len = gdt_dec32(gccb->gc_scratch + GDT_SCR_MSG_LEN);
 1749         if (msg_len)
 1750             if (!(gccb->gc_scratch[GDT_SCR_MSG_ANSWER] && 
 1751                   gccb->gc_scratch[GDT_SCR_MSG_EXT])) {
 1752                 gccb->gc_scratch[GDT_SCR_MSG_TEXT + msg_len] = '\0';
 1753                 printf("%s",&gccb->gc_scratch[GDT_SCR_MSG_TEXT]);
 1754             }
 1755 
 1756         if (gccb->gc_scratch[GDT_SCR_MSG_EXT] && 
 1757             !gccb->gc_scratch[GDT_SCR_MSG_ANSWER]) {
 1758             while (gdt->sc_test_busy(gdt))
 1759                 DELAY(1);
 1760             bzero(gccb->gc_cmd, GDT_CMD_SZ);
 1761             gccb = gdt_get_ccb(gdt);
 1762             if (gccb == NULL) {
 1763                 printf("iir%d: No free command index found\n",
 1764                        gdt->sc_hanum);
 1765                 return (1);
 1766             }
 1767             gccb->gc_service = service;
 1768             gccb->gc_flags = GDT_GCF_SCREEN;
 1769             gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
 1770                       gccb->gc_cmd_index);
 1771             gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, GDT_READ);
 1772             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_HANDLE,
 1773                       gccb->gc_scratch[GDT_SCR_MSG_HANDLE]);
 1774             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_ADDR,
 1775                       gccb->gc_scratch_busbase);
 1776             gdt->sc_set_sema0(gdt);
 1777             gdt->sc_cmd_off = 0;
 1778             gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_SCREEN_SZ, 
 1779                                       sizeof(u_int32_t));
 1780             gdt->sc_cmd_cnt = 0;
 1781             gdt->sc_copy_cmd(gdt, gccb);
 1782             gdt->sc_release_event(gdt);
 1783             return (0);
 1784         }
 1785 
 1786         if (gccb->gc_scratch[GDT_SCR_MSG_ANSWER] && 
 1787             gdt_dec32(gccb->gc_scratch + GDT_SCR_MSG_ALEN)) {
 1788             /* default answers (getchar() not possible) */
 1789             if (gdt_dec32(gccb->gc_scratch + GDT_SCR_MSG_ALEN) == 1) {
 1790                 gdt_enc32(gccb->gc_scratch + GDT_SCR_MSG_ALEN, 0);
 1791                 gdt_enc32(gccb->gc_scratch + GDT_SCR_MSG_LEN, 1);
 1792                 gccb->gc_scratch[GDT_SCR_MSG_TEXT] = 0;
 1793             } else {
 1794                 gdt_enc32(gccb->gc_scratch + GDT_SCR_MSG_ALEN, 
 1795                           gdt_dec32(gccb->gc_scratch + GDT_SCR_MSG_ALEN) - 2);
 1796                 gdt_enc32(gccb->gc_scratch + GDT_SCR_MSG_LEN, 2);
 1797                 gccb->gc_scratch[GDT_SCR_MSG_TEXT] = 1;
 1798                 gccb->gc_scratch[GDT_SCR_MSG_TEXT + 1] = 0;
 1799             }
 1800             gccb->gc_scratch[GDT_SCR_MSG_EXT] = 0;
 1801             gccb->gc_scratch[GDT_SCR_MSG_ANSWER] = 0;
 1802             while (gdt->sc_test_busy(gdt))
 1803                 DELAY(1);
 1804             bzero(gccb->gc_cmd, GDT_CMD_SZ);
 1805             gccb = gdt_get_ccb(gdt);
 1806             if (gccb == NULL) {
 1807                 printf("iir%d: No free command index found\n",
 1808                        gdt->sc_hanum);
 1809                 return (1);
 1810             }
 1811             gccb->gc_service = service;
 1812             gccb->gc_flags = GDT_GCF_SCREEN;
 1813             gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
 1814                       gccb->gc_cmd_index);
 1815             gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, GDT_WRITE);
 1816             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_HANDLE,
 1817                       gccb->gc_scratch[GDT_SCR_MSG_HANDLE]);
 1818             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_ADDR,
 1819                       gccb->gc_scratch_busbase);
 1820             gdt->sc_set_sema0(gdt);
 1821             gdt->sc_cmd_off = 0;
 1822             gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_SCREEN_SZ, 
 1823                                       sizeof(u_int32_t));
 1824             gdt->sc_cmd_cnt = 0;
 1825             gdt->sc_copy_cmd(gdt, gccb);
 1826             gdt->sc_release_event(gdt);
 1827             return (0);
 1828         }
 1829         printf("\n");
 1830         return (0);
 1831     } else {
 1832         untimeout(iir_timeout, gccb, ccb->ccb_h.timeout_ch);
 1833         if (gdt->sc_status == GDT_S_BSY) {
 1834             GDT_DPRINTF(GDT_D_DEBUG, ("gdt_sync_event(%p) gccb %p busy\n", 
 1835                                       gdt, gccb));
 1836             TAILQ_INSERT_HEAD(&gdt->sc_ccb_queue, &ccb->ccb_h, sim_links.tqe);
 1837             ++gdt_stat.req_queue_act;
 1838             if (gdt_stat.req_queue_act > gdt_stat.req_queue_max)
 1839                 gdt_stat.req_queue_max = gdt_stat.req_queue_act;
 1840             return (2);
 1841         }
 1842 
 1843         bus_dmamap_sync(gdt->sc_buffer_dmat, gccb->gc_dmamap, 
 1844             (ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN ?
 1845             BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
 1846         bus_dmamap_unload(gdt->sc_buffer_dmat, gccb->gc_dmamap);
 1847 
 1848         ccb->csio.resid = 0;
 1849         if (gdt->sc_status == GDT_S_OK) {
 1850             ccb->ccb_h.status |= CAM_REQ_CMP;
 1851             ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
 1852         } else {
 1853             /* error */
 1854             if (gccb->gc_service == GDT_CACHESERVICE) {
 1855                 ccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR | CAM_AUTOSNS_VALID;
 1856                 ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
 1857                 ccb->csio.scsi_status = SCSI_STATUS_CHECK_COND;
 1858                 bzero(&ccb->csio.sense_data, ccb->csio.sense_len);
 1859                 ccb->csio.sense_data.error_code =
 1860                     SSD_CURRENT_ERROR | SSD_ERRCODE_VALID;
 1861                 ccb->csio.sense_data.flags = SSD_KEY_NOT_READY;
 1862 
 1863                 gdt->sc_dvr.size = sizeof(gdt->sc_dvr.eu.sync);
 1864                 gdt->sc_dvr.eu.sync.ionode  = gdt->sc_hanum;
 1865                 gdt->sc_dvr.eu.sync.service = service;
 1866                 gdt->sc_dvr.eu.sync.status  = gdt->sc_status;
 1867                 gdt->sc_dvr.eu.sync.info    = gdt->sc_info;
 1868                 gdt->sc_dvr.eu.sync.hostdrive = ccb->ccb_h.target_id;
 1869                 if (gdt->sc_status >= 0x8000)
 1870                     gdt_store_event(GDT_ES_SYNC, 0, &gdt->sc_dvr);
 1871                 else
 1872                     gdt_store_event(GDT_ES_SYNC, service, &gdt->sc_dvr);
 1873             } else {
 1874                 /* raw service */
 1875                 if (gdt->sc_status != GDT_S_RAW_SCSI || gdt->sc_info >= 0x100) {
 1876                     ccb->ccb_h.status = CAM_DEV_NOT_THERE;
 1877                 } else {
 1878                     ccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR|CAM_AUTOSNS_VALID;
 1879                     ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
 1880                     ccb->csio.scsi_status = gdt->sc_info;
 1881                     bcopy(gccb->gc_scratch, &ccb->csio.sense_data,
 1882                           ccb->csio.sense_len);
 1883                 }
 1884             }
 1885         }
 1886         --gdt_stat.io_count_act;
 1887         xpt_done(ccb);
 1888     }
 1889     return (0);
 1890 }
 1891 
 1892 /* Controller event handling functions */
 1893 gdt_evt_str *gdt_store_event(u_int16_t source, u_int16_t idx,
 1894                              gdt_evt_data *evt)
 1895 {
 1896     gdt_evt_str *e;
 1897     struct timeval tv;
 1898 
 1899     GDT_DPRINTF(GDT_D_MISC, ("gdt_store_event(%d, %d)\n", source, idx));
 1900     if (source == 0)                        /* no source -> no event */
 1901         return 0;
 1902 
 1903     if (ebuffer[elastidx].event_source == source &&
 1904         ebuffer[elastidx].event_idx == idx &&
 1905         ((evt->size != 0 && ebuffer[elastidx].event_data.size != 0 &&
 1906           !memcmp((char *)&ebuffer[elastidx].event_data.eu,
 1907                   (char *)&evt->eu, evt->size)) ||
 1908          (evt->size == 0 && ebuffer[elastidx].event_data.size == 0 &&
 1909           !strcmp((char *)&ebuffer[elastidx].event_data.event_string,
 1910                   (char *)&evt->event_string)))) { 
 1911         e = &ebuffer[elastidx];
 1912         getmicrotime(&tv);
 1913         e->last_stamp = tv.tv_sec;
 1914         ++e->same_count;
 1915     } else {
 1916         if (ebuffer[elastidx].event_source != 0) {  /* entry not free ? */
 1917             ++elastidx;
 1918             if (elastidx == GDT_MAX_EVENTS)
 1919                 elastidx = 0;
 1920             if (elastidx == eoldidx) {              /* reached mark ? */
 1921                 ++eoldidx;
 1922                 if (eoldidx == GDT_MAX_EVENTS)
 1923                     eoldidx = 0;
 1924             }
 1925         }
 1926         e = &ebuffer[elastidx];
 1927         e->event_source = source;
 1928         e->event_idx = idx;
 1929         getmicrotime(&tv);
 1930         e->first_stamp = e->last_stamp = tv.tv_sec;
 1931         e->same_count = 1;
 1932         e->event_data = *evt;
 1933         e->application = 0;
 1934     }
 1935     return e;
 1936 }
 1937 
 1938 int gdt_read_event(int handle, gdt_evt_str *estr)
 1939 {
 1940     gdt_evt_str *e;
 1941     int eindex, lock;
 1942     
 1943     GDT_DPRINTF(GDT_D_MISC, ("gdt_read_event(%d)\n", handle));
 1944     lock = splcam();
 1945     if (handle == -1)
 1946         eindex = eoldidx;
 1947     else
 1948         eindex = handle;
 1949     estr->event_source = 0;
 1950 
 1951     if (eindex >= GDT_MAX_EVENTS) {
 1952         splx(lock);
 1953         return eindex;
 1954     }
 1955     e = &ebuffer[eindex];
 1956     if (e->event_source != 0) {
 1957         if (eindex != elastidx) {
 1958             if (++eindex == GDT_MAX_EVENTS)
 1959                 eindex = 0;
 1960         } else {
 1961             eindex = -1;
 1962         }
 1963         memcpy(estr, e, sizeof(gdt_evt_str));
 1964     }
 1965     splx(lock);
 1966     return eindex;
 1967 }
 1968 
 1969 void gdt_readapp_event(u_int8_t application, gdt_evt_str *estr)
 1970 {
 1971     gdt_evt_str *e;
 1972     int found = FALSE;
 1973     int eindex, lock;
 1974     
 1975     GDT_DPRINTF(GDT_D_MISC, ("gdt_readapp_event(%d)\n", application));
 1976     lock = splcam();
 1977     eindex = eoldidx;
 1978     for (;;) {
 1979         e = &ebuffer[eindex];
 1980         if (e->event_source == 0)
 1981             break;
 1982         if ((e->application & application) == 0) {
 1983             e->application |= application;
 1984             found = TRUE;
 1985             break;
 1986         }
 1987         if (eindex == elastidx)
 1988             break;
 1989         if (++eindex == GDT_MAX_EVENTS)
 1990             eindex = 0;
 1991     }
 1992     if (found)
 1993         memcpy(estr, e, sizeof(gdt_evt_str));
 1994     else
 1995         estr->event_source = 0;
 1996     splx(lock);
 1997 }
 1998 
 1999 void gdt_clear_events()
 2000 {
 2001     GDT_DPRINTF(GDT_D_MISC, ("gdt_clear_events\n"));
 2002 
 2003     eoldidx = elastidx = 0;
 2004     ebuffer[0].event_source = 0;
 2005 }

Cache object: 07da08efff0ef0cdee405bfb7743bc2c


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


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