Home | History | Annotate | Line # | Download | only in ic
ninjascsi32.c revision 1.2
      1  1.2  thorpej /*	$NetBSD: ninjascsi32.c,v 1.2 2004/08/26 18:38:19 thorpej Exp $	*/
      2  1.1    itohy 
      3  1.1    itohy /*-
      4  1.1    itohy  * Copyright (c) 2004 The NetBSD Foundation, Inc.
      5  1.1    itohy  * All rights reserved.
      6  1.1    itohy  *
      7  1.1    itohy  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1    itohy  * by ITOH Yasufumi.
      9  1.1    itohy  *
     10  1.1    itohy  * Redistribution and use in source and binary forms, with or without
     11  1.1    itohy  * modification, are permitted provided that the following conditions
     12  1.1    itohy  * are met:
     13  1.1    itohy  * 1. Redistributions of source code must retain the above copyright
     14  1.1    itohy  *    notice, this list of conditions and the following disclaimer.
     15  1.1    itohy  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1    itohy  *    notice, this list of conditions and the following disclaimer in the
     17  1.1    itohy  *    documentation and/or other materials provided with the distribution.
     18  1.1    itohy  * 3. All advertising materials mentioning features or use of this software
     19  1.1    itohy  *    must display the following acknowledgement:
     20  1.1    itohy  *	This product includes software developed by the NetBSD
     21  1.1    itohy  *	Foundation, Inc. and its contributors.
     22  1.1    itohy  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.1    itohy  *    contributors may be used to endorse or promote products derived
     24  1.1    itohy  *    from this software without specific prior written permission.
     25  1.1    itohy  *
     26  1.1    itohy  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.1    itohy  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.1    itohy  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.1    itohy  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.1    itohy  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.1    itohy  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.1    itohy  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.1    itohy  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.1    itohy  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.1    itohy  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.1    itohy  * POSSIBILITY OF SUCH DAMAGE.
     37  1.1    itohy  */
     38  1.1    itohy 
     39  1.1    itohy #include <sys/cdefs.h>
     40  1.2  thorpej __KERNEL_RCSID(0, "$NetBSD: ninjascsi32.c,v 1.2 2004/08/26 18:38:19 thorpej Exp $");
     41  1.1    itohy 
     42  1.1    itohy #include <sys/param.h>
     43  1.1    itohy #include <sys/systm.h>
     44  1.1    itohy #include <sys/callout.h>
     45  1.1    itohy #include <sys/device.h>
     46  1.1    itohy #include <sys/kernel.h>
     47  1.1    itohy #include <sys/buf.h>
     48  1.1    itohy #include <sys/scsiio.h>
     49  1.1    itohy 
     50  1.1    itohy #include <machine/bus.h>
     51  1.1    itohy #include <machine/intr.h>
     52  1.1    itohy 
     53  1.1    itohy #include <uvm/uvm_extern.h>
     54  1.1    itohy 
     55  1.1    itohy #include <dev/scsipi/scsi_all.h>
     56  1.1    itohy #include <dev/scsipi/scsipi_all.h>
     57  1.1    itohy #include <dev/scsipi/scsiconf.h>
     58  1.1    itohy #include <dev/scsipi/scsi_message.h>
     59  1.1    itohy 
     60  1.1    itohy /*
     61  1.1    itohy  * DualEdge transfer support
     62  1.1    itohy  */
     63  1.1    itohy /* #define NJSC32_DUALEDGE */	/* XXX untested */
     64  1.1    itohy 
     65  1.1    itohy /*
     66  1.1    itohy  * Auto param loading does not work properly (it partially works (works on
     67  1.1    itohy  * start, doesn't on restart) on rev 0x54, it doesn't work at all on rev 0x51),
     68  1.1    itohy  * and it doesn't improve the performance so much,
     69  1.1    itohy  * forget about it.
     70  1.1    itohy  */
     71  1.1    itohy #undef NJSC32_AUTOPARAM
     72  1.1    itohy 
     73  1.1    itohy #include <dev/ic/ninjascsi32reg.h>
     74  1.1    itohy #include <dev/ic/ninjascsi32var.h>
     75  1.1    itohy 
     76  1.1    itohy /* #define NJSC32_DEBUG */
     77  1.1    itohy /* #define NJSC32_TRACE */
     78  1.1    itohy 
     79  1.1    itohy #ifdef NJSC32_DEBUG
     80  1.1    itohy #define DPRINTF(x)	printf x
     81  1.1    itohy #define DPRINTC(cmd, x)	PRINTC(cmd, x)
     82  1.1    itohy #else
     83  1.1    itohy #define DPRINTF(x)
     84  1.1    itohy #define DPRINTC(cmd, x)
     85  1.1    itohy #endif
     86  1.1    itohy #ifdef NJSC32_TRACE
     87  1.1    itohy #define TPRINTF(x)	printf x
     88  1.1    itohy #define TPRINTC(cmd, x)	PRINTC(cmd, x)
     89  1.1    itohy #else
     90  1.1    itohy #define TPRINTF(x)
     91  1.1    itohy #define TPRINTC(cmd, x)
     92  1.1    itohy #endif
     93  1.1    itohy 
     94  1.1    itohy #define PRINTC(cmd, x)	do {					\
     95  1.1    itohy 		scsi_print_addr((cmd)->c_xs->xs_periph);	\
     96  1.1    itohy 		printf x;					\
     97  1.1    itohy 	} while (/* CONSTCOND */ 0)
     98  1.1    itohy 
     99  1.2  thorpej static void	njsc32_scsipi_request(struct scsipi_channel *,
    100  1.2  thorpej 		    scsipi_adapter_req_t, void *);
    101  1.2  thorpej static void	njsc32_scsipi_minphys(struct buf *buf);
    102  1.2  thorpej static int	njsc32_scsipi_ioctl(struct scsipi_channel *, u_long, caddr_t,
    103  1.2  thorpej 		    int, struct proc *);
    104  1.2  thorpej 
    105  1.2  thorpej static void	njsc32_init(struct njsc32_softc *, int nosleep);
    106  1.2  thorpej static int	njsc32_init_cmds(struct njsc32_softc *);
    107  1.2  thorpej static void	njsc32_target_async(struct njsc32_softc *,
    108  1.2  thorpej 		    struct njsc32_target *);
    109  1.2  thorpej static void	njsc32_init_targets(struct njsc32_softc *);
    110  1.2  thorpej static void	njsc32_add_msgout(struct njsc32_softc *, int);
    111  1.2  thorpej static u_int32_t njsc32_get_auto_msgout(struct njsc32_softc *);
    112  1.1    itohy #ifdef NJSC32_DUALEDGE
    113  1.2  thorpej static void	njsc32_msgout_wdtr(struct njsc32_softc *, int);
    114  1.1    itohy #endif
    115  1.2  thorpej static void	njsc32_msgout_sdtr(struct njsc32_softc *, int period,
    116  1.2  thorpej 		    int offset);
    117  1.2  thorpej static void	njsc32_negotiate_xfer(struct njsc32_softc *,
    118  1.2  thorpej 		    struct njsc32_target *);
    119  1.2  thorpej static void	njsc32_arbitration_failed(struct njsc32_softc *);
    120  1.2  thorpej static void	njsc32_start(struct njsc32_softc *);
    121  1.2  thorpej static void	njsc32_run_xfer(struct njsc32_softc *, struct scsipi_xfer *);
    122  1.2  thorpej static void	njsc32_end_cmd(struct njsc32_softc *, struct njsc32_cmd *,
    123  1.2  thorpej 		    scsipi_xfer_result_t);
    124  1.2  thorpej static void	njsc32_reset_bus(struct njsc32_softc *);
    125  1.2  thorpej static void	njsc32_clear_cmds(struct njsc32_softc *,
    126  1.2  thorpej 		    scsipi_xfer_result_t);
    127  1.2  thorpej static void	njsc32_reset_detected(struct njsc32_softc *);
    128  1.2  thorpej static void	njsc32_set_ptr(struct njsc32_softc *, struct njsc32_cmd *,
    129  1.2  thorpej 		    u_int32_t);
    130  1.2  thorpej static void	njsc32_assert_ack(struct njsc32_softc *);
    131  1.2  thorpej static void	njsc32_negate_ack(struct njsc32_softc *);
    132  1.2  thorpej static void	njsc32_wait_req_negate(struct njsc32_softc *);
    133  1.2  thorpej static void	njsc32_reconnect(struct njsc32_softc *, struct njsc32_cmd *);
    134  1.1    itohy enum njsc32_reselstat {
    135  1.1    itohy 	NJSC32_RESEL_ERROR,		/* to be rejected */
    136  1.1    itohy 	NJSC32_RESEL_COMPLETE,		/* reselection is just complete */
    137  1.1    itohy 	NJSC32_RESEL_THROUGH		/* this message is OK (no reply) */
    138  1.1    itohy };
    139  1.2  thorpej static enum njsc32_reselstat njsc32_resel_identify(struct njsc32_softc *,
    140  1.2  thorpej 		    int lun, struct njsc32_cmd **);
    141  1.2  thorpej static enum njsc32_reselstat njsc32_resel_tag(struct njsc32_softc *,
    142  1.2  thorpej 		    int tag, struct njsc32_cmd **);
    143  1.2  thorpej static void	njsc32_cmd_reload(struct njsc32_softc *, struct njsc32_cmd *,
    144  1.2  thorpej 		    int);
    145  1.2  thorpej static void	njsc32_update_xfer_mode(struct njsc32_softc *,
    146  1.2  thorpej 		    struct njsc32_target *);
    147  1.2  thorpej static void	njsc32_msgin(struct njsc32_softc *);
    148  1.2  thorpej static void	njsc32_msgout(struct njsc32_softc *);
    149  1.2  thorpej static void	njsc32_cmdtimeout(void *);
    150  1.2  thorpej static void	njsc32_reseltimeout(void *);
    151  1.1    itohy 
    152  1.1    itohy static __inline unsigned
    153  1.2  thorpej njsc32_read_1(struct njsc32_softc *sc, int no)
    154  1.1    itohy {
    155  1.1    itohy 
    156  1.1    itohy 	return bus_space_read_1(sc->sc_regt, sc->sc_regh, no);
    157  1.1    itohy }
    158  1.1    itohy 
    159  1.1    itohy static __inline unsigned
    160  1.2  thorpej njsc32_read_2(struct njsc32_softc *sc, int no)
    161  1.1    itohy {
    162  1.1    itohy 
    163  1.1    itohy 	return bus_space_read_2(sc->sc_regt, sc->sc_regh, no);
    164  1.1    itohy }
    165  1.1    itohy 
    166  1.1    itohy static __inline u_int32_t
    167  1.2  thorpej njsc32_read_4(struct njsc32_softc *sc, int no)
    168  1.1    itohy {
    169  1.1    itohy 
    170  1.1    itohy 	return bus_space_read_4(sc->sc_regt, sc->sc_regh, no);
    171  1.1    itohy }
    172  1.1    itohy 
    173  1.1    itohy static __inline void
    174  1.2  thorpej njsc32_write_1(struct njsc32_softc *sc, int no, int val)
    175  1.1    itohy {
    176  1.1    itohy 
    177  1.1    itohy 	bus_space_write_1(sc->sc_regt, sc->sc_regh, no, val);
    178  1.1    itohy }
    179  1.1    itohy 
    180  1.1    itohy static __inline void
    181  1.2  thorpej njsc32_write_2(struct njsc32_softc *sc, int no, int val)
    182  1.1    itohy {
    183  1.1    itohy 
    184  1.1    itohy 	bus_space_write_2(sc->sc_regt, sc->sc_regh, no, val);
    185  1.1    itohy }
    186  1.1    itohy 
    187  1.1    itohy static __inline void
    188  1.2  thorpej njsc32_write_4(struct njsc32_softc *sc, int no, u_int32_t val)
    189  1.1    itohy {
    190  1.1    itohy 
    191  1.1    itohy 	bus_space_write_4(sc->sc_regt, sc->sc_regh, no, val);
    192  1.1    itohy }
    193  1.1    itohy 
    194  1.1    itohy static __inline unsigned
    195  1.2  thorpej njsc32_ireg_read_1(struct njsc32_softc *sc, int no)
    196  1.1    itohy {
    197  1.1    itohy 
    198  1.1    itohy 	bus_space_write_1(sc->sc_regt, sc->sc_regh, NJSC32_REG_INDEX, no);
    199  1.1    itohy 	return bus_space_read_1(sc->sc_regt, sc->sc_regh, NJSC32_REG_DATA_LOW);
    200  1.1    itohy }
    201  1.1    itohy 
    202  1.1    itohy static __inline unsigned
    203  1.2  thorpej njsc32_ireg_read_2(struct njsc32_softc *sc, int no)
    204  1.1    itohy {
    205  1.1    itohy 
    206  1.1    itohy 	bus_space_write_1(sc->sc_regt, sc->sc_regh, NJSC32_REG_INDEX, no);
    207  1.1    itohy 	return bus_space_read_2(sc->sc_regt, sc->sc_regh, NJSC32_REG_DATA_LOW);
    208  1.1    itohy }
    209  1.1    itohy 
    210  1.1    itohy static __inline u_int32_t
    211  1.2  thorpej njsc32_ireg_read_4(struct njsc32_softc *sc, int no)
    212  1.1    itohy {
    213  1.1    itohy 	u_int32_t val;
    214  1.1    itohy 
    215  1.1    itohy 	bus_space_write_1(sc->sc_regt, sc->sc_regh, NJSC32_REG_INDEX, no);
    216  1.1    itohy 	val = (u_int16_t)bus_space_read_2(sc->sc_regt, sc->sc_regh,
    217  1.1    itohy 	    NJSC32_REG_DATA_LOW);
    218  1.1    itohy 	return val | (bus_space_read_2(sc->sc_regt, sc->sc_regh,
    219  1.1    itohy 	    NJSC32_REG_DATA_HIGH) << 16);
    220  1.1    itohy }
    221  1.1    itohy 
    222  1.1    itohy static __inline void
    223  1.2  thorpej njsc32_ireg_write_1(struct njsc32_softc *sc, int no, int val)
    224  1.1    itohy {
    225  1.1    itohy 
    226  1.1    itohy 	bus_space_write_1(sc->sc_regt, sc->sc_regh, NJSC32_REG_INDEX, no);
    227  1.1    itohy 	bus_space_write_1(sc->sc_regt, sc->sc_regh, NJSC32_REG_DATA_LOW, val);
    228  1.1    itohy }
    229  1.1    itohy 
    230  1.1    itohy static __inline void
    231  1.2  thorpej njsc32_ireg_write_2(struct njsc32_softc *sc, int no, int val)
    232  1.1    itohy {
    233  1.1    itohy 
    234  1.1    itohy 	bus_space_write_1(sc->sc_regt, sc->sc_regh, NJSC32_REG_INDEX, no);
    235  1.1    itohy 	bus_space_write_2(sc->sc_regt, sc->sc_regh, NJSC32_REG_DATA_LOW, val);
    236  1.1    itohy }
    237  1.1    itohy 
    238  1.1    itohy static __inline void
    239  1.2  thorpej njsc32_ireg_write_4(struct njsc32_softc *sc, int no, u_int32_t val)
    240  1.1    itohy {
    241  1.1    itohy 
    242  1.1    itohy 	bus_space_write_1(sc->sc_regt, sc->sc_regh, NJSC32_REG_INDEX, no);
    243  1.1    itohy 	bus_space_write_2(sc->sc_regt, sc->sc_regh, NJSC32_REG_DATA_LOW, val);
    244  1.1    itohy 	bus_space_write_2(sc->sc_regt, sc->sc_regh, NJSC32_REG_DATA_HIGH,
    245  1.1    itohy 	    val >> 16);
    246  1.1    itohy }
    247  1.1    itohy 
    248  1.1    itohy #define NS(ns)	((ns) / 4)	/* nanosecond (>= 50) -> sync value */
    249  1.1    itohy #ifdef __STDC__
    250  1.1    itohy # define ACKW(n)	NJSC32_ACK_WIDTH_ ## n ## CLK
    251  1.1    itohy # define SMPL(n)	(NJSC32_SREQ_SAMPLING_ ## n ## CLK |	\
    252  1.1    itohy 			 NJSC32_SREQ_SAMPLING_ENABLE)
    253  1.1    itohy #else
    254  1.1    itohy # define ACKW(n)	NJSC32_ACK_WIDTH_/**/n/**/CLK
    255  1.1    itohy # define SMPL(n)	(NJSC32_SREQ_SAMPLING_/**/n/**/CLK |	\
    256  1.1    itohy 			 NJSC32_SREQ_SAMPLING_ENABLE)
    257  1.1    itohy #endif
    258  1.1    itohy 
    259  1.1    itohy #define NJSC32_NSYNCT_MAXSYNC	1
    260  1.1    itohy #define NJSC32_NSYNCT		16
    261  1.1    itohy 
    262  1.1    itohy /* 40MHz (25ns) */
    263  1.1    itohy static const struct njsc32_sync_param njsc32_synct_40M[NJSC32_NSYNCT] = {
    264  1.1    itohy 	{ 0, 0, 0 },			/* dummy for async */
    265  1.1    itohy 	{ NS( 50), ACKW(1), 0       },	/* 20.0 :  50ns,  25ns */
    266  1.1    itohy 	{ NS( 75), ACKW(1), SMPL(1) },	/* 13.3 :  75ns,  25ns */
    267  1.1    itohy 	{ NS(100), ACKW(2), SMPL(1) },	/* 10.0 : 100ns,  50ns */
    268  1.1    itohy 	{ NS(125), ACKW(2), SMPL(2) },	/*  8.0 : 125ns,  50ns */
    269  1.1    itohy 	{ NS(150), ACKW(3), SMPL(2) },	/*  6.7 : 150ns,  75ns */
    270  1.1    itohy 	{ NS(175), ACKW(3), SMPL(2) },	/*  5.7 : 175ns,  75ns */
    271  1.1    itohy 	{ NS(200), ACKW(4), SMPL(2) },	/*  5.0 : 200ns, 100ns */
    272  1.1    itohy 	{ NS(225), ACKW(4), SMPL(4) },	/*  4.4 : 225ns, 100ns */
    273  1.1    itohy 	{ NS(250), ACKW(4), SMPL(4) },	/*  4.0 : 250ns, 100ns */
    274  1.1    itohy 	{ NS(275), ACKW(4), SMPL(4) },	/*  3.64: 275ns, 100ns */
    275  1.1    itohy 	{ NS(300), ACKW(4), SMPL(4) },	/*  3.33: 300ns, 100ns */
    276  1.1    itohy 	{ NS(325), ACKW(4), SMPL(4) },	/*  3.01: 325ns, 100ns */
    277  1.1    itohy 	{ NS(350), ACKW(4), SMPL(4) },	/*  2.86: 350ns, 100ns */
    278  1.1    itohy 	{ NS(375), ACKW(4), SMPL(4) },	/*  2.67: 375ns, 100ns */
    279  1.1    itohy 	{ NS(400), ACKW(4), SMPL(4) }	/*  2.50: 400ns, 100ns */
    280  1.1    itohy };
    281  1.1    itohy 
    282  1.1    itohy #ifdef NJSC32_SUPPORT_OTHER_CLOCKS
    283  1.1    itohy /* 20MHz (50ns) */
    284  1.1    itohy static const struct njsc32_sync_param njsc32_synct_20M[NJSC32_NSYNCT] = {
    285  1.1    itohy 	{ 0, 0, 0 },			/* dummy for async */
    286  1.1    itohy 	{ NS(100), ACKW(1), 0       },	/* 10.0 : 100ns,  50ns */
    287  1.1    itohy 	{ NS(150), ACKW(1), SMPL(2) },	/*  6.7 : 150ns,  50ns */
    288  1.1    itohy 	{ NS(200), ACKW(2), SMPL(2) },	/*  5.0 : 200ns, 100ns */
    289  1.1    itohy 	{ NS(250), ACKW(2), SMPL(4) },	/*  4.0 : 250ns, 100ns */
    290  1.1    itohy 	{ NS(300), ACKW(3), SMPL(4) },	/*  3.3 : 300ns, 150ns */
    291  1.1    itohy 	{ NS(350), ACKW(3), SMPL(4) },	/*  2.8 : 350ns, 150ns */
    292  1.1    itohy 	{ NS(400), ACKW(4), SMPL(4) },	/*  2.5 : 400ns, 200ns */
    293  1.1    itohy 	{ NS(450), ACKW(4), SMPL(4) },	/*  2.2 : 450ns, 200ns */
    294  1.1    itohy 	{ NS(500), ACKW(4), SMPL(4) },	/*  2.0 : 500ns, 200ns */
    295  1.1    itohy 	{ NS(550), ACKW(4), SMPL(4) },	/*  1.82: 550ns, 200ns */
    296  1.1    itohy 	{ NS(600), ACKW(4), SMPL(4) },	/*  1.67: 600ns, 200ns */
    297  1.1    itohy 	{ NS(650), ACKW(4), SMPL(4) },	/*  1.54: 650ns, 200ns */
    298  1.1    itohy 	{ NS(700), ACKW(4), SMPL(4) },	/*  1.43: 700ns, 200ns */
    299  1.1    itohy 	{ NS(750), ACKW(4), SMPL(4) },	/*  1.33: 750ns, 200ns */
    300  1.1    itohy 	{ NS(800), ACKW(4), SMPL(4) }	/*  1.25: 800ns, 200ns */
    301  1.1    itohy };
    302  1.1    itohy 
    303  1.1    itohy /* 33.3MHz (30ns) */
    304  1.1    itohy static const struct njsc32_sync_param njsc32_synct_pci[NJSC32_NSYNCT] = {
    305  1.1    itohy 	{ 0, 0, 0 },			/* dummy for async */
    306  1.1    itohy 	{ NS( 60), ACKW(1), 0       },	/* 16.6 :  60ns,  30ns */
    307  1.1    itohy 	{ NS( 90), ACKW(1), SMPL(1) },	/* 11.1 :  90ns,  30ns */
    308  1.1    itohy 	{ NS(120), ACKW(2), SMPL(2) },	/*  8.3 : 120ns,  60ns */
    309  1.1    itohy 	{ NS(150), ACKW(2), SMPL(2) },	/*  6.7 : 150ns,  60ns */
    310  1.1    itohy 	{ NS(180), ACKW(3), SMPL(2) },	/*  5.6 : 180ns,  90ns */
    311  1.1    itohy 	{ NS(210), ACKW(3), SMPL(4) },	/*  4.8 : 210ns,  90ns */
    312  1.1    itohy 	{ NS(240), ACKW(4), SMPL(4) },	/*  4.2 : 240ns, 120ns */
    313  1.1    itohy 	{ NS(270), ACKW(4), SMPL(4) },	/*  3.7 : 270ns, 120ns */
    314  1.1    itohy 	{ NS(300), ACKW(4), SMPL(4) },	/*  3.3 : 300ns, 120ns */
    315  1.1    itohy 	{ NS(330), ACKW(4), SMPL(4) },	/*  3.0 : 330ns, 120ns */
    316  1.1    itohy 	{ NS(360), ACKW(4), SMPL(4) },	/*  2.8 : 360ns, 120ns */
    317  1.1    itohy 	{ NS(390), ACKW(4), SMPL(4) },	/*  2.6 : 390ns, 120ns */
    318  1.1    itohy 	{ NS(420), ACKW(4), SMPL(4) },	/*  2.4 : 420ns, 120ns */
    319  1.1    itohy 	{ NS(450), ACKW(4), SMPL(4) },	/*  2.2 : 450ns, 120ns */
    320  1.1    itohy 	{ NS(480), ACKW(4), SMPL(4) }	/*  2.1 : 480ns, 120ns */
    321  1.1    itohy };
    322  1.1    itohy #endif	/* NJSC32_SUPPORT_OTHER_CLOCKS */
    323  1.1    itohy 
    324  1.1    itohy #undef NS
    325  1.1    itohy #undef ACKW
    326  1.1    itohy #undef SMPL
    327  1.1    itohy 
    328  1.1    itohy /* initialize device */
    329  1.1    itohy static void
    330  1.2  thorpej njsc32_init(struct njsc32_softc *sc, int nosleep)
    331  1.1    itohy {
    332  1.1    itohy 	u_int16_t intstat;
    333  1.1    itohy 
    334  1.1    itohy 	/* block all interrupts */
    335  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_IRQ, NJSC32_IRQ_MASK_ALL);
    336  1.1    itohy 
    337  1.1    itohy 	/* clear transfer */
    338  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER, 0);
    339  1.1    itohy 	njsc32_write_4(sc, NJSC32_REG_BM_CNT, 0);
    340  1.1    itohy 
    341  1.1    itohy 	/* make sure interrupts are cleared */
    342  1.1    itohy 	/* XXX loop forever? */
    343  1.1    itohy 	while ((intstat = njsc32_read_2(sc, NJSC32_REG_IRQ)) &
    344  1.1    itohy 	    NJSC32_IRQ_INTR_PENDING) {
    345  1.1    itohy 		DPRINTF(("%s: njsc32_init: intr pending: %#x\n",
    346  1.1    itohy 		    sc->sc_dev.dv_xname, intstat));
    347  1.1    itohy 	}
    348  1.1    itohy 
    349  1.1    itohy 	/* FIFO threshold */
    350  1.1    itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_FIFO_THRESHOLD_FULL,
    351  1.1    itohy 	    NJSC32_FIFO_FULL_BUSMASTER);
    352  1.1    itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_FIFO_THRESHOLD_EMPTY,
    353  1.1    itohy 	    NJSC32_FIFO_EMPTY_BUSMASTER);
    354  1.1    itohy 
    355  1.1    itohy 	/* clock source */
    356  1.1    itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_CLOCK, sc->sc_clk);
    357  1.1    itohy 
    358  1.1    itohy 	/* memory read multiple */
    359  1.1    itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_BM,
    360  1.1    itohy 	    NJSC32_BM_MEMRD_CMD1 | NJSC32_BM_SGT_AUTO_PARA_MEMRD_CMD);
    361  1.1    itohy 
    362  1.1    itohy 	/* clear parity error and enable parity detection */
    363  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_PARITY_CONTROL,
    364  1.1    itohy 	    NJSC32_PARITYCTL_CHECK_ENABLE | NJSC32_PARITYCTL_CLEAR_ERROR);
    365  1.1    itohy 
    366  1.1    itohy 	/* misc configuration */
    367  1.1    itohy 	njsc32_ireg_write_2(sc, NJSC32_IREG_MISC,
    368  1.1    itohy 	    NJSC32_MISC_SCSI_DIRECTION_DETECTOR_SELECT |
    369  1.1    itohy 	    NJSC32_MISC_DELAYED_BMSTART |
    370  1.1    itohy 	    NJSC32_MISC_MASTER_TERMINATION_SELECT |
    371  1.1    itohy 	    NJSC32_MISC_BMREQ_NEGATE_TIMING_SEL |
    372  1.1    itohy 	    NJSC32_MISC_AUTOSEL_TIMING_SEL |
    373  1.1    itohy 	    NJSC32_MISC_BMSTOP_CHANGE2_NONDATA_PHASE);
    374  1.1    itohy 
    375  1.1    itohy 	/*
    376  1.1    itohy 	 * Check for termination power (32Bi only?).
    377  1.1    itohy 	 */
    378  1.1    itohy 	if (!nosleep || cold) {
    379  1.1    itohy 		DPRINTF(("%s: njsc32_init: checking TERMPWR\n",
    380  1.1    itohy 		    sc->sc_dev.dv_xname));
    381  1.1    itohy 
    382  1.1    itohy 		/* First, turn termination power off */
    383  1.1    itohy 		njsc32_ireg_write_1(sc, NJSC32_IREG_TERM_PWR, 0);
    384  1.1    itohy 
    385  1.1    itohy 		/* give 0.5s to settle */
    386  1.1    itohy 		if (nosleep)
    387  1.1    itohy 			delay(500000);
    388  1.1    itohy 		else
    389  1.1    itohy 			tsleep(sc, PWAIT, "njs_t1", hz / 2);
    390  1.1    itohy 	}
    391  1.1    itohy 
    392  1.1    itohy 	/* supply termination power if not supplied by other devices */
    393  1.1    itohy 	if ((njsc32_ireg_read_1(sc, NJSC32_IREG_TERM_PWR) &
    394  1.1    itohy 	    NJSC32_TERMPWR_SENSE) == 0) {
    395  1.1    itohy 		/* termination power is not present on the bus */
    396  1.1    itohy 		if (sc->sc_flags & NJSC32_CANNOT_SUPPLY_TERMPWR) {
    397  1.1    itohy 			/*
    398  1.1    itohy 			 * CardBus device must not supply termination power
    399  1.1    itohy 			 * to avoid excessive power consumption.
    400  1.1    itohy 			 */
    401  1.1    itohy 			printf("%s: no termination power present\n",
    402  1.1    itohy 			    sc->sc_dev.dv_xname);
    403  1.1    itohy 		} else {
    404  1.1    itohy 			/* supply termination power */
    405  1.1    itohy 			njsc32_ireg_write_1(sc, NJSC32_IREG_TERM_PWR,
    406  1.1    itohy 			    NJSC32_TERMPWR_BPWR);
    407  1.1    itohy 
    408  1.1    itohy 			DPRINTF(("%s: supplying termination power\n",
    409  1.1    itohy 			    sc->sc_dev.dv_xname));
    410  1.1    itohy 
    411  1.1    itohy 			/* give 0.5s to settle */
    412  1.1    itohy 			if (!nosleep)
    413  1.1    itohy 				tsleep(sc, PWAIT, "njs_t2", hz / 2);
    414  1.1    itohy 		}
    415  1.1    itohy 	}
    416  1.1    itohy 
    417  1.1    itohy 	/* stop timer */
    418  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TIMER, NJSC32_TIMER_STOP);
    419  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TIMER, NJSC32_TIMER_STOP);
    420  1.1    itohy 
    421  1.1    itohy 	/* default transfer parameter */
    422  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SYNC, 0);
    423  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_ACK_WIDTH, NJSC32_ACK_WIDTH_1CLK);
    424  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_SEL_TIMEOUT,
    425  1.1    itohy 	    NJSC32_SEL_TIMEOUT_TIME);
    426  1.1    itohy 
    427  1.1    itohy 	/* select interrupt source */
    428  1.1    itohy 	njsc32_ireg_write_2(sc, NJSC32_IREG_IRQ_SELECT,
    429  1.1    itohy 	    NJSC32_IRQSEL_RESELECT |
    430  1.1    itohy 	    NJSC32_IRQSEL_PHASE_CHANGE |
    431  1.1    itohy 	    NJSC32_IRQSEL_SCSIRESET |
    432  1.1    itohy 	    NJSC32_IRQSEL_TIMER |
    433  1.1    itohy 	    NJSC32_IRQSEL_FIFO_THRESHOLD |
    434  1.1    itohy 	    NJSC32_IRQSEL_TARGET_ABORT |
    435  1.1    itohy 	    NJSC32_IRQSEL_MASTER_ABORT |
    436  1.1    itohy 	/* XXX not yet
    437  1.1    itohy 	    NJSC32_IRQSEL_SERR |
    438  1.1    itohy 	    NJSC32_IRQSEL_PERR |
    439  1.1    itohy 	    NJSC32_IRQSEL_BMCNTERR |
    440  1.1    itohy 	*/
    441  1.1    itohy 	    NJSC32_IRQSEL_AUTO_SCSI_SEQ);
    442  1.1    itohy 
    443  1.1    itohy 	/* unblock interrupts */
    444  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_IRQ, 0);
    445  1.1    itohy 
    446  1.1    itohy 	/* turn LED off */
    447  1.1    itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_EXT_PORT_DDR,
    448  1.1    itohy 	    NJSC32_EXTPORT_LED_OFF);
    449  1.1    itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_EXT_PORT,
    450  1.1    itohy 	    NJSC32_EXTPORT_LED_OFF);
    451  1.1    itohy 
    452  1.1    itohy 	/* reset SCSI bus so the targets become known state */
    453  1.1    itohy 	njsc32_reset_bus(sc);
    454  1.1    itohy }
    455  1.1    itohy 
    456  1.1    itohy static int
    457  1.2  thorpej njsc32_init_cmds(struct njsc32_softc *sc)
    458  1.1    itohy {
    459  1.1    itohy 	struct njsc32_cmd *cmd;
    460  1.1    itohy 	bus_addr_t dmaaddr;
    461  1.1    itohy 	int i, error;
    462  1.1    itohy 
    463  1.1    itohy 	/*
    464  1.1    itohy 	 * allocate DMA area for command
    465  1.1    itohy 	 */
    466  1.1    itohy 	if ((error = bus_dmamem_alloc(sc->sc_dmat,
    467  1.1    itohy 	    sizeof(struct njsc32_dma_page), PAGE_SIZE, 0,
    468  1.1    itohy 	    &sc->sc_cmdpg_seg, 1, &sc->sc_cmdpg_nsegs, BUS_DMA_NOWAIT)) != 0) {
    469  1.1    itohy 		printf("%s: unable to allocate cmd page, error = %d\n",
    470  1.1    itohy 		    sc->sc_dev.dv_xname, error);
    471  1.1    itohy 		return 0;
    472  1.1    itohy 	}
    473  1.1    itohy 	if ((error = bus_dmamem_map(sc->sc_dmat, &sc->sc_cmdpg_seg,
    474  1.1    itohy 	    sc->sc_cmdpg_nsegs, sizeof(struct njsc32_dma_page),
    475  1.1    itohy 	    (caddr_t *)&sc->sc_cmdpg,
    476  1.1    itohy 	    BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
    477  1.1    itohy 		printf("%s: unable to map cmd page, error = %d\n",
    478  1.1    itohy 		    sc->sc_dev.dv_xname, error);
    479  1.1    itohy 		goto fail1;
    480  1.1    itohy 	}
    481  1.1    itohy 	if ((error = bus_dmamap_create(sc->sc_dmat,
    482  1.1    itohy 	    sizeof(struct njsc32_dma_page), 1,
    483  1.1    itohy 	    sizeof(struct njsc32_dma_page), 0, BUS_DMA_NOWAIT,
    484  1.1    itohy 	    &sc->sc_dmamap_cmdpg)) != 0) {
    485  1.1    itohy 		printf("%s: unable to create cmd DMA map, error = %d\n",
    486  1.1    itohy 		    sc->sc_dev.dv_xname, error);
    487  1.1    itohy 		goto fail2;
    488  1.1    itohy 	}
    489  1.1    itohy 	if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap_cmdpg,
    490  1.1    itohy 	    sc->sc_cmdpg, sizeof(struct njsc32_dma_page),
    491  1.1    itohy 	    NULL, BUS_DMA_NOWAIT)) != 0) {
    492  1.1    itohy 		printf("%s: unable to load cmd DMA map, error = %d\n",
    493  1.1    itohy 		    sc->sc_dev.dv_xname, error);
    494  1.1    itohy 		goto fail3;
    495  1.1    itohy 	}
    496  1.1    itohy 
    497  1.1    itohy 	memset(sc->sc_cmdpg, 0, sizeof(struct njsc32_dma_page));
    498  1.1    itohy 	dmaaddr = sc->sc_dmamap_cmdpg->dm_segs[0].ds_addr;
    499  1.1    itohy 
    500  1.1    itohy #ifdef NJSC32_AUTOPARAM
    501  1.1    itohy 	sc->sc_ap_dma = dmaaddr + offsetof(struct njsc32_dma_page, dp_ap);
    502  1.1    itohy #endif
    503  1.1    itohy 
    504  1.1    itohy 	for (i = 0; i < NJSC32_NUM_CMD; i++) {
    505  1.1    itohy 		cmd = &sc->sc_cmds[i];
    506  1.1    itohy 		cmd->c_sc = sc;
    507  1.1    itohy 		cmd->c_sgt = sc->sc_cmdpg->dp_sg[i];
    508  1.1    itohy 		cmd->c_sgt_dma = dmaaddr +
    509  1.1    itohy 		    offsetof(struct njsc32_dma_page, dp_sg[i]);
    510  1.1    itohy 		cmd->c_flags = 0;
    511  1.1    itohy 
    512  1.1    itohy 		error = bus_dmamap_create(sc->sc_dmat,
    513  1.1    itohy 		    NJSC32_MAX_XFER,		/* max total map size */
    514  1.1    itohy 		    NJSC32_NUM_SG,		/* max number of segments */
    515  1.1    itohy 		    NJSC32_SGT_MAXSEGLEN,	/* max size of a segment */
    516  1.1    itohy 		    0,				/* boundary */
    517  1.1    itohy 		    BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &cmd->c_dmamap_xfer);
    518  1.1    itohy 		if (error) {
    519  1.1    itohy 			printf("%s: only %d cmd descs available (error = %d)\n",
    520  1.1    itohy 			    sc->sc_dev.dv_xname, i, error);
    521  1.1    itohy 			break;
    522  1.1    itohy 		}
    523  1.1    itohy 		TAILQ_INSERT_TAIL(&sc->sc_freecmd, cmd, c_q);
    524  1.1    itohy 	}
    525  1.1    itohy 
    526  1.1    itohy 	if (i > 0)
    527  1.1    itohy 		return i;
    528  1.1    itohy 
    529  1.1    itohy fail3:	bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap_cmdpg);
    530  1.1    itohy fail2:	bus_dmamem_unmap(sc->sc_dmat, (caddr_t)sc->sc_cmdpg,
    531  1.1    itohy 	    sizeof(struct njsc32_dma_page));
    532  1.1    itohy fail1:	bus_dmamem_free(sc->sc_dmat, &sc->sc_cmdpg_seg, sc->sc_cmdpg_nsegs);
    533  1.1    itohy 
    534  1.1    itohy 	return 0;
    535  1.1    itohy }
    536  1.1    itohy 
    537  1.1    itohy static void
    538  1.2  thorpej njsc32_target_async(struct njsc32_softc *sc, struct njsc32_target *target)
    539  1.1    itohy {
    540  1.1    itohy 
    541  1.1    itohy 	target->t_sync =
    542  1.1    itohy 	    NJSC32_SYNC_VAL(sc->sc_sync_max, NJSC32_SYNCOFFSET_ASYNC);
    543  1.1    itohy 	target->t_ackwidth = NJSC32_ACK_WIDTH_1CLK;
    544  1.1    itohy 	target->t_sample = 0;		/* disable */
    545  1.1    itohy 	target->t_syncoffset = NJSC32_SYNCOFFSET_ASYNC;
    546  1.1    itohy 	target->t_syncperiod = NJSC32_SYNCPERIOD_ASYNC;
    547  1.1    itohy }
    548  1.1    itohy 
    549  1.1    itohy static void
    550  1.2  thorpej njsc32_init_targets(struct njsc32_softc *sc)
    551  1.1    itohy {
    552  1.1    itohy 	int id, lun;
    553  1.1    itohy 	struct njsc32_lu *lu;
    554  1.1    itohy 
    555  1.1    itohy 	for (id = 0; id <= NJSC32_MAX_TARGET_ID; id++) {
    556  1.1    itohy 		/* cancel negotiation status */
    557  1.1    itohy 		sc->sc_targets[id].t_state = NJSC32_TARST_INIT;
    558  1.1    itohy 
    559  1.1    itohy 		/* default to async mode */
    560  1.1    itohy 		njsc32_target_async(sc, &sc->sc_targets[id]);
    561  1.1    itohy 
    562  1.1    itohy #ifdef NJSC32_DUALEDGE
    563  1.1    itohy 		sc->sc_targets[id].t_xferctl = 0;
    564  1.1    itohy #endif
    565  1.1    itohy 
    566  1.1    itohy 		sc->sc_targets[id].t_targetid =
    567  1.1    itohy 		    (1 << id) | (1 << NJSC32_INITIATOR_ID);
    568  1.1    itohy 
    569  1.1    itohy 		/* init logical units */
    570  1.1    itohy 		for (lun = 0; lun < NJSC32_NLU; lun++) {
    571  1.1    itohy 			lu = &sc->sc_targets[id].t_lus[lun];
    572  1.1    itohy 			lu->lu_cmd = NULL;
    573  1.1    itohy 			TAILQ_INIT(&lu->lu_q);
    574  1.1    itohy 		}
    575  1.1    itohy 	}
    576  1.1    itohy }
    577  1.1    itohy 
    578  1.1    itohy void
    579  1.2  thorpej njsc32_attach(struct njsc32_softc *sc)
    580  1.1    itohy {
    581  1.1    itohy 	const char *str;
    582  1.1    itohy #if 1	/* test */
    583  1.1    itohy 	int reg;
    584  1.1    itohy 	njsc32_model_t detected_model;
    585  1.1    itohy #endif
    586  1.1    itohy 
    587  1.1    itohy 	/* init */
    588  1.1    itohy 	TAILQ_INIT(&sc->sc_freecmd);
    589  1.1    itohy 	TAILQ_INIT(&sc->sc_reqcmd);
    590  1.1    itohy 
    591  1.1    itohy #if 1	/* test */
    592  1.1    itohy 	/*
    593  1.1    itohy 	 * try to distinguish 32Bi and 32UDE
    594  1.1    itohy 	 */
    595  1.1    itohy 	/* try to set DualEdge bit (exists on 32UDE only) and read it back */
    596  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER, NJSC32_XFR_DUALEDGE_ENABLE);
    597  1.1    itohy 	if ((reg = njsc32_read_2(sc, NJSC32_REG_TRANSFER)) == 0xffff) {
    598  1.1    itohy 		/* device was removed? */
    599  1.1    itohy 		aprint_error("%s: attach failed\n", sc->sc_dev.dv_xname);
    600  1.1    itohy 		return;
    601  1.1    itohy 	} else if (reg & NJSC32_XFR_DUALEDGE_ENABLE) {
    602  1.1    itohy 		detected_model = NJSC32_MODEL_32UDE | NJSC32_FLAG_DUALEDGE;
    603  1.1    itohy 	} else {
    604  1.1    itohy 		detected_model = NJSC32_MODEL_32BI;
    605  1.1    itohy 	}
    606  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER, 0);	/* restore */
    607  1.1    itohy 
    608  1.1    itohy #if 1/*def DIAGNOSTIC*/
    609  1.1    itohy 	/* compare what is configured with what is detected */
    610  1.1    itohy 	if ((sc->sc_model & NJSC32_MODEL_MASK) !=
    611  1.1    itohy 	    (detected_model & NJSC32_MODEL_MASK)) {
    612  1.1    itohy 		/*
    613  1.1    itohy 		 * Please report this error if it happens.
    614  1.1    itohy 		 */
    615  1.1    itohy 		aprint_error("%s: model mismatch: %#x vs %#x\n",
    616  1.1    itohy 		    sc->sc_dev.dv_xname, sc->sc_model, detected_model);
    617  1.1    itohy 		return;
    618  1.1    itohy 	}
    619  1.1    itohy #endif
    620  1.1    itohy #endif
    621  1.1    itohy 
    622  1.1    itohy 	/* check model */
    623  1.1    itohy 	switch (sc->sc_model & NJSC32_MODEL_MASK) {
    624  1.1    itohy 	case NJSC32_MODEL_32BI:
    625  1.1    itohy 		str = "Bi";
    626  1.1    itohy 		/* 32Bi doesn't support DualEdge transfer */
    627  1.1    itohy 		KASSERT((sc->sc_model & NJSC32_FLAG_DUALEDGE) == 0);
    628  1.1    itohy 		break;
    629  1.1    itohy 	case NJSC32_MODEL_32UDE:
    630  1.1    itohy 		str = "UDE";
    631  1.1    itohy 		break;
    632  1.1    itohy 	default:
    633  1.1    itohy 		aprint_error("%s: unknown model!\n", sc->sc_dev.dv_xname);
    634  1.1    itohy 		return;
    635  1.1    itohy 	}
    636  1.1    itohy 	aprint_normal("%s: NJSC-32%s", sc->sc_dev.dv_xname, str);
    637  1.1    itohy 
    638  1.1    itohy 	switch (sc->sc_clk) {
    639  1.1    itohy 	default:
    640  1.1    itohy #ifdef DIAGNOSTIC
    641  1.1    itohy 		panic("njsc32_attach: unknown clk %d", sc->sc_clk);
    642  1.1    itohy #endif
    643  1.1    itohy 	case NJSC32_CLOCK_DIV_4:
    644  1.1    itohy 		sc->sc_synct = njsc32_synct_40M;
    645  1.1    itohy 		str = "40MHz";
    646  1.1    itohy 		break;
    647  1.1    itohy #ifdef NJSC32_SUPPORT_OTHER_CLOCKS
    648  1.1    itohy 	case NJSC32_CLOCK_DIV_2:
    649  1.1    itohy 		sc->sc_synct = njsc32_synct_20M;
    650  1.1    itohy 		str = "20MHz";
    651  1.1    itohy 		break;
    652  1.1    itohy 	case NJSC32_CLOCK_PCICLK:
    653  1.1    itohy 		sc->sc_synct = njsc32_synct_pci;
    654  1.1    itohy 		str = "PCI";
    655  1.1    itohy 		break;
    656  1.1    itohy #endif
    657  1.1    itohy 	}
    658  1.1    itohy 	aprint_normal(", G/A rev %#x, clk %s%s\n",
    659  1.1    itohy 	    NJSC32_INDEX_GAREV(njsc32_read_2(sc, NJSC32_REG_INDEX)), str,
    660  1.1    itohy 	    (sc->sc_model & NJSC32_FLAG_DUALEDGE) ?
    661  1.1    itohy #ifdef NJSC32_DUALEDGE
    662  1.1    itohy 		", DualEdge"
    663  1.1    itohy #else
    664  1.1    itohy 		", DualEdge (no driver support)"
    665  1.1    itohy #endif
    666  1.1    itohy 	    : "");
    667  1.1    itohy 
    668  1.1    itohy 	/* allocate DMA resource */
    669  1.1    itohy 	if ((sc->sc_ncmd = njsc32_init_cmds(sc)) == 0) {
    670  1.1    itohy 		printf("%s: no usable DMA map\n", sc->sc_dev.dv_xname);
    671  1.1    itohy 		return;
    672  1.1    itohy 	}
    673  1.1    itohy 	sc->sc_flags |= NJSC32_CMDPG_MAPPED;
    674  1.1    itohy 
    675  1.1    itohy 	sc->sc_curcmd = NULL;
    676  1.1    itohy 	sc->sc_nusedcmds = 0;
    677  1.1    itohy 	sc->sc_stat = NJSC32_STAT_IDLE;
    678  1.1    itohy 
    679  1.1    itohy 	sc->sc_sync_max = 1;	/* XXX look up EEPROM configuration? */
    680  1.1    itohy 
    681  1.1    itohy 	/* initialize target structure */
    682  1.1    itohy 	njsc32_init_targets(sc);
    683  1.1    itohy 
    684  1.1    itohy 	/* initialize hardware */
    685  1.1    itohy 	njsc32_init(sc, cold);
    686  1.1    itohy 
    687  1.1    itohy 	/* setup adapter */
    688  1.1    itohy 	sc->sc_adapter.adapt_dev = &sc->sc_dev;
    689  1.1    itohy 	sc->sc_adapter.adapt_nchannels = 1;
    690  1.1    itohy 	sc->sc_adapter.adapt_request = njsc32_scsipi_request;
    691  1.1    itohy 	sc->sc_adapter.adapt_minphys = njsc32_scsipi_minphys;
    692  1.1    itohy 	sc->sc_adapter.adapt_ioctl = njsc32_scsipi_ioctl;
    693  1.1    itohy 
    694  1.1    itohy 	sc->sc_adapter.adapt_max_periph = sc->sc_adapter.adapt_openings =
    695  1.1    itohy 	    sc->sc_ncmd;
    696  1.1    itohy 
    697  1.1    itohy 	/* setup channel */
    698  1.1    itohy 	sc->sc_channel.chan_adapter = &sc->sc_adapter;
    699  1.1    itohy 	sc->sc_channel.chan_bustype = &scsi_bustype;
    700  1.1    itohy 	sc->sc_channel.chan_channel = 0;
    701  1.1    itohy 	sc->sc_channel.chan_ntargets = NJSC32_NTARGET;
    702  1.1    itohy 	sc->sc_channel.chan_nluns = NJSC32_NLU;
    703  1.1    itohy 	sc->sc_channel.chan_id = NJSC32_INITIATOR_ID;
    704  1.1    itohy 
    705  1.1    itohy 	sc->sc_scsi = config_found(&sc->sc_dev, &sc->sc_channel, scsiprint);
    706  1.1    itohy }
    707  1.1    itohy 
    708  1.1    itohy int
    709  1.2  thorpej njsc32_detach(struct njsc32_softc *sc, int flags)
    710  1.1    itohy {
    711  1.1    itohy 	int rv = 0;
    712  1.1    itohy 	int i, s;
    713  1.1    itohy 	struct njsc32_cmd *cmd;
    714  1.1    itohy 
    715  1.1    itohy 	s = splbio();
    716  1.1    itohy 
    717  1.1    itohy 	/* clear running/disconnected commands */
    718  1.1    itohy 	njsc32_clear_cmds(sc, XS_DRIVER_STUFFUP);
    719  1.1    itohy 
    720  1.1    itohy 	sc->sc_stat = NJSC32_STAT_DETACH;
    721  1.1    itohy 
    722  1.1    itohy 	/* clear pending commands */
    723  1.1    itohy 	while ((cmd = TAILQ_FIRST(&sc->sc_reqcmd)) != NULL) {
    724  1.1    itohy 		TAILQ_REMOVE(&sc->sc_reqcmd, cmd, c_q);
    725  1.1    itohy 		njsc32_end_cmd(sc, cmd, XS_RESET);
    726  1.1    itohy 	}
    727  1.1    itohy 
    728  1.1    itohy 	if (sc->sc_scsi != NULL)
    729  1.1    itohy 		rv = config_detach(sc->sc_scsi, flags);
    730  1.1    itohy 
    731  1.1    itohy 	splx(s);
    732  1.1    itohy 
    733  1.1    itohy 	/* free DMA resource */
    734  1.1    itohy 	if (sc->sc_flags & NJSC32_CMDPG_MAPPED) {
    735  1.1    itohy 		for (i = 0; i < sc->sc_ncmd; i++) {
    736  1.1    itohy 			cmd = &sc->sc_cmds[i];
    737  1.1    itohy 			if (cmd->c_flags & NJSC32_CMD_DMA_MAPPED)
    738  1.1    itohy 				bus_dmamap_unload(sc->sc_dmat,
    739  1.1    itohy 				    cmd->c_dmamap_xfer);
    740  1.1    itohy 			bus_dmamap_destroy(sc->sc_dmat, cmd->c_dmamap_xfer);
    741  1.1    itohy 		}
    742  1.1    itohy 
    743  1.1    itohy 		bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap_cmdpg);
    744  1.1    itohy 		bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap_cmdpg);
    745  1.1    itohy 		bus_dmamem_unmap(sc->sc_dmat, (caddr_t)sc->sc_cmdpg,
    746  1.1    itohy 		    sizeof(struct njsc32_dma_page));
    747  1.1    itohy 		bus_dmamem_free(sc->sc_dmat, &sc->sc_cmdpg_seg,
    748  1.1    itohy 		    sc->sc_cmdpg_nsegs);
    749  1.1    itohy 	}
    750  1.1    itohy 
    751  1.1    itohy 	return 0;
    752  1.1    itohy }
    753  1.1    itohy 
    754  1.1    itohy static __inline void
    755  1.2  thorpej njsc32_cmd_init(struct njsc32_cmd *cmd)
    756  1.1    itohy {
    757  1.1    itohy 
    758  1.1    itohy 	cmd->c_flags = 0;
    759  1.1    itohy 
    760  1.1    itohy 	/* scatter/gather table */
    761  1.1    itohy 	cmd->c_sgtdmaaddr = NJSC32_CMD_DMAADDR_SGT(cmd, 0);
    762  1.1    itohy 	cmd->c_sgoffset = 0;
    763  1.1    itohy 	cmd->c_sgfixcnt = 0;
    764  1.1    itohy 
    765  1.1    itohy 	/* data pointer */
    766  1.1    itohy 	cmd->c_dp_cur = cmd->c_dp_saved = cmd->c_dp_max = 0;
    767  1.1    itohy }
    768  1.1    itohy 
    769  1.1    itohy static __inline void
    770  1.2  thorpej njsc32_init_msgout(struct njsc32_softc *sc)
    771  1.1    itohy {
    772  1.1    itohy 
    773  1.1    itohy 	sc->sc_msgoutlen = 0;
    774  1.1    itohy 	sc->sc_msgoutidx = 0;
    775  1.1    itohy }
    776  1.1    itohy 
    777  1.1    itohy static void
    778  1.2  thorpej njsc32_add_msgout(struct njsc32_softc *sc, int byte)
    779  1.1    itohy {
    780  1.1    itohy 
    781  1.1    itohy 	if (sc->sc_msgoutlen >= NJSC32_MSGOUT_LEN) {
    782  1.1    itohy 		printf("njsc32_add_msgout: too many\n");
    783  1.1    itohy 		return;
    784  1.1    itohy 	}
    785  1.1    itohy 	sc->sc_msgout[sc->sc_msgoutlen++] = byte;
    786  1.1    itohy }
    787  1.1    itohy 
    788  1.1    itohy static u_int32_t
    789  1.2  thorpej njsc32_get_auto_msgout(struct njsc32_softc *sc)
    790  1.1    itohy {
    791  1.1    itohy 	u_int32_t val;
    792  1.1    itohy 	u_int8_t *p;
    793  1.1    itohy 
    794  1.1    itohy 	val = 0;
    795  1.1    itohy 	p = sc->sc_msgout;
    796  1.1    itohy 	switch (sc->sc_msgoutlen) {
    797  1.1    itohy 		/* 31-24 23-16 15-8 7 ... 1 0 */
    798  1.1    itohy 	case 3:	/* MSG3  MSG2  MSG1 V --- cnt */
    799  1.1    itohy 		val |= *p++ << NJSC32_MSGOUT_MSG1_SHIFT;
    800  1.1    itohy 		/* FALLTHROUGH */
    801  1.1    itohy 
    802  1.1    itohy 	case 2:	/* MSG2  MSG1  ---  V --- cnt */
    803  1.1    itohy 		val |= *p++ << NJSC32_MSGOUT_MSG2_SHIFT;
    804  1.1    itohy 		/* FALLTHROUGH */
    805  1.1    itohy 
    806  1.1    itohy 	case 1:	/* MSG1  ---   ---  V --- cnt */
    807  1.1    itohy 		val |= *p++ << NJSC32_MSGOUT_MSG3_SHIFT;
    808  1.1    itohy 		val |= NJSC32_MSGOUT_VALID | sc->sc_msgoutlen;
    809  1.1    itohy 		break;
    810  1.1    itohy 
    811  1.1    itohy 	default:
    812  1.1    itohy 		break;
    813  1.1    itohy 	}
    814  1.1    itohy 	return val;
    815  1.1    itohy }
    816  1.1    itohy 
    817  1.1    itohy #ifdef NJSC32_DUALEDGE
    818  1.1    itohy /* add Wide Data Transfer Request to the next Message Out */
    819  1.1    itohy static void
    820  1.2  thorpej njsc32_msgout_wdtr(struct njsc32_softc *sc, int width)
    821  1.1    itohy {
    822  1.1    itohy 
    823  1.1    itohy 	njsc32_add_msgout(sc, MSG_EXTENDED);
    824  1.1    itohy 	njsc32_add_msgout(sc, MSG_EXT_WDTR_LEN);
    825  1.1    itohy 	njsc32_add_msgout(sc, MSG_EXT_WDTR);
    826  1.1    itohy 	njsc32_add_msgout(sc, width);
    827  1.1    itohy }
    828  1.1    itohy #endif
    829  1.1    itohy 
    830  1.1    itohy /* add Synchronous Data Transfer Request to the next Message Out */
    831  1.1    itohy static void
    832  1.2  thorpej njsc32_msgout_sdtr(struct njsc32_softc *sc, int period, int offset)
    833  1.1    itohy {
    834  1.1    itohy 
    835  1.1    itohy 	njsc32_add_msgout(sc, MSG_EXTENDED);
    836  1.1    itohy 	njsc32_add_msgout(sc, MSG_EXT_SDTR_LEN);
    837  1.1    itohy 	njsc32_add_msgout(sc, MSG_EXT_SDTR);
    838  1.1    itohy 	njsc32_add_msgout(sc, period);
    839  1.1    itohy 	njsc32_add_msgout(sc, offset);
    840  1.1    itohy }
    841  1.1    itohy 
    842  1.1    itohy static void
    843  1.2  thorpej njsc32_negotiate_xfer(struct njsc32_softc *sc, struct njsc32_target *target)
    844  1.1    itohy {
    845  1.1    itohy 
    846  1.1    itohy 	/* initial negotiation state */
    847  1.1    itohy 	if (target->t_state == NJSC32_TARST_INIT) {
    848  1.1    itohy #ifdef NJSC32_DUALEDGE
    849  1.1    itohy 		if (target->t_flags & NJSC32_TARF_DE)
    850  1.1    itohy 			target->t_state = NJSC32_TARST_DE;
    851  1.1    itohy 		else
    852  1.1    itohy #endif
    853  1.1    itohy 		if (target->t_flags & NJSC32_TARF_SYNC)
    854  1.1    itohy 			target->t_state = NJSC32_TARST_SDTR;
    855  1.1    itohy 		else
    856  1.1    itohy 			target->t_state = NJSC32_TARST_DONE;
    857  1.1    itohy 	}
    858  1.1    itohy 
    859  1.1    itohy 	switch (target->t_state) {
    860  1.1    itohy 	default:
    861  1.1    itohy 	case NJSC32_TARST_INIT:
    862  1.1    itohy #ifdef DIAGNOSTIC
    863  1.1    itohy 		panic("njsc32_negotiate_xfer");
    864  1.1    itohy 		/* NOTREACHED */
    865  1.1    itohy #endif
    866  1.1    itohy 		/* FALLTHROUGH */
    867  1.1    itohy 	case NJSC32_TARST_DONE:
    868  1.1    itohy 		/* no more work */
    869  1.1    itohy 		break;
    870  1.1    itohy 
    871  1.1    itohy #ifdef NJSC32_DUALEDGE
    872  1.1    itohy 	case NJSC32_TARST_DE:
    873  1.1    itohy 		njsc32_msgout_wdtr(sc, 0xde /* XXX? */);
    874  1.1    itohy 		break;
    875  1.1    itohy 
    876  1.1    itohy 	case NJSC32_TARST_WDTR:
    877  1.1    itohy 		njsc32_msgout_wdtr(sc, MSG_EXT_WDTR_BUS_8_BIT);
    878  1.1    itohy 		break;
    879  1.1    itohy #endif
    880  1.1    itohy 
    881  1.1    itohy 	case NJSC32_TARST_SDTR:
    882  1.1    itohy 		njsc32_msgout_sdtr(sc, sc->sc_synct[sc->sc_sync_max].sp_period,
    883  1.1    itohy 		    NJSC32_SYNCOFFSET_MAX);
    884  1.1    itohy 		break;
    885  1.1    itohy 
    886  1.1    itohy 	case NJSC32_TARST_ASYNC:
    887  1.1    itohy 		njsc32_msgout_sdtr(sc, NJSC32_SYNCPERIOD_ASYNC,
    888  1.1    itohy 		    NJSC32_SYNCOFFSET_ASYNC);
    889  1.1    itohy 		break;
    890  1.1    itohy 	}
    891  1.1    itohy }
    892  1.1    itohy 
    893  1.1    itohy /* turn LED on */
    894  1.1    itohy static __inline void
    895  1.2  thorpej njsc32_led_on(struct njsc32_softc *sc)
    896  1.1    itohy {
    897  1.1    itohy 
    898  1.1    itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_EXT_PORT, NJSC32_EXTPORT_LED_ON);
    899  1.1    itohy }
    900  1.1    itohy 
    901  1.1    itohy /* turn LED off */
    902  1.1    itohy static __inline void
    903  1.2  thorpej njsc32_led_off(struct njsc32_softc *sc)
    904  1.1    itohy {
    905  1.1    itohy 
    906  1.1    itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_EXT_PORT, NJSC32_EXTPORT_LED_OFF);
    907  1.1    itohy }
    908  1.1    itohy 
    909  1.1    itohy static void
    910  1.2  thorpej njsc32_arbitration_failed(struct njsc32_softc *sc)
    911  1.1    itohy {
    912  1.1    itohy 	struct njsc32_cmd *cmd;
    913  1.1    itohy 
    914  1.1    itohy 	if ((cmd = sc->sc_curcmd) == NULL || sc->sc_stat != NJSC32_STAT_ARBIT)
    915  1.1    itohy 		return;
    916  1.1    itohy 
    917  1.1    itohy 	if ((cmd->c_xs->xs_control & XS_CTL_POLL) == 0)
    918  1.1    itohy 		callout_stop(&cmd->c_xs->xs_callout);
    919  1.1    itohy 
    920  1.1    itohy 	sc->sc_stat = NJSC32_STAT_IDLE;
    921  1.1    itohy 	sc->sc_curcmd = NULL;
    922  1.1    itohy 
    923  1.1    itohy 	/* the command is no longer active */
    924  1.1    itohy 	if (--sc->sc_nusedcmds == 0)
    925  1.1    itohy 		njsc32_led_off(sc);
    926  1.1    itohy }
    927  1.1    itohy 
    928  1.1    itohy static __inline void
    929  1.2  thorpej njsc32_cmd_load(struct njsc32_softc *sc, struct njsc32_cmd *cmd)
    930  1.1    itohy {
    931  1.1    itohy 	struct njsc32_target *target;
    932  1.1    itohy 	struct scsipi_xfer *xs;
    933  1.1    itohy 	int i, control, lun;
    934  1.1    itohy 	u_int32_t msgoutreg;
    935  1.1    itohy #ifdef NJSC32_AUTOPARAM
    936  1.1    itohy 	struct njsc32_autoparam *ap;
    937  1.1    itohy #endif
    938  1.1    itohy 
    939  1.1    itohy 	xs = cmd->c_xs;
    940  1.1    itohy #ifdef NJSC32_AUTOPARAM
    941  1.1    itohy 	ap = &sc->sc_cmdpg->dp_ap;
    942  1.1    itohy #else
    943  1.1    itohy 	/* reset CDB pointer */
    944  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, NJSC32_CMD_CLEAR_CDB_FIFO_PTR);
    945  1.1    itohy #endif
    946  1.1    itohy 
    947  1.1    itohy 	/* CDB */
    948  1.1    itohy 	TPRINTC(cmd, ("njsc32_cmd_load: CDB"));
    949  1.1    itohy 	for (i = 0; i < xs->cmdlen; i++) {
    950  1.1    itohy #ifdef NJSC32_AUTOPARAM
    951  1.1    itohy 		ap->ap_cdb[i].cdb_data = ((u_int8_t *)xs->cmd)[i];
    952  1.1    itohy #else
    953  1.1    itohy 		njsc32_write_1(sc, NJSC32_REG_COMMAND_DATA,
    954  1.1    itohy 		    ((u_int8_t *)xs->cmd)[i]);
    955  1.1    itohy #endif
    956  1.1    itohy 		TPRINTF((" %02x", ((u_int8_t *)cmd->c_xs->cmd)[i]));
    957  1.1    itohy 	}
    958  1.1    itohy #ifdef NJSC32_AUTOPARAM	/* XXX needed? */
    959  1.1    itohy 	for ( ; i < NJSC32_AUTOPARAM_CDBLEN; i++)
    960  1.1    itohy 		ap->ap_cdb[i].cdb_data = 0;
    961  1.1    itohy #endif
    962  1.1    itohy 
    963  1.1    itohy 	control = xs->xs_control;
    964  1.1    itohy 
    965  1.1    itohy 	/*
    966  1.1    itohy 	 * Message Out
    967  1.1    itohy 	 */
    968  1.1    itohy 	njsc32_init_msgout(sc);
    969  1.1    itohy 
    970  1.1    itohy 	/* Identify */
    971  1.1    itohy 	lun = xs->xs_periph->periph_lun;
    972  1.1    itohy 	njsc32_add_msgout(sc, (control & XS_CTL_REQSENSE) ?
    973  1.1    itohy 	    MSG_IDENTIFY(lun, 0) : MSG_IDENTIFY(lun, 1));
    974  1.1    itohy 
    975  1.1    itohy 	/* tagged queueing */
    976  1.1    itohy 	if (control & XS_CTL_TAGMASK) {
    977  1.1    itohy 		njsc32_add_msgout(sc, xs->xs_tag_type);
    978  1.1    itohy 		njsc32_add_msgout(sc, xs->xs_tag_id);
    979  1.1    itohy 		TPRINTF((" (tag %#x %#x)\n", xs->xs_tag_type, xs->xs_tag_id));
    980  1.1    itohy 	}
    981  1.1    itohy 	TPRINTF(("\n"));
    982  1.1    itohy 
    983  1.1    itohy 	target = cmd->c_target;
    984  1.1    itohy 
    985  1.1    itohy 	/* transfer negotiation */
    986  1.1    itohy 	if (control & XS_CTL_REQSENSE)
    987  1.1    itohy 		target->t_state = NJSC32_TARST_INIT;
    988  1.1    itohy 	njsc32_negotiate_xfer(sc, target);
    989  1.1    itohy 
    990  1.1    itohy 	msgoutreg = njsc32_get_auto_msgout(sc);
    991  1.1    itohy 
    992  1.1    itohy #ifdef NJSC32_AUTOPARAM
    993  1.1    itohy 	ap->ap_msgout = htole32(msgoutreg);
    994  1.1    itohy 
    995  1.1    itohy 	ap->ap_sync	= target->t_sync;
    996  1.1    itohy 	ap->ap_ackwidth	= target->t_ackwidth;
    997  1.1    itohy 	ap->ap_targetid	= target->t_targetid;
    998  1.1    itohy 	ap->ap_sample	= target->t_sample;
    999  1.1    itohy 
   1000  1.1    itohy 	ap->ap_cmdctl = htole16(NJSC32_CMD_CLEAR_CDB_FIFO_PTR |
   1001  1.1    itohy 	    NJSC32_CMD_AUTO_COMMAND_PHASE |
   1002  1.1    itohy 	    NJSC32_CMD_AUTO_SCSI_START | NJSC32_CMD_AUTO_ATN |
   1003  1.1    itohy 	    NJSC32_CMD_AUTO_MSGIN_00_04 | NJSC32_CMD_AUTO_MSGIN_02);
   1004  1.1    itohy #ifdef NJSC32_DUALEDGE
   1005  1.1    itohy 	ap->ap_xferctl = htole16(cmd->c_xferctl | target->t_xferctl);
   1006  1.1    itohy #else
   1007  1.1    itohy 	ap->ap_xferctl = htole16(cmd->c_xferctl);
   1008  1.1    itohy #endif
   1009  1.1    itohy 	ap->ap_sgtdmaaddr = htole32(cmd->c_sgtdmaaddr);
   1010  1.1    itohy 
   1011  1.1    itohy 	/* sync njsc32_autoparam */
   1012  1.1    itohy 	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_cmdpg,
   1013  1.1    itohy 	    offsetof(struct njsc32_dma_page, dp_ap),	/* offset */
   1014  1.1    itohy 	    sizeof(struct njsc32_autoparam),
   1015  1.1    itohy 	    BUS_DMASYNC_PREWRITE);
   1016  1.1    itohy 
   1017  1.1    itohy 	/* autoparam DMA address */
   1018  1.1    itohy 	njsc32_write_4(sc, NJSC32_REG_SGT_ADR, sc->sc_ap_dma);
   1019  1.1    itohy 
   1020  1.1    itohy 	/* start command (autoparam) */
   1021  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL,
   1022  1.1    itohy 	    NJSC32_CMD_CLEAR_CDB_FIFO_PTR | NJSC32_CMD_AUTO_PARAMETER);
   1023  1.1    itohy 
   1024  1.1    itohy #else	/* not NJSC32_AUTOPARAM */
   1025  1.1    itohy 
   1026  1.1    itohy 	njsc32_write_4(sc, NJSC32_REG_SCSI_MSG_OUT, msgoutreg);
   1027  1.1    itohy 
   1028  1.1    itohy 	/* load parameters */
   1029  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_TARGET_ID, target->t_targetid);
   1030  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SYNC, target->t_sync);
   1031  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_ACK_WIDTH, target->t_ackwidth);
   1032  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SREQ_SAMPLING, target->t_sample);
   1033  1.1    itohy 	njsc32_write_4(sc, NJSC32_REG_SGT_ADR, cmd->c_sgtdmaaddr);
   1034  1.1    itohy #ifdef NJSC32_DUALEDGE
   1035  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER,
   1036  1.1    itohy 	    cmd->c_xferctl | target->t_xferctl);
   1037  1.1    itohy #else
   1038  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER, cmd->c_xferctl);
   1039  1.1    itohy #endif
   1040  1.1    itohy 	/* start AutoSCSI */
   1041  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL,
   1042  1.1    itohy 	    NJSC32_CMD_CLEAR_CDB_FIFO_PTR | NJSC32_CMD_AUTO_COMMAND_PHASE |
   1043  1.1    itohy 	    NJSC32_CMD_AUTO_SCSI_START | NJSC32_CMD_AUTO_ATN |
   1044  1.1    itohy 	    NJSC32_CMD_AUTO_MSGIN_00_04 | NJSC32_CMD_AUTO_MSGIN_02);
   1045  1.1    itohy #endif	/* not NJSC32_AUTOPARAM */
   1046  1.1    itohy }
   1047  1.1    itohy 
   1048  1.1    itohy /* Note: must be called at splbio() */
   1049  1.1    itohy static void
   1050  1.2  thorpej njsc32_start(struct njsc32_softc *sc)
   1051  1.1    itohy {
   1052  1.1    itohy 	struct njsc32_cmd *cmd;
   1053  1.1    itohy 
   1054  1.1    itohy 	/* get a command to issue */
   1055  1.1    itohy 	TAILQ_FOREACH(cmd, &sc->sc_reqcmd, c_q) {
   1056  1.1    itohy 		if (cmd->c_lu->lu_cmd == NULL &&
   1057  1.1    itohy 		    ((cmd->c_flags & NJSC32_CMD_TAGGED) ||
   1058  1.1    itohy 		     TAILQ_EMPTY(&cmd->c_lu->lu_q)))
   1059  1.1    itohy 			break;	/* OK, the logical unit is free */
   1060  1.1    itohy 	}
   1061  1.1    itohy 	if (!cmd)
   1062  1.1    itohy 		goto out;	/* no work to do */
   1063  1.1    itohy 
   1064  1.1    itohy 	/* request will always fail if not in bus free phase */
   1065  1.1    itohy 	if (njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_MONITOR) !=
   1066  1.1    itohy 	    NJSC32_BUSMON_BUSFREE)
   1067  1.1    itohy 		goto busy;
   1068  1.1    itohy 
   1069  1.1    itohy 	/* clear parity error and enable parity detection */
   1070  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_PARITY_CONTROL,
   1071  1.1    itohy 	    NJSC32_PARITYCTL_CHECK_ENABLE | NJSC32_PARITYCTL_CLEAR_ERROR);
   1072  1.1    itohy 
   1073  1.1    itohy 	njsc32_cmd_load(sc, cmd);
   1074  1.1    itohy 
   1075  1.1    itohy 	if (sc->sc_nusedcmds++ == 0)
   1076  1.1    itohy 		njsc32_led_on(sc);
   1077  1.1    itohy 
   1078  1.1    itohy 	sc->sc_curcmd = cmd;
   1079  1.1    itohy 	sc->sc_stat = NJSC32_STAT_ARBIT;
   1080  1.1    itohy 
   1081  1.1    itohy 	if ((cmd->c_xs->xs_control & XS_CTL_POLL) == 0) {
   1082  1.1    itohy 		callout_reset(&cmd->c_xs->xs_callout,
   1083  1.1    itohy 		    mstohz(cmd->c_xs->timeout),
   1084  1.1    itohy 		    njsc32_cmdtimeout, cmd);
   1085  1.1    itohy 	}
   1086  1.1    itohy 
   1087  1.1    itohy 	return;
   1088  1.1    itohy 
   1089  1.1    itohy busy:	/* XXX retry counter */
   1090  1.1    itohy 	TPRINTF(("%s: njsc32_start: busy\n", sc->sc_dev.dv_xname));
   1091  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TIMER, NJSC32_ARBITRATION_RETRY_TIME);
   1092  1.1    itohy out:	njsc32_write_2(sc, NJSC32_REG_TRANSFER, 0);
   1093  1.1    itohy }
   1094  1.1    itohy 
   1095  1.1    itohy static void
   1096  1.2  thorpej njsc32_run_xfer(struct njsc32_softc *sc, struct scsipi_xfer *xs)
   1097  1.1    itohy {
   1098  1.1    itohy 	struct scsipi_periph *periph;
   1099  1.1    itohy 	int control;
   1100  1.1    itohy 	int lun;
   1101  1.1    itohy 	struct njsc32_cmd *cmd;
   1102  1.1    itohy 	int s, i, error;
   1103  1.1    itohy 
   1104  1.1    itohy 	periph = xs->xs_periph;
   1105  1.1    itohy 	KASSERT((unsigned)periph->periph_target <= NJSC32_MAX_TARGET_ID);
   1106  1.1    itohy 
   1107  1.1    itohy 	control = xs->xs_control;
   1108  1.1    itohy 	lun = periph->periph_lun;
   1109  1.1    itohy 
   1110  1.1    itohy 	/*
   1111  1.1    itohy 	 * get a free cmd
   1112  1.1    itohy 	 * (scsipi layer knows the number of cmds, so this shall never fail)
   1113  1.1    itohy 	 */
   1114  1.1    itohy 	s = splbio();
   1115  1.1    itohy 	cmd = TAILQ_FIRST(&sc->sc_freecmd);
   1116  1.1    itohy 	KASSERT(cmd);
   1117  1.1    itohy 	TAILQ_REMOVE(&sc->sc_freecmd, cmd, c_q);
   1118  1.1    itohy 	splx(s);
   1119  1.1    itohy 
   1120  1.1    itohy 	/*
   1121  1.1    itohy 	 * build a request
   1122  1.1    itohy 	 */
   1123  1.1    itohy 	njsc32_cmd_init(cmd);
   1124  1.1    itohy 	cmd->c_xs = xs;
   1125  1.1    itohy 	cmd->c_target = &sc->sc_targets[periph->periph_target];
   1126  1.1    itohy 	cmd->c_lu = &cmd->c_target->t_lus[lun];
   1127  1.1    itohy 
   1128  1.1    itohy 	/* tagged queueing */
   1129  1.1    itohy 	if (control & XS_CTL_TAGMASK) {
   1130  1.1    itohy 		cmd->c_flags |= NJSC32_CMD_TAGGED;
   1131  1.1    itohy 		if (control & XS_CTL_HEAD_TAG)
   1132  1.1    itohy 			cmd->c_flags |= NJSC32_CMD_TAGGED_HEAD;
   1133  1.1    itohy 	}
   1134  1.1    itohy 
   1135  1.1    itohy 	/* map DMA buffer */
   1136  1.1    itohy 	cmd->c_datacnt = xs->datalen;
   1137  1.1    itohy 	if (xs->datalen) {
   1138  1.1    itohy 		/* Is XS_CTL_DATA_UIO ever used anywhere? */
   1139  1.1    itohy 		KASSERT((control & XS_CTL_DATA_UIO) == 0);
   1140  1.1    itohy 
   1141  1.1    itohy 		error = bus_dmamap_load(sc->sc_dmat, cmd->c_dmamap_xfer,
   1142  1.1    itohy 		    xs->data, xs->datalen, NULL,
   1143  1.1    itohy 		    ((control & XS_CTL_NOSLEEP) ?
   1144  1.1    itohy 			BUS_DMA_NOWAIT : BUS_DMA_WAITOK) |
   1145  1.1    itohy 		    BUS_DMA_STREAMING |
   1146  1.1    itohy 		    ((control & XS_CTL_DATA_IN) ?
   1147  1.1    itohy 			BUS_DMA_READ : BUS_DMA_WRITE));
   1148  1.1    itohy 
   1149  1.1    itohy 		switch (error) {
   1150  1.1    itohy 		case 0:
   1151  1.1    itohy 			break;
   1152  1.1    itohy 		case ENOMEM:
   1153  1.1    itohy 		case EAGAIN:
   1154  1.1    itohy 			xs->error = XS_RESOURCE_SHORTAGE;
   1155  1.1    itohy 			goto map_failed;
   1156  1.1    itohy 		default:
   1157  1.1    itohy 			xs->error = XS_DRIVER_STUFFUP;
   1158  1.1    itohy 		map_failed:
   1159  1.1    itohy 			printf("%s: njsc32_run_xfer: map failed, error %d\n",
   1160  1.1    itohy 			    sc->sc_dev.dv_xname, error);
   1161  1.1    itohy 			/* put it back to free command list */
   1162  1.1    itohy 			s = splbio();
   1163  1.1    itohy 			TAILQ_INSERT_HEAD(&sc->sc_freecmd, cmd, c_q);
   1164  1.1    itohy 			splx(s);
   1165  1.1    itohy 			/* abort this transfer */
   1166  1.1    itohy 			scsipi_done(xs);
   1167  1.1    itohy 			return;
   1168  1.1    itohy 		}
   1169  1.1    itohy 
   1170  1.1    itohy 		bus_dmamap_sync(sc->sc_dmat, cmd->c_dmamap_xfer,
   1171  1.1    itohy 		    0, cmd->c_dmamap_xfer->dm_mapsize,
   1172  1.1    itohy 		    (control & XS_CTL_DATA_IN) ?
   1173  1.1    itohy 			BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
   1174  1.1    itohy 
   1175  1.1    itohy 		for (i = 0; i < cmd->c_dmamap_xfer->dm_nsegs; i++) {
   1176  1.1    itohy 			cmd->c_sgt[i].sg_addr =
   1177  1.1    itohy 			    htole32(cmd->c_dmamap_xfer->dm_segs[i].ds_addr);
   1178  1.1    itohy 			cmd->c_sgt[i].sg_len =
   1179  1.1    itohy 			    htole32(cmd->c_dmamap_xfer->dm_segs[i].ds_len);
   1180  1.1    itohy 		}
   1181  1.1    itohy 		/* end mark */
   1182  1.1    itohy 		cmd->c_sgt[i - 1].sg_len |= htole32(NJSC32_SGT_ENDMARK);
   1183  1.1    itohy 
   1184  1.1    itohy 		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_cmdpg,
   1185  1.1    itohy 		    (char *)cmd->c_sgt - (char *)sc->sc_cmdpg, /* offset */
   1186  1.1    itohy 		    NJSC32_SIZE_SGT,
   1187  1.1    itohy 		    BUS_DMASYNC_PREWRITE);
   1188  1.1    itohy 
   1189  1.1    itohy 		cmd->c_flags |= NJSC32_CMD_DMA_MAPPED;
   1190  1.1    itohy 
   1191  1.1    itohy 		/* enable transfer */
   1192  1.1    itohy 		cmd->c_xferctl =
   1193  1.1    itohy 		    NJSC32_XFR_TRANSFER_GO | NJSC32_XFR_BM_START |
   1194  1.1    itohy 		    NJSC32_XFR_ALL_COUNT_CLR;
   1195  1.1    itohy 
   1196  1.1    itohy 		/* XXX How can we specify the DMA direction? */
   1197  1.1    itohy 
   1198  1.1    itohy #if 0	/* faster write mode? (doesn't work) */
   1199  1.1    itohy 		if ((control & XS_CTL_DATA_IN) == 0)
   1200  1.1    itohy 			cmd->c_xferctl |= NJSC32_XFR_ADVANCED_BM_WRITE;
   1201  1.1    itohy #endif
   1202  1.1    itohy 	} else {
   1203  1.1    itohy 		/* no data transfer */
   1204  1.1    itohy 		cmd->c_xferctl = 0;
   1205  1.1    itohy 	}
   1206  1.1    itohy 
   1207  1.1    itohy 	/* queue request */
   1208  1.1    itohy 	s = splbio();
   1209  1.1    itohy 	TAILQ_INSERT_TAIL(&sc->sc_reqcmd, cmd, c_q);
   1210  1.1    itohy 
   1211  1.1    itohy 	/* start the controller if idle */
   1212  1.1    itohy 	if (sc->sc_stat == NJSC32_STAT_IDLE)
   1213  1.1    itohy 		njsc32_start(sc);
   1214  1.1    itohy 
   1215  1.1    itohy 	splx(s);
   1216  1.1    itohy 
   1217  1.1    itohy 	if (control & XS_CTL_POLL) {
   1218  1.1    itohy 		/* wait for completion */
   1219  1.1    itohy 		/* XXX should handle timeout? */
   1220  1.1    itohy 		while ((xs->xs_status & XS_STS_DONE) == 0) {
   1221  1.1    itohy 			delay(1000);
   1222  1.1    itohy 			njsc32_intr(sc);
   1223  1.1    itohy 		}
   1224  1.1    itohy 	}
   1225  1.1    itohy }
   1226  1.1    itohy 
   1227  1.1    itohy static void
   1228  1.2  thorpej njsc32_end_cmd(struct njsc32_softc *sc, struct njsc32_cmd *cmd,
   1229  1.2  thorpej     scsipi_xfer_result_t result)
   1230  1.1    itohy {
   1231  1.1    itohy 	struct scsipi_xfer *xs;
   1232  1.1    itohy 	int s;
   1233  1.1    itohy #ifdef DIAGNOSTIC
   1234  1.1    itohy 	struct njsc32_cmd *c;
   1235  1.1    itohy #endif
   1236  1.1    itohy 
   1237  1.1    itohy 	KASSERT(cmd);
   1238  1.1    itohy 
   1239  1.1    itohy #ifdef DIAGNOSTIC
   1240  1.1    itohy 	s = splbio();
   1241  1.1    itohy 	TAILQ_FOREACH(c, &sc->sc_freecmd, c_q) {
   1242  1.1    itohy 		if (cmd == c)
   1243  1.1    itohy 			panic("njsc32_end_cmd: already in free list");
   1244  1.1    itohy 	}
   1245  1.1    itohy 	splx(s);
   1246  1.1    itohy #endif
   1247  1.1    itohy 	xs = cmd->c_xs;
   1248  1.1    itohy 
   1249  1.1    itohy 	if (cmd->c_flags & NJSC32_CMD_DMA_MAPPED) {
   1250  1.1    itohy 		if (cmd->c_datacnt) {
   1251  1.1    itohy 			bus_dmamap_sync(sc->sc_dmat, cmd->c_dmamap_xfer,
   1252  1.1    itohy 			    0, cmd->c_dmamap_xfer->dm_mapsize,
   1253  1.1    itohy 			    (xs->xs_control & XS_CTL_DATA_IN) ?
   1254  1.1    itohy 				BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
   1255  1.1    itohy 
   1256  1.1    itohy 			bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_cmdpg,
   1257  1.1    itohy 			    (char *)cmd->c_sgt - (char *)sc->sc_cmdpg,
   1258  1.1    itohy 			    NJSC32_SIZE_SGT, BUS_DMASYNC_POSTWRITE);
   1259  1.1    itohy 		}
   1260  1.1    itohy 
   1261  1.1    itohy 		bus_dmamap_unload(sc->sc_dmat, cmd->c_dmamap_xfer);
   1262  1.1    itohy 		cmd->c_flags &= ~NJSC32_CMD_DMA_MAPPED;
   1263  1.1    itohy 	}
   1264  1.1    itohy 
   1265  1.1    itohy 	s = splbio();
   1266  1.1    itohy 	if ((xs->xs_control & XS_CTL_POLL) == 0)
   1267  1.1    itohy 		callout_stop(&xs->xs_callout);
   1268  1.1    itohy 
   1269  1.1    itohy 	TAILQ_INSERT_HEAD(&sc->sc_freecmd, cmd, c_q);
   1270  1.1    itohy 	splx(s);
   1271  1.1    itohy 
   1272  1.1    itohy 	xs->error = result;
   1273  1.1    itohy 	scsipi_done(xs);
   1274  1.1    itohy 
   1275  1.1    itohy 	if (--sc->sc_nusedcmds == 0)
   1276  1.1    itohy 		njsc32_led_off(sc);
   1277  1.1    itohy }
   1278  1.1    itohy 
   1279  1.1    itohy /*
   1280  1.1    itohy  * request from scsipi layer
   1281  1.1    itohy  */
   1282  1.2  thorpej static void
   1283  1.2  thorpej njsc32_scsipi_request(struct scsipi_channel *chan, scsipi_adapter_req_t req,
   1284  1.2  thorpej     void *arg)
   1285  1.1    itohy {
   1286  1.1    itohy 	struct njsc32_softc *sc;
   1287  1.1    itohy 	struct scsipi_xfer_mode *xm;
   1288  1.1    itohy 	struct njsc32_target *target;
   1289  1.1    itohy 
   1290  1.1    itohy 	sc = (void *)chan->chan_adapter->adapt_dev;
   1291  1.1    itohy 
   1292  1.1    itohy 	switch (req) {
   1293  1.1    itohy 	case ADAPTER_REQ_RUN_XFER:
   1294  1.1    itohy 		njsc32_run_xfer(sc, arg);
   1295  1.1    itohy 		break;
   1296  1.1    itohy 
   1297  1.1    itohy 	case ADAPTER_REQ_GROW_RESOURCES:
   1298  1.1    itohy 		/* not supported */
   1299  1.1    itohy 		break;
   1300  1.1    itohy 
   1301  1.1    itohy 	case ADAPTER_REQ_SET_XFER_MODE:
   1302  1.1    itohy 		xm = arg;
   1303  1.1    itohy 		target = &sc->sc_targets[xm->xm_target];
   1304  1.1    itohy 
   1305  1.1    itohy 		target->t_flags = 0;
   1306  1.1    itohy 		if (xm->xm_mode & PERIPH_CAP_TQING)
   1307  1.1    itohy 			target->t_flags |= NJSC32_TARF_TAG;
   1308  1.1    itohy 		if (xm->xm_mode & PERIPH_CAP_SYNC) {
   1309  1.1    itohy 			target->t_flags |= NJSC32_TARF_SYNC;
   1310  1.1    itohy #ifdef NJSC32_DUALEDGE
   1311  1.1    itohy 			if (sc->sc_model & NJSC32_FLAG_DUALEDGE)
   1312  1.1    itohy 				target->t_flags |= NJSC32_TARF_DE;
   1313  1.1    itohy #endif
   1314  1.1    itohy 		}
   1315  1.1    itohy #ifdef NJSC32_DUALEDGE
   1316  1.1    itohy 		target->t_xferctl = 0;
   1317  1.1    itohy #endif
   1318  1.1    itohy 		target->t_state = NJSC32_TARST_INIT;
   1319  1.1    itohy 		njsc32_target_async(sc, target);
   1320  1.1    itohy 
   1321  1.1    itohy 		break;
   1322  1.1    itohy 	default:
   1323  1.1    itohy 		break;
   1324  1.1    itohy 	}
   1325  1.1    itohy }
   1326  1.1    itohy 
   1327  1.2  thorpej static void
   1328  1.2  thorpej njsc32_scsipi_minphys(struct buf *bp)
   1329  1.1    itohy {
   1330  1.1    itohy 
   1331  1.1    itohy 	if (bp->b_bcount > NJSC32_MAX_XFER)
   1332  1.1    itohy 		bp->b_bcount = NJSC32_MAX_XFER;
   1333  1.1    itohy 	minphys(bp);
   1334  1.1    itohy }
   1335  1.1    itohy 
   1336  1.1    itohy static void
   1337  1.2  thorpej njsc32_reset_bus(struct njsc32_softc *sc)
   1338  1.1    itohy {
   1339  1.1    itohy 	int s;
   1340  1.1    itohy 
   1341  1.1    itohy 	DPRINTF(("%s: njsc32_reset_bus:\n", sc->sc_dev.dv_xname));
   1342  1.1    itohy 
   1343  1.1    itohy 	/* SCSI bus reset */
   1344  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_BUS_CONTROL, NJSC32_SBCTL_RST);
   1345  1.1    itohy 	delay(NJSC32_RESET_HOLD_TIME);
   1346  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_BUS_CONTROL, 0);
   1347  1.1    itohy 
   1348  1.1    itohy 	/* clear transfer */
   1349  1.1    itohy 	s = splbio();
   1350  1.1    itohy 	njsc32_reset_detected(sc);
   1351  1.1    itohy 	splx(s);
   1352  1.1    itohy }
   1353  1.1    itohy 
   1354  1.1    itohy /*
   1355  1.1    itohy  * clear running/disconnected commands
   1356  1.1    itohy  */
   1357  1.1    itohy static void
   1358  1.2  thorpej njsc32_clear_cmds(struct njsc32_softc *sc, scsipi_xfer_result_t cmdresult)
   1359  1.1    itohy {
   1360  1.1    itohy 	struct njsc32_cmd *cmd;
   1361  1.1    itohy 	int id, lun;
   1362  1.1    itohy 	struct njsc32_lu *lu;
   1363  1.1    itohy 
   1364  1.1    itohy 	njsc32_arbitration_failed(sc);
   1365  1.1    itohy 
   1366  1.1    itohy 	/* clear current transfer */
   1367  1.1    itohy 	if ((cmd = sc->sc_curcmd) != NULL) {
   1368  1.1    itohy 		sc->sc_curcmd = NULL;
   1369  1.1    itohy 		njsc32_end_cmd(sc, cmd, cmdresult);
   1370  1.1    itohy 	}
   1371  1.1    itohy 
   1372  1.1    itohy 	/* clear disconnected transfers */
   1373  1.1    itohy 	for (id = 0; id <= NJSC32_MAX_TARGET_ID; id++) {
   1374  1.1    itohy 		for (lun = 0; lun < NJSC32_NLU; lun++) {
   1375  1.1    itohy 			lu = &sc->sc_targets[id].t_lus[lun];
   1376  1.1    itohy 
   1377  1.1    itohy 			if ((cmd = lu->lu_cmd) != NULL) {
   1378  1.1    itohy 				lu->lu_cmd = NULL;
   1379  1.1    itohy 				njsc32_end_cmd(sc, cmd, cmdresult);
   1380  1.1    itohy 			}
   1381  1.1    itohy 			while ((cmd = TAILQ_FIRST(&lu->lu_q)) != NULL) {
   1382  1.1    itohy 				TAILQ_REMOVE(&lu->lu_q, cmd, c_q);
   1383  1.1    itohy 				njsc32_end_cmd(sc, cmd, cmdresult);
   1384  1.1    itohy 			}
   1385  1.1    itohy 		}
   1386  1.1    itohy 	}
   1387  1.1    itohy }
   1388  1.1    itohy 
   1389  1.1    itohy static void
   1390  1.2  thorpej njsc32_reset_detected(struct njsc32_softc *sc)
   1391  1.1    itohy {
   1392  1.1    itohy 
   1393  1.1    itohy 	njsc32_clear_cmds(sc, XS_RESET);
   1394  1.1    itohy 	njsc32_init_targets(sc);
   1395  1.1    itohy 	sc->sc_stat = NJSC32_STAT_IDLE;
   1396  1.1    itohy 	KASSERT(sc->sc_nusedcmds == 0);
   1397  1.1    itohy 	scsipi_async_event(&sc->sc_channel, ASYNC_EVENT_RESET, NULL);
   1398  1.1    itohy }
   1399  1.1    itohy 
   1400  1.2  thorpej static int
   1401  1.2  thorpej njsc32_scsipi_ioctl(struct scsipi_channel *chan, u_long cmd, caddr_t addr,
   1402  1.2  thorpej     int flag, struct proc *p)
   1403  1.1    itohy {
   1404  1.1    itohy 	struct njsc32_softc *sc = (void *)chan->chan_adapter->adapt_dev;
   1405  1.1    itohy 
   1406  1.1    itohy 	switch (cmd) {
   1407  1.1    itohy 	case SCBUSIORESET:
   1408  1.1    itohy 		njsc32_init(sc, 0);
   1409  1.1    itohy 		return 0;
   1410  1.1    itohy 	default:
   1411  1.1    itohy 		break;
   1412  1.1    itohy 	}
   1413  1.1    itohy 
   1414  1.1    itohy 	return ENOTTY;
   1415  1.1    itohy }
   1416  1.1    itohy 
   1417  1.1    itohy /*
   1418  1.1    itohy  * set current data pointer
   1419  1.1    itohy  */
   1420  1.1    itohy static __inline void
   1421  1.2  thorpej njsc32_set_cur_ptr(struct njsc32_cmd *cmd, u_int32_t pos)
   1422  1.1    itohy {
   1423  1.1    itohy 
   1424  1.1    itohy 	/* new current data pointer */
   1425  1.1    itohy 	cmd->c_dp_cur = pos;
   1426  1.1    itohy 
   1427  1.1    itohy 	/* update number of bytes transferred */
   1428  1.1    itohy 	if (pos > cmd->c_dp_max)
   1429  1.1    itohy 		cmd->c_dp_max = pos;
   1430  1.1    itohy }
   1431  1.1    itohy 
   1432  1.1    itohy /*
   1433  1.1    itohy  * set data pointer for the next transfer
   1434  1.1    itohy  */
   1435  1.1    itohy static void
   1436  1.2  thorpej njsc32_set_ptr(struct njsc32_softc *sc, struct njsc32_cmd *cmd, u_int32_t pos)
   1437  1.1    itohy {
   1438  1.1    itohy 	struct njsc32_sgtable *sg;
   1439  1.1    itohy 	unsigned sgte;
   1440  1.1    itohy 	u_int32_t len;
   1441  1.1    itohy 
   1442  1.1    itohy 	/* set current pointer */
   1443  1.1    itohy 	njsc32_set_cur_ptr(cmd, pos);
   1444  1.1    itohy 
   1445  1.1    itohy 	/* undo previous fix if any */
   1446  1.1    itohy 	if (cmd->c_sgfixcnt != 0) {
   1447  1.1    itohy 		sg = &cmd->c_sgt[cmd->c_sgoffset];
   1448  1.1    itohy 		sg->sg_addr = htole32(le32toh(sg->sg_addr) - cmd->c_sgfixcnt);
   1449  1.1    itohy 		sg->sg_len = htole32(le32toh(sg->sg_len) + cmd->c_sgfixcnt);
   1450  1.1    itohy 		cmd->c_sgfixcnt = 0;
   1451  1.1    itohy 	}
   1452  1.1    itohy 
   1453  1.1    itohy 	if (pos >= cmd->c_datacnt) {
   1454  1.1    itohy 		/* transfer done */
   1455  1.1    itohy #if 1 /*def DIAGNOSTIC*/
   1456  1.1    itohy 		if (pos > cmd->c_datacnt)
   1457  1.1    itohy 			printf("%s: pos %u too large\n",
   1458  1.1    itohy 			    sc->sc_dev.dv_xname, pos - cmd->c_datacnt);
   1459  1.1    itohy #endif
   1460  1.1    itohy 		cmd->c_xferctl = 0;	/* XXX correct? */
   1461  1.1    itohy 
   1462  1.1    itohy 		return;
   1463  1.1    itohy 	}
   1464  1.1    itohy 
   1465  1.1    itohy 	for (sgte = 0, sg = cmd->c_sgt;
   1466  1.1    itohy 	    sgte < NJSC32_NUM_SG && pos > 0; sgte++, sg++) {
   1467  1.1    itohy 		len = le32toh(sg->sg_len) & ~NJSC32_SGT_ENDMARK;
   1468  1.1    itohy 		if (pos < len) {
   1469  1.1    itohy 			sg->sg_addr = htole32(le32toh(sg->sg_addr) + pos);
   1470  1.1    itohy 			sg->sg_len = htole32(le32toh(sg->sg_len) - pos);
   1471  1.1    itohy 			cmd->c_sgfixcnt = pos;
   1472  1.1    itohy 			break;
   1473  1.1    itohy 		}
   1474  1.1    itohy 		pos -= len;
   1475  1.1    itohy #ifdef DIAGNOSTIC
   1476  1.1    itohy 		if (sg->sg_len & htole32(NJSC32_SGT_ENDMARK)) {
   1477  1.1    itohy 			panic("njsc32_set_ptr: bad pos");
   1478  1.1    itohy 		}
   1479  1.1    itohy #endif
   1480  1.1    itohy 	}
   1481  1.1    itohy #ifdef DIAGNOSTIC
   1482  1.1    itohy 	if (sgte >= NJSC32_NUM_SG)
   1483  1.1    itohy 		panic("njsc32_set_ptr: bad sg");
   1484  1.1    itohy #endif
   1485  1.1    itohy 	if (cmd->c_sgoffset != sgte) {
   1486  1.1    itohy 		cmd->c_sgoffset = sgte;
   1487  1.1    itohy 		cmd->c_sgtdmaaddr = NJSC32_CMD_DMAADDR_SGT(cmd, sgte);
   1488  1.1    itohy 	}
   1489  1.1    itohy 
   1490  1.1    itohy 	/* XXX overkill */
   1491  1.1    itohy 	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_cmdpg,
   1492  1.1    itohy 	    (char *)cmd->c_sgt - (char *)sc->sc_cmdpg,	/* offset */
   1493  1.1    itohy 	    NJSC32_SIZE_SGT,
   1494  1.1    itohy 	    BUS_DMASYNC_PREWRITE);
   1495  1.1    itohy }
   1496  1.1    itohy 
   1497  1.1    itohy /*
   1498  1.1    itohy  * save data pointer
   1499  1.1    itohy  */
   1500  1.1    itohy static __inline void
   1501  1.2  thorpej njsc32_save_ptr(struct njsc32_cmd *cmd)
   1502  1.1    itohy {
   1503  1.1    itohy 
   1504  1.1    itohy 	cmd->c_dp_saved = cmd->c_dp_cur;
   1505  1.1    itohy }
   1506  1.1    itohy 
   1507  1.1    itohy static void
   1508  1.2  thorpej njsc32_assert_ack(struct njsc32_softc *sc)
   1509  1.1    itohy {
   1510  1.1    itohy 	u_int8_t reg;
   1511  1.1    itohy 
   1512  1.1    itohy 	reg = njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_CONTROL);
   1513  1.1    itohy 	reg |= NJSC32_SBCTL_ACK | NJSC32_SBCTL_ACK_ENABLE;
   1514  1.1    itohy #if 0	/* needed? */
   1515  1.1    itohy 	reg |= NJSC32_SBCTL_AUTODIRECTION;
   1516  1.1    itohy #endif
   1517  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_BUS_CONTROL, reg);
   1518  1.1    itohy }
   1519  1.1    itohy 
   1520  1.1    itohy static void
   1521  1.2  thorpej njsc32_negate_ack(struct njsc32_softc *sc)
   1522  1.1    itohy {
   1523  1.1    itohy 	u_int8_t reg;
   1524  1.1    itohy 
   1525  1.1    itohy 	reg = njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_CONTROL);
   1526  1.1    itohy #if 0	/* needed? */
   1527  1.1    itohy 	reg |= NJSC32_SBCTL_ACK_ENABLE;
   1528  1.1    itohy 	reg |= NJSC32_SBCTL_AUTODIRECTION;
   1529  1.1    itohy #endif
   1530  1.1    itohy 	reg &= ~NJSC32_SBCTL_ACK;
   1531  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_BUS_CONTROL, reg);
   1532  1.1    itohy }
   1533  1.1    itohy 
   1534  1.1    itohy static void
   1535  1.2  thorpej njsc32_wait_req_negate(struct njsc32_softc *sc)
   1536  1.1    itohy {
   1537  1.1    itohy 	int cnt;
   1538  1.1    itohy 
   1539  1.1    itohy 	for (cnt = 0; cnt < NJSC32_REQ_TIMEOUT; cnt++) {
   1540  1.1    itohy 		if ((njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_MONITOR) &
   1541  1.1    itohy 		    NJSC32_BUSMON_REQ) == 0)
   1542  1.1    itohy 			return;
   1543  1.1    itohy 		delay(1);
   1544  1.1    itohy 	}
   1545  1.1    itohy 	printf("%s: njsc32_wait_req_negate: timed out\n", sc->sc_dev.dv_xname);
   1546  1.1    itohy }
   1547  1.1    itohy 
   1548  1.1    itohy static void
   1549  1.2  thorpej njsc32_reconnect(struct njsc32_softc *sc, struct njsc32_cmd *cmd)
   1550  1.1    itohy {
   1551  1.1    itohy 	struct scsipi_xfer *xs;
   1552  1.1    itohy 
   1553  1.1    itohy 	xs = cmd->c_xs;
   1554  1.1    itohy 	if ((xs->xs_control & XS_CTL_POLL) == 0) {
   1555  1.1    itohy 		callout_stop(&xs->xs_callout);
   1556  1.1    itohy 		callout_reset(&xs->xs_callout,
   1557  1.1    itohy 		    mstohz(xs->timeout),
   1558  1.1    itohy 		    njsc32_cmdtimeout, cmd);
   1559  1.1    itohy 	}
   1560  1.1    itohy 
   1561  1.1    itohy 	/* Reconnection implies Restore Pointers */
   1562  1.1    itohy 	njsc32_set_ptr(sc, cmd, cmd->c_dp_saved);
   1563  1.1    itohy }
   1564  1.1    itohy 
   1565  1.1    itohy static enum njsc32_reselstat
   1566  1.2  thorpej njsc32_resel_identify(struct njsc32_softc *sc, int lun,
   1567  1.2  thorpej     struct njsc32_cmd **pcmd)
   1568  1.1    itohy {
   1569  1.1    itohy 	int targetid;
   1570  1.1    itohy 	struct njsc32_lu *plu;
   1571  1.1    itohy 	struct njsc32_cmd *cmd;
   1572  1.1    itohy 
   1573  1.1    itohy 	switch (sc->sc_stat) {
   1574  1.1    itohy 	case NJSC32_STAT_RESEL:
   1575  1.1    itohy 		break;	/* OK */
   1576  1.1    itohy 
   1577  1.1    itohy 	case NJSC32_STAT_RESEL_LUN:
   1578  1.1    itohy 	case NJSC32_STAT_RECONNECT:
   1579  1.1    itohy 		/*
   1580  1.1    itohy 		 * accept and ignore if the LUN is the same as the current one,
   1581  1.1    itohy 		 * reject otherwise.
   1582  1.1    itohy 		 */
   1583  1.1    itohy 		return sc->sc_resellun == lun ?
   1584  1.1    itohy 		    NJSC32_RESEL_THROUGH : NJSC32_RESEL_ERROR;
   1585  1.1    itohy 
   1586  1.1    itohy 	default:
   1587  1.1    itohy 		printf("%s: njsc32_resel_identify: not in reselection\n",
   1588  1.1    itohy 		    sc->sc_dev.dv_xname);
   1589  1.1    itohy 		return NJSC32_RESEL_ERROR;
   1590  1.1    itohy 	}
   1591  1.1    itohy 
   1592  1.1    itohy 	targetid = sc->sc_reselid;
   1593  1.1    itohy 	TPRINTF(("%s: njsc32_resel_identify: reselection lun %d\n",
   1594  1.1    itohy 	    sc->sc_dev.dv_xname, lun));
   1595  1.1    itohy 
   1596  1.1    itohy 	if (targetid > NJSC32_MAX_TARGET_ID || lun >= NJSC32_NLU)
   1597  1.1    itohy 		return NJSC32_RESEL_ERROR;
   1598  1.1    itohy 
   1599  1.1    itohy 	sc->sc_resellun = lun;
   1600  1.1    itohy 	plu = &sc->sc_targets[targetid].t_lus[lun];
   1601  1.1    itohy 
   1602  1.1    itohy 	if ((cmd = plu->lu_cmd) != NULL) {
   1603  1.1    itohy 		sc->sc_stat = NJSC32_STAT_RECONNECT;
   1604  1.1    itohy 		plu->lu_cmd = NULL;
   1605  1.1    itohy 		*pcmd = cmd;
   1606  1.1    itohy 		TPRINTC(cmd, ("njsc32_resel_identify: I_T_L nexus\n"));
   1607  1.1    itohy 		njsc32_reconnect(sc, cmd);
   1608  1.1    itohy 		return NJSC32_RESEL_COMPLETE;
   1609  1.1    itohy 	} else if (!TAILQ_EMPTY(&plu->lu_q)) {
   1610  1.1    itohy 		/* wait for tag */
   1611  1.1    itohy 		sc->sc_stat = NJSC32_STAT_RESEL_LUN;
   1612  1.1    itohy 		return NJSC32_RESEL_THROUGH;
   1613  1.1    itohy 	}
   1614  1.1    itohy 
   1615  1.1    itohy 	/* no disconnected commands */
   1616  1.1    itohy 	return NJSC32_RESEL_ERROR;
   1617  1.1    itohy }
   1618  1.1    itohy 
   1619  1.1    itohy static enum njsc32_reselstat
   1620  1.2  thorpej njsc32_resel_tag(struct njsc32_softc *sc, int tag, struct njsc32_cmd **pcmd)
   1621  1.1    itohy {
   1622  1.1    itohy 	struct njsc32_cmd_head *head;
   1623  1.1    itohy 	struct njsc32_cmd *cmd;
   1624  1.1    itohy 
   1625  1.1    itohy 	TPRINTF(("%s: njsc32_resel_tag: reselection tag %d\n",
   1626  1.1    itohy 	    sc->sc_dev.dv_xname, tag));
   1627  1.1    itohy 	if (sc->sc_stat != NJSC32_STAT_RESEL_LUN)
   1628  1.1    itohy 		return NJSC32_RESEL_ERROR;
   1629  1.1    itohy 
   1630  1.1    itohy 	head = &sc->sc_targets[sc->sc_reselid].t_lus[sc->sc_resellun].lu_q;
   1631  1.1    itohy 
   1632  1.1    itohy 	/* XXX slow? */
   1633  1.1    itohy 	/* search for the command of the tag */
   1634  1.1    itohy 	TAILQ_FOREACH(cmd, head, c_q) {
   1635  1.1    itohy 		if (cmd->c_xs->xs_tag_id == tag) {
   1636  1.1    itohy 			sc->sc_stat = NJSC32_STAT_RECONNECT;
   1637  1.1    itohy 			TAILQ_REMOVE(head, cmd, c_q);
   1638  1.1    itohy 			*pcmd = cmd;
   1639  1.1    itohy 			TPRINTC(cmd, ("njsc32_resel_tag: I_T_L_Q nexus\n"));
   1640  1.1    itohy 			njsc32_reconnect(sc, cmd);
   1641  1.1    itohy 			return NJSC32_RESEL_COMPLETE;
   1642  1.1    itohy 		}
   1643  1.1    itohy 	}
   1644  1.1    itohy 
   1645  1.1    itohy 	/* no disconnected commands */
   1646  1.1    itohy 	return NJSC32_RESEL_ERROR;
   1647  1.1    itohy }
   1648  1.1    itohy 
   1649  1.1    itohy /*
   1650  1.1    itohy  * Reload parameters and restart AutoSCSI.
   1651  1.1    itohy  *
   1652  1.1    itohy  * XXX autoparam doesn't work as expected and we can't use it here.
   1653  1.1    itohy  */
   1654  1.1    itohy static void
   1655  1.2  thorpej njsc32_cmd_reload(struct njsc32_softc *sc, struct njsc32_cmd *cmd, int cctl)
   1656  1.1    itohy {
   1657  1.1    itohy 	struct njsc32_target *target;
   1658  1.1    itohy 
   1659  1.1    itohy 	target = cmd->c_target;
   1660  1.1    itohy 
   1661  1.1    itohy 	/* clear parity error and enable parity detection */
   1662  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_PARITY_CONTROL,
   1663  1.1    itohy 	    NJSC32_PARITYCTL_CHECK_ENABLE | NJSC32_PARITYCTL_CLEAR_ERROR);
   1664  1.1    itohy 
   1665  1.1    itohy 	/* load parameters */
   1666  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SYNC, target->t_sync);
   1667  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_ACK_WIDTH, target->t_ackwidth);
   1668  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SREQ_SAMPLING, target->t_sample);
   1669  1.1    itohy 	njsc32_write_4(sc, NJSC32_REG_SGT_ADR, cmd->c_sgtdmaaddr);
   1670  1.1    itohy #ifdef NJSC32_DUALEDGE
   1671  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER,
   1672  1.1    itohy 	    cmd->c_xferctl | target->t_xferctl);
   1673  1.1    itohy #else
   1674  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER, cmd->c_xferctl);
   1675  1.1    itohy #endif
   1676  1.1    itohy 	/* start AutoSCSI */
   1677  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, cctl);
   1678  1.1    itohy 
   1679  1.1    itohy 	sc->sc_curcmd = cmd;
   1680  1.1    itohy }
   1681  1.1    itohy 
   1682  1.1    itohy static void
   1683  1.2  thorpej njsc32_update_xfer_mode(struct njsc32_softc *sc, struct njsc32_target *target)
   1684  1.1    itohy {
   1685  1.1    itohy 	struct scsipi_xfer_mode xm;
   1686  1.1    itohy 
   1687  1.1    itohy 	xm.xm_target = target - sc->sc_targets;	/* target ID */
   1688  1.1    itohy 	xm.xm_mode = 0;
   1689  1.1    itohy 	xm.xm_period = target->t_syncperiod;
   1690  1.1    itohy 	xm.xm_offset = target->t_syncoffset;
   1691  1.1    itohy 	if (xm.xm_offset != 0)
   1692  1.1    itohy 		xm.xm_mode |= PERIPH_CAP_SYNC;
   1693  1.1    itohy 	if (target->t_flags & NJSC32_TARF_TAG)
   1694  1.1    itohy 		xm.xm_mode |= PERIPH_CAP_TQING;
   1695  1.1    itohy 
   1696  1.1    itohy 	scsipi_async_event(&sc->sc_channel, ASYNC_EVENT_XFER_MODE, &xm);
   1697  1.1    itohy }
   1698  1.1    itohy 
   1699  1.1    itohy static void
   1700  1.2  thorpej njsc32_msgin(struct njsc32_softc *sc)
   1701  1.1    itohy {
   1702  1.1    itohy 	u_int8_t msg0, msg;
   1703  1.1    itohy 	int msgcnt;
   1704  1.1    itohy 	struct njsc32_cmd *cmd;
   1705  1.1    itohy 	enum njsc32_reselstat rstat;
   1706  1.1    itohy 	int cctl = 0;
   1707  1.1    itohy 	u_int32_t ptr;	/* unsigned type ensures 2-complement calculation */
   1708  1.1    itohy 	u_int32_t msgout = 0;
   1709  1.1    itohy 	boolean_t reload_params = FALSE;
   1710  1.1    itohy 	struct njsc32_target *target;
   1711  1.1    itohy 	int idx, period, offset;
   1712  1.1    itohy 
   1713  1.1    itohy 	/*
   1714  1.1    itohy 	 * we are in Message In, so the previous Message Out should have
   1715  1.1    itohy 	 * been done.
   1716  1.1    itohy 	 */
   1717  1.1    itohy 	njsc32_init_msgout(sc);
   1718  1.1    itohy 
   1719  1.1    itohy 	/* get a byte of Message In */
   1720  1.1    itohy 	msg = njsc32_read_1(sc, NJSC32_REG_DATA_IN);
   1721  1.1    itohy 	TPRINTF(("%s: njsc32_msgin: got %#x\n", sc->sc_dev.dv_xname, msg));
   1722  1.1    itohy 	if ((msgcnt = sc->sc_msgincnt) < NJSC32_MSGIN_LEN)
   1723  1.1    itohy 		sc->sc_msginbuf[sc->sc_msgincnt] = msg;
   1724  1.1    itohy 
   1725  1.1    itohy 	njsc32_assert_ack(sc);
   1726  1.1    itohy 
   1727  1.1    itohy 	msg0 = sc->sc_msginbuf[0];
   1728  1.1    itohy 	cmd = sc->sc_curcmd;
   1729  1.1    itohy 
   1730  1.1    itohy 	/* check for parity error */
   1731  1.1    itohy 	if (njsc32_read_1(sc, NJSC32_REG_PARITY_STATUS) &
   1732  1.1    itohy 	    NJSC32_PARITYSTATUS_ERROR_LSB) {
   1733  1.1    itohy 
   1734  1.1    itohy 		printf("%s: msgin: parity error\n", sc->sc_dev.dv_xname);
   1735  1.1    itohy 
   1736  1.1    itohy 		/* clear parity error */
   1737  1.1    itohy 		njsc32_write_1(sc, NJSC32_REG_PARITY_CONTROL,
   1738  1.1    itohy 		    NJSC32_PARITYCTL_CHECK_ENABLE |
   1739  1.1    itohy 		    NJSC32_PARITYCTL_CLEAR_ERROR);
   1740  1.1    itohy 
   1741  1.1    itohy 		/* respond as Message Parity Error */
   1742  1.1    itohy 		njsc32_add_msgout(sc, MSG_PARITY_ERROR);
   1743  1.1    itohy 
   1744  1.1    itohy 		/* clear Message In */
   1745  1.1    itohy 		sc->sc_msgincnt = 0;
   1746  1.1    itohy 		goto reply;
   1747  1.1    itohy 	}
   1748  1.1    itohy 
   1749  1.1    itohy #define WAITNEXTMSG	do { sc->sc_msgincnt++; goto restart; } while (0)
   1750  1.1    itohy #define MSGCOMPLETE	do { sc->sc_msgincnt = 0; goto restart; } while (0)
   1751  1.1    itohy 	if (MSG_ISIDENTIFY(msg0)) {
   1752  1.1    itohy 		/*
   1753  1.1    itohy 		 * Got Identify message from target.
   1754  1.1    itohy 		 */
   1755  1.1    itohy 		if ((msg0 & ~MSG_IDENTIFY_LUNMASK) != MSG_IDENTIFYFLAG ||
   1756  1.1    itohy 		    (rstat = njsc32_resel_identify(sc, msg0 &
   1757  1.1    itohy 			MSG_IDENTIFY_LUNMASK, &cmd)) == NJSC32_RESEL_ERROR) {
   1758  1.1    itohy 			/*
   1759  1.1    itohy 			 * invalid Identify -> Reject
   1760  1.1    itohy 			 */
   1761  1.1    itohy 			goto reject;
   1762  1.1    itohy 		}
   1763  1.1    itohy 		if (rstat == NJSC32_RESEL_COMPLETE)
   1764  1.1    itohy 			reload_params = TRUE;
   1765  1.1    itohy 		MSGCOMPLETE;
   1766  1.1    itohy 	}
   1767  1.1    itohy 
   1768  1.1    itohy 	if (msg0 == MSG_SIMPLE_Q_TAG) {
   1769  1.1    itohy 		if (msgcnt == 0)
   1770  1.1    itohy 			WAITNEXTMSG;
   1771  1.1    itohy 
   1772  1.1    itohy 		/* got whole message */
   1773  1.1    itohy 		sc->sc_msgincnt = 0;
   1774  1.1    itohy 
   1775  1.1    itohy 		if ((rstat = njsc32_resel_tag(sc, sc->sc_msginbuf[1], &cmd))
   1776  1.1    itohy 		    == NJSC32_RESEL_ERROR) {
   1777  1.1    itohy 			/*
   1778  1.1    itohy 			 * invalid Simple Queue Tag -> Abort Tag
   1779  1.1    itohy 			 */
   1780  1.1    itohy 			printf("%s: msgin: invalid tag\n", sc->sc_dev.dv_xname);
   1781  1.1    itohy 			njsc32_add_msgout(sc, MSG_ABORT_TAG);
   1782  1.1    itohy 			goto reply;
   1783  1.1    itohy 		}
   1784  1.1    itohy 		if (rstat == NJSC32_RESEL_COMPLETE)
   1785  1.1    itohy 			reload_params = TRUE;
   1786  1.1    itohy 		MSGCOMPLETE;
   1787  1.1    itohy 	}
   1788  1.1    itohy 
   1789  1.1    itohy 	/* I_T_L or I_T_L_Q nexus should be established now */
   1790  1.1    itohy 	if (cmd == NULL) {
   1791  1.1    itohy 		printf("%s: msgin %#x without nexus -- sending abort\n",
   1792  1.1    itohy 		    sc->sc_dev.dv_xname, msg0);
   1793  1.1    itohy 		njsc32_add_msgout(sc, MSG_ABORT);
   1794  1.1    itohy 		goto reply;
   1795  1.1    itohy 	}
   1796  1.1    itohy 
   1797  1.1    itohy 	/*
   1798  1.1    itohy 	 * extended message
   1799  1.1    itohy 	 * 0x01 <length (0 stands for 256)> <length bytes>
   1800  1.1    itohy 	 *                                 (<code> [<parameter> ...])
   1801  1.1    itohy 	 */
   1802  1.1    itohy #define EXTLENOFF	1
   1803  1.1    itohy #define EXTCODEOFF	2
   1804  1.1    itohy 	if (msg0 == MSG_EXTENDED) {
   1805  1.1    itohy 		if (msgcnt < EXTLENOFF ||
   1806  1.1    itohy 		    msgcnt < EXTLENOFF + 1 +
   1807  1.1    itohy 		    (u_int8_t)(sc->sc_msginbuf[EXTLENOFF] - 1))
   1808  1.1    itohy 			WAITNEXTMSG;
   1809  1.1    itohy 
   1810  1.1    itohy 		/* got whole message */
   1811  1.1    itohy 		sc->sc_msgincnt = 0;
   1812  1.1    itohy 
   1813  1.1    itohy 		switch (sc->sc_msginbuf[EXTCODEOFF]) {
   1814  1.1    itohy 		case 0:	/* Modify Data Pointer */
   1815  1.1    itohy 			if (msgcnt != 5 + EXTCODEOFF - 1)
   1816  1.1    itohy 				break;
   1817  1.1    itohy 			/*
   1818  1.1    itohy 			 * parameter is 32bit big-endian signed (2-complement)
   1819  1.1    itohy 			 * value
   1820  1.1    itohy 			 */
   1821  1.1    itohy 			ptr = (sc->sc_msginbuf[EXTCODEOFF + 1] << 24) |
   1822  1.1    itohy 			      (sc->sc_msginbuf[EXTCODEOFF + 2] << 16) |
   1823  1.1    itohy 			      (sc->sc_msginbuf[EXTCODEOFF + 3] << 8) |
   1824  1.1    itohy 			      sc->sc_msginbuf[EXTCODEOFF + 4];
   1825  1.1    itohy 
   1826  1.1    itohy 			/* new pointer */
   1827  1.1    itohy 			ptr += cmd->c_dp_cur;	/* ignore overflow */
   1828  1.1    itohy 
   1829  1.1    itohy 			/* reject if ptr is not in data buffer */
   1830  1.1    itohy 			if (ptr > cmd->c_datacnt)
   1831  1.1    itohy 				break;
   1832  1.1    itohy 
   1833  1.1    itohy 			njsc32_set_ptr(sc, cmd, ptr);
   1834  1.1    itohy 			goto restart;
   1835  1.1    itohy 
   1836  1.1    itohy 		case MSG_EXT_SDTR:	/* Synchronous Data Transfer Request */
   1837  1.1    itohy 			DPRINTC(cmd, ("SDTR %#x %#x\n",
   1838  1.1    itohy 			    sc->sc_msginbuf[EXTCODEOFF + 1],
   1839  1.1    itohy 			    sc->sc_msginbuf[EXTCODEOFF + 2]));
   1840  1.1    itohy 			if (msgcnt != MSG_EXT_SDTR_LEN + EXTCODEOFF-1)
   1841  1.1    itohy 				break;	/* reject */
   1842  1.1    itohy 
   1843  1.1    itohy 			target = cmd->c_target;
   1844  1.1    itohy 
   1845  1.1    itohy 			/* lookup sync period parameters */
   1846  1.1    itohy 			period = sc->sc_msginbuf[EXTCODEOFF + 1];
   1847  1.1    itohy 			for (idx = sc->sc_sync_max; idx < NJSC32_NSYNCT; idx++)
   1848  1.1    itohy 				if (sc->sc_synct[idx].sp_period >= period) {
   1849  1.1    itohy 					period = sc->sc_synct[idx].sp_period;
   1850  1.1    itohy 					break;
   1851  1.1    itohy 				}
   1852  1.1    itohy 			if (idx >= NJSC32_NSYNCT) {
   1853  1.1    itohy 				/*
   1854  1.1    itohy 				 * We can't meet the timing condition that
   1855  1.1    itohy 				 * the target requests -- use async.
   1856  1.1    itohy 				 */
   1857  1.1    itohy 				njsc32_target_async(sc, target);
   1858  1.1    itohy 				njsc32_update_xfer_mode(sc, target);
   1859  1.1    itohy 				if (target->t_state == NJSC32_TARST_SDTR) {
   1860  1.1    itohy 					/*
   1861  1.1    itohy 					 * We started SDTR exchange -- start
   1862  1.1    itohy 					 * negotiation again and request async.
   1863  1.1    itohy 					 */
   1864  1.1    itohy 					target->t_state = NJSC32_TARST_ASYNC;
   1865  1.1    itohy 					njsc32_negotiate_xfer(sc, target);
   1866  1.1    itohy 					goto reply;
   1867  1.1    itohy 				} else {
   1868  1.1    itohy 					/*
   1869  1.1    itohy 					 * The target started SDTR exchange
   1870  1.1    itohy 					 * -- just reject and fallback
   1871  1.1    itohy 					 * to async.
   1872  1.1    itohy 					 */
   1873  1.1    itohy 					goto reject;
   1874  1.1    itohy 				}
   1875  1.1    itohy 			}
   1876  1.1    itohy 
   1877  1.1    itohy 			/* check sync offset */
   1878  1.1    itohy 			offset = sc->sc_msginbuf[EXTCODEOFF + 2];
   1879  1.1    itohy 			if (offset > NJSC32_SYNCOFFSET_MAX) {
   1880  1.1    itohy 				if (target->t_state == NJSC32_TARST_SDTR) {
   1881  1.1    itohy 					printf("%s: wrong sync offset: %d\n",
   1882  1.1    itohy 					    cmd->c_xs->xs_periph->periph_dev->dv_xname,
   1883  1.1    itohy 					    offset);
   1884  1.1    itohy 					/* XXX what to do? */
   1885  1.1    itohy 				}
   1886  1.1    itohy 				offset = NJSC32_SYNCOFFSET_MAX;
   1887  1.1    itohy 			}
   1888  1.1    itohy 
   1889  1.1    itohy 			target->t_ackwidth = sc->sc_synct[idx].sp_ackw;
   1890  1.1    itohy 			target->t_sample   = sc->sc_synct[idx].sp_sample;
   1891  1.1    itohy 			target->t_syncperiod = period;
   1892  1.1    itohy 			target->t_syncoffset = offset;
   1893  1.1    itohy 			target->t_sync = NJSC32_SYNC_VAL(idx, offset);
   1894  1.1    itohy 			njsc32_update_xfer_mode(sc, target);
   1895  1.1    itohy 
   1896  1.1    itohy 			if (target->t_state == NJSC32_TARST_SDTR) {
   1897  1.1    itohy 				target->t_state = NJSC32_TARST_DONE;
   1898  1.1    itohy 			} else {
   1899  1.1    itohy 				njsc32_msgout_sdtr(sc, period, offset);
   1900  1.1    itohy 				goto reply;
   1901  1.1    itohy 			}
   1902  1.1    itohy 			goto restart;
   1903  1.1    itohy 
   1904  1.1    itohy 		case MSG_EXT_WDTR:	/* Wide Data Transfer Request */
   1905  1.1    itohy 			DPRINTC(cmd,
   1906  1.1    itohy 			    ("WDTR %#x\n", sc->sc_msginbuf[EXTCODEOFF + 1]));
   1907  1.1    itohy #ifdef NJSC32_DUALEDGE
   1908  1.1    itohy 			if (msgcnt != MSG_EXT_WDTR_LEN + EXTCODEOFF-1)
   1909  1.1    itohy 				break;	/* reject */
   1910  1.1    itohy 
   1911  1.1    itohy 			/*
   1912  1.1    itohy 			 * T->I of this message is not used for
   1913  1.1    itohy 			 * DualEdge negotiation, so the device
   1914  1.1    itohy 			 * must not be a DualEdge device.
   1915  1.1    itohy 			 *
   1916  1.1    itohy 			 * XXX correct?
   1917  1.1    itohy 			 */
   1918  1.1    itohy 			target = cmd->c_target;
   1919  1.1    itohy 			target->t_xferctl = 0;
   1920  1.1    itohy 
   1921  1.1    itohy 			switch (target->t_state) {
   1922  1.1    itohy 			case NJSC32_TARST_DE:
   1923  1.1    itohy 				if (sc->sc_msginbuf[EXTCODEOFF + 1] !=
   1924  1.1    itohy 				    MSG_EXT_WDTR_BUS_8_BIT) {
   1925  1.1    itohy 					/*
   1926  1.1    itohy 					 * Oops, we got unexpected WDTR.
   1927  1.1    itohy 					 * Negotiate for 8bit.
   1928  1.1    itohy 					 */
   1929  1.1    itohy 					target->t_state = NJSC32_TARST_WDTR;
   1930  1.1    itohy 				} else {
   1931  1.1    itohy 					target->t_state = NJSC32_TARST_SDTR;
   1932  1.1    itohy 				}
   1933  1.1    itohy 				njsc32_negotiate_xfer(sc, target);
   1934  1.1    itohy 				goto reply;
   1935  1.1    itohy 
   1936  1.1    itohy 			case NJSC32_TARST_WDTR:
   1937  1.1    itohy 				if (sc->sc_msginbuf[EXTCODEOFF + 1] !=
   1938  1.1    itohy 				    MSG_EXT_WDTR_BUS_8_BIT) {
   1939  1.1    itohy 					printf("%s: unexpected transfer width: %#x\n",
   1940  1.1    itohy 					    cmd->c_xs->xs_periph->periph_dev->dv_xname,
   1941  1.1    itohy 					    sc->sc_msginbuf[EXTCODEOFF + 1]);
   1942  1.1    itohy 					/* XXX what to do? */
   1943  1.1    itohy 				}
   1944  1.1    itohy 				target->t_state = NJSC32_TARST_SDTR;
   1945  1.1    itohy 				njsc32_negotiate_xfer(sc, target);
   1946  1.1    itohy 				goto reply;
   1947  1.1    itohy 
   1948  1.1    itohy 			default:
   1949  1.1    itohy 				/* the target started WDTR exchange */
   1950  1.1    itohy 				DPRINTC(cmd, ("WDTR from target\n"));
   1951  1.1    itohy 
   1952  1.1    itohy 				target->t_state = NJSC32_TARST_SDTR;
   1953  1.1    itohy 				njsc32_target_async(sc, target);
   1954  1.1    itohy 
   1955  1.1    itohy 				break;	/* reject the WDTR (8bit transfer) */
   1956  1.1    itohy 			}
   1957  1.1    itohy #endif	/* NJSC32_DUALEDGE */
   1958  1.1    itohy 			break;	/* reject */
   1959  1.1    itohy 		}
   1960  1.1    itohy 		DPRINTC(cmd, ("njsc32_msgin: reject ext msg %#x msgincnt %d\n",
   1961  1.1    itohy 		    sc->sc_msginbuf[EXTCODEOFF], msgcnt));
   1962  1.1    itohy 		goto reject;
   1963  1.1    itohy 	}
   1964  1.1    itohy 
   1965  1.1    itohy 	/* 2byte messages */
   1966  1.1    itohy 	if (MSG_IS2BYTE(msg0)) {
   1967  1.1    itohy 		if (msgcnt == 0)
   1968  1.1    itohy 			WAITNEXTMSG;
   1969  1.1    itohy 
   1970  1.1    itohy 		/* got whole message */
   1971  1.1    itohy 		sc->sc_msgincnt = 0;
   1972  1.1    itohy 	}
   1973  1.1    itohy 
   1974  1.1    itohy 	switch (msg0) {
   1975  1.1    itohy 	case MSG_CMDCOMPLETE:		/* 0x00 */
   1976  1.1    itohy 	case MSG_SAVEDATAPOINTER:	/* 0x02 */
   1977  1.1    itohy 	case MSG_DISCONNECT:		/* 0x04 */
   1978  1.1    itohy 		/* handled by AutoSCSI */
   1979  1.1    itohy 		PRINTC(cmd, ("msgin: unexpected msg: %#x\n", msg0));
   1980  1.1    itohy 		break;
   1981  1.1    itohy 
   1982  1.1    itohy 	case MSG_RESTOREPOINTERS:	/* 0x03 */
   1983  1.1    itohy 		/* restore data pointer to what was saved */
   1984  1.1    itohy 		DPRINTC(cmd, ("njsc32_msgin: Restore Pointers\n"));
   1985  1.1    itohy 		njsc32_set_ptr(sc, cmd, cmd->c_dp_saved);
   1986  1.1    itohy 		reload_params = TRUE;
   1987  1.1    itohy 		MSGCOMPLETE;
   1988  1.1    itohy 		/* NOTREACHED */
   1989  1.1    itohy 		break;
   1990  1.1    itohy 
   1991  1.1    itohy #if 0	/* handled above */
   1992  1.1    itohy 	case MSG_EXTENDED:		/* 0x01 */
   1993  1.1    itohy #endif
   1994  1.1    itohy 	case MSG_MESSAGE_REJECT:	/* 0x07 */
   1995  1.1    itohy 		target = cmd->c_target;
   1996  1.1    itohy 		DPRINTC(cmd, ("Reject tarst %d\n", target->t_state));
   1997  1.1    itohy 		switch (target->t_state) {
   1998  1.1    itohy #ifdef NJSC32_DUALEDGE
   1999  1.1    itohy 		case NJSC32_TARST_WDTR:
   2000  1.1    itohy 		case NJSC32_TARST_DE:
   2001  1.1    itohy 			target->t_xferctl = 0;
   2002  1.1    itohy 			target->t_state = NJSC32_TARST_SDTR;
   2003  1.1    itohy 			njsc32_negotiate_xfer(sc, target);
   2004  1.1    itohy 			goto reply;
   2005  1.1    itohy #endif
   2006  1.1    itohy 		case NJSC32_TARST_SDTR:
   2007  1.1    itohy 		case NJSC32_TARST_ASYNC:
   2008  1.1    itohy 			njsc32_target_async(sc, target);
   2009  1.1    itohy 			target->t_state = NJSC32_TARST_DONE;
   2010  1.1    itohy 			njsc32_update_xfer_mode(sc, target);
   2011  1.1    itohy 			break;
   2012  1.1    itohy 		default:
   2013  1.1    itohy 			break;
   2014  1.1    itohy 		}
   2015  1.1    itohy 		goto restart;
   2016  1.1    itohy 
   2017  1.1    itohy 	case MSG_NOOP:			/* 0x08 */
   2018  1.1    itohy #ifdef NJSC32_DUALEDGE
   2019  1.1    itohy 		target = cmd->c_target;
   2020  1.1    itohy 		if (target->t_state == NJSC32_TARST_DE) {
   2021  1.1    itohy 			aprint_normal("%s: DualEdge transfer\n",
   2022  1.1    itohy 			    cmd->c_xs->xs_periph->periph_dev->dv_xname);
   2023  1.1    itohy 			target->t_xferctl = NJSC32_XFR_DUALEDGE_ENABLE;
   2024  1.1    itohy 			/* go to next negotiation */
   2025  1.1    itohy 			target->t_state = NJSC32_TARST_SDTR;
   2026  1.1    itohy 			njsc32_negotiate_xfer(sc, target);
   2027  1.1    itohy 			goto reply;
   2028  1.1    itohy 		}
   2029  1.1    itohy #endif
   2030  1.1    itohy 		goto restart;
   2031  1.1    itohy 
   2032  1.1    itohy 	case MSG_INITIATOR_DET_ERR:	/* 0x05 I->T only */
   2033  1.1    itohy 	case MSG_ABORT:			/* 0x06 I->T only */
   2034  1.1    itohy 	case MSG_PARITY_ERROR:		/* 0x09 I->T only */
   2035  1.1    itohy 	case MSG_LINK_CMD_COMPLETE:	/* 0x0a */
   2036  1.1    itohy 	case MSG_LINK_CMD_COMPLETEF:	/* 0x0b */
   2037  1.1    itohy 	case MSG_BUS_DEV_RESET:		/* 0x0c I->T only */
   2038  1.1    itohy 	case MSG_ABORT_TAG:		/* 0x0d I->T only */
   2039  1.1    itohy 	case MSG_CLEAR_QUEUE:		/* 0x0e I->T only */
   2040  1.1    itohy 
   2041  1.1    itohy #if 0	/* handled above */
   2042  1.1    itohy 	case MSG_SIMPLE_Q_TAG:		/* 0x20 */
   2043  1.1    itohy #endif
   2044  1.1    itohy 	case MSG_HEAD_OF_Q_TAG:		/* 0x21 I->T only */
   2045  1.1    itohy 	case MSG_ORDERED_Q_TAG:		/* 0x22 I->T only */
   2046  1.1    itohy 	case MSG_IGN_WIDE_RESIDUE:	/* 0x23 */
   2047  1.1    itohy 
   2048  1.1    itohy 	default:
   2049  1.1    itohy #ifdef NJSC32_DEBUG
   2050  1.1    itohy 		PRINTC(cmd, ("msgin: unsupported msg: %#x", msg0));
   2051  1.1    itohy 		if (MSG_IS2BYTE(msg0))
   2052  1.1    itohy 			printf(" %#x", msg);
   2053  1.1    itohy 		printf("\n");
   2054  1.1    itohy #endif
   2055  1.1    itohy 		break;
   2056  1.1    itohy 	}
   2057  1.1    itohy 
   2058  1.1    itohy reject:
   2059  1.1    itohy 	njsc32_add_msgout(sc, MSG_MESSAGE_REJECT);
   2060  1.1    itohy 
   2061  1.1    itohy reply:
   2062  1.1    itohy 	msgout = njsc32_get_auto_msgout(sc);
   2063  1.1    itohy 
   2064  1.1    itohy restart:
   2065  1.1    itohy 	cctl = NJSC32_CMD_CLEAR_CDB_FIFO_PTR |
   2066  1.1    itohy 	    NJSC32_CMD_AUTO_COMMAND_PHASE |
   2067  1.1    itohy 	    NJSC32_CMD_AUTO_SCSI_RESTART;
   2068  1.1    itohy 
   2069  1.1    itohy 	/*
   2070  1.1    itohy 	 * Be careful the second and latter bytes of Message In
   2071  1.1    itohy 	 * shall not be absorbed by AutoSCSI.
   2072  1.1    itohy 	 */
   2073  1.1    itohy 	if (sc->sc_msgincnt == 0)
   2074  1.1    itohy 		cctl |= NJSC32_CMD_AUTO_MSGIN_00_04 | NJSC32_CMD_AUTO_MSGIN_02;
   2075  1.1    itohy 
   2076  1.1    itohy 	if (sc->sc_msgoutlen != 0)
   2077  1.1    itohy 		cctl |= NJSC32_CMD_AUTO_ATN;
   2078  1.1    itohy 
   2079  1.1    itohy 	njsc32_write_4(sc, NJSC32_REG_SCSI_MSG_OUT, msgout);
   2080  1.1    itohy 
   2081  1.1    itohy 	/* (re)start AutoSCSI (may assert ATN) */
   2082  1.1    itohy 	if (reload_params) {
   2083  1.1    itohy 		njsc32_cmd_reload(sc, cmd, cctl);
   2084  1.1    itohy 	} else {
   2085  1.1    itohy 		njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, cctl);
   2086  1.1    itohy 	}
   2087  1.1    itohy 
   2088  1.1    itohy 	/* +ATN -> -REQ: need 90ns delay? */
   2089  1.1    itohy 
   2090  1.1    itohy 	njsc32_wait_req_negate(sc);	/* wait for REQ negation */
   2091  1.1    itohy 
   2092  1.1    itohy 	njsc32_negate_ack(sc);
   2093  1.1    itohy 
   2094  1.1    itohy 	return;
   2095  1.1    itohy }
   2096  1.1    itohy 
   2097  1.1    itohy static void
   2098  1.2  thorpej njsc32_msgout(struct njsc32_softc *sc)
   2099  1.1    itohy {
   2100  1.1    itohy 	int cctl;
   2101  1.1    itohy 	u_int8_t bus;
   2102  1.1    itohy 	unsigned n;
   2103  1.1    itohy 
   2104  1.1    itohy 	if (sc->sc_msgoutlen == 0) {
   2105  1.1    itohy 		/* target entered to Message Out on unexpected timing */
   2106  1.1    itohy 		njsc32_add_msgout(sc, MSG_NOOP);
   2107  1.1    itohy 	}
   2108  1.1    itohy 
   2109  1.1    itohy 	cctl = NJSC32_CMD_CLEAR_CDB_FIFO_PTR |
   2110  1.1    itohy 	    NJSC32_CMD_AUTO_COMMAND_PHASE | NJSC32_CMD_AUTO_SCSI_RESTART |
   2111  1.1    itohy 	    NJSC32_CMD_AUTO_MSGIN_00_04 | NJSC32_CMD_AUTO_MSGIN_02;
   2112  1.1    itohy 
   2113  1.1    itohy 	/* make sure target is in Message Out phase */
   2114  1.1    itohy 	bus = njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_MONITOR);
   2115  1.1    itohy 	if ((bus & NJSC32_BUSMON_PHASE_MASK) != NJSC32_PHASE_MESSAGE_OUT) {
   2116  1.1    itohy 		/*
   2117  1.1    itohy 		 * Message Out is aborted by target.
   2118  1.1    itohy 		 */
   2119  1.1    itohy 		printf("%s: njsc32_msgout: phase change %#x\n",
   2120  1.1    itohy 		    sc->sc_dev.dv_xname, bus);
   2121  1.1    itohy 
   2122  1.1    itohy 		/* XXX what to do? */
   2123  1.1    itohy 
   2124  1.1    itohy 		/* restart AutoSCSI (negate ATN) */
   2125  1.1    itohy 		njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, cctl);
   2126  1.1    itohy 
   2127  1.1    itohy 		sc->sc_msgoutidx = 0;
   2128  1.1    itohy 		return;
   2129  1.1    itohy 	}
   2130  1.1    itohy 
   2131  1.1    itohy 	n = sc->sc_msgoutidx;
   2132  1.1    itohy 	if (n == sc->sc_msgoutlen - 1) {
   2133  1.1    itohy 		/*
   2134  1.1    itohy 		 * negate ATN before sending ACK
   2135  1.1    itohy 		 */
   2136  1.1    itohy 		njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, 0);
   2137  1.1    itohy 
   2138  1.1    itohy 		sc->sc_msgoutidx = 0;	/* target may retry Message Out */
   2139  1.1    itohy 	} else {
   2140  1.1    itohy 		cctl |= NJSC32_CMD_AUTO_ATN;
   2141  1.1    itohy 		sc->sc_msgoutidx++;
   2142  1.1    itohy 	}
   2143  1.1    itohy 
   2144  1.1    itohy 	/* Send Message Out */
   2145  1.1    itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_OUT_LATCH, sc->sc_msgout[n]);
   2146  1.1    itohy 
   2147  1.1    itohy 	/* DBn -> +ACK: need 55ns delay? */
   2148  1.1    itohy 
   2149  1.1    itohy 	njsc32_assert_ack(sc);
   2150  1.1    itohy 	njsc32_wait_req_negate(sc);	/* wait for REQ negation */
   2151  1.1    itohy 
   2152  1.1    itohy 	/* restart AutoSCSI */
   2153  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, cctl);
   2154  1.1    itohy 
   2155  1.1    itohy 	njsc32_negate_ack(sc);
   2156  1.1    itohy 
   2157  1.1    itohy 	/*
   2158  1.1    itohy 	 * do not reset sc->sc_msgoutlen so the target
   2159  1.1    itohy 	 * can retry Message Out phase
   2160  1.1    itohy 	 */
   2161  1.1    itohy }
   2162  1.1    itohy 
   2163  1.1    itohy static void
   2164  1.2  thorpej njsc32_cmdtimeout(void *arg)
   2165  1.1    itohy {
   2166  1.1    itohy 	struct njsc32_cmd *cmd = arg;
   2167  1.1    itohy 	struct njsc32_softc *sc;
   2168  1.1    itohy 	int s;
   2169  1.1    itohy 
   2170  1.1    itohy 	PRINTC(cmd, ("command timeout\n"));
   2171  1.1    itohy 
   2172  1.1    itohy 	sc = cmd->c_sc;
   2173  1.1    itohy 
   2174  1.1    itohy 	s = splbio();
   2175  1.1    itohy 
   2176  1.1    itohy 	if (sc->sc_stat == NJSC32_STAT_ARBIT)
   2177  1.1    itohy 		njsc32_arbitration_failed(sc);
   2178  1.1    itohy 	else {
   2179  1.1    itohy 		sc->sc_curcmd = NULL;
   2180  1.1    itohy 		sc->sc_stat = NJSC32_STAT_IDLE;
   2181  1.1    itohy 		njsc32_end_cmd(sc, cmd, XS_TIMEOUT);
   2182  1.1    itohy 	}
   2183  1.1    itohy 
   2184  1.1    itohy 	/* XXX? */
   2185  1.1    itohy 	njsc32_init(sc, 1);	/* bus reset */
   2186  1.1    itohy 
   2187  1.1    itohy 	splx(s);
   2188  1.1    itohy }
   2189  1.1    itohy 
   2190  1.1    itohy static void
   2191  1.2  thorpej njsc32_reseltimeout(void *arg)
   2192  1.1    itohy {
   2193  1.1    itohy 	struct njsc32_cmd *cmd = arg;
   2194  1.1    itohy 	struct njsc32_softc *sc;
   2195  1.1    itohy 	int s;
   2196  1.1    itohy 
   2197  1.1    itohy 	PRINTC(cmd, ("reselection timeout\n"));
   2198  1.1    itohy 
   2199  1.1    itohy 	sc = cmd->c_sc;
   2200  1.1    itohy 
   2201  1.1    itohy 	s = splbio();
   2202  1.1    itohy 
   2203  1.1    itohy 	/* remove from disconnected list */
   2204  1.1    itohy 	if (cmd->c_flags & NJSC32_CMD_TAGGED) {
   2205  1.1    itohy 		/* I_T_L_Q */
   2206  1.1    itohy 		KASSERT(cmd->c_lu->lu_cmd == NULL);
   2207  1.1    itohy 		TAILQ_REMOVE(&cmd->c_lu->lu_q, cmd, c_q);
   2208  1.1    itohy 	} else {
   2209  1.1    itohy 		/* I_T_L */
   2210  1.1    itohy 		KASSERT(cmd->c_lu->lu_cmd == cmd);
   2211  1.1    itohy 		cmd->c_lu->lu_cmd = NULL;
   2212  1.1    itohy 	}
   2213  1.1    itohy 
   2214  1.1    itohy 	njsc32_end_cmd(sc, cmd, XS_TIMEOUT);
   2215  1.1    itohy 
   2216  1.1    itohy 	/* XXX? */
   2217  1.1    itohy 	njsc32_init(sc, 1);	/* bus reset */
   2218  1.1    itohy 
   2219  1.1    itohy 	splx(s);
   2220  1.1    itohy }
   2221  1.1    itohy 
   2222  1.1    itohy static __inline void
   2223  1.2  thorpej njsc32_end_auto(struct njsc32_softc *sc, struct njsc32_cmd *cmd, int auto_phase)
   2224  1.1    itohy {
   2225  1.1    itohy 	struct scsipi_xfer *xs;
   2226  1.1    itohy 
   2227  1.1    itohy 	if (auto_phase & NJSC32_XPHASE_MSGIN_02) {
   2228  1.1    itohy 		/* Message In: 0x02 Save Data Pointer */
   2229  1.1    itohy 
   2230  1.1    itohy 		/*
   2231  1.1    itohy 		 * Adjust saved data pointer
   2232  1.1    itohy 		 * if the command is not completed yet.
   2233  1.1    itohy 		 */
   2234  1.1    itohy 		if ((auto_phase & NJSC32_XPHASE_MSGIN_00) == 0 &&
   2235  1.1    itohy 		    (auto_phase &
   2236  1.1    itohy 		     (NJSC32_XPHASE_DATA_IN | NJSC32_XPHASE_DATA_OUT)) != 0) {
   2237  1.1    itohy 			njsc32_save_ptr(cmd);
   2238  1.1    itohy 		}
   2239  1.1    itohy 		TPRINTF(("BM %u, SGT %u, SACK %u, SAVED_ACK %u\n",
   2240  1.1    itohy 		    njsc32_read_4(sc, NJSC32_REG_BM_CNT),
   2241  1.1    itohy 		    njsc32_read_4(sc, NJSC32_REG_SGT_ADR),
   2242  1.1    itohy 		    njsc32_read_4(sc, NJSC32_REG_SACK_CNT),
   2243  1.1    itohy 		    njsc32_read_4(sc, NJSC32_REG_SAVED_ACK_CNT)));
   2244  1.1    itohy 	}
   2245  1.1    itohy 
   2246  1.1    itohy 	xs = cmd->c_xs;
   2247  1.1    itohy 
   2248  1.1    itohy 	if (auto_phase & NJSC32_XPHASE_MSGIN_00) {
   2249  1.1    itohy 		/* Command Complete */
   2250  1.1    itohy 		TPRINTC(cmd, ("njsc32_intr: Command Complete\n"));
   2251  1.1    itohy 		switch (xs->status) {
   2252  1.1    itohy 		case SCSI_CHECK: case SCSI_QUEUE_FULL: case SCSI_BUSY:
   2253  1.1    itohy 			/*
   2254  1.1    itohy 			 * scsipi layer will automatically handle the error
   2255  1.1    itohy 			 */
   2256  1.1    itohy 			njsc32_end_cmd(sc, cmd, XS_BUSY);
   2257  1.1    itohy 			break;
   2258  1.1    itohy 		default:
   2259  1.1    itohy 			xs->resid -= cmd->c_dp_max;
   2260  1.1    itohy 			njsc32_end_cmd(sc, cmd, XS_NOERROR);
   2261  1.1    itohy 			break;
   2262  1.1    itohy 		}
   2263  1.1    itohy 	} else if (auto_phase & NJSC32_XPHASE_MSGIN_04) {
   2264  1.1    itohy 		/* Disconnect */
   2265  1.1    itohy 		TPRINTC(cmd, ("njsc32_intr: Disconnect\n"));
   2266  1.1    itohy 
   2267  1.1    itohy 		/* for ill-designed devices */
   2268  1.1    itohy 		if ((xs->xs_periph->periph_quirks & PQUIRK_AUTOSAVE) != 0)
   2269  1.1    itohy 			njsc32_save_ptr(cmd);
   2270  1.1    itohy 
   2271  1.1    itohy 		/*
   2272  1.1    itohy 		 * move current cmd to disconnected list
   2273  1.1    itohy 		 */
   2274  1.1    itohy 		if (cmd->c_flags & NJSC32_CMD_TAGGED) {
   2275  1.1    itohy 			/* I_T_L_Q */
   2276  1.1    itohy 			if (cmd->c_flags & NJSC32_CMD_TAGGED_HEAD)
   2277  1.1    itohy 				TAILQ_INSERT_HEAD(&cmd->c_lu->lu_q, cmd, c_q);
   2278  1.1    itohy 			else
   2279  1.1    itohy 				TAILQ_INSERT_TAIL(&cmd->c_lu->lu_q, cmd, c_q);
   2280  1.1    itohy 		} else {
   2281  1.1    itohy 			/* I_T_L */
   2282  1.1    itohy 			cmd->c_lu->lu_cmd = cmd;
   2283  1.1    itohy 		}
   2284  1.1    itohy 
   2285  1.1    itohy 		/*
   2286  1.1    itohy 		 * schedule timeout -- avoid being
   2287  1.1    itohy 		 * disconnected forever
   2288  1.1    itohy 		 */
   2289  1.1    itohy 		if ((xs->xs_control & XS_CTL_POLL) == 0) {
   2290  1.1    itohy 			callout_stop(&xs->xs_callout);
   2291  1.1    itohy 			callout_reset(&xs->xs_callout, mstohz(xs->timeout),
   2292  1.1    itohy 			    njsc32_reseltimeout, cmd);
   2293  1.1    itohy 		}
   2294  1.1    itohy 
   2295  1.1    itohy 	} else {
   2296  1.1    itohy 		/*
   2297  1.1    itohy 		 * target has come to Bus Free phase
   2298  1.1    itohy 		 * probably to notify an error
   2299  1.1    itohy 		 */
   2300  1.1    itohy 		PRINTC(cmd, ("njsc32_intr: unexpected bus free\n"));
   2301  1.1    itohy 		/* try Request Sense */
   2302  1.1    itohy 		xs->status = SCSI_CHECK;
   2303  1.1    itohy 		njsc32_end_cmd(sc, cmd, XS_BUSY);
   2304  1.1    itohy 	}
   2305  1.1    itohy }
   2306  1.1    itohy 
   2307  1.1    itohy int
   2308  1.2  thorpej njsc32_intr(void *arg)
   2309  1.1    itohy {
   2310  1.1    itohy 	struct njsc32_softc *sc = arg;
   2311  1.1    itohy 	u_int16_t intr;
   2312  1.1    itohy 	u_int8_t arbstat, bus_phase;
   2313  1.1    itohy 	int auto_phase;
   2314  1.1    itohy 	int idbit;
   2315  1.1    itohy 	struct njsc32_cmd *cmd;
   2316  1.1    itohy 
   2317  1.1    itohy 	intr = njsc32_read_2(sc, NJSC32_REG_IRQ);
   2318  1.1    itohy 	if ((intr & NJSC32_IRQ_INTR_PENDING) == 0)
   2319  1.1    itohy 		return 0;	/* not mine */
   2320  1.1    itohy 
   2321  1.1    itohy 	TPRINTF(("%s: njsc32_intr: %#x\n", sc->sc_dev.dv_xname, intr));
   2322  1.1    itohy 
   2323  1.1    itohy #if 0	/* I don't think this is required */
   2324  1.1    itohy 	/* mask interrupts */
   2325  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_IRQ, NJSC32_IRQ_MASK_ALL);
   2326  1.1    itohy #endif
   2327  1.1    itohy 
   2328  1.1    itohy 	/* we got an interrupt, so stop the timer */
   2329  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_TIMER, NJSC32_TIMER_STOP);
   2330  1.1    itohy 
   2331  1.1    itohy 	if (intr & NJSC32_IRQ_SCSIRESET) {
   2332  1.1    itohy 		printf("%s: detected bus reset\n", sc->sc_dev.dv_xname);
   2333  1.1    itohy 		/* clear current request */
   2334  1.1    itohy 		njsc32_reset_detected(sc);
   2335  1.1    itohy 		goto out;
   2336  1.1    itohy 	}
   2337  1.1    itohy 
   2338  1.1    itohy 	if (sc->sc_stat == NJSC32_STAT_ARBIT) {
   2339  1.1    itohy 		cmd = sc->sc_curcmd;
   2340  1.1    itohy 		KASSERT(cmd);
   2341  1.1    itohy 		arbstat = njsc32_read_1(sc, NJSC32_REG_ARBITRATION_STAT);
   2342  1.1    itohy 		if (arbstat & (NJSC32_ARBSTAT_WIN | NJSC32_ARBSTAT_FAIL)) {
   2343  1.1    itohy 			/*
   2344  1.1    itohy 			 * arbitration done
   2345  1.1    itohy 			 */
   2346  1.1    itohy 			/* clear arbitration status */
   2347  1.1    itohy 			njsc32_write_1(sc, NJSC32_REG_SET_ARBITRATION,
   2348  1.1    itohy 			    NJSC32_SETARB_CLEAR);
   2349  1.1    itohy 
   2350  1.1    itohy 			if (arbstat & NJSC32_ARBSTAT_WIN) {
   2351  1.1    itohy 				TPRINTC(cmd,
   2352  1.1    itohy 				    ("njsc32_intr: arbitration won\n"));
   2353  1.1    itohy 
   2354  1.1    itohy 				TAILQ_REMOVE(&sc->sc_reqcmd, cmd, c_q);
   2355  1.1    itohy 
   2356  1.1    itohy 				sc->sc_stat = NJSC32_STAT_CONNECT;
   2357  1.1    itohy 			} else {
   2358  1.1    itohy 				TPRINTC(cmd,
   2359  1.1    itohy 				    ("njsc32_intr: arbitration failed\n"));
   2360  1.1    itohy 
   2361  1.1    itohy 				njsc32_arbitration_failed(sc);
   2362  1.1    itohy 
   2363  1.1    itohy 				/* XXX delay */
   2364  1.1    itohy 				/* XXX retry counter */
   2365  1.1    itohy 			}
   2366  1.1    itohy 		}
   2367  1.1    itohy 	}
   2368  1.1    itohy 
   2369  1.1    itohy 	if (intr & NJSC32_IRQ_TIMER) {
   2370  1.1    itohy 		TPRINTF(("%s: njsc32_intr: timer interrupt\n",
   2371  1.1    itohy 		    sc->sc_dev.dv_xname));
   2372  1.1    itohy 	}
   2373  1.1    itohy 
   2374  1.1    itohy 	if (intr & NJSC32_IRQ_RESELECT) {
   2375  1.1    itohy 		/* Reselection from a target */
   2376  1.1    itohy 		njsc32_arbitration_failed(sc);	/* just in case */
   2377  1.1    itohy 		if ((cmd = sc->sc_curcmd) != NULL) {
   2378  1.1    itohy 			/* ? */
   2379  1.1    itohy 			printf("%s: unexpected reselection\n",
   2380  1.1    itohy 			    sc->sc_dev.dv_xname);
   2381  1.1    itohy 			sc->sc_curcmd = NULL;
   2382  1.1    itohy 			sc->sc_stat = NJSC32_STAT_IDLE;
   2383  1.1    itohy 			njsc32_end_cmd(sc, cmd, XS_DRIVER_STUFFUP);
   2384  1.1    itohy 		}
   2385  1.1    itohy 
   2386  1.1    itohy 		idbit = njsc32_read_1(sc, NJSC32_REG_RESELECT_ID);
   2387  1.1    itohy 		if ((idbit & (1 << NJSC32_INITIATOR_ID)) == 0 ||
   2388  1.1    itohy 		    (sc->sc_reselid = ffs(idbit & ~NJSC32_INITIATOR_ID) -1)
   2389  1.1    itohy 		    < 0) {
   2390  1.1    itohy 			printf("%s: invalid reselection (id: %#x)\n",
   2391  1.1    itohy 			    sc->sc_dev.dv_xname, idbit);
   2392  1.1    itohy 			sc->sc_stat = NJSC32_STAT_IDLE;	/* XXX ? */
   2393  1.1    itohy 		} else {
   2394  1.1    itohy 			sc->sc_stat = NJSC32_STAT_RESEL;
   2395  1.1    itohy 			TPRINTF(("%s: njsc32_intr: reselection from %d\n",
   2396  1.1    itohy 			    sc->sc_dev.dv_xname, sc->sc_reselid));
   2397  1.1    itohy 		}
   2398  1.1    itohy 	}
   2399  1.1    itohy 
   2400  1.1    itohy 	if (intr & NJSC32_IRQ_PHASE_CHANGE) {
   2401  1.1    itohy #if 1	/* XXX probably not needed */
   2402  1.1    itohy 		if (sc->sc_stat == NJSC32_STAT_ARBIT)
   2403  1.1    itohy 			PRINTC(sc->sc_curcmd,
   2404  1.1    itohy 			    ("njsc32_intr: cancel arbitration phase\n"));
   2405  1.1    itohy 		njsc32_arbitration_failed(sc);
   2406  1.1    itohy #endif
   2407  1.1    itohy 		/* current bus phase */
   2408  1.1    itohy 		bus_phase = njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_MONITOR) &
   2409  1.1    itohy 		    NJSC32_BUSMON_PHASE_MASK;
   2410  1.1    itohy 
   2411  1.1    itohy 		switch (bus_phase) {
   2412  1.1    itohy 		case NJSC32_PHASE_MESSAGE_IN:
   2413  1.1    itohy 			njsc32_msgin(sc);
   2414  1.1    itohy 			break;
   2415  1.1    itohy 
   2416  1.1    itohy 		/*
   2417  1.1    itohy 		 * target may suddenly become Status / Bus Free phase
   2418  1.1    itohy 		 * to notify an error condition
   2419  1.1    itohy 		 */
   2420  1.1    itohy 		case NJSC32_PHASE_STATUS:
   2421  1.1    itohy 			printf("%s: unexpected bus phase: Status\n",
   2422  1.1    itohy 			    sc->sc_dev.dv_xname);
   2423  1.1    itohy 			if ((cmd = sc->sc_curcmd) != NULL) {
   2424  1.1    itohy 				cmd->c_xs->status =
   2425  1.1    itohy 				    njsc32_read_1(sc, NJSC32_REG_SCSI_CSB_IN);
   2426  1.1    itohy 				TPRINTC(cmd, ("njsc32_intr: Status %d\n",
   2427  1.1    itohy 				    cmd->c_xs->status));
   2428  1.1    itohy 			}
   2429  1.1    itohy 			break;
   2430  1.1    itohy 		case NJSC32_PHASE_BUSFREE:
   2431  1.1    itohy 			printf("%s: unexpected bus phase: Bus Free\n",
   2432  1.1    itohy 			    sc->sc_dev.dv_xname);
   2433  1.1    itohy 			if ((cmd = sc->sc_curcmd) != NULL) {
   2434  1.1    itohy 				sc->sc_curcmd = NULL;
   2435  1.1    itohy 				sc->sc_stat = NJSC32_STAT_IDLE;
   2436  1.1    itohy 				if (cmd->c_xs->status != SCSI_QUEUE_FULL &&
   2437  1.1    itohy 				    cmd->c_xs->status != SCSI_BUSY)
   2438  1.1    itohy 					cmd->c_xs->status = SCSI_CHECK;/* XXX */
   2439  1.1    itohy 				njsc32_end_cmd(sc, cmd, XS_BUSY);
   2440  1.1    itohy 			}
   2441  1.1    itohy 			goto out;
   2442  1.1    itohy 		default:
   2443  1.1    itohy #ifdef NJSC32_DEBUG
   2444  1.1    itohy 			printf("%s: unexpected bus phase: ",
   2445  1.1    itohy 			    sc->sc_dev.dv_xname);
   2446  1.1    itohy 			switch (bus_phase) {
   2447  1.1    itohy 			case NJSC32_PHASE_COMMAND:
   2448  1.1    itohy 				printf("Command\n");	break;
   2449  1.1    itohy 			case NJSC32_PHASE_MESSAGE_OUT:
   2450  1.1    itohy 				printf("Message Out\n");break;
   2451  1.1    itohy 			case NJSC32_PHASE_DATA_IN:
   2452  1.1    itohy 				printf("Data In\n");	break;
   2453  1.1    itohy 			case NJSC32_PHASE_DATA_OUT:
   2454  1.1    itohy 				printf("Data Out\n");	break;
   2455  1.1    itohy 			case NJSC32_PHASE_RESELECT:
   2456  1.1    itohy 				printf("Reselect\n");break;
   2457  1.1    itohy 			default: printf("%#x\n", bus_phase);	break;
   2458  1.1    itohy 			}
   2459  1.1    itohy #else
   2460  1.1    itohy 			printf("%s: unexpected bus phase: %#x",
   2461  1.1    itohy 			    sc->sc_dev.dv_xname, bus_phase);
   2462  1.1    itohy #endif
   2463  1.1    itohy 			break;
   2464  1.1    itohy 		}
   2465  1.1    itohy 	}
   2466  1.1    itohy 
   2467  1.1    itohy 	if (intr & NJSC32_IRQ_AUTOSCSI) {
   2468  1.1    itohy 		/*
   2469  1.1    itohy 		 * AutoSCSI interrupt
   2470  1.1    itohy 		 */
   2471  1.1    itohy 		auto_phase = njsc32_read_2(sc, NJSC32_REG_EXECUTE_PHASE);
   2472  1.1    itohy 		TPRINTF(("%s: njsc32_intr: AutoSCSI: %#x\n",
   2473  1.1    itohy 		    sc->sc_dev.dv_xname, auto_phase));
   2474  1.1    itohy 		njsc32_write_2(sc, NJSC32_REG_EXECUTE_PHASE, 0);
   2475  1.1    itohy 
   2476  1.1    itohy 		if (auto_phase & NJSC32_XPHASE_SEL_TIMEOUT) {
   2477  1.1    itohy 			cmd = sc->sc_curcmd;
   2478  1.1    itohy 			if (cmd == NULL) {
   2479  1.1    itohy 				printf("%s: sel no cmd\n",
   2480  1.1    itohy 				    sc->sc_dev.dv_xname);
   2481  1.1    itohy 				goto out;
   2482  1.1    itohy 			}
   2483  1.1    itohy 			DPRINTC(cmd, ("njsc32_intr: selection timeout\n"));
   2484  1.1    itohy 
   2485  1.1    itohy 			sc->sc_curcmd = NULL;
   2486  1.1    itohy 			sc->sc_stat = NJSC32_STAT_IDLE;
   2487  1.1    itohy 			njsc32_end_cmd(sc, cmd, XS_SELTIMEOUT);
   2488  1.1    itohy 
   2489  1.1    itohy 			goto out;
   2490  1.1    itohy 		}
   2491  1.1    itohy 
   2492  1.1    itohy #ifdef NJSC32_TRACE
   2493  1.1    itohy 		if (auto_phase & NJSC32_XPHASE_COMMAND) {
   2494  1.1    itohy 			/* Command phase has been automatically processed */
   2495  1.1    itohy 			TPRINTF(("%s: njsc32_intr: Command\n",
   2496  1.1    itohy 			    sc->sc_dev.dv_xname));
   2497  1.1    itohy 		}
   2498  1.1    itohy #endif
   2499  1.1    itohy #ifdef NJSC32_DEBUG
   2500  1.1    itohy 		if (auto_phase & NJSC32_XPHASE_ILLEGAL) {
   2501  1.1    itohy 			printf("%s: njsc32_intr: Illegal phase\n",
   2502  1.1    itohy 			    sc->sc_dev.dv_xname);
   2503  1.1    itohy 		}
   2504  1.1    itohy #endif
   2505  1.1    itohy 
   2506  1.1    itohy 		if (auto_phase & NJSC32_XPHASE_PAUSED_MSG_IN) {
   2507  1.1    itohy 			TPRINTF(("%s: njsc32_intr: Process Message In\n",
   2508  1.1    itohy 			    sc->sc_dev.dv_xname));
   2509  1.1    itohy 			njsc32_msgin(sc);
   2510  1.1    itohy 		}
   2511  1.1    itohy 
   2512  1.1    itohy 		if (auto_phase & NJSC32_XPHASE_PAUSED_MSG_OUT) {
   2513  1.1    itohy 			TPRINTF(("%s: njsc32_intr: Process Message Out\n",
   2514  1.1    itohy 			    sc->sc_dev.dv_xname));
   2515  1.1    itohy 			njsc32_msgout(sc);
   2516  1.1    itohy 		}
   2517  1.1    itohy 
   2518  1.1    itohy 		cmd = sc->sc_curcmd;
   2519  1.1    itohy 		if (cmd == NULL) {
   2520  1.1    itohy 			TPRINTF(("%s: njsc32_intr: no cmd\n",
   2521  1.1    itohy 			    sc->sc_dev.dv_xname));
   2522  1.1    itohy 			goto out;
   2523  1.1    itohy 		}
   2524  1.1    itohy 
   2525  1.1    itohy 		if (auto_phase &
   2526  1.1    itohy 		    (NJSC32_XPHASE_DATA_IN | NJSC32_XPHASE_DATA_OUT)) {
   2527  1.1    itohy #ifdef NJSC32_TRACE
   2528  1.1    itohy 			if (auto_phase & NJSC32_XPHASE_DATA_IN)
   2529  1.1    itohy 				PRINTC(cmd, ("njsc32_intr: data in done\n"));
   2530  1.1    itohy 			if (auto_phase & NJSC32_XPHASE_DATA_OUT)
   2531  1.1    itohy 				PRINTC(cmd, ("njsc32_intr: data out done\n"));
   2532  1.1    itohy 			printf("BM %u, SGT %u, SACK %u, SAVED_ACK %u\n",
   2533  1.1    itohy 				njsc32_read_4(sc, NJSC32_REG_BM_CNT),
   2534  1.1    itohy 				njsc32_read_4(sc, NJSC32_REG_SGT_ADR),
   2535  1.1    itohy 				njsc32_read_4(sc, NJSC32_REG_SACK_CNT),
   2536  1.1    itohy 				njsc32_read_4(sc, NJSC32_REG_SAVED_ACK_CNT));
   2537  1.1    itohy #endif
   2538  1.1    itohy 
   2539  1.1    itohy 			/*
   2540  1.1    itohy 			 * detected parity error on data transfer?
   2541  1.1    itohy 			 */
   2542  1.1    itohy 			if (njsc32_read_1(sc, NJSC32_REG_PARITY_STATUS) &
   2543  1.1    itohy 			    (NJSC32_PARITYSTATUS_ERROR_LSB|
   2544  1.1    itohy 			     NJSC32_PARITYSTATUS_ERROR_MSB)) {
   2545  1.1    itohy 
   2546  1.1    itohy 				PRINTC(cmd, ("datain: parity error\n"));
   2547  1.1    itohy 
   2548  1.1    itohy 				/* clear parity error */
   2549  1.1    itohy 				njsc32_write_1(sc, NJSC32_REG_PARITY_CONTROL,
   2550  1.1    itohy 				    NJSC32_PARITYCTL_CHECK_ENABLE |
   2551  1.1    itohy 				    NJSC32_PARITYCTL_CLEAR_ERROR);
   2552  1.1    itohy 
   2553  1.1    itohy 				if (auto_phase & NJSC32_XPHASE_BUS_FREE) {
   2554  1.1    itohy 					/*
   2555  1.1    itohy 					 * XXX command has already finished
   2556  1.1    itohy 					 * -- what can we do?
   2557  1.1    itohy 					 *
   2558  1.1    itohy 					 * It is not clear current command
   2559  1.1    itohy 					 * caused the error -- reset everything.
   2560  1.1    itohy 					 */
   2561  1.1    itohy 					njsc32_init(sc, 1);	/* XXX */
   2562  1.1    itohy 				} else {
   2563  1.1    itohy 					/* XXX does this case occur? */
   2564  1.1    itohy #if 1
   2565  1.1    itohy 					printf("%s: datain: parity error\n",
   2566  1.1    itohy 					    sc->sc_dev.dv_xname);
   2567  1.1    itohy #endif
   2568  1.1    itohy 					/*
   2569  1.1    itohy 					 * Make attention condition and try
   2570  1.1    itohy 					 * to send Initiator Detected Error
   2571  1.1    itohy 					 * message.
   2572  1.1    itohy 					 */
   2573  1.1    itohy 					njsc32_init_msgout(sc);
   2574  1.1    itohy 					njsc32_add_msgout(sc,
   2575  1.1    itohy 					    MSG_INITIATOR_DET_ERR);
   2576  1.1    itohy 					njsc32_write_4(sc,
   2577  1.1    itohy 					    NJSC32_REG_SCSI_MSG_OUT,
   2578  1.1    itohy 					    njsc32_get_auto_msgout(sc));
   2579  1.1    itohy 					/* restart autoscsi with ATN */
   2580  1.1    itohy 					njsc32_write_2(sc,
   2581  1.1    itohy 					    NJSC32_REG_COMMAND_CONTROL,
   2582  1.1    itohy 					    NJSC32_CMD_CLEAR_CDB_FIFO_PTR |
   2583  1.1    itohy 					    NJSC32_CMD_AUTO_COMMAND_PHASE |
   2584  1.1    itohy 					    NJSC32_CMD_AUTO_SCSI_RESTART |
   2585  1.1    itohy 					    NJSC32_CMD_AUTO_MSGIN_00_04 |
   2586  1.1    itohy 					    NJSC32_CMD_AUTO_MSGIN_02 |
   2587  1.1    itohy 					    NJSC32_CMD_AUTO_ATN);
   2588  1.1    itohy 				}
   2589  1.1    itohy 				goto out;
   2590  1.1    itohy 			}
   2591  1.1    itohy 
   2592  1.1    itohy 			/*
   2593  1.1    itohy 			 * data has been transferred, and current pointer
   2594  1.1    itohy 			 * is changed
   2595  1.1    itohy 			 */
   2596  1.1    itohy 			njsc32_set_cur_ptr(cmd, cmd->c_dp_cur +
   2597  1.1    itohy 			    njsc32_read_4(sc, NJSC32_REG_SACK_CNT));
   2598  1.1    itohy 		}
   2599  1.1    itohy 
   2600  1.1    itohy 		if (auto_phase & NJSC32_XPHASE_MSGOUT) {
   2601  1.1    itohy 			/* Message Out phase has been automatically processed */
   2602  1.1    itohy 			TPRINTC(cmd, ("njsc32_intr: Message Out\n"));
   2603  1.1    itohy 			if ((auto_phase & NJSC32_XPHASE_PAUSED_MSG_IN) == 0 &&
   2604  1.1    itohy 			    sc->sc_msgoutlen <= NJSC32_MSGOUT_MAX_AUTO) {
   2605  1.1    itohy 				njsc32_init_msgout(sc);
   2606  1.1    itohy 			}
   2607  1.1    itohy 		}
   2608  1.1    itohy 
   2609  1.1    itohy 		if (auto_phase & NJSC32_XPHASE_STATUS) {
   2610  1.1    itohy 			/* Status phase has been automatically processed */
   2611  1.1    itohy 			cmd->c_xs->status =
   2612  1.1    itohy 			    njsc32_read_1(sc, NJSC32_REG_SCSI_CSB_IN);
   2613  1.1    itohy 			TPRINTC(cmd, ("njsc32_intr: Status %#x\n",
   2614  1.1    itohy 			    cmd->c_xs->status));
   2615  1.1    itohy 		}
   2616  1.1    itohy 
   2617  1.1    itohy 		if (auto_phase & NJSC32_XPHASE_BUS_FREE) {
   2618  1.1    itohy 			/* AutoSCSI is finished */
   2619  1.1    itohy 
   2620  1.1    itohy 			TPRINTC(cmd, ("njsc32_intr: Bus Free\n"));
   2621  1.1    itohy 
   2622  1.1    itohy 			sc->sc_stat = NJSC32_STAT_IDLE;
   2623  1.1    itohy 			sc->sc_curcmd = NULL;
   2624  1.1    itohy 
   2625  1.1    itohy 			njsc32_end_auto(sc, cmd, auto_phase);
   2626  1.1    itohy 		}
   2627  1.1    itohy 		goto out;
   2628  1.1    itohy 	}
   2629  1.1    itohy 
   2630  1.1    itohy 	if (intr & NJSC32_IRQ_FIFO_THRESHOLD) {
   2631  1.1    itohy 		/* XXX We use DMA, and this shouldn't happen */
   2632  1.1    itohy 		printf("%s: njsc32_intr: FIFO\n", sc->sc_dev.dv_xname);
   2633  1.1    itohy 		njsc32_init(sc, 1);
   2634  1.1    itohy 		goto out;
   2635  1.1    itohy 	}
   2636  1.1    itohy 	if (intr & NJSC32_IRQ_PCI) {
   2637  1.1    itohy 		/* XXX? */
   2638  1.1    itohy 		printf("%s: njsc32_intr: PCI\n", sc->sc_dev.dv_xname);
   2639  1.1    itohy 	}
   2640  1.1    itohy 	if (intr & NJSC32_IRQ_BMCNTERR) {
   2641  1.1    itohy 		/* XXX? */
   2642  1.1    itohy 		printf("%s: njsc32_intr: BM\n", sc->sc_dev.dv_xname);
   2643  1.1    itohy 	}
   2644  1.1    itohy 
   2645  1.1    itohy out:
   2646  1.1    itohy 	/* go next command if controller is idle */
   2647  1.1    itohy 	if (sc->sc_stat == NJSC32_STAT_IDLE)
   2648  1.1    itohy 		njsc32_start(sc);
   2649  1.1    itohy 
   2650  1.1    itohy #if 0
   2651  1.1    itohy 	/* enable interrupts */
   2652  1.1    itohy 	njsc32_write_2(sc, NJSC32_REG_IRQ, 0);
   2653  1.1    itohy #endif
   2654  1.1    itohy 
   2655  1.1    itohy 	return 1;	/* processed */
   2656  1.1    itohy }
   2657