Home | History | Annotate | Line # | Download | only in dev
sbic.c revision 1.23
      1  1.23     lukem /*	$NetBSD: sbic.c,v 1.23 2003/07/15 02:43:47 lukem Exp $	*/
      2   1.1     chuck 
      3   1.1     chuck /*
      4   1.1     chuck  * Changes Copyright (c) 1996 Steve Woodford
      5   1.1     chuck  * Original Copyright (c) 1994 Christian E. Hopps
      6   1.1     chuck  * Copyright (c) 1990 The Regents of the University of California.
      7   1.1     chuck  * All rights reserved.
      8   1.1     chuck  *
      9   1.1     chuck  * This code is derived from software contributed to Berkeley by
     10   1.1     chuck  * Van Jacobson of Lawrence Berkeley Laboratory.
     11   1.1     chuck  *
     12   1.1     chuck  * Redistribution and use in source and binary forms, with or without
     13   1.1     chuck  * modification, are permitted provided that the following conditions
     14   1.1     chuck  * are met:
     15   1.1     chuck  * 1. Redistributions of source code must retain the above copyright
     16   1.1     chuck  *    notice, this list of conditions and the following disclaimer.
     17   1.1     chuck  * 2. Redistributions in binary form must reproduce the above copyright
     18   1.1     chuck  *    notice, this list of conditions and the following disclaimer in the
     19   1.1     chuck  *    documentation and/or other materials provided with the distribution.
     20   1.1     chuck  * 3. All advertising materials mentioning features or use of this software
     21   1.1     chuck  *    must display the following acknowledgement:
     22   1.1     chuck  *  This product includes software developed by the University of
     23   1.1     chuck  *  California, Berkeley and its contributors.
     24   1.1     chuck  * 4. Neither the name of the University nor the names of its contributors
     25   1.1     chuck  *    may be used to endorse or promote products derived from this software
     26   1.1     chuck  *    without specific prior written permission.
     27   1.1     chuck  *
     28   1.1     chuck  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     29   1.1     chuck  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     30   1.1     chuck  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     31   1.1     chuck  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     32   1.1     chuck  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     33   1.1     chuck  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     34   1.1     chuck  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     35   1.1     chuck  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     36   1.1     chuck  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     37   1.1     chuck  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     38   1.1     chuck  * SUCH DAMAGE.
     39   1.1     chuck  *
     40   1.1     chuck  *  @(#)scsi.c  7.5 (Berkeley) 5/4/91
     41   1.1     chuck  */
     42   1.1     chuck 
     43   1.1     chuck /*
     44   1.1     chuck  * Steve Woodford (SCW), Apr, 1996
     45   1.1     chuck  * MVME147S WD33C93 Scsi Bus Interface Controller driver,
     46   1.1     chuck  *
     47   1.1     chuck  * Basically a de-loused and tidied up version of the Amiga AMD 33C93 driver.
     48   1.1     chuck  *
     49   1.1     chuck  * The original driver used features which required at least a WD33C93A
     50   1.1     chuck  * chip. The '147 has the original WD33C93 chip (no 'A' suffix).
     51   1.1     chuck  *
     52   1.1     chuck  * This version of the driver is pretty well generic, so should work with
     53   1.1     chuck  * any flavour of WD33C93 chip.
     54   1.1     chuck  */
     55  1.23     lukem 
     56  1.23     lukem #include <sys/cdefs.h>
     57  1.23     lukem __KERNEL_RCSID(0, "$NetBSD: sbic.c,v 1.23 2003/07/15 02:43:47 lukem Exp $");
     58  1.23     lukem 
     59   1.7  jonathan #include "opt_ddb.h"
     60   1.1     chuck 
     61   1.1     chuck #include <sys/param.h>
     62   1.1     chuck #include <sys/systm.h>
     63   1.1     chuck #include <sys/device.h>
     64   1.1     chuck #include <sys/kernel.h> /* For hz */
     65   1.1     chuck #include <sys/disklabel.h>
     66   1.1     chuck #include <sys/buf.h>
     67  1.12       scw 
     68   1.6    bouyer #include <dev/scsipi/scsi_all.h>
     69   1.6    bouyer #include <dev/scsipi/scsipi_all.h>
     70   1.6    bouyer #include <dev/scsipi/scsiconf.h>
     71  1.12       scw 
     72  1.15       mrg #include <uvm/uvm_extern.h>
     73  1.12       scw 
     74   1.1     chuck #include <mvme68k/mvme68k/isr.h>
     75   1.1     chuck #include <mvme68k/dev/dmavar.h>
     76   1.1     chuck #include <mvme68k/dev/sbicreg.h>
     77   1.1     chuck #include <mvme68k/dev/sbicvar.h>
     78   1.1     chuck 
     79   1.1     chuck 
     80   1.1     chuck /*
     81   1.1     chuck  * Since I can't find this in any other header files
     82   1.1     chuck  */
     83   1.1     chuck #define SCSI_PHASE(reg) (reg&0x07)
     84   1.1     chuck 
     85   1.1     chuck /*
     86   1.1     chuck  * SCSI delays
     87   1.1     chuck  * In u-seconds, primarily for state changes on the SPC.
     88   1.1     chuck  */
     89   1.1     chuck #define SBIC_CMD_WAIT   50000   /* wait per step of 'immediate' cmds */
     90   1.1     chuck #define SBIC_DATA_WAIT  50000   /* wait per data in/out step */
     91   1.1     chuck #define SBIC_INIT_WAIT  50000   /* wait per step (both) during init */
     92   1.1     chuck 
     93   1.1     chuck /*
     94   1.1     chuck  * Convenience macro for waiting for a particular sbic event
     95   1.1     chuck  */
     96   1.1     chuck #define SBIC_WAIT(regs, until, timeo) sbicwait(regs, until, timeo, __LINE__)
     97   1.1     chuck 
     98   1.1     chuck int     sbicicmd            __P((struct sbic_softc *, void *, int, void *, int));
     99   1.6    bouyer int     sbicgo              __P((struct sbic_softc *, struct scsipi_xfer *));
    100   1.6    bouyer int     sbicdmaok           __P((struct sbic_softc *, struct scsipi_xfer *));
    101   1.1     chuck int     sbicwait            __P((sbic_regmap_p, u_char, int , int));
    102   1.1     chuck int     sbiccheckdmap       __P((void *, u_long, u_long));
    103   1.1     chuck u_char  sbicselectbus       __P((struct sbic_softc *));
    104   1.1     chuck int     sbicxfout           __P((sbic_regmap_p, int, void *));
    105   1.1     chuck int     sbicxfin            __P((sbic_regmap_p, int, void *));
    106   1.1     chuck int     sbicfromscsiperiod  __P((struct sbic_softc *, int));
    107   1.1     chuck int     sbictoscsiperiod    __P((struct sbic_softc *, int));
    108   1.1     chuck int     sbicpoll            __P((struct sbic_softc *));
    109   1.1     chuck int     sbicnextstate       __P((struct sbic_softc *, u_char, u_char));
    110   1.1     chuck int     sbicmsgin           __P((struct sbic_softc *));
    111   1.1     chuck int     sbicabort           __P((struct sbic_softc *, char *));
    112   1.1     chuck void    sbicxfdone          __P((struct sbic_softc *));
    113   1.1     chuck void    sbicerror           __P((struct sbic_softc *,u_char));
    114   1.1     chuck void    sbicreset           __P((struct sbic_softc *));
    115   1.1     chuck void    sbic_scsidone       __P((struct sbic_acb *, int));
    116   1.1     chuck void    sbic_sched          __P((struct sbic_softc *));
    117   1.1     chuck void    sbic_save_ptrs      __P((struct sbic_softc *));
    118   1.1     chuck void    sbic_load_ptrs      __P((struct sbic_softc *));
    119   1.1     chuck 
    120   1.1     chuck /*
    121   1.1     chuck  * Synch xfer parameters, and timing conversions
    122   1.1     chuck  */
    123   1.1     chuck int     sbic_min_period = SBIC_SYN_MIN_PERIOD;  /* in cycles = f(ICLK,FSn) */
    124   1.1     chuck int     sbic_max_offset = SBIC_SYN_MAX_OFFSET;  /* pure number */
    125   1.1     chuck int     sbic_cmd_wait   = SBIC_CMD_WAIT;
    126   1.1     chuck int     sbic_data_wait  = SBIC_DATA_WAIT;
    127   1.1     chuck int     sbic_init_wait  = SBIC_INIT_WAIT;
    128   1.1     chuck 
    129   1.1     chuck /*
    130   1.1     chuck  * was broken before.. now if you want this you get it for all drives
    131   1.1     chuck  * on sbic controllers.
    132   1.1     chuck  */
    133   1.1     chuck u_char  sbic_inhibit_sync[8];
    134   1.1     chuck int     sbic_enable_reselect     = 1;   /* Allow Disconnect / Reselect */
    135   1.1     chuck int     sbic_no_dma              = 0;   /* Use PIO transfers instead of DMA */
    136   1.1     chuck int     sbic_parallel_operations = 1;   /* Allow command queues */
    137   1.1     chuck 
    138   1.1     chuck /*
    139   1.1     chuck  * Some useful stuff for debugging purposes
    140   1.1     chuck  */
    141   1.1     chuck #ifdef DEBUG
    142   1.1     chuck int     sbicdma_ops     = 0;    /* total DMA operations */
    143   1.1     chuck int     sbicdma_hits    = 0;    /* number of DMA chains that were contiguous */
    144   1.1     chuck int     sbicdma_misses  = 0;    /* number of DMA chains that were not contiguous */
    145   1.1     chuck int     sbicdma_saves   = 0;
    146   1.1     chuck 
    147   1.5  christos #define QPRINTF(a) if (sbic_debug > 1) printf a
    148   1.1     chuck 
    149   1.1     chuck int     sbic_debug      = 0;    /* Debug all chip related things */
    150   1.1     chuck int     sync_debug      = 0;    /* Debug all Synchronous Scsi related things */
    151   1.1     chuck int     reselect_debug  = 0;    /* Debug all reselection related things */
    152   1.1     chuck int     data_pointer_debug = 0; /* Debug Data Pointer related things */
    153   1.1     chuck 
    154   1.1     chuck void    sbictimeout __P((struct sbic_softc *dev));
    155   1.1     chuck 
    156   1.1     chuck #else
    157   1.1     chuck #define QPRINTF(a)  /* */
    158   1.1     chuck #endif
    159   1.1     chuck 
    160   1.1     chuck 
    161   1.1     chuck /*
    162   1.1     chuck  * default minphys routine for sbic based controllers
    163   1.1     chuck  */
    164   1.1     chuck void
    165   1.1     chuck sbic_minphys(bp)
    166   1.1     chuck     struct buf *bp;
    167   1.1     chuck {
    168   1.1     chuck     /*
    169   1.1     chuck      * No max transfer at this level.
    170   1.1     chuck      */
    171   1.1     chuck     minphys(bp);
    172   1.1     chuck }
    173   1.1     chuck 
    174   1.1     chuck 
    175   1.1     chuck /*
    176   1.1     chuck  * Save DMA pointers.  Take into account partial transfer. Shut down DMA.
    177   1.1     chuck  */
    178   1.1     chuck void
    179   1.1     chuck sbic_save_ptrs(dev)
    180   1.1     chuck     struct sbic_softc   *dev;
    181   1.1     chuck {
    182   1.1     chuck     sbic_regmap_p       regs;
    183   1.1     chuck     struct sbic_acb*    acb;
    184   1.1     chuck     int                 count,
    185   1.1     chuck                         asr,
    186   1.1     chuck                         s;
    187   1.1     chuck 
    188   1.1     chuck     /*
    189   1.1     chuck      * Only need to save pointers if DMA was active...
    190   1.1     chuck      */
    191   1.1     chuck     if ( dev->sc_cur == NULL || (dev->sc_flags & SBICF_INDMA) == 0 )
    192   1.1     chuck         return;
    193   1.1     chuck 
    194   1.1     chuck     regs = dev->sc_sbicp;
    195   1.1     chuck 
    196   1.1     chuck     s = splbio();
    197   1.1     chuck 
    198   1.1     chuck     /*
    199   1.1     chuck      * Wait until WD chip is idle
    200   1.1     chuck      */
    201   1.1     chuck     do {
    202   1.1     chuck         GET_SBIC_asr(regs, asr);
    203   1.1     chuck         if( asr & SBIC_ASR_DBR ) {
    204   1.5  christos             printf("sbic_save_ptrs: asr %02x canceled!\n", asr);
    205   1.1     chuck             splx(s);
    206   1.1     chuck             return;
    207   1.1     chuck         }
    208   1.1     chuck     } while( asr & (SBIC_ASR_BSY|SBIC_ASR_CIP) );
    209   1.1     chuck 
    210   1.1     chuck 
    211   1.1     chuck     /*
    212   1.1     chuck      * Save important state.
    213   1.1     chuck      * must be done before dmastop
    214   1.1     chuck      */
    215   1.1     chuck     acb            = dev->sc_nexus;
    216   1.1     chuck     acb->sc_dmacmd = dev->sc_dmacmd;
    217   1.1     chuck 
    218   1.1     chuck     /*
    219   1.1     chuck      * Fetch the residual count
    220   1.1     chuck      */
    221   1.1     chuck     SBIC_TC_GET(regs, count);
    222   1.1     chuck 
    223   1.1     chuck     /*
    224   1.1     chuck      * Shut down DMA
    225   1.1     chuck      */
    226   1.1     chuck     dev->sc_dmastop(dev);
    227   1.1     chuck 
    228   1.1     chuck     /*
    229   1.1     chuck      * No longer in DMA
    230   1.1     chuck      */
    231   1.1     chuck     dev->sc_flags &= ~SBICF_INDMA;
    232   1.1     chuck 
    233   1.1     chuck     /*
    234   1.1     chuck      * Ensure the WD chip is back in polled I/O mode, with nothing to
    235   1.1     chuck      * transfer.
    236   1.1     chuck      */
    237   1.1     chuck     SBIC_TC_PUT(regs, 0);
    238   1.1     chuck     SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
    239   1.1     chuck 
    240   1.1     chuck     /*
    241   1.1     chuck      * Update current count...
    242   1.1     chuck      */
    243   1.1     chuck     acb->sc_tcnt = count;
    244   1.1     chuck 
    245   1.1     chuck     /*
    246   1.1     chuck      * Work out how many bytes were actually transferred
    247   1.1     chuck      */
    248   1.1     chuck     count        = dev->sc_tcnt - count;
    249   1.1     chuck     dev->sc_tcnt = acb->sc_tcnt;
    250   1.1     chuck 
    251   1.1     chuck     /*
    252   1.1     chuck      * Fixup partial xfers
    253   1.1     chuck      */
    254   1.1     chuck     acb->sc_kv.dc_addr  += count;
    255   1.1     chuck     acb->sc_kv.dc_count -= count;
    256   1.1     chuck     acb->sc_pa.dc_addr  += count;
    257   1.1     chuck     acb->sc_pa.dc_count -= count >> 1;
    258   1.1     chuck 
    259   1.1     chuck #ifdef DEBUG
    260   1.1     chuck     if ( data_pointer_debug )
    261  1.12       scw         printf("save at (%p,%x):%x\n",
    262   1.1     chuck                dev->sc_cur->dc_addr, dev->sc_cur->dc_count,count);
    263   1.1     chuck     sbicdma_saves++;
    264   1.1     chuck #endif
    265   1.1     chuck 
    266   1.1     chuck     splx(s);
    267   1.1     chuck }
    268   1.1     chuck 
    269   1.1     chuck 
    270   1.1     chuck /*
    271   1.1     chuck  * DOES NOT RESTART DMA!!!
    272   1.1     chuck  */
    273   1.1     chuck void
    274   1.1     chuck sbic_load_ptrs(dev)
    275   1.1     chuck     struct sbic_softc   *dev;
    276   1.1     chuck {
    277   1.1     chuck     struct sbic_acb *acb = dev->sc_nexus;
    278   1.1     chuck     int             s;
    279   1.1     chuck 
    280   1.1     chuck     if ( acb->sc_kv.dc_count == 0 ) {
    281   1.1     chuck         /*
    282   1.1     chuck          * No data to xfer
    283   1.1     chuck          */
    284   1.1     chuck         return;
    285   1.1     chuck     }
    286   1.1     chuck 
    287   1.1     chuck     s = splbio();
    288   1.1     chuck 
    289   1.1     chuck     /*
    290   1.1     chuck      * Reset the Scatter-Gather chain
    291   1.1     chuck      */
    292   1.1     chuck     dev->sc_last = dev->sc_cur = &acb->sc_pa;
    293   1.1     chuck 
    294   1.1     chuck     /*
    295   1.1     chuck      * Restore the Transfer Count and DMA specific data
    296   1.1     chuck      */
    297   1.1     chuck     dev->sc_tcnt   = acb->sc_tcnt;
    298   1.1     chuck     dev->sc_dmacmd = acb->sc_dmacmd;
    299   1.1     chuck 
    300   1.1     chuck #ifdef DEBUG
    301   1.1     chuck     sbicdma_ops++;
    302   1.1     chuck #endif
    303   1.1     chuck 
    304   1.1     chuck     /*
    305   1.1     chuck      * Need to fixup new segment?
    306   1.1     chuck      */
    307   1.1     chuck     if ( dev->sc_tcnt == 0 ) {
    308   1.1     chuck         /*
    309   1.1     chuck          * sc_tcnt == 0 implies end of segment
    310   1.1     chuck          */
    311   1.1     chuck         char    *vaddr, *paddr;
    312   1.1     chuck         int     count;
    313   1.1     chuck 
    314   1.1     chuck         /*
    315   1.1     chuck          * do kvm to pa mappings
    316   1.1     chuck          */
    317   1.1     chuck         vaddr = acb->sc_kv.dc_addr;
    318  1.12       scw         paddr = acb->sc_pa.dc_addr = (char *) kvtop((caddr_t)vaddr);
    319   1.1     chuck 
    320  1.20   thorpej         for (count = (PAGE_SIZE - ((int)vaddr & PGOFSET));
    321   1.1     chuck              count < acb->sc_kv.dc_count &&
    322  1.12       scw              (char*)kvtop((caddr_t)(vaddr + count + 4)) == paddr + count + 4;
    323  1.20   thorpej              count += PAGE_SIZE)
    324   1.1     chuck             ;   /* Do nothing */
    325   1.1     chuck 
    326   1.1     chuck         /*
    327   1.1     chuck          * If it's all contiguous...
    328   1.1     chuck          */
    329   1.1     chuck         if ( count > acb->sc_kv.dc_count ) {
    330   1.1     chuck             count = acb->sc_kv.dc_count;
    331   1.1     chuck #ifdef  DEBUG
    332   1.1     chuck             sbicdma_hits++;
    333   1.1     chuck #endif
    334   1.1     chuck         }
    335   1.1     chuck #ifdef  DEBUG
    336   1.1     chuck         else
    337   1.1     chuck             sbicdma_misses++;
    338   1.1     chuck #endif
    339   1.1     chuck 
    340   1.1     chuck         acb->sc_tcnt        = count;
    341   1.1     chuck         acb->sc_pa.dc_count = count >> 1;
    342   1.1     chuck 
    343   1.1     chuck #ifdef DEBUG
    344   1.1     chuck         if ( data_pointer_debug )
    345  1.12       scw             printf("DMA recalc:kv(%p,%x)pa(%p,%lx)\n", acb->sc_kv.dc_addr,
    346   1.1     chuck                                                       acb->sc_kv.dc_count,
    347   1.1     chuck                                                       acb->sc_pa.dc_addr,
    348   1.1     chuck                                                       acb->sc_tcnt);
    349   1.1     chuck #endif
    350   1.1     chuck 
    351   1.1     chuck     }
    352   1.1     chuck 
    353   1.1     chuck     splx(s);
    354   1.1     chuck }
    355   1.1     chuck 
    356   1.1     chuck /*
    357   1.1     chuck  * used by specific sbic controller
    358   1.1     chuck  *
    359   1.1     chuck  * it appears that the higher level code does nothing with LUN's
    360   1.1     chuck  * so I will too.  I could plug it in, however so could they
    361   1.6    bouyer  * in scsi_scsipi_cmd().
    362   1.1     chuck  */
    363  1.16    bouyer void
    364  1.16    bouyer sbic_scsi_request(chan, req, arg)
    365  1.16    bouyer 	struct scsipi_channel *chan;
    366  1.16    bouyer 	scsipi_adapter_req_t req;
    367  1.16    bouyer 	void *arg;
    368  1.16    bouyer {
    369   1.6    bouyer     struct scsipi_xfer *xs;
    370  1.16    bouyer     struct scsipi_periph *periph;
    371  1.16    bouyer     struct sbic_softc   *dev = (void *)chan->chan_adapter->adapt_dev;
    372   1.1     chuck     struct sbic_acb     *acb;
    373  1.16    bouyer     int                 flags, s;
    374   1.1     chuck 
    375  1.16    bouyer     switch (req) {
    376  1.16    bouyer     case ADAPTER_REQ_RUN_XFER:
    377  1.16    bouyer 	xs = arg;
    378  1.16    bouyer 	periph = xs->xs_periph;
    379  1.16    bouyer         flags = xs->xs_control;
    380   1.1     chuck 
    381  1.16    bouyer         if ( flags & XS_CTL_DATA_UIO )
    382  1.16    bouyer             panic("sbic: scsi data uio requested");
    383   1.1     chuck 
    384  1.16    bouyer         if ( dev->sc_nexus && (flags & XS_CTL_POLL) )
    385  1.16    bouyer             panic("sbic_scsicmd: busy");
    386   1.1     chuck 
    387  1.16    bouyer         s = splbio();
    388   1.1     chuck 
    389  1.16    bouyer         if ( (acb = dev->free_list.tqh_first) != NULL )
    390  1.16    bouyer             TAILQ_REMOVE(&dev->free_list, acb, chain);
    391   1.1     chuck 
    392  1.16    bouyer         splx(s);
    393   1.1     chuck 
    394  1.16    bouyer         if ( acb == NULL ) {
    395   1.1     chuck #ifdef DEBUG
    396  1.16    bouyer             printf("sbic_scsicmd: unable to queue request for target %d\n",
    397  1.16    bouyer                 periph->periph_target);
    398   1.1     chuck #ifdef DDB
    399  1.16    bouyer             Debugger();
    400   1.1     chuck #endif
    401   1.1     chuck #endif
    402  1.16    bouyer             xs->error = XS_RESOURCE_SHORTAGE;
    403  1.16    bouyer 	    scsipi_done(xs);
    404  1.16    bouyer             return;
    405  1.16    bouyer         }
    406  1.16    bouyer 
    407  1.16    bouyer         if ( flags & XS_CTL_DATA_IN )
    408  1.16    bouyer             acb->flags = ACB_ACTIVE | ACB_DATAIN;
    409  1.16    bouyer         else
    410  1.16    bouyer             acb->flags = ACB_ACTIVE;
    411   1.1     chuck 
    412  1.16    bouyer         acb->xs             = xs;
    413  1.16    bouyer         acb->clen           = xs->cmdlen;
    414  1.16    bouyer         acb->sc_kv.dc_addr  = xs->data;
    415  1.16    bouyer         acb->sc_kv.dc_count = xs->datalen;
    416  1.16    bouyer         acb->pa_addr        = xs->data ? (char *)kvtop((caddr_t)xs->data) : 0;
    417  1.17       scw         memcpy(&acb->cmd, xs->cmd, xs->cmdlen);
    418   1.1     chuck 
    419  1.16    bouyer         if ( flags & XS_CTL_POLL ) {
    420  1.16    bouyer             /*
    421  1.16    bouyer              * This has major side effects -- it locks up the machine
    422  1.16    bouyer              */
    423  1.16    bouyer             int stat;
    424   1.1     chuck 
    425  1.16    bouyer             s = splbio();
    426   1.1     chuck 
    427  1.16    bouyer             dev->sc_flags |= SBICF_ICMD;
    428   1.1     chuck 
    429  1.16    bouyer             do {
    430  1.16    bouyer                 /*
    431  1.16    bouyer                  * If we already had a nexus, while away the time until idle...
    432  1.16    bouyer                  * This is likely only to happen if a reselection occurs between
    433  1.16    bouyer                  * here and our earlier check for ICMD && sc_nexus (which would
    434  1.16    bouyer                  * have resulted in a panic() had it been true).
    435  1.16    bouyer                  */
    436  1.16    bouyer                 while ( dev->sc_nexus )
    437  1.16    bouyer                     sbicpoll(dev);
    438   1.1     chuck 
    439  1.16    bouyer                 /*
    440  1.16    bouyer                  * Fix up the new nexus
    441  1.16    bouyer                  */
    442  1.16    bouyer                 dev->sc_nexus   = acb;
    443  1.16    bouyer                 dev->sc_xs      = xs;
    444  1.16    bouyer                 dev->target     = periph->periph_target;
    445  1.16    bouyer                 dev->lun        = periph->periph_lun;
    446   1.1     chuck 
    447  1.16    bouyer                 stat = sbicicmd(dev, &acb->cmd, acb->clen,
    448  1.16    bouyer                                 acb->sc_kv.dc_addr, acb->sc_kv.dc_count);
    449   1.1     chuck 
    450  1.16    bouyer             } while ( dev->sc_nexus != acb );
    451   1.1     chuck 
    452  1.16    bouyer             sbic_scsidone(acb, stat);
    453   1.1     chuck 
    454  1.16    bouyer             splx(s);
    455   1.1     chuck 
    456  1.16    bouyer             return;
    457  1.16    bouyer         }
    458   1.1     chuck 
    459  1.16    bouyer         s = splbio();
    460  1.16    bouyer         TAILQ_INSERT_TAIL(&dev->ready_list, acb, chain);
    461   1.1     chuck 
    462  1.16    bouyer         /*
    463  1.16    bouyer          * If nothing is active, try to start it now.
    464  1.16    bouyer          */
    465  1.16    bouyer         if ( dev->sc_nexus == NULL )
    466  1.16    bouyer             sbic_sched(dev);
    467   1.1     chuck 
    468  1.16    bouyer         splx(s);
    469   1.1     chuck 
    470  1.16    bouyer         return;
    471   1.1     chuck 
    472  1.16    bouyer     case ADAPTER_REQ_GROW_RESOURCES:
    473  1.16    bouyer 	/* XXX Not supported. */
    474  1.16    bouyer 	return;
    475  1.16    bouyer 
    476  1.16    bouyer     case ADAPTER_REQ_SET_XFER_MODE:
    477  1.16    bouyer 	/* XXX Not supported. */
    478  1.16    bouyer 	return;
    479  1.16    bouyer     }
    480   1.1     chuck 
    481   1.1     chuck }
    482   1.1     chuck 
    483   1.1     chuck /*
    484   1.1     chuck  * attempt to start the next available command
    485   1.1     chuck  */
    486   1.1     chuck void
    487   1.1     chuck sbic_sched(dev)
    488   1.1     chuck     struct sbic_softc *dev;
    489   1.1     chuck {
    490   1.6    bouyer     struct scsipi_xfer    *xs;
    491  1.16    bouyer     struct scsipi_periph  *periph = NULL;    /* Gag the compiler */
    492   1.1     chuck     struct sbic_acb     *acb;
    493   1.1     chuck     int                 flags,
    494   1.1     chuck                         stat;
    495   1.1     chuck 
    496   1.1     chuck     /*
    497   1.1     chuck      * XXXSCW
    498   1.1     chuck      * I'll keep this test here, even though I can't see any obvious way
    499   1.1     chuck      * in which sbic_sched() could be called with sc_nexus non NULL
    500   1.1     chuck      */
    501   1.1     chuck     if ( dev->sc_nexus )
    502   1.1     chuck         return;         /* a command is current active */
    503   1.1     chuck 
    504   1.1     chuck     /*
    505   1.1     chuck      * Loop through the ready list looking for work to do...
    506   1.1     chuck      */
    507   1.1     chuck     for (acb = dev->ready_list.tqh_first; acb; acb = acb->chain.tqe_next) {
    508   1.1     chuck         int     i, j;
    509   1.1     chuck 
    510  1.16    bouyer         periph = acb->xs->xs_periph;
    511  1.16    bouyer         i   = periph->periph_target;
    512  1.16    bouyer         j   = 1 << periph->periph_lun;
    513   1.1     chuck 
    514   1.1     chuck         /*
    515   1.1     chuck          * We've found a potential command, but is the target/lun busy?
    516   1.1     chuck          */
    517   1.1     chuck         if ( (dev->sc_tinfo[i].lubusy & j) == 0 ) {
    518   1.1     chuck             /*
    519   1.1     chuck              * Nope, it's not busy, so we can use it.
    520   1.1     chuck              */
    521   1.1     chuck             dev->sc_tinfo[i].lubusy |= j;
    522   1.1     chuck             TAILQ_REMOVE(&dev->ready_list, acb, chain);
    523   1.1     chuck             dev->sc_nexus = acb;
    524   1.1     chuck             acb->sc_pa.dc_addr = acb->pa_addr;  /* XXXX check */
    525   1.1     chuck             break;
    526   1.1     chuck         }
    527   1.1     chuck     }
    528   1.1     chuck 
    529   1.1     chuck     if ( acb == NULL ) {
    530   1.1     chuck         QPRINTF(("sbicsched: no work\n"));
    531   1.1     chuck         return;         /* did not find an available command */
    532   1.1     chuck     }
    533   1.1     chuck 
    534   1.1     chuck #ifdef DEBUG
    535   1.1     chuck     if ( data_pointer_debug > 1 )
    536  1.16    bouyer         printf("sbic_sched(%d,%d)\n", periph->periph_target,
    537  1.16    bouyer 			periph->periph_lun);
    538   1.1     chuck #endif
    539   1.1     chuck 
    540   1.1     chuck     dev->sc_xs = xs = acb->xs;
    541  1.10   thorpej     flags      = xs->xs_control;
    542   1.1     chuck 
    543  1.10   thorpej     if ( flags & XS_CTL_RESET )
    544   1.1     chuck         sbicreset(dev);
    545   1.1     chuck 
    546   1.1     chuck     dev->sc_stat[0] = -1;
    547  1.16    bouyer     dev->target     = periph->periph_target;
    548  1.16    bouyer     dev->lun        = periph->periph_lun;
    549   1.1     chuck 
    550  1.10   thorpej     if ( flags & XS_CTL_POLL || (!sbic_parallel_operations &&
    551   1.1     chuck                               (sbicdmaok(dev, xs) == 0)) )
    552   1.1     chuck         stat = sbicicmd(dev, &acb->cmd, acb->clen,
    553   1.1     chuck                         acb->sc_kv.dc_addr, acb->sc_kv.dc_count);
    554   1.1     chuck     else
    555  1.11       scw     if ( sbicgo(dev, xs) == 0 && xs->error != XS_SELTIMEOUT )
    556   1.1     chuck         return;
    557   1.1     chuck     else
    558   1.1     chuck         stat = dev->sc_stat[0];
    559   1.1     chuck 
    560   1.1     chuck     sbic_scsidone(acb, stat);
    561   1.1     chuck }
    562   1.1     chuck 
    563   1.1     chuck void
    564   1.1     chuck sbic_scsidone(acb, stat)
    565   1.1     chuck     struct sbic_acb *acb;
    566   1.1     chuck     int             stat;
    567   1.1     chuck {
    568   1.6    bouyer     struct scsipi_xfer    *xs  = acb->xs;
    569  1.16    bouyer     struct scsipi_periph  *periph = xs->xs_periph;
    570  1.16    bouyer     struct sbic_softc   *dev = (void *)periph->periph_channel->chan_adapter->adapt_dev;
    571   1.1     chuck     int                 dosched = 0;
    572   1.1     chuck 
    573   1.1     chuck #ifdef DIAGNOSTIC
    574   1.1     chuck     if ( acb == NULL || xs == NULL ) {
    575   1.6    bouyer         printf("sbic_scsidone -- (%d,%d) no scsipi_xfer\n", dev->target, dev->lun);
    576   1.1     chuck #ifdef DDB
    577   1.1     chuck         Debugger();
    578   1.1     chuck #endif
    579   1.1     chuck         return;
    580   1.1     chuck     }
    581   1.1     chuck #endif
    582   1.1     chuck 
    583   1.1     chuck 
    584   1.1     chuck #ifdef DEBUG
    585   1.1     chuck     if ( data_pointer_debug > 1 )
    586  1.16    bouyer         printf("scsidone: (%d,%d)->(%d,%d)%02x\n", periph->periph_target,
    587  1.16    bouyer 			periph->periph_lun,
    588   1.1     chuck                                                    dev->target, dev->lun, stat);
    589   1.1     chuck 
    590  1.16    bouyer     if ( xs->xs_periph->periph_target == dev->sc_channel.chan_id)
    591   1.1     chuck         panic("target == hostid");
    592   1.1     chuck #endif
    593   1.1     chuck 
    594  1.16    bouyer     xs->status = stat;
    595  1.16    bouyer     xs->resid = 0;      /* XXXX */
    596  1.16    bouyer     if ( xs->error == XS_NOERROR) {
    597  1.16    bouyer         if ( stat == SCSI_CHECK || stat == SCSI_BUSY)
    598  1.16    bouyer             xs->error = XS_BUSY;
    599   1.1     chuck     }
    600   1.1     chuck 
    601   1.1     chuck 
    602   1.1     chuck     /*
    603   1.1     chuck      * Remove the ACB from whatever queue it's on.  We have to do a bit of
    604   1.1     chuck      * a hack to figure out which queue it's on.  Note that it is *not*
    605   1.1     chuck      * necessary to cdr down the ready queue, but we must cdr down the
    606   1.1     chuck      * nexus queue and see if it's there, so we can mark the unit as no
    607   1.1     chuck      * longer busy.  This code is sickening, but it works.
    608   1.1     chuck      */
    609   1.1     chuck     if ( acb == dev->sc_nexus ) {
    610   1.1     chuck 
    611   1.1     chuck         dev->sc_nexus = NULL;
    612   1.1     chuck         dev->sc_xs    = NULL;
    613   1.1     chuck 
    614  1.16    bouyer         dev->sc_tinfo[periph->periph_target].lubusy &=
    615  1.16    bouyer 			~(1 << periph->periph_lun);
    616   1.1     chuck 
    617   1.1     chuck         if ( dev->ready_list.tqh_first )
    618   1.1     chuck             dosched = 1;    /* start next command */
    619   1.1     chuck 
    620   1.1     chuck     } else
    621   1.1     chuck     if ( dev->ready_list.tqh_last == &acb->chain.tqe_next ) {
    622   1.1     chuck 
    623   1.1     chuck         TAILQ_REMOVE(&dev->ready_list, acb, chain);
    624   1.1     chuck 
    625   1.1     chuck     } else {
    626   1.1     chuck 
    627   1.8       scw         struct sbic_acb *a;
    628   1.1     chuck 
    629   1.1     chuck         for (a = dev->nexus_list.tqh_first; a; a = a->chain.tqe_next) {
    630   1.1     chuck             if ( a == acb ) {
    631   1.1     chuck                 TAILQ_REMOVE(&dev->nexus_list, acb, chain);
    632  1.16    bouyer                 dev->sc_tinfo[periph->periph_target].lubusy &=
    633  1.16    bouyer 					~(1 << periph->periph_lun);
    634   1.1     chuck                 break;
    635   1.1     chuck             }
    636   1.1     chuck         }
    637   1.1     chuck 
    638   1.1     chuck         if ( a )
    639   1.1     chuck             ;
    640   1.1     chuck         else if ( acb->chain.tqe_next ) {
    641   1.1     chuck             TAILQ_REMOVE(&dev->ready_list, acb, chain);
    642   1.1     chuck         } else {
    643   1.5  christos             printf("%s: can't find matching acb\n", dev->sc_dev.dv_xname);
    644   1.1     chuck #ifdef DDB
    645   1.1     chuck             Debugger();
    646   1.1     chuck #endif
    647   1.1     chuck         }
    648   1.1     chuck     }
    649   1.1     chuck 
    650   1.1     chuck     /*
    651   1.1     chuck      * Put it on the free list.
    652   1.1     chuck      */
    653   1.1     chuck     acb->flags = ACB_FREE;
    654   1.1     chuck     TAILQ_INSERT_HEAD(&dev->free_list, acb, chain);
    655   1.1     chuck 
    656  1.16    bouyer     dev->sc_tinfo[periph->periph_target].cmds++;
    657   1.1     chuck 
    658   1.6    bouyer     scsipi_done(xs);
    659   1.1     chuck 
    660   1.1     chuck     if ( dosched )
    661   1.1     chuck         sbic_sched(dev);
    662   1.1     chuck }
    663   1.1     chuck 
    664   1.1     chuck int
    665   1.1     chuck sbicdmaok(dev, xs)
    666   1.1     chuck     struct sbic_softc   *dev;
    667   1.6    bouyer     struct scsipi_xfer    *xs;
    668   1.1     chuck {
    669  1.11       scw     if ( sbic_no_dma || xs->datalen == 0 ||
    670  1.11       scw     	 xs->datalen & 0x03 || (int)xs->data & 0x03)
    671   1.1     chuck         return(0);
    672   1.1     chuck 
    673   1.1     chuck     /*
    674  1.21       wiz      * controller supports DMA to any addresses?
    675   1.1     chuck      */
    676   1.1     chuck     if ( (dev->sc_flags & SBICF_BADDMA) == 0 )
    677   1.1     chuck         return(1);
    678   1.1     chuck 
    679   1.1     chuck     /*
    680  1.21       wiz      * this address is ok for DMA?
    681   1.1     chuck      */
    682   1.1     chuck     if ( sbiccheckdmap(xs->data, xs->datalen, dev->sc_dmamask) == 0 )
    683   1.1     chuck         return(1);
    684   1.1     chuck 
    685   1.1     chuck     return(0);
    686   1.1     chuck }
    687   1.1     chuck 
    688   1.1     chuck int
    689   1.1     chuck sbicwait(regs, until, timeo, line)
    690   1.1     chuck     sbic_regmap_p   regs;
    691   1.1     chuck     u_char          until;
    692   1.1     chuck     int             timeo;
    693   1.1     chuck     int             line;
    694   1.1     chuck {
    695   1.1     chuck     u_char  val;
    696   1.1     chuck 
    697   1.1     chuck     if ( timeo == 0 )
    698   1.1     chuck         timeo = 1000000;    /* some large value.. */
    699   1.1     chuck 
    700   1.1     chuck     GET_SBIC_asr(regs, val);
    701   1.1     chuck 
    702   1.1     chuck     while ( (val & until) == 0 ) {
    703   1.1     chuck 
    704   1.1     chuck         if ( timeo-- == 0 ) {
    705   1.1     chuck             int csr;
    706   1.1     chuck             GET_SBIC_csr(regs, csr);
    707   1.5  christos             printf("sbicwait TIMEO @%d with asr=x%x csr=x%x\n", line, val, csr);
    708   1.1     chuck #if defined(DDB) && defined(DEBUG)
    709   1.1     chuck             Debugger();
    710   1.1     chuck #endif
    711   1.1     chuck             return(val); /* Maybe I should abort */
    712   1.1     chuck             break;
    713   1.1     chuck         }
    714   1.1     chuck 
    715   1.1     chuck         DELAY(1);
    716   1.1     chuck         GET_SBIC_asr(regs, val);
    717   1.1     chuck     }
    718   1.1     chuck 
    719   1.1     chuck     return(val);
    720   1.1     chuck }
    721   1.1     chuck 
    722   1.1     chuck int
    723   1.1     chuck sbicabort(dev, where)
    724   1.1     chuck     struct sbic_softc   *dev;
    725   1.1     chuck     char                *where;
    726   1.1     chuck {
    727   1.1     chuck     sbic_regmap_p   regs = dev->sc_sbicp;
    728   1.1     chuck     u_char          csr,
    729   1.1     chuck                     asr;
    730   1.1     chuck 
    731   1.1     chuck     GET_SBIC_asr(regs, asr);
    732   1.1     chuck     GET_SBIC_csr(regs, csr);
    733   1.1     chuck 
    734   1.5  christos     printf ("%s: abort %s: csr = 0x%02x, asr = 0x%02x\n",
    735   1.1     chuck             dev->sc_dev.dv_xname, where, csr, asr);
    736   1.1     chuck 
    737   1.1     chuck     /*
    738   1.1     chuck      * Clean up chip itself
    739   1.1     chuck      */
    740   1.1     chuck     if ( dev->sc_flags & SBICF_SELECTED ) {
    741   1.1     chuck 
    742   1.1     chuck         while ( asr & SBIC_ASR_DBR ) {
    743   1.1     chuck             /*
    744   1.1     chuck              * sbic is jammed w/data. need to clear it
    745   1.1     chuck              * But we don't know what direction it needs to go
    746   1.1     chuck              */
    747   1.1     chuck             GET_SBIC_data(regs, asr);
    748   1.5  christos             printf("%s: abort %s: clearing data buffer 0x%02x\n",
    749   1.1     chuck                    dev->sc_dev.dv_xname, where, asr);
    750   1.1     chuck             GET_SBIC_asr(regs, asr);
    751   1.1     chuck             if ( asr & SBIC_ASR_DBR ) /* Not the read direction, then */
    752   1.1     chuck                 SET_SBIC_data(regs, asr);
    753   1.1     chuck             GET_SBIC_asr(regs, asr);
    754   1.1     chuck         }
    755   1.1     chuck 
    756   1.1     chuck         WAIT_CIP(regs);
    757   1.1     chuck 
    758   1.5  christos         printf("%s: sbicabort - sending ABORT command\n", dev->sc_dev.dv_xname);
    759   1.1     chuck         SET_SBIC_cmd(regs, SBIC_CMD_ABORT);
    760   1.1     chuck         WAIT_CIP(regs);
    761   1.1     chuck 
    762   1.1     chuck         GET_SBIC_asr(regs, asr);
    763   1.1     chuck 
    764   1.1     chuck         if ( asr & (SBIC_ASR_BSY|SBIC_ASR_LCI) ) {
    765   1.1     chuck             /*
    766   1.1     chuck              * ok, get more drastic..
    767   1.1     chuck              */
    768   1.5  christos             printf("%s: sbicabort - asr %x, trying to reset\n",
    769   1.1     chuck                     dev->sc_dev.dv_xname, asr);
    770   1.1     chuck             sbicreset(dev);
    771   1.1     chuck             dev->sc_flags &= ~SBICF_SELECTED;
    772   1.2     chuck             return SBIC_STATE_ERROR;
    773   1.1     chuck         }
    774   1.1     chuck 
    775   1.5  christos         printf("%s: sbicabort - sending DISC command\n", dev->sc_dev.dv_xname);
    776   1.1     chuck         SET_SBIC_cmd(regs, SBIC_CMD_DISC);
    777   1.1     chuck 
    778   1.1     chuck         do {
    779   1.1     chuck             SBIC_WAIT (regs, SBIC_ASR_INT, 0);
    780   1.1     chuck             GET_SBIC_asr(regs, asr);
    781   1.1     chuck             GET_SBIC_csr (regs, csr);
    782   1.1     chuck             QPRINTF(("csr: 0x%02x, asr: 0x%02x\n", csr, asr));
    783   1.1     chuck         } while ( (csr != SBIC_CSR_DISC) && (csr != SBIC_CSR_DISC_1) &&
    784   1.1     chuck                   (csr != SBIC_CSR_CMD_INVALID) );
    785   1.1     chuck 
    786   1.1     chuck         /*
    787   1.1     chuck          * lets just hope it worked..
    788   1.1     chuck          */
    789   1.1     chuck         dev->sc_flags &= ~SBICF_SELECTED;
    790   1.1     chuck     }
    791   1.1     chuck 
    792   1.2     chuck     return SBIC_STATE_ERROR;
    793   1.1     chuck }
    794   1.1     chuck 
    795   1.1     chuck 
    796   1.1     chuck /*
    797   1.1     chuck  * Initialize driver-private structures
    798   1.1     chuck  */
    799   1.1     chuck void
    800   1.1     chuck sbicinit(dev)
    801   1.1     chuck     struct sbic_softc *dev;
    802   1.1     chuck {
    803   1.1     chuck     u_int   i;
    804   1.1     chuck 
    805   1.1     chuck     if ( (dev->sc_flags & SBICF_ALIVE) == 0 ) {
    806   1.1     chuck 
    807   1.1     chuck         struct sbic_acb *acb;
    808   1.1     chuck 
    809   1.1     chuck         TAILQ_INIT(&dev->ready_list);
    810   1.1     chuck         TAILQ_INIT(&dev->nexus_list);
    811   1.1     chuck         TAILQ_INIT(&dev->free_list);
    812  1.13   thorpej 	callout_init(&dev->sc_timo_ch);
    813   1.1     chuck 
    814   1.1     chuck         dev->sc_nexus = NULL;
    815   1.1     chuck         dev->sc_xs    = NULL;
    816   1.1     chuck 
    817   1.1     chuck         acb = dev->sc_acb;
    818  1.17       scw         memset(acb, 0, sizeof(dev->sc_acb));
    819   1.1     chuck 
    820   1.1     chuck         for (i = 0; i < sizeof(dev->sc_acb) / sizeof(*acb); i++) {
    821   1.1     chuck             TAILQ_INSERT_TAIL(&dev->free_list, acb, chain);
    822   1.1     chuck             acb++;
    823   1.1     chuck         }
    824   1.1     chuck 
    825  1.17       scw         memset(dev->sc_tinfo, 0, sizeof(dev->sc_tinfo));
    826   1.1     chuck 
    827   1.1     chuck #ifdef DEBUG
    828   1.1     chuck         /*
    829   1.1     chuck          * make sure timeout is really not needed
    830   1.1     chuck          */
    831  1.13   thorpej 	callout_reset(&dev->sc_timo_ch, 30 * hz, (void *)sbictimeout, dev);
    832   1.1     chuck #endif
    833   1.1     chuck 
    834   1.1     chuck     } else
    835   1.1     chuck         panic("sbic: reinitializing driver!");
    836   1.1     chuck 
    837   1.1     chuck     dev->sc_flags |=  SBICF_ALIVE;
    838   1.1     chuck     dev->sc_flags &= ~SBICF_SELECTED;
    839   1.1     chuck 
    840   1.1     chuck     /*
    841   1.1     chuck      * initialize inhibit array
    842   1.9       scw 	 * Never enable Sync, since it just doesn't work on mvme147 :(
    843   1.1     chuck      */
    844   1.9       scw     for (i = 0; i < 8; ++i)
    845   1.9       scw         sbic_inhibit_sync[i] = 1;
    846   1.1     chuck 
    847   1.1     chuck     sbicreset(dev);
    848   1.1     chuck }
    849   1.1     chuck 
    850   1.1     chuck void
    851   1.1     chuck sbicreset(dev)
    852   1.1     chuck     struct sbic_softc *dev;
    853   1.1     chuck {
    854   1.1     chuck     sbic_regmap_p   regs = dev->sc_sbicp;
    855   1.1     chuck     u_int           my_id,
    856   1.1     chuck                     s;
    857   1.1     chuck     u_char          csr;
    858   1.1     chuck 
    859   1.1     chuck     s = splbio();
    860   1.1     chuck 
    861  1.16    bouyer     my_id = dev->sc_channel.chan_id & SBIC_ID_MASK;
    862   1.1     chuck 
    863   1.1     chuck     if (dev->sc_clkfreq < 110)
    864   1.1     chuck         my_id |= SBIC_ID_FS_8_10;
    865   1.1     chuck     else if (dev->sc_clkfreq < 160)
    866   1.1     chuck         my_id |= SBIC_ID_FS_12_15;
    867   1.1     chuck     else if (dev->sc_clkfreq < 210)
    868   1.1     chuck         my_id |= SBIC_ID_FS_16_20;
    869   1.1     chuck 
    870   1.1     chuck     SET_SBIC_myid(regs, my_id);
    871   1.1     chuck 
    872   1.1     chuck     /*
    873   1.1     chuck      * Reset the chip
    874   1.1     chuck      */
    875   1.1     chuck     SET_SBIC_cmd(regs, SBIC_CMD_RESET);
    876   1.1     chuck     DELAY(25);
    877   1.1     chuck 
    878   1.1     chuck     SBIC_WAIT(regs, SBIC_ASR_INT, 0);
    879   1.1     chuck     GET_SBIC_csr(regs, csr);       /* clears interrupt also */
    880   1.1     chuck 
    881   1.1     chuck     /*
    882   1.1     chuck      * Set up various chip parameters
    883   1.1     chuck      */
    884   1.1     chuck     SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
    885   1.1     chuck 
    886   1.1     chuck     /*
    887   1.1     chuck      * don't allow Selection (SBIC_RID_ES)
    888   1.1     chuck      * until we can handle target mode!!
    889   1.1     chuck      */
    890   1.1     chuck     SET_SBIC_rselid(regs, SBIC_RID_ER);
    891   1.1     chuck 
    892   1.1     chuck     /*
    893   1.1     chuck      * Asynchronous for now
    894   1.1     chuck      */
    895   1.1     chuck     SET_SBIC_syn(regs, 0);
    896   1.1     chuck 
    897   1.1     chuck     /*
    898   1.1     chuck      * Anything else was zeroed by reset
    899   1.1     chuck      */
    900   1.1     chuck     splx(s);
    901   1.1     chuck 
    902   1.1     chuck     dev->sc_flags &= ~SBICF_SELECTED;
    903   1.1     chuck }
    904   1.1     chuck 
    905   1.1     chuck void
    906   1.1     chuck sbicerror(dev, csr)
    907   1.1     chuck     struct sbic_softc   *dev;
    908   1.1     chuck     u_char              csr;
    909   1.1     chuck {
    910   1.6    bouyer     struct scsipi_xfer    *xs  = dev->sc_xs;
    911   1.1     chuck 
    912   1.1     chuck #ifdef DIAGNOSTIC
    913   1.1     chuck     if ( xs == NULL )
    914   1.1     chuck         panic("sbicerror: dev->sc_xs == NULL");
    915   1.1     chuck #endif
    916   1.1     chuck 
    917  1.10   thorpej     if ( xs->xs_control & XS_CTL_SILENT )
    918   1.1     chuck         return;
    919   1.1     chuck 
    920   1.5  christos     printf("%s: csr == 0x%02x\n", dev->sc_dev.dv_xname, csr);
    921   1.1     chuck }
    922   1.1     chuck 
    923   1.1     chuck /*
    924   1.1     chuck  * select the bus, return when selected or error.
    925   1.1     chuck  *
    926   1.1     chuck  * Returns the current CSR following selection and optionally MSG out phase.
    927   1.1     chuck  * i.e. the returned CSR *should* indicate CMD phase...
    928   1.1     chuck  * If the return value is 0, some error happened.
    929   1.1     chuck  */
    930   1.1     chuck u_char
    931   1.1     chuck sbicselectbus(dev)
    932   1.1     chuck     struct sbic_softc   *dev;
    933   1.1     chuck {
    934   1.1     chuck     sbic_regmap_p   regs   = dev->sc_sbicp;
    935   1.1     chuck     u_char          target = dev->target,
    936   1.1     chuck                     lun    = dev->lun,
    937   1.1     chuck                     asr,
    938   1.1     chuck                     csr,
    939   1.1     chuck                     id;
    940   1.1     chuck 
    941   1.1     chuck     /*
    942   1.1     chuck      * if we're already selected, return (XXXX panic maybe?)
    943   1.1     chuck      */
    944   1.1     chuck     if ( dev->sc_flags & SBICF_SELECTED )
    945   1.1     chuck         return(0);
    946   1.1     chuck 
    947   1.1     chuck     QPRINTF(("sbicselectbus %d: ", target));
    948   1.1     chuck 
    949   1.1     chuck     /*
    950   1.1     chuck      * issue select
    951   1.1     chuck      */
    952   1.1     chuck     SET_SBIC_selid(regs, target);
    953   1.1     chuck     SET_SBIC_timeo(regs, SBIC_TIMEOUT(250, dev->sc_clkfreq));
    954   1.1     chuck 
    955   1.1     chuck     GET_SBIC_asr(regs, asr);
    956   1.1     chuck 
    957   1.1     chuck     if ( asr & (SBIC_ASR_INT|SBIC_ASR_BSY) ) {
    958   1.1     chuck         /*
    959   1.1     chuck          * This means we got ourselves reselected upon
    960   1.1     chuck          */
    961   1.1     chuck         QPRINTF(("WD busy (reselect?)\n"));
    962   1.1     chuck         return 0;
    963   1.1     chuck     }
    964   1.1     chuck 
    965   1.1     chuck     SET_SBIC_cmd(regs, SBIC_CMD_SEL_ATN);
    966   1.1     chuck 
    967   1.1     chuck     /*
    968  1.18       wiz      * wait for select (merged from separate function may need
    969   1.1     chuck      * cleanup)
    970   1.1     chuck      */
    971   1.1     chuck     WAIT_CIP(regs);
    972   1.1     chuck 
    973   1.1     chuck     do {
    974   1.1     chuck 
    975   1.1     chuck         asr = SBIC_WAIT(regs, SBIC_ASR_INT | SBIC_ASR_LCI, 0);
    976   1.1     chuck 
    977   1.1     chuck         if ( asr & SBIC_ASR_LCI ) {
    978   1.1     chuck             QPRINTF(("late LCI: asr %02x\n", asr));
    979   1.1     chuck             return 0;
    980   1.1     chuck         }
    981   1.1     chuck 
    982   1.1     chuck         /*
    983   1.1     chuck          * Clear interrupt
    984   1.1     chuck          */
    985   1.1     chuck         GET_SBIC_csr (regs, csr);
    986   1.1     chuck 
    987   1.1     chuck         QPRINTF(("%02x ", csr));
    988   1.1     chuck 
    989   1.1     chuck         /*
    990   1.1     chuck          * Reselected from under our feet?
    991   1.1     chuck          */
    992   1.1     chuck         if ( csr == SBIC_CSR_RSLT_NI || csr == SBIC_CSR_RSLT_IFY ) {
    993   1.1     chuck             QPRINTF(("got reselected, asr %02x\n", asr));
    994   1.1     chuck             /*
    995   1.1     chuck              * We need to handle this now so we don't lock up later
    996   1.1     chuck              */
    997   1.1     chuck             sbicnextstate(dev, csr, asr);
    998   1.1     chuck 
    999   1.1     chuck             return 0;
   1000   1.1     chuck         }
   1001   1.1     chuck 
   1002   1.1     chuck         /*
   1003   1.1     chuck          * Whoops!
   1004   1.1     chuck          */
   1005   1.1     chuck         if ( csr == SBIC_CSR_SLT || csr == SBIC_CSR_SLT_ATN ) {
   1006   1.1     chuck             panic("sbicselectbus: target issued select!");
   1007   1.1     chuck             return 0;
   1008   1.1     chuck         }
   1009   1.1     chuck 
   1010   1.1     chuck     } while (csr != (SBIC_CSR_MIS_2 | MESG_OUT_PHASE) &&
   1011   1.1     chuck              csr != (SBIC_CSR_MIS_2 | CMD_PHASE) &&
   1012   1.1     chuck              csr != SBIC_CSR_SEL_TIMEO);
   1013   1.1     chuck 
   1014   1.1     chuck     /*
   1015   1.1     chuck      * Anyone at home?
   1016   1.1     chuck      */
   1017   1.1     chuck     if ( csr == SBIC_CSR_SEL_TIMEO ) {
   1018   1.1     chuck         dev->sc_xs->error = XS_SELTIMEOUT;
   1019   1.1     chuck         QPRINTF(("Selection Timeout\n"));
   1020   1.1     chuck         return 0;
   1021   1.1     chuck     }
   1022   1.1     chuck 
   1023   1.1     chuck     QPRINTF(("Selection Complete\n"));
   1024   1.1     chuck 
   1025   1.1     chuck     /*
   1026   1.1     chuck      * Assume we're now selected
   1027   1.1     chuck      */
   1028   1.1     chuck     GET_SBIC_selid(regs, id);
   1029   1.1     chuck     dev->target    = id;
   1030   1.1     chuck     dev->lun       = lun;
   1031   1.1     chuck     dev->sc_flags |= SBICF_SELECTED;
   1032   1.1     chuck 
   1033   1.1     chuck     /*
   1034   1.1     chuck      * Enable (or not) reselection
   1035   1.1     chuck      * XXXSCW This is probably not necessary since we don't use use the
   1036   1.2     chuck      * Select-and-Xfer-with-ATN command to initiate a selection...
   1037   1.1     chuck      */
   1038   1.1     chuck     if ( !sbic_enable_reselect && dev->nexus_list.tqh_first == NULL)
   1039   1.1     chuck         SET_SBIC_rselid (regs, 0);
   1040   1.1     chuck     else
   1041   1.1     chuck         SET_SBIC_rselid (regs, SBIC_RID_ER);
   1042   1.1     chuck 
   1043   1.1     chuck     /*
   1044   1.1     chuck      * We only really need to do anything when the target goes to MSG out
   1045   1.1     chuck      * If the device ignored ATN, it's probably old and brain-dead,
   1046   1.1     chuck      * but we'll try to support it anyhow.
   1047   1.1     chuck      * If it doesn't support message out, it definately doesn't
   1048   1.1     chuck      * support synchronous transfers, so no point in even asking...
   1049   1.1     chuck      */
   1050   1.1     chuck     if ( csr == (SBIC_CSR_MIS_2 | MESG_OUT_PHASE) ) {
   1051   1.1     chuck         /*
   1052   1.1     chuck          * Send identify message (SCSI-2 requires an identify msg)
   1053   1.1     chuck          */
   1054   1.1     chuck         if ( sbic_inhibit_sync[id] && dev->sc_sync[id].state == SYNC_START ) {
   1055   1.1     chuck             /*
   1056   1.1     chuck              * Handle drives that don't want to be asked
   1057   1.1     chuck              * whether to go sync at all.
   1058   1.1     chuck              */
   1059   1.1     chuck             dev->sc_sync[id].offset = 0;
   1060   1.1     chuck             dev->sc_sync[id].period = sbic_min_period;
   1061   1.1     chuck             dev->sc_sync[id].state  = SYNC_DONE;
   1062   1.1     chuck         }
   1063   1.1     chuck 
   1064   1.1     chuck         /*
   1065   1.1     chuck          * Do we need to negotiate Synchronous Xfers for this target?
   1066   1.1     chuck          */
   1067   1.1     chuck         if ( dev->sc_sync[id].state != SYNC_START ) {
   1068   1.1     chuck             /*
   1069   1.1     chuck              * Nope, we've already negotiated.
   1070   1.1     chuck              * Now see if we should allow the target to disconnect/reselect...
   1071   1.1     chuck              */
   1072  1.10   thorpej             if ( dev->sc_xs->xs_control & XS_CTL_POLL || dev->sc_flags & SBICF_ICMD ||
   1073   1.1     chuck                                                   !sbic_enable_reselect )
   1074   1.1     chuck                 SEND_BYTE (regs, MSG_IDENTIFY | lun);
   1075   1.1     chuck             else
   1076   1.1     chuck                 SEND_BYTE (regs, MSG_IDENTIFY_DR | lun);
   1077   1.1     chuck 
   1078   1.1     chuck         } else {
   1079   1.1     chuck             /*
   1080   1.1     chuck              * try to initiate a sync transfer.
   1081   1.1     chuck              * So compose the sync message we're going
   1082   1.1     chuck              * to send to the target
   1083   1.1     chuck              */
   1084   1.1     chuck #ifdef DEBUG
   1085   1.1     chuck             if ( sync_debug )
   1086   1.5  christos                 printf("\nSending sync request to target %d ... ", id);
   1087   1.1     chuck #endif
   1088   1.1     chuck             /*
   1089   1.1     chuck              * setup scsi message sync message request
   1090   1.1     chuck              */
   1091   1.1     chuck             dev->sc_msg[0] = MSG_IDENTIFY | lun;
   1092   1.1     chuck             dev->sc_msg[1] = MSG_EXT_MESSAGE;
   1093   1.1     chuck             dev->sc_msg[2] = 3;
   1094   1.1     chuck             dev->sc_msg[3] = MSG_SYNC_REQ;
   1095   1.1     chuck             dev->sc_msg[4] = sbictoscsiperiod(dev, sbic_min_period);
   1096   1.1     chuck             dev->sc_msg[5] = sbic_max_offset;
   1097   1.1     chuck 
   1098   1.1     chuck             sbicxfout(regs, 6, dev->sc_msg);
   1099   1.1     chuck 
   1100   1.1     chuck             dev->sc_sync[id].state = SYNC_SENT;
   1101   1.1     chuck #ifdef DEBUG
   1102   1.1     chuck             if ( sync_debug )
   1103   1.5  christos                 printf ("sent\n");
   1104   1.1     chuck #endif
   1105   1.1     chuck         }
   1106   1.1     chuck 
   1107   1.1     chuck         /*
   1108   1.1     chuck          * There's one interrupt still to come: the change to CMD phase...
   1109   1.1     chuck          */
   1110   1.1     chuck         SBIC_WAIT(regs, SBIC_ASR_INT , 0);
   1111   1.1     chuck         GET_SBIC_csr(regs, csr);
   1112   1.1     chuck     }
   1113   1.1     chuck 
   1114   1.2     chuck     /*
   1115   1.2     chuck      * set sync or async
   1116   1.2     chuck      */
   1117   1.2     chuck     if ( dev->sc_sync[target].state == SYNC_DONE ) {
   1118   1.2     chuck #ifdef  DEBUG
   1119   1.2     chuck         if ( sync_debug )
   1120   1.5  christos             printf("select(%d): sync reg = 0x%02x\n", target,
   1121   1.2     chuck                             SBIC_SYN(dev->sc_sync[target].offset,
   1122   1.2     chuck                                      dev->sc_sync[target].period));
   1123   1.2     chuck #endif
   1124   1.2     chuck         SET_SBIC_syn(regs, SBIC_SYN(dev->sc_sync[target].offset,
   1125   1.2     chuck                                     dev->sc_sync[target].period));
   1126   1.2     chuck     } else {
   1127   1.2     chuck #ifdef  DEBUG
   1128   1.2     chuck         if ( sync_debug )
   1129   1.5  christos             printf("select(%d): sync reg = 0x%02x\n", target,
   1130   1.2     chuck                             SBIC_SYN(0,sbic_min_period));
   1131   1.2     chuck #endif
   1132   1.2     chuck         SET_SBIC_syn(regs, SBIC_SYN(0, sbic_min_period));
   1133   1.2     chuck     }
   1134   1.2     chuck 
   1135   1.1     chuck     return csr;
   1136   1.1     chuck }
   1137   1.1     chuck 
   1138   1.1     chuck /*
   1139   1.2     chuck  * Information Transfer *to* a Scsi Target.
   1140   1.2     chuck  *
   1141   1.2     chuck  * Note: Don't expect there to be an interrupt immediately after all
   1142   1.2     chuck  * the data is transferred out. The WD spec sheet says that the Transfer-
   1143   1.2     chuck  * Info command for non-MSG_IN phases only completes when the target
   1144   1.2     chuck  * next asserts 'REQ'. That is, when the SCSI bus changes to a new state.
   1145   1.2     chuck  *
   1146   1.2     chuck  * This can have a nasty effect on commands which take a relatively long
   1147   1.2     chuck  * time to complete, for example a START/STOP unit command may remain in
   1148   1.2     chuck  * CMD phase until the disk has spun up. Only then will the target change
   1149   1.2     chuck  * to STATUS phase. This is really only a problem for immediate commands
   1150   1.2     chuck  * since we don't allow disconnection for them (yet).
   1151   1.1     chuck  */
   1152   1.1     chuck int
   1153   1.1     chuck sbicxfout(regs, len, bp)
   1154   1.1     chuck     sbic_regmap_p   regs;
   1155   1.1     chuck     int             len;
   1156   1.1     chuck     void            *bp;
   1157   1.1     chuck {
   1158   1.1     chuck     int     wait = sbic_data_wait;
   1159   1.1     chuck     u_char  asr,
   1160   1.1     chuck             *buf = bp;
   1161   1.1     chuck 
   1162   1.1     chuck     QPRINTF(("sbicxfout {%d} %02x %02x %02x %02x %02x "
   1163   1.1     chuck         "%02x %02x %02x %02x %02x\n", len, buf[0], buf[1], buf[2],
   1164   1.1     chuck         buf[3], buf[4], buf[5], buf[6], buf[7], buf[8], buf[9]));
   1165   1.1     chuck 
   1166   1.1     chuck     /*
   1167   1.1     chuck      * sigh.. WD-PROTO strikes again.. sending the command in one go
   1168   1.1     chuck      * causes the chip to lock up if talking to certain (misbehaving?)
   1169   1.1     chuck      * targets. Anyway, this procedure should work for all targets, but
   1170   1.1     chuck      * it's slightly slower due to the overhead
   1171   1.1     chuck      */
   1172   1.1     chuck     WAIT_CIP (regs);
   1173   1.1     chuck 
   1174   1.1     chuck     SBIC_TC_PUT (regs, 0);
   1175   1.1     chuck     SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
   1176   1.1     chuck     SBIC_TC_PUT (regs, (unsigned)len);
   1177   1.1     chuck     SET_SBIC_cmd (regs, SBIC_CMD_XFER_INFO);
   1178   1.1     chuck 
   1179   1.1     chuck     /*
   1180   1.1     chuck      * Loop for each byte transferred
   1181   1.1     chuck      */
   1182   1.1     chuck     do {
   1183   1.1     chuck 
   1184   1.1     chuck         GET_SBIC_asr (regs, asr);
   1185   1.1     chuck 
   1186   1.1     chuck         if ( asr & SBIC_ASR_DBR ) {
   1187   1.1     chuck             if ( len ) {
   1188   1.1     chuck                 SET_SBIC_data (regs, *buf);
   1189   1.1     chuck                 buf++;
   1190   1.1     chuck                 len--;
   1191   1.1     chuck             } else {
   1192   1.1     chuck                 SET_SBIC_data (regs, 0);
   1193   1.1     chuck             }
   1194   1.1     chuck             wait = sbic_data_wait;
   1195   1.1     chuck         }
   1196   1.1     chuck 
   1197   1.2     chuck     } while ( len && (asr & SBIC_ASR_INT) == 0 && wait-- > 0 );
   1198   1.1     chuck 
   1199   1.1     chuck #ifdef  DEBUG
   1200   1.1     chuck     QPRINTF(("sbicxfout done: %d bytes remaining (wait:%d)\n", len, wait));
   1201   1.1     chuck #endif
   1202   1.1     chuck 
   1203   1.1     chuck     /*
   1204   1.2     chuck      * Normally, an interrupt will be pending when this routing returns.
   1205   1.1     chuck      */
   1206   1.1     chuck     return(len);
   1207   1.1     chuck }
   1208   1.1     chuck 
   1209   1.1     chuck /*
   1210   1.1     chuck  * Information Transfer *from* a Scsi Target
   1211   1.1     chuck  * returns # bytes left to read
   1212   1.1     chuck  */
   1213   1.1     chuck int
   1214   1.1     chuck sbicxfin(regs, len, bp)
   1215   1.1     chuck     sbic_regmap_p   regs;
   1216   1.1     chuck     int             len;
   1217   1.1     chuck     void            *bp;
   1218   1.1     chuck {
   1219   1.1     chuck     int     wait = sbic_data_wait;
   1220   1.1     chuck     u_char  *buf = bp;
   1221   1.1     chuck     u_char  asr;
   1222   1.1     chuck #ifdef  DEBUG
   1223   1.1     chuck     u_char  *obp = bp;
   1224   1.1     chuck #endif
   1225   1.1     chuck 
   1226   1.1     chuck     WAIT_CIP (regs);
   1227   1.1     chuck 
   1228   1.1     chuck     SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
   1229   1.1     chuck     SBIC_TC_PUT (regs, (unsigned)len);
   1230   1.1     chuck     SET_SBIC_cmd (regs, SBIC_CMD_XFER_INFO);
   1231   1.1     chuck 
   1232   1.1     chuck     /*
   1233   1.1     chuck      * Loop for each byte transferred
   1234   1.1     chuck      */
   1235   1.1     chuck     do {
   1236   1.1     chuck 
   1237   1.1     chuck         GET_SBIC_asr (regs, asr);
   1238   1.1     chuck 
   1239   1.1     chuck         if ( asr & SBIC_ASR_DBR ) {
   1240   1.1     chuck             if ( len ) {
   1241   1.1     chuck                 GET_SBIC_data (regs, *buf);
   1242   1.1     chuck                 buf++;
   1243   1.1     chuck                 len--;
   1244   1.1     chuck             } else {
   1245   1.1     chuck                 u_char foo;
   1246   1.1     chuck                 GET_SBIC_data (regs, foo);
   1247   1.1     chuck             }
   1248   1.1     chuck             wait = sbic_data_wait;
   1249   1.1     chuck         }
   1250   1.1     chuck 
   1251   1.1     chuck     } while ( (asr & SBIC_ASR_INT) == 0 && wait-- > 0 );
   1252   1.1     chuck 
   1253   1.1     chuck     QPRINTF(("sbicxfin {%d} %02x %02x %02x %02x %02x %02x "
   1254   1.1     chuck         "%02x %02x %02x %02x\n", len, obp[0], obp[1], obp[2],
   1255   1.1     chuck         obp[3], obp[4], obp[5], obp[6], obp[7], obp[8], obp[9]));
   1256   1.1     chuck 
   1257   1.1     chuck     SBIC_TC_PUT (regs, 0);
   1258   1.1     chuck 
   1259   1.1     chuck     /*
   1260   1.1     chuck      * this leaves with one csr to be read
   1261   1.1     chuck      */
   1262   1.1     chuck     return len;
   1263   1.1     chuck }
   1264   1.1     chuck 
   1265   1.1     chuck /*
   1266   1.1     chuck  * SCSI 'immediate' command:  issue a command to some SCSI device
   1267   1.1     chuck  * and get back an 'immediate' response (i.e., do programmed xfer
   1268   1.1     chuck  * to get the response data).  'cbuf' is a buffer containing a scsi
   1269   1.1     chuck  * command of length clen bytes.  'buf' is a buffer of length 'len'
   1270   1.1     chuck  * bytes for data.  The transfer direction is determined by the device
   1271   1.1     chuck  * (i.e., by the scsi bus data xfer phase).  If 'len' is zero, the
   1272   1.1     chuck  * command must supply no data.
   1273   1.2     chuck  *
   1274   1.2     chuck  * Note that although this routine looks like it can handle disconnect/
   1275   1.2     chuck  * reselect, the fact is that it can't. There is still some work to be
   1276   1.2     chuck  * done to clean this lot up.
   1277   1.1     chuck  */
   1278   1.1     chuck int
   1279   1.1     chuck sbicicmd(dev, cbuf, clen, buf, len)
   1280   1.1     chuck     struct sbic_softc   *dev;
   1281   1.1     chuck     void                *cbuf,
   1282   1.1     chuck                         *buf;
   1283   1.1     chuck     int                 clen,
   1284   1.1     chuck                         len;
   1285   1.1     chuck {
   1286   1.1     chuck     sbic_regmap_p   regs = dev->sc_sbicp;
   1287   1.1     chuck     struct sbic_acb *acb = dev->sc_nexus;
   1288   1.1     chuck     u_char          csr,
   1289   1.1     chuck                     asr;
   1290   1.2     chuck     int             still_busy = SBIC_STATE_RUNNING;
   1291   1.1     chuck 
   1292   1.1     chuck     /*
   1293   1.1     chuck      * Make sure pointers are OK
   1294   1.1     chuck      */
   1295   1.1     chuck     dev->sc_last = dev->sc_cur = &acb->sc_pa;
   1296   1.1     chuck     dev->sc_tcnt = acb->sc_tcnt = 0;
   1297   1.1     chuck 
   1298   1.1     chuck     acb->sc_dmacmd      = 0;
   1299   1.1     chuck     acb->sc_pa.dc_count = 0; /* No DMA */
   1300   1.1     chuck     acb->sc_kv.dc_addr  = buf;
   1301   1.1     chuck     acb->sc_kv.dc_count = len;
   1302   1.1     chuck 
   1303   1.1     chuck #ifdef  DEBUG
   1304   1.1     chuck     if ( data_pointer_debug > 1 )
   1305   1.5  christos         printf("sbicicmd(%d,%d):%d\n", dev->target, dev->lun, acb->sc_kv.dc_count);
   1306   1.1     chuck #endif
   1307   1.1     chuck 
   1308   1.1     chuck     /*
   1309   1.1     chuck      * set the sbic into non-DMA mode
   1310   1.1     chuck      */
   1311   1.1     chuck     SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
   1312   1.1     chuck 
   1313   1.1     chuck     dev->sc_stat[0] = 0xff;
   1314   1.1     chuck     dev->sc_msg[0]  = 0xff;
   1315   1.1     chuck 
   1316   1.1     chuck     /*
   1317   1.1     chuck      * We're stealing the SCSI bus
   1318   1.1     chuck      */
   1319   1.1     chuck     dev->sc_flags |= SBICF_ICMD;
   1320   1.1     chuck 
   1321   1.1     chuck     do {
   1322   1.1     chuck         GET_SBIC_asr (regs, asr);
   1323   1.1     chuck 
   1324   1.1     chuck         /*
   1325   1.1     chuck          * select the SCSI bus (it's an error if bus isn't free)
   1326   1.1     chuck          */
   1327   1.2     chuck         if ( (dev->sc_flags & SBICF_SELECTED) == 0 &&
   1328   1.2     chuck              still_busy != SBIC_STATE_DISCONNECT ) {
   1329   1.1     chuck             if ( (csr = sbicselectbus(dev)) == 0 ) {
   1330   1.1     chuck                 dev->sc_flags &= ~SBICF_ICMD;
   1331   1.1     chuck                 return(-1);
   1332   1.1     chuck             }
   1333   1.1     chuck         } else
   1334   1.2     chuck         if ( (asr & (SBIC_ASR_BSY | SBIC_ASR_INT)) == SBIC_ASR_INT )
   1335   1.1     chuck             GET_SBIC_csr(regs, csr);
   1336   1.2     chuck         else
   1337   1.2     chuck             csr = 0;
   1338   1.2     chuck 
   1339   1.2     chuck         if ( csr ) {
   1340   1.2     chuck 
   1341   1.2     chuck             QPRINTF((">ASR:0x%02x CSR:0x%02x< ", asr, csr));
   1342   1.1     chuck 
   1343   1.2     chuck             switch ( csr ) {
   1344   1.1     chuck 
   1345   1.2     chuck               case SBIC_CSR_S_XFERRED:
   1346   1.2     chuck               case SBIC_CSR_DISC:
   1347   1.2     chuck               case SBIC_CSR_DISC_1:
   1348   1.2     chuck                 {
   1349   1.2     chuck                     u_char  phase;
   1350   1.1     chuck 
   1351   1.2     chuck                     dev->sc_flags &= ~SBICF_SELECTED;
   1352   1.2     chuck                     GET_SBIC_cmd_phase (regs, phase);
   1353   1.2     chuck 
   1354   1.2     chuck                     if ( phase == 0x60 ) {
   1355   1.2     chuck                         GET_SBIC_tlun (regs, dev->sc_stat[0]);
   1356   1.2     chuck                         still_busy = SBIC_STATE_DONE; /* done */
   1357   1.2     chuck                     } else {
   1358   1.1     chuck #ifdef DEBUG
   1359   1.2     chuck                         if ( reselect_debug > 1 )
   1360   1.5  christos                             printf("sbicicmd: handling disconnect\n");
   1361   1.1     chuck #endif
   1362   1.2     chuck                         still_busy = SBIC_STATE_DISCONNECT;
   1363   1.2     chuck                     }
   1364   1.1     chuck                 }
   1365   1.2     chuck                 break;
   1366   1.1     chuck 
   1367   1.2     chuck               case SBIC_CSR_XFERRED | CMD_PHASE:
   1368   1.2     chuck               case SBIC_CSR_MIS     | CMD_PHASE:
   1369   1.2     chuck               case SBIC_CSR_MIS_1   | CMD_PHASE:
   1370   1.2     chuck               case SBIC_CSR_MIS_2   | CMD_PHASE:
   1371   1.2     chuck                 {
   1372   1.2     chuck                     if ( sbicxfout(regs, clen, cbuf) )
   1373   1.2     chuck                         still_busy = sbicabort(dev, "icmd sending cmd");
   1374   1.2     chuck                 }
   1375   1.2     chuck                 break;
   1376   1.1     chuck 
   1377   1.2     chuck               case SBIC_CSR_XFERRED | STATUS_PHASE:
   1378   1.2     chuck               case SBIC_CSR_MIS     | STATUS_PHASE:
   1379   1.2     chuck               case SBIC_CSR_MIS_1   | STATUS_PHASE:
   1380   1.2     chuck               case SBIC_CSR_MIS_2   | STATUS_PHASE:
   1381   1.2     chuck                 {
   1382   1.2     chuck                     /*
   1383   1.2     chuck                      * The sbic does the status/cmd-complete reading ok,
   1384   1.2     chuck                      * so do this with its hi-level commands.
   1385   1.2     chuck                      */
   1386   1.1     chuck #ifdef DEBUG
   1387   1.2     chuck                     if ( sbic_debug )
   1388   1.5  christos                         printf("SBICICMD status phase (bsy=%d)\n", still_busy);
   1389   1.1     chuck #endif
   1390   1.2     chuck                     SET_SBIC_cmd_phase(regs, 0x46);
   1391   1.2     chuck                     SET_SBIC_cmd(regs, SBIC_CMD_SEL_ATN_XFER);
   1392   1.2     chuck                 }
   1393   1.2     chuck                 break;
   1394   1.1     chuck 
   1395   1.2     chuck               default:
   1396   1.2     chuck                 {
   1397   1.2     chuck                     still_busy = sbicnextstate(dev, csr, asr);
   1398   1.2     chuck                 }
   1399   1.2     chuck                 break;
   1400   1.1     chuck             }
   1401   1.1     chuck 
   1402   1.2     chuck             /*
   1403   1.2     chuck              * make sure the last command was taken,
   1404   1.2     chuck              * ie. we're not hunting after an ignored command..
   1405   1.2     chuck              */
   1406   1.2     chuck             GET_SBIC_asr(regs, asr);
   1407   1.1     chuck 
   1408   1.2     chuck             /*
   1409   1.2     chuck              * tapes may take a loooong time..
   1410   1.2     chuck              */
   1411   1.2     chuck             while (asr & SBIC_ASR_BSY ) {
   1412   1.1     chuck 
   1413   1.2     chuck                 if ( asr & SBIC_ASR_DBR ) {
   1414   1.2     chuck                     int     i;
   1415   1.1     chuck 
   1416   1.5  christos                     printf("sbicicmd: Waiting while sbic is jammed, CSR:%02x,ASR:%02x\n", csr,asr);
   1417   1.1     chuck #ifdef DDB
   1418   1.2     chuck                     Debugger();
   1419   1.1     chuck #endif
   1420   1.2     chuck                     /*
   1421   1.2     chuck                      * SBIC is jammed
   1422   1.2     chuck                      * DUNNO which direction
   1423   1.2     chuck                      * Try old direction
   1424   1.2     chuck                      */
   1425   1.2     chuck                     GET_SBIC_data(regs, i);
   1426   1.2     chuck                     GET_SBIC_asr(regs, asr);
   1427   1.2     chuck 
   1428   1.2     chuck                     if ( asr & SBIC_ASR_DBR ) /* Wants us to write */
   1429   1.2     chuck                         SET_SBIC_data(regs, i);
   1430   1.2     chuck                 }
   1431   1.2     chuck 
   1432   1.1     chuck                 GET_SBIC_asr(regs, asr);
   1433   1.1     chuck             }
   1434   1.1     chuck         }
   1435   1.1     chuck 
   1436   1.1     chuck         /*
   1437   1.1     chuck          * wait for last command to complete
   1438   1.1     chuck          */
   1439   1.1     chuck         if ( asr & SBIC_ASR_LCI ) {
   1440   1.5  christos             printf("sbicicmd: last command ignored\n");
   1441   1.1     chuck         }
   1442   1.1     chuck         else
   1443   1.2     chuck         if ( still_busy >= SBIC_STATE_RUNNING ) /* Bsy */
   1444   1.1     chuck             SBIC_WAIT (regs, SBIC_ASR_INT, sbic_cmd_wait);
   1445   1.1     chuck 
   1446   1.1     chuck         /*
   1447   1.1     chuck          * do it again
   1448   1.1     chuck          */
   1449   1.2     chuck     } while ( still_busy >= SBIC_STATE_RUNNING && dev->sc_stat[0] == 0xff );
   1450   1.1     chuck 
   1451   1.1     chuck     /*
   1452   1.1     chuck      * Sometimes we need to do an extra read of the CSR
   1453   1.1     chuck      */
   1454   1.1     chuck     GET_SBIC_csr(regs, csr);
   1455   1.1     chuck 
   1456   1.1     chuck #ifdef DEBUG
   1457   1.1     chuck     if ( data_pointer_debug > 1 )
   1458   1.5  christos         printf("sbicicmd done(%d,%d):%d =%d=\n", dev->target, dev->lun,
   1459   1.1     chuck                                                  acb->sc_kv.dc_count,
   1460   1.1     chuck                                                  dev->sc_stat[0]);
   1461   1.1     chuck #endif
   1462   1.1     chuck 
   1463   1.1     chuck     dev->sc_flags &= ~SBICF_ICMD;
   1464   1.1     chuck 
   1465   1.1     chuck     return(dev->sc_stat[0]);
   1466   1.1     chuck }
   1467   1.1     chuck 
   1468   1.1     chuck /*
   1469   1.1     chuck  * Finish SCSI xfer command:  After the completion interrupt from
   1470   1.1     chuck  * a read/write operation, sequence through the final phases in
   1471   1.1     chuck  * programmed i/o.  This routine is a lot like sbicicmd except we
   1472   1.1     chuck  * skip (and don't allow) the select, cmd out and data in/out phases.
   1473   1.1     chuck  */
   1474   1.1     chuck void
   1475   1.1     chuck sbicxfdone(dev)
   1476   1.1     chuck     struct sbic_softc   *dev;
   1477   1.1     chuck {
   1478   1.1     chuck     sbic_regmap_p   regs = dev->sc_sbicp;
   1479   1.1     chuck     u_char          phase,
   1480   1.1     chuck                     csr;
   1481   1.1     chuck     int             s;
   1482   1.1     chuck 
   1483   1.1     chuck     QPRINTF(("{"));
   1484   1.1     chuck     s = splbio();
   1485   1.1     chuck 
   1486   1.1     chuck     /*
   1487   1.1     chuck      * have the sbic complete on its own
   1488   1.1     chuck      */
   1489   1.1     chuck     SBIC_TC_PUT(regs, 0);
   1490   1.1     chuck     SET_SBIC_cmd_phase(regs, 0x46);
   1491   1.1     chuck     SET_SBIC_cmd(regs, SBIC_CMD_SEL_ATN_XFER);
   1492   1.1     chuck 
   1493   1.1     chuck     do {
   1494   1.1     chuck 
   1495   1.1     chuck         SBIC_WAIT (regs, SBIC_ASR_INT, 0);
   1496   1.1     chuck         GET_SBIC_csr (regs, csr);
   1497   1.1     chuck         QPRINTF(("%02x:", csr));
   1498   1.1     chuck 
   1499   1.1     chuck     } while ( (csr != SBIC_CSR_DISC) && (csr != SBIC_CSR_DISC_1) &&
   1500   1.1     chuck               (csr != SBIC_CSR_S_XFERRED));
   1501   1.1     chuck 
   1502   1.1     chuck     dev->sc_flags &= ~SBICF_SELECTED;
   1503   1.1     chuck 
   1504   1.1     chuck     GET_SBIC_cmd_phase (regs, phase);
   1505   1.1     chuck     QPRINTF(("}%02x", phase));
   1506   1.1     chuck 
   1507   1.1     chuck     if ( phase == 0x60 )
   1508   1.1     chuck         GET_SBIC_tlun(regs, dev->sc_stat[0]);
   1509   1.1     chuck     else
   1510   1.1     chuck         sbicerror(dev, csr);
   1511   1.1     chuck 
   1512   1.1     chuck     QPRINTF(("=STS:%02x=\n", dev->sc_stat[0]));
   1513   1.1     chuck 
   1514   1.1     chuck     splx(s);
   1515   1.1     chuck }
   1516   1.1     chuck 
   1517   1.1     chuck /*
   1518   1.1     chuck  * No DMA chains
   1519   1.1     chuck  */
   1520   1.1     chuck int
   1521   1.1     chuck sbicgo(dev, xs)
   1522   1.1     chuck     struct sbic_softc   *dev;
   1523   1.6    bouyer     struct scsipi_xfer    *xs;
   1524   1.1     chuck {
   1525   1.1     chuck     struct sbic_acb *acb = dev->sc_nexus;
   1526   1.1     chuck     sbic_regmap_p   regs = dev->sc_sbicp;
   1527   1.1     chuck     int             i,
   1528   1.1     chuck                     dmaflags,
   1529   1.1     chuck                     count,
   1530   1.1     chuck                     usedma;
   1531   1.1     chuck     u_char          csr,
   1532   1.1     chuck                     asr,
   1533   1.1     chuck                     *addr;
   1534   1.1     chuck 
   1535  1.16    bouyer     dev->target = xs->xs_periph->periph_target;
   1536  1.16    bouyer     dev->lun    = xs->xs_periph->periph_lun;
   1537   1.1     chuck 
   1538   1.1     chuck     usedma = sbicdmaok(dev, xs);
   1539   1.1     chuck 
   1540   1.1     chuck #ifdef DEBUG
   1541   1.1     chuck     if ( data_pointer_debug > 1 )
   1542   1.5  christos         printf("sbicgo(%d,%d): usedma=%d\n", dev->target, dev->lun, usedma);
   1543   1.1     chuck #endif
   1544   1.1     chuck 
   1545   1.1     chuck     /*
   1546   1.1     chuck      * select the SCSI bus (it's an error if bus isn't free)
   1547   1.1     chuck      */
   1548   1.1     chuck     if ( (csr = sbicselectbus(dev)) == 0 )
   1549   1.1     chuck         return(0); /* Not done: needs to be rescheduled */
   1550   1.1     chuck 
   1551   1.1     chuck     dev->sc_stat[0] = 0xff;
   1552   1.1     chuck 
   1553   1.1     chuck     /*
   1554   1.1     chuck      * Calculate DMA chains now
   1555   1.1     chuck      */
   1556   1.1     chuck     if ( acb->flags & ACB_DATAIN )
   1557   1.1     chuck         dmaflags = DMAGO_READ;
   1558   1.1     chuck     else
   1559   1.1     chuck         dmaflags = 0;
   1560   1.1     chuck 
   1561   1.1     chuck     addr  = acb->sc_kv.dc_addr;
   1562   1.1     chuck     count = acb->sc_kv.dc_count;
   1563   1.1     chuck 
   1564  1.12       scw     if ( count && ((char *)kvtop((caddr_t)addr) != acb->sc_pa.dc_addr) ) {
   1565  1.19       chs         printf("sbic: DMA buffer mapping changed %p->%x\n",
   1566  1.12       scw                 acb->sc_pa.dc_addr, kvtop((caddr_t)addr));
   1567   1.1     chuck #ifdef DDB
   1568   1.1     chuck         Debugger();
   1569   1.1     chuck #endif
   1570   1.1     chuck     }
   1571   1.1     chuck 
   1572   1.1     chuck #ifdef DEBUG
   1573   1.1     chuck     ++sbicdma_ops;          /* count total DMA operations */
   1574   1.1     chuck #endif
   1575   1.1     chuck 
   1576   1.1     chuck     /*
   1577   1.1     chuck      * Allocate the DMA chain
   1578   1.1     chuck      * Mark end of segment...
   1579   1.1     chuck      */
   1580   1.1     chuck     acb->sc_tcnt        = dev->sc_tcnt = 0;
   1581   1.1     chuck     acb->sc_pa.dc_count = 0;
   1582   1.1     chuck 
   1583   1.1     chuck     sbic_load_ptrs(dev);
   1584   1.1     chuck 
   1585   1.1     chuck     /*
   1586   1.1     chuck      * Enable interrupts but don't do any DMA
   1587   1.1     chuck      * enintr() also enables interrupts for the sbic
   1588   1.1     chuck      */
   1589   1.1     chuck     dev->sc_enintr(dev);
   1590   1.1     chuck 
   1591   1.1     chuck     if ( usedma ) {
   1592   1.1     chuck         dev->sc_tcnt = dev->sc_dmago(dev, acb->sc_pa.dc_addr,
   1593   1.1     chuck                                           acb->sc_pa.dc_count, dmaflags);
   1594   1.1     chuck #ifdef DEBUG
   1595   1.1     chuck         dev->sc_dmatimo = dev->sc_tcnt ? 1 : 0;
   1596   1.1     chuck #endif
   1597   1.1     chuck     } else
   1598   1.1     chuck         dev->sc_dmacmd = 0; /* Don't use DMA */
   1599   1.1     chuck 
   1600   1.1     chuck     acb->sc_dmacmd = dev->sc_dmacmd;
   1601   1.1     chuck 
   1602   1.1     chuck #ifdef DEBUG
   1603   1.1     chuck     if ( data_pointer_debug > 1 ) {
   1604  1.12       scw         printf("sbicgo dmago:%d(%p:%lx) dmacmd=0x%02x\n", dev->target,
   1605   1.1     chuck                                            dev->sc_cur->dc_addr,
   1606   1.1     chuck                                            dev->sc_tcnt,
   1607   1.1     chuck                                            dev->sc_dmacmd);
   1608   1.1     chuck     }
   1609   1.1     chuck #endif
   1610   1.1     chuck 
   1611   1.1     chuck     /*
   1612   1.1     chuck      * Lets cycle a while then let the interrupt handler take over.
   1613   1.1     chuck      */
   1614   1.1     chuck     GET_SBIC_asr(regs, asr);
   1615   1.1     chuck 
   1616   1.1     chuck     do {
   1617   1.1     chuck 
   1618   1.1     chuck         QPRINTF(("go "));
   1619   1.1     chuck 
   1620   1.1     chuck         /*
   1621   1.1     chuck          * Handle the new phase
   1622   1.1     chuck          */
   1623   1.1     chuck         i = sbicnextstate(dev, csr, asr);
   1624   1.1     chuck #if 0
   1625   1.1     chuck         WAIT_CIP(regs);
   1626   1.1     chuck #endif
   1627   1.1     chuck         if ( i == SBIC_STATE_RUNNING ) {
   1628   1.1     chuck             GET_SBIC_asr(regs, asr);
   1629   1.1     chuck 
   1630   1.1     chuck             if ( asr & SBIC_ASR_LCI )
   1631   1.5  christos                 printf("sbicgo: LCI asr:%02x csr:%02x\n", asr, csr);
   1632   1.1     chuck 
   1633   1.1     chuck             if ( asr & SBIC_ASR_INT )
   1634   1.1     chuck                 GET_SBIC_csr(regs, csr);
   1635   1.1     chuck         }
   1636   1.1     chuck 
   1637   1.1     chuck     } while ( i == SBIC_STATE_RUNNING && asr & (SBIC_ASR_INT|SBIC_ASR_LCI) );
   1638   1.1     chuck 
   1639   1.1     chuck     if ( i == SBIC_STATE_DONE ) {
   1640   1.1     chuck         if ( dev->sc_stat[0] == 0xff )
   1641   1.1     chuck #if 0
   1642   1.5  christos             printf("sbicgo: done & stat = 0xff\n");
   1643   1.1     chuck #else
   1644   1.1     chuck             ;
   1645   1.1     chuck #endif
   1646   1.1     chuck         else
   1647   1.1     chuck             return 1;   /* Did we really finish that fast? */
   1648   1.1     chuck     }
   1649   1.1     chuck 
   1650   1.1     chuck     return 0;
   1651   1.1     chuck }
   1652   1.1     chuck 
   1653   1.1     chuck 
   1654   1.1     chuck int
   1655   1.1     chuck sbicintr(dev)
   1656   1.1     chuck     struct sbic_softc   *dev;
   1657   1.1     chuck {
   1658   1.1     chuck     sbic_regmap_p       regs = dev->sc_sbicp;
   1659   1.1     chuck     u_char              asr,
   1660   1.1     chuck                         csr;
   1661   1.1     chuck     int                 i;
   1662   1.1     chuck 
   1663   1.1     chuck     /*
   1664   1.1     chuck      * pending interrupt?
   1665   1.1     chuck      */
   1666   1.1     chuck     GET_SBIC_asr (regs, asr);
   1667   1.1     chuck     if ( (asr & SBIC_ASR_INT) == 0 )
   1668   1.1     chuck         return(0);
   1669   1.1     chuck 
   1670   1.2     chuck     GET_SBIC_csr(regs, csr);
   1671   1.2     chuck 
   1672   1.1     chuck     do {
   1673   1.1     chuck 
   1674   1.1     chuck         QPRINTF(("intr[0x%x]", csr));
   1675   1.1     chuck 
   1676   1.1     chuck         i = sbicnextstate(dev, csr, asr);
   1677   1.1     chuck #if 0
   1678   1.1     chuck         WAIT_CIP(regs);
   1679   1.1     chuck #endif
   1680   1.2     chuck         if ( i == SBIC_STATE_RUNNING ) {
   1681   1.2     chuck             GET_SBIC_asr(regs, asr);
   1682   1.2     chuck 
   1683   1.2     chuck             if ( asr & SBIC_ASR_LCI )
   1684   1.5  christos                 printf("sbicgo: LCI asr:%02x csr:%02x\n", asr, csr);
   1685   1.2     chuck 
   1686   1.2     chuck             if ( asr & SBIC_ASR_INT )
   1687   1.2     chuck                 GET_SBIC_csr(regs, csr);
   1688   1.2     chuck         }
   1689   1.1     chuck 
   1690   1.1     chuck     } while ( i == SBIC_STATE_RUNNING && asr & (SBIC_ASR_INT|SBIC_ASR_LCI) );
   1691   1.1     chuck 
   1692   1.1     chuck     QPRINTF(("intr done. state=%d, asr=0x%02x\n", i, asr));
   1693   1.1     chuck 
   1694   1.1     chuck     return(1);
   1695   1.1     chuck }
   1696   1.1     chuck 
   1697   1.1     chuck /*
   1698   1.1     chuck  * Run commands and wait for disconnect.
   1699   1.1     chuck  * This is only ever called when a command is in progress, when we
   1700   1.1     chuck  * want to busy wait for it to finish.
   1701   1.1     chuck  */
   1702   1.1     chuck int
   1703   1.1     chuck sbicpoll(dev)
   1704   1.1     chuck     struct sbic_softc   *dev;
   1705   1.1     chuck {
   1706   1.1     chuck     sbic_regmap_p       regs = dev->sc_sbicp;
   1707   1.1     chuck     u_char              asr,
   1708   1.1     chuck                         csr;
   1709   1.1     chuck     int                 i;
   1710   1.1     chuck 
   1711   1.1     chuck     /*
   1712   1.1     chuck      * Wait for the next interrupt
   1713   1.1     chuck      */
   1714   1.1     chuck     SBIC_WAIT(regs, SBIC_ASR_INT, sbic_cmd_wait);
   1715   1.1     chuck 
   1716   1.1     chuck     do {
   1717   1.1     chuck         GET_SBIC_asr (regs, asr);
   1718   1.1     chuck 
   1719   1.1     chuck         if ( asr & SBIC_ASR_INT )
   1720   1.1     chuck             GET_SBIC_csr(regs, csr);
   1721   1.1     chuck 
   1722   1.1     chuck         QPRINTF(("poll[0x%x]", csr));
   1723   1.1     chuck 
   1724   1.1     chuck         /*
   1725   1.1     chuck          * Handle it
   1726   1.1     chuck          */
   1727   1.1     chuck         i = sbicnextstate(dev, csr, asr);
   1728   1.1     chuck 
   1729   1.1     chuck         WAIT_CIP(regs);
   1730   1.1     chuck         GET_SBIC_asr(regs, asr);
   1731   1.1     chuck 
   1732   1.1     chuck         /*
   1733   1.1     chuck          * tapes may take a loooong time..
   1734   1.1     chuck          */
   1735   1.1     chuck         while ( asr & SBIC_ASR_BSY ) {
   1736   1.2     chuck             u_char z = 0;
   1737   1.1     chuck 
   1738   1.1     chuck             if ( asr & SBIC_ASR_DBR ) {
   1739   1.5  christos                 printf("sbipoll: Waiting while sbic is jammed, CSR:%02x,ASR:%02x\n", csr,asr);
   1740   1.1     chuck #ifdef DDB
   1741   1.1     chuck                 Debugger();
   1742   1.1     chuck #endif
   1743   1.1     chuck                 /*
   1744   1.1     chuck                  * SBIC is jammed
   1745   1.1     chuck                  * DUNNO which direction
   1746   1.1     chuck                  * Try old direction
   1747   1.1     chuck                  */
   1748   1.2     chuck                 GET_SBIC_data(regs, z);
   1749   1.1     chuck                 GET_SBIC_asr(regs, asr);
   1750   1.1     chuck 
   1751   1.1     chuck                 if ( asr & SBIC_ASR_DBR ) /* Wants us to write */
   1752   1.2     chuck                     SET_SBIC_data(regs, z);
   1753   1.1     chuck             }
   1754   1.1     chuck 
   1755   1.1     chuck             GET_SBIC_asr(regs, asr);
   1756   1.1     chuck         }
   1757   1.1     chuck 
   1758   1.1     chuck         if ( asr & SBIC_ASR_LCI )
   1759   1.5  christos             printf("sbicpoll: LCI asr:%02x csr:%02x\n", asr,csr);
   1760   1.1     chuck         else
   1761   1.2     chuck         if ( i == SBIC_STATE_RUNNING ) /* BSY */
   1762   1.1     chuck             SBIC_WAIT(regs, SBIC_ASR_INT, sbic_cmd_wait);
   1763   1.1     chuck 
   1764   1.1     chuck     } while ( i == SBIC_STATE_RUNNING );
   1765   1.1     chuck 
   1766   1.1     chuck     return(1);
   1767   1.1     chuck }
   1768   1.1     chuck 
   1769   1.1     chuck /*
   1770   1.1     chuck  * Handle a single msgin
   1771   1.1     chuck  */
   1772   1.1     chuck int
   1773   1.1     chuck sbicmsgin(dev)
   1774   1.1     chuck     struct sbic_softc   *dev;
   1775   1.1     chuck {
   1776   1.1     chuck     sbic_regmap_p       regs = dev->sc_sbicp;
   1777   1.1     chuck     int                 recvlen = 1;
   1778   1.1     chuck     u_char              asr,
   1779   1.1     chuck                         csr,
   1780   1.1     chuck                         *tmpaddr,
   1781   1.1     chuck                         *msgaddr;
   1782   1.1     chuck 
   1783   1.1     chuck     tmpaddr = msgaddr = dev->sc_msg;
   1784   1.1     chuck 
   1785   1.1     chuck     tmpaddr[0] = 0xff;
   1786   1.1     chuck     tmpaddr[1] = 0xff;
   1787   1.1     chuck 
   1788   1.1     chuck     GET_SBIC_asr(regs, asr);
   1789   1.1     chuck 
   1790   1.1     chuck #ifdef DEBUG
   1791   1.1     chuck     if ( reselect_debug > 1 )
   1792   1.5  christos         printf("sbicmsgin asr=%02x\n", asr);
   1793   1.1     chuck #endif
   1794   1.1     chuck 
   1795   1.1     chuck     GET_SBIC_selid (regs, csr);
   1796   1.1     chuck     SET_SBIC_selid (regs, csr | SBIC_SID_FROM_SCSI);
   1797   1.1     chuck 
   1798   1.1     chuck     SBIC_TC_PUT(regs, 0);
   1799   1.1     chuck     SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
   1800   1.1     chuck 
   1801   1.1     chuck     do {
   1802   1.1     chuck         while( recvlen-- ) {
   1803   1.1     chuck 
   1804   1.1     chuck             /*
   1805   1.1     chuck              * Fetch the next byte of the message
   1806   1.1     chuck              */
   1807   1.1     chuck             RECV_BYTE(regs, *tmpaddr);
   1808   1.1     chuck 
   1809   1.1     chuck             /*
   1810   1.1     chuck              * get the command completion interrupt, or we
   1811   1.1     chuck              * can't send a new command (LCI)
   1812   1.1     chuck              */
   1813   1.1     chuck             SBIC_WAIT(regs, SBIC_ASR_INT, 0);
   1814   1.1     chuck             GET_SBIC_csr(regs, csr);
   1815   1.1     chuck 
   1816   1.1     chuck #ifdef DEBUG
   1817   1.1     chuck             if ( reselect_debug > 1 )
   1818   1.5  christos                 printf("sbicmsgin: got %02x csr %02x\n", *tmpaddr, csr);
   1819   1.1     chuck #endif
   1820   1.1     chuck 
   1821   1.1     chuck             tmpaddr++;
   1822   1.1     chuck 
   1823   1.1     chuck             if ( recvlen ) {
   1824   1.1     chuck                 /*
   1825   1.1     chuck                  * Clear ACK, and wait for the interrupt for the next byte
   1826   1.1     chuck                  */
   1827   1.1     chuck                 SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
   1828   1.1     chuck                 SBIC_WAIT(regs, SBIC_ASR_INT, 0);
   1829   1.1     chuck                 GET_SBIC_csr(regs, csr);
   1830   1.1     chuck             }
   1831   1.1     chuck         }
   1832   1.1     chuck 
   1833   1.1     chuck         if ( msgaddr[0] == 0xff ) {
   1834   1.5  christos             printf("sbicmsgin: sbic swallowed our message\n");
   1835   1.1     chuck             break;
   1836   1.1     chuck         }
   1837   1.1     chuck 
   1838   1.1     chuck #ifdef DEBUG
   1839   1.1     chuck         if ( sync_debug ) {
   1840   1.1     chuck             GET_SBIC_asr(regs, asr);
   1841   1.5  christos             printf("msgin done csr 0x%x asr 0x%x msg 0x%x\n", csr, asr, msgaddr[0]);
   1842   1.1     chuck         }
   1843   1.1     chuck #endif
   1844   1.1     chuck         /*
   1845   1.1     chuck          * test whether this is a reply to our sync
   1846   1.1     chuck          * request
   1847   1.1     chuck          */
   1848   1.1     chuck         if ( MSG_ISIDENTIFY(msgaddr[0]) ) {
   1849   1.1     chuck 
   1850   1.1     chuck             /*
   1851   1.1     chuck              * Got IFFY msg -- ack it
   1852   1.1     chuck              */
   1853   1.1     chuck             QPRINTF(("IFFY"));
   1854   1.1     chuck 
   1855   1.1     chuck         } else
   1856   1.1     chuck         if ( msgaddr[0] == MSG_REJECT &&
   1857   1.1     chuck              dev->sc_sync[dev->target].state == SYNC_SENT) {
   1858   1.1     chuck 
   1859   1.1     chuck             /*
   1860   1.1     chuck              * Target probably rejected our Sync negotiation.
   1861   1.1     chuck              */
   1862   1.1     chuck             QPRINTF(("REJECT of SYN"));
   1863   1.1     chuck 
   1864   1.1     chuck #ifdef DEBUG
   1865   1.1     chuck             if ( sync_debug )
   1866   1.5  christos                 printf("target %d rejected sync, going async\n", dev->target);
   1867   1.1     chuck #endif
   1868   1.1     chuck 
   1869   1.1     chuck             dev->sc_sync[dev->target].period = sbic_min_period;
   1870   1.1     chuck             dev->sc_sync[dev->target].offset = 0;
   1871   1.1     chuck             dev->sc_sync[dev->target].state  = SYNC_DONE;
   1872   1.1     chuck             SET_SBIC_syn(regs, SBIC_SYN(dev->sc_sync[dev->target].offset,
   1873   1.1     chuck                                         dev->sc_sync[dev->target].period));
   1874   1.1     chuck 
   1875   1.1     chuck         } else
   1876   1.1     chuck         if ( msgaddr[0] == MSG_REJECT ) {
   1877   1.1     chuck 
   1878   1.1     chuck             /*
   1879   1.1     chuck              * we'll never REJECt a REJECT message..
   1880   1.1     chuck              */
   1881   1.1     chuck             QPRINTF(("REJECT"));
   1882   1.1     chuck 
   1883   1.1     chuck         } else
   1884   1.1     chuck         if ( msgaddr[0] == MSG_SAVE_DATA_PTR ) {
   1885   1.1     chuck 
   1886   1.1     chuck             /*
   1887   1.1     chuck              * don't reject this either.
   1888   1.1     chuck              */
   1889   1.1     chuck             QPRINTF(("MSG_SAVE_DATA_PTR"));
   1890   1.1     chuck 
   1891   1.1     chuck         } else
   1892   1.1     chuck         if ( msgaddr[0] == MSG_RESTORE_PTR ) {
   1893   1.1     chuck 
   1894   1.1     chuck             /*
   1895   1.1     chuck              * don't reject this either.
   1896   1.1     chuck              */
   1897   1.1     chuck             QPRINTF(("MSG_RESTORE_PTR"));
   1898   1.1     chuck 
   1899   1.1     chuck         } else
   1900   1.1     chuck         if ( msgaddr[0] == MSG_DISCONNECT ) {
   1901   1.1     chuck 
   1902   1.1     chuck             /*
   1903   1.1     chuck              * Target is disconnecting...
   1904   1.1     chuck              */
   1905   1.1     chuck             QPRINTF(("DISCONNECT"));
   1906   1.1     chuck 
   1907   1.1     chuck #ifdef DEBUG
   1908   1.1     chuck             if ( reselect_debug > 1 && msgaddr[0] == MSG_DISCONNECT )
   1909   1.5  christos                 printf("sbicmsgin: got disconnect msg %s\n",
   1910   1.1     chuck                        (dev->sc_flags & SBICF_ICMD) ? "rejecting" : "");
   1911   1.1     chuck #endif
   1912   1.1     chuck 
   1913   1.1     chuck             if ( dev->sc_flags & SBICF_ICMD ) {
   1914   1.1     chuck                 /*
   1915   1.1     chuck                  * We're in immediate mode. Prevent disconnects.
   1916   1.1     chuck                  * prepare to reject the message, NACK
   1917   1.1     chuck                  */
   1918   1.1     chuck                 SET_SBIC_cmd(regs, SBIC_CMD_SET_ATN);
   1919   1.1     chuck                 WAIT_CIP(regs);
   1920   1.1     chuck             }
   1921   1.1     chuck 
   1922   1.1     chuck         } else
   1923   1.1     chuck         if ( msgaddr[0] == MSG_CMD_COMPLETE ) {
   1924   1.1     chuck 
   1925   1.1     chuck             /*
   1926   1.1     chuck              * !! KLUDGE ALERT !! quite a few drives don't seem to
   1927   1.1     chuck              * really like the current way of sending the
   1928   1.1     chuck              * sync-handshake together with the ident-message, and
   1929   1.1     chuck              * they react by sending command-complete and
   1930   1.1     chuck              * disconnecting right after returning the valid sync
   1931   1.1     chuck              * handshake. So, all I can do is reselect the drive,
   1932   1.1     chuck              * and hope it won't disconnect again. I don't think
   1933   1.1     chuck              * this is valid behavior, but I can't help fixing a
   1934   1.1     chuck              * problem that apparently exists.
   1935   1.1     chuck              *
   1936   1.1     chuck              * Note: we should not get here on `normal' command
   1937   1.1     chuck              * completion, as that condition is handled by the
   1938   1.1     chuck              * high-level sel&xfer resume command used to walk
   1939   1.1     chuck              * thru status/cc-phase.
   1940   1.1     chuck              */
   1941   1.1     chuck             QPRINTF(("CMD_COMPLETE"));
   1942   1.1     chuck 
   1943   1.1     chuck #ifdef DEBUG
   1944   1.1     chuck             if ( sync_debug )
   1945   1.5  christos                 printf ("GOT MSG %d! target %d acting weird.."
   1946   1.1     chuck                         " waiting for disconnect...\n", msgaddr[0], dev->target);
   1947   1.1     chuck #endif
   1948   1.1     chuck 
   1949   1.1     chuck             /*
   1950   1.1     chuck              * Check to see if sbic is handling this
   1951   1.1     chuck              */
   1952   1.1     chuck             GET_SBIC_asr(regs, asr);
   1953   1.1     chuck 
   1954   1.1     chuck             /*
   1955   1.1     chuck              * XXXSCW: I'm not convinced of this, we haven't negated ACK yet...
   1956   1.1     chuck              */
   1957   1.1     chuck             if ( asr & SBIC_ASR_BSY )
   1958   1.1     chuck                 return SBIC_STATE_RUNNING;
   1959   1.1     chuck 
   1960   1.1     chuck             /*
   1961   1.1     chuck              * Let's try this: Assume it works and set status to 00
   1962   1.1     chuck              */
   1963   1.1     chuck             dev->sc_stat[0] = 0;
   1964   1.1     chuck 
   1965   1.1     chuck         } else
   1966   1.1     chuck         if ( msgaddr[0] == MSG_EXT_MESSAGE && tmpaddr == &(msgaddr[1]) ) {
   1967   1.1     chuck 
   1968   1.1     chuck             /*
   1969   1.1     chuck              * Target is sending us an extended message. We'll assume it's
   1970   1.1     chuck              * the response to our Sync. negotiation.
   1971   1.1     chuck              */
   1972   1.1     chuck             QPRINTF(("ExtMSG\n"));
   1973   1.1     chuck 
   1974   1.1     chuck             /*
   1975   1.1     chuck              * Read in whole extended message. First, negate ACK to accept
   1976   1.1     chuck              * the MSG_EXT_MESSAGE byte...
   1977   1.1     chuck              */
   1978   1.1     chuck             SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
   1979   1.1     chuck 
   1980   1.1     chuck             /*
   1981   1.1     chuck              * Wait for the interrupt for the next byte (length)
   1982   1.1     chuck              */
   1983   1.1     chuck             SBIC_WAIT(regs, SBIC_ASR_INT, 0);
   1984   1.1     chuck             GET_SBIC_csr(regs, csr);
   1985   1.1     chuck 
   1986   1.1     chuck #ifdef  DEBUG
   1987   1.1     chuck             QPRINTF(("CLR ACK csr %02x\n", csr));
   1988   1.1     chuck #endif
   1989   1.1     chuck 
   1990   1.1     chuck             /*
   1991   1.1     chuck              * Read the length byte
   1992   1.1     chuck              */
   1993   1.1     chuck             RECV_BYTE(regs, *tmpaddr);
   1994   1.1     chuck 
   1995   1.1     chuck             /*
   1996   1.1     chuck              * Wait for command completion IRQ
   1997   1.1     chuck              */
   1998   1.1     chuck             SBIC_WAIT(regs, SBIC_ASR_INT, 0);
   1999   1.1     chuck             GET_SBIC_csr(regs, csr);
   2000   1.1     chuck 
   2001   1.1     chuck             /*
   2002   1.1     chuck              * Reload the loop counter
   2003   1.1     chuck              */
   2004   1.1     chuck             recvlen = *tmpaddr++;
   2005   1.1     chuck 
   2006   1.1     chuck             QPRINTF(("Recving ext msg, csr %02x len %02x\n", csr, recvlen));
   2007   1.1     chuck 
   2008   1.1     chuck         } else
   2009   1.1     chuck         if ( msgaddr[0] == MSG_EXT_MESSAGE && msgaddr[1] == 3 &&
   2010   1.1     chuck              msgaddr[2] == MSG_SYNC_REQ ) {
   2011   1.1     chuck 
   2012   1.1     chuck             /*
   2013   1.1     chuck              * We've received the complete Extended Message Sync. Request...
   2014   1.1     chuck              */
   2015   1.1     chuck             QPRINTF(("SYN"));
   2016   1.1     chuck 
   2017   1.1     chuck             /*
   2018   1.1     chuck              * Compute the required Transfer Period for the WD chip...
   2019   1.1     chuck              */
   2020   1.1     chuck             dev->sc_sync[dev->target].period = sbicfromscsiperiod(dev, msgaddr[3]);
   2021   1.1     chuck             dev->sc_sync[dev->target].offset = msgaddr[4];
   2022   1.1     chuck             dev->sc_sync[dev->target].state  = SYNC_DONE;
   2023   1.1     chuck 
   2024   1.1     chuck             /*
   2025   1.1     chuck              * Put the WD chip in synchronous mode
   2026   1.1     chuck              */
   2027   1.1     chuck             SET_SBIC_syn(regs, SBIC_SYN(dev->sc_sync[dev->target].offset,
   2028   1.1     chuck                                         dev->sc_sync[dev->target].period));
   2029   1.2     chuck #ifdef  DEBUG
   2030   1.2     chuck             if ( sync_debug )
   2031   1.5  christos                 printf("msgin(%d): sync reg = 0x%02x\n", dev->target,
   2032   1.2     chuck                                 SBIC_SYN(dev->sc_sync[dev->target].offset,
   2033   1.2     chuck                                          dev->sc_sync[dev->target].period));
   2034   1.2     chuck #endif
   2035   1.1     chuck 
   2036   1.5  christos             printf("%s: target %d now synchronous, period=%dns, offset=%d.\n",
   2037   1.1     chuck                    dev->sc_dev.dv_xname, dev->target,
   2038   1.1     chuck                    msgaddr[3] * 4, msgaddr[4]);
   2039   1.1     chuck 
   2040   1.1     chuck         } else {
   2041   1.1     chuck 
   2042   1.1     chuck             /*
   2043   1.1     chuck              * We don't support whatever this message is...
   2044   1.1     chuck              */
   2045   1.1     chuck #ifdef DEBUG
   2046   1.1     chuck             if ( sbic_debug || sync_debug )
   2047   1.5  christos                 printf ("sbicmsgin: Rejecting message 0x%02x\n", msgaddr[0]);
   2048   1.1     chuck #endif
   2049   1.1     chuck 
   2050   1.1     chuck             /*
   2051   1.1     chuck              * prepare to reject the message, NACK
   2052   1.1     chuck              */
   2053   1.1     chuck             SET_SBIC_cmd(regs, SBIC_CMD_SET_ATN);
   2054   1.1     chuck             WAIT_CIP(regs);
   2055   1.1     chuck         }
   2056   1.1     chuck 
   2057   1.1     chuck         /*
   2058   1.1     chuck          * Negate ACK to complete the transfer
   2059   1.1     chuck          */
   2060   1.1     chuck         SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
   2061   1.1     chuck 
   2062   1.1     chuck         /*
   2063   1.1     chuck          * Wait for the interrupt for the next byte, or phase change.
   2064   1.1     chuck          * Only read the CSR if we have more data to transfer.
   2065   1.1     chuck          * XXXSCW: We should really verify that we're still in MSG IN phase
   2066   1.1     chuck          * before blindly going back around this loop, but that would mean
   2067   1.1     chuck          * we read the CSR... <sigh>
   2068   1.1     chuck          */
   2069   1.1     chuck         SBIC_WAIT(regs, SBIC_ASR_INT, 0);
   2070   1.1     chuck         if ( recvlen > 0 )
   2071   1.1     chuck             GET_SBIC_csr(regs, csr);
   2072   1.1     chuck 
   2073   1.1     chuck     } while ( recvlen > 0 );
   2074   1.1     chuck 
   2075   1.1     chuck     /*
   2076   1.1     chuck      * Should still have one CSR to read
   2077   1.1     chuck      */
   2078   1.1     chuck     return SBIC_STATE_RUNNING;
   2079   1.1     chuck }
   2080   1.1     chuck 
   2081   1.1     chuck 
   2082   1.1     chuck /*
   2083   1.1     chuck  * sbicnextstate()
   2084   1.1     chuck  * return:
   2085   1.2     chuck  *      SBIC_STATE_DONE        == done
   2086   1.2     chuck  *      SBIC_STATE_RUNNING     == working
   2087   1.2     chuck  *      SBIC_STATE_DISCONNECT  == disconnected
   2088   1.2     chuck  *      SBIC_STATE_ERROR       == error
   2089   1.1     chuck  */
   2090   1.1     chuck int
   2091   1.1     chuck sbicnextstate(dev, csr, asr)
   2092   1.1     chuck     struct sbic_softc   *dev;
   2093   1.1     chuck     u_char              csr,
   2094   1.1     chuck                         asr;
   2095   1.1     chuck {
   2096   1.1     chuck     sbic_regmap_p       regs = dev->sc_sbicp;
   2097   1.1     chuck     struct sbic_acb     *acb = dev->sc_nexus;
   2098   1.1     chuck 
   2099   1.1     chuck     QPRINTF(("next[%02x,%02x]: ",asr,csr));
   2100   1.1     chuck 
   2101   1.1     chuck     switch (csr) {
   2102   1.1     chuck 
   2103   1.1     chuck       case SBIC_CSR_XFERRED | CMD_PHASE:
   2104   1.1     chuck       case SBIC_CSR_MIS     | CMD_PHASE:
   2105   1.1     chuck       case SBIC_CSR_MIS_1   | CMD_PHASE:
   2106   1.1     chuck       case SBIC_CSR_MIS_2   | CMD_PHASE:
   2107   1.1     chuck         {
   2108   1.1     chuck             if ( sbicxfout(regs, acb->clen, &acb->cmd) )
   2109   1.1     chuck                 goto abort;
   2110   1.1     chuck         }
   2111   1.1     chuck         break;
   2112   1.1     chuck 
   2113   1.1     chuck       case SBIC_CSR_XFERRED | STATUS_PHASE:
   2114   1.1     chuck       case SBIC_CSR_MIS     | STATUS_PHASE:
   2115   1.1     chuck       case SBIC_CSR_MIS_1   | STATUS_PHASE:
   2116   1.1     chuck       case SBIC_CSR_MIS_2   | STATUS_PHASE:
   2117   1.1     chuck         {
   2118   1.1     chuck             SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
   2119   1.1     chuck 
   2120   1.1     chuck             /*
   2121   1.1     chuck              * this should be the normal i/o completion case.
   2122   1.1     chuck              * get the status & cmd complete msg then let the
   2123   1.1     chuck              * device driver look at what happened.
   2124   1.1     chuck              */
   2125   1.1     chuck             sbicxfdone(dev);
   2126   1.1     chuck 
   2127   1.1     chuck #ifdef DEBUG
   2128   1.1     chuck             dev->sc_dmatimo = 0;
   2129   1.1     chuck             if ( data_pointer_debug > 1 )
   2130  1.12       scw                 printf("next dmastop: %d(%p:%lx)\n", dev->target,
   2131   1.1     chuck                                                     dev->sc_cur->dc_addr,
   2132   1.1     chuck                                                     dev->sc_tcnt);
   2133   1.1     chuck #endif
   2134   1.1     chuck             /*
   2135   1.1     chuck              * Stop the DMA chip
   2136   1.1     chuck              */
   2137   1.1     chuck             dev->sc_dmastop(dev);
   2138   1.1     chuck 
   2139   1.1     chuck             dev->sc_flags &= ~(SBICF_INDMA | SBICF_DCFLUSH);
   2140   1.1     chuck 
   2141   1.1     chuck             /*
   2142   1.1     chuck              * Indicate to the upper layers that the command is done
   2143   1.1     chuck              */
   2144   1.1     chuck             sbic_scsidone(acb, dev->sc_stat[0]);
   2145   1.1     chuck 
   2146   1.1     chuck             return SBIC_STATE_DONE;
   2147   1.1     chuck         }
   2148   1.1     chuck 
   2149   1.1     chuck       case SBIC_CSR_XFERRED | DATA_OUT_PHASE:
   2150   1.1     chuck       case SBIC_CSR_XFERRED | DATA_IN_PHASE:
   2151   1.1     chuck       case SBIC_CSR_MIS     | DATA_OUT_PHASE:
   2152   1.1     chuck       case SBIC_CSR_MIS     | DATA_IN_PHASE:
   2153   1.1     chuck       case SBIC_CSR_MIS_1   | DATA_OUT_PHASE:
   2154   1.1     chuck       case SBIC_CSR_MIS_1   | DATA_IN_PHASE:
   2155   1.1     chuck       case SBIC_CSR_MIS_2   | DATA_OUT_PHASE:
   2156   1.1     chuck       case SBIC_CSR_MIS_2   | DATA_IN_PHASE:
   2157   1.1     chuck         {
   2158   1.1     chuck             /*
   2159   1.1     chuck              * Verify that we expected to transfer data...
   2160   1.1     chuck              */
   2161   1.1     chuck             if ( acb->sc_kv.dc_count <= 0 ) {
   2162   1.5  christos                 printf("next: DATA phase with xfer count == %d, asr:0x%02x csr:0x%02x\n",
   2163   1.1     chuck                         acb->sc_kv.dc_count, asr, csr);
   2164   1.1     chuck                 goto abort;
   2165   1.1     chuck             }
   2166   1.1     chuck 
   2167   1.1     chuck             /*
   2168   1.1     chuck              * Should we transfer using PIO or DMA ?
   2169   1.1     chuck              */
   2170  1.10   thorpej             if ( dev->sc_xs->xs_control & XS_CTL_POLL || dev->sc_flags & SBICF_ICMD ||
   2171   1.1     chuck                  acb->sc_dmacmd == 0 ) {
   2172   1.1     chuck 
   2173   1.1     chuck                 /*
   2174   1.1     chuck                  * Do PIO transfer
   2175   1.1     chuck                  */
   2176   1.1     chuck                 int     i;
   2177   1.1     chuck 
   2178   1.1     chuck #ifdef DEBUG
   2179   1.1     chuck                 if ( data_pointer_debug > 1 )
   2180  1.12       scw                     printf("next PIO: %d(%p:%x)\n", dev->target,
   2181   1.1     chuck                                                     acb->sc_kv.dc_addr,
   2182   1.1     chuck                                                     acb->sc_kv.dc_count);
   2183   1.1     chuck #endif
   2184   1.1     chuck 
   2185   1.1     chuck                 if ( SBIC_PHASE(csr) == DATA_IN_PHASE )
   2186   1.1     chuck                     /*
   2187   1.1     chuck                      * data in
   2188   1.1     chuck                      */
   2189   1.1     chuck                     i = sbicxfin(regs, acb->sc_kv.dc_count,
   2190   1.1     chuck                                        acb->sc_kv.dc_addr);
   2191   1.1     chuck                 else
   2192   1.1     chuck                     /*
   2193   1.1     chuck                      * data out
   2194   1.1     chuck                      */
   2195   1.1     chuck                     i = sbicxfout(regs, acb->sc_kv.dc_count,
   2196   1.1     chuck                                         acb->sc_kv.dc_addr);
   2197   1.1     chuck 
   2198   1.1     chuck                 acb->sc_kv.dc_addr += (acb->sc_kv.dc_count - i);
   2199   1.1     chuck                 acb->sc_kv.dc_count = i;
   2200   1.1     chuck 
   2201   1.1     chuck                 /*
   2202   1.1     chuck                  * Update current count...
   2203   1.1     chuck                  */
   2204   1.1     chuck                 acb->sc_tcnt = dev->sc_tcnt = i;
   2205   1.1     chuck 
   2206   1.1     chuck                 dev->sc_flags &= ~SBICF_INDMA;
   2207   1.1     chuck 
   2208   1.1     chuck             } else {
   2209   1.1     chuck 
   2210   1.1     chuck                 /*
   2211   1.1     chuck                  * Do DMA transfer
   2212  1.21       wiz                  * set next DMA addr and dec count
   2213   1.1     chuck                  */
   2214   1.1     chuck                 sbic_save_ptrs(dev);
   2215   1.1     chuck                 sbic_load_ptrs(dev);
   2216   1.1     chuck 
   2217   1.1     chuck                 SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI |
   2218   1.1     chuck                                        SBIC_MACHINE_DMA_MODE);
   2219   1.1     chuck 
   2220   1.1     chuck #ifdef DEBUG
   2221   1.1     chuck                 dev->sc_dmatimo = 1;
   2222   1.1     chuck                 if ( data_pointer_debug > 1 )
   2223  1.12       scw                     printf("next DMA: %d(%p:%lx)\n", dev->target,
   2224   1.1     chuck                                                     dev->sc_cur->dc_addr,
   2225   1.1     chuck                                                     dev->sc_tcnt);
   2226   1.1     chuck #endif
   2227   1.1     chuck                 /*
   2228   1.1     chuck                  * Start the DMA chip going
   2229   1.1     chuck                  */
   2230   1.1     chuck                 dev->sc_tcnt = dev->sc_dmanext(dev);
   2231   1.1     chuck 
   2232   1.1     chuck                 /*
   2233   1.1     chuck                  * Tell the WD chip how much to transfer this time around
   2234   1.1     chuck                  */
   2235   1.1     chuck                 SBIC_TC_PUT(regs, (unsigned)dev->sc_tcnt);
   2236   1.1     chuck 
   2237   1.1     chuck                 /*
   2238   1.1     chuck                  * Start the transfer
   2239   1.1     chuck                  */
   2240   1.1     chuck                 SET_SBIC_cmd(regs, SBIC_CMD_XFER_INFO);
   2241   1.1     chuck 
   2242   1.1     chuck                 /*
   2243   1.1     chuck                  * Indicate that we're in DMA mode
   2244   1.1     chuck                  */
   2245   1.1     chuck                 dev->sc_flags |= SBICF_INDMA;
   2246   1.1     chuck             }
   2247   1.1     chuck         }
   2248   1.1     chuck         break;
   2249   1.1     chuck 
   2250   1.1     chuck       case SBIC_CSR_XFERRED | MESG_IN_PHASE:
   2251   1.1     chuck       case SBIC_CSR_MIS     | MESG_IN_PHASE:
   2252   1.1     chuck       case SBIC_CSR_MIS_1   | MESG_IN_PHASE:
   2253   1.1     chuck       case SBIC_CSR_MIS_2   | MESG_IN_PHASE:
   2254   1.1     chuck         {
   2255   1.1     chuck             sbic_save_ptrs(dev);
   2256   1.1     chuck 
   2257   1.1     chuck             /*
   2258   1.1     chuck              * Handle a single message in...
   2259   1.1     chuck              */
   2260   1.1     chuck             return sbicmsgin(dev);
   2261   1.1     chuck         }
   2262   1.1     chuck 
   2263   1.1     chuck       case SBIC_CSR_MSGIN_W_ACK:
   2264   1.1     chuck         {
   2265   1.1     chuck             /*
   2266   1.1     chuck              * We should never see this since it's handled in 'sbicmsgin()'
   2267   1.1     chuck              * but just for the sake of paranoia...
   2268   1.1     chuck              */
   2269   1.1     chuck             SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK); /* Dunno what I'm ACKing */
   2270   1.5  christos             printf("Acking unknown msgin CSR:%02x",csr);
   2271   1.1     chuck         }
   2272   1.1     chuck         break;
   2273   1.1     chuck 
   2274   1.1     chuck       case SBIC_CSR_XFERRED | MESG_OUT_PHASE:
   2275   1.1     chuck       case SBIC_CSR_MIS     | MESG_OUT_PHASE:
   2276   1.1     chuck       case SBIC_CSR_MIS_1   | MESG_OUT_PHASE:
   2277   1.1     chuck       case SBIC_CSR_MIS_2   | MESG_OUT_PHASE:
   2278   1.1     chuck         {
   2279   1.1     chuck             /*
   2280   1.1     chuck              * We only ever handle a message out phase here for sending a
   2281   1.1     chuck              * REJECT message.
   2282   1.1     chuck              */
   2283   1.1     chuck             sbic_save_ptrs(dev);
   2284   1.1     chuck 
   2285   1.1     chuck #ifdef DEBUG
   2286   1.1     chuck             if (sync_debug)
   2287   1.5  christos                 printf ("sending REJECT msg to last msg.\n");
   2288   1.1     chuck #endif
   2289   1.1     chuck 
   2290   1.1     chuck             SEND_BYTE(regs, MSG_REJECT);
   2291   1.1     chuck             WAIT_CIP(regs);
   2292   1.1     chuck         }
   2293   1.1     chuck         break;
   2294   1.1     chuck 
   2295   1.1     chuck       case SBIC_CSR_DISC:
   2296   1.1     chuck       case SBIC_CSR_DISC_1:
   2297   1.1     chuck         {
   2298   1.1     chuck             /*
   2299   1.1     chuck              * Try to schedule another target
   2300   1.1     chuck              */
   2301   1.1     chuck             sbic_save_ptrs(dev);
   2302   1.1     chuck 
   2303   1.1     chuck             dev->sc_flags &= ~SBICF_SELECTED;
   2304   1.1     chuck 
   2305   1.1     chuck #ifdef DEBUG
   2306   1.1     chuck             if ( reselect_debug > 1 )
   2307   1.5  christos                 printf("sbicnext target %d disconnected\n", dev->target);
   2308   1.1     chuck #endif
   2309   1.1     chuck 
   2310   1.1     chuck             TAILQ_INSERT_HEAD(&dev->nexus_list, acb, chain);
   2311   1.1     chuck 
   2312   1.1     chuck             ++dev->sc_tinfo[dev->target].dconns;
   2313   1.1     chuck 
   2314   1.1     chuck             dev->sc_nexus = NULL;
   2315   1.1     chuck             dev->sc_xs    = NULL;
   2316   1.1     chuck 
   2317  1.10   thorpej             if ( acb->xs->xs_control & XS_CTL_POLL || dev->sc_flags & SBICF_ICMD ||
   2318   1.1     chuck                                                !sbic_parallel_operations )
   2319   1.1     chuck                 return SBIC_STATE_DISCONNECT;
   2320   1.1     chuck 
   2321   1.1     chuck             QPRINTF(("sbicnext: calling sbic_sched\n"));
   2322   1.1     chuck 
   2323   1.1     chuck             sbic_sched(dev);
   2324   1.1     chuck 
   2325   1.1     chuck             QPRINTF(("sbicnext: sbic_sched returned\n"));
   2326   1.1     chuck 
   2327   1.1     chuck             return SBIC_STATE_DISCONNECT;
   2328   1.1     chuck         }
   2329   1.1     chuck 
   2330   1.1     chuck       case SBIC_CSR_RSLT_NI:
   2331   1.1     chuck       case SBIC_CSR_RSLT_IFY:
   2332   1.1     chuck         {
   2333   1.1     chuck             /*
   2334   1.1     chuck              * A reselection.
   2335   1.1     chuck              * Note that since we don't enable Advanced Features (assuming
   2336   1.1     chuck              * the WD chip is at least the 'A' revision), we're only ever
   2337   1.1     chuck              * likely to see the 'SBIC_CSR_RSLT_NI' status. But for the
   2338   1.1     chuck              * hell of it, we'll handle it anyway, for all the extra code
   2339   1.1     chuck              * it needs...
   2340   1.1     chuck              */
   2341   1.1     chuck             u_char  newtarget,
   2342   1.1     chuck                     newlun;
   2343   1.1     chuck 
   2344   1.1     chuck             GET_SBIC_rselid(regs, newtarget);
   2345   1.1     chuck 
   2346   1.1     chuck             /*
   2347   1.1     chuck              * check SBIC_RID_SIV?
   2348   1.1     chuck              */
   2349   1.1     chuck             newtarget &= SBIC_RID_MASK;
   2350   1.1     chuck 
   2351   1.1     chuck             if ( csr == SBIC_CSR_RSLT_IFY ) {
   2352   1.1     chuck 
   2353   1.1     chuck                 /*
   2354   1.1     chuck                  * Read Identify msg to avoid lockup
   2355   1.1     chuck                  */
   2356   1.1     chuck                 GET_SBIC_data(regs, newlun);
   2357   1.1     chuck                 WAIT_CIP(regs);
   2358   1.1     chuck                 newlun &= SBIC_TLUN_MASK;
   2359   1.1     chuck 
   2360   1.1     chuck             } else {
   2361   1.1     chuck 
   2362   1.1     chuck                 /*
   2363   1.1     chuck                  * Need to read Identify message the hard way, assuming
   2364   1.1     chuck                  * the target even sends us one...
   2365   1.1     chuck                  */
   2366   1.1     chuck                 for (newlun = 255; newlun; --newlun) {
   2367   1.1     chuck                     GET_SBIC_asr(regs, asr);
   2368   1.1     chuck                     if (asr & SBIC_ASR_INT)
   2369   1.1     chuck                         break;
   2370   1.2     chuck                     delay(10);
   2371   1.1     chuck                 }
   2372   1.1     chuck 
   2373   1.1     chuck                 /*
   2374   1.1     chuck                  * If we didn't get an interrupt, somethink's up
   2375   1.1     chuck                  */
   2376   1.1     chuck                 if ( (asr & SBIC_ASR_INT) == 0 ) {
   2377   1.5  christos                     printf("%s: Reselect without identify? asr %x\n",
   2378   1.2     chuck                             dev->sc_dev.dv_xname, asr);
   2379   1.1     chuck                     newlun = 0; /* XXXX */
   2380   1.1     chuck                 } else {
   2381   1.1     chuck                     /*
   2382   1.1     chuck                      * We got an interrupt, verify that it's a change to
   2383   1.1     chuck                      * message in phase, and if so read the message.
   2384   1.1     chuck                      */
   2385   1.1     chuck                     GET_SBIC_csr(regs,csr);
   2386   1.1     chuck 
   2387  1.12       scw                     if ( csr == (SBIC_CSR_MIS   | MESG_IN_PHASE) ||
   2388  1.12       scw                          csr == (SBIC_CSR_MIS_1 | MESG_IN_PHASE) ||
   2389  1.12       scw                          csr == (SBIC_CSR_MIS_2 | MESG_IN_PHASE) ) {
   2390   1.1     chuck                         /*
   2391   1.1     chuck                          * Yup, gone to message in. Fetch the target LUN
   2392   1.1     chuck                          */
   2393   1.1     chuck                         sbicmsgin(dev);
   2394   1.1     chuck                         newlun = dev->sc_msg[0] & 0x07;
   2395   1.1     chuck 
   2396   1.1     chuck                     } else {
   2397   1.1     chuck                         /*
   2398   1.1     chuck                          * Whoops! Target didn't go to message in phase!!
   2399   1.1     chuck                          */
   2400   1.5  christos                         printf("RSLT_NI - not MESG_IN_PHASE %x\n", csr);
   2401   1.1     chuck                         newlun = 0; /* XXXSCW */
   2402   1.1     chuck                     }
   2403   1.1     chuck                 }
   2404   1.1     chuck             }
   2405   1.1     chuck 
   2406   1.1     chuck             /*
   2407   1.1     chuck              * Ok, we have the identity of the reselecting target.
   2408   1.1     chuck              */
   2409   1.1     chuck #ifdef DEBUG
   2410   1.1     chuck             if ( reselect_debug > 1 ||
   2411   1.1     chuck                 (reselect_debug && csr == SBIC_CSR_RSLT_NI) ) {
   2412   1.5  christos                 printf("sbicnext: reselect %s from targ %d lun %d\n",
   2413   1.1     chuck                         csr == SBIC_CSR_RSLT_NI ? "NI" : "IFY", newtarget, newlun);
   2414   1.1     chuck             }
   2415   1.1     chuck #endif
   2416   1.1     chuck 
   2417   1.1     chuck             if ( dev->sc_nexus ) {
   2418   1.1     chuck                 /*
   2419   1.1     chuck                  * Whoops! We've been reselected with an command in progress!
   2420   1.1     chuck                  * The best we can do is to put the current command back on the
   2421   1.1     chuck                  * ready list and hope for the best.
   2422   1.1     chuck                  */
   2423   1.1     chuck #ifdef DEBUG
   2424   1.1     chuck                 if ( reselect_debug > 1 ) {
   2425   1.5  christos                     printf("%s: reselect %s with active command\n",
   2426   1.1     chuck                         dev->sc_dev.dv_xname,
   2427   1.1     chuck                         csr == SBIC_CSR_RSLT_NI ? "NI" : "IFY");
   2428   1.1     chuck                 }
   2429   1.1     chuck #endif
   2430   1.1     chuck 
   2431   1.1     chuck                 TAILQ_INSERT_HEAD(&dev->ready_list, dev->sc_nexus, chain);
   2432   1.1     chuck 
   2433   1.1     chuck                 dev->sc_tinfo[dev->target].lubusy &= ~(1 << dev->lun);
   2434   1.1     chuck 
   2435   1.1     chuck                 dev->sc_nexus = NULL;
   2436   1.1     chuck                 dev->sc_xs    = NULL;
   2437   1.1     chuck             }
   2438   1.1     chuck 
   2439   1.1     chuck             /*
   2440   1.1     chuck              * Reload sync values for this target
   2441   1.1     chuck              */
   2442   1.1     chuck             if ( dev->sc_sync[newtarget].state == SYNC_DONE )
   2443   1.1     chuck                 SET_SBIC_syn(regs, SBIC_SYN (dev->sc_sync[newtarget].offset,
   2444   1.1     chuck                                              dev->sc_sync[newtarget].period));
   2445   1.1     chuck             else
   2446   1.1     chuck                 SET_SBIC_syn(regs, SBIC_SYN (0, sbic_min_period));
   2447   1.1     chuck 
   2448   1.1     chuck             /*
   2449   1.1     chuck              * Loop through the nexus list until we find the saved entry
   2450   1.1     chuck              * for the reselecting target...
   2451   1.1     chuck              */
   2452   1.1     chuck             for (acb = dev->nexus_list.tqh_first; acb;
   2453   1.1     chuck                                                   acb = acb->chain.tqe_next) {
   2454   1.1     chuck 
   2455  1.16    bouyer                 if ( acb->xs->xs_periph->periph_target == newtarget &&
   2456  1.16    bouyer                      acb->xs->xs_periph->periph_lun    == newlun) {
   2457   1.1     chuck                     /*
   2458   1.1     chuck                      * We've found the saved entry. Dequeue it, and
   2459   1.1     chuck                      * make it current again.
   2460   1.1     chuck                      */
   2461   1.1     chuck                     TAILQ_REMOVE(&dev->nexus_list, acb, chain);
   2462   1.1     chuck 
   2463   1.1     chuck                     dev->sc_nexus  = acb;
   2464   1.1     chuck                     dev->sc_xs     = acb->xs;
   2465   1.1     chuck                     dev->sc_flags |= SBICF_SELECTED;
   2466   1.1     chuck                     dev->target    = newtarget;
   2467   1.1     chuck                     dev->lun       = newlun;
   2468   1.1     chuck                     break;
   2469   1.1     chuck                 }
   2470   1.1     chuck             }
   2471   1.1     chuck 
   2472   1.1     chuck             if ( acb == NULL ) {
   2473  1.12       scw                 printf("%s: reselect %s targ %d not in nexus_list %p\n",
   2474   1.1     chuck                         dev->sc_dev.dv_xname,
   2475   1.1     chuck                         csr == SBIC_CSR_RSLT_NI ? "NI" : "IFY", newtarget,
   2476   1.1     chuck                         &dev->nexus_list.tqh_first);
   2477   1.1     chuck                 panic("bad reselect in sbic");
   2478   1.1     chuck             }
   2479   1.1     chuck 
   2480   1.1     chuck             if ( csr == SBIC_CSR_RSLT_IFY )
   2481   1.1     chuck                 SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
   2482   1.1     chuck         }
   2483   1.1     chuck         break;
   2484   1.1     chuck 
   2485   1.1     chuck       default:
   2486   1.1     chuck         abort:
   2487   1.1     chuck         {
   2488   1.1     chuck             /*
   2489   1.1     chuck              * Something unexpected happened -- deal with it.
   2490   1.1     chuck              */
   2491   1.5  christos             printf("next: aborting asr 0x%02x csr 0x%02x\n", asr, csr);
   2492   1.1     chuck 
   2493   1.1     chuck #ifdef DDB
   2494   1.1     chuck             Debugger();
   2495   1.1     chuck #endif
   2496   1.1     chuck 
   2497   1.1     chuck #ifdef DEBUG
   2498   1.1     chuck             dev->sc_dmatimo = 0;
   2499   1.1     chuck             if ( data_pointer_debug > 1 )
   2500  1.12       scw                 printf("next dmastop: %d(%p:%lx)\n", dev->target,
   2501   1.1     chuck                                                     dev->sc_cur->dc_addr,
   2502   1.1     chuck                                                     dev->sc_tcnt);
   2503   1.1     chuck #endif
   2504   1.1     chuck 
   2505   1.1     chuck             dev->sc_dmastop(dev);
   2506   1.1     chuck             SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
   2507   1.1     chuck             if ( dev->sc_xs ) sbicerror(dev, csr);
   2508   1.1     chuck             sbicabort(dev, "next");
   2509   1.1     chuck 
   2510   1.1     chuck             if ( dev->sc_flags & SBICF_INDMA ) {
   2511   1.1     chuck                 dev->sc_flags &= ~(SBICF_INDMA | SBICF_DCFLUSH);
   2512   1.1     chuck 
   2513   1.1     chuck #ifdef DEBUG
   2514   1.1     chuck                 dev->sc_dmatimo = 0;
   2515   1.1     chuck                 if ( data_pointer_debug > 1 )
   2516  1.12       scw                     printf("next dmastop: %d(%p:%lx)\n", dev->target,
   2517   1.1     chuck                                                         dev->sc_cur->dc_addr,
   2518   1.1     chuck                                                         dev->sc_tcnt);
   2519   1.1     chuck #endif
   2520   1.1     chuck                 sbic_scsidone(acb, -1);
   2521   1.1     chuck             }
   2522   1.1     chuck 
   2523   1.1     chuck             return SBIC_STATE_ERROR;
   2524   1.1     chuck         }
   2525   1.1     chuck     }
   2526   1.1     chuck 
   2527   1.1     chuck     return(SBIC_STATE_RUNNING);
   2528   1.1     chuck }
   2529   1.1     chuck 
   2530   1.1     chuck 
   2531   1.1     chuck /*
   2532   1.1     chuck  * Check if DMA can not be used with specified buffer
   2533   1.1     chuck  */
   2534   1.1     chuck int
   2535   1.1     chuck sbiccheckdmap(bp, len, mask)
   2536   1.1     chuck     void    *bp;
   2537   1.1     chuck     u_long  len,
   2538   1.1     chuck             mask;
   2539   1.1     chuck {
   2540   1.1     chuck     u_char  *buffer;
   2541   1.1     chuck     u_long  phy_buf;
   2542   1.1     chuck     u_long  phy_len;
   2543   1.1     chuck 
   2544   1.1     chuck     buffer = bp;
   2545   1.1     chuck 
   2546   1.1     chuck     if ( len == 0 )
   2547   1.1     chuck         return(1);
   2548   1.1     chuck 
   2549   1.1     chuck     while ( len ) {
   2550   1.1     chuck 
   2551  1.12       scw         phy_buf = kvtop((caddr_t)buffer);
   2552  1.20   thorpej         phy_len = PAGE_SIZE - ((int) buffer & PGOFSET);
   2553   1.1     chuck 
   2554   1.1     chuck         if ( len < phy_len )
   2555   1.1     chuck             phy_len = len;
   2556   1.1     chuck 
   2557   1.1     chuck         if ( phy_buf & mask )
   2558   1.1     chuck             return(1);
   2559   1.1     chuck 
   2560   1.1     chuck         buffer += phy_len;
   2561   1.1     chuck         len    -= phy_len;
   2562   1.1     chuck     }
   2563   1.1     chuck 
   2564   1.1     chuck     return(0);
   2565   1.1     chuck }
   2566   1.1     chuck 
   2567   1.1     chuck int
   2568   1.1     chuck sbictoscsiperiod(dev, a)
   2569   1.1     chuck     struct sbic_softc   *dev;
   2570   1.1     chuck     int                 a;
   2571   1.1     chuck {
   2572   1.1     chuck     unsigned int fs;
   2573   1.1     chuck 
   2574   1.1     chuck     /*
   2575   1.1     chuck      * cycle = DIV / (2 * CLK)
   2576   1.1     chuck      * DIV = FS + 2
   2577   1.1     chuck      * best we can do is 200ns at 20Mhz, 2 cycles
   2578   1.1     chuck      */
   2579   1.1     chuck 
   2580   1.1     chuck     GET_SBIC_myid(dev->sc_sbicp, fs);
   2581   1.1     chuck 
   2582   1.1     chuck     fs = (fs >> 6) + 2;         /* DIV */
   2583   1.1     chuck 
   2584   1.1     chuck     fs = (fs * 10000) / (dev->sc_clkfreq << 1); /* Cycle, in ns */
   2585   1.1     chuck 
   2586   1.1     chuck     if ( a < 2 )
   2587   1.1     chuck         a = 8;                  /* map to Cycles */
   2588   1.1     chuck 
   2589   1.1     chuck     return ( (fs * a) >> 2 );   /* in 4 ns units */
   2590   1.1     chuck }
   2591   1.1     chuck 
   2592   1.1     chuck int
   2593   1.1     chuck sbicfromscsiperiod(dev, p)
   2594   1.1     chuck     struct sbic_softc   *dev;
   2595   1.1     chuck     int                 p;
   2596   1.1     chuck {
   2597   1.1     chuck     unsigned    fs,
   2598   1.1     chuck                 ret;
   2599   1.1     chuck 
   2600   1.1     chuck     /*
   2601   1.1     chuck      * Just the inverse of the above
   2602   1.1     chuck      */
   2603   1.1     chuck     GET_SBIC_myid(dev->sc_sbicp, fs);
   2604   1.1     chuck 
   2605   1.1     chuck     fs = (fs >> 6) + 2;     /* DIV */
   2606   1.1     chuck 
   2607   1.1     chuck     fs = (fs * 10000) / (dev->sc_clkfreq << 1); /* Cycle, in ns */
   2608   1.1     chuck 
   2609   1.1     chuck     ret = p << 2;           /* in ns units */
   2610   1.1     chuck     ret = ret / fs;         /* in Cycles */
   2611   1.1     chuck 
   2612   1.1     chuck     if ( ret < sbic_min_period )
   2613   1.1     chuck         return(sbic_min_period);
   2614   1.1     chuck 
   2615   1.1     chuck     /*
   2616   1.1     chuck      * verify rounding
   2617   1.1     chuck      */
   2618   1.1     chuck     if ( sbictoscsiperiod(dev, ret) < p )
   2619   1.1     chuck         ret++;
   2620   1.1     chuck 
   2621   1.1     chuck     return( (ret >= 8) ? 0 : ret );
   2622   1.1     chuck }
   2623   1.1     chuck 
   2624   1.1     chuck #ifdef DEBUG
   2625   1.1     chuck void
   2626   1.1     chuck sbictimeout(dev)
   2627   1.1     chuck     struct sbic_softc   *dev;
   2628   1.1     chuck {
   2629   1.1     chuck     int     s,
   2630   1.1     chuck             asr;
   2631   1.1     chuck 
   2632   1.1     chuck     s = splbio();
   2633   1.1     chuck 
   2634   1.1     chuck     if ( dev->sc_dmatimo ) {
   2635   1.1     chuck 
   2636   1.1     chuck         if ( dev->sc_dmatimo > 1 ) {
   2637   1.1     chuck 
   2638  1.21       wiz             printf("%s: DMA timeout #%d\n", dev->sc_dev.dv_xname,
   2639   1.1     chuck                                             dev->sc_dmatimo - 1);
   2640   1.1     chuck 
   2641   1.1     chuck             GET_SBIC_asr(dev->sc_sbicp, asr);
   2642   1.1     chuck 
   2643   1.1     chuck             if ( asr & SBIC_ASR_INT ) {
   2644   1.1     chuck                 /*
   2645   1.1     chuck                  * We need to service a missed IRQ
   2646   1.1     chuck                  */
   2647   1.1     chuck                 sbicintr(dev);
   2648   1.2     chuck             } else {
   2649   1.2     chuck                 (void) sbicabort(dev, "timeout");
   2650   1.2     chuck                 splx(s);
   2651   1.2     chuck                 return;
   2652   1.1     chuck             }
   2653   1.1     chuck         }
   2654   1.1     chuck 
   2655   1.1     chuck         dev->sc_dmatimo++;
   2656   1.1     chuck     }
   2657   1.1     chuck 
   2658   1.1     chuck     splx(s);
   2659   1.1     chuck 
   2660  1.13   thorpej     callout_reset(&dev->sc_timo_ch, 30 * hz, (void *)sbictimeout, dev);
   2661   1.1     chuck }
   2662   1.1     chuck #endif
   2663