Home | History | Annotate | Line # | Download | only in dev
scsi_1185.c revision 1.13
      1  1.13      agc /*	$NetBSD: scsi_1185.c,v 1.13 2003/08/07 16:28:52 agc Exp $	*/
      2   1.3   tsubai 
      3   1.1   tsubai /*
      4   1.1   tsubai  * Copyright (c) 1992, 1993
      5   1.1   tsubai  *	The Regents of the University of California.  All rights reserved.
      6   1.1   tsubai  *
      7   1.1   tsubai  * This code is derived from software contributed to Berkeley by
      8   1.1   tsubai  * Sony Corp. and Kazumasa Utashiro of Software Research Associates, Inc.
      9   1.1   tsubai  *
     10   1.1   tsubai  * Redistribution and use in source and binary forms, with or without
     11   1.1   tsubai  * modification, are permitted provided that the following conditions
     12   1.1   tsubai  * are met:
     13   1.1   tsubai  * 1. Redistributions of source code must retain the above copyright
     14   1.1   tsubai  *    notice, this list of conditions and the following disclaimer.
     15   1.1   tsubai  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1   tsubai  *    notice, this list of conditions and the following disclaimer in the
     17   1.1   tsubai  *    documentation and/or other materials provided with the distribution.
     18  1.13      agc  * 3. Neither the name of the University nor the names of its contributors
     19   1.1   tsubai  *    may be used to endorse or promote products derived from this software
     20   1.1   tsubai  *    without specific prior written permission.
     21   1.1   tsubai  *
     22   1.1   tsubai  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     23   1.1   tsubai  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     24   1.1   tsubai  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     25   1.1   tsubai  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     26   1.1   tsubai  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     27   1.1   tsubai  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     28   1.1   tsubai  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     29   1.1   tsubai  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     30   1.1   tsubai  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     31   1.1   tsubai  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     32   1.1   tsubai  * SUCH DAMAGE.
     33   1.1   tsubai  *
     34   1.1   tsubai  * from: $Hdr: scsi_1185.c,v 4.300 91/06/09 06:22:20 root Rel41 $ SONY
     35   1.1   tsubai  *
     36   1.1   tsubai  *	@(#)scsi_1185.c	8.1 (Berkeley) 6/11/93
     37   1.1   tsubai  */
     38   1.1   tsubai 
     39   1.1   tsubai /*
     40   1.1   tsubai  * Copyright (c) 1989- by SONY Corporation.
     41   1.4   tsubai  *
     42   1.1   tsubai  *	scsi_1185.c
     43   1.1   tsubai  *
     44   1.1   tsubai  *	CXD1185Q
     45   1.1   tsubai  *	SCSI bus low level common routines
     46   1.1   tsubai  *				for one cpu machine
     47   1.4   tsubai  *
     48   1.1   tsubai  * MODIFY HISTORY:
     49   1.1   tsubai  *
     50   1.1   tsubai  *	DMAC_WAIT	--- DMAC_0266 wo tukau-baai, DMAC mata-wa SCSI-chip ni
     51   1.1   tsubai  *				tuzukete access suru-baai,
     52   1.1   tsubai  *				kanarazu wait wo ireru-beshi !
     53   1.1   tsubai  */
     54  1.12    lukem 
     55  1.12    lukem #include <sys/cdefs.h>
     56  1.13      agc __KERNEL_RCSID(0, "$NetBSD: scsi_1185.c,v 1.13 2003/08/07 16:28:52 agc Exp $");
     57   1.1   tsubai 
     58   1.1   tsubai #include <sys/param.h>
     59   1.1   tsubai #include <sys/systm.h>
     60   1.4   tsubai #include <sys/device.h>
     61   1.4   tsubai 
     62  1.10  thorpej #include <uvm/uvm_extern.h>
     63  1.10  thorpej 
     64   1.4   tsubai #include <dev/scsipi/scsi_all.h>
     65   1.4   tsubai #include <dev/scsipi/scsipi_all.h>
     66   1.4   tsubai #include <dev/scsipi/scsiconf.h>
     67   1.1   tsubai 
     68   1.1   tsubai #include <machine/cpu.h>
     69   1.4   tsubai #include <machine/intr.h>
     70   1.4   tsubai #include <machine/machConst.h>
     71   1.1   tsubai 
     72   1.8  thorpej #include <mips/cache.h>
     73   1.8  thorpej 
     74   1.2  thorpej #include <newsmips/dev/screg_1185.h>
     75   1.4   tsubai #include <newsmips/dev/scsireg.h>
     76   1.1   tsubai 
     77   1.4   tsubai #if defined(news3400)
     78   1.2  thorpej # include <newsmips/dev/dmac_0448.h>
     79   1.1   tsubai # ifndef NDMACMAP
     80   1.4   tsubai # define NDMACMAP 144
     81   1.1   tsubai # endif
     82   1.1   tsubai #endif
     83   1.1   tsubai 
     84   1.1   tsubai #define VOLATILE volatile
     85   1.1   tsubai #define ABORT_SYNCTR_MES_FROM_TARGET
     86   1.1   tsubai #define SCSI_1185AQ
     87   1.1   tsubai #define RESET_RECOVER
     88   1.1   tsubai #define DMAC_MAP_INIT			/* for nws-3700 parity error */
     89   1.1   tsubai #define APAD_ALWAYS_ON
     90   1.1   tsubai 
     91   1.4   tsubai #define CHECK_LOOP_CNT	60
     92   1.4   tsubai #define RSL_LOOP_CNT	60
     93   1.1   tsubai 
     94   1.1   tsubai #ifndef DMAC_MAP_INIT
     95   1.1   tsubai # define MAP_OVER_ACCESS		/* for nws-3700 parity error */
     96   1.1   tsubai #endif
     97   1.1   tsubai 
     98   1.1   tsubai #undef	CHECK_MRQ
     99   1.1   tsubai 
    100   1.1   tsubai #ifdef NOT_SUPPORT_SYNCTR
    101   1.4   tsubai # define MAX_OFFSET_BYTES 0
    102   1.1   tsubai #else
    103   1.4   tsubai # define MAX_OFFSET_BYTES MAX_OFFSET
    104   1.1   tsubai #endif
    105   1.1   tsubai 
    106   1.1   tsubai #define	act_point	spoint
    107   1.1   tsubai #define	act_trcnt	stcnt
    108   1.1   tsubai #define	act_tag		stag
    109   1.1   tsubai #define	act_offset	soffset
    110   1.1   tsubai 
    111   1.4   tsubai #define	splscsi splsc
    112   1.1   tsubai 
    113   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
    114   1.1   tsubai #define nops(x)		{ int i; for (i = 0; i < (x); i++) ; }
    115   1.1   tsubai #define	DMAC_WAIT0	;
    116   1.1   tsubai #else
    117   1.1   tsubai #define	DMAC_WAIT0	DMAC_WAIT
    118   1.1   tsubai #endif
    119   1.1   tsubai 
    120   1.1   tsubai #ifdef DMAC_MAP_INIT
    121   1.4   tsubai static int dmac_map_init = 0;
    122   1.1   tsubai #endif
    123   1.1   tsubai 
    124   1.1   tsubai /*
    125   1.1   tsubai  *	command flag status
    126   1.1   tsubai  */
    127   1.1   tsubai #define	CF_SET		1
    128   1.1   tsubai #define	CF_SEND		2
    129   1.1   tsubai #define	CF_ENOUGH	3
    130   1.1   tsubai #define	CF_EXEC		4
    131   1.1   tsubai 
    132   1.4   tsubai #define	SEL_TIMEOUT_VALUE 0x7a
    133   1.1   tsubai 
    134   1.4   tsubai extern struct cfdriver sc_cd;
    135   1.1   tsubai 
    136   1.4   tsubai void sc_send __P((struct sc_scb *, int, int));
    137   1.4   tsubai int scintr __P((void));
    138   1.4   tsubai void scsi_hardreset __P((void));
    139   1.4   tsubai void scsi_chipreset __P((struct sc_softc *));
    140   1.4   tsubai void scsi_softreset __P((struct sc_softc *));
    141   1.4   tsubai int sc_busy __P((struct sc_softc *, int));
    142   1.1   tsubai 
    143   1.1   tsubai static int WAIT_STATR_BITCLR __P((int));
    144   1.1   tsubai static int WAIT_STATR_BITSET __P((int));
    145   1.4   tsubai static void SET_CMD __P((struct sc_softc *, int));
    146   1.1   tsubai static void SET_CNT __P((int));
    147   1.1   tsubai static int GET_CNT __P((void));
    148   1.1   tsubai static void GET_INTR __P((VOLATILE int *, VOLATILE int *));
    149   1.4   tsubai static void sc_start __P((struct sc_softc *));
    150   1.4   tsubai static void sc_resel __P((struct sc_softc *));
    151   1.4   tsubai static void sc_discon __P((struct sc_softc *));
    152   1.4   tsubai static void sc_pmatch __P((struct sc_softc *));
    153   1.4   tsubai static void flush_fifo __P((struct sc_softc *));
    154   1.4   tsubai static void sc_cout __P((struct sc_softc *, struct sc_chan_stat *));
    155   1.4   tsubai static void sc_min __P((struct sc_softc *, struct sc_chan_stat *));
    156   1.4   tsubai static void sc_mout __P((struct sc_softc *, struct sc_chan_stat *));
    157   1.4   tsubai static void sc_sin __P((struct sc_softc *, VOLATILE struct sc_chan_stat *));
    158   1.4   tsubai static void sc_dio __P((struct sc_softc *, VOLATILE struct sc_chan_stat *));
    159   1.4   tsubai static void sc_dio_pad __P((struct sc_softc *, VOLATILE struct sc_chan_stat *));
    160   1.4   tsubai static void print_scsi_stat __P((struct sc_softc *));
    161   1.4   tsubai static void append_wb __P((struct sc_softc *, struct sc_chan_stat *));
    162   1.4   tsubai static struct sc_chan_stat *get_wb_chan __P((struct sc_softc *));
    163   1.4   tsubai static int release_wb __P((struct sc_softc *));
    164   1.4   tsubai static void adjust_transfer __P((struct sc_softc *, struct sc_chan_stat *));
    165   1.4   tsubai static void clean_k2dcache __P((struct sc_scb *));
    166   1.1   tsubai 
    167   1.4   tsubai extern void sc_done __P((struct sc_scb *));
    168   1.5   tsubai extern paddr_t kvtophys __P((vaddr_t));
    169   1.1   tsubai 
    170   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
    171   1.3   tsubai #define dma_reset(x) {						\
    172   1.3   tsubai 	int s = splscsi();					\
    173   1.3   tsubai 	dmac_gsel = (x); dmac_cctl = DM_RST; dmac_cctl = 0;	\
    174   1.3   tsubai 	splx(s);						\
    175   1.1   tsubai }
    176   1.1   tsubai #endif
    177   1.1   tsubai 
    178   1.1   tsubai int
    179   1.1   tsubai WAIT_STATR_BITCLR(bitmask)
    180   1.1   tsubai 	register int bitmask;
    181   1.1   tsubai {
    182   1.1   tsubai 	register int iloop;
    183   1.1   tsubai 	register VOLATILE int dummy;
    184   1.1   tsubai 
    185   1.1   tsubai 	iloop = 0;
    186   1.1   tsubai 	do {
    187   1.1   tsubai 		dummy = sc_statr;
    188   1.1   tsubai 		DMAC_WAIT0;
    189   1.1   tsubai 		if (iloop++ > CHECK_LOOP_CNT)
    190   1.1   tsubai 			return (-1);
    191   1.1   tsubai 	} while (dummy & bitmask);
    192   1.1   tsubai 	return (0);
    193   1.1   tsubai }
    194   1.1   tsubai 
    195   1.1   tsubai int
    196   1.1   tsubai WAIT_STATR_BITSET(bitmask)
    197   1.1   tsubai 	register int bitmask;
    198   1.1   tsubai {
    199   1.1   tsubai 	register int iloop;
    200   1.1   tsubai 	register VOLATILE int dummy;
    201   1.1   tsubai 
    202   1.1   tsubai 	iloop = 0;
    203   1.1   tsubai 	do {
    204   1.1   tsubai 		dummy = sc_statr;
    205   1.1   tsubai 		DMAC_WAIT0;
    206   1.1   tsubai 		if (iloop++ > CHECK_LOOP_CNT)
    207   1.1   tsubai 			return (-1);
    208   1.1   tsubai 	} while ((dummy & bitmask) == 0);
    209   1.1   tsubai 	return (0);
    210   1.1   tsubai }
    211   1.1   tsubai 
    212   1.1   tsubai void
    213   1.4   tsubai SET_CMD(sc, CMD)
    214   1.4   tsubai 	struct sc_softc *sc;
    215   1.1   tsubai 	register int CMD;
    216   1.1   tsubai {
    217   1.1   tsubai 	(void) WAIT_STATR_BITCLR(R0_CIP);
    218   1.4   tsubai 	sc->lastcmd = (CMD);
    219   1.1   tsubai 	sc_comr = (CMD);
    220   1.1   tsubai 	DMAC_WAIT0;
    221   1.1   tsubai }
    222   1.1   tsubai 
    223   1.1   tsubai void
    224   1.1   tsubai SET_CNT(COUNT)
    225   1.1   tsubai 	register int COUNT;
    226   1.1   tsubai {
    227   1.1   tsubai 	sc_tclow = (COUNT) & 0xff;
    228   1.1   tsubai 	DMAC_WAIT0;
    229   1.1   tsubai 	sc_tcmid = ((COUNT) >> 8) & 0xff;
    230   1.1   tsubai 	DMAC_WAIT0;
    231   1.1   tsubai 	sc_tchi = ((COUNT) >> 16) & 0xff;
    232   1.1   tsubai 	DMAC_WAIT0;
    233   1.1   tsubai }
    234   1.1   tsubai 
    235   1.1   tsubai int
    236   1.1   tsubai GET_CNT()
    237   1.1   tsubai {
    238   1.1   tsubai 	register VOLATILE int COUNT;
    239   1.1   tsubai 
    240   1.1   tsubai 	COUNT = sc_tclow;
    241   1.1   tsubai 	DMAC_WAIT0;
    242   1.1   tsubai 	COUNT += (sc_tcmid << 8) & 0xff00;
    243   1.1   tsubai 	DMAC_WAIT0;
    244   1.1   tsubai 	COUNT += (sc_tchi << 16) & 0xff0000;
    245   1.1   tsubai 	DMAC_WAIT0;
    246   1.1   tsubai 	return (COUNT);
    247   1.1   tsubai }
    248   1.1   tsubai 
    249   1.1   tsubai void
    250   1.1   tsubai GET_INTR(DATA1, DATA2)
    251   1.1   tsubai 	register VOLATILE int *DATA1;
    252   1.1   tsubai 	register VOLATILE int *DATA2;
    253   1.1   tsubai {
    254   1.1   tsubai 	(void) WAIT_STATR_BITCLR(R0_CIP);
    255   1.1   tsubai 	while (sc_statr & R0_MIRQ) {
    256   1.1   tsubai 		DMAC_WAIT0;
    257   1.1   tsubai 		*DATA1 |= sc_intrq1;
    258   1.1   tsubai 		DMAC_WAIT0;
    259   1.1   tsubai 		*DATA2 |= sc_intrq2;
    260   1.1   tsubai 		DMAC_WAIT0;
    261   1.1   tsubai 	}
    262   1.1   tsubai }
    263   1.1   tsubai 
    264   1.1   tsubai 
    265   1.1   tsubai void
    266   1.4   tsubai sc_send(scb, chan, ie)
    267   1.4   tsubai 	struct sc_scb *scb;
    268   1.4   tsubai 	int chan, ie;
    269   1.4   tsubai {
    270   1.4   tsubai 	struct sc_softc *sc = scb->scb_softc;
    271   1.4   tsubai 	struct sc_chan_stat *cs;
    272   1.4   tsubai 	struct scsipi_xfer *xs;
    273   1.4   tsubai 	int i;
    274   1.4   tsubai 	u_char *p;
    275   1.4   tsubai 
    276   1.4   tsubai 	cs = &sc->chan_stat[chan];
    277   1.4   tsubai 	xs = scb->xs;
    278   1.4   tsubai 
    279   1.4   tsubai 	p = (u_char *)xs->cmd;
    280   1.4   tsubai 	if (cs->scb != NULL) {
    281   1.4   tsubai 		printf("SCSI%d: sc_send() NOT NULL cs->sc\n", chan);
    282   1.4   tsubai 		printf("ie=0x%x scb=0x%p cs->sc=0x%p\n", ie, scb, cs->scb);
    283   1.4   tsubai 		printf("cdb=");
    284   1.4   tsubai 		for (i = 0; i < 6; i++)
    285   1.4   tsubai 			printf(" 0x%x", *p++);
    286   1.4   tsubai 		printf("\n");
    287   1.4   tsubai 		panic("SCSI soft error");
    288   1.1   tsubai 		/*NOTREACHED*/
    289   1.1   tsubai 	}
    290   1.1   tsubai 
    291   1.4   tsubai 	if (p[0] == SCOP_RESET && p[1] == SCOP_RESET) {
    292   1.1   tsubai 		/*
    293   1.1   tsubai 		 * SCSI bus reset command procedure
    294   1.1   tsubai 		 *	(vender unique by Sony Corp.)
    295   1.1   tsubai 		 */
    296   1.1   tsubai #ifdef SCSI_1185AQ
    297   1.4   tsubai 		if (sc_idenr & 0x08)
    298   1.4   tsubai 			sc->scsi_1185AQ = 1;
    299   1.4   tsubai 		else
    300   1.4   tsubai 			sc->scsi_1185AQ = 0;
    301   1.1   tsubai #endif
    302   1.4   tsubai 		cs->scb = scb;
    303   1.1   tsubai 		scsi_hardreset();
    304   1.4   tsubai 		scb->istatus = INST_EP;
    305   1.4   tsubai 		cs->scb = NULL;
    306   1.4   tsubai 		sc_done(scb);
    307   1.1   tsubai 		return;
    308   1.1   tsubai 	}
    309   1.1   tsubai 
    310   1.4   tsubai 	if (scb->sc_map && (scb->sc_map->mp_pages > 0)) {
    311   1.1   tsubai 		/*
    312   1.1   tsubai 		 * use map table
    313   1.1   tsubai 		 */
    314   1.4   tsubai 		scb->sc_coffset = scb->sc_map->mp_offset & PGOFSET;
    315   1.4   tsubai 		if (scb->sc_map->mp_pages > NSCMAP) {
    316   1.1   tsubai 			printf("SCSI%d: map table overflow\n", chan);
    317   1.4   tsubai 			scb->istatus = INST_EP|INST_LB|INST_PRE;
    318   1.1   tsubai 			return;
    319   1.1   tsubai 		}
    320   1.1   tsubai 	} else {
    321   1.1   tsubai 		/*
    322   1.1   tsubai 		 * no use map table
    323   1.1   tsubai 		 */
    324   1.4   tsubai 		scb->sc_coffset = (u_int)scb->sc_cpoint & PGOFSET;
    325   1.1   tsubai 	}
    326   1.4   tsubai 	scb->sc_ctag = 0;
    327   1.1   tsubai 
    328   1.4   tsubai 	cs->scb = scb;
    329   1.1   tsubai 	cs->comflg = OFF;
    330   1.1   tsubai 
    331   1.1   tsubai 	cs->intr_flg = ie;
    332   1.1   tsubai 	cs->chan_num = chan;
    333   1.4   tsubai 	sc->perr_flag[chan] = 0;
    334   1.4   tsubai 	sc->mout_flag[chan] = 0;
    335   1.4   tsubai 	sc->min_cnt[chan] = 0;
    336   1.4   tsubai 
    337   1.4   tsubai 	sc->sel_stat[chan] = SEL_WAIT;
    338   1.4   tsubai 	append_wb(sc, cs);
    339   1.4   tsubai 	sc_start(sc);
    340   1.1   tsubai }
    341   1.1   tsubai 
    342   1.1   tsubai /*
    343   1.1   tsubai  *	SCSI start up routine
    344   1.1   tsubai  */
    345   1.1   tsubai void
    346   1.4   tsubai sc_start(sc)
    347   1.4   tsubai 	struct sc_softc *sc;
    348   1.1   tsubai {
    349   1.4   tsubai 	struct sc_chan_stat *cs;
    350   1.4   tsubai 	int chan, dummy;
    351   1.4   tsubai 	int s;
    352   1.1   tsubai 
    353   1.4   tsubai 	s = splscsi();
    354   1.4   tsubai 	cs = get_wb_chan(sc);
    355   1.4   tsubai 	if ((cs == NULL) || (sc->ipc >= 0))
    356   1.1   tsubai 		goto sc_start_exit;
    357   1.4   tsubai 	chan = cs->chan_num;
    358   1.4   tsubai 	if (sc->sel_stat[chan] != SEL_WAIT) {
    359   1.1   tsubai 		/*
    360   1.1   tsubai 		 * already started
    361   1.1   tsubai 		 */
    362   1.1   tsubai 		goto sc_start_exit;
    363   1.1   tsubai 	}
    364   1.4   tsubai 	sc->sel_stat[chan] = SEL_START;
    365   1.1   tsubai 
    366   1.1   tsubai 	dummy = sc_cmonr;
    367   1.1   tsubai 	DMAC_WAIT0;
    368   1.1   tsubai 	if (dummy & (R4_MBSY|R4_MSEL)) {
    369   1.4   tsubai 		sc->sel_stat[chan] = SEL_WAIT;
    370   1.1   tsubai 		goto sc_start_exit;
    371   1.1   tsubai 	}
    372   1.1   tsubai 
    373   1.1   tsubai 	/*
    374   1.1   tsubai 	 *	send SELECT with ATN command
    375   1.1   tsubai 	 */
    376   1.4   tsubai 	sc->dma_stat = OFF;
    377   1.4   tsubai 	sc->pad_start = 0;
    378   1.1   tsubai 	dummy = sc_statr;
    379   1.1   tsubai 	DMAC_WAIT0;
    380   1.1   tsubai 	if (dummy & R0_CIP) {
    381   1.4   tsubai 		sc->sel_stat[chan] = SEL_WAIT;
    382   1.1   tsubai 		goto sc_start_exit;
    383   1.1   tsubai 	}
    384   1.1   tsubai 	sc_idenr = (chan << SC_TG_SHIFT) | SC_OWNID;
    385   1.1   tsubai 	DMAC_WAIT0;
    386   1.1   tsubai #ifdef SCSI_1185AQ
    387   1.4   tsubai 	if (sc->scsi_1185AQ)
    388   1.1   tsubai 		sc_intok1 = Ra_STO|Ra_ARBF;
    389   1.1   tsubai 	else
    390   1.1   tsubai 		sc_intok1 = Ra_STO|Ra_RSL|Ra_ARBF;
    391   1.1   tsubai #else
    392   1.1   tsubai 	sc_intok1 = Ra_STO|Ra_RSL|Ra_ARBF;
    393   1.1   tsubai #endif
    394   1.1   tsubai 	DMAC_WAIT0;
    395   1.1   tsubai 	/*
    396   1.1   tsubai 	 * BUGFIX for signal reflection on BSY
    397   1.1   tsubai 	 *	!Rb_DCNT
    398   1.1   tsubai 	 */
    399   1.1   tsubai 	sc_intok2 = Rb_FNC|Rb_SRST|Rb_PHC|Rb_SPE;
    400   1.1   tsubai 	DMAC_WAIT0;
    401   1.1   tsubai 
    402   1.1   tsubai 	dummy = sc_cmonr;
    403   1.1   tsubai 	DMAC_WAIT0;
    404   1.1   tsubai 	if (dummy & (R4_MBSY|R4_MSEL)) {
    405   1.4   tsubai 		sc->sel_stat[chan] = SEL_WAIT;
    406   1.1   tsubai 		goto sc_start_exit;
    407   1.1   tsubai 	}
    408   1.4   tsubai 	SET_CMD(sc, SCMD_SEL_ATN);
    409   1.1   tsubai 
    410   1.1   tsubai sc_start_exit:
    411   1.1   tsubai 	splx(s);
    412   1.1   tsubai }
    413   1.1   tsubai 
    414   1.1   tsubai /*
    415   1.1   tsubai  *	SCSI interrupt service routine
    416   1.1   tsubai  */
    417   1.1   tsubai int
    418   1.1   tsubai scintr()
    419   1.1   tsubai {
    420   1.1   tsubai 	register int iloop;
    421   1.1   tsubai 	register VOLATILE int chan;
    422   1.1   tsubai 	register VOLATILE int dummy;
    423   1.4   tsubai 	struct sc_softc *sc;
    424   1.4   tsubai 	struct sc_chan_stat *cs;
    425   1.1   tsubai 	int s_int1, s_int2;
    426   1.1   tsubai 
    427   1.4   tsubai 	sc = sc_cd.cd_devs[0];					/* XXX */
    428   1.4   tsubai 
    429   1.1   tsubai scintr_loop:
    430   1.1   tsubai 
    431   1.1   tsubai #if defined(CHECK_MRQ) && defined(news3400)
    432   1.1   tsubai 	while (dmac_gstat & CH_MRQ(CH_SCSI))
    433   1.1   tsubai 		DMAC_WAIT;
    434   1.1   tsubai #endif
    435   1.1   tsubai 
    436   1.1   tsubai 	for (iloop = 0; iloop < 100; iloop++) {
    437   1.1   tsubai 		dummy = sc_statr;
    438   1.1   tsubai 		DMAC_WAIT;
    439   1.1   tsubai 		if ((dummy & R0_CIP) == 0)
    440   1.1   tsubai 			break;
    441   1.1   tsubai 	}
    442   1.1   tsubai 
    443   1.1   tsubai 	/*
    444   1.1   tsubai 	 * get SCSI interrupt request
    445   1.1   tsubai 	 */
    446   1.1   tsubai 	while (sc_statr & R0_MIRQ) {
    447   1.1   tsubai 		DMAC_WAIT0;
    448   1.1   tsubai 		s_int1 = sc_intrq1;
    449   1.1   tsubai 		DMAC_WAIT0;
    450   1.1   tsubai 		s_int2 = sc_intrq2;
    451   1.1   tsubai 		DMAC_WAIT0;
    452   1.4   tsubai 		sc->int_stat1 |= s_int1;
    453   1.4   tsubai 		sc->int_stat2 |= s_int2;
    454   1.1   tsubai 	}
    455   1.1   tsubai 
    456   1.4   tsubai 	if (sc->int_stat2 & R3_SRST) {
    457   1.1   tsubai 		/*
    458   1.1   tsubai 		 * RST signal is drived
    459   1.1   tsubai 		 */
    460   1.4   tsubai 		sc->int_stat2 &= ~R3_SRST;
    461   1.4   tsubai 		scsi_softreset(sc);
    462   1.1   tsubai 		goto scintr_exit;
    463   1.1   tsubai 	}
    464   1.1   tsubai 
    465   1.4   tsubai 	if ((sc->ipc < 0) && (sc->wrc <= 0) && (sc->wbc <= 0)) {
    466   1.4   tsubai 		sc->int_stat1 = 0;
    467   1.4   tsubai 		sc->int_stat2 = 0;
    468   1.1   tsubai 		goto scintr_exit;
    469   1.1   tsubai 	}
    470   1.1   tsubai 
    471   1.4   tsubai 	cs = get_wb_chan(sc);
    472   1.4   tsubai 	if (cs) chan = cs->chan_num;
    473   1.4   tsubai 
    474   1.4   tsubai 	if (cs && (sc->sel_stat[chan] == SEL_START) &&
    475   1.4   tsubai 		(sc->lastcmd == SCMD_SEL_ATN)) {
    476   1.1   tsubai 		/*
    477   1.1   tsubai 		 *	Check the result of SELECTION command
    478   1.1   tsubai 		 */
    479   1.4   tsubai 		if (sc->int_stat1 & R2_RSL) {
    480   1.1   tsubai 			/*
    481   1.1   tsubai 			 * RESELECTION occur
    482   1.1   tsubai 			 */
    483   1.4   tsubai 			if (sc->wrc > 0) {
    484   1.4   tsubai 				sc->sel_stat[chan] = SEL_RSLD;
    485   1.1   tsubai 			} else {
    486   1.1   tsubai 				/*
    487   1.1   tsubai 				 * Ghost RESELECTION ???
    488   1.1   tsubai 				 */
    489   1.4   tsubai 				sc->int_stat1 &= ~R2_RSL;
    490   1.1   tsubai 			}
    491   1.1   tsubai 		}
    492   1.4   tsubai 		if (sc->int_stat1 & R2_ARBF) {
    493   1.1   tsubai 			/*
    494   1.1   tsubai 			 * ARBITRATION fault
    495   1.1   tsubai 			 */
    496   1.4   tsubai 			sc->int_stat1 &= ~R2_ARBF;
    497   1.4   tsubai 			sc->sel_stat[chan] = SEL_ARBF;
    498   1.1   tsubai 		}
    499   1.4   tsubai 		if (sc->int_stat1 & R2_STO) {
    500   1.1   tsubai 			/*
    501   1.1   tsubai 			 * SELECTION timeout
    502   1.1   tsubai 			 */
    503   1.4   tsubai 			sc->int_stat1 &= ~R2_STO;
    504   1.4   tsubai 			if ((sc->int_stat2&(R3_PHC|R3_RMSG)) != (R3_PHC|R3_RMSG)) {
    505   1.4   tsubai 				sc->ipc = chan;
    506   1.4   tsubai 				sc->ip = &sc->chan_stat[chan];
    507   1.4   tsubai 				sc->sel_stat[chan] = SEL_TIMEOUT;
    508   1.4   tsubai 				sc->chan_stat[chan].scb->istatus
    509   1.1   tsubai 					= INST_EP|INST_TO;
    510   1.4   tsubai 				release_wb(sc);
    511   1.1   tsubai 			}
    512   1.1   tsubai 		}
    513   1.1   tsubai 
    514   1.1   tsubai 		/*
    515   1.1   tsubai 		 *	SELECTION command done
    516   1.1   tsubai 		 */
    517   1.4   tsubai 		switch (sc->sel_stat[chan]) {
    518   1.1   tsubai 
    519   1.1   tsubai 		case SEL_START:
    520   1.4   tsubai 			if ((sc->int_stat2 & R3_FNC) == 0)
    521   1.1   tsubai 				break;
    522   1.1   tsubai 			/*
    523   1.1   tsubai 			 * SELECTION success
    524   1.1   tsubai 			 */
    525   1.1   tsubai 			sc_intok2 = Rb_FNC|Rb_DCNT|Rb_SRST|Rb_PHC|Rb_SPE;
    526   1.4   tsubai 			sc->ipc = chan;
    527   1.4   tsubai 			sc->ip = &sc->chan_stat[chan];
    528   1.4   tsubai 			sc->ip->scb->istatus |= INST_IP;
    529   1.4   tsubai 			sc->dma_stat = OFF;
    530   1.4   tsubai 			sc->pad_start = 0;
    531   1.4   tsubai 			sc->sel_stat[chan] = SEL_SUCCESS;
    532   1.4   tsubai 			release_wb(sc);
    533   1.1   tsubai #ifndef NOT_SUPPORT_SYNCTR
    534   1.4   tsubai 			sc_syncr = sc->sync_tr[chan];
    535   1.1   tsubai 			DMAC_WAIT0;
    536   1.1   tsubai #endif
    537   1.1   tsubai 			DMAC_WAIT0;
    538   1.1   tsubai 			break;
    539   1.1   tsubai 
    540   1.1   tsubai 		case SEL_TIMEOUT:
    541   1.1   tsubai 			/*
    542   1.1   tsubai 			 * SELECTION time out
    543   1.1   tsubai 			 */
    544   1.4   tsubai 			sc_discon(sc);
    545   1.1   tsubai 			goto scintr_exit;
    546   1.1   tsubai 
    547   1.1   tsubai 		/* case SEL_RSLD: */
    548   1.1   tsubai 		/* case SEL_ARBF: */
    549   1.1   tsubai 		default:
    550   1.1   tsubai 			/*
    551   1.1   tsubai 			 * SELECTION failed
    552   1.1   tsubai 			 */
    553   1.4   tsubai 			sc->sel_stat[chan] = SEL_WAIT;
    554   1.1   tsubai 			break;
    555   1.1   tsubai 		}
    556   1.4   tsubai 		if ((sc->int_stat1 & R2_RSL) == 0)
    557   1.4   tsubai 			sc->int_stat2 &= ~R3_FNC;
    558   1.1   tsubai 	}
    559   1.1   tsubai 
    560   1.4   tsubai 	if (sc->ip != NULL) {
    561   1.1   tsubai 		/*
    562   1.1   tsubai 		 * check In Process channel's request
    563   1.1   tsubai 		 */
    564   1.4   tsubai 		if (sc->dma_stat != OFF) {
    565   1.1   tsubai 			/*
    566   1.1   tsubai 			 * adjust pointer & counter
    567   1.1   tsubai 			 */
    568   1.4   tsubai 			adjust_transfer(sc, sc->ip);
    569   1.1   tsubai 		}
    570   1.4   tsubai 		if (sc->int_stat2 & R3_SPE) {
    571   1.1   tsubai 			register int VOLATILE statr;
    572   1.1   tsubai 			register int VOLATILE cmonr;
    573   1.1   tsubai 
    574   1.1   tsubai 			statr = sc_statr;
    575   1.1   tsubai 			DMAC_WAIT0;
    576   1.1   tsubai 			cmonr = sc_cmonr;
    577   1.4   tsubai 			sc->int_stat2 &= ~R3_SPE;
    578   1.4   tsubai 			sc->perr_flag[sc->ip->chan_num] = 1;
    579   1.1   tsubai 		}
    580   1.1   tsubai 	}
    581   1.1   tsubai 
    582   1.4   tsubai 	if (sc->int_stat2 & R3_DCNT) {
    583   1.1   tsubai 		/*
    584   1.1   tsubai 		 * Bus Free
    585   1.1   tsubai 		 */
    586   1.4   tsubai 		sc_discon(sc);
    587   1.4   tsubai 		sc->int_stat2 &= ~R3_DCNT;
    588   1.1   tsubai 	}
    589   1.1   tsubai 
    590   1.4   tsubai 	if ((sc->ipc >= 0) && (sc->sel_stat[sc->ipc] == SEL_RSL_WAIT)) {
    591   1.4   tsubai 		sc->sel_stat[sc->ipc] = SEL_RSLD;
    592   1.4   tsubai 		sc->ipc = -1;
    593   1.4   tsubai 		sc->int_stat1 |= R2_RSL;
    594   1.1   tsubai 	}
    595   1.4   tsubai 	if (sc->int_stat1 & R2_RSL) {
    596   1.1   tsubai 		/*
    597   1.1   tsubai 		 * Reselection
    598   1.1   tsubai 		 */
    599   1.4   tsubai 		sc_resel(sc);
    600   1.4   tsubai 		sc->int_stat1 &= ~R2_RSL;
    601   1.4   tsubai 		if (sc->sel_stat[sc->ipc] == SEL_RSL_WAIT)
    602   1.1   tsubai 			goto scintr_exit;
    603   1.1   tsubai 	}
    604   1.1   tsubai 
    605   1.1   tsubai 
    606   1.4   tsubai 	if ((sc->ipc >= 0) && (sc->ipc != SC_OWNID) &&
    607   1.4   tsubai 	    (sc->sel_stat[sc->ipc] == SEL_SUCCESS)) {
    608   1.4   tsubai 		if (sc->int_stat2 & R3_PHC) {
    609   1.1   tsubai 			/*
    610   1.1   tsubai 			 * Phase change
    611   1.1   tsubai 			 */
    612   1.4   tsubai 			sc->int_stat2 &= ~(R3_PHC|R3_RMSG);
    613   1.4   tsubai 			sc_pmatch(sc);
    614   1.4   tsubai 		} else if (sc->int_stat2 & R3_RMSG) {
    615   1.1   tsubai 			/*
    616   1.1   tsubai 			 * message Phase
    617   1.1   tsubai 			 */
    618   1.4   tsubai 			if (sc->min_flag > 0) {
    619   1.4   tsubai 				sc->int_stat2 &= ~(R3_PHC|R3_RMSG);
    620   1.4   tsubai 				sc_pmatch(sc);
    621   1.1   tsubai 			}
    622   1.1   tsubai 		}
    623   1.4   tsubai 		else if (sc->dma_stat != OFF) {
    624   1.1   tsubai 			dummy = sc_cmonr;
    625   1.1   tsubai 			DMAC_WAIT0;
    626   1.1   tsubai 			if ((dummy & (R4_MMSG|R4_MCD|R4_MREQ)) == R4_MREQ) {
    627   1.1   tsubai 				/*
    628   1.1   tsubai 				 * still DATA transfer phase
    629   1.1   tsubai 				 */
    630   1.4   tsubai 				sc_dio_pad(sc, sc->ip);
    631   1.1   tsubai 			}
    632   1.1   tsubai 		}
    633   1.4   tsubai 		else if (sc->ip->comflg == CF_SEND) {
    634   1.1   tsubai 			dummy = sc_cmonr;
    635   1.1   tsubai 			DMAC_WAIT0;
    636   1.1   tsubai 			if ((dummy & SC_PMASK) == COM_OUT) {
    637   1.1   tsubai 				/*
    638   1.1   tsubai 				 * command out phase
    639   1.1   tsubai 				 */
    640   1.4   tsubai 				sc_cout(sc, sc->ip);
    641   1.1   tsubai 			}
    642   1.1   tsubai 		}
    643   1.1   tsubai 	} else {
    644   1.4   tsubai 		if (sc->int_stat2 & (R3_PHC|R3_RMSG))
    645   1.1   tsubai 			goto scintr_exit;
    646   1.1   tsubai 	}
    647   1.1   tsubai 
    648   1.4   tsubai 	if ((sc->int_stat1 & (R2_STO|R2_RSL|R2_ARBF))
    649   1.4   tsubai 	    || (sc->int_stat2 & (R3_DCNT|R3_SRST|R3_PHC|R3_SPE))) {
    650   1.1   tsubai 		/*
    651   1.1   tsubai 		 * still remain intrq
    652   1.1   tsubai 		 */
    653   1.1   tsubai 		goto scintr_loop;
    654   1.1   tsubai 	}
    655   1.1   tsubai 
    656   1.1   tsubai scintr_exit:
    657   1.1   tsubai 	return (1);
    658   1.1   tsubai }
    659   1.1   tsubai 
    660   1.1   tsubai /*
    661   1.1   tsubai  *	SCSI bus reset routine
    662   1.1   tsubai  *		scsi_hardreset() is occered a reset interrupt.
    663   1.1   tsubai  *		And call scsi_softreset().
    664   1.1   tsubai  */
    665   1.1   tsubai void
    666   1.1   tsubai scsi_hardreset()
    667   1.1   tsubai {
    668   1.1   tsubai 	register int s;
    669   1.1   tsubai #ifdef DMAC_MAP_INIT
    670   1.1   tsubai 	register int i;
    671   1.1   tsubai #endif
    672   1.4   tsubai 	struct sc_softc *sc;
    673   1.1   tsubai 
    674   1.4   tsubai 	sc = sc_cd.cd_devs[0];					/* XXX */
    675   1.1   tsubai 	s = splscsi();
    676   1.1   tsubai 
    677   1.4   tsubai 	scsi_chipreset(sc);
    678   1.1   tsubai 	DMAC_WAIT0;
    679   1.4   tsubai 	sc->int_stat1 = 0;
    680   1.4   tsubai 	sc->int_stat2 = 0;
    681   1.4   tsubai 	SET_CMD(sc, SCMD_AST_RST);			/* assert RST signal */
    682   1.1   tsubai 
    683   1.1   tsubai #ifdef DMAC_MAP_INIT
    684   1.1   tsubai 	if (dmac_map_init == 0) {
    685   1.1   tsubai 		dmac_map_init++;
    686   1.1   tsubai 		for (i = 0; i < NDMACMAP; i++) {
    687   1.9  thorpej # if defined(__mips__) && defined(CPU_SINGLE)
    688   1.1   tsubai 			dmac_gsel = CH_SCSI;
    689   1.1   tsubai 			dmac_ctag = (u_char)i;
    690   1.1   tsubai 			dmac_cmap = (u_short)0;
    691   1.1   tsubai # endif
    692   1.1   tsubai 		}
    693   1.1   tsubai 	}
    694   1.1   tsubai #endif
    695   1.1   tsubai 	/*cxd1185_init();*/
    696   1.1   tsubai 	splx(s);
    697   1.1   tsubai }
    698   1.1   tsubai 
    699   1.1   tsubai /*
    700   1.1   tsubai  * I/O port (sc_ioptr) bit assign
    701  1.11  tsutsui  *
    702   1.1   tsubai  *	Rf_PRT3		-	<reserved>
    703   1.1   tsubai  *	Rf_PRT2		-	<reserved>
    704   1.1   tsubai  *	Rf_PRT1		out	Floppy Disk Density control
    705   1.1   tsubai  *	Rf_PRT0		out	Floppy Disk Eject control
    706   1.1   tsubai  */
    707   1.1   tsubai 
    708   1.1   tsubai void
    709   1.4   tsubai scsi_chipreset(sc)
    710   1.4   tsubai 	struct sc_softc *sc;
    711   1.1   tsubai {
    712   1.1   tsubai 	register int s;
    713   1.1   tsubai 	register VOLATILE int save_ioptr;
    714   1.1   tsubai 
    715   1.1   tsubai 	s = splscsi();
    716   1.1   tsubai 
    717   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
    718   1.1   tsubai 	dmac_gsel = CH_SCSI;
    719   1.1   tsubai 	dmac_cwid = 4;				/* initialize DMAC SCSI chan */
    720   1.1   tsubai 	*(unsigned VOLATILE char *)PINTEN |= DMA_INTEN;
    721   1.1   tsubai 	dma_reset(CH_SCSI);
    722   1.1   tsubai #endif
    723   1.1   tsubai 	sc_envir = 0;				/* 1/4 clock */
    724   1.1   tsubai 	DMAC_WAIT0;
    725   1.1   tsubai 	save_ioptr = sc_ioptr;
    726   1.1   tsubai 	DMAC_WAIT0;
    727   1.4   tsubai 	sc->lastcmd = SCMD_CHIP_RST;
    728   1.1   tsubai 	sc_comr = SCMD_CHIP_RST;		/* reset chip */
    729   1.1   tsubai 	DMAC_WAIT;
    730   1.1   tsubai 	(void) WAIT_STATR_BITCLR(R0_CIP);
    731   1.1   tsubai 	/*
    732   1.1   tsubai 	 * SCMD_CHIP_RST command reset all register
    733   1.1   tsubai 	 *				except sc_statr<7:6> & sc_cmonr.
    734   1.1   tsubai 	 * So, bit R0_MIRQ & R3_FNC will be not set.
    735   1.1   tsubai 	 */
    736   1.1   tsubai 	sc_idenr = SC_OWNID;
    737   1.1   tsubai 	DMAC_WAIT0;
    738   1.1   tsubai 
    739   1.1   tsubai 	sc_intok1 = Ra_STO|Ra_RSL|Ra_ARBF;
    740   1.1   tsubai 	DMAC_WAIT0;
    741   1.1   tsubai 	sc_intok2 = Rb_FNC|Rb_SRST|Rb_PHC|Rb_SPE|Rb_RMSG;
    742   1.1   tsubai 	DMAC_WAIT0;
    743   1.1   tsubai 
    744   1.1   tsubai 	sc_ioptr = save_ioptr;
    745   1.1   tsubai 	DMAC_WAIT;
    746   1.1   tsubai 
    747   1.1   tsubai 	sc_moder = Rc_TMSL;			/* RST drive time = 25.5 us */
    748   1.1   tsubai 	DMAC_WAIT0;
    749   1.1   tsubai 	sc_timer = 0x2;
    750   1.1   tsubai 	DMAC_WAIT0;
    751   1.1   tsubai 
    752   1.1   tsubai 	sc_moder = Rc_SPHI;			/* selection timeout = 252 ms */
    753   1.1   tsubai 	DMAC_WAIT0;
    754   1.1   tsubai 	sc_timer = SEL_TIMEOUT_VALUE;
    755   1.1   tsubai 	DMAC_WAIT0;
    756   1.1   tsubai 
    757   1.1   tsubai #ifdef SCSI_1185AQ
    758   1.4   tsubai 	if (sc->scsi_1185AQ)
    759   1.4   tsubai 		SET_CMD(sc, SCMD_ENB_SEL);		/* enable reselection */
    760   1.1   tsubai #endif
    761   1.1   tsubai 
    762   1.4   tsubai 	sc->int_stat1 &= ~R2_RSL;		/* ignore RSL inter request */
    763   1.1   tsubai 
    764   1.1   tsubai 	splx(s);
    765   1.1   tsubai }
    766   1.1   tsubai 
    767   1.1   tsubai void
    768   1.4   tsubai scsi_softreset(sc)
    769   1.4   tsubai 	struct sc_softc *sc;
    770   1.1   tsubai {
    771   1.1   tsubai 	register VOLATILE struct sc_chan_stat *cs;
    772   1.4   tsubai 	int i;
    773   1.1   tsubai 	/* register int (*handler)(); */
    774   1.1   tsubai 
    775   1.4   tsubai 	sc->wbq_actf = NULL;
    776   1.4   tsubai 	sc->wbq_actl = NULL;
    777   1.4   tsubai 	sc->wbc = 0;
    778   1.4   tsubai 	sc->wrc = 0;
    779   1.4   tsubai 	sc->ip = NULL;
    780   1.4   tsubai 	sc->ipc = -1;
    781   1.4   tsubai 	sc->dma_stat = OFF;
    782   1.4   tsubai 	sc->pad_start = 0;
    783   1.1   tsubai 
    784   1.1   tsubai 	for (i = 0; i < NTARGET; ++i) {
    785   1.1   tsubai 		if (i == SC_OWNID)
    786   1.1   tsubai 			continue;
    787   1.4   tsubai 		cs = &sc->chan_stat[i];
    788   1.1   tsubai 		cs->wb_next = NULL;
    789   1.1   tsubai #ifndef NOT_SUPPORT_SYNCTR
    790   1.4   tsubai 		sc->sync_tr[i] = 0;		/* asynchronous mode */
    791   1.1   tsubai #endif
    792   1.4   tsubai 		sc->sel_stat[i] = SEL_WAIT;
    793   1.4   tsubai 		if (cs->scb != NULL) {
    794   1.4   tsubai 			struct sc_scb *scb = cs->scb;
    795   1.4   tsubai 
    796   1.4   tsubai 			if ((cs->scb->istatus & INST_EP) == 0)
    797   1.4   tsubai 				cs->scb->istatus = (INST_EP|INST_HE);
    798   1.4   tsubai 			cs->scb = NULL;
    799   1.9  thorpej #ifdef __mips__
    800   1.4   tsubai 			clean_k2dcache(scb);
    801   1.4   tsubai #endif
    802   1.4   tsubai 			if (cs->intr_flg == SCSI_INTEN) {
    803   1.4   tsubai 				intrcnt[SCSI_INTR]++;
    804   1.1   tsubai #if 0
    805   1.4   tsubai 				handler = scintsw[i].sci_inthandler;
    806   1.4   tsubai 				if (handler)
    807   1.4   tsubai 					(*handler)(scintsw[i].sci_ctlr);
    808   1.1   tsubai #endif
    809   1.1   tsubai 			}
    810   1.4   tsubai 			sc_done(scb);
    811   1.1   tsubai 		}
    812   1.1   tsubai 	}
    813   1.1   tsubai }
    814   1.1   tsubai 
    815   1.1   tsubai /*
    816   1.1   tsubai  *	RESELECTION interrupt service routine
    817   1.1   tsubai  *		( RESELECTION phase )
    818   1.1   tsubai  */
    819   1.1   tsubai void
    820   1.4   tsubai sc_resel(sc)
    821   1.4   tsubai 	struct sc_softc *sc;
    822   1.1   tsubai {
    823   1.1   tsubai 	register struct sc_chan_stat *cs;
    824   1.1   tsubai 	register VOLATILE int chan;
    825   1.1   tsubai 	register VOLATILE int statr;
    826   1.1   tsubai 	register int iloop;
    827   1.1   tsubai 
    828   1.4   tsubai 	sc->min_flag = 0;
    829   1.1   tsubai 	chan = (sc_idenr & R6_SID_MASK) >> SC_TG_SHIFT;
    830   1.1   tsubai 
    831   1.1   tsubai 	if (chan == SC_OWNID)
    832   1.1   tsubai 		return;
    833   1.1   tsubai 
    834   1.1   tsubai 	statr = sc_statr;
    835   1.1   tsubai 	DMAC_WAIT0;
    836   1.1   tsubai 	if (statr & R0_CIP) {
    837   1.4   tsubai 		if (sc->lastcmd == SCMD_SEL_ATN) {
    838   1.1   tsubai 			/*
    839   1.1   tsubai 			 * SELECTION command dead lock ?
    840   1.1   tsubai 			 *	save interrupt request
    841   1.1   tsubai 			 */
    842   1.1   tsubai 			while (sc_statr & R0_MIRQ) {
    843   1.1   tsubai 				DMAC_WAIT0;
    844   1.4   tsubai 				sc->int_stat1 |= sc_intrq1;
    845   1.1   tsubai 				DMAC_WAIT0;
    846   1.4   tsubai 				sc->int_stat2 |= sc_intrq2;
    847   1.1   tsubai 				DMAC_WAIT0;
    848   1.1   tsubai 			}
    849   1.4   tsubai 			scsi_chipreset(sc);
    850   1.1   tsubai 		}
    851   1.1   tsubai 	}
    852   1.1   tsubai 
    853   1.4   tsubai 	cs = &sc->chan_stat[chan];
    854   1.4   tsubai 	if (cs->scb == NULL) {
    855   1.1   tsubai 		scsi_hardreset();
    856   1.1   tsubai 		return;
    857   1.1   tsubai 	}
    858   1.4   tsubai 	if ((cs->scb->istatus & INST_WR) == 0) {
    859   1.1   tsubai 		scsi_hardreset();
    860   1.1   tsubai 		return;
    861   1.1   tsubai 	}
    862   1.1   tsubai 
    863   1.4   tsubai 	if (sc->ipc >= 0) {
    864   1.1   tsubai 		scsi_hardreset();
    865   1.1   tsubai 		return;
    866   1.1   tsubai 	}
    867   1.1   tsubai 
    868   1.4   tsubai 	sc->ip = cs;
    869   1.4   tsubai 	sc->ipc = chan;
    870   1.1   tsubai 
    871   1.1   tsubai 	sc_intok2 = Rb_FNC|Rb_DCNT|Rb_SRST|Rb_PHC|Rb_SPE;
    872   1.1   tsubai 	DMAC_WAIT0;
    873   1.1   tsubai 
    874   1.1   tsubai 	iloop = 0;
    875   1.4   tsubai 	while ((sc->int_stat2 & R3_FNC) == 0) {
    876   1.1   tsubai 		/*
    877   1.1   tsubai 		 * Max 6 usec wait
    878   1.1   tsubai 		 */
    879   1.1   tsubai 		if (iloop++ > RSL_LOOP_CNT) {
    880   1.4   tsubai 			sc->sel_stat[chan] = SEL_RSL_WAIT;
    881   1.1   tsubai 			return;
    882   1.1   tsubai 		}
    883   1.4   tsubai 		GET_INTR(&sc->int_stat1, &sc->int_stat2);
    884   1.1   tsubai 	}
    885   1.4   tsubai 	sc->int_stat2 &= ~R3_FNC;
    886  1.11  tsutsui 
    887   1.4   tsubai 	sc->sel_stat[chan] = SEL_SUCCESS;
    888   1.1   tsubai 
    889   1.4   tsubai 	sc->wrc--;
    890   1.4   tsubai 	sc->dma_stat = OFF;
    891   1.4   tsubai 	sc->pad_start = 0;
    892   1.4   tsubai 	cs->scb->istatus |= INST_IP;
    893   1.4   tsubai 	cs->scb->istatus &= ~INST_WR;
    894   1.1   tsubai 
    895   1.1   tsubai #ifndef NOT_SUPPORT_SYNCTR
    896   1.4   tsubai 	sc_syncr = sc->sync_tr[chan];
    897   1.1   tsubai 	DMAC_WAIT0;
    898   1.1   tsubai #endif
    899   1.1   tsubai }
    900   1.1   tsubai 
    901   1.1   tsubai /*
    902   1.1   tsubai  *	DISCONNECT interrupt service routine
    903   1.1   tsubai  *		( Target disconnect / job done )
    904   1.1   tsubai  */
    905   1.1   tsubai void
    906   1.4   tsubai sc_discon(sc)
    907   1.4   tsubai 	struct sc_softc *sc;
    908   1.1   tsubai {
    909   1.1   tsubai 	register VOLATILE struct sc_chan_stat *cs;
    910   1.1   tsubai 	/* register int (*handler)(); */
    911   1.1   tsubai 	register VOLATILE int dummy;
    912   1.1   tsubai 
    913   1.1   tsubai 	/*
    914   1.7      wiz 	 * Signal reflection on BSY has occurred.
    915   1.1   tsubai 	 *	Not Bus Free Phase, ignore.
    916   1.1   tsubai 	 *
    917   1.1   tsubai 	 *	But, CXD1185Q reset INIT bit of sc_statr.
    918   1.1   tsubai 	 *	So, can't issue Transfer Information command.
    919  1.11  tsutsui 	 *
    920   1.1   tsubai 	 *	What shall we do ?  Bus reset ?
    921   1.1   tsubai 	 */
    922   1.4   tsubai 	if ((sc->int_stat2 & R3_DCNT) && ((sc_intok2 & Rb_DCNT) == 0))
    923   1.1   tsubai 		return;
    924   1.1   tsubai 
    925   1.1   tsubai 	sc_intok2 = Rb_FNC|Rb_SRST|Rb_PHC|Rb_SPE;
    926   1.1   tsubai 	DMAC_WAIT0;
    927   1.1   tsubai 
    928   1.4   tsubai 	sc->min_flag = 0;
    929   1.1   tsubai 	dummy = sc_cmonr;
    930   1.1   tsubai 	DMAC_WAIT0;
    931   1.1   tsubai 	if (dummy & R4_MATN) {
    932   1.4   tsubai 		SET_CMD(sc, SCMD_NGT_ATN);
    933   1.1   tsubai 		(void) WAIT_STATR_BITSET(R0_MIRQ);
    934   1.4   tsubai 		GET_INTR(&sc->int_stat1, &sc->int_stat2); /* clear interrupt */
    935   1.1   tsubai 	}
    936   1.1   tsubai 
    937   1.4   tsubai 	if ((sc->int_stat1 & R2_RSL) == 0)
    938   1.4   tsubai 		sc->int_stat2 &= ~R3_FNC;
    939   1.1   tsubai 
    940   1.4   tsubai 	cs = sc->ip;
    941   1.4   tsubai 	if ((cs == NULL) || (sc->ipc < 0))
    942   1.1   tsubai 		goto sc_discon_exit;
    943   1.1   tsubai 
    944   1.4   tsubai 	if ((sc->sel_stat[cs->chan_num] != SEL_SUCCESS)
    945   1.4   tsubai 			&& (sc->sel_stat[cs->chan_num] != SEL_TIMEOUT))
    946   1.1   tsubai 		printf("sc_discon: eh!\n");
    947   1.1   tsubai 
    948   1.1   tsubai 	/*
    949   1.1   tsubai 	 * indicate abnormal terminate
    950   1.1   tsubai 	 */
    951   1.4   tsubai 	if ((cs->scb->istatus & (INST_EP|INST_WR)) == 0)
    952   1.4   tsubai 		cs->scb->istatus |= (INST_EP|INST_PRE|INST_LB);
    953   1.1   tsubai 
    954   1.4   tsubai 	cs->scb->istatus &= ~INST_IP;
    955   1.4   tsubai 	sc->dma_stat = OFF;
    956   1.4   tsubai 	sc->pad_start = 0;
    957   1.4   tsubai 	sc->ip = NULL;
    958   1.4   tsubai 	sc->ipc = -1;
    959   1.4   tsubai 
    960   1.4   tsubai 	if ((cs->scb->istatus & INST_WR) == 0) {
    961   1.4   tsubai 		struct sc_scb *scb = cs->scb;
    962   1.4   tsubai 
    963   1.4   tsubai 		if (sc->perr_flag[cs->chan_num] > 0)
    964   1.4   tsubai 			cs->scb->istatus |= INST_EP|INST_PRE;
    965   1.4   tsubai 		cs->scb = NULL;
    966   1.9  thorpej #ifdef __mips__
    967   1.4   tsubai 		clean_k2dcache(scb);
    968   1.4   tsubai #endif
    969   1.4   tsubai 		if (cs->intr_flg == SCSI_INTEN) {
    970   1.4   tsubai 			intrcnt[SCSI_INTR]++;
    971   1.1   tsubai #if 0
    972   1.4   tsubai 			handler = scintsw[cs->chan_num].sci_inthandler;
    973   1.4   tsubai 			if (handler)
    974   1.4   tsubai 				(*handler)(scintsw[cs->chan_num].sci_ctlr);
    975   1.1   tsubai #endif
    976   1.1   tsubai 		}
    977   1.4   tsubai 		sc_done(scb);
    978   1.1   tsubai 	}
    979   1.1   tsubai 
    980   1.1   tsubai sc_discon_exit:
    981   1.4   tsubai 	sc_start(sc);
    982   1.1   tsubai }
    983   1.1   tsubai 
    984   1.1   tsubai /*
    985   1.1   tsubai  *	SCSI phase match interrupt service routine
    986   1.1   tsubai  */
    987   1.1   tsubai void
    988   1.4   tsubai sc_pmatch(sc)
    989   1.4   tsubai 	struct sc_softc *sc;
    990   1.1   tsubai {
    991   1.4   tsubai 	struct sc_chan_stat *cs;
    992   1.1   tsubai 	register VOLATILE int phase;
    993   1.1   tsubai 	register VOLATILE int phase2;
    994   1.1   tsubai 	register VOLATILE int cmonr;
    995   1.1   tsubai 
    996   1.4   tsubai 	sc->int_stat2 &= ~R3_FNC;			/* XXXXXXXX */
    997   1.1   tsubai 
    998   1.4   tsubai 	cs = sc->ip;
    999   1.1   tsubai 	if (cs == NULL)
   1000   1.1   tsubai 		return;
   1001   1.1   tsubai 
   1002   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
   1003   1.1   tsubai 	dma_reset(CH_SCSI);
   1004   1.4   tsubai #endif
   1005   1.1   tsubai 	phase = sc_cmonr & SC_PMASK;
   1006   1.1   tsubai 	DMAC_WAIT0;
   1007   1.1   tsubai 	for (;;) {
   1008   1.1   tsubai 		phase2 = phase;
   1009   1.1   tsubai 		cmonr = sc_cmonr;
   1010   1.1   tsubai 		DMAC_WAIT0;
   1011   1.1   tsubai 		phase = cmonr & SC_PMASK;
   1012   1.1   tsubai 		if (phase == phase2) {
   1013   1.1   tsubai 			if ((phase == DAT_IN) || (phase == DAT_OUT))
   1014   1.1   tsubai 				break;
   1015   1.1   tsubai 			else if (cmonr & R4_MREQ)
   1016   1.1   tsubai 				break;
   1017   1.1   tsubai 		}
   1018   1.1   tsubai 	}
   1019   1.1   tsubai 
   1020   1.1   tsubai 
   1021   1.4   tsubai 	sc->dma_stat = OFF;
   1022   1.4   tsubai 	sc->pad_start = 0;
   1023   1.1   tsubai 
   1024   1.1   tsubai 	if (phase == COM_OUT) {
   1025   1.4   tsubai 		sc->min_flag = 0;
   1026   1.1   tsubai 		if (cs->comflg != CF_SEND)
   1027   1.1   tsubai 			cs->comflg = CF_SET;
   1028   1.4   tsubai 		sc_cout(sc, cs);
   1029   1.1   tsubai 	} else {
   1030   1.1   tsubai 		cs->comflg = CF_ENOUGH;
   1031   1.1   tsubai 		sc_intok2 &= ~Rb_FNC;
   1032   1.1   tsubai 		if (phase == MES_IN) {
   1033   1.4   tsubai 			sc->min_flag++;
   1034   1.4   tsubai 			sc_min(sc, cs);
   1035   1.1   tsubai 		} else {
   1036   1.4   tsubai 			sc->min_flag = 0;
   1037   1.1   tsubai 
   1038   1.1   tsubai 			switch (phase) {
   1039   1.1   tsubai 
   1040   1.1   tsubai 			case MES_OUT:
   1041   1.4   tsubai 				sc_mout(sc, cs);
   1042   1.1   tsubai 				break;
   1043   1.1   tsubai 
   1044   1.1   tsubai 			case DAT_IN:
   1045   1.1   tsubai 			case DAT_OUT:
   1046   1.4   tsubai 				sc_dio(sc, cs);
   1047   1.1   tsubai 				break;
   1048   1.1   tsubai 
   1049   1.1   tsubai 			case STAT_IN:
   1050   1.4   tsubai 				sc_sin(sc, cs);
   1051   1.1   tsubai 				break;
   1052   1.1   tsubai 
   1053   1.1   tsubai 			default:
   1054   1.1   tsubai 				printf("SCSI%d: unknown phase\n", cs->chan_num);
   1055   1.1   tsubai 				break;
   1056   1.1   tsubai 			}
   1057   1.1   tsubai 		}
   1058   1.1   tsubai 	}
   1059   1.1   tsubai }
   1060   1.1   tsubai 
   1061   1.1   tsubai 
   1062   1.1   tsubai void
   1063   1.4   tsubai flush_fifo(sc)
   1064   1.4   tsubai 	struct sc_softc *sc;
   1065   1.1   tsubai {
   1066   1.1   tsubai 	register VOLATILE int dummy;
   1067   1.1   tsubai 	VOLATILE int tmp;
   1068   1.1   tsubai 	VOLATILE int tmp0;
   1069   1.1   tsubai 
   1070   1.1   tsubai 	dummy = sc_ffstr;
   1071   1.1   tsubai 	DMAC_WAIT0;
   1072   1.1   tsubai 	if (dummy & R5_FIFOREM) {
   1073   1.1   tsubai 		/*
   1074   1.1   tsubai 		 * flush FIFO
   1075   1.1   tsubai 		 */
   1076   1.4   tsubai 		SET_CMD(sc, SCMD_FLSH_FIFO);
   1077   1.1   tsubai 		tmp = 0;
   1078   1.1   tsubai 		do {
   1079   1.1   tsubai 			do {
   1080   1.1   tsubai 				dummy = sc_statr;
   1081   1.1   tsubai 				DMAC_WAIT0;
   1082   1.1   tsubai 			} while (dummy & R0_CIP);
   1083   1.1   tsubai 			GET_INTR(&tmp0, &tmp); /* clear interrupt */
   1084   1.1   tsubai 		} while ((tmp & R3_FNC) == 0);
   1085   1.1   tsubai 	}
   1086   1.1   tsubai }
   1087   1.1   tsubai 
   1088   1.1   tsubai /*
   1089   1.1   tsubai  *	SCSI command send routine
   1090   1.1   tsubai  */
   1091   1.1   tsubai void
   1092   1.4   tsubai sc_cout(sc, cs)
   1093   1.4   tsubai 	struct sc_softc *sc;
   1094   1.1   tsubai 	register struct sc_chan_stat *cs;
   1095   1.1   tsubai {
   1096   1.1   tsubai 	register int iloop;
   1097   1.1   tsubai 	register int cdb_bytes;
   1098   1.1   tsubai 	register VOLATILE int dummy;
   1099   1.1   tsubai 	register VOLATILE int statr;
   1100   1.4   tsubai 	struct scsipi_xfer *xs;
   1101   1.1   tsubai 
   1102   1.1   tsubai 	if (cs->comflg == CF_SET) {
   1103   1.4   tsubai 		struct sc_scb *scb = cs->scb;
   1104   1.4   tsubai 
   1105   1.1   tsubai 		cs->comflg = CF_SEND;
   1106   1.1   tsubai 
   1107   1.4   tsubai 		flush_fifo(sc);
   1108   1.1   tsubai 
   1109   1.4   tsubai 		xs = scb->xs;
   1110   1.4   tsubai 		cdb_bytes = xs->cmdlen;
   1111   1.4   tsubai 
   1112   1.4   tsubai 		switch (xs->cmd->opcode & CMD_TYPEMASK) {
   1113   1.1   tsubai 		case CMD_T0:
   1114   1.1   tsubai 		case CMD_T1:
   1115   1.1   tsubai 		case CMD_T5:
   1116   1.1   tsubai 			break;
   1117   1.1   tsubai 
   1118   1.1   tsubai 		default:
   1119   1.1   tsubai 			cdb_bytes = 6;
   1120   1.1   tsubai 			sc_intok2 |= Rb_FNC;
   1121   1.1   tsubai 			break;
   1122   1.1   tsubai 		}
   1123   1.1   tsubai 
   1124   1.1   tsubai 		/*
   1125   1.1   tsubai 		 * set Active pointers
   1126   1.1   tsubai 		 */
   1127   1.4   tsubai 		sc->act_cmd_pointer = (char *)xs->cmd;
   1128   1.4   tsubai 		cs->act_trcnt = scb->sc_ctrnscnt;
   1129   1.4   tsubai 		cs->act_point = scb->sc_cpoint;
   1130   1.4   tsubai 		cs->act_tag = scb->sc_ctag;
   1131   1.4   tsubai 		cs->act_offset = scb->sc_coffset;
   1132   1.1   tsubai 
   1133   1.1   tsubai 	} else {
   1134   1.1   tsubai 		cdb_bytes = 1;
   1135   1.1   tsubai 		iloop = 0;
   1136   1.1   tsubai 		do {
   1137   1.1   tsubai 			dummy = sc_cmonr;
   1138   1.1   tsubai 			DMAC_WAIT0;
   1139   1.1   tsubai 			if ((dummy & SC_PMASK) != COM_OUT)
   1140   1.1   tsubai 				return;
   1141   1.1   tsubai 			statr = sc_statr;
   1142   1.1   tsubai 			DMAC_WAIT0;
   1143   1.1   tsubai 			if (statr & R0_MIRQ)
   1144   1.1   tsubai 				return;
   1145   1.1   tsubai 		} while ((dummy & R4_MREQ) == 0);
   1146   1.1   tsubai 		statr = sc_statr;
   1147   1.1   tsubai 		DMAC_WAIT0;
   1148   1.1   tsubai 		if (statr & R0_MIRQ)
   1149   1.1   tsubai 			return;
   1150   1.1   tsubai 	}
   1151   1.1   tsubai 
   1152   1.1   tsubai 
   1153   1.1   tsubai 	SET_CNT(cdb_bytes);
   1154   1.4   tsubai 	SET_CMD(sc, SCMD_TR_INFO|R0_TRBE);
   1155   1.1   tsubai 
   1156   1.1   tsubai 	for (iloop = 0; iloop < cdb_bytes; iloop++) {
   1157   1.1   tsubai 		do {
   1158   1.1   tsubai 			dummy = sc_cmonr;
   1159   1.1   tsubai 			DMAC_WAIT0;
   1160   1.1   tsubai 			if ((dummy & SC_PMASK) != COM_OUT)
   1161   1.1   tsubai 				return;
   1162   1.1   tsubai 		} while ((dummy & R4_MREQ) == 0);
   1163   1.1   tsubai 		statr = sc_statr;
   1164   1.1   tsubai 		DMAC_WAIT0;
   1165   1.1   tsubai 		if (statr & R0_MIRQ)
   1166   1.1   tsubai 			return;
   1167   1.4   tsubai 		sc_datr = *sc->act_cmd_pointer++;
   1168   1.1   tsubai 		do {
   1169   1.1   tsubai 			dummy = sc_cmonr;
   1170   1.1   tsubai 			DMAC_WAIT0;
   1171   1.1   tsubai 		} while ((dummy & R4_MACK) != 0);
   1172   1.1   tsubai 	}
   1173   1.1   tsubai }
   1174   1.1   tsubai 
   1175   1.1   tsubai #define GET_MIN_COUNT	127
   1176   1.1   tsubai 
   1177   1.1   tsubai /*
   1178   1.1   tsubai  *	SCSI message accept routine
   1179   1.1   tsubai  */
   1180   1.1   tsubai void
   1181   1.4   tsubai sc_min(sc, cs)
   1182   1.4   tsubai 	struct sc_softc *sc;
   1183   1.1   tsubai 	register struct sc_chan_stat *cs;
   1184   1.1   tsubai {
   1185   1.4   tsubai 	struct sc_scb *scb = cs->scb;
   1186   1.4   tsubai 	struct scsipi_xfer *xs = scb->xs;
   1187   1.1   tsubai 	register VOLATILE int dummy;
   1188   1.1   tsubai 
   1189   1.1   tsubai 	sc_intok2 = Rb_FNC|Rb_DCNT|Rb_SRST|Rb_PHC|Rb_SPE|Rb_RMSG;
   1190   1.1   tsubai 	DMAC_WAIT0;
   1191   1.1   tsubai 
   1192   1.4   tsubai 	if (sc->min_flag == 1)
   1193   1.4   tsubai 		flush_fifo(sc);
   1194   1.1   tsubai 
   1195   1.1   tsubai 	dummy = sc_cmonr;
   1196   1.1   tsubai 	DMAC_WAIT0;
   1197   1.1   tsubai 	if ((dummy & R4_MREQ) == 0) {
   1198   1.1   tsubai 		printf("sc_min: !REQ cmonr=%x\n", dummy);
   1199   1.4   tsubai 		print_scsi_stat(sc);
   1200   1.1   tsubai 		scsi_hardreset();
   1201   1.1   tsubai 		return;
   1202   1.1   tsubai 	}
   1203   1.1   tsubai 
   1204   1.1   tsubai /*  retry_cmd_issue: */
   1205   1.4   tsubai 	sc->int_stat2 &= ~R3_FNC;
   1206   1.4   tsubai 	SET_CMD(sc, SCMD_TR_INFO);
   1207   1.1   tsubai 	do {
   1208   1.1   tsubai 		do {
   1209   1.1   tsubai 			dummy = sc_statr;
   1210   1.1   tsubai 			DMAC_WAIT0;
   1211   1.1   tsubai 		} while (dummy & R0_CIP);
   1212   1.4   tsubai 		GET_INTR(&sc->int_stat1, &sc->int_stat2);	/* clear interrupt */
   1213   1.4   tsubai 	} while ((sc->int_stat2 & R3_FNC) == 0);
   1214   1.4   tsubai 	sc->int_stat2 &= ~R3_FNC;
   1215   1.1   tsubai 
   1216   1.1   tsubai 	dummy = sc_ffstr;
   1217   1.1   tsubai 	if (dummy & R5_FIE) {
   1218   1.1   tsubai 		DMAC_WAIT;
   1219   1.1   tsubai 		dummy = sc_ffstr;
   1220   1.1   tsubai 		DMAC_WAIT0;
   1221   1.1   tsubai 		if (dummy & R5_FIE) {
   1222   1.1   tsubai 			dummy = sc_statr;
   1223   1.1   tsubai 			DMAC_WAIT0;
   1224   1.1   tsubai 			if ((dummy & R0_INIT) == 0) {
   1225   1.1   tsubai 				/*
   1226   1.1   tsubai 				 * CXD1185 detect BSY false
   1227   1.1   tsubai 				 */
   1228   1.1   tsubai 				scsi_hardreset();
   1229   1.1   tsubai 				return;
   1230   1.1   tsubai 			}
   1231   1.1   tsubai 		}
   1232   1.1   tsubai 	}
   1233   1.1   tsubai 	dummy = sc_datr;				/* get message byte */
   1234   1.1   tsubai 	DMAC_WAIT0;
   1235   1.1   tsubai 
   1236   1.4   tsubai 	if (sc->min_cnt[cs->chan_num] == 0) {
   1237   1.4   tsubai 		scb->message = scb->identify;
   1238   1.1   tsubai 		if (dummy == MSG_EXTND) {
   1239   1.1   tsubai 			/* Extended Message */
   1240   1.4   tsubai 			sc->min_cnt[cs->chan_num] = GET_MIN_COUNT;
   1241   1.4   tsubai 			sc->min_point[cs->chan_num] = scb->msgbuf;
   1242   1.4   tsubai 			bzero(scb->msgbuf, 8);
   1243   1.4   tsubai 			*sc->min_point[cs->chan_num]++ = dummy;
   1244   1.1   tsubai 		} else {
   1245   1.1   tsubai 			switch ((dummy & MSG_IDENT)? MSG_IDENT : dummy) {
   1246   1.1   tsubai 
   1247   1.1   tsubai 			case MSG_CCOMP:
   1248   1.4   tsubai 				scb->istatus |= INST_EP;
   1249   1.1   tsubai 				break;
   1250   1.1   tsubai 
   1251   1.1   tsubai 			case MSG_MREJ:
   1252   1.1   tsubai #ifndef NOT_SUPPORT_SYNCTR
   1253   1.4   tsubai 				if (sc->mout_flag[cs->chan_num] == MOUT_SYNC_TR)
   1254   1.4   tsubai 					sc->sync_tr[cs->chan_num] = 0;
   1255   1.1   tsubai #endif
   1256   1.1   tsubai 				break;
   1257   1.1   tsubai 
   1258   1.1   tsubai 			case MSG_IDENT:
   1259   1.1   tsubai 			case MSG_RDP:
   1260   1.4   tsubai 
   1261   1.4   tsubai 				sc->dma_stat = OFF;
   1262   1.4   tsubai 				sc->pad_start = 0;
   1263   1.1   tsubai 				cs->comflg = OFF;
   1264   1.1   tsubai 				/*
   1265   1.4   tsubai 			 	 * restore the saved value to Active pointers
   1266   1.4   tsubai 			 	 */
   1267   1.4   tsubai 				sc->act_cmd_pointer = (char *)xs->cmd;
   1268   1.4   tsubai 				cs->act_trcnt = scb->sc_ctrnscnt;
   1269   1.4   tsubai 				cs->act_point = scb->sc_cpoint;
   1270   1.4   tsubai 				cs->act_tag = scb->sc_ctag;
   1271   1.4   tsubai 				cs->act_offset = scb->sc_coffset;
   1272   1.1   tsubai 				break;
   1273   1.1   tsubai 
   1274   1.1   tsubai 			case MSG_SDP:
   1275   1.1   tsubai 				/*
   1276   1.1   tsubai 				 * save Active pointers
   1277   1.1   tsubai 				 */
   1278   1.4   tsubai 				scb->sc_ctrnscnt = cs->act_trcnt;
   1279   1.4   tsubai 				scb->sc_ctag = cs->act_tag;
   1280   1.4   tsubai 				scb->sc_coffset = cs->act_offset;
   1281   1.4   tsubai 				scb->sc_cpoint = cs->act_point;
   1282   1.1   tsubai 				break;
   1283   1.1   tsubai 
   1284   1.1   tsubai 			case MSG_DCNT:
   1285   1.4   tsubai 				scb->istatus |= INST_WR;
   1286   1.4   tsubai 				sc->wrc++;
   1287   1.1   tsubai 				break;
   1288   1.1   tsubai 
   1289   1.1   tsubai 			default:
   1290   1.4   tsubai 				scb->message = MSG_MREJ;
   1291   1.4   tsubai 				SET_CMD(sc, SCMD_AST_ATN);
   1292   1.1   tsubai 				printf("SCSI%d:sc_min() Unknown mes=0x%x, \n",
   1293   1.1   tsubai 					cs->chan_num, dummy);
   1294   1.1   tsubai 			}
   1295   1.1   tsubai 		}
   1296   1.1   tsubai 	} else {
   1297   1.4   tsubai 		*sc->min_point[cs->chan_num]++ = dummy;
   1298   1.4   tsubai 		if (sc->min_cnt[cs->chan_num] == GET_MIN_COUNT)
   1299   1.4   tsubai 			sc->min_cnt[cs->chan_num] = dummy;
   1300   1.1   tsubai 		else
   1301   1.4   tsubai 			sc->min_cnt[cs->chan_num]--;
   1302   1.4   tsubai 		if (sc->min_cnt[cs->chan_num] <= 0) {
   1303   1.1   tsubai #ifdef ABORT_SYNCTR_MES_FROM_TARGET
   1304   1.4   tsubai 			if ((scb->msgbuf[2] == 0x01) &&
   1305   1.4   tsubai 			    (sc->mout_flag[cs->chan_num] == MOUT_SYNC_TR)) {
   1306   1.1   tsubai #else
   1307   1.4   tsubai 			if (scb->msgbuf[2] == 0x01) {
   1308   1.1   tsubai #endif
   1309   1.1   tsubai 				register int i;
   1310   1.1   tsubai 				/*
   1311   1.1   tsubai 				 * receive Synchronous transfer message reply
   1312   1.1   tsubai 				 *	calculate transfer period val
   1313   1.1   tsubai 				 *	tpm * 4/1000 us = 4/16 * (tpv + 1)
   1314   1.1   tsubai 				 */
   1315   1.1   tsubai #define	TPM2TPV(tpm)	(((tpm)*16 + 999) / 1000 - 1)
   1316   1.1   tsubai #ifndef NOT_SUPPORT_SYNCTR
   1317   1.4   tsubai 				i = scb->msgbuf[3];	/* get tpm */
   1318   1.1   tsubai 				i = TPM2TPV(i) << 4;
   1319   1.4   tsubai 				if (scb->msgbuf[4] == 0)
   1320   1.4   tsubai 					sc->sync_tr[cs->chan_num] = 0;
   1321   1.1   tsubai 				else
   1322   1.4   tsubai 					sc->sync_tr[cs->chan_num] =
   1323   1.4   tsubai 						i | scb->msgbuf[4];
   1324   1.1   tsubai #endif /* !NOT_SUPPORT_SYNCTR */
   1325   1.1   tsubai 			} else {
   1326   1.4   tsubai 				scb->message = MSG_MREJ;
   1327   1.4   tsubai 				SET_CMD(sc, SCMD_AST_ATN);	/* assert ATN */
   1328   1.1   tsubai 			}
   1329   1.1   tsubai 		}
   1330   1.1   tsubai 	}
   1331   1.4   tsubai 	SET_CMD(sc, SCMD_NGT_ACK);
   1332   1.1   tsubai }
   1333   1.1   tsubai 
   1334   1.1   tsubai /*
   1335   1.1   tsubai  *	SCSI message send routine
   1336   1.1   tsubai  */
   1337   1.1   tsubai void
   1338   1.4   tsubai sc_mout(sc, cs)
   1339   1.4   tsubai 	struct sc_softc *sc;
   1340   1.1   tsubai 	register struct sc_chan_stat *cs;
   1341   1.1   tsubai {
   1342   1.4   tsubai 	register struct sc_scb *scb = cs->scb;
   1343   1.1   tsubai 	register u_char *mp;
   1344   1.1   tsubai 	register int cnt;
   1345   1.1   tsubai 	register int iloop;
   1346   1.1   tsubai 	register VOLATILE int dummy;
   1347   1.1   tsubai 	VOLATILE int tmp;
   1348   1.1   tsubai 	VOLATILE int tmp0;
   1349   1.1   tsubai 
   1350   1.4   tsubai 	flush_fifo(sc);
   1351   1.1   tsubai 
   1352   1.4   tsubai 	if (sc->mout_flag[cs->chan_num] == 0) {
   1353   1.4   tsubai 		sc->mout_flag[cs->chan_num] = MOUT_IDENTIFY;
   1354   1.4   tsubai 		if (scb->message != 0) {
   1355   1.1   tsubai 			sc_intok2 = Rb_FNC|Rb_DCNT|Rb_SRST|Rb_PHC|Rb_SPE|Rb_RMSG;
   1356   1.1   tsubai 			DMAC_WAIT0;
   1357   1.4   tsubai 			if ((scb->message == MSG_EXTND)
   1358   1.4   tsubai 					&& (scb->msgbuf[2] == 0x01)) {
   1359   1.1   tsubai 				cnt = 5;
   1360   1.4   tsubai 				mp = scb->msgbuf;
   1361   1.4   tsubai 				scb->msgbuf[3] = MIN_TP;
   1362   1.4   tsubai 				if (scb->msgbuf[4] > MAX_OFFSET_BYTES)
   1363   1.4   tsubai 					scb->msgbuf[4] = MAX_OFFSET_BYTES;
   1364   1.4   tsubai 				sc->mout_flag[cs->chan_num] = MOUT_SYNC_TR;
   1365   1.1   tsubai 			} else {
   1366   1.1   tsubai 				cnt = 1;
   1367   1.4   tsubai 				mp = &scb->message;
   1368   1.1   tsubai 			}
   1369   1.1   tsubai 
   1370   1.1   tsubai 			SET_CNT(cnt);
   1371   1.4   tsubai 			SET_CMD(sc, SCMD_TR_INFO|R0_TRBE);
   1372   1.4   tsubai 			sc_datr = scb->identify;
   1373   1.1   tsubai 			DMAC_WAIT0;
   1374   1.1   tsubai 			for (iloop = 1; iloop < cnt; iloop++) {
   1375   1.1   tsubai 				sc_datr = *mp++;
   1376   1.1   tsubai 				DMAC_WAIT;
   1377   1.1   tsubai 			}
   1378   1.1   tsubai 			do {
   1379   1.1   tsubai 				dummy = sc_cmonr;
   1380   1.1   tsubai 				DMAC_WAIT0;
   1381   1.1   tsubai 				if ((dummy & R4_MBSY) == 0)
   1382   1.1   tsubai 					return;
   1383   1.1   tsubai 				dummy = sc_statr;
   1384   1.1   tsubai 				DMAC_WAIT0;
   1385   1.1   tsubai 			} while (dummy & R0_CIP);
   1386   1.1   tsubai 
   1387   1.1   tsubai 			tmp = 0;
   1388   1.1   tsubai 			GET_INTR(&tmp0, &tmp);		/* clear interrupt */
   1389   1.1   tsubai 			if ((tmp & R3_FNC) == 0) {
   1390   1.1   tsubai 				(void) WAIT_STATR_BITSET(R0_MIRQ);
   1391   1.1   tsubai 				GET_INTR(&tmp0, &tmp);	/* clear interrupt */
   1392   1.1   tsubai 			}
   1393   1.1   tsubai 
   1394   1.1   tsubai 			do {
   1395   1.1   tsubai 				dummy = sc_cmonr;
   1396   1.1   tsubai 				DMAC_WAIT0;
   1397   1.1   tsubai 				if ((dummy & R4_MBSY) == 0)
   1398   1.1   tsubai 					return;
   1399   1.1   tsubai 			} while ((dummy & R4_MREQ) == 0);
   1400   1.4   tsubai 			SET_CMD(sc, SCMD_NGT_ATN);
   1401   1.1   tsubai 			(void) WAIT_STATR_BITCLR(R0_CIP);
   1402   1.1   tsubai 			GET_INTR(&tmp0, &tmp);		/* clear interrupt */
   1403   1.1   tsubai 
   1404   1.1   tsubai 			dummy = sc_cmonr;
   1405   1.1   tsubai 			DMAC_WAIT0;
   1406   1.1   tsubai 			if ((dummy & R4_MREQ) == 0) {
   1407   1.1   tsubai 				printf("sc_mout: !REQ cmonr=%x\n", dummy);
   1408   1.4   tsubai 				print_scsi_stat(sc);
   1409   1.1   tsubai 				scsi_hardreset();
   1410   1.1   tsubai 				return;
   1411   1.1   tsubai 			}
   1412   1.1   tsubai 
   1413   1.4   tsubai 			SET_CMD(sc, SCMD_TR_INFO);
   1414   1.1   tsubai 			sc_datr = *mp++;
   1415   1.1   tsubai 			DMAC_WAIT0;
   1416   1.1   tsubai 		} else {
   1417   1.1   tsubai 			dummy = sc_cmonr;
   1418   1.1   tsubai 			DMAC_WAIT0;
   1419   1.1   tsubai 			if (dummy & R4_MATN) {
   1420   1.4   tsubai 				SET_CMD(sc, SCMD_NGT_ATN);
   1421   1.1   tsubai 				(void) WAIT_STATR_BITCLR(R0_CIP);
   1422   1.1   tsubai 				GET_INTR(&tmp0, &tmp);	/* clear interrupt */
   1423   1.1   tsubai 			}
   1424   1.1   tsubai 
   1425   1.1   tsubai 			iloop = 0;
   1426   1.1   tsubai 			do {
   1427   1.1   tsubai 				dummy = sc_cmonr;
   1428   1.1   tsubai 				DMAC_WAIT0;
   1429   1.1   tsubai 				if (iloop++ > CHECK_LOOP_CNT)
   1430   1.1   tsubai 					break;
   1431   1.1   tsubai 			} while ((dummy & R4_MREQ) == 0);
   1432   1.4   tsubai 			SET_CMD(sc, SCMD_TR_INFO);
   1433   1.4   tsubai 			sc_datr = scb->identify;
   1434   1.1   tsubai 			DMAC_WAIT0;
   1435   1.1   tsubai 		}
   1436   1.1   tsubai 	} else {
   1437   1.1   tsubai 		dummy = sc_cmonr;
   1438   1.1   tsubai 		DMAC_WAIT0;
   1439   1.1   tsubai 		if (dummy & R4_MATN) {
   1440   1.4   tsubai 			SET_CMD(sc, SCMD_NGT_ATN);
   1441   1.1   tsubai 			(void) WAIT_STATR_BITCLR(R0_CIP);
   1442   1.1   tsubai 			GET_INTR(&tmp0, &tmp);		/* clear interrupt */
   1443   1.1   tsubai 		}
   1444   1.1   tsubai 
   1445   1.1   tsubai 		dummy = sc_cmonr;
   1446   1.1   tsubai 		DMAC_WAIT0;
   1447   1.1   tsubai 		if ((dummy & R4_MREQ) == 0) {
   1448   1.1   tsubai 			printf("sc_mout: !REQ cmonr=%x\n", dummy);
   1449   1.4   tsubai 			print_scsi_stat(sc);
   1450   1.1   tsubai 			scsi_hardreset();
   1451   1.1   tsubai 			return;
   1452   1.1   tsubai 		}
   1453   1.1   tsubai 
   1454   1.4   tsubai 		SET_CMD(sc, SCMD_TR_INFO);
   1455   1.4   tsubai 		sc_datr = scb->message;
   1456   1.1   tsubai 		DMAC_WAIT0;
   1457   1.1   tsubai 	}
   1458   1.1   tsubai }
   1459   1.1   tsubai 
   1460   1.1   tsubai /*
   1461   1.1   tsubai  *	SCSI status accept routine
   1462   1.1   tsubai  */
   1463   1.1   tsubai void
   1464   1.4   tsubai sc_sin(sc, cs)
   1465   1.4   tsubai 	struct sc_softc *sc;
   1466   1.1   tsubai 	register VOLATILE struct sc_chan_stat *cs;
   1467   1.1   tsubai {
   1468   1.1   tsubai 	register VOLATILE int dummy;
   1469   1.1   tsubai 	register int iloop;
   1470   1.1   tsubai 
   1471   1.4   tsubai 	flush_fifo(sc);
   1472   1.1   tsubai 
   1473   1.1   tsubai 	dummy = sc_cmonr;
   1474   1.1   tsubai 	DMAC_WAIT0;
   1475   1.1   tsubai 	if ((dummy & R4_MREQ) == 0) {
   1476   1.1   tsubai 		printf("sc_sin: !REQ cmonr=%x\n", dummy);
   1477   1.4   tsubai 		print_scsi_stat(sc);
   1478   1.1   tsubai 		scsi_hardreset();
   1479   1.1   tsubai 		return;
   1480   1.1   tsubai 	}
   1481   1.1   tsubai 
   1482   1.1   tsubai 	sc_intok2 = Rb_FNC|Rb_DCNT|Rb_SRST|Rb_PHC|Rb_SPE|Rb_RMSG;
   1483   1.1   tsubai 	DMAC_WAIT0;
   1484   1.1   tsubai 
   1485   1.4   tsubai 	SET_CMD(sc, SCMD_TR_INFO);
   1486   1.1   tsubai 
   1487   1.1   tsubai 	(void) WAIT_STATR_BITCLR(R0_CIP);
   1488   1.1   tsubai 
   1489   1.4   tsubai 	sc->int_stat2 &= ~R3_FNC;
   1490   1.1   tsubai 	iloop = 0;
   1491   1.1   tsubai 	do {
   1492   1.1   tsubai 		if (iloop++ > CHECK_LOOP_CNT)
   1493   1.1   tsubai 			break;
   1494   1.4   tsubai 		GET_INTR(&sc->int_stat1, &sc->int_stat2);	/* clear interrupt */
   1495   1.4   tsubai 	} while ((sc->int_stat2 & R3_FNC) == 0);
   1496   1.4   tsubai 	sc->int_stat2 &= ~R3_FNC;
   1497   1.1   tsubai 
   1498   1.4   tsubai 	cs->scb->tstatus = sc_datr;		/* get status byte */
   1499   1.1   tsubai 	DMAC_WAIT0;
   1500   1.1   tsubai }
   1501   1.1   tsubai 
   1502   1.1   tsubai /*
   1503   1.1   tsubai  *	SCSI data in/out routine
   1504   1.1   tsubai  */
   1505   1.1   tsubai void
   1506   1.4   tsubai sc_dio(sc, cs)
   1507   1.4   tsubai 	struct sc_softc *sc;
   1508   1.1   tsubai 	register VOLATILE struct sc_chan_stat *cs;
   1509   1.1   tsubai {
   1510   1.4   tsubai 	register VOLATILE struct sc_scb *scb;
   1511   1.1   tsubai 	register int i;
   1512   1.1   tsubai 	register int pages;
   1513   1.1   tsubai 	register u_int tag;
   1514   1.1   tsubai 	register u_int pfn;
   1515   1.1   tsubai 	VOLATILE int phase;
   1516   1.4   tsubai 	struct scsipi_xfer *xs;
   1517   1.1   tsubai 
   1518   1.4   tsubai 	scb = cs->scb;
   1519   1.4   tsubai 	xs = scb->xs;
   1520   1.1   tsubai 
   1521   1.1   tsubai 	sc_intok2 = Rb_FNC|Rb_DCNT|Rb_SRST|Rb_PHC|Rb_SPE;
   1522   1.1   tsubai 	DMAC_WAIT0;
   1523   1.1   tsubai 
   1524   1.1   tsubai 	if (cs->act_trcnt <= 0) {
   1525   1.4   tsubai 		sc_dio_pad(sc, cs);
   1526   1.1   tsubai 		return;
   1527   1.1   tsubai 	}
   1528   1.1   tsubai 
   1529   1.4   tsubai 	switch (xs->cmd->opcode) {
   1530   1.1   tsubai 
   1531   1.1   tsubai 	case SCOP_READ:
   1532   1.1   tsubai 	case SCOP_WRITE:
   1533   1.1   tsubai 	case SCOP_EREAD:
   1534   1.1   tsubai 	case SCOP_EWRITE:
   1535   1.4   tsubai 		i = (cs->act_trcnt + DEV_BSIZE -1) / DEV_BSIZE;
   1536   1.4   tsubai 		i *= DEV_BSIZE;
   1537   1.1   tsubai 		break;
   1538   1.1   tsubai 
   1539   1.1   tsubai 	default:
   1540   1.1   tsubai 		i = cs->act_trcnt;
   1541   1.1   tsubai 		break;
   1542   1.1   tsubai 	}
   1543   1.1   tsubai 
   1544   1.1   tsubai 	SET_CNT(i);
   1545   1.4   tsubai 	sc->pad_cnt[cs->chan_num] = i - cs->act_trcnt;
   1546   1.1   tsubai 
   1547   1.1   tsubai 	phase = sc_cmonr & SC_PMASK;
   1548   1.1   tsubai 	DMAC_WAIT0;
   1549   1.1   tsubai 	if (phase == DAT_IN) {
   1550   1.1   tsubai 		if (sc_syncr == OFF) {
   1551   1.1   tsubai 			DMAC_WAIT0;
   1552   1.4   tsubai 			flush_fifo(sc);
   1553   1.1   tsubai 		}
   1554   1.1   tsubai 	}
   1555   1.1   tsubai 
   1556   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
   1557   1.4   tsubai 	SET_CMD(sc, SCMD_TR_INFO|R0_DMA|R0_TRBE);
   1558   1.1   tsubai #endif
   1559   1.1   tsubai 
   1560   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
   1561   1.1   tsubai 	dmac_gsel = CH_SCSI;
   1562   1.1   tsubai 	dmac_ctrcl = (u_char)(cs->act_trcnt & 0xff);
   1563   1.1   tsubai 	dmac_ctrcm = (u_char)((cs->act_trcnt >> 8) & 0xff);
   1564   1.1   tsubai 	dmac_ctrch = (u_char)((cs->act_trcnt >> 16) & 0x0f);
   1565   1.1   tsubai 	dmac_cofsh = (u_char)((cs->act_offset >> 8) & 0xf);
   1566   1.1   tsubai 	dmac_cofsl = (u_char)(cs->act_offset & 0xff);
   1567   1.1   tsubai #endif
   1568   1.1   tsubai 	tag = 0;
   1569   1.1   tsubai 
   1570   1.4   tsubai 	if (scb->sc_map && (scb->sc_map->mp_pages > 0)) {
   1571   1.1   tsubai 		/*
   1572   1.1   tsubai 		 * Set DMAC map entry from map table
   1573   1.1   tsubai 		 */
   1574   1.4   tsubai 		pages = scb->sc_map->mp_pages;
   1575   1.1   tsubai 		for (i = cs->act_tag; i < pages; i++) {
   1576   1.4   tsubai 			if ((pfn = scb->sc_map->mp_addr[i]) == 0)
   1577   1.1   tsubai 				panic("SCSI:sc_dma() zero entry");
   1578   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
   1579   1.1   tsubai 			dmac_gsel = CH_SCSI;
   1580   1.1   tsubai 			dmac_ctag = (u_char)tag++;
   1581   1.1   tsubai 			dmac_cmap = (u_short)pfn;
   1582   1.1   tsubai #endif
   1583   1.1   tsubai 		}
   1584   1.1   tsubai #ifdef MAP_OVER_ACCESS
   1585   1.9  thorpej # if defined(__mips__) && defined(CPU_SINGLE)
   1586   1.1   tsubai 		dmac_gsel = CH_SCSI;
   1587   1.1   tsubai 		dmac_ctag = (u_char)tag++;
   1588   1.1   tsubai 		dmac_cmap = (u_short)pfn;
   1589   1.1   tsubai # endif
   1590   1.1   tsubai #endif
   1591   1.1   tsubai 	} else {
   1592   1.1   tsubai 		/*
   1593   1.1   tsubai 		 * Set DMAC map entry from logical address
   1594   1.1   tsubai 		 */
   1595   1.5   tsubai 		pfn = kvtophys((vaddr_t)cs->act_point) >> PGSHIFT;
   1596   1.1   tsubai 		pages = (cs->act_trcnt >> PGSHIFT) + 2;
   1597   1.1   tsubai 		for (i = 0; i < pages; i++) {
   1598   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
   1599   1.1   tsubai 			dmac_gsel = CH_SCSI;
   1600   1.1   tsubai 			dmac_ctag = (u_char)tag++;
   1601   1.1   tsubai 			dmac_cmap = (u_short)pfn + i;
   1602   1.1   tsubai #endif
   1603   1.1   tsubai 		}
   1604   1.1   tsubai 	}
   1605   1.1   tsubai 
   1606   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
   1607   1.1   tsubai 	dmac_gsel = CH_SCSI;
   1608   1.1   tsubai 	dmac_ctag = 0;
   1609   1.1   tsubai #endif
   1610   1.1   tsubai 
   1611   1.1   tsubai 	if (phase == DAT_IN) {
   1612   1.4   tsubai 		sc->dma_stat = SC_DMAC_RD;
   1613   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
   1614   1.1   tsubai 		/*
   1615   1.1   tsubai 		 * auto pad flag is always on
   1616   1.1   tsubai 		 */
   1617   1.1   tsubai 		dmac_gsel = CH_SCSI;
   1618   1.1   tsubai 		dmac_cctl = DM_MODE|DM_APAD;
   1619   1.1   tsubai 		DMAC_WAIT;
   1620   1.1   tsubai 		dmac_cctl = DM_MODE|DM_APAD|DM_ENABLE;
   1621   1.1   tsubai 		DMAC_WAIT0;
   1622   1.1   tsubai #endif
   1623   1.1   tsubai 	}
   1624   1.1   tsubai 	else if (phase == DAT_OUT) {
   1625   1.4   tsubai 		sc->dma_stat = SC_DMAC_WR;
   1626   1.9  thorpej #if defined(__mips__) && defined(CPU_SINGLE)
   1627   1.1   tsubai 		dmac_gsel = CH_SCSI;
   1628   1.1   tsubai 		dmac_cctl = DM_APAD;
   1629   1.1   tsubai 		DMAC_WAIT;
   1630   1.1   tsubai 		dmac_cctl = DM_APAD|DM_ENABLE;
   1631   1.1   tsubai 		DMAC_WAIT0;
   1632   1.1   tsubai #endif
   1633   1.1   tsubai 						/* DMAC start on mem->I/O */
   1634   1.1   tsubai 	}
   1635   1.1   tsubai }
   1636   1.1   tsubai 
   1637   1.1   tsubai #define MAX_TR_CNT24	((1 << 24) -1)
   1638   1.1   tsubai void
   1639   1.4   tsubai sc_dio_pad(sc, cs)
   1640   1.4   tsubai 	struct sc_softc *sc;
   1641   1.1   tsubai 	register VOLATILE struct sc_chan_stat *cs;
   1642   1.1   tsubai {
   1643   1.1   tsubai 	register int dummy;
   1644   1.1   tsubai 
   1645   1.1   tsubai 	if (cs->act_trcnt >= 0)
   1646   1.1   tsubai 		return;
   1647   1.4   tsubai 	sc->pad_start = 1;
   1648   1.1   tsubai 
   1649   1.1   tsubai 	SET_CNT(MAX_TR_CNT24);
   1650   1.4   tsubai 	SET_CMD(sc, SCMD_TR_PAD|R0_TRBE);
   1651   1.1   tsubai 	dummy = sc_cmonr & SC_PMASK;
   1652   1.1   tsubai 	DMAC_WAIT0;
   1653   1.1   tsubai 	if (dummy == DAT_IN)
   1654   1.1   tsubai 		dummy = sc_datr;		/* get data */
   1655   1.1   tsubai 	else
   1656   1.1   tsubai 		sc_datr = 0;			/* send data */
   1657   1.1   tsubai }
   1658   1.1   tsubai 
   1659   1.1   tsubai void
   1660   1.4   tsubai print_scsi_stat(sc)
   1661   1.4   tsubai 	struct sc_softc *sc;
   1662   1.1   tsubai {
   1663   1.4   tsubai 	printf("ipc=%d wrc=%d wbc=%d\n", sc->ipc, sc->wrc, sc->wbc);
   1664   1.1   tsubai }
   1665   1.1   tsubai 
   1666   1.1   tsubai /*
   1667   1.1   tsubai  *	return 0 if it was done.  Or retun TRUE if it is busy.
   1668   1.1   tsubai  */
   1669   1.1   tsubai int
   1670   1.4   tsubai sc_busy(sc, chan)
   1671   1.4   tsubai 	struct sc_softc *sc;
   1672   1.1   tsubai 	register int chan;
   1673   1.1   tsubai {
   1674   1.4   tsubai 	return ((int)sc->chan_stat[chan].scb);
   1675   1.1   tsubai }
   1676   1.1   tsubai 
   1677   1.1   tsubai 
   1678   1.1   tsubai /*
   1679   1.1   tsubai  *	append channel into Waiting Bus_free queue
   1680   1.1   tsubai  */
   1681   1.1   tsubai void
   1682   1.4   tsubai append_wb(sc, cs)
   1683   1.4   tsubai 	struct sc_softc *sc;
   1684   1.4   tsubai 	struct sc_chan_stat *cs;
   1685   1.1   tsubai {
   1686   1.4   tsubai 	int s;
   1687   1.1   tsubai 
   1688   1.1   tsubai 	s = splclock();			/* inhibit process switch */
   1689   1.4   tsubai 	if (sc->wbq_actf == NULL)
   1690   1.4   tsubai 		sc->wbq_actf = cs;
   1691   1.1   tsubai 	else
   1692   1.4   tsubai 		sc->wbq_actl->wb_next = cs;
   1693   1.4   tsubai 	sc->wbq_actl = cs;
   1694   1.4   tsubai 	cs->scb->istatus = INST_WAIT;
   1695   1.4   tsubai 	sc->wbc++;
   1696   1.1   tsubai 	splx(s);
   1697   1.1   tsubai }
   1698   1.1   tsubai 
   1699   1.1   tsubai /*
   1700   1.1   tsubai  *	get channel from Waiting Bus_free queue
   1701   1.1   tsubai  */
   1702   1.4   tsubai struct sc_chan_stat *
   1703   1.4   tsubai get_wb_chan(sc)
   1704   1.4   tsubai 	struct sc_softc *sc;
   1705   1.1   tsubai {
   1706   1.4   tsubai 	struct sc_chan_stat *cs;
   1707   1.4   tsubai 	int s;
   1708   1.1   tsubai 
   1709   1.1   tsubai 	s = splclock();			/* inhibit process switch */
   1710   1.4   tsubai 	cs = sc->wbq_actf;
   1711   1.4   tsubai 	if (cs && cs->chan_num == SC_OWNID)	/* needed? */
   1712   1.4   tsubai 		cs = NULL;
   1713   1.1   tsubai 	splx(s);
   1714   1.4   tsubai 	return cs;
   1715   1.1   tsubai }
   1716   1.1   tsubai 
   1717   1.1   tsubai /*
   1718   1.1   tsubai  *	release channel from Waiting Bus_free queue
   1719   1.1   tsubai  */
   1720   1.1   tsubai int
   1721   1.4   tsubai release_wb(sc)
   1722   1.4   tsubai 	struct sc_softc *sc;
   1723   1.1   tsubai {
   1724   1.4   tsubai 	struct sc_chan_stat *cs;
   1725   1.4   tsubai 	int error = 0;
   1726   1.4   tsubai 	int s;
   1727   1.1   tsubai 
   1728   1.1   tsubai 	s = splclock();			/* inhibit process switch */
   1729   1.4   tsubai 	if (sc->wbq_actf == NULL) {
   1730   1.1   tsubai 		error = -1;
   1731   1.1   tsubai 	} else {
   1732   1.4   tsubai 		cs = sc->wbq_actf;
   1733   1.4   tsubai 		sc->wbq_actf = cs->wb_next;
   1734   1.1   tsubai 		cs->wb_next = NULL;
   1735   1.4   tsubai 		if (sc->wbq_actl == cs)
   1736   1.4   tsubai 			sc->wbq_actl = NULL;
   1737   1.4   tsubai 		cs->scb->istatus &= ~INST_WAIT;
   1738   1.4   tsubai 		sc->wbc--;
   1739   1.1   tsubai 	}
   1740   1.1   tsubai 	splx(s);
   1741   1.4   tsubai 	return error;
   1742   1.1   tsubai }
   1743   1.1   tsubai 
   1744   1.1   tsubai void
   1745   1.4   tsubai adjust_transfer(sc, cs)
   1746   1.4   tsubai 	struct sc_softc *sc;
   1747   1.4   tsubai 	struct sc_chan_stat *cs;
   1748   1.1   tsubai {
   1749   1.4   tsubai 	struct sc_scb *scb = cs->scb;
   1750   1.4   tsubai 	u_int remain_cnt;
   1751   1.4   tsubai 	u_int offset, sent_byte;
   1752   1.1   tsubai 
   1753   1.4   tsubai 	if (sc->pad_start) {
   1754   1.4   tsubai 		sc->pad_start = 0;
   1755   1.1   tsubai 		remain_cnt = 0;
   1756   1.1   tsubai 	} else {
   1757   1.9  thorpej # if defined(__mips__) && defined(CPU_SINGLE)
   1758   1.1   tsubai 		remain_cnt = GET_CNT();
   1759   1.4   tsubai 		remain_cnt -= sc->pad_cnt[cs->chan_num];
   1760   1.4   tsubai 		if (sc->dma_stat == SC_DMAC_WR) {
   1761   1.1   tsubai 			/*
   1762   1.1   tsubai 			 * adjust counter in the FIFO
   1763   1.1   tsubai 			 */
   1764   1.1   tsubai 			remain_cnt += sc_ffstr & R5_FIFOREM;
   1765   1.1   tsubai 		}
   1766   1.1   tsubai # endif
   1767   1.1   tsubai 	}
   1768   1.1   tsubai 
   1769   1.4   tsubai 	sent_byte = scb->sc_ctrnscnt - remain_cnt;
   1770   1.1   tsubai 	cs->act_trcnt = remain_cnt;
   1771   1.1   tsubai 
   1772   1.4   tsubai 	offset = scb->sc_coffset + sent_byte;
   1773   1.1   tsubai 	cs->act_tag += (offset >> PGSHIFT);
   1774   1.1   tsubai 	cs->act_offset = offset & PGOFSET;
   1775   1.4   tsubai 	if ((scb->sc_map == NULL) || (scb->sc_map->mp_pages <= 0))
   1776   1.1   tsubai 		cs->act_point += sent_byte;
   1777   1.1   tsubai }
   1778   1.3   tsubai 
   1779   1.9  thorpej #ifdef __mips__
   1780   1.3   tsubai static void
   1781   1.4   tsubai clean_k2dcache(scb)
   1782   1.4   tsubai 	struct sc_scb *scb;
   1783   1.3   tsubai {
   1784   1.4   tsubai 	struct sc_map *sc_map = scb->sc_map;
   1785   1.5   tsubai 	paddr_t pa;
   1786   1.3   tsubai 	int i, pages;
   1787   1.3   tsubai 
   1788   1.5   tsubai 	pa = kvtophys((vaddr_t)scb->msgbuf);
   1789   1.8  thorpej 	mips_dcache_wbinv_range_index(MIPS_PHYS_TO_KSEG0(pa),
   1790   1.8  thorpej 	    sizeof(scb->msgbuf));
   1791   1.4   tsubai 
   1792   1.4   tsubai 	if (MACH_IS_USPACE(scb->sc_cpoint))
   1793   1.4   tsubai 		panic("clean_k2dcache: user address is not supported");
   1794   1.4   tsubai 
   1795   1.4   tsubai 	if (MACH_IS_CACHED(scb->sc_cpoint)) {
   1796   1.8  thorpej 		mips_dcache_wbinv_range_index((vaddr_t)scb->sc_cpoint,
   1797   1.8  thorpej 		    scb->sc_ctrnscnt);
   1798   1.3   tsubai 		return;
   1799   1.4   tsubai 	}
   1800   1.3   tsubai 
   1801   1.4   tsubai 	if (sc_map) {
   1802   1.4   tsubai 		pages = sc_map->mp_pages;
   1803   1.4   tsubai 		for (i = 0; i < pages; i++) {
   1804   1.4   tsubai 			pa = sc_map->mp_addr[i] << PGSHIFT;
   1805   1.8  thorpej 			mips_dcache_wbinv_range_index(MIPS_PHYS_TO_KSEG0(pa),
   1806  1.10  thorpej 			    PAGE_SIZE);
   1807   1.4   tsubai 		}
   1808   1.3   tsubai 	}
   1809   1.3   tsubai }
   1810   1.3   tsubai #endif
   1811