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