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