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