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.4/sys/dev/iir/iir.c 177914 2008-04-04 16:42:17Z 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             size_t copylen = MIN(sizeof(inq), ccb->csio.dxfer_len);
 1165 
 1166             bzero(&inq, sizeof(inq));
 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             strncpy(inq.vendor, gdt->oem_name, sizeof(inq.vendor));
 1175             snprintf(inq.product, sizeof(inq.product),
 1176                      "Host Drive   #%02d", t);
 1177             strncpy(inq.revision, "   ", sizeof(inq.revision));
 1178             bcopy(&inq, ccb->csio.data_ptr, copylen );
 1179             if( ccb->csio.dxfer_len > copylen )
 1180                 bzero( ccb->csio.data_ptr+copylen,
 1181                        ccb->csio.dxfer_len - copylen );
 1182             break;
 1183         }
 1184       case MODE_SENSE_6:
 1185         {
 1186             struct mpd_data {
 1187                 struct scsi_mode_hdr_6 hd;
 1188                 struct scsi_mode_block_descr bd;
 1189                 struct scsi_control_page cp;
 1190             } mpd;
 1191             size_t copylen = MIN(sizeof(mpd), ccb->csio.dxfer_len);
 1192             u_int8_t page;
 1193 
 1194             /*mpd = (struct mpd_data *)ccb->csio.data_ptr;*/
 1195             bzero(&mpd, sizeof(mpd));
 1196             mpd.hd.datalen = sizeof(struct scsi_mode_hdr_6) +
 1197                 sizeof(struct scsi_mode_block_descr);
 1198             mpd.hd.dev_specific = (gdt->sc_hdr[t].hd_devtype & 2) ? 0x80 : 0;
 1199             mpd.hd.block_descr_len = sizeof(struct scsi_mode_block_descr);
 1200             mpd.bd.block_len[0] = (GDT_SECTOR_SIZE & 0x00ff0000) >> 16;
 1201             mpd.bd.block_len[1] = (GDT_SECTOR_SIZE & 0x0000ff00) >> 8;
 1202             mpd.bd.block_len[2] = (GDT_SECTOR_SIZE & 0x000000ff);
 1203 
 1204             bcopy(&mpd, ccb->csio.data_ptr, copylen );
 1205             if( ccb->csio.dxfer_len > copylen )
 1206                 bzero( ccb->csio.data_ptr+copylen,
 1207                        ccb->csio.dxfer_len - copylen );
 1208             page=((struct scsi_mode_sense_6 *)ccb->csio.cdb_io.cdb_bytes)->page;
 1209             switch (page) {
 1210               default:
 1211                 GDT_DPRINTF(GDT_D_MISC, ("MODE_SENSE_6: page 0x%x\n", page));
 1212                 break;
 1213             }
 1214             break;
 1215         }
 1216       case READ_CAPACITY:
 1217         {
 1218             struct scsi_read_capacity_data rcd;
 1219             size_t copylen = MIN(sizeof(rcd), ccb->csio.dxfer_len);
 1220               
 1221             /*rcd = (struct scsi_read_capacity_data *)ccb->csio.data_ptr;*/
 1222             bzero(&rcd, sizeof(rcd));
 1223             scsi_ulto4b(gdt->sc_hdr[t].hd_size - 1, rcd.addr);
 1224             scsi_ulto4b(GDT_SECTOR_SIZE, rcd.length);
 1225             bcopy(&rcd, ccb->csio.data_ptr, copylen );
 1226             if( ccb->csio.dxfer_len > copylen )
 1227                 bzero( ccb->csio.data_ptr+copylen,
 1228                        ccb->csio.dxfer_len - copylen );
 1229             break;
 1230         }
 1231       default:
 1232         GDT_DPRINTF(GDT_D_MISC, ("gdt_internal_cache_cmd(%d) unknown\n", 
 1233                                     ccb->csio.cdb_io.cdb_bytes[0]));
 1234         break;
 1235     }
 1236     ccb->ccb_h.status |= CAM_REQ_CMP;
 1237     --gdt_stat.io_count_act;
 1238     xpt_done(ccb);
 1239 }
 1240 
 1241 static void     
 1242 gdtmapmem(void *arg, bus_dma_segment_t *dm_segs, int nseg, int error)
 1243 {
 1244     bus_addr_t *busaddrp;
 1245     
 1246     busaddrp = (bus_addr_t *)arg;
 1247     *busaddrp = dm_segs->ds_addr;
 1248 }
 1249 
 1250 static void     
 1251 gdtexecuteccb(void *arg, bus_dma_segment_t *dm_segs, int nseg, int error)
 1252 {
 1253     struct gdt_ccb *gccb;
 1254     union ccb *ccb;
 1255     struct gdt_softc *gdt;
 1256     int i, lock;
 1257 
 1258     lock = splcam();
 1259 
 1260     gccb = (struct gdt_ccb *)arg;
 1261     ccb = gccb->gc_ccb;
 1262     gdt = cam_sim_softc((struct cam_sim *)ccb->ccb_h.ccb_sim_ptr);
 1263 
 1264     GDT_DPRINTF(GDT_D_CMD, ("gdtexecuteccb(%p, %p, %p, %d, %d)\n", 
 1265                             gdt, gccb, dm_segs, nseg, error));
 1266     gdt_stat.sg_count_act = nseg;
 1267     if (nseg > gdt_stat.sg_count_max)
 1268         gdt_stat.sg_count_max = nseg;
 1269 
 1270     /* Copy the segments into our SG list */
 1271     if (gccb->gc_service == GDT_CACHESERVICE) {
 1272         for (i = 0; i < nseg; ++i) {
 1273             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_SG_LST +
 1274                       i * GDT_SG_SZ + GDT_SG_PTR, dm_segs->ds_addr);
 1275             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_SG_LST +
 1276                       i * GDT_SG_SZ + GDT_SG_LEN, dm_segs->ds_len);
 1277             dm_segs++;
 1278         }
 1279         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_SG_CANZ,      
 1280                   nseg);
 1281         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_CACHE_DESTADDR, 
 1282                   0xffffffffUL);
 1283 
 1284         gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_CACHE_SG_LST +
 1285                                   nseg * GDT_SG_SZ, sizeof(u_int32_t));
 1286     } else {
 1287         for (i = 0; i < nseg; ++i) {
 1288             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SG_LST +
 1289                       i * GDT_SG_SZ + GDT_SG_PTR, dm_segs->ds_addr);
 1290             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SG_LST +
 1291                       i * GDT_SG_SZ + GDT_SG_LEN, dm_segs->ds_len);
 1292             dm_segs++;
 1293         }
 1294         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SG_RANZ,        
 1295                   nseg);
 1296         gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_RAW_SDATA, 
 1297                   0xffffffffUL);
 1298 
 1299         gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_RAW_SG_LST +
 1300                                   nseg * GDT_SG_SZ, sizeof(u_int32_t));
 1301     }
 1302 
 1303     if (nseg != 0) {
 1304         bus_dmamap_sync(gdt->sc_buffer_dmat, gccb->gc_dmamap, 
 1305             (ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN ?
 1306             BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
 1307     }
 1308     
 1309     /* We must NOT abort the command here if CAM_REQ_INPROG is not set,
 1310      * because command semaphore is already set!
 1311      */
 1312     
 1313     ccb->ccb_h.status |= CAM_SIM_QUEUED;
 1314     /* timeout handling */
 1315     ccb->ccb_h.timeout_ch =
 1316         timeout(iir_timeout, (caddr_t)gccb,
 1317                 (ccb->ccb_h.timeout * hz) / 1000);
 1318 
 1319     gdt->sc_copy_cmd(gdt, gccb);
 1320     splx(lock);
 1321 }
 1322 
 1323 
 1324 static void     
 1325 iir_action( struct cam_sim *sim, union ccb *ccb )
 1326 {
 1327     struct gdt_softc *gdt;
 1328     int lock, bus, target, lun;
 1329 
 1330     gdt = (struct gdt_softc *)cam_sim_softc( sim );
 1331     ccb->ccb_h.ccb_sim_ptr = sim;
 1332     bus = cam_sim_bus(sim);
 1333     target = ccb->ccb_h.target_id;
 1334     lun = ccb->ccb_h.target_lun;
 1335     GDT_DPRINTF(GDT_D_CMD, 
 1336                 ("iir_action(%p) func 0x%x cmd 0x%x bus %d target %d lun %d\n", 
 1337                  gdt, ccb->ccb_h.func_code, ccb->csio.cdb_io.cdb_bytes[0], 
 1338                  bus, target, lun)); 
 1339     ++gdt_stat.io_count_act;
 1340     if (gdt_stat.io_count_act > gdt_stat.io_count_max)
 1341         gdt_stat.io_count_max = gdt_stat.io_count_act;
 1342 
 1343     switch (ccb->ccb_h.func_code) {
 1344       case XPT_SCSI_IO:
 1345         lock = splcam();
 1346         TAILQ_INSERT_TAIL(&gdt->sc_ccb_queue, &ccb->ccb_h, sim_links.tqe);
 1347         ++gdt_stat.req_queue_act;
 1348         if (gdt_stat.req_queue_act > gdt_stat.req_queue_max)
 1349             gdt_stat.req_queue_max = gdt_stat.req_queue_act;
 1350         splx(lock);
 1351         gdt_next(gdt);
 1352         break;
 1353       case XPT_RESET_DEV:   /* Bus Device Reset the specified SCSI device */
 1354       case XPT_ABORT:                       /* Abort the specified CCB */
 1355         /* XXX Implement */
 1356         ccb->ccb_h.status = CAM_REQ_INVALID;
 1357         --gdt_stat.io_count_act;
 1358         xpt_done(ccb);
 1359         break;
 1360       case XPT_SET_TRAN_SETTINGS:
 1361         ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
 1362         --gdt_stat.io_count_act;
 1363         xpt_done(ccb);  
 1364         break;
 1365       case XPT_GET_TRAN_SETTINGS:
 1366         /* Get default/user set transfer settings for the target */
 1367           {
 1368               struct        ccb_trans_settings *cts;
 1369               u_int target_mask;
 1370               
 1371               cts = &ccb->cts;
 1372               target_mask = 0x01 << target;
 1373               if ((cts->flags & CCB_TRANS_USER_SETTINGS) != 0) { 
 1374                   cts->flags = CCB_TRANS_DISC_ENB|CCB_TRANS_TAG_ENB;
 1375                   cts->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
 1376                   cts->sync_period = 25; /* 10MHz */
 1377                   if (cts->sync_period != 0)
 1378                       cts->sync_offset = 15;
 1379                   
 1380                   cts->valid = CCB_TRANS_SYNC_RATE_VALID
 1381                       | CCB_TRANS_SYNC_OFFSET_VALID
 1382                       | CCB_TRANS_BUS_WIDTH_VALID
 1383                       | CCB_TRANS_DISC_VALID
 1384                       | CCB_TRANS_TQ_VALID;
 1385                   ccb->ccb_h.status = CAM_REQ_CMP;
 1386               } else {
 1387                   ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
 1388               }
 1389               --gdt_stat.io_count_act;
 1390               xpt_done(ccb);
 1391               break;
 1392           }
 1393       case XPT_CALC_GEOMETRY:
 1394           {
 1395               struct ccb_calc_geometry *ccg;
 1396               u_int32_t secs_per_cylinder;
 1397 
 1398               ccg = &ccb->ccg;
 1399               ccg->heads = gdt->sc_hdr[target].hd_heads;
 1400               ccg->secs_per_track = gdt->sc_hdr[target].hd_secs;
 1401               secs_per_cylinder = ccg->heads * ccg->secs_per_track;
 1402               ccg->cylinders = ccg->volume_size / secs_per_cylinder;
 1403               ccb->ccb_h.status = CAM_REQ_CMP;
 1404               --gdt_stat.io_count_act;
 1405               xpt_done(ccb);
 1406               break;
 1407           }
 1408       case XPT_RESET_BUS:           /* Reset the specified SCSI bus */
 1409           {
 1410               /* XXX Implement */
 1411               ccb->ccb_h.status = CAM_REQ_CMP;
 1412               --gdt_stat.io_count_act;
 1413               xpt_done(ccb);
 1414               break;
 1415           }
 1416       case XPT_TERM_IO:             /* Terminate the I/O process */
 1417         /* XXX Implement */
 1418         ccb->ccb_h.status = CAM_REQ_INVALID;
 1419         --gdt_stat.io_count_act;
 1420         xpt_done(ccb);
 1421         break;
 1422       case XPT_PATH_INQ:            /* Path routing inquiry */
 1423           {
 1424               struct ccb_pathinq *cpi = &ccb->cpi;
 1425               
 1426               cpi->version_num = 1;
 1427               cpi->hba_inquiry = PI_SDTR_ABLE|PI_TAG_ABLE;
 1428               cpi->hba_inquiry |= PI_WIDE_16;
 1429               cpi->target_sprt = 1;
 1430               cpi->hba_misc = 0;
 1431               cpi->hba_eng_cnt = 0;
 1432               if (bus == gdt->sc_virt_bus)
 1433                   cpi->max_target = GDT_MAX_HDRIVES - 1;
 1434               else if (gdt->sc_class & GDT_FC)
 1435                   cpi->max_target = GDT_MAXID_FC - 1;
 1436               else
 1437                   cpi->max_target = GDT_MAXID - 1;
 1438               cpi->max_lun = 7;
 1439               cpi->unit_number = cam_sim_unit(sim);
 1440               cpi->bus_id = bus;
 1441               cpi->initiator_id = 
 1442                   (bus == gdt->sc_virt_bus ? 127 : gdt->sc_bus_id[bus]);
 1443               cpi->base_transfer_speed = 3300;
 1444               strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
 1445               if (gdt->sc_vendor == INTEL_VENDOR_ID)
 1446                   strncpy(cpi->hba_vid, "Intel Corp.", HBA_IDLEN);
 1447               else
 1448                   strncpy(cpi->hba_vid, "ICP vortex ", HBA_IDLEN);
 1449               strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
 1450               cpi->ccb_h.status = CAM_REQ_CMP;
 1451               --gdt_stat.io_count_act;
 1452               xpt_done(ccb);
 1453               break;
 1454           }
 1455       default:
 1456         GDT_DPRINTF(GDT_D_INVALID, ("gdt_next(%p) cmd 0x%x invalid\n", 
 1457                                     gdt, ccb->ccb_h.func_code));
 1458         ccb->ccb_h.status = CAM_REQ_INVALID;
 1459         --gdt_stat.io_count_act;
 1460         xpt_done(ccb);
 1461         break;
 1462     }
 1463 }
 1464 
 1465 static void     
 1466 iir_poll( struct cam_sim *sim )
 1467 {
 1468     struct gdt_softc *gdt;
 1469 
 1470     gdt = (struct gdt_softc *)cam_sim_softc( sim );
 1471     GDT_DPRINTF(GDT_D_CMD, ("iir_poll sim %p gdt %p\n", sim, gdt));
 1472     iir_intr(gdt);
 1473 }
 1474 
 1475 static void     
 1476 iir_timeout(void *arg)
 1477 {
 1478     GDT_DPRINTF(GDT_D_TIMEOUT, ("iir_timeout(%p)\n", gccb));
 1479 }
 1480 
 1481 static void
 1482 iir_watchdog(void *arg)
 1483 {
 1484     struct gdt_softc *gdt;
 1485 
 1486     gdt = (struct gdt_softc *)arg;
 1487     GDT_DPRINTF(GDT_D_DEBUG, ("iir_watchdog(%p)\n", gdt));
 1488 
 1489     {
 1490         int ccbs = 0, ucmds = 0, frees = 0, pends = 0;
 1491         struct gdt_ccb *p;
 1492         struct ccb_hdr *h;
 1493         struct gdt_ucmd *u;
 1494 
 1495         for (h = TAILQ_FIRST(&gdt->sc_ccb_queue); h != NULL; 
 1496              h = TAILQ_NEXT(h, sim_links.tqe))
 1497             ccbs++;
 1498         for (u = TAILQ_FIRST(&gdt->sc_ucmd_queue); u != NULL; 
 1499              u = TAILQ_NEXT(u, links))
 1500             ucmds++;
 1501         for (p = SLIST_FIRST(&gdt->sc_free_gccb); p != NULL; 
 1502              p = SLIST_NEXT(p, sle))
 1503             frees++;
 1504         for (p = SLIST_FIRST(&gdt->sc_pending_gccb); p != NULL; 
 1505              p = SLIST_NEXT(p, sle))
 1506             pends++;
 1507 
 1508         GDT_DPRINTF(GDT_D_TIMEOUT, ("ccbs %d ucmds %d frees %d pends %d\n",
 1509                ccbs, ucmds, frees, pends));
 1510     }
 1511 
 1512     timeout(iir_watchdog, (caddr_t)gdt, hz * 15);
 1513 }
 1514 
 1515 static void     
 1516 iir_shutdown( void *arg, int howto )
 1517 {
 1518     struct gdt_softc *gdt;
 1519     struct gdt_ccb *gccb;
 1520     gdt_ucmd_t *ucmd;
 1521     int lock, i;
 1522 
 1523     gdt = (struct gdt_softc *)arg;
 1524     GDT_DPRINTF(GDT_D_CMD, ("iir_shutdown(%p, %d)\n", gdt, howto));
 1525 
 1526     printf("iir%d: Flushing all Host Drives. Please wait ...  ",
 1527            gdt->sc_hanum);
 1528 
 1529     /* allocate ucmd buffer */
 1530     ucmd = malloc(sizeof(gdt_ucmd_t), M_GDTBUF, M_NOWAIT);
 1531     if (ucmd == NULL) {
 1532         printf("iir%d: iir_shutdown(): Cannot allocate resource\n",
 1533                gdt->sc_hanum);
 1534         return;
 1535     }
 1536     bzero(ucmd, sizeof(gdt_ucmd_t));
 1537 
 1538     /* wait for pending IOs */
 1539     lock = splcam();
 1540     gdt->sc_state = GDT_SHUTDOWN;
 1541     splx(lock);
 1542     if ((gccb = SLIST_FIRST(&gdt->sc_pending_gccb)) != NULL)
 1543         (void) tsleep((void *)gccb, PCATCH | PRIBIO, "iirshw", 100 * hz);
 1544 
 1545     /* flush */
 1546     for (i = 0; i < GDT_MAX_HDRIVES; ++i) {
 1547         if (gdt->sc_hdr[i].hd_present) {
 1548             ucmd->service = GDT_CACHESERVICE;
 1549             ucmd->OpCode = GDT_FLUSH;
 1550             ucmd->u.cache.DeviceNo = i;
 1551             lock = splcam();
 1552             TAILQ_INSERT_TAIL(&gdt->sc_ucmd_queue, ucmd, links);
 1553             ucmd->complete_flag = FALSE;
 1554             splx(lock);
 1555             gdt_next(gdt);
 1556             if (!ucmd->complete_flag)
 1557                 (void) tsleep((void *)ucmd, PCATCH|PRIBIO, "iirshw", 10*hz);
 1558         }
 1559     }
 1560 
 1561     free(ucmd, M_DEVBUF);
 1562     printf("Done.\n");
 1563 }
 1564 
 1565 void
 1566 iir_intr(void *arg)
 1567 {
 1568     struct gdt_softc *gdt = arg;
 1569     struct gdt_intr_ctx ctx;
 1570     int lock = 0;
 1571     struct gdt_ccb *gccb;
 1572     gdt_ucmd_t *ucmd;
 1573     u_int32_t cnt;
 1574 
 1575     GDT_DPRINTF(GDT_D_INTR, ("gdt_intr(%p)\n", gdt));
 1576 
 1577     /* If polling and we were not called from gdt_wait, just return */
 1578     if ((gdt->sc_state & GDT_POLLING) &&
 1579         !(gdt->sc_state & GDT_POLL_WAIT))
 1580         return;
 1581 
 1582     if (!(gdt->sc_state & GDT_POLLING)) 
 1583         lock = splcam();
 1584     gdt_wait_index = 0;
 1585 
 1586     ctx.istatus = gdt->sc_get_status(gdt);
 1587     if (ctx.istatus == 0x00) {
 1588         if (!(gdt->sc_state & GDT_POLLING)) 
 1589             splx(lock);
 1590         gdt->sc_status = GDT_S_NO_STATUS;
 1591         return;
 1592     }
 1593 
 1594     gdt->sc_intr(gdt, &ctx);
 1595 
 1596     gdt->sc_status = ctx.cmd_status;
 1597     gdt->sc_service = ctx.service;
 1598     gdt->sc_info = ctx.info;
 1599     gdt->sc_info2 = ctx.info2;
 1600 
 1601     if (gdt->sc_state & GDT_POLL_WAIT) { 
 1602         gdt_wait_gdt = gdt;
 1603         gdt_wait_index = ctx.istatus;
 1604     }
 1605 
 1606     if (ctx.istatus == GDT_ASYNCINDEX) {
 1607         gdt_async_event(gdt, ctx.service);
 1608         if (!(gdt->sc_state & GDT_POLLING)) 
 1609             splx(lock);
 1610         return;
 1611     }
 1612     if (ctx.istatus == GDT_SPEZINDEX) {
 1613         GDT_DPRINTF(GDT_D_INVALID, 
 1614                     ("iir%d: Service unknown or not initialized!\n", 
 1615                      gdt->sc_hanum));   
 1616         gdt->sc_dvr.size = sizeof(gdt->sc_dvr.eu.driver);
 1617         gdt->sc_dvr.eu.driver.ionode = gdt->sc_hanum;
 1618         gdt_store_event(GDT_ES_DRIVER, 4, &gdt->sc_dvr);
 1619         if (!(gdt->sc_state & GDT_POLLING)) 
 1620             splx(lock);
 1621         return;
 1622     }
 1623 
 1624     gccb = &gdt->sc_gccbs[ctx.istatus - 2];
 1625     ctx.service = gccb->gc_service;
 1626 
 1627     switch (gccb->gc_flags) {
 1628       case GDT_GCF_UNUSED:
 1629         GDT_DPRINTF(GDT_D_INVALID, ("iir%d: Index (%d) to unused command!\n",
 1630                     gdt->sc_hanum, ctx.istatus));
 1631         gdt->sc_dvr.size = sizeof(gdt->sc_dvr.eu.driver);
 1632         gdt->sc_dvr.eu.driver.ionode = gdt->sc_hanum;
 1633         gdt->sc_dvr.eu.driver.index = ctx.istatus;
 1634         gdt_store_event(GDT_ES_DRIVER, 1, &gdt->sc_dvr);
 1635         gdt_free_ccb(gdt, gccb);
 1636         /* fallthrough */
 1637 
 1638       case GDT_GCF_INTERNAL:
 1639         if (!(gdt->sc_state & GDT_POLLING)) 
 1640             splx(lock);
 1641         break;
 1642 
 1643       case GDT_GCF_IOCTL:
 1644         ucmd = gccb->gc_ucmd; 
 1645         if (gdt->sc_status == GDT_S_BSY) {
 1646             GDT_DPRINTF(GDT_D_DEBUG, ("iir_intr(%p) ioctl: gccb %p busy\n", 
 1647                                       gdt, gccb));
 1648             TAILQ_INSERT_HEAD(&gdt->sc_ucmd_queue, ucmd, links);
 1649             if (!(gdt->sc_state & GDT_POLLING)) 
 1650                 splx(lock);
 1651         } else {
 1652             ucmd->status = gdt->sc_status;
 1653             ucmd->info = gdt->sc_info;
 1654             ucmd->complete_flag = TRUE;
 1655             if (ucmd->service == GDT_CACHESERVICE) {
 1656                 if (ucmd->OpCode == GDT_IOCTL) {
 1657                     cnt = ucmd->u.ioctl.param_size;
 1658                     if (cnt != 0)
 1659                         bcopy(gccb->gc_scratch, ucmd->data, cnt);
 1660                 } else {
 1661                     cnt = ucmd->u.cache.BlockCnt * GDT_SECTOR_SIZE;
 1662                     if (cnt != 0)
 1663                         bcopy(gccb->gc_scratch, ucmd->data, cnt);
 1664                 }
 1665             } else {
 1666                 cnt = ucmd->u.raw.sdlen;
 1667                 if (cnt != 0)
 1668                     bcopy(gccb->gc_scratch, ucmd->data, cnt);
 1669                 if (ucmd->u.raw.sense_len != 0) 
 1670                     bcopy(gccb->gc_scratch, ucmd->data, cnt);
 1671             }
 1672             gdt_free_ccb(gdt, gccb);
 1673             if (!(gdt->sc_state & GDT_POLLING)) 
 1674                 splx(lock);
 1675             /* wakeup */
 1676             wakeup(ucmd);
 1677         }
 1678         gdt_next(gdt); 
 1679         break;
 1680 
 1681       default:
 1682         gdt_free_ccb(gdt, gccb);
 1683         gdt_sync_event(gdt, ctx.service, ctx.istatus, gccb);
 1684         if (!(gdt->sc_state & GDT_POLLING)) 
 1685             splx(lock);
 1686         gdt_next(gdt); 
 1687         break;
 1688     }
 1689 }
 1690 
 1691 int
 1692 gdt_async_event(struct gdt_softc *gdt, int service)
 1693 {
 1694     struct gdt_ccb *gccb;
 1695 
 1696     GDT_DPRINTF(GDT_D_INTR, ("gdt_async_event(%p, %d)\n", gdt, service));
 1697 
 1698     if (service == GDT_SCREENSERVICE) {
 1699         if (gdt->sc_status == GDT_MSG_REQUEST) {
 1700             while (gdt->sc_test_busy(gdt))
 1701                 DELAY(1);
 1702             gccb = gdt_get_ccb(gdt);
 1703             if (gccb == NULL) {
 1704                 printf("iir%d: No free command index found\n",
 1705                        gdt->sc_hanum);
 1706                 return (1);
 1707             }
 1708             bzero(gccb->gc_cmd, GDT_CMD_SZ);
 1709             gccb->gc_service = service;
 1710             gccb->gc_flags = GDT_GCF_SCREEN;
 1711             gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
 1712                       gccb->gc_cmd_index);
 1713             gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, GDT_READ);
 1714             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_HANDLE,
 1715                       GDT_MSG_INV_HANDLE);
 1716             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_ADDR,
 1717                       gccb->gc_scratch_busbase);
 1718             gdt->sc_set_sema0(gdt);
 1719             gdt->sc_cmd_off = 0;
 1720             gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_SCREEN_SZ, 
 1721                                       sizeof(u_int32_t));
 1722             gdt->sc_cmd_cnt = 0;
 1723             gdt->sc_copy_cmd(gdt, gccb);
 1724             printf("iir%d: [PCI %d/%d] ",
 1725                 gdt->sc_hanum,gdt->sc_bus,gdt->sc_slot);
 1726             gdt->sc_release_event(gdt);
 1727         }
 1728 
 1729     } else {
 1730         if ((gdt->sc_fw_vers & 0xff) >= 0x1a) {
 1731             gdt->sc_dvr.size = 0;
 1732             gdt->sc_dvr.eu.async.ionode = gdt->sc_hanum;
 1733             gdt->sc_dvr.eu.async.status  = gdt->sc_status;
 1734             /* severity and event_string already set! */
 1735         } else {        
 1736             gdt->sc_dvr.size = sizeof(gdt->sc_dvr.eu.async);
 1737             gdt->sc_dvr.eu.async.ionode   = gdt->sc_hanum;
 1738             gdt->sc_dvr.eu.async.service = service;
 1739             gdt->sc_dvr.eu.async.status  = gdt->sc_status;
 1740             gdt->sc_dvr.eu.async.info    = gdt->sc_info;
 1741             *(u_int32_t *)gdt->sc_dvr.eu.async.scsi_coord  = gdt->sc_info2;
 1742         }
 1743         gdt_store_event(GDT_ES_ASYNC, service, &gdt->sc_dvr);
 1744         printf("iir%d: %s\n", gdt->sc_hanum, gdt->sc_dvr.event_string);
 1745     }
 1746     
 1747     return (0);
 1748 }
 1749 
 1750 int
 1751 gdt_sync_event(struct gdt_softc *gdt, int service, 
 1752                u_int8_t index, struct gdt_ccb *gccb)
 1753 {
 1754     union ccb *ccb;
 1755 
 1756     GDT_DPRINTF(GDT_D_INTR,
 1757                 ("gdt_sync_event(%p, %d, %d, %p)\n", gdt,service,index,gccb));
 1758 
 1759     ccb = gccb->gc_ccb;
 1760 
 1761     if (service == GDT_SCREENSERVICE) {
 1762         u_int32_t msg_len;
 1763 
 1764         msg_len = gdt_dec32(gccb->gc_scratch + GDT_SCR_MSG_LEN);
 1765         if (msg_len)
 1766             if (!(gccb->gc_scratch[GDT_SCR_MSG_ANSWER] && 
 1767                   gccb->gc_scratch[GDT_SCR_MSG_EXT])) {
 1768                 gccb->gc_scratch[GDT_SCR_MSG_TEXT + msg_len] = '\0';
 1769                 printf("%s",&gccb->gc_scratch[GDT_SCR_MSG_TEXT]);
 1770             }
 1771 
 1772         if (gccb->gc_scratch[GDT_SCR_MSG_EXT] && 
 1773             !gccb->gc_scratch[GDT_SCR_MSG_ANSWER]) {
 1774             while (gdt->sc_test_busy(gdt))
 1775                 DELAY(1);
 1776             bzero(gccb->gc_cmd, GDT_CMD_SZ);
 1777             gccb = gdt_get_ccb(gdt);
 1778             if (gccb == NULL) {
 1779                 printf("iir%d: No free command index found\n",
 1780                        gdt->sc_hanum);
 1781                 return (1);
 1782             }
 1783             gccb->gc_service = service;
 1784             gccb->gc_flags = GDT_GCF_SCREEN;
 1785             gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
 1786                       gccb->gc_cmd_index);
 1787             gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, GDT_READ);
 1788             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_HANDLE,
 1789                       gccb->gc_scratch[GDT_SCR_MSG_HANDLE]);
 1790             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_ADDR,
 1791                       gccb->gc_scratch_busbase);
 1792             gdt->sc_set_sema0(gdt);
 1793             gdt->sc_cmd_off = 0;
 1794             gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_SCREEN_SZ, 
 1795                                       sizeof(u_int32_t));
 1796             gdt->sc_cmd_cnt = 0;
 1797             gdt->sc_copy_cmd(gdt, gccb);
 1798             gdt->sc_release_event(gdt);
 1799             return (0);
 1800         }
 1801 
 1802         if (gccb->gc_scratch[GDT_SCR_MSG_ANSWER] && 
 1803             gdt_dec32(gccb->gc_scratch + GDT_SCR_MSG_ALEN)) {
 1804             /* default answers (getchar() not possible) */
 1805             if (gdt_dec32(gccb->gc_scratch + GDT_SCR_MSG_ALEN) == 1) {
 1806                 gdt_enc32(gccb->gc_scratch + GDT_SCR_MSG_ALEN, 0);
 1807                 gdt_enc32(gccb->gc_scratch + GDT_SCR_MSG_LEN, 1);
 1808                 gccb->gc_scratch[GDT_SCR_MSG_TEXT] = 0;
 1809             } else {
 1810                 gdt_enc32(gccb->gc_scratch + GDT_SCR_MSG_ALEN, 
 1811                           gdt_dec32(gccb->gc_scratch + GDT_SCR_MSG_ALEN) - 2);
 1812                 gdt_enc32(gccb->gc_scratch + GDT_SCR_MSG_LEN, 2);
 1813                 gccb->gc_scratch[GDT_SCR_MSG_TEXT] = 1;
 1814                 gccb->gc_scratch[GDT_SCR_MSG_TEXT + 1] = 0;
 1815             }
 1816             gccb->gc_scratch[GDT_SCR_MSG_EXT] = 0;
 1817             gccb->gc_scratch[GDT_SCR_MSG_ANSWER] = 0;
 1818             while (gdt->sc_test_busy(gdt))
 1819                 DELAY(1);
 1820             bzero(gccb->gc_cmd, GDT_CMD_SZ);
 1821             gccb = gdt_get_ccb(gdt);
 1822             if (gccb == NULL) {
 1823                 printf("iir%d: No free command index found\n",
 1824                        gdt->sc_hanum);
 1825                 return (1);
 1826             }
 1827             gccb->gc_service = service;
 1828             gccb->gc_flags = GDT_GCF_SCREEN;
 1829             gdt_enc32(gccb->gc_cmd + GDT_CMD_COMMANDINDEX,
 1830                       gccb->gc_cmd_index);
 1831             gdt_enc16(gccb->gc_cmd + GDT_CMD_OPCODE, GDT_WRITE);
 1832             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_HANDLE,
 1833                       gccb->gc_scratch[GDT_SCR_MSG_HANDLE]);
 1834             gdt_enc32(gccb->gc_cmd + GDT_CMD_UNION + GDT_SCREEN_MSG_ADDR,
 1835                       gccb->gc_scratch_busbase);
 1836             gdt->sc_set_sema0(gdt);
 1837             gdt->sc_cmd_off = 0;
 1838             gccb->gc_cmd_len = roundup(GDT_CMD_UNION + GDT_SCREEN_SZ, 
 1839                                       sizeof(u_int32_t));
 1840             gdt->sc_cmd_cnt = 0;
 1841             gdt->sc_copy_cmd(gdt, gccb);
 1842             gdt->sc_release_event(gdt);
 1843             return (0);
 1844         }
 1845         printf("\n");
 1846         return (0);
 1847     } else {
 1848         untimeout(iir_timeout, gccb, ccb->ccb_h.timeout_ch);
 1849         if (gdt->sc_status == GDT_S_BSY) {
 1850             GDT_DPRINTF(GDT_D_DEBUG, ("gdt_sync_event(%p) gccb %p busy\n", 
 1851                                       gdt, gccb));
 1852             TAILQ_INSERT_HEAD(&gdt->sc_ccb_queue, &ccb->ccb_h, sim_links.tqe);
 1853             ++gdt_stat.req_queue_act;
 1854             if (gdt_stat.req_queue_act > gdt_stat.req_queue_max)
 1855                 gdt_stat.req_queue_max = gdt_stat.req_queue_act;
 1856             return (2);
 1857         }
 1858 
 1859         bus_dmamap_sync(gdt->sc_buffer_dmat, gccb->gc_dmamap, 
 1860             (ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN ?
 1861             BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
 1862         bus_dmamap_unload(gdt->sc_buffer_dmat, gccb->gc_dmamap);
 1863 
 1864         ccb->csio.resid = 0;
 1865         if (gdt->sc_status == GDT_S_OK) {
 1866             ccb->ccb_h.status |= CAM_REQ_CMP;
 1867             ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
 1868         } else {
 1869             /* error */
 1870             if (gccb->gc_service == GDT_CACHESERVICE) {
 1871                 ccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR | CAM_AUTOSNS_VALID;
 1872                 ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
 1873                 ccb->csio.scsi_status = SCSI_STATUS_CHECK_COND;
 1874                 bzero(&ccb->csio.sense_data, ccb->csio.sense_len);
 1875                 ccb->csio.sense_data.error_code =
 1876                     SSD_CURRENT_ERROR | SSD_ERRCODE_VALID;
 1877                 ccb->csio.sense_data.flags = SSD_KEY_NOT_READY;
 1878 
 1879                 gdt->sc_dvr.size = sizeof(gdt->sc_dvr.eu.sync);
 1880                 gdt->sc_dvr.eu.sync.ionode  = gdt->sc_hanum;
 1881                 gdt->sc_dvr.eu.sync.service = service;
 1882                 gdt->sc_dvr.eu.sync.status  = gdt->sc_status;
 1883                 gdt->sc_dvr.eu.sync.info    = gdt->sc_info;
 1884                 gdt->sc_dvr.eu.sync.hostdrive = ccb->ccb_h.target_id;
 1885                 if (gdt->sc_status >= 0x8000)
 1886                     gdt_store_event(GDT_ES_SYNC, 0, &gdt->sc_dvr);
 1887                 else
 1888                     gdt_store_event(GDT_ES_SYNC, service, &gdt->sc_dvr);
 1889             } else {
 1890                 /* raw service */
 1891                 if (gdt->sc_status != GDT_S_RAW_SCSI || gdt->sc_info >= 0x100) {
 1892                     ccb->ccb_h.status = CAM_DEV_NOT_THERE;
 1893                 } else {
 1894                     ccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR|CAM_AUTOSNS_VALID;
 1895                     ccb->ccb_h.status &= ~CAM_SIM_QUEUED;
 1896                     ccb->csio.scsi_status = gdt->sc_info;
 1897                     bcopy(gccb->gc_scratch, &ccb->csio.sense_data,
 1898                           ccb->csio.sense_len);
 1899                 }
 1900             }
 1901         }
 1902         --gdt_stat.io_count_act;
 1903         xpt_done(ccb);
 1904     }
 1905     return (0);
 1906 }
 1907 
 1908 /* Controller event handling functions */
 1909 gdt_evt_str *gdt_store_event(u_int16_t source, u_int16_t idx,
 1910                              gdt_evt_data *evt)
 1911 {
 1912     gdt_evt_str *e;
 1913     struct timeval tv;
 1914 
 1915     GDT_DPRINTF(GDT_D_MISC, ("gdt_store_event(%d, %d)\n", source, idx));
 1916     if (source == 0)                        /* no source -> no event */
 1917         return 0;
 1918 
 1919     if (ebuffer[elastidx].event_source == source &&
 1920         ebuffer[elastidx].event_idx == idx &&
 1921         ((evt->size != 0 && ebuffer[elastidx].event_data.size != 0 &&
 1922           !memcmp((char *)&ebuffer[elastidx].event_data.eu,
 1923                   (char *)&evt->eu, evt->size)) ||
 1924          (evt->size == 0 && ebuffer[elastidx].event_data.size == 0 &&
 1925           !strcmp((char *)&ebuffer[elastidx].event_data.event_string,
 1926                   (char *)&evt->event_string)))) { 
 1927         e = &ebuffer[elastidx];
 1928         getmicrotime(&tv);
 1929         e->last_stamp = tv.tv_sec;
 1930         ++e->same_count;
 1931     } else {
 1932         if (ebuffer[elastidx].event_source != 0) {  /* entry not free ? */
 1933             ++elastidx;
 1934             if (elastidx == GDT_MAX_EVENTS)
 1935                 elastidx = 0;
 1936             if (elastidx == eoldidx) {              /* reached mark ? */
 1937                 ++eoldidx;
 1938                 if (eoldidx == GDT_MAX_EVENTS)
 1939                     eoldidx = 0;
 1940             }
 1941         }
 1942         e = &ebuffer[elastidx];
 1943         e->event_source = source;
 1944         e->event_idx = idx;
 1945         getmicrotime(&tv);
 1946         e->first_stamp = e->last_stamp = tv.tv_sec;
 1947         e->same_count = 1;
 1948         e->event_data = *evt;
 1949         e->application = 0;
 1950     }
 1951     return e;
 1952 }
 1953 
 1954 int gdt_read_event(int handle, gdt_evt_str *estr)
 1955 {
 1956     gdt_evt_str *e;
 1957     int eindex, lock;
 1958     
 1959     GDT_DPRINTF(GDT_D_MISC, ("gdt_read_event(%d)\n", handle));
 1960     lock = splcam();
 1961     if (handle == -1)
 1962         eindex = eoldidx;
 1963     else
 1964         eindex = handle;
 1965     estr->event_source = 0;
 1966 
 1967     if (eindex >= GDT_MAX_EVENTS) {
 1968         splx(lock);
 1969         return eindex;
 1970     }
 1971     e = &ebuffer[eindex];
 1972     if (e->event_source != 0) {
 1973         if (eindex != elastidx) {
 1974             if (++eindex == GDT_MAX_EVENTS)
 1975                 eindex = 0;
 1976         } else {
 1977             eindex = -1;
 1978         }
 1979         memcpy(estr, e, sizeof(gdt_evt_str));
 1980     }
 1981     splx(lock);
 1982     return eindex;
 1983 }
 1984 
 1985 void gdt_readapp_event(u_int8_t application, gdt_evt_str *estr)
 1986 {
 1987     gdt_evt_str *e;
 1988     int found = FALSE;
 1989     int eindex, lock;
 1990     
 1991     GDT_DPRINTF(GDT_D_MISC, ("gdt_readapp_event(%d)\n", application));
 1992     lock = splcam();
 1993     eindex = eoldidx;
 1994     for (;;) {
 1995         e = &ebuffer[eindex];
 1996         if (e->event_source == 0)
 1997             break;
 1998         if ((e->application & application) == 0) {
 1999             e->application |= application;
 2000             found = TRUE;
 2001             break;
 2002         }
 2003         if (eindex == elastidx)
 2004             break;
 2005         if (++eindex == GDT_MAX_EVENTS)
 2006             eindex = 0;
 2007     }
 2008     if (found)
 2009         memcpy(estr, e, sizeof(gdt_evt_str));
 2010     else
 2011         estr->event_source = 0;
 2012     splx(lock);
 2013 }
 2014 
 2015 void gdt_clear_events()
 2016 {
 2017     GDT_DPRINTF(GDT_D_MISC, ("gdt_clear_events\n"));
 2018 
 2019     eoldidx = elastidx = 0;
 2020     ebuffer[0].event_source = 0;
 2021 }

Cache object: 887de97f3e051143f0c95846fb6d391f


[ 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.