Home | History | Annotate | Line # | Download | only in dev
wstsc.c revision 1.2
      1  1.1  chopps /*
      2  1.2  chopps  * Copyright (c) 1994 Michael L. Hitch
      3  1.1  chopps  * Copyright (c) 1982, 1990 The Regents of the University of California.
      4  1.1  chopps  * All rights reserved.
      5  1.1  chopps  *
      6  1.1  chopps  * Redistribution and use in source and binary forms, with or without
      7  1.1  chopps  * modification, are permitted provided that the following conditions
      8  1.1  chopps  * are met:
      9  1.1  chopps  * 1. Redistributions of source code must retain the above copyright
     10  1.1  chopps  *    notice, this list of conditions and the following disclaimer.
     11  1.1  chopps  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1  chopps  *    notice, this list of conditions and the following disclaimer in the
     13  1.1  chopps  *    documentation and/or other materials provided with the distribution.
     14  1.1  chopps  * 3. All advertising materials mentioning features or use of this software
     15  1.1  chopps  *    must display the following acknowledgement:
     16  1.1  chopps  *	This product includes software developed by the University of
     17  1.1  chopps  *	California, Berkeley and its contributors.
     18  1.1  chopps  * 4. Neither the name of the University nor the names of its contributors
     19  1.1  chopps  *    may be used to endorse or promote products derived from this software
     20  1.1  chopps  *    without specific prior written permission.
     21  1.1  chopps  *
     22  1.1  chopps  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     23  1.1  chopps  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     24  1.1  chopps  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     25  1.1  chopps  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     26  1.1  chopps  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     27  1.1  chopps  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     28  1.1  chopps  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     29  1.1  chopps  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     30  1.1  chopps  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     31  1.1  chopps  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     32  1.1  chopps  * SUCH DAMAGE.
     33  1.1  chopps  *
     34  1.1  chopps  *	@(#)supradma.c
     35  1.2  chopps  *	$Id: wstsc.c,v 1.2 1994/05/29 04:50:25 chopps Exp $
     36  1.1  chopps  */
     37  1.2  chopps #include <sys/param.h>
     38  1.2  chopps #include <sys/systm.h>
     39  1.2  chopps #include <sys/kernel.h>
     40  1.2  chopps #include <sys/device.h>
     41  1.2  chopps #include <scsi/scsi_all.h>
     42  1.2  chopps #include <scsi/scsiconf.h>
     43  1.2  chopps #include <amiga/amiga/device.h>
     44  1.2  chopps #include <amiga/dev/scireg.h>
     45  1.2  chopps #include <amiga/dev/scivar.h>
     46  1.2  chopps #include <amiga/dev/ztwobusvar.h>
     47  1.2  chopps 
     48  1.2  chopps int wstscprint __P((void *auxp, char *));
     49  1.2  chopps void wstscattach __P((struct device *, struct device *, void *));
     50  1.2  chopps int wstscmatch __P((struct device *, struct cfdata *, void *));
     51  1.1  chopps 
     52  1.2  chopps int wstsc_dma_xfer_in __P((struct sci_softc *dev, int len,
     53  1.2  chopps     register u_char *buf, int phase));
     54  1.2  chopps int wstsc_dma_xfer_out __P((struct sci_softc *dev, int len,
     55  1.2  chopps     register u_char *buf, int phase));
     56  1.2  chopps int wstsc_dma_xfer_in2 __P((struct sci_softc *dev, int len,
     57  1.2  chopps     register u_short *buf, int phase));
     58  1.2  chopps int wstsc_dma_xfer_out2 __P((struct sci_softc *dev, int len,
     59  1.2  chopps     register u_short *buf, int phase));
     60  1.1  chopps 
     61  1.2  chopps struct scsi_adapter wstsc_scsiswitch = {
     62  1.2  chopps 	sci_scsicmd,
     63  1.2  chopps 	sci_minphys,
     64  1.2  chopps 	0,			/* no lun support */
     65  1.2  chopps 	0,			/* no lun support */
     66  1.2  chopps 	sci_adinfo,
     67  1.2  chopps 	"wstsc",
     68  1.2  chopps };
     69  1.2  chopps 
     70  1.2  chopps struct scsi_device wstsc_scsidev = {
     71  1.2  chopps 	NULL,		/* use default error handler */
     72  1.2  chopps 	NULL,		/* do not have a start functio */
     73  1.2  chopps 	NULL,		/* have no async handler */
     74  1.2  chopps 	NULL,		/* Use default done routine */
     75  1.2  chopps 	"wstsc",
     76  1.2  chopps 	0,
     77  1.2  chopps };
     78  1.1  chopps 
     79  1.2  chopps #define QPRINTF
     80  1.1  chopps 
     81  1.2  chopps #ifdef DEBUG
     82  1.2  chopps extern int sci_debug;
     83  1.2  chopps #endif
     84  1.1  chopps 
     85  1.2  chopps extern int sci_data_wait;
     86  1.1  chopps 
     87  1.1  chopps int supradma_pseudo = 0;	/* 0=none, 1=byte, 2=word */
     88  1.1  chopps 
     89  1.2  chopps struct cfdriver wstsccd = {
     90  1.2  chopps 	NULL, "wstsc", wstscmatch, wstscattach,
     91  1.2  chopps 	DV_DULL, sizeof(struct sci_softc), NULL, 0 };
     92  1.1  chopps 
     93  1.2  chopps /*
     94  1.2  chopps  * if this a Supra WordSync board
     95  1.2  chopps  */
     96  1.2  chopps int
     97  1.2  chopps wstscmatch(pdp, cdp, auxp)
     98  1.2  chopps 	struct device *pdp;
     99  1.2  chopps 	struct cfdata *cdp;
    100  1.2  chopps 	void *auxp;
    101  1.2  chopps {
    102  1.2  chopps 	struct ztwobus_args *zap;
    103  1.1  chopps 
    104  1.2  chopps 	zap = auxp;
    105  1.1  chopps 
    106  1.2  chopps 	/*
    107  1.2  chopps 	 * Check manufacturer and product id.
    108  1.2  chopps 	 */
    109  1.2  chopps 	if (zap->manid == 1056 && zap->prodid == 12)	/* add other boards? */
    110  1.2  chopps 		return(1);
    111  1.2  chopps 	else
    112  1.2  chopps 		return(0);
    113  1.2  chopps }
    114  1.1  chopps 
    115  1.1  chopps void
    116  1.2  chopps wstscattach(pdp, dp, auxp)
    117  1.2  chopps 	struct device *pdp, *dp;
    118  1.2  chopps 	void *auxp;
    119  1.1  chopps {
    120  1.2  chopps 	volatile u_char *rp;
    121  1.2  chopps 	struct sci_softc *sc;
    122  1.2  chopps 	struct ztwobus_args *zap;
    123  1.2  chopps 
    124  1.2  chopps 	zap = auxp;
    125  1.2  chopps 
    126  1.2  chopps 	sc = (struct sci_softc *)dp;
    127  1.2  chopps 	rp = zap->va;
    128  1.2  chopps 	/*
    129  1.2  chopps 	 * set up 5380 register pointers
    130  1.2  chopps 	 * (Needs check on which Supra board this is - for now,
    131  1.2  chopps 	 *  just do the WordSync)
    132  1.2  chopps 	 */
    133  1.2  chopps 	sc->sci_data = rp + 0;
    134  1.2  chopps 	sc->sci_odata = rp + 0;
    135  1.2  chopps 	sc->sci_icmd = rp + 2;
    136  1.2  chopps 	sc->sci_mode = rp + 4;
    137  1.2  chopps 	sc->sci_tcmd = rp + 6;
    138  1.2  chopps 	sc->sci_bus_csr = rp + 8;
    139  1.2  chopps 	sc->sci_sel_enb = rp + 8;
    140  1.2  chopps 	sc->sci_csr = rp + 10;
    141  1.2  chopps 	sc->sci_dma_send = rp + 10;
    142  1.2  chopps 	sc->sci_idata = rp + 12;
    143  1.2  chopps 	sc->sci_trecv = rp + 12;
    144  1.2  chopps 	sc->sci_iack = rp + 14;
    145  1.2  chopps 	sc->sci_irecv = rp + 14;
    146  1.2  chopps 
    147  1.1  chopps 	if (supradma_pseudo == 2) {
    148  1.2  chopps 		sc->dma_xfer_in = wstsc_dma_xfer_in2;
    149  1.2  chopps 		sc->dma_xfer_out = wstsc_dma_xfer_out2;
    150  1.2  chopps 	}
    151  1.2  chopps 	else if (supradma_pseudo == 1) {
    152  1.2  chopps 		sc->dma_xfer_in = wstsc_dma_xfer_in;
    153  1.2  chopps 		sc->dma_xfer_out = wstsc_dma_xfer_out;
    154  1.1  chopps 	}
    155  1.2  chopps 
    156  1.2  chopps 	scireset(sc);
    157  1.2  chopps 
    158  1.2  chopps 	sc->sc_link.adapter_softc = sc;
    159  1.2  chopps 	sc->sc_link.adapter_targ = 7;
    160  1.2  chopps 	sc->sc_link.adapter = &wstsc_scsiswitch;
    161  1.2  chopps 	sc->sc_link.device = &wstsc_scsidev;
    162  1.2  chopps 	TAILQ_INIT(&sc->sc_xslist);
    163  1.2  chopps 
    164  1.2  chopps 	/*
    165  1.2  chopps 	 * attach all scsi units on us
    166  1.2  chopps 	 */
    167  1.2  chopps 	config_found(dp, &sc->sc_link, wstscprint);
    168  1.2  chopps }
    169  1.2  chopps 
    170  1.2  chopps /*
    171  1.2  chopps  * print diag if pnp is NULL else just extra
    172  1.2  chopps  */
    173  1.2  chopps int
    174  1.2  chopps wstscprint(auxp, pnp)
    175  1.2  chopps 	void *auxp;
    176  1.2  chopps 	char *pnp;
    177  1.2  chopps {
    178  1.2  chopps 	if (pnp == NULL)
    179  1.2  chopps 		return(UNCONF);
    180  1.2  chopps 	return(QUIET);
    181  1.1  chopps }
    182  1.1  chopps 
    183  1.2  chopps int
    184  1.2  chopps wstsc_dma_xfer_in (dev, len, buf, phase)
    185  1.1  chopps 	struct sci_softc *dev;
    186  1.1  chopps 	int len;
    187  1.1  chopps 	register u_char *buf;
    188  1.1  chopps 	int phase;
    189  1.1  chopps {
    190  1.1  chopps 	int wait = sci_data_wait;
    191  1.1  chopps 	u_char csr;
    192  1.1  chopps 	u_char *obp = (u_char *) buf;
    193  1.1  chopps 	volatile register u_char *sci_dma = dev->sci_idata;
    194  1.1  chopps 	volatile register u_char *sci_csr = dev->sci_csr;
    195  1.1  chopps 
    196  1.1  chopps 	QPRINTF(("supradma_in %d, csr=%02x\n", len, *dev->sci_bus_csr));
    197  1.1  chopps 
    198  1.1  chopps 	*dev->sci_tcmd = phase;
    199  1.1  chopps 	*dev->sci_icmd = 0;
    200  1.1  chopps 	*dev->sci_mode = SCI_MODE_DMA;
    201  1.1  chopps 	*dev->sci_irecv = 0;
    202  1.1  chopps 
    203  1.1  chopps 	while (len >= 128) {
    204  1.1  chopps 		wait = sci_data_wait;
    205  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    206  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    207  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    208  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    209  1.1  chopps 			  || --wait < 0) {
    210  1.1  chopps #ifdef DEBUG
    211  1.1  chopps 				if (sci_debug | 1)
    212  1.1  chopps 					printf("supradma2_in fail: l%d i%x w%d\n",
    213  1.1  chopps 					len, *dev->sci_bus_csr, wait);
    214  1.1  chopps #endif
    215  1.1  chopps 				*dev->sci_mode = 0;
    216  1.1  chopps 				return 0;
    217  1.1  chopps 			}
    218  1.1  chopps 		}
    219  1.1  chopps 
    220  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    221  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    222  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    223  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    224  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    225  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    226  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    227  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    228  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    229  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    230  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    231  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    232  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    233  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    234  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    235  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    236  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    237  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    238  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    239  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    240  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    241  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    242  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    243  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    244  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    245  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    246  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    247  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    248  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    249  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    250  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    251  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    252  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    253  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    254  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    255  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    256  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    257  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    258  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    259  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    260  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    261  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    262  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    263  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    264  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    265  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    266  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    267  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    268  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    269  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    270  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    271  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    272  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    273  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    274  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    275  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    276  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    277  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    278  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    279  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    280  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    281  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    282  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    283  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    284  1.1  chopps 		len -= 128;
    285  1.1  chopps 	}
    286  1.1  chopps 
    287  1.1  chopps 	while (len > 0) {
    288  1.1  chopps 		wait = sci_data_wait;
    289  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    290  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    291  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    292  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    293  1.1  chopps 			  || --wait < 0) {
    294  1.1  chopps #ifdef DEBUG
    295  1.1  chopps 				if (sci_debug | 1)
    296  1.1  chopps 					printf("supradma1_in fail: l%d i%x w%d\n",
    297  1.1  chopps 					len, *dev->sci_bus_csr, wait);
    298  1.1  chopps #endif
    299  1.1  chopps 				*dev->sci_mode = 0;
    300  1.1  chopps 				return 0;
    301  1.1  chopps 			}
    302  1.1  chopps 		}
    303  1.1  chopps 
    304  1.1  chopps 		*buf++ = *sci_dma;
    305  1.1  chopps 		len--;
    306  1.1  chopps 	}
    307  1.1  chopps 
    308  1.1  chopps 	QPRINTF(("supradma_in {%d} %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
    309  1.1  chopps 	  len, obp[0], obp[1], obp[2], obp[3], obp[4], obp[5],
    310  1.1  chopps 	  obp[6], obp[7], obp[8], obp[9]));
    311  1.1  chopps 
    312  1.1  chopps 	*dev->sci_mode = 0;
    313  1.1  chopps 	return 0;
    314  1.1  chopps }
    315  1.1  chopps 
    316  1.2  chopps int
    317  1.2  chopps wstsc_dma_xfer_out (dev, len, buf, phase)
    318  1.1  chopps 	struct sci_softc *dev;
    319  1.1  chopps 	int len;
    320  1.1  chopps 	register u_char *buf;
    321  1.1  chopps 	int phase;
    322  1.1  chopps {
    323  1.1  chopps 	int wait = sci_data_wait;
    324  1.1  chopps 	u_char csr;
    325  1.1  chopps 	u_char *obp = buf;
    326  1.1  chopps 	volatile register u_char *sci_dma = dev->sci_data;
    327  1.1  chopps 	volatile register u_char *sci_csr = dev->sci_csr;
    328  1.1  chopps 
    329  1.1  chopps 	QPRINTF(("supradma_out %d, csr=%02x\n", len, *dev->sci_bus_csr));
    330  1.1  chopps 
    331  1.1  chopps 	QPRINTF(("supradma_out {%d} %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
    332  1.1  chopps   	 len, buf[0], buf[1], buf[2], buf[3], buf[4], buf[5],
    333  1.1  chopps 	 buf[6], buf[7], buf[8], buf[9]));
    334  1.1  chopps 
    335  1.1  chopps 	*dev->sci_tcmd = phase;
    336  1.1  chopps 	*dev->sci_mode = SCI_MODE_DMA;
    337  1.1  chopps 	*dev->sci_icmd = SCI_ICMD_DATA;
    338  1.1  chopps 	*dev->sci_dma_send = 0;
    339  1.1  chopps 	while (len > 0) {
    340  1.1  chopps 		wait = sci_data_wait;
    341  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    342  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    343  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    344  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    345  1.1  chopps 			  || --wait < 0) {
    346  1.1  chopps #ifdef DEBUG
    347  1.1  chopps 				if (sci_debug)
    348  1.1  chopps 					printf("supradma_out fail: l%d i%x w%d\n",
    349  1.1  chopps 					len, csr, wait);
    350  1.1  chopps #endif
    351  1.1  chopps 				*dev->sci_mode = 0;
    352  1.1  chopps 				return 0;
    353  1.1  chopps 			}
    354  1.1  chopps 		}
    355  1.1  chopps 
    356  1.1  chopps 		*sci_dma = *buf++;
    357  1.1  chopps 		len--;
    358  1.1  chopps 	}
    359  1.1  chopps 
    360  1.1  chopps 	wait = sci_data_wait;
    361  1.1  chopps 	while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) ==
    362  1.1  chopps 	  SCI_CSR_PHASE_MATCH && --wait);
    363  1.1  chopps 
    364  1.1  chopps 
    365  1.1  chopps 	*dev->sci_mode = 0;
    366  1.1  chopps 	*dev->sci_icmd = 0;
    367  1.1  chopps 	return 0;
    368  1.1  chopps }
    369  1.1  chopps 
    370  1.1  chopps 
    371  1.2  chopps int
    372  1.2  chopps wstsc_dma_xfer_in2 (dev, len, buf, phase)
    373  1.1  chopps 	struct sci_softc *dev;
    374  1.1  chopps 	int len;
    375  1.1  chopps 	register u_short *buf;
    376  1.1  chopps 	int phase;
    377  1.1  chopps {
    378  1.1  chopps 	int wait = sci_data_wait;
    379  1.1  chopps 	u_char csr;
    380  1.1  chopps 	u_char *obp = (u_char *) buf;
    381  1.1  chopps 	volatile register u_short *sci_dma = (u_short *)(dev->sci_idata + 0x10);
    382  1.1  chopps 	volatile register u_char *sci_csr = dev->sci_csr + 0x10;
    383  1.1  chopps 
    384  1.1  chopps 	QPRINTF(("supradma_in2 %d, csr=%02x\n", len, *dev->sci_bus_csr));
    385  1.1  chopps 
    386  1.1  chopps 	*dev->sci_tcmd = phase;
    387  1.1  chopps 	*dev->sci_mode = SCI_MODE_DMA;
    388  1.1  chopps 	*dev->sci_icmd = 0;
    389  1.1  chopps 	*(dev->sci_irecv + 16) = 0;
    390  1.1  chopps 	while (len >= 128) {
    391  1.1  chopps #if 0
    392  1.1  chopps 		wait = sci_data_wait;
    393  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    394  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    395  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    396  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    397  1.1  chopps 			  || --wait < 0) {
    398  1.1  chopps #ifdef DEBUG
    399  1.1  chopps 				if (sci_debug | 1)
    400  1.1  chopps 					printf("supradma2_in2 fail: l%d i%x w%d\n",
    401  1.1  chopps 					len, *dev->sci_bus_csr, wait);
    402  1.1  chopps #endif
    403  1.1  chopps 				*dev->sci_mode &= ~SCI_MODE_DMA;
    404  1.1  chopps 				return 0;
    405  1.1  chopps 			}
    406  1.1  chopps 		}
    407  1.1  chopps #else
    408  1.1  chopps 		while (!(*sci_csr & SCI_CSR_DREQ))
    409  1.1  chopps 			;
    410  1.1  chopps #endif
    411  1.1  chopps 
    412  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    413  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    414  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    415  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    416  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    417  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    418  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    419  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    420  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    421  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    422  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    423  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    424  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    425  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    426  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    427  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    428  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    429  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    430  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    431  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    432  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    433  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    434  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    435  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    436  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    437  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    438  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    439  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    440  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    441  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    442  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    443  1.1  chopps 		*buf++ = *sci_dma; *buf++ = *sci_dma;
    444  1.1  chopps 		len -= 128;
    445  1.1  chopps 	}
    446  1.1  chopps 	while (len > 0) {
    447  1.1  chopps #if 0
    448  1.1  chopps 		wait = sci_data_wait;
    449  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    450  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    451  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    452  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    453  1.1  chopps 			  || --wait < 0) {
    454  1.1  chopps #ifdef DEBUG
    455  1.1  chopps 				if (sci_debug | 1)
    456  1.1  chopps 					printf("supradma1_in2 fail: l%d i%x w%d\n",
    457  1.1  chopps 					len, *dev->sci_bus_csr, wait);
    458  1.1  chopps #endif
    459  1.1  chopps 				*dev->sci_mode &= ~SCI_MODE_DMA;
    460  1.1  chopps 				return 0;
    461  1.1  chopps 			}
    462  1.1  chopps 		}
    463  1.1  chopps #else
    464  1.1  chopps 		while (!(*sci_csr * SCI_CSR_DREQ))
    465  1.1  chopps 			;
    466  1.1  chopps #endif
    467  1.1  chopps 
    468  1.1  chopps 		*buf++ = *sci_dma;
    469  1.1  chopps 		len -= 2;
    470  1.1  chopps 	}
    471  1.1  chopps 
    472  1.1  chopps 	QPRINTF(("supradma_in2 {%d} %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
    473  1.1  chopps 	  len, obp[0], obp[1], obp[2], obp[3], obp[4], obp[5],
    474  1.1  chopps 	  obp[6], obp[7], obp[8], obp[9]));
    475  1.1  chopps 
    476  1.1  chopps 	*dev->sci_irecv = 0;
    477  1.1  chopps 	*dev->sci_mode = 0;
    478  1.1  chopps 	return 0;
    479  1.1  chopps }
    480  1.1  chopps 
    481  1.2  chopps int
    482  1.2  chopps wstsc_dma_xfer_out2 (dev, len, buf, phase)
    483  1.1  chopps 	struct sci_softc *dev;
    484  1.1  chopps 	int len;
    485  1.1  chopps 	register u_short *buf;
    486  1.1  chopps 	int phase;
    487  1.1  chopps {
    488  1.1  chopps 	int wait = sci_data_wait;
    489  1.1  chopps 	u_char csr;
    490  1.1  chopps 	u_char *obp = (u_char *) buf;
    491  1.1  chopps 	volatile register u_short *sci_dma = (ushort *)(dev->sci_data + 0x10);
    492  1.1  chopps 	volatile register u_char *sci_bus_csr = dev->sci_bus_csr;
    493  1.1  chopps 
    494  1.1  chopps 	QPRINTF(("supradma_out2 %d, csr=%02x\n", len, *dev->sci_bus_csr));
    495  1.1  chopps 
    496  1.1  chopps 	QPRINTF(("supradma_out2 {%d} %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
    497  1.1  chopps   	 len, obp[0], obp[1], obp[2], obp[3], obp[4], obp[5],
    498  1.1  chopps 	 obp[6], obp[7], obp[8], obp[9]));
    499  1.1  chopps 
    500  1.1  chopps 	*dev->sci_tcmd = phase;
    501  1.1  chopps 	*dev->sci_mode = SCI_MODE_DMA;
    502  1.1  chopps 	*dev->sci_icmd = SCI_ICMD_DATA;
    503  1.1  chopps 	*dev->sci_dma_send = 0;
    504  1.1  chopps 	while (len > 0) {
    505  1.1  chopps #if 0
    506  1.1  chopps 		wait = sci_data_wait;
    507  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    508  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    509  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    510  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    511  1.1  chopps 			  || --wait < 0) {
    512  1.1  chopps #ifdef DEBUG
    513  1.1  chopps 				if (sci_debug)
    514  1.1  chopps 					printf("supradma_out2 fail: l%d i%x w%d\n",
    515  1.1  chopps 					len, csr, wait);
    516  1.1  chopps #endif
    517  1.1  chopps 				*dev->sci_mode = 0;
    518  1.1  chopps 				return 0;
    519  1.1  chopps 			}
    520  1.1  chopps 		}
    521  1.1  chopps #else
    522  1.1  chopps 		*dev->sci_mode = 0;
    523  1.1  chopps 		*dev->sci_icmd &= ~SCI_ICMD_ACK;
    524  1.1  chopps 		while (!(*sci_bus_csr & SCI_BUS_REQ))
    525  1.1  chopps 			;
    526  1.1  chopps 		*dev->sci_mode = SCI_MODE_DMA;
    527  1.1  chopps 		*dev->sci_dma_send = 0;
    528  1.1  chopps #endif
    529  1.1  chopps 
    530  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    531  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    532  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    533  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    534  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    535  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    536  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    537  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    538  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    539  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    540  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    541  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    542  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    543  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    544  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    545  1.1  chopps 		*sci_dma = *buf++; *sci_dma = *buf++;
    546  1.1  chopps 		if (*(sci_bus_csr + 0x10) & SCI_BUS_REQ)
    547  1.1  chopps 			;
    548  1.1  chopps 		len -= 64;
    549  1.1  chopps 	}
    550  1.1  chopps 
    551  1.1  chopps #if 0
    552  1.1  chopps 	wait = sci_data_wait;
    553  1.1  chopps 	while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) ==
    554  1.1  chopps 	  SCI_CSR_PHASE_MATCH && --wait);
    555  1.1  chopps #endif
    556  1.1  chopps 
    557  1.1  chopps 
    558  1.1  chopps 	*dev->sci_irecv = 0;
    559  1.1  chopps 	*dev->sci_icmd &= ~SCI_ICMD_ACK;
    560  1.1  chopps 	*dev->sci_mode = 0;
    561  1.1  chopps 	*dev->sci_icmd = 0;
    562  1.1  chopps 	return 0;
    563  1.1  chopps }
    564  1.1  chopps 
    565  1.2  chopps int
    566  1.2  chopps wstsc_intr()
    567  1.2  chopps {
    568  1.1  chopps 	struct sci_softc *dev;
    569  1.2  chopps 	int i, found;
    570  1.2  chopps 	u_char stat;
    571  1.2  chopps 
    572  1.2  chopps 	found = 0;
    573  1.2  chopps 	for (i = 0; i < wstsccd.cd_ndevs; i++) {
    574  1.2  chopps 		dev = wstsccd.cd_devs[i];
    575  1.2  chopps 		if (dev == NULL)
    576  1.2  chopps 			continue;
    577  1.2  chopps 		if ((*(dev->sci_csr + 0x10) & SCI_CSR_INT) == 0)
    578  1.2  chopps 			continue;
    579  1.2  chopps 		++found;
    580  1.2  chopps 		stat = *(dev->sci_iack + 0x10);
    581  1.1  chopps 	}
    582  1.2  chopps 	return (found);
    583  1.1  chopps }
    584