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