Home | History | Annotate | Line # | Download | only in dev
wstsc.c revision 1.3
      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.3  chopps  *	$Id: wstsc.c,v 1.3 1994/06/13 08:13:09 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.3  chopps 	printf("\n");
    125  1.3  chopps 
    126  1.2  chopps 	zap = auxp;
    127  1.2  chopps 
    128  1.2  chopps 	sc = (struct sci_softc *)dp;
    129  1.2  chopps 	rp = zap->va;
    130  1.2  chopps 	/*
    131  1.2  chopps 	 * set up 5380 register pointers
    132  1.2  chopps 	 * (Needs check on which Supra board this is - for now,
    133  1.2  chopps 	 *  just do the WordSync)
    134  1.2  chopps 	 */
    135  1.2  chopps 	sc->sci_data = rp + 0;
    136  1.2  chopps 	sc->sci_odata = rp + 0;
    137  1.2  chopps 	sc->sci_icmd = rp + 2;
    138  1.2  chopps 	sc->sci_mode = rp + 4;
    139  1.2  chopps 	sc->sci_tcmd = rp + 6;
    140  1.2  chopps 	sc->sci_bus_csr = rp + 8;
    141  1.2  chopps 	sc->sci_sel_enb = rp + 8;
    142  1.2  chopps 	sc->sci_csr = rp + 10;
    143  1.2  chopps 	sc->sci_dma_send = rp + 10;
    144  1.2  chopps 	sc->sci_idata = rp + 12;
    145  1.2  chopps 	sc->sci_trecv = rp + 12;
    146  1.2  chopps 	sc->sci_iack = rp + 14;
    147  1.2  chopps 	sc->sci_irecv = rp + 14;
    148  1.2  chopps 
    149  1.1  chopps 	if (supradma_pseudo == 2) {
    150  1.2  chopps 		sc->dma_xfer_in = wstsc_dma_xfer_in2;
    151  1.2  chopps 		sc->dma_xfer_out = wstsc_dma_xfer_out2;
    152  1.2  chopps 	}
    153  1.2  chopps 	else if (supradma_pseudo == 1) {
    154  1.2  chopps 		sc->dma_xfer_in = wstsc_dma_xfer_in;
    155  1.2  chopps 		sc->dma_xfer_out = wstsc_dma_xfer_out;
    156  1.1  chopps 	}
    157  1.2  chopps 
    158  1.2  chopps 	scireset(sc);
    159  1.2  chopps 
    160  1.2  chopps 	sc->sc_link.adapter_softc = sc;
    161  1.2  chopps 	sc->sc_link.adapter_targ = 7;
    162  1.2  chopps 	sc->sc_link.adapter = &wstsc_scsiswitch;
    163  1.2  chopps 	sc->sc_link.device = &wstsc_scsidev;
    164  1.2  chopps 	TAILQ_INIT(&sc->sc_xslist);
    165  1.2  chopps 
    166  1.2  chopps 	/*
    167  1.2  chopps 	 * attach all scsi units on us
    168  1.2  chopps 	 */
    169  1.2  chopps 	config_found(dp, &sc->sc_link, wstscprint);
    170  1.2  chopps }
    171  1.2  chopps 
    172  1.2  chopps /*
    173  1.2  chopps  * print diag if pnp is NULL else just extra
    174  1.2  chopps  */
    175  1.2  chopps int
    176  1.2  chopps wstscprint(auxp, pnp)
    177  1.2  chopps 	void *auxp;
    178  1.2  chopps 	char *pnp;
    179  1.2  chopps {
    180  1.2  chopps 	if (pnp == NULL)
    181  1.2  chopps 		return(UNCONF);
    182  1.2  chopps 	return(QUIET);
    183  1.1  chopps }
    184  1.1  chopps 
    185  1.2  chopps int
    186  1.2  chopps wstsc_dma_xfer_in (dev, len, buf, phase)
    187  1.1  chopps 	struct sci_softc *dev;
    188  1.1  chopps 	int len;
    189  1.1  chopps 	register u_char *buf;
    190  1.1  chopps 	int phase;
    191  1.1  chopps {
    192  1.1  chopps 	int wait = sci_data_wait;
    193  1.1  chopps 	u_char csr;
    194  1.1  chopps 	u_char *obp = (u_char *) buf;
    195  1.1  chopps 	volatile register u_char *sci_dma = dev->sci_idata;
    196  1.1  chopps 	volatile register u_char *sci_csr = dev->sci_csr;
    197  1.1  chopps 
    198  1.1  chopps 	QPRINTF(("supradma_in %d, csr=%02x\n", len, *dev->sci_bus_csr));
    199  1.1  chopps 
    200  1.1  chopps 	*dev->sci_tcmd = phase;
    201  1.1  chopps 	*dev->sci_icmd = 0;
    202  1.1  chopps 	*dev->sci_mode = SCI_MODE_DMA;
    203  1.1  chopps 	*dev->sci_irecv = 0;
    204  1.1  chopps 
    205  1.1  chopps 	while (len >= 128) {
    206  1.1  chopps 		wait = sci_data_wait;
    207  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    208  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    209  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    210  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    211  1.1  chopps 			  || --wait < 0) {
    212  1.1  chopps #ifdef DEBUG
    213  1.1  chopps 				if (sci_debug | 1)
    214  1.1  chopps 					printf("supradma2_in fail: l%d i%x w%d\n",
    215  1.1  chopps 					len, *dev->sci_bus_csr, wait);
    216  1.1  chopps #endif
    217  1.1  chopps 				*dev->sci_mode = 0;
    218  1.1  chopps 				return 0;
    219  1.1  chopps 			}
    220  1.1  chopps 		}
    221  1.1  chopps 
    222  1.3  chopps #define R1	(*buf++ = *sci_dma)
    223  1.3  chopps 		R1; R1; R1; R1; R1; R1; R1; R1;
    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.1  chopps 		len -= 128;
    240  1.1  chopps 	}
    241  1.1  chopps 
    242  1.1  chopps 	while (len > 0) {
    243  1.1  chopps 		wait = sci_data_wait;
    244  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    245  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    246  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    247  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    248  1.1  chopps 			  || --wait < 0) {
    249  1.1  chopps #ifdef DEBUG
    250  1.1  chopps 				if (sci_debug | 1)
    251  1.1  chopps 					printf("supradma1_in fail: l%d i%x w%d\n",
    252  1.1  chopps 					len, *dev->sci_bus_csr, wait);
    253  1.1  chopps #endif
    254  1.1  chopps 				*dev->sci_mode = 0;
    255  1.1  chopps 				return 0;
    256  1.1  chopps 			}
    257  1.1  chopps 		}
    258  1.1  chopps 
    259  1.1  chopps 		*buf++ = *sci_dma;
    260  1.1  chopps 		len--;
    261  1.1  chopps 	}
    262  1.1  chopps 
    263  1.1  chopps 	QPRINTF(("supradma_in {%d} %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
    264  1.1  chopps 	  len, obp[0], obp[1], obp[2], obp[3], obp[4], obp[5],
    265  1.1  chopps 	  obp[6], obp[7], obp[8], obp[9]));
    266  1.1  chopps 
    267  1.1  chopps 	*dev->sci_mode = 0;
    268  1.1  chopps 	return 0;
    269  1.1  chopps }
    270  1.1  chopps 
    271  1.2  chopps int
    272  1.2  chopps wstsc_dma_xfer_out (dev, len, buf, phase)
    273  1.1  chopps 	struct sci_softc *dev;
    274  1.1  chopps 	int len;
    275  1.1  chopps 	register u_char *buf;
    276  1.1  chopps 	int phase;
    277  1.1  chopps {
    278  1.1  chopps 	int wait = sci_data_wait;
    279  1.1  chopps 	u_char csr;
    280  1.1  chopps 	u_char *obp = buf;
    281  1.1  chopps 	volatile register u_char *sci_dma = dev->sci_data;
    282  1.1  chopps 	volatile register u_char *sci_csr = dev->sci_csr;
    283  1.1  chopps 
    284  1.1  chopps 	QPRINTF(("supradma_out %d, csr=%02x\n", len, *dev->sci_bus_csr));
    285  1.1  chopps 
    286  1.1  chopps 	QPRINTF(("supradma_out {%d} %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
    287  1.1  chopps   	 len, buf[0], buf[1], buf[2], buf[3], buf[4], buf[5],
    288  1.1  chopps 	 buf[6], buf[7], buf[8], buf[9]));
    289  1.1  chopps 
    290  1.1  chopps 	*dev->sci_tcmd = phase;
    291  1.1  chopps 	*dev->sci_mode = SCI_MODE_DMA;
    292  1.1  chopps 	*dev->sci_icmd = SCI_ICMD_DATA;
    293  1.1  chopps 	*dev->sci_dma_send = 0;
    294  1.1  chopps 	while (len > 0) {
    295  1.1  chopps 		wait = sci_data_wait;
    296  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    297  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    298  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    299  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    300  1.1  chopps 			  || --wait < 0) {
    301  1.1  chopps #ifdef DEBUG
    302  1.1  chopps 				if (sci_debug)
    303  1.1  chopps 					printf("supradma_out fail: l%d i%x w%d\n",
    304  1.1  chopps 					len, csr, wait);
    305  1.1  chopps #endif
    306  1.1  chopps 				*dev->sci_mode = 0;
    307  1.1  chopps 				return 0;
    308  1.1  chopps 			}
    309  1.1  chopps 		}
    310  1.1  chopps 
    311  1.1  chopps 		*sci_dma = *buf++;
    312  1.1  chopps 		len--;
    313  1.1  chopps 	}
    314  1.1  chopps 
    315  1.1  chopps 	wait = sci_data_wait;
    316  1.1  chopps 	while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) ==
    317  1.1  chopps 	  SCI_CSR_PHASE_MATCH && --wait);
    318  1.1  chopps 
    319  1.1  chopps 
    320  1.1  chopps 	*dev->sci_mode = 0;
    321  1.1  chopps 	*dev->sci_icmd = 0;
    322  1.1  chopps 	return 0;
    323  1.1  chopps }
    324  1.1  chopps 
    325  1.1  chopps 
    326  1.2  chopps int
    327  1.2  chopps wstsc_dma_xfer_in2 (dev, len, buf, phase)
    328  1.1  chopps 	struct sci_softc *dev;
    329  1.1  chopps 	int len;
    330  1.1  chopps 	register u_short *buf;
    331  1.1  chopps 	int phase;
    332  1.1  chopps {
    333  1.1  chopps 	int wait = sci_data_wait;
    334  1.1  chopps 	u_char csr;
    335  1.1  chopps 	u_char *obp = (u_char *) buf;
    336  1.1  chopps 	volatile register u_short *sci_dma = (u_short *)(dev->sci_idata + 0x10);
    337  1.1  chopps 	volatile register u_char *sci_csr = dev->sci_csr + 0x10;
    338  1.1  chopps 
    339  1.1  chopps 	QPRINTF(("supradma_in2 %d, csr=%02x\n", len, *dev->sci_bus_csr));
    340  1.1  chopps 
    341  1.1  chopps 	*dev->sci_tcmd = phase;
    342  1.1  chopps 	*dev->sci_mode = SCI_MODE_DMA;
    343  1.1  chopps 	*dev->sci_icmd = 0;
    344  1.1  chopps 	*(dev->sci_irecv + 16) = 0;
    345  1.1  chopps 	while (len >= 128) {
    346  1.1  chopps #if 0
    347  1.1  chopps 		wait = sci_data_wait;
    348  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    349  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    350  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    351  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    352  1.1  chopps 			  || --wait < 0) {
    353  1.1  chopps #ifdef DEBUG
    354  1.1  chopps 				if (sci_debug | 1)
    355  1.1  chopps 					printf("supradma2_in2 fail: l%d i%x w%d\n",
    356  1.1  chopps 					len, *dev->sci_bus_csr, wait);
    357  1.1  chopps #endif
    358  1.1  chopps 				*dev->sci_mode &= ~SCI_MODE_DMA;
    359  1.1  chopps 				return 0;
    360  1.1  chopps 			}
    361  1.1  chopps 		}
    362  1.1  chopps #else
    363  1.1  chopps 		while (!(*sci_csr & SCI_CSR_DREQ))
    364  1.1  chopps 			;
    365  1.1  chopps #endif
    366  1.1  chopps 
    367  1.3  chopps #define R2	(*buf++ = *sci_dma)
    368  1.3  chopps 		R2; R2; R2; R2; R2; R2; R2; R2;
    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.1  chopps 		len -= 128;
    377  1.1  chopps 	}
    378  1.1  chopps 	while (len > 0) {
    379  1.1  chopps #if 0
    380  1.1  chopps 		wait = sci_data_wait;
    381  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    382  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    383  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    384  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    385  1.1  chopps 			  || --wait < 0) {
    386  1.1  chopps #ifdef DEBUG
    387  1.1  chopps 				if (sci_debug | 1)
    388  1.1  chopps 					printf("supradma1_in2 fail: l%d i%x w%d\n",
    389  1.1  chopps 					len, *dev->sci_bus_csr, wait);
    390  1.1  chopps #endif
    391  1.1  chopps 				*dev->sci_mode &= ~SCI_MODE_DMA;
    392  1.1  chopps 				return 0;
    393  1.1  chopps 			}
    394  1.1  chopps 		}
    395  1.1  chopps #else
    396  1.1  chopps 		while (!(*sci_csr * SCI_CSR_DREQ))
    397  1.1  chopps 			;
    398  1.1  chopps #endif
    399  1.1  chopps 
    400  1.1  chopps 		*buf++ = *sci_dma;
    401  1.1  chopps 		len -= 2;
    402  1.1  chopps 	}
    403  1.1  chopps 
    404  1.1  chopps 	QPRINTF(("supradma_in2 {%d} %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
    405  1.1  chopps 	  len, obp[0], obp[1], obp[2], obp[3], obp[4], obp[5],
    406  1.1  chopps 	  obp[6], obp[7], obp[8], obp[9]));
    407  1.1  chopps 
    408  1.1  chopps 	*dev->sci_irecv = 0;
    409  1.1  chopps 	*dev->sci_mode = 0;
    410  1.1  chopps 	return 0;
    411  1.1  chopps }
    412  1.1  chopps 
    413  1.2  chopps int
    414  1.2  chopps wstsc_dma_xfer_out2 (dev, len, buf, phase)
    415  1.1  chopps 	struct sci_softc *dev;
    416  1.1  chopps 	int len;
    417  1.1  chopps 	register u_short *buf;
    418  1.1  chopps 	int phase;
    419  1.1  chopps {
    420  1.1  chopps 	int wait = sci_data_wait;
    421  1.1  chopps 	u_char csr;
    422  1.1  chopps 	u_char *obp = (u_char *) buf;
    423  1.1  chopps 	volatile register u_short *sci_dma = (ushort *)(dev->sci_data + 0x10);
    424  1.1  chopps 	volatile register u_char *sci_bus_csr = dev->sci_bus_csr;
    425  1.1  chopps 
    426  1.1  chopps 	QPRINTF(("supradma_out2 %d, csr=%02x\n", len, *dev->sci_bus_csr));
    427  1.1  chopps 
    428  1.1  chopps 	QPRINTF(("supradma_out2 {%d} %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
    429  1.1  chopps   	 len, obp[0], obp[1], obp[2], obp[3], obp[4], obp[5],
    430  1.1  chopps 	 obp[6], obp[7], obp[8], obp[9]));
    431  1.1  chopps 
    432  1.1  chopps 	*dev->sci_tcmd = phase;
    433  1.1  chopps 	*dev->sci_mode = SCI_MODE_DMA;
    434  1.1  chopps 	*dev->sci_icmd = SCI_ICMD_DATA;
    435  1.1  chopps 	*dev->sci_dma_send = 0;
    436  1.3  chopps 	while (len > 64) {
    437  1.3  chopps #if 0
    438  1.3  chopps 		wait = sci_data_wait;
    439  1.3  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    440  1.3  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    441  1.3  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    442  1.3  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    443  1.3  chopps 			  || --wait < 0) {
    444  1.3  chopps #ifdef DEBUG
    445  1.3  chopps 				if (sci_debug)
    446  1.3  chopps 					printf("supradma_out2 fail: l%d i%x w%d\n",
    447  1.3  chopps 					len, csr, wait);
    448  1.3  chopps #endif
    449  1.3  chopps 				*dev->sci_mode = 0;
    450  1.3  chopps 				return 0;
    451  1.3  chopps 			}
    452  1.3  chopps 		}
    453  1.3  chopps #else
    454  1.3  chopps 		*dev->sci_mode = 0;
    455  1.3  chopps 		*dev->sci_icmd &= ~SCI_ICMD_ACK;
    456  1.3  chopps 		while (!(*sci_bus_csr & SCI_BUS_REQ))
    457  1.3  chopps 			;
    458  1.3  chopps 		*dev->sci_mode = SCI_MODE_DMA;
    459  1.3  chopps 		*dev->sci_dma_send = 0;
    460  1.3  chopps #endif
    461  1.3  chopps 
    462  1.3  chopps #define W2	(*sci_dma = *buf++)
    463  1.3  chopps 		W2; W2; W2; W2; W2; W2; W2; W2;
    464  1.3  chopps 		W2; W2; W2; W2; W2; W2; W2; W2;
    465  1.3  chopps 		if (*(sci_bus_csr + 0x10) & SCI_BUS_REQ)
    466  1.3  chopps 			;
    467  1.3  chopps 		len -= 64;
    468  1.3  chopps 	}
    469  1.3  chopps 
    470  1.1  chopps 	while (len > 0) {
    471  1.1  chopps #if 0
    472  1.1  chopps 		wait = sci_data_wait;
    473  1.1  chopps 		while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) !=
    474  1.1  chopps 		  (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) {
    475  1.1  chopps 			if (!(*sci_csr & SCI_CSR_PHASE_MATCH)
    476  1.1  chopps 			  || !(*dev->sci_bus_csr & SCI_BUS_BSY)
    477  1.1  chopps 			  || --wait < 0) {
    478  1.1  chopps #ifdef DEBUG
    479  1.1  chopps 				if (sci_debug)
    480  1.1  chopps 					printf("supradma_out2 fail: l%d i%x w%d\n",
    481  1.1  chopps 					len, csr, wait);
    482  1.1  chopps #endif
    483  1.1  chopps 				*dev->sci_mode = 0;
    484  1.1  chopps 				return 0;
    485  1.1  chopps 			}
    486  1.1  chopps 		}
    487  1.1  chopps #else
    488  1.1  chopps 		*dev->sci_mode = 0;
    489  1.1  chopps 		*dev->sci_icmd &= ~SCI_ICMD_ACK;
    490  1.1  chopps 		while (!(*sci_bus_csr & SCI_BUS_REQ))
    491  1.1  chopps 			;
    492  1.1  chopps 		*dev->sci_mode = SCI_MODE_DMA;
    493  1.1  chopps 		*dev->sci_dma_send = 0;
    494  1.1  chopps #endif
    495  1.1  chopps 
    496  1.3  chopps 		*sci_dma = *buf++;
    497  1.1  chopps 		if (*(sci_bus_csr + 0x10) & SCI_BUS_REQ)
    498  1.1  chopps 			;
    499  1.3  chopps 		len -= 2;
    500  1.1  chopps 	}
    501  1.1  chopps 
    502  1.1  chopps #if 0
    503  1.1  chopps 	wait = sci_data_wait;
    504  1.1  chopps 	while ((*sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) ==
    505  1.1  chopps 	  SCI_CSR_PHASE_MATCH && --wait);
    506  1.1  chopps #endif
    507  1.1  chopps 
    508  1.1  chopps 
    509  1.1  chopps 	*dev->sci_irecv = 0;
    510  1.1  chopps 	*dev->sci_icmd &= ~SCI_ICMD_ACK;
    511  1.1  chopps 	*dev->sci_mode = 0;
    512  1.1  chopps 	*dev->sci_icmd = 0;
    513  1.1  chopps 	return 0;
    514  1.1  chopps }
    515  1.1  chopps 
    516  1.2  chopps int
    517  1.2  chopps wstsc_intr()
    518  1.2  chopps {
    519  1.1  chopps 	struct sci_softc *dev;
    520  1.2  chopps 	int i, found;
    521  1.2  chopps 	u_char stat;
    522  1.2  chopps 
    523  1.2  chopps 	found = 0;
    524  1.2  chopps 	for (i = 0; i < wstsccd.cd_ndevs; i++) {
    525  1.2  chopps 		dev = wstsccd.cd_devs[i];
    526  1.2  chopps 		if (dev == NULL)
    527  1.2  chopps 			continue;
    528  1.2  chopps 		if ((*(dev->sci_csr + 0x10) & SCI_CSR_INT) == 0)
    529  1.2  chopps 			continue;
    530  1.2  chopps 		++found;
    531  1.2  chopps 		stat = *(dev->sci_iack + 0x10);
    532  1.1  chopps 	}
    533  1.2  chopps 	return (found);
    534  1.1  chopps }
    535