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