Home | History | Annotate | Line # | Download | only in ic
ninjascsi32.c revision 1.10
      1  1.10  christos /*	$NetBSD: ninjascsi32.c,v 1.10 2007/03/04 06:01:59 christos Exp $	*/
      2   1.1     itohy 
      3   1.1     itohy /*-
      4   1.6     itohy  * Copyright (c) 2004, 2006 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.10  christos __KERNEL_RCSID(0, "$NetBSD: ninjascsi32.c,v 1.10 2007/03/04 06:01:59 christos 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.3  christos static void	njsc32_scsipi_minphys(struct buf *);
    102  1.10  christos static int	njsc32_scsipi_ioctl(struct scsipi_channel *, u_long, void *,
    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.5     perry 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.5     perry 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.5     perry 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.5     perry 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.5     perry 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.5     perry 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.5     perry 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.5     perry 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.5     perry 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.5     perry 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.5     perry 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.5     perry 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.10  christos 	    (void **)&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.6     itohy 	bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap_cmdpg);
    530   1.1     itohy fail3:	bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap_cmdpg);
    531  1.10  christos fail2:	bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_cmdpg,
    532   1.1     itohy 	    sizeof(struct njsc32_dma_page));
    533   1.1     itohy fail1:	bus_dmamem_free(sc->sc_dmat, &sc->sc_cmdpg_seg, sc->sc_cmdpg_nsegs);
    534   1.1     itohy 
    535   1.1     itohy 	return 0;
    536   1.1     itohy }
    537   1.1     itohy 
    538   1.1     itohy static void
    539   1.2   thorpej njsc32_target_async(struct njsc32_softc *sc, struct njsc32_target *target)
    540   1.1     itohy {
    541   1.1     itohy 
    542   1.1     itohy 	target->t_sync =
    543   1.1     itohy 	    NJSC32_SYNC_VAL(sc->sc_sync_max, NJSC32_SYNCOFFSET_ASYNC);
    544   1.1     itohy 	target->t_ackwidth = NJSC32_ACK_WIDTH_1CLK;
    545   1.1     itohy 	target->t_sample = 0;		/* disable */
    546   1.1     itohy 	target->t_syncoffset = NJSC32_SYNCOFFSET_ASYNC;
    547   1.1     itohy 	target->t_syncperiod = NJSC32_SYNCPERIOD_ASYNC;
    548   1.1     itohy }
    549   1.1     itohy 
    550   1.1     itohy static void
    551   1.2   thorpej njsc32_init_targets(struct njsc32_softc *sc)
    552   1.1     itohy {
    553   1.1     itohy 	int id, lun;
    554   1.1     itohy 	struct njsc32_lu *lu;
    555   1.1     itohy 
    556   1.1     itohy 	for (id = 0; id <= NJSC32_MAX_TARGET_ID; id++) {
    557   1.1     itohy 		/* cancel negotiation status */
    558   1.1     itohy 		sc->sc_targets[id].t_state = NJSC32_TARST_INIT;
    559   1.1     itohy 
    560   1.1     itohy 		/* default to async mode */
    561   1.1     itohy 		njsc32_target_async(sc, &sc->sc_targets[id]);
    562   1.1     itohy 
    563   1.1     itohy #ifdef NJSC32_DUALEDGE
    564   1.1     itohy 		sc->sc_targets[id].t_xferctl = 0;
    565   1.1     itohy #endif
    566   1.1     itohy 
    567   1.1     itohy 		sc->sc_targets[id].t_targetid =
    568   1.1     itohy 		    (1 << id) | (1 << NJSC32_INITIATOR_ID);
    569   1.1     itohy 
    570   1.1     itohy 		/* init logical units */
    571   1.1     itohy 		for (lun = 0; lun < NJSC32_NLU; lun++) {
    572   1.1     itohy 			lu = &sc->sc_targets[id].t_lus[lun];
    573   1.1     itohy 			lu->lu_cmd = NULL;
    574   1.1     itohy 			TAILQ_INIT(&lu->lu_q);
    575   1.1     itohy 		}
    576   1.1     itohy 	}
    577   1.1     itohy }
    578   1.1     itohy 
    579   1.1     itohy void
    580   1.2   thorpej njsc32_attach(struct njsc32_softc *sc)
    581   1.1     itohy {
    582   1.1     itohy 	const char *str;
    583   1.1     itohy #if 1	/* test */
    584   1.1     itohy 	int reg;
    585   1.1     itohy 	njsc32_model_t detected_model;
    586   1.1     itohy #endif
    587   1.1     itohy 
    588   1.1     itohy 	/* init */
    589   1.1     itohy 	TAILQ_INIT(&sc->sc_freecmd);
    590   1.1     itohy 	TAILQ_INIT(&sc->sc_reqcmd);
    591   1.1     itohy 
    592   1.1     itohy #if 1	/* test */
    593   1.1     itohy 	/*
    594   1.1     itohy 	 * try to distinguish 32Bi and 32UDE
    595   1.1     itohy 	 */
    596   1.1     itohy 	/* try to set DualEdge bit (exists on 32UDE only) and read it back */
    597   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER, NJSC32_XFR_DUALEDGE_ENABLE);
    598   1.1     itohy 	if ((reg = njsc32_read_2(sc, NJSC32_REG_TRANSFER)) == 0xffff) {
    599   1.1     itohy 		/* device was removed? */
    600   1.1     itohy 		aprint_error("%s: attach failed\n", sc->sc_dev.dv_xname);
    601   1.1     itohy 		return;
    602   1.1     itohy 	} else if (reg & NJSC32_XFR_DUALEDGE_ENABLE) {
    603   1.1     itohy 		detected_model = NJSC32_MODEL_32UDE | NJSC32_FLAG_DUALEDGE;
    604   1.1     itohy 	} else {
    605   1.1     itohy 		detected_model = NJSC32_MODEL_32BI;
    606   1.1     itohy 	}
    607   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER, 0);	/* restore */
    608   1.1     itohy 
    609   1.1     itohy #if 1/*def DIAGNOSTIC*/
    610   1.1     itohy 	/* compare what is configured with what is detected */
    611   1.1     itohy 	if ((sc->sc_model & NJSC32_MODEL_MASK) !=
    612   1.1     itohy 	    (detected_model & NJSC32_MODEL_MASK)) {
    613   1.1     itohy 		/*
    614   1.1     itohy 		 * Please report this error if it happens.
    615   1.1     itohy 		 */
    616   1.1     itohy 		aprint_error("%s: model mismatch: %#x vs %#x\n",
    617   1.1     itohy 		    sc->sc_dev.dv_xname, sc->sc_model, detected_model);
    618   1.1     itohy 		return;
    619   1.1     itohy 	}
    620   1.1     itohy #endif
    621   1.1     itohy #endif
    622   1.1     itohy 
    623   1.1     itohy 	/* check model */
    624   1.1     itohy 	switch (sc->sc_model & NJSC32_MODEL_MASK) {
    625   1.1     itohy 	case NJSC32_MODEL_32BI:
    626   1.1     itohy 		str = "Bi";
    627   1.1     itohy 		/* 32Bi doesn't support DualEdge transfer */
    628   1.1     itohy 		KASSERT((sc->sc_model & NJSC32_FLAG_DUALEDGE) == 0);
    629   1.1     itohy 		break;
    630   1.1     itohy 	case NJSC32_MODEL_32UDE:
    631   1.1     itohy 		str = "UDE";
    632   1.1     itohy 		break;
    633   1.1     itohy 	default:
    634   1.1     itohy 		aprint_error("%s: unknown model!\n", sc->sc_dev.dv_xname);
    635   1.1     itohy 		return;
    636   1.1     itohy 	}
    637   1.1     itohy 	aprint_normal("%s: NJSC-32%s", sc->sc_dev.dv_xname, str);
    638   1.1     itohy 
    639   1.1     itohy 	switch (sc->sc_clk) {
    640   1.1     itohy 	default:
    641   1.1     itohy #ifdef DIAGNOSTIC
    642   1.1     itohy 		panic("njsc32_attach: unknown clk %d", sc->sc_clk);
    643   1.1     itohy #endif
    644   1.1     itohy 	case NJSC32_CLOCK_DIV_4:
    645   1.1     itohy 		sc->sc_synct = njsc32_synct_40M;
    646   1.1     itohy 		str = "40MHz";
    647   1.1     itohy 		break;
    648   1.1     itohy #ifdef NJSC32_SUPPORT_OTHER_CLOCKS
    649   1.1     itohy 	case NJSC32_CLOCK_DIV_2:
    650   1.1     itohy 		sc->sc_synct = njsc32_synct_20M;
    651   1.1     itohy 		str = "20MHz";
    652   1.1     itohy 		break;
    653   1.1     itohy 	case NJSC32_CLOCK_PCICLK:
    654   1.1     itohy 		sc->sc_synct = njsc32_synct_pci;
    655   1.1     itohy 		str = "PCI";
    656   1.1     itohy 		break;
    657   1.1     itohy #endif
    658   1.1     itohy 	}
    659   1.1     itohy 	aprint_normal(", G/A rev %#x, clk %s%s\n",
    660   1.1     itohy 	    NJSC32_INDEX_GAREV(njsc32_read_2(sc, NJSC32_REG_INDEX)), str,
    661   1.1     itohy 	    (sc->sc_model & NJSC32_FLAG_DUALEDGE) ?
    662   1.1     itohy #ifdef NJSC32_DUALEDGE
    663   1.1     itohy 		", DualEdge"
    664   1.1     itohy #else
    665   1.1     itohy 		", DualEdge (no driver support)"
    666   1.1     itohy #endif
    667   1.1     itohy 	    : "");
    668   1.1     itohy 
    669   1.1     itohy 	/* allocate DMA resource */
    670   1.1     itohy 	if ((sc->sc_ncmd = njsc32_init_cmds(sc)) == 0) {
    671   1.1     itohy 		printf("%s: no usable DMA map\n", sc->sc_dev.dv_xname);
    672   1.1     itohy 		return;
    673   1.1     itohy 	}
    674   1.1     itohy 	sc->sc_flags |= NJSC32_CMDPG_MAPPED;
    675   1.1     itohy 
    676   1.1     itohy 	sc->sc_curcmd = NULL;
    677   1.1     itohy 	sc->sc_nusedcmds = 0;
    678   1.1     itohy 	sc->sc_stat = NJSC32_STAT_IDLE;
    679   1.1     itohy 
    680   1.1     itohy 	sc->sc_sync_max = 1;	/* XXX look up EEPROM configuration? */
    681   1.1     itohy 
    682   1.1     itohy 	/* initialize target structure */
    683   1.1     itohy 	njsc32_init_targets(sc);
    684   1.1     itohy 
    685   1.1     itohy 	/* initialize hardware */
    686   1.1     itohy 	njsc32_init(sc, cold);
    687   1.1     itohy 
    688   1.1     itohy 	/* setup adapter */
    689   1.1     itohy 	sc->sc_adapter.adapt_dev = &sc->sc_dev;
    690   1.1     itohy 	sc->sc_adapter.adapt_nchannels = 1;
    691   1.1     itohy 	sc->sc_adapter.adapt_request = njsc32_scsipi_request;
    692   1.1     itohy 	sc->sc_adapter.adapt_minphys = njsc32_scsipi_minphys;
    693   1.1     itohy 	sc->sc_adapter.adapt_ioctl = njsc32_scsipi_ioctl;
    694   1.1     itohy 
    695   1.1     itohy 	sc->sc_adapter.adapt_max_periph = sc->sc_adapter.adapt_openings =
    696   1.1     itohy 	    sc->sc_ncmd;
    697   1.1     itohy 
    698   1.1     itohy 	/* setup channel */
    699   1.1     itohy 	sc->sc_channel.chan_adapter = &sc->sc_adapter;
    700   1.1     itohy 	sc->sc_channel.chan_bustype = &scsi_bustype;
    701   1.1     itohy 	sc->sc_channel.chan_channel = 0;
    702   1.1     itohy 	sc->sc_channel.chan_ntargets = NJSC32_NTARGET;
    703   1.1     itohy 	sc->sc_channel.chan_nluns = NJSC32_NLU;
    704   1.1     itohy 	sc->sc_channel.chan_id = NJSC32_INITIATOR_ID;
    705   1.1     itohy 
    706   1.1     itohy 	sc->sc_scsi = config_found(&sc->sc_dev, &sc->sc_channel, scsiprint);
    707   1.1     itohy }
    708   1.1     itohy 
    709   1.1     itohy int
    710   1.2   thorpej njsc32_detach(struct njsc32_softc *sc, int flags)
    711   1.1     itohy {
    712   1.1     itohy 	int rv = 0;
    713   1.1     itohy 	int i, s;
    714   1.1     itohy 	struct njsc32_cmd *cmd;
    715   1.1     itohy 
    716   1.1     itohy 	s = splbio();
    717   1.1     itohy 
    718   1.1     itohy 	/* clear running/disconnected commands */
    719   1.1     itohy 	njsc32_clear_cmds(sc, XS_DRIVER_STUFFUP);
    720   1.1     itohy 
    721   1.1     itohy 	sc->sc_stat = NJSC32_STAT_DETACH;
    722   1.1     itohy 
    723   1.1     itohy 	/* clear pending commands */
    724   1.1     itohy 	while ((cmd = TAILQ_FIRST(&sc->sc_reqcmd)) != NULL) {
    725   1.1     itohy 		TAILQ_REMOVE(&sc->sc_reqcmd, cmd, c_q);
    726   1.1     itohy 		njsc32_end_cmd(sc, cmd, XS_RESET);
    727   1.1     itohy 	}
    728   1.1     itohy 
    729   1.1     itohy 	if (sc->sc_scsi != NULL)
    730   1.1     itohy 		rv = config_detach(sc->sc_scsi, flags);
    731   1.1     itohy 
    732   1.1     itohy 	splx(s);
    733   1.1     itohy 
    734   1.1     itohy 	/* free DMA resource */
    735   1.1     itohy 	if (sc->sc_flags & NJSC32_CMDPG_MAPPED) {
    736   1.1     itohy 		for (i = 0; i < sc->sc_ncmd; i++) {
    737   1.1     itohy 			cmd = &sc->sc_cmds[i];
    738   1.1     itohy 			if (cmd->c_flags & NJSC32_CMD_DMA_MAPPED)
    739   1.1     itohy 				bus_dmamap_unload(sc->sc_dmat,
    740   1.1     itohy 				    cmd->c_dmamap_xfer);
    741   1.1     itohy 			bus_dmamap_destroy(sc->sc_dmat, cmd->c_dmamap_xfer);
    742   1.1     itohy 		}
    743   1.1     itohy 
    744   1.1     itohy 		bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap_cmdpg);
    745   1.1     itohy 		bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap_cmdpg);
    746  1.10  christos 		bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_cmdpg,
    747   1.1     itohy 		    sizeof(struct njsc32_dma_page));
    748   1.1     itohy 		bus_dmamem_free(sc->sc_dmat, &sc->sc_cmdpg_seg,
    749   1.1     itohy 		    sc->sc_cmdpg_nsegs);
    750   1.1     itohy 	}
    751   1.1     itohy 
    752   1.1     itohy 	return 0;
    753   1.1     itohy }
    754   1.1     itohy 
    755   1.5     perry static inline void
    756   1.2   thorpej njsc32_cmd_init(struct njsc32_cmd *cmd)
    757   1.1     itohy {
    758   1.1     itohy 
    759   1.1     itohy 	cmd->c_flags = 0;
    760   1.1     itohy 
    761   1.1     itohy 	/* scatter/gather table */
    762   1.1     itohy 	cmd->c_sgtdmaaddr = NJSC32_CMD_DMAADDR_SGT(cmd, 0);
    763   1.1     itohy 	cmd->c_sgoffset = 0;
    764   1.1     itohy 	cmd->c_sgfixcnt = 0;
    765   1.1     itohy 
    766   1.1     itohy 	/* data pointer */
    767   1.1     itohy 	cmd->c_dp_cur = cmd->c_dp_saved = cmd->c_dp_max = 0;
    768   1.1     itohy }
    769   1.1     itohy 
    770   1.5     perry static inline void
    771   1.2   thorpej njsc32_init_msgout(struct njsc32_softc *sc)
    772   1.1     itohy {
    773   1.1     itohy 
    774   1.1     itohy 	sc->sc_msgoutlen = 0;
    775   1.1     itohy 	sc->sc_msgoutidx = 0;
    776   1.1     itohy }
    777   1.1     itohy 
    778   1.1     itohy static void
    779   1.2   thorpej njsc32_add_msgout(struct njsc32_softc *sc, int byte)
    780   1.1     itohy {
    781   1.1     itohy 
    782   1.1     itohy 	if (sc->sc_msgoutlen >= NJSC32_MSGOUT_LEN) {
    783   1.1     itohy 		printf("njsc32_add_msgout: too many\n");
    784   1.1     itohy 		return;
    785   1.1     itohy 	}
    786   1.1     itohy 	sc->sc_msgout[sc->sc_msgoutlen++] = byte;
    787   1.1     itohy }
    788   1.1     itohy 
    789   1.1     itohy static u_int32_t
    790   1.2   thorpej njsc32_get_auto_msgout(struct njsc32_softc *sc)
    791   1.1     itohy {
    792   1.1     itohy 	u_int32_t val;
    793   1.1     itohy 	u_int8_t *p;
    794   1.1     itohy 
    795   1.1     itohy 	val = 0;
    796   1.1     itohy 	p = sc->sc_msgout;
    797   1.1     itohy 	switch (sc->sc_msgoutlen) {
    798   1.1     itohy 		/* 31-24 23-16 15-8 7 ... 1 0 */
    799   1.1     itohy 	case 3:	/* MSG3  MSG2  MSG1 V --- cnt */
    800   1.1     itohy 		val |= *p++ << NJSC32_MSGOUT_MSG1_SHIFT;
    801   1.1     itohy 		/* FALLTHROUGH */
    802   1.1     itohy 
    803   1.1     itohy 	case 2:	/* MSG2  MSG1  ---  V --- cnt */
    804   1.1     itohy 		val |= *p++ << NJSC32_MSGOUT_MSG2_SHIFT;
    805   1.1     itohy 		/* FALLTHROUGH */
    806   1.1     itohy 
    807   1.1     itohy 	case 1:	/* MSG1  ---   ---  V --- cnt */
    808   1.1     itohy 		val |= *p++ << NJSC32_MSGOUT_MSG3_SHIFT;
    809   1.1     itohy 		val |= NJSC32_MSGOUT_VALID | sc->sc_msgoutlen;
    810   1.1     itohy 		break;
    811   1.1     itohy 
    812   1.1     itohy 	default:
    813   1.1     itohy 		break;
    814   1.1     itohy 	}
    815   1.1     itohy 	return val;
    816   1.1     itohy }
    817   1.1     itohy 
    818   1.1     itohy #ifdef NJSC32_DUALEDGE
    819   1.1     itohy /* add Wide Data Transfer Request to the next Message Out */
    820   1.1     itohy static void
    821   1.2   thorpej njsc32_msgout_wdtr(struct njsc32_softc *sc, int width)
    822   1.1     itohy {
    823   1.1     itohy 
    824   1.1     itohy 	njsc32_add_msgout(sc, MSG_EXTENDED);
    825   1.1     itohy 	njsc32_add_msgout(sc, MSG_EXT_WDTR_LEN);
    826   1.1     itohy 	njsc32_add_msgout(sc, MSG_EXT_WDTR);
    827   1.1     itohy 	njsc32_add_msgout(sc, width);
    828   1.1     itohy }
    829   1.1     itohy #endif
    830   1.1     itohy 
    831   1.1     itohy /* add Synchronous Data Transfer Request to the next Message Out */
    832   1.1     itohy static void
    833   1.2   thorpej njsc32_msgout_sdtr(struct njsc32_softc *sc, int period, int offset)
    834   1.1     itohy {
    835   1.1     itohy 
    836   1.1     itohy 	njsc32_add_msgout(sc, MSG_EXTENDED);
    837   1.1     itohy 	njsc32_add_msgout(sc, MSG_EXT_SDTR_LEN);
    838   1.1     itohy 	njsc32_add_msgout(sc, MSG_EXT_SDTR);
    839   1.1     itohy 	njsc32_add_msgout(sc, period);
    840   1.1     itohy 	njsc32_add_msgout(sc, offset);
    841   1.1     itohy }
    842   1.1     itohy 
    843   1.1     itohy static void
    844   1.2   thorpej njsc32_negotiate_xfer(struct njsc32_softc *sc, struct njsc32_target *target)
    845   1.1     itohy {
    846   1.1     itohy 
    847   1.1     itohy 	/* initial negotiation state */
    848   1.1     itohy 	if (target->t_state == NJSC32_TARST_INIT) {
    849   1.1     itohy #ifdef NJSC32_DUALEDGE
    850   1.1     itohy 		if (target->t_flags & NJSC32_TARF_DE)
    851   1.1     itohy 			target->t_state = NJSC32_TARST_DE;
    852   1.1     itohy 		else
    853   1.1     itohy #endif
    854   1.1     itohy 		if (target->t_flags & NJSC32_TARF_SYNC)
    855   1.1     itohy 			target->t_state = NJSC32_TARST_SDTR;
    856   1.1     itohy 		else
    857   1.1     itohy 			target->t_state = NJSC32_TARST_DONE;
    858   1.1     itohy 	}
    859   1.1     itohy 
    860   1.1     itohy 	switch (target->t_state) {
    861   1.1     itohy 	default:
    862   1.1     itohy 	case NJSC32_TARST_INIT:
    863   1.1     itohy #ifdef DIAGNOSTIC
    864   1.1     itohy 		panic("njsc32_negotiate_xfer");
    865   1.1     itohy 		/* NOTREACHED */
    866   1.1     itohy #endif
    867   1.1     itohy 		/* FALLTHROUGH */
    868   1.1     itohy 	case NJSC32_TARST_DONE:
    869   1.1     itohy 		/* no more work */
    870   1.1     itohy 		break;
    871   1.1     itohy 
    872   1.1     itohy #ifdef NJSC32_DUALEDGE
    873   1.1     itohy 	case NJSC32_TARST_DE:
    874   1.1     itohy 		njsc32_msgout_wdtr(sc, 0xde /* XXX? */);
    875   1.1     itohy 		break;
    876   1.1     itohy 
    877   1.1     itohy 	case NJSC32_TARST_WDTR:
    878   1.1     itohy 		njsc32_msgout_wdtr(sc, MSG_EXT_WDTR_BUS_8_BIT);
    879   1.1     itohy 		break;
    880   1.1     itohy #endif
    881   1.1     itohy 
    882   1.1     itohy 	case NJSC32_TARST_SDTR:
    883   1.1     itohy 		njsc32_msgout_sdtr(sc, sc->sc_synct[sc->sc_sync_max].sp_period,
    884   1.1     itohy 		    NJSC32_SYNCOFFSET_MAX);
    885   1.1     itohy 		break;
    886   1.1     itohy 
    887   1.1     itohy 	case NJSC32_TARST_ASYNC:
    888   1.1     itohy 		njsc32_msgout_sdtr(sc, NJSC32_SYNCPERIOD_ASYNC,
    889   1.1     itohy 		    NJSC32_SYNCOFFSET_ASYNC);
    890   1.1     itohy 		break;
    891   1.1     itohy 	}
    892   1.1     itohy }
    893   1.1     itohy 
    894   1.1     itohy /* turn LED on */
    895   1.5     perry static inline void
    896   1.2   thorpej njsc32_led_on(struct njsc32_softc *sc)
    897   1.1     itohy {
    898   1.1     itohy 
    899   1.1     itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_EXT_PORT, NJSC32_EXTPORT_LED_ON);
    900   1.1     itohy }
    901   1.1     itohy 
    902   1.1     itohy /* turn LED off */
    903   1.5     perry static inline void
    904   1.2   thorpej njsc32_led_off(struct njsc32_softc *sc)
    905   1.1     itohy {
    906   1.1     itohy 
    907   1.1     itohy 	njsc32_ireg_write_1(sc, NJSC32_IREG_EXT_PORT, NJSC32_EXTPORT_LED_OFF);
    908   1.1     itohy }
    909   1.1     itohy 
    910   1.1     itohy static void
    911   1.2   thorpej njsc32_arbitration_failed(struct njsc32_softc *sc)
    912   1.1     itohy {
    913   1.1     itohy 	struct njsc32_cmd *cmd;
    914   1.1     itohy 
    915   1.1     itohy 	if ((cmd = sc->sc_curcmd) == NULL || sc->sc_stat != NJSC32_STAT_ARBIT)
    916   1.1     itohy 		return;
    917   1.1     itohy 
    918   1.1     itohy 	if ((cmd->c_xs->xs_control & XS_CTL_POLL) == 0)
    919   1.1     itohy 		callout_stop(&cmd->c_xs->xs_callout);
    920   1.1     itohy 
    921   1.1     itohy 	sc->sc_stat = NJSC32_STAT_IDLE;
    922   1.1     itohy 	sc->sc_curcmd = NULL;
    923   1.1     itohy 
    924   1.1     itohy 	/* the command is no longer active */
    925   1.1     itohy 	if (--sc->sc_nusedcmds == 0)
    926   1.1     itohy 		njsc32_led_off(sc);
    927   1.1     itohy }
    928   1.1     itohy 
    929   1.5     perry static inline void
    930   1.2   thorpej njsc32_cmd_load(struct njsc32_softc *sc, struct njsc32_cmd *cmd)
    931   1.1     itohy {
    932   1.1     itohy 	struct njsc32_target *target;
    933   1.1     itohy 	struct scsipi_xfer *xs;
    934   1.1     itohy 	int i, control, lun;
    935   1.1     itohy 	u_int32_t msgoutreg;
    936   1.1     itohy #ifdef NJSC32_AUTOPARAM
    937   1.1     itohy 	struct njsc32_autoparam *ap;
    938   1.1     itohy #endif
    939   1.1     itohy 
    940   1.1     itohy 	xs = cmd->c_xs;
    941   1.1     itohy #ifdef NJSC32_AUTOPARAM
    942   1.1     itohy 	ap = &sc->sc_cmdpg->dp_ap;
    943   1.1     itohy #else
    944   1.1     itohy 	/* reset CDB pointer */
    945   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, NJSC32_CMD_CLEAR_CDB_FIFO_PTR);
    946   1.1     itohy #endif
    947   1.1     itohy 
    948   1.1     itohy 	/* CDB */
    949   1.1     itohy 	TPRINTC(cmd, ("njsc32_cmd_load: CDB"));
    950   1.1     itohy 	for (i = 0; i < xs->cmdlen; i++) {
    951   1.1     itohy #ifdef NJSC32_AUTOPARAM
    952   1.1     itohy 		ap->ap_cdb[i].cdb_data = ((u_int8_t *)xs->cmd)[i];
    953   1.1     itohy #else
    954   1.1     itohy 		njsc32_write_1(sc, NJSC32_REG_COMMAND_DATA,
    955   1.1     itohy 		    ((u_int8_t *)xs->cmd)[i]);
    956   1.1     itohy #endif
    957   1.1     itohy 		TPRINTF((" %02x", ((u_int8_t *)cmd->c_xs->cmd)[i]));
    958   1.1     itohy 	}
    959   1.1     itohy #ifdef NJSC32_AUTOPARAM	/* XXX needed? */
    960   1.1     itohy 	for ( ; i < NJSC32_AUTOPARAM_CDBLEN; i++)
    961   1.1     itohy 		ap->ap_cdb[i].cdb_data = 0;
    962   1.1     itohy #endif
    963   1.1     itohy 
    964   1.1     itohy 	control = xs->xs_control;
    965   1.1     itohy 
    966   1.1     itohy 	/*
    967   1.1     itohy 	 * Message Out
    968   1.1     itohy 	 */
    969   1.1     itohy 	njsc32_init_msgout(sc);
    970   1.1     itohy 
    971   1.1     itohy 	/* Identify */
    972   1.1     itohy 	lun = xs->xs_periph->periph_lun;
    973   1.1     itohy 	njsc32_add_msgout(sc, (control & XS_CTL_REQSENSE) ?
    974   1.1     itohy 	    MSG_IDENTIFY(lun, 0) : MSG_IDENTIFY(lun, 1));
    975   1.1     itohy 
    976   1.1     itohy 	/* tagged queueing */
    977   1.1     itohy 	if (control & XS_CTL_TAGMASK) {
    978   1.1     itohy 		njsc32_add_msgout(sc, xs->xs_tag_type);
    979   1.1     itohy 		njsc32_add_msgout(sc, xs->xs_tag_id);
    980   1.1     itohy 		TPRINTF((" (tag %#x %#x)\n", xs->xs_tag_type, xs->xs_tag_id));
    981   1.1     itohy 	}
    982   1.1     itohy 	TPRINTF(("\n"));
    983   1.1     itohy 
    984   1.1     itohy 	target = cmd->c_target;
    985   1.1     itohy 
    986   1.1     itohy 	/* transfer negotiation */
    987   1.1     itohy 	if (control & XS_CTL_REQSENSE)
    988   1.1     itohy 		target->t_state = NJSC32_TARST_INIT;
    989   1.1     itohy 	njsc32_negotiate_xfer(sc, target);
    990   1.1     itohy 
    991   1.1     itohy 	msgoutreg = njsc32_get_auto_msgout(sc);
    992   1.1     itohy 
    993   1.1     itohy #ifdef NJSC32_AUTOPARAM
    994   1.1     itohy 	ap->ap_msgout = htole32(msgoutreg);
    995   1.1     itohy 
    996   1.1     itohy 	ap->ap_sync	= target->t_sync;
    997   1.1     itohy 	ap->ap_ackwidth	= target->t_ackwidth;
    998   1.1     itohy 	ap->ap_targetid	= target->t_targetid;
    999   1.1     itohy 	ap->ap_sample	= target->t_sample;
   1000   1.1     itohy 
   1001   1.1     itohy 	ap->ap_cmdctl = htole16(NJSC32_CMD_CLEAR_CDB_FIFO_PTR |
   1002   1.1     itohy 	    NJSC32_CMD_AUTO_COMMAND_PHASE |
   1003   1.1     itohy 	    NJSC32_CMD_AUTO_SCSI_START | NJSC32_CMD_AUTO_ATN |
   1004   1.1     itohy 	    NJSC32_CMD_AUTO_MSGIN_00_04 | NJSC32_CMD_AUTO_MSGIN_02);
   1005   1.1     itohy #ifdef NJSC32_DUALEDGE
   1006   1.1     itohy 	ap->ap_xferctl = htole16(cmd->c_xferctl | target->t_xferctl);
   1007   1.1     itohy #else
   1008   1.1     itohy 	ap->ap_xferctl = htole16(cmd->c_xferctl);
   1009   1.1     itohy #endif
   1010   1.1     itohy 	ap->ap_sgtdmaaddr = htole32(cmd->c_sgtdmaaddr);
   1011   1.1     itohy 
   1012   1.1     itohy 	/* sync njsc32_autoparam */
   1013   1.1     itohy 	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_cmdpg,
   1014   1.1     itohy 	    offsetof(struct njsc32_dma_page, dp_ap),	/* offset */
   1015   1.1     itohy 	    sizeof(struct njsc32_autoparam),
   1016   1.1     itohy 	    BUS_DMASYNC_PREWRITE);
   1017   1.1     itohy 
   1018   1.1     itohy 	/* autoparam DMA address */
   1019   1.1     itohy 	njsc32_write_4(sc, NJSC32_REG_SGT_ADR, sc->sc_ap_dma);
   1020   1.1     itohy 
   1021   1.1     itohy 	/* start command (autoparam) */
   1022   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL,
   1023   1.1     itohy 	    NJSC32_CMD_CLEAR_CDB_FIFO_PTR | NJSC32_CMD_AUTO_PARAMETER);
   1024   1.1     itohy 
   1025   1.1     itohy #else	/* not NJSC32_AUTOPARAM */
   1026   1.1     itohy 
   1027   1.1     itohy 	njsc32_write_4(sc, NJSC32_REG_SCSI_MSG_OUT, msgoutreg);
   1028   1.1     itohy 
   1029   1.1     itohy 	/* load parameters */
   1030   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_TARGET_ID, target->t_targetid);
   1031   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_SYNC, target->t_sync);
   1032   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_ACK_WIDTH, target->t_ackwidth);
   1033   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_SREQ_SAMPLING, target->t_sample);
   1034   1.1     itohy 	njsc32_write_4(sc, NJSC32_REG_SGT_ADR, cmd->c_sgtdmaaddr);
   1035   1.1     itohy #ifdef NJSC32_DUALEDGE
   1036   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER,
   1037   1.1     itohy 	    cmd->c_xferctl | target->t_xferctl);
   1038   1.1     itohy #else
   1039   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER, cmd->c_xferctl);
   1040   1.1     itohy #endif
   1041   1.1     itohy 	/* start AutoSCSI */
   1042   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL,
   1043   1.1     itohy 	    NJSC32_CMD_CLEAR_CDB_FIFO_PTR | NJSC32_CMD_AUTO_COMMAND_PHASE |
   1044   1.1     itohy 	    NJSC32_CMD_AUTO_SCSI_START | NJSC32_CMD_AUTO_ATN |
   1045   1.1     itohy 	    NJSC32_CMD_AUTO_MSGIN_00_04 | NJSC32_CMD_AUTO_MSGIN_02);
   1046   1.1     itohy #endif	/* not NJSC32_AUTOPARAM */
   1047   1.1     itohy }
   1048   1.1     itohy 
   1049   1.1     itohy /* Note: must be called at splbio() */
   1050   1.1     itohy static void
   1051   1.2   thorpej njsc32_start(struct njsc32_softc *sc)
   1052   1.1     itohy {
   1053   1.1     itohy 	struct njsc32_cmd *cmd;
   1054   1.1     itohy 
   1055   1.1     itohy 	/* get a command to issue */
   1056   1.1     itohy 	TAILQ_FOREACH(cmd, &sc->sc_reqcmd, c_q) {
   1057   1.1     itohy 		if (cmd->c_lu->lu_cmd == NULL &&
   1058   1.1     itohy 		    ((cmd->c_flags & NJSC32_CMD_TAGGED) ||
   1059   1.1     itohy 		     TAILQ_EMPTY(&cmd->c_lu->lu_q)))
   1060   1.1     itohy 			break;	/* OK, the logical unit is free */
   1061   1.1     itohy 	}
   1062   1.1     itohy 	if (!cmd)
   1063   1.1     itohy 		goto out;	/* no work to do */
   1064   1.1     itohy 
   1065   1.1     itohy 	/* request will always fail if not in bus free phase */
   1066   1.1     itohy 	if (njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_MONITOR) !=
   1067   1.1     itohy 	    NJSC32_BUSMON_BUSFREE)
   1068   1.1     itohy 		goto busy;
   1069   1.1     itohy 
   1070   1.1     itohy 	/* clear parity error and enable parity detection */
   1071   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_PARITY_CONTROL,
   1072   1.1     itohy 	    NJSC32_PARITYCTL_CHECK_ENABLE | NJSC32_PARITYCTL_CLEAR_ERROR);
   1073   1.1     itohy 
   1074   1.1     itohy 	njsc32_cmd_load(sc, cmd);
   1075   1.1     itohy 
   1076   1.1     itohy 	if (sc->sc_nusedcmds++ == 0)
   1077   1.1     itohy 		njsc32_led_on(sc);
   1078   1.1     itohy 
   1079   1.1     itohy 	sc->sc_curcmd = cmd;
   1080   1.1     itohy 	sc->sc_stat = NJSC32_STAT_ARBIT;
   1081   1.1     itohy 
   1082   1.1     itohy 	if ((cmd->c_xs->xs_control & XS_CTL_POLL) == 0) {
   1083   1.1     itohy 		callout_reset(&cmd->c_xs->xs_callout,
   1084   1.1     itohy 		    mstohz(cmd->c_xs->timeout),
   1085   1.1     itohy 		    njsc32_cmdtimeout, cmd);
   1086   1.1     itohy 	}
   1087   1.1     itohy 
   1088   1.1     itohy 	return;
   1089   1.1     itohy 
   1090   1.1     itohy busy:	/* XXX retry counter */
   1091   1.1     itohy 	TPRINTF(("%s: njsc32_start: busy\n", sc->sc_dev.dv_xname));
   1092   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_TIMER, NJSC32_ARBITRATION_RETRY_TIME);
   1093   1.1     itohy out:	njsc32_write_2(sc, NJSC32_REG_TRANSFER, 0);
   1094   1.1     itohy }
   1095   1.1     itohy 
   1096   1.1     itohy static void
   1097   1.2   thorpej njsc32_run_xfer(struct njsc32_softc *sc, struct scsipi_xfer *xs)
   1098   1.1     itohy {
   1099   1.1     itohy 	struct scsipi_periph *periph;
   1100   1.1     itohy 	int control;
   1101   1.1     itohy 	int lun;
   1102   1.1     itohy 	struct njsc32_cmd *cmd;
   1103   1.1     itohy 	int s, i, error;
   1104   1.1     itohy 
   1105   1.1     itohy 	periph = xs->xs_periph;
   1106   1.1     itohy 	KASSERT((unsigned)periph->periph_target <= NJSC32_MAX_TARGET_ID);
   1107   1.1     itohy 
   1108   1.1     itohy 	control = xs->xs_control;
   1109   1.1     itohy 	lun = periph->periph_lun;
   1110   1.1     itohy 
   1111   1.1     itohy 	/*
   1112   1.1     itohy 	 * get a free cmd
   1113   1.1     itohy 	 * (scsipi layer knows the number of cmds, so this shall never fail)
   1114   1.1     itohy 	 */
   1115   1.1     itohy 	s = splbio();
   1116   1.1     itohy 	cmd = TAILQ_FIRST(&sc->sc_freecmd);
   1117   1.1     itohy 	KASSERT(cmd);
   1118   1.1     itohy 	TAILQ_REMOVE(&sc->sc_freecmd, cmd, c_q);
   1119   1.1     itohy 	splx(s);
   1120   1.1     itohy 
   1121   1.1     itohy 	/*
   1122   1.1     itohy 	 * build a request
   1123   1.1     itohy 	 */
   1124   1.1     itohy 	njsc32_cmd_init(cmd);
   1125   1.1     itohy 	cmd->c_xs = xs;
   1126   1.1     itohy 	cmd->c_target = &sc->sc_targets[periph->periph_target];
   1127   1.1     itohy 	cmd->c_lu = &cmd->c_target->t_lus[lun];
   1128   1.1     itohy 
   1129   1.1     itohy 	/* tagged queueing */
   1130   1.1     itohy 	if (control & XS_CTL_TAGMASK) {
   1131   1.1     itohy 		cmd->c_flags |= NJSC32_CMD_TAGGED;
   1132   1.1     itohy 		if (control & XS_CTL_HEAD_TAG)
   1133   1.1     itohy 			cmd->c_flags |= NJSC32_CMD_TAGGED_HEAD;
   1134   1.1     itohy 	}
   1135   1.1     itohy 
   1136   1.1     itohy 	/* map DMA buffer */
   1137   1.1     itohy 	cmd->c_datacnt = xs->datalen;
   1138   1.1     itohy 	if (xs->datalen) {
   1139   1.1     itohy 		/* Is XS_CTL_DATA_UIO ever used anywhere? */
   1140   1.1     itohy 		KASSERT((control & XS_CTL_DATA_UIO) == 0);
   1141   1.1     itohy 
   1142   1.1     itohy 		error = bus_dmamap_load(sc->sc_dmat, cmd->c_dmamap_xfer,
   1143   1.1     itohy 		    xs->data, xs->datalen, NULL,
   1144   1.1     itohy 		    ((control & XS_CTL_NOSLEEP) ?
   1145   1.1     itohy 			BUS_DMA_NOWAIT : BUS_DMA_WAITOK) |
   1146   1.1     itohy 		    BUS_DMA_STREAMING |
   1147   1.1     itohy 		    ((control & XS_CTL_DATA_IN) ?
   1148   1.1     itohy 			BUS_DMA_READ : BUS_DMA_WRITE));
   1149   1.1     itohy 
   1150   1.1     itohy 		switch (error) {
   1151   1.1     itohy 		case 0:
   1152   1.1     itohy 			break;
   1153   1.1     itohy 		case ENOMEM:
   1154   1.1     itohy 		case EAGAIN:
   1155   1.1     itohy 			xs->error = XS_RESOURCE_SHORTAGE;
   1156   1.1     itohy 			goto map_failed;
   1157   1.1     itohy 		default:
   1158   1.1     itohy 			xs->error = XS_DRIVER_STUFFUP;
   1159   1.1     itohy 		map_failed:
   1160   1.1     itohy 			printf("%s: njsc32_run_xfer: map failed, error %d\n",
   1161   1.1     itohy 			    sc->sc_dev.dv_xname, error);
   1162   1.1     itohy 			/* put it back to free command list */
   1163   1.1     itohy 			s = splbio();
   1164   1.1     itohy 			TAILQ_INSERT_HEAD(&sc->sc_freecmd, cmd, c_q);
   1165   1.1     itohy 			splx(s);
   1166   1.1     itohy 			/* abort this transfer */
   1167   1.1     itohy 			scsipi_done(xs);
   1168   1.1     itohy 			return;
   1169   1.1     itohy 		}
   1170   1.1     itohy 
   1171   1.1     itohy 		bus_dmamap_sync(sc->sc_dmat, cmd->c_dmamap_xfer,
   1172   1.1     itohy 		    0, cmd->c_dmamap_xfer->dm_mapsize,
   1173   1.1     itohy 		    (control & XS_CTL_DATA_IN) ?
   1174   1.1     itohy 			BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
   1175   1.1     itohy 
   1176   1.1     itohy 		for (i = 0; i < cmd->c_dmamap_xfer->dm_nsegs; i++) {
   1177   1.1     itohy 			cmd->c_sgt[i].sg_addr =
   1178   1.1     itohy 			    htole32(cmd->c_dmamap_xfer->dm_segs[i].ds_addr);
   1179   1.1     itohy 			cmd->c_sgt[i].sg_len =
   1180   1.1     itohy 			    htole32(cmd->c_dmamap_xfer->dm_segs[i].ds_len);
   1181   1.1     itohy 		}
   1182   1.1     itohy 		/* end mark */
   1183   1.1     itohy 		cmd->c_sgt[i - 1].sg_len |= htole32(NJSC32_SGT_ENDMARK);
   1184   1.1     itohy 
   1185   1.1     itohy 		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_cmdpg,
   1186   1.1     itohy 		    (char *)cmd->c_sgt - (char *)sc->sc_cmdpg, /* offset */
   1187   1.1     itohy 		    NJSC32_SIZE_SGT,
   1188   1.1     itohy 		    BUS_DMASYNC_PREWRITE);
   1189   1.1     itohy 
   1190   1.1     itohy 		cmd->c_flags |= NJSC32_CMD_DMA_MAPPED;
   1191   1.1     itohy 
   1192   1.1     itohy 		/* enable transfer */
   1193   1.1     itohy 		cmd->c_xferctl =
   1194   1.1     itohy 		    NJSC32_XFR_TRANSFER_GO | NJSC32_XFR_BM_START |
   1195   1.1     itohy 		    NJSC32_XFR_ALL_COUNT_CLR;
   1196   1.1     itohy 
   1197   1.1     itohy 		/* XXX How can we specify the DMA direction? */
   1198   1.1     itohy 
   1199   1.1     itohy #if 0	/* faster write mode? (doesn't work) */
   1200   1.1     itohy 		if ((control & XS_CTL_DATA_IN) == 0)
   1201   1.1     itohy 			cmd->c_xferctl |= NJSC32_XFR_ADVANCED_BM_WRITE;
   1202   1.1     itohy #endif
   1203   1.1     itohy 	} else {
   1204   1.1     itohy 		/* no data transfer */
   1205   1.1     itohy 		cmd->c_xferctl = 0;
   1206   1.1     itohy 	}
   1207   1.1     itohy 
   1208   1.1     itohy 	/* queue request */
   1209   1.1     itohy 	s = splbio();
   1210   1.1     itohy 	TAILQ_INSERT_TAIL(&sc->sc_reqcmd, cmd, c_q);
   1211   1.1     itohy 
   1212   1.1     itohy 	/* start the controller if idle */
   1213   1.1     itohy 	if (sc->sc_stat == NJSC32_STAT_IDLE)
   1214   1.1     itohy 		njsc32_start(sc);
   1215   1.1     itohy 
   1216   1.1     itohy 	splx(s);
   1217   1.1     itohy 
   1218   1.1     itohy 	if (control & XS_CTL_POLL) {
   1219   1.1     itohy 		/* wait for completion */
   1220   1.1     itohy 		/* XXX should handle timeout? */
   1221   1.1     itohy 		while ((xs->xs_status & XS_STS_DONE) == 0) {
   1222   1.1     itohy 			delay(1000);
   1223   1.1     itohy 			njsc32_intr(sc);
   1224   1.1     itohy 		}
   1225   1.1     itohy 	}
   1226   1.1     itohy }
   1227   1.1     itohy 
   1228   1.1     itohy static void
   1229   1.2   thorpej njsc32_end_cmd(struct njsc32_softc *sc, struct njsc32_cmd *cmd,
   1230   1.2   thorpej     scsipi_xfer_result_t result)
   1231   1.1     itohy {
   1232   1.1     itohy 	struct scsipi_xfer *xs;
   1233   1.1     itohy 	int s;
   1234   1.1     itohy #ifdef DIAGNOSTIC
   1235   1.1     itohy 	struct njsc32_cmd *c;
   1236   1.1     itohy #endif
   1237   1.1     itohy 
   1238   1.1     itohy 	KASSERT(cmd);
   1239   1.1     itohy 
   1240   1.1     itohy #ifdef DIAGNOSTIC
   1241   1.1     itohy 	s = splbio();
   1242   1.1     itohy 	TAILQ_FOREACH(c, &sc->sc_freecmd, c_q) {
   1243   1.1     itohy 		if (cmd == c)
   1244   1.1     itohy 			panic("njsc32_end_cmd: already in free list");
   1245   1.1     itohy 	}
   1246   1.1     itohy 	splx(s);
   1247   1.1     itohy #endif
   1248   1.1     itohy 	xs = cmd->c_xs;
   1249   1.1     itohy 
   1250   1.1     itohy 	if (cmd->c_flags & NJSC32_CMD_DMA_MAPPED) {
   1251   1.1     itohy 		if (cmd->c_datacnt) {
   1252   1.1     itohy 			bus_dmamap_sync(sc->sc_dmat, cmd->c_dmamap_xfer,
   1253   1.1     itohy 			    0, cmd->c_dmamap_xfer->dm_mapsize,
   1254   1.1     itohy 			    (xs->xs_control & XS_CTL_DATA_IN) ?
   1255   1.1     itohy 				BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
   1256   1.1     itohy 
   1257   1.1     itohy 			bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_cmdpg,
   1258   1.1     itohy 			    (char *)cmd->c_sgt - (char *)sc->sc_cmdpg,
   1259   1.1     itohy 			    NJSC32_SIZE_SGT, BUS_DMASYNC_POSTWRITE);
   1260   1.1     itohy 		}
   1261   1.1     itohy 
   1262   1.1     itohy 		bus_dmamap_unload(sc->sc_dmat, cmd->c_dmamap_xfer);
   1263   1.1     itohy 		cmd->c_flags &= ~NJSC32_CMD_DMA_MAPPED;
   1264   1.1     itohy 	}
   1265   1.1     itohy 
   1266   1.1     itohy 	s = splbio();
   1267   1.1     itohy 	if ((xs->xs_control & XS_CTL_POLL) == 0)
   1268   1.1     itohy 		callout_stop(&xs->xs_callout);
   1269   1.1     itohy 
   1270   1.1     itohy 	TAILQ_INSERT_HEAD(&sc->sc_freecmd, cmd, c_q);
   1271   1.1     itohy 	splx(s);
   1272   1.1     itohy 
   1273   1.1     itohy 	xs->error = result;
   1274   1.1     itohy 	scsipi_done(xs);
   1275   1.1     itohy 
   1276   1.1     itohy 	if (--sc->sc_nusedcmds == 0)
   1277   1.1     itohy 		njsc32_led_off(sc);
   1278   1.1     itohy }
   1279   1.1     itohy 
   1280   1.1     itohy /*
   1281   1.1     itohy  * request from scsipi layer
   1282   1.1     itohy  */
   1283   1.2   thorpej static void
   1284   1.2   thorpej njsc32_scsipi_request(struct scsipi_channel *chan, scsipi_adapter_req_t req,
   1285   1.2   thorpej     void *arg)
   1286   1.1     itohy {
   1287   1.1     itohy 	struct njsc32_softc *sc;
   1288   1.1     itohy 	struct scsipi_xfer_mode *xm;
   1289   1.1     itohy 	struct njsc32_target *target;
   1290   1.1     itohy 
   1291   1.1     itohy 	sc = (void *)chan->chan_adapter->adapt_dev;
   1292   1.1     itohy 
   1293   1.1     itohy 	switch (req) {
   1294   1.1     itohy 	case ADAPTER_REQ_RUN_XFER:
   1295   1.1     itohy 		njsc32_run_xfer(sc, arg);
   1296   1.1     itohy 		break;
   1297   1.1     itohy 
   1298   1.1     itohy 	case ADAPTER_REQ_GROW_RESOURCES:
   1299   1.1     itohy 		/* not supported */
   1300   1.1     itohy 		break;
   1301   1.1     itohy 
   1302   1.1     itohy 	case ADAPTER_REQ_SET_XFER_MODE:
   1303   1.1     itohy 		xm = arg;
   1304   1.1     itohy 		target = &sc->sc_targets[xm->xm_target];
   1305   1.1     itohy 
   1306   1.1     itohy 		target->t_flags = 0;
   1307   1.1     itohy 		if (xm->xm_mode & PERIPH_CAP_TQING)
   1308   1.1     itohy 			target->t_flags |= NJSC32_TARF_TAG;
   1309   1.1     itohy 		if (xm->xm_mode & PERIPH_CAP_SYNC) {
   1310   1.1     itohy 			target->t_flags |= NJSC32_TARF_SYNC;
   1311   1.1     itohy #ifdef NJSC32_DUALEDGE
   1312   1.1     itohy 			if (sc->sc_model & NJSC32_FLAG_DUALEDGE)
   1313   1.1     itohy 				target->t_flags |= NJSC32_TARF_DE;
   1314   1.1     itohy #endif
   1315   1.1     itohy 		}
   1316   1.1     itohy #ifdef NJSC32_DUALEDGE
   1317   1.1     itohy 		target->t_xferctl = 0;
   1318   1.1     itohy #endif
   1319   1.1     itohy 		target->t_state = NJSC32_TARST_INIT;
   1320   1.1     itohy 		njsc32_target_async(sc, target);
   1321   1.1     itohy 
   1322   1.1     itohy 		break;
   1323   1.1     itohy 	default:
   1324   1.1     itohy 		break;
   1325   1.1     itohy 	}
   1326   1.1     itohy }
   1327   1.1     itohy 
   1328   1.2   thorpej static void
   1329   1.2   thorpej njsc32_scsipi_minphys(struct buf *bp)
   1330   1.1     itohy {
   1331   1.1     itohy 
   1332   1.1     itohy 	if (bp->b_bcount > NJSC32_MAX_XFER)
   1333   1.1     itohy 		bp->b_bcount = NJSC32_MAX_XFER;
   1334   1.1     itohy 	minphys(bp);
   1335   1.1     itohy }
   1336   1.1     itohy 
   1337   1.1     itohy static void
   1338   1.2   thorpej njsc32_reset_bus(struct njsc32_softc *sc)
   1339   1.1     itohy {
   1340   1.1     itohy 	int s;
   1341   1.1     itohy 
   1342   1.1     itohy 	DPRINTF(("%s: njsc32_reset_bus:\n", sc->sc_dev.dv_xname));
   1343   1.1     itohy 
   1344   1.1     itohy 	/* SCSI bus reset */
   1345   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_BUS_CONTROL, NJSC32_SBCTL_RST);
   1346   1.1     itohy 	delay(NJSC32_RESET_HOLD_TIME);
   1347   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_BUS_CONTROL, 0);
   1348   1.1     itohy 
   1349   1.1     itohy 	/* clear transfer */
   1350   1.1     itohy 	s = splbio();
   1351   1.1     itohy 	njsc32_reset_detected(sc);
   1352   1.1     itohy 	splx(s);
   1353   1.1     itohy }
   1354   1.1     itohy 
   1355   1.1     itohy /*
   1356   1.1     itohy  * clear running/disconnected commands
   1357   1.1     itohy  */
   1358   1.1     itohy static void
   1359   1.2   thorpej njsc32_clear_cmds(struct njsc32_softc *sc, scsipi_xfer_result_t cmdresult)
   1360   1.1     itohy {
   1361   1.1     itohy 	struct njsc32_cmd *cmd;
   1362   1.1     itohy 	int id, lun;
   1363   1.1     itohy 	struct njsc32_lu *lu;
   1364   1.1     itohy 
   1365   1.1     itohy 	njsc32_arbitration_failed(sc);
   1366   1.1     itohy 
   1367   1.1     itohy 	/* clear current transfer */
   1368   1.1     itohy 	if ((cmd = sc->sc_curcmd) != NULL) {
   1369   1.1     itohy 		sc->sc_curcmd = NULL;
   1370   1.1     itohy 		njsc32_end_cmd(sc, cmd, cmdresult);
   1371   1.1     itohy 	}
   1372   1.1     itohy 
   1373   1.1     itohy 	/* clear disconnected transfers */
   1374   1.1     itohy 	for (id = 0; id <= NJSC32_MAX_TARGET_ID; id++) {
   1375   1.1     itohy 		for (lun = 0; lun < NJSC32_NLU; lun++) {
   1376   1.1     itohy 			lu = &sc->sc_targets[id].t_lus[lun];
   1377   1.1     itohy 
   1378   1.1     itohy 			if ((cmd = lu->lu_cmd) != NULL) {
   1379   1.1     itohy 				lu->lu_cmd = NULL;
   1380   1.1     itohy 				njsc32_end_cmd(sc, cmd, cmdresult);
   1381   1.1     itohy 			}
   1382   1.1     itohy 			while ((cmd = TAILQ_FIRST(&lu->lu_q)) != NULL) {
   1383   1.1     itohy 				TAILQ_REMOVE(&lu->lu_q, cmd, c_q);
   1384   1.1     itohy 				njsc32_end_cmd(sc, cmd, cmdresult);
   1385   1.1     itohy 			}
   1386   1.1     itohy 		}
   1387   1.1     itohy 	}
   1388   1.1     itohy }
   1389   1.1     itohy 
   1390   1.1     itohy static void
   1391   1.2   thorpej njsc32_reset_detected(struct njsc32_softc *sc)
   1392   1.1     itohy {
   1393   1.1     itohy 
   1394   1.1     itohy 	njsc32_clear_cmds(sc, XS_RESET);
   1395   1.1     itohy 	njsc32_init_targets(sc);
   1396   1.1     itohy 	sc->sc_stat = NJSC32_STAT_IDLE;
   1397   1.1     itohy 	KASSERT(sc->sc_nusedcmds == 0);
   1398   1.1     itohy 	scsipi_async_event(&sc->sc_channel, ASYNC_EVENT_RESET, NULL);
   1399   1.1     itohy }
   1400   1.1     itohy 
   1401   1.2   thorpej static int
   1402   1.7  christos njsc32_scsipi_ioctl(struct scsipi_channel *chan, u_long cmd,
   1403  1.10  christos     void *addr, int flag, struct proc *p)
   1404   1.1     itohy {
   1405   1.1     itohy 	struct njsc32_softc *sc = (void *)chan->chan_adapter->adapt_dev;
   1406   1.1     itohy 
   1407   1.1     itohy 	switch (cmd) {
   1408   1.1     itohy 	case SCBUSIORESET:
   1409   1.1     itohy 		njsc32_init(sc, 0);
   1410   1.1     itohy 		return 0;
   1411   1.1     itohy 	default:
   1412   1.1     itohy 		break;
   1413   1.1     itohy 	}
   1414   1.1     itohy 
   1415   1.1     itohy 	return ENOTTY;
   1416   1.1     itohy }
   1417   1.1     itohy 
   1418   1.1     itohy /*
   1419   1.1     itohy  * set current data pointer
   1420   1.1     itohy  */
   1421   1.5     perry static inline void
   1422   1.2   thorpej njsc32_set_cur_ptr(struct njsc32_cmd *cmd, u_int32_t pos)
   1423   1.1     itohy {
   1424   1.1     itohy 
   1425   1.1     itohy 	/* new current data pointer */
   1426   1.1     itohy 	cmd->c_dp_cur = pos;
   1427   1.1     itohy 
   1428   1.1     itohy 	/* update number of bytes transferred */
   1429   1.1     itohy 	if (pos > cmd->c_dp_max)
   1430   1.1     itohy 		cmd->c_dp_max = pos;
   1431   1.1     itohy }
   1432   1.1     itohy 
   1433   1.1     itohy /*
   1434   1.1     itohy  * set data pointer for the next transfer
   1435   1.1     itohy  */
   1436   1.1     itohy static void
   1437   1.2   thorpej njsc32_set_ptr(struct njsc32_softc *sc, struct njsc32_cmd *cmd, u_int32_t pos)
   1438   1.1     itohy {
   1439   1.1     itohy 	struct njsc32_sgtable *sg;
   1440   1.1     itohy 	unsigned sgte;
   1441   1.1     itohy 	u_int32_t len;
   1442   1.1     itohy 
   1443   1.1     itohy 	/* set current pointer */
   1444   1.1     itohy 	njsc32_set_cur_ptr(cmd, pos);
   1445   1.1     itohy 
   1446   1.1     itohy 	/* undo previous fix if any */
   1447   1.1     itohy 	if (cmd->c_sgfixcnt != 0) {
   1448   1.1     itohy 		sg = &cmd->c_sgt[cmd->c_sgoffset];
   1449   1.1     itohy 		sg->sg_addr = htole32(le32toh(sg->sg_addr) - cmd->c_sgfixcnt);
   1450   1.1     itohy 		sg->sg_len = htole32(le32toh(sg->sg_len) + cmd->c_sgfixcnt);
   1451   1.1     itohy 		cmd->c_sgfixcnt = 0;
   1452   1.1     itohy 	}
   1453   1.1     itohy 
   1454   1.1     itohy 	if (pos >= cmd->c_datacnt) {
   1455   1.1     itohy 		/* transfer done */
   1456   1.1     itohy #if 1 /*def DIAGNOSTIC*/
   1457   1.1     itohy 		if (pos > cmd->c_datacnt)
   1458   1.1     itohy 			printf("%s: pos %u too large\n",
   1459   1.1     itohy 			    sc->sc_dev.dv_xname, pos - cmd->c_datacnt);
   1460   1.1     itohy #endif
   1461   1.1     itohy 		cmd->c_xferctl = 0;	/* XXX correct? */
   1462   1.1     itohy 
   1463   1.1     itohy 		return;
   1464   1.1     itohy 	}
   1465   1.1     itohy 
   1466   1.1     itohy 	for (sgte = 0, sg = cmd->c_sgt;
   1467   1.1     itohy 	    sgte < NJSC32_NUM_SG && pos > 0; sgte++, sg++) {
   1468   1.1     itohy 		len = le32toh(sg->sg_len) & ~NJSC32_SGT_ENDMARK;
   1469   1.1     itohy 		if (pos < len) {
   1470   1.1     itohy 			sg->sg_addr = htole32(le32toh(sg->sg_addr) + pos);
   1471   1.1     itohy 			sg->sg_len = htole32(le32toh(sg->sg_len) - pos);
   1472   1.1     itohy 			cmd->c_sgfixcnt = pos;
   1473   1.1     itohy 			break;
   1474   1.1     itohy 		}
   1475   1.1     itohy 		pos -= len;
   1476   1.1     itohy #ifdef DIAGNOSTIC
   1477   1.1     itohy 		if (sg->sg_len & htole32(NJSC32_SGT_ENDMARK)) {
   1478   1.1     itohy 			panic("njsc32_set_ptr: bad pos");
   1479   1.1     itohy 		}
   1480   1.1     itohy #endif
   1481   1.1     itohy 	}
   1482   1.1     itohy #ifdef DIAGNOSTIC
   1483   1.1     itohy 	if (sgte >= NJSC32_NUM_SG)
   1484   1.1     itohy 		panic("njsc32_set_ptr: bad sg");
   1485   1.1     itohy #endif
   1486   1.1     itohy 	if (cmd->c_sgoffset != sgte) {
   1487   1.1     itohy 		cmd->c_sgoffset = sgte;
   1488   1.1     itohy 		cmd->c_sgtdmaaddr = NJSC32_CMD_DMAADDR_SGT(cmd, sgte);
   1489   1.1     itohy 	}
   1490   1.1     itohy 
   1491   1.1     itohy 	/* XXX overkill */
   1492   1.1     itohy 	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_cmdpg,
   1493   1.1     itohy 	    (char *)cmd->c_sgt - (char *)sc->sc_cmdpg,	/* offset */
   1494   1.1     itohy 	    NJSC32_SIZE_SGT,
   1495   1.1     itohy 	    BUS_DMASYNC_PREWRITE);
   1496   1.1     itohy }
   1497   1.1     itohy 
   1498   1.1     itohy /*
   1499   1.1     itohy  * save data pointer
   1500   1.1     itohy  */
   1501   1.5     perry static inline void
   1502   1.2   thorpej njsc32_save_ptr(struct njsc32_cmd *cmd)
   1503   1.1     itohy {
   1504   1.1     itohy 
   1505   1.1     itohy 	cmd->c_dp_saved = cmd->c_dp_cur;
   1506   1.1     itohy }
   1507   1.1     itohy 
   1508   1.1     itohy static void
   1509   1.2   thorpej njsc32_assert_ack(struct njsc32_softc *sc)
   1510   1.1     itohy {
   1511   1.1     itohy 	u_int8_t reg;
   1512   1.1     itohy 
   1513   1.1     itohy 	reg = njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_CONTROL);
   1514   1.1     itohy 	reg |= NJSC32_SBCTL_ACK | NJSC32_SBCTL_ACK_ENABLE;
   1515   1.1     itohy #if 0	/* needed? */
   1516   1.1     itohy 	reg |= NJSC32_SBCTL_AUTODIRECTION;
   1517   1.1     itohy #endif
   1518   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_BUS_CONTROL, reg);
   1519   1.1     itohy }
   1520   1.1     itohy 
   1521   1.1     itohy static void
   1522   1.2   thorpej njsc32_negate_ack(struct njsc32_softc *sc)
   1523   1.1     itohy {
   1524   1.1     itohy 	u_int8_t reg;
   1525   1.1     itohy 
   1526   1.1     itohy 	reg = njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_CONTROL);
   1527   1.1     itohy #if 0	/* needed? */
   1528   1.1     itohy 	reg |= NJSC32_SBCTL_ACK_ENABLE;
   1529   1.1     itohy 	reg |= NJSC32_SBCTL_AUTODIRECTION;
   1530   1.1     itohy #endif
   1531   1.1     itohy 	reg &= ~NJSC32_SBCTL_ACK;
   1532   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_BUS_CONTROL, reg);
   1533   1.1     itohy }
   1534   1.1     itohy 
   1535   1.1     itohy static void
   1536   1.2   thorpej njsc32_wait_req_negate(struct njsc32_softc *sc)
   1537   1.1     itohy {
   1538   1.1     itohy 	int cnt;
   1539   1.1     itohy 
   1540   1.1     itohy 	for (cnt = 0; cnt < NJSC32_REQ_TIMEOUT; cnt++) {
   1541   1.1     itohy 		if ((njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_MONITOR) &
   1542   1.1     itohy 		    NJSC32_BUSMON_REQ) == 0)
   1543   1.1     itohy 			return;
   1544   1.1     itohy 		delay(1);
   1545   1.1     itohy 	}
   1546   1.1     itohy 	printf("%s: njsc32_wait_req_negate: timed out\n", sc->sc_dev.dv_xname);
   1547   1.1     itohy }
   1548   1.1     itohy 
   1549   1.1     itohy static void
   1550   1.2   thorpej njsc32_reconnect(struct njsc32_softc *sc, struct njsc32_cmd *cmd)
   1551   1.1     itohy {
   1552   1.1     itohy 	struct scsipi_xfer *xs;
   1553   1.1     itohy 
   1554   1.1     itohy 	xs = cmd->c_xs;
   1555   1.1     itohy 	if ((xs->xs_control & XS_CTL_POLL) == 0) {
   1556   1.1     itohy 		callout_stop(&xs->xs_callout);
   1557   1.1     itohy 		callout_reset(&xs->xs_callout,
   1558   1.1     itohy 		    mstohz(xs->timeout),
   1559   1.1     itohy 		    njsc32_cmdtimeout, cmd);
   1560   1.1     itohy 	}
   1561   1.1     itohy 
   1562   1.1     itohy 	/* Reconnection implies Restore Pointers */
   1563   1.1     itohy 	njsc32_set_ptr(sc, cmd, cmd->c_dp_saved);
   1564   1.1     itohy }
   1565   1.1     itohy 
   1566   1.1     itohy static enum njsc32_reselstat
   1567   1.2   thorpej njsc32_resel_identify(struct njsc32_softc *sc, int lun,
   1568   1.2   thorpej     struct njsc32_cmd **pcmd)
   1569   1.1     itohy {
   1570   1.1     itohy 	int targetid;
   1571   1.1     itohy 	struct njsc32_lu *plu;
   1572   1.1     itohy 	struct njsc32_cmd *cmd;
   1573   1.1     itohy 
   1574   1.1     itohy 	switch (sc->sc_stat) {
   1575   1.1     itohy 	case NJSC32_STAT_RESEL:
   1576   1.1     itohy 		break;	/* OK */
   1577   1.1     itohy 
   1578   1.1     itohy 	case NJSC32_STAT_RESEL_LUN:
   1579   1.1     itohy 	case NJSC32_STAT_RECONNECT:
   1580   1.1     itohy 		/*
   1581   1.1     itohy 		 * accept and ignore if the LUN is the same as the current one,
   1582   1.1     itohy 		 * reject otherwise.
   1583   1.1     itohy 		 */
   1584   1.1     itohy 		return sc->sc_resellun == lun ?
   1585   1.1     itohy 		    NJSC32_RESEL_THROUGH : NJSC32_RESEL_ERROR;
   1586   1.1     itohy 
   1587   1.1     itohy 	default:
   1588   1.1     itohy 		printf("%s: njsc32_resel_identify: not in reselection\n",
   1589   1.1     itohy 		    sc->sc_dev.dv_xname);
   1590   1.1     itohy 		return NJSC32_RESEL_ERROR;
   1591   1.1     itohy 	}
   1592   1.1     itohy 
   1593   1.1     itohy 	targetid = sc->sc_reselid;
   1594   1.1     itohy 	TPRINTF(("%s: njsc32_resel_identify: reselection lun %d\n",
   1595   1.1     itohy 	    sc->sc_dev.dv_xname, lun));
   1596   1.1     itohy 
   1597   1.1     itohy 	if (targetid > NJSC32_MAX_TARGET_ID || lun >= NJSC32_NLU)
   1598   1.1     itohy 		return NJSC32_RESEL_ERROR;
   1599   1.1     itohy 
   1600   1.1     itohy 	sc->sc_resellun = lun;
   1601   1.1     itohy 	plu = &sc->sc_targets[targetid].t_lus[lun];
   1602   1.1     itohy 
   1603   1.1     itohy 	if ((cmd = plu->lu_cmd) != NULL) {
   1604   1.1     itohy 		sc->sc_stat = NJSC32_STAT_RECONNECT;
   1605   1.1     itohy 		plu->lu_cmd = NULL;
   1606   1.1     itohy 		*pcmd = cmd;
   1607   1.1     itohy 		TPRINTC(cmd, ("njsc32_resel_identify: I_T_L nexus\n"));
   1608   1.1     itohy 		njsc32_reconnect(sc, cmd);
   1609   1.1     itohy 		return NJSC32_RESEL_COMPLETE;
   1610   1.1     itohy 	} else if (!TAILQ_EMPTY(&plu->lu_q)) {
   1611   1.1     itohy 		/* wait for tag */
   1612   1.1     itohy 		sc->sc_stat = NJSC32_STAT_RESEL_LUN;
   1613   1.1     itohy 		return NJSC32_RESEL_THROUGH;
   1614   1.1     itohy 	}
   1615   1.1     itohy 
   1616   1.1     itohy 	/* no disconnected commands */
   1617   1.1     itohy 	return NJSC32_RESEL_ERROR;
   1618   1.1     itohy }
   1619   1.1     itohy 
   1620   1.1     itohy static enum njsc32_reselstat
   1621   1.2   thorpej njsc32_resel_tag(struct njsc32_softc *sc, int tag, struct njsc32_cmd **pcmd)
   1622   1.1     itohy {
   1623   1.1     itohy 	struct njsc32_cmd_head *head;
   1624   1.1     itohy 	struct njsc32_cmd *cmd;
   1625   1.1     itohy 
   1626   1.1     itohy 	TPRINTF(("%s: njsc32_resel_tag: reselection tag %d\n",
   1627   1.1     itohy 	    sc->sc_dev.dv_xname, tag));
   1628   1.1     itohy 	if (sc->sc_stat != NJSC32_STAT_RESEL_LUN)
   1629   1.1     itohy 		return NJSC32_RESEL_ERROR;
   1630   1.1     itohy 
   1631   1.1     itohy 	head = &sc->sc_targets[sc->sc_reselid].t_lus[sc->sc_resellun].lu_q;
   1632   1.1     itohy 
   1633   1.1     itohy 	/* XXX slow? */
   1634   1.1     itohy 	/* search for the command of the tag */
   1635   1.1     itohy 	TAILQ_FOREACH(cmd, head, c_q) {
   1636   1.1     itohy 		if (cmd->c_xs->xs_tag_id == tag) {
   1637   1.1     itohy 			sc->sc_stat = NJSC32_STAT_RECONNECT;
   1638   1.1     itohy 			TAILQ_REMOVE(head, cmd, c_q);
   1639   1.1     itohy 			*pcmd = cmd;
   1640   1.1     itohy 			TPRINTC(cmd, ("njsc32_resel_tag: I_T_L_Q nexus\n"));
   1641   1.1     itohy 			njsc32_reconnect(sc, cmd);
   1642   1.1     itohy 			return NJSC32_RESEL_COMPLETE;
   1643   1.1     itohy 		}
   1644   1.1     itohy 	}
   1645   1.1     itohy 
   1646   1.1     itohy 	/* no disconnected commands */
   1647   1.1     itohy 	return NJSC32_RESEL_ERROR;
   1648   1.1     itohy }
   1649   1.1     itohy 
   1650   1.1     itohy /*
   1651   1.1     itohy  * Reload parameters and restart AutoSCSI.
   1652   1.1     itohy  *
   1653   1.1     itohy  * XXX autoparam doesn't work as expected and we can't use it here.
   1654   1.1     itohy  */
   1655   1.1     itohy static void
   1656   1.2   thorpej njsc32_cmd_reload(struct njsc32_softc *sc, struct njsc32_cmd *cmd, int cctl)
   1657   1.1     itohy {
   1658   1.1     itohy 	struct njsc32_target *target;
   1659   1.1     itohy 
   1660   1.1     itohy 	target = cmd->c_target;
   1661   1.1     itohy 
   1662   1.1     itohy 	/* clear parity error and enable parity detection */
   1663   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_PARITY_CONTROL,
   1664   1.1     itohy 	    NJSC32_PARITYCTL_CHECK_ENABLE | NJSC32_PARITYCTL_CLEAR_ERROR);
   1665   1.1     itohy 
   1666   1.1     itohy 	/* load parameters */
   1667   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_SYNC, target->t_sync);
   1668   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_ACK_WIDTH, target->t_ackwidth);
   1669   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_SREQ_SAMPLING, target->t_sample);
   1670   1.1     itohy 	njsc32_write_4(sc, NJSC32_REG_SGT_ADR, cmd->c_sgtdmaaddr);
   1671   1.1     itohy #ifdef NJSC32_DUALEDGE
   1672   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER,
   1673   1.1     itohy 	    cmd->c_xferctl | target->t_xferctl);
   1674   1.1     itohy #else
   1675   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_TRANSFER, cmd->c_xferctl);
   1676   1.1     itohy #endif
   1677   1.1     itohy 	/* start AutoSCSI */
   1678   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, cctl);
   1679   1.1     itohy 
   1680   1.1     itohy 	sc->sc_curcmd = cmd;
   1681   1.1     itohy }
   1682   1.1     itohy 
   1683   1.1     itohy static void
   1684   1.2   thorpej njsc32_update_xfer_mode(struct njsc32_softc *sc, struct njsc32_target *target)
   1685   1.1     itohy {
   1686   1.1     itohy 	struct scsipi_xfer_mode xm;
   1687   1.1     itohy 
   1688   1.1     itohy 	xm.xm_target = target - sc->sc_targets;	/* target ID */
   1689   1.1     itohy 	xm.xm_mode = 0;
   1690   1.1     itohy 	xm.xm_period = target->t_syncperiod;
   1691   1.1     itohy 	xm.xm_offset = target->t_syncoffset;
   1692   1.1     itohy 	if (xm.xm_offset != 0)
   1693   1.1     itohy 		xm.xm_mode |= PERIPH_CAP_SYNC;
   1694   1.1     itohy 	if (target->t_flags & NJSC32_TARF_TAG)
   1695   1.1     itohy 		xm.xm_mode |= PERIPH_CAP_TQING;
   1696   1.1     itohy 
   1697   1.1     itohy 	scsipi_async_event(&sc->sc_channel, ASYNC_EVENT_XFER_MODE, &xm);
   1698   1.1     itohy }
   1699   1.1     itohy 
   1700   1.1     itohy static void
   1701   1.2   thorpej njsc32_msgin(struct njsc32_softc *sc)
   1702   1.1     itohy {
   1703   1.1     itohy 	u_int8_t msg0, msg;
   1704   1.1     itohy 	int msgcnt;
   1705   1.1     itohy 	struct njsc32_cmd *cmd;
   1706   1.1     itohy 	enum njsc32_reselstat rstat;
   1707   1.1     itohy 	int cctl = 0;
   1708   1.1     itohy 	u_int32_t ptr;	/* unsigned type ensures 2-complement calculation */
   1709   1.1     itohy 	u_int32_t msgout = 0;
   1710   1.9   thorpej 	bool reload_params = FALSE;
   1711   1.1     itohy 	struct njsc32_target *target;
   1712   1.1     itohy 	int idx, period, offset;
   1713   1.1     itohy 
   1714   1.1     itohy 	/*
   1715   1.1     itohy 	 * we are in Message In, so the previous Message Out should have
   1716   1.1     itohy 	 * been done.
   1717   1.1     itohy 	 */
   1718   1.1     itohy 	njsc32_init_msgout(sc);
   1719   1.1     itohy 
   1720   1.1     itohy 	/* get a byte of Message In */
   1721   1.1     itohy 	msg = njsc32_read_1(sc, NJSC32_REG_DATA_IN);
   1722   1.1     itohy 	TPRINTF(("%s: njsc32_msgin: got %#x\n", sc->sc_dev.dv_xname, msg));
   1723   1.1     itohy 	if ((msgcnt = sc->sc_msgincnt) < NJSC32_MSGIN_LEN)
   1724   1.1     itohy 		sc->sc_msginbuf[sc->sc_msgincnt] = msg;
   1725   1.1     itohy 
   1726   1.1     itohy 	njsc32_assert_ack(sc);
   1727   1.1     itohy 
   1728   1.1     itohy 	msg0 = sc->sc_msginbuf[0];
   1729   1.1     itohy 	cmd = sc->sc_curcmd;
   1730   1.1     itohy 
   1731   1.1     itohy 	/* check for parity error */
   1732   1.1     itohy 	if (njsc32_read_1(sc, NJSC32_REG_PARITY_STATUS) &
   1733   1.1     itohy 	    NJSC32_PARITYSTATUS_ERROR_LSB) {
   1734   1.1     itohy 
   1735   1.1     itohy 		printf("%s: msgin: parity error\n", sc->sc_dev.dv_xname);
   1736   1.1     itohy 
   1737   1.1     itohy 		/* clear parity error */
   1738   1.1     itohy 		njsc32_write_1(sc, NJSC32_REG_PARITY_CONTROL,
   1739   1.1     itohy 		    NJSC32_PARITYCTL_CHECK_ENABLE |
   1740   1.1     itohy 		    NJSC32_PARITYCTL_CLEAR_ERROR);
   1741   1.1     itohy 
   1742   1.1     itohy 		/* respond as Message Parity Error */
   1743   1.1     itohy 		njsc32_add_msgout(sc, MSG_PARITY_ERROR);
   1744   1.1     itohy 
   1745   1.1     itohy 		/* clear Message In */
   1746   1.1     itohy 		sc->sc_msgincnt = 0;
   1747   1.1     itohy 		goto reply;
   1748   1.1     itohy 	}
   1749   1.1     itohy 
   1750   1.1     itohy #define WAITNEXTMSG	do { sc->sc_msgincnt++; goto restart; } while (0)
   1751   1.1     itohy #define MSGCOMPLETE	do { sc->sc_msgincnt = 0; goto restart; } while (0)
   1752   1.1     itohy 	if (MSG_ISIDENTIFY(msg0)) {
   1753   1.1     itohy 		/*
   1754   1.1     itohy 		 * Got Identify message from target.
   1755   1.1     itohy 		 */
   1756   1.1     itohy 		if ((msg0 & ~MSG_IDENTIFY_LUNMASK) != MSG_IDENTIFYFLAG ||
   1757   1.1     itohy 		    (rstat = njsc32_resel_identify(sc, msg0 &
   1758   1.1     itohy 			MSG_IDENTIFY_LUNMASK, &cmd)) == NJSC32_RESEL_ERROR) {
   1759   1.1     itohy 			/*
   1760   1.1     itohy 			 * invalid Identify -> Reject
   1761   1.1     itohy 			 */
   1762   1.1     itohy 			goto reject;
   1763   1.1     itohy 		}
   1764   1.1     itohy 		if (rstat == NJSC32_RESEL_COMPLETE)
   1765   1.1     itohy 			reload_params = TRUE;
   1766   1.1     itohy 		MSGCOMPLETE;
   1767   1.1     itohy 	}
   1768   1.1     itohy 
   1769   1.1     itohy 	if (msg0 == MSG_SIMPLE_Q_TAG) {
   1770   1.1     itohy 		if (msgcnt == 0)
   1771   1.1     itohy 			WAITNEXTMSG;
   1772   1.1     itohy 
   1773   1.1     itohy 		/* got whole message */
   1774   1.1     itohy 		sc->sc_msgincnt = 0;
   1775   1.1     itohy 
   1776   1.1     itohy 		if ((rstat = njsc32_resel_tag(sc, sc->sc_msginbuf[1], &cmd))
   1777   1.1     itohy 		    == NJSC32_RESEL_ERROR) {
   1778   1.1     itohy 			/*
   1779   1.1     itohy 			 * invalid Simple Queue Tag -> Abort Tag
   1780   1.1     itohy 			 */
   1781   1.1     itohy 			printf("%s: msgin: invalid tag\n", sc->sc_dev.dv_xname);
   1782   1.1     itohy 			njsc32_add_msgout(sc, MSG_ABORT_TAG);
   1783   1.1     itohy 			goto reply;
   1784   1.1     itohy 		}
   1785   1.1     itohy 		if (rstat == NJSC32_RESEL_COMPLETE)
   1786   1.1     itohy 			reload_params = TRUE;
   1787   1.1     itohy 		MSGCOMPLETE;
   1788   1.1     itohy 	}
   1789   1.1     itohy 
   1790   1.1     itohy 	/* I_T_L or I_T_L_Q nexus should be established now */
   1791   1.1     itohy 	if (cmd == NULL) {
   1792   1.1     itohy 		printf("%s: msgin %#x without nexus -- sending abort\n",
   1793   1.1     itohy 		    sc->sc_dev.dv_xname, msg0);
   1794   1.1     itohy 		njsc32_add_msgout(sc, MSG_ABORT);
   1795   1.1     itohy 		goto reply;
   1796   1.1     itohy 	}
   1797   1.1     itohy 
   1798   1.1     itohy 	/*
   1799   1.1     itohy 	 * extended message
   1800   1.1     itohy 	 * 0x01 <length (0 stands for 256)> <length bytes>
   1801   1.1     itohy 	 *                                 (<code> [<parameter> ...])
   1802   1.1     itohy 	 */
   1803   1.1     itohy #define EXTLENOFF	1
   1804   1.1     itohy #define EXTCODEOFF	2
   1805   1.1     itohy 	if (msg0 == MSG_EXTENDED) {
   1806   1.1     itohy 		if (msgcnt < EXTLENOFF ||
   1807   1.1     itohy 		    msgcnt < EXTLENOFF + 1 +
   1808   1.1     itohy 		    (u_int8_t)(sc->sc_msginbuf[EXTLENOFF] - 1))
   1809   1.1     itohy 			WAITNEXTMSG;
   1810   1.1     itohy 
   1811   1.1     itohy 		/* got whole message */
   1812   1.1     itohy 		sc->sc_msgincnt = 0;
   1813   1.1     itohy 
   1814   1.1     itohy 		switch (sc->sc_msginbuf[EXTCODEOFF]) {
   1815   1.1     itohy 		case 0:	/* Modify Data Pointer */
   1816   1.1     itohy 			if (msgcnt != 5 + EXTCODEOFF - 1)
   1817   1.1     itohy 				break;
   1818   1.1     itohy 			/*
   1819   1.1     itohy 			 * parameter is 32bit big-endian signed (2-complement)
   1820   1.1     itohy 			 * value
   1821   1.1     itohy 			 */
   1822   1.1     itohy 			ptr = (sc->sc_msginbuf[EXTCODEOFF + 1] << 24) |
   1823   1.1     itohy 			      (sc->sc_msginbuf[EXTCODEOFF + 2] << 16) |
   1824   1.1     itohy 			      (sc->sc_msginbuf[EXTCODEOFF + 3] << 8) |
   1825   1.1     itohy 			      sc->sc_msginbuf[EXTCODEOFF + 4];
   1826   1.1     itohy 
   1827   1.1     itohy 			/* new pointer */
   1828   1.1     itohy 			ptr += cmd->c_dp_cur;	/* ignore overflow */
   1829   1.1     itohy 
   1830   1.1     itohy 			/* reject if ptr is not in data buffer */
   1831   1.1     itohy 			if (ptr > cmd->c_datacnt)
   1832   1.1     itohy 				break;
   1833   1.1     itohy 
   1834   1.1     itohy 			njsc32_set_ptr(sc, cmd, ptr);
   1835   1.1     itohy 			goto restart;
   1836   1.1     itohy 
   1837   1.1     itohy 		case MSG_EXT_SDTR:	/* Synchronous Data Transfer Request */
   1838   1.1     itohy 			DPRINTC(cmd, ("SDTR %#x %#x\n",
   1839   1.1     itohy 			    sc->sc_msginbuf[EXTCODEOFF + 1],
   1840   1.1     itohy 			    sc->sc_msginbuf[EXTCODEOFF + 2]));
   1841   1.1     itohy 			if (msgcnt != MSG_EXT_SDTR_LEN + EXTCODEOFF-1)
   1842   1.1     itohy 				break;	/* reject */
   1843   1.1     itohy 
   1844   1.1     itohy 			target = cmd->c_target;
   1845   1.1     itohy 
   1846   1.1     itohy 			/* lookup sync period parameters */
   1847   1.1     itohy 			period = sc->sc_msginbuf[EXTCODEOFF + 1];
   1848   1.1     itohy 			for (idx = sc->sc_sync_max; idx < NJSC32_NSYNCT; idx++)
   1849   1.1     itohy 				if (sc->sc_synct[idx].sp_period >= period) {
   1850   1.1     itohy 					period = sc->sc_synct[idx].sp_period;
   1851   1.1     itohy 					break;
   1852   1.1     itohy 				}
   1853   1.1     itohy 			if (idx >= NJSC32_NSYNCT) {
   1854   1.1     itohy 				/*
   1855   1.1     itohy 				 * We can't meet the timing condition that
   1856   1.1     itohy 				 * the target requests -- use async.
   1857   1.1     itohy 				 */
   1858   1.1     itohy 				njsc32_target_async(sc, target);
   1859   1.1     itohy 				njsc32_update_xfer_mode(sc, target);
   1860   1.1     itohy 				if (target->t_state == NJSC32_TARST_SDTR) {
   1861   1.1     itohy 					/*
   1862   1.1     itohy 					 * We started SDTR exchange -- start
   1863   1.1     itohy 					 * negotiation again and request async.
   1864   1.1     itohy 					 */
   1865   1.1     itohy 					target->t_state = NJSC32_TARST_ASYNC;
   1866   1.1     itohy 					njsc32_negotiate_xfer(sc, target);
   1867   1.1     itohy 					goto reply;
   1868   1.1     itohy 				} else {
   1869   1.1     itohy 					/*
   1870   1.1     itohy 					 * The target started SDTR exchange
   1871   1.1     itohy 					 * -- just reject and fallback
   1872   1.1     itohy 					 * to async.
   1873   1.1     itohy 					 */
   1874   1.1     itohy 					goto reject;
   1875   1.1     itohy 				}
   1876   1.1     itohy 			}
   1877   1.1     itohy 
   1878   1.1     itohy 			/* check sync offset */
   1879   1.1     itohy 			offset = sc->sc_msginbuf[EXTCODEOFF + 2];
   1880   1.1     itohy 			if (offset > NJSC32_SYNCOFFSET_MAX) {
   1881   1.1     itohy 				if (target->t_state == NJSC32_TARST_SDTR) {
   1882   1.1     itohy 					printf("%s: wrong sync offset: %d\n",
   1883   1.1     itohy 					    cmd->c_xs->xs_periph->periph_dev->dv_xname,
   1884   1.1     itohy 					    offset);
   1885   1.1     itohy 					/* XXX what to do? */
   1886   1.1     itohy 				}
   1887   1.1     itohy 				offset = NJSC32_SYNCOFFSET_MAX;
   1888   1.1     itohy 			}
   1889   1.1     itohy 
   1890   1.1     itohy 			target->t_ackwidth = sc->sc_synct[idx].sp_ackw;
   1891   1.1     itohy 			target->t_sample   = sc->sc_synct[idx].sp_sample;
   1892   1.1     itohy 			target->t_syncperiod = period;
   1893   1.1     itohy 			target->t_syncoffset = offset;
   1894   1.1     itohy 			target->t_sync = NJSC32_SYNC_VAL(idx, offset);
   1895   1.1     itohy 			njsc32_update_xfer_mode(sc, target);
   1896   1.1     itohy 
   1897   1.1     itohy 			if (target->t_state == NJSC32_TARST_SDTR) {
   1898   1.1     itohy 				target->t_state = NJSC32_TARST_DONE;
   1899   1.1     itohy 			} else {
   1900   1.1     itohy 				njsc32_msgout_sdtr(sc, period, offset);
   1901   1.1     itohy 				goto reply;
   1902   1.1     itohy 			}
   1903   1.1     itohy 			goto restart;
   1904   1.1     itohy 
   1905   1.1     itohy 		case MSG_EXT_WDTR:	/* Wide Data Transfer Request */
   1906   1.1     itohy 			DPRINTC(cmd,
   1907   1.1     itohy 			    ("WDTR %#x\n", sc->sc_msginbuf[EXTCODEOFF + 1]));
   1908   1.1     itohy #ifdef NJSC32_DUALEDGE
   1909   1.1     itohy 			if (msgcnt != MSG_EXT_WDTR_LEN + EXTCODEOFF-1)
   1910   1.1     itohy 				break;	/* reject */
   1911   1.1     itohy 
   1912   1.1     itohy 			/*
   1913   1.1     itohy 			 * T->I of this message is not used for
   1914   1.1     itohy 			 * DualEdge negotiation, so the device
   1915   1.1     itohy 			 * must not be a DualEdge device.
   1916   1.1     itohy 			 *
   1917   1.1     itohy 			 * XXX correct?
   1918   1.1     itohy 			 */
   1919   1.1     itohy 			target = cmd->c_target;
   1920   1.1     itohy 			target->t_xferctl = 0;
   1921   1.1     itohy 
   1922   1.1     itohy 			switch (target->t_state) {
   1923   1.1     itohy 			case NJSC32_TARST_DE:
   1924   1.1     itohy 				if (sc->sc_msginbuf[EXTCODEOFF + 1] !=
   1925   1.1     itohy 				    MSG_EXT_WDTR_BUS_8_BIT) {
   1926   1.1     itohy 					/*
   1927   1.1     itohy 					 * Oops, we got unexpected WDTR.
   1928   1.1     itohy 					 * Negotiate for 8bit.
   1929   1.1     itohy 					 */
   1930   1.1     itohy 					target->t_state = NJSC32_TARST_WDTR;
   1931   1.1     itohy 				} else {
   1932   1.1     itohy 					target->t_state = NJSC32_TARST_SDTR;
   1933   1.1     itohy 				}
   1934   1.1     itohy 				njsc32_negotiate_xfer(sc, target);
   1935   1.1     itohy 				goto reply;
   1936   1.1     itohy 
   1937   1.1     itohy 			case NJSC32_TARST_WDTR:
   1938   1.1     itohy 				if (sc->sc_msginbuf[EXTCODEOFF + 1] !=
   1939   1.1     itohy 				    MSG_EXT_WDTR_BUS_8_BIT) {
   1940   1.1     itohy 					printf("%s: unexpected transfer width: %#x\n",
   1941   1.1     itohy 					    cmd->c_xs->xs_periph->periph_dev->dv_xname,
   1942   1.1     itohy 					    sc->sc_msginbuf[EXTCODEOFF + 1]);
   1943   1.1     itohy 					/* XXX what to do? */
   1944   1.1     itohy 				}
   1945   1.1     itohy 				target->t_state = NJSC32_TARST_SDTR;
   1946   1.1     itohy 				njsc32_negotiate_xfer(sc, target);
   1947   1.1     itohy 				goto reply;
   1948   1.1     itohy 
   1949   1.1     itohy 			default:
   1950   1.1     itohy 				/* the target started WDTR exchange */
   1951   1.1     itohy 				DPRINTC(cmd, ("WDTR from target\n"));
   1952   1.1     itohy 
   1953   1.1     itohy 				target->t_state = NJSC32_TARST_SDTR;
   1954   1.1     itohy 				njsc32_target_async(sc, target);
   1955   1.1     itohy 
   1956   1.1     itohy 				break;	/* reject the WDTR (8bit transfer) */
   1957   1.1     itohy 			}
   1958   1.1     itohy #endif	/* NJSC32_DUALEDGE */
   1959   1.1     itohy 			break;	/* reject */
   1960   1.1     itohy 		}
   1961   1.1     itohy 		DPRINTC(cmd, ("njsc32_msgin: reject ext msg %#x msgincnt %d\n",
   1962   1.1     itohy 		    sc->sc_msginbuf[EXTCODEOFF], msgcnt));
   1963   1.1     itohy 		goto reject;
   1964   1.1     itohy 	}
   1965   1.1     itohy 
   1966   1.1     itohy 	/* 2byte messages */
   1967   1.1     itohy 	if (MSG_IS2BYTE(msg0)) {
   1968   1.1     itohy 		if (msgcnt == 0)
   1969   1.1     itohy 			WAITNEXTMSG;
   1970   1.1     itohy 
   1971   1.1     itohy 		/* got whole message */
   1972   1.1     itohy 		sc->sc_msgincnt = 0;
   1973   1.1     itohy 	}
   1974   1.1     itohy 
   1975   1.1     itohy 	switch (msg0) {
   1976   1.1     itohy 	case MSG_CMDCOMPLETE:		/* 0x00 */
   1977   1.1     itohy 	case MSG_SAVEDATAPOINTER:	/* 0x02 */
   1978   1.1     itohy 	case MSG_DISCONNECT:		/* 0x04 */
   1979   1.1     itohy 		/* handled by AutoSCSI */
   1980   1.1     itohy 		PRINTC(cmd, ("msgin: unexpected msg: %#x\n", msg0));
   1981   1.1     itohy 		break;
   1982   1.1     itohy 
   1983   1.1     itohy 	case MSG_RESTOREPOINTERS:	/* 0x03 */
   1984   1.1     itohy 		/* restore data pointer to what was saved */
   1985   1.1     itohy 		DPRINTC(cmd, ("njsc32_msgin: Restore Pointers\n"));
   1986   1.1     itohy 		njsc32_set_ptr(sc, cmd, cmd->c_dp_saved);
   1987   1.1     itohy 		reload_params = TRUE;
   1988   1.1     itohy 		MSGCOMPLETE;
   1989   1.1     itohy 		/* NOTREACHED */
   1990   1.1     itohy 		break;
   1991   1.1     itohy 
   1992   1.1     itohy #if 0	/* handled above */
   1993   1.1     itohy 	case MSG_EXTENDED:		/* 0x01 */
   1994   1.1     itohy #endif
   1995   1.1     itohy 	case MSG_MESSAGE_REJECT:	/* 0x07 */
   1996   1.1     itohy 		target = cmd->c_target;
   1997   1.1     itohy 		DPRINTC(cmd, ("Reject tarst %d\n", target->t_state));
   1998   1.1     itohy 		switch (target->t_state) {
   1999   1.1     itohy #ifdef NJSC32_DUALEDGE
   2000   1.1     itohy 		case NJSC32_TARST_WDTR:
   2001   1.1     itohy 		case NJSC32_TARST_DE:
   2002   1.1     itohy 			target->t_xferctl = 0;
   2003   1.1     itohy 			target->t_state = NJSC32_TARST_SDTR;
   2004   1.1     itohy 			njsc32_negotiate_xfer(sc, target);
   2005   1.1     itohy 			goto reply;
   2006   1.1     itohy #endif
   2007   1.1     itohy 		case NJSC32_TARST_SDTR:
   2008   1.1     itohy 		case NJSC32_TARST_ASYNC:
   2009   1.1     itohy 			njsc32_target_async(sc, target);
   2010   1.1     itohy 			target->t_state = NJSC32_TARST_DONE;
   2011   1.1     itohy 			njsc32_update_xfer_mode(sc, target);
   2012   1.1     itohy 			break;
   2013   1.1     itohy 		default:
   2014   1.1     itohy 			break;
   2015   1.1     itohy 		}
   2016   1.1     itohy 		goto restart;
   2017   1.1     itohy 
   2018   1.1     itohy 	case MSG_NOOP:			/* 0x08 */
   2019   1.1     itohy #ifdef NJSC32_DUALEDGE
   2020   1.1     itohy 		target = cmd->c_target;
   2021   1.1     itohy 		if (target->t_state == NJSC32_TARST_DE) {
   2022   1.1     itohy 			aprint_normal("%s: DualEdge transfer\n",
   2023   1.1     itohy 			    cmd->c_xs->xs_periph->periph_dev->dv_xname);
   2024   1.1     itohy 			target->t_xferctl = NJSC32_XFR_DUALEDGE_ENABLE;
   2025   1.1     itohy 			/* go to next negotiation */
   2026   1.1     itohy 			target->t_state = NJSC32_TARST_SDTR;
   2027   1.1     itohy 			njsc32_negotiate_xfer(sc, target);
   2028   1.1     itohy 			goto reply;
   2029   1.1     itohy 		}
   2030   1.1     itohy #endif
   2031   1.1     itohy 		goto restart;
   2032   1.1     itohy 
   2033   1.1     itohy 	case MSG_INITIATOR_DET_ERR:	/* 0x05 I->T only */
   2034   1.1     itohy 	case MSG_ABORT:			/* 0x06 I->T only */
   2035   1.1     itohy 	case MSG_PARITY_ERROR:		/* 0x09 I->T only */
   2036   1.1     itohy 	case MSG_LINK_CMD_COMPLETE:	/* 0x0a */
   2037   1.1     itohy 	case MSG_LINK_CMD_COMPLETEF:	/* 0x0b */
   2038   1.1     itohy 	case MSG_BUS_DEV_RESET:		/* 0x0c I->T only */
   2039   1.1     itohy 	case MSG_ABORT_TAG:		/* 0x0d I->T only */
   2040   1.1     itohy 	case MSG_CLEAR_QUEUE:		/* 0x0e I->T only */
   2041   1.1     itohy 
   2042   1.1     itohy #if 0	/* handled above */
   2043   1.1     itohy 	case MSG_SIMPLE_Q_TAG:		/* 0x20 */
   2044   1.1     itohy #endif
   2045   1.1     itohy 	case MSG_HEAD_OF_Q_TAG:		/* 0x21 I->T only */
   2046   1.1     itohy 	case MSG_ORDERED_Q_TAG:		/* 0x22 I->T only */
   2047   1.1     itohy 	case MSG_IGN_WIDE_RESIDUE:	/* 0x23 */
   2048   1.1     itohy 
   2049   1.1     itohy 	default:
   2050   1.1     itohy #ifdef NJSC32_DEBUG
   2051   1.1     itohy 		PRINTC(cmd, ("msgin: unsupported msg: %#x", msg0));
   2052   1.1     itohy 		if (MSG_IS2BYTE(msg0))
   2053   1.1     itohy 			printf(" %#x", msg);
   2054   1.1     itohy 		printf("\n");
   2055   1.1     itohy #endif
   2056   1.1     itohy 		break;
   2057   1.1     itohy 	}
   2058   1.1     itohy 
   2059   1.1     itohy reject:
   2060   1.1     itohy 	njsc32_add_msgout(sc, MSG_MESSAGE_REJECT);
   2061   1.1     itohy 
   2062   1.1     itohy reply:
   2063   1.1     itohy 	msgout = njsc32_get_auto_msgout(sc);
   2064   1.1     itohy 
   2065   1.1     itohy restart:
   2066   1.1     itohy 	cctl = NJSC32_CMD_CLEAR_CDB_FIFO_PTR |
   2067   1.1     itohy 	    NJSC32_CMD_AUTO_COMMAND_PHASE |
   2068   1.1     itohy 	    NJSC32_CMD_AUTO_SCSI_RESTART;
   2069   1.1     itohy 
   2070   1.1     itohy 	/*
   2071   1.1     itohy 	 * Be careful the second and latter bytes of Message In
   2072   1.1     itohy 	 * shall not be absorbed by AutoSCSI.
   2073   1.1     itohy 	 */
   2074   1.1     itohy 	if (sc->sc_msgincnt == 0)
   2075   1.1     itohy 		cctl |= NJSC32_CMD_AUTO_MSGIN_00_04 | NJSC32_CMD_AUTO_MSGIN_02;
   2076   1.1     itohy 
   2077   1.1     itohy 	if (sc->sc_msgoutlen != 0)
   2078   1.1     itohy 		cctl |= NJSC32_CMD_AUTO_ATN;
   2079   1.1     itohy 
   2080   1.1     itohy 	njsc32_write_4(sc, NJSC32_REG_SCSI_MSG_OUT, msgout);
   2081   1.1     itohy 
   2082   1.1     itohy 	/* (re)start AutoSCSI (may assert ATN) */
   2083   1.1     itohy 	if (reload_params) {
   2084   1.1     itohy 		njsc32_cmd_reload(sc, cmd, cctl);
   2085   1.1     itohy 	} else {
   2086   1.1     itohy 		njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, cctl);
   2087   1.1     itohy 	}
   2088   1.1     itohy 
   2089   1.1     itohy 	/* +ATN -> -REQ: need 90ns delay? */
   2090   1.1     itohy 
   2091   1.1     itohy 	njsc32_wait_req_negate(sc);	/* wait for REQ negation */
   2092   1.1     itohy 
   2093   1.1     itohy 	njsc32_negate_ack(sc);
   2094   1.1     itohy 
   2095   1.1     itohy 	return;
   2096   1.1     itohy }
   2097   1.1     itohy 
   2098   1.1     itohy static void
   2099   1.2   thorpej njsc32_msgout(struct njsc32_softc *sc)
   2100   1.1     itohy {
   2101   1.1     itohy 	int cctl;
   2102   1.1     itohy 	u_int8_t bus;
   2103   1.1     itohy 	unsigned n;
   2104   1.1     itohy 
   2105   1.1     itohy 	if (sc->sc_msgoutlen == 0) {
   2106   1.1     itohy 		/* target entered to Message Out on unexpected timing */
   2107   1.1     itohy 		njsc32_add_msgout(sc, MSG_NOOP);
   2108   1.1     itohy 	}
   2109   1.1     itohy 
   2110   1.1     itohy 	cctl = NJSC32_CMD_CLEAR_CDB_FIFO_PTR |
   2111   1.1     itohy 	    NJSC32_CMD_AUTO_COMMAND_PHASE | NJSC32_CMD_AUTO_SCSI_RESTART |
   2112   1.1     itohy 	    NJSC32_CMD_AUTO_MSGIN_00_04 | NJSC32_CMD_AUTO_MSGIN_02;
   2113   1.1     itohy 
   2114   1.1     itohy 	/* make sure target is in Message Out phase */
   2115   1.1     itohy 	bus = njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_MONITOR);
   2116   1.1     itohy 	if ((bus & NJSC32_BUSMON_PHASE_MASK) != NJSC32_PHASE_MESSAGE_OUT) {
   2117   1.1     itohy 		/*
   2118   1.1     itohy 		 * Message Out is aborted by target.
   2119   1.1     itohy 		 */
   2120   1.1     itohy 		printf("%s: njsc32_msgout: phase change %#x\n",
   2121   1.1     itohy 		    sc->sc_dev.dv_xname, bus);
   2122   1.1     itohy 
   2123   1.1     itohy 		/* XXX what to do? */
   2124   1.1     itohy 
   2125   1.1     itohy 		/* restart AutoSCSI (negate ATN) */
   2126   1.1     itohy 		njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, cctl);
   2127   1.1     itohy 
   2128   1.1     itohy 		sc->sc_msgoutidx = 0;
   2129   1.1     itohy 		return;
   2130   1.1     itohy 	}
   2131   1.1     itohy 
   2132   1.1     itohy 	n = sc->sc_msgoutidx;
   2133   1.1     itohy 	if (n == sc->sc_msgoutlen - 1) {
   2134   1.1     itohy 		/*
   2135   1.1     itohy 		 * negate ATN before sending ACK
   2136   1.1     itohy 		 */
   2137   1.1     itohy 		njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, 0);
   2138   1.1     itohy 
   2139   1.1     itohy 		sc->sc_msgoutidx = 0;	/* target may retry Message Out */
   2140   1.1     itohy 	} else {
   2141   1.1     itohy 		cctl |= NJSC32_CMD_AUTO_ATN;
   2142   1.1     itohy 		sc->sc_msgoutidx++;
   2143   1.1     itohy 	}
   2144   1.1     itohy 
   2145   1.1     itohy 	/* Send Message Out */
   2146   1.1     itohy 	njsc32_write_1(sc, NJSC32_REG_SCSI_OUT_LATCH, sc->sc_msgout[n]);
   2147   1.1     itohy 
   2148   1.1     itohy 	/* DBn -> +ACK: need 55ns delay? */
   2149   1.1     itohy 
   2150   1.1     itohy 	njsc32_assert_ack(sc);
   2151   1.1     itohy 	njsc32_wait_req_negate(sc);	/* wait for REQ negation */
   2152   1.1     itohy 
   2153   1.1     itohy 	/* restart AutoSCSI */
   2154   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_COMMAND_CONTROL, cctl);
   2155   1.1     itohy 
   2156   1.1     itohy 	njsc32_negate_ack(sc);
   2157   1.1     itohy 
   2158   1.1     itohy 	/*
   2159   1.1     itohy 	 * do not reset sc->sc_msgoutlen so the target
   2160   1.1     itohy 	 * can retry Message Out phase
   2161   1.1     itohy 	 */
   2162   1.1     itohy }
   2163   1.1     itohy 
   2164   1.1     itohy static void
   2165   1.2   thorpej njsc32_cmdtimeout(void *arg)
   2166   1.1     itohy {
   2167   1.1     itohy 	struct njsc32_cmd *cmd = arg;
   2168   1.1     itohy 	struct njsc32_softc *sc;
   2169   1.1     itohy 	int s;
   2170   1.1     itohy 
   2171   1.1     itohy 	PRINTC(cmd, ("command timeout\n"));
   2172   1.1     itohy 
   2173   1.1     itohy 	sc = cmd->c_sc;
   2174   1.1     itohy 
   2175   1.1     itohy 	s = splbio();
   2176   1.1     itohy 
   2177   1.1     itohy 	if (sc->sc_stat == NJSC32_STAT_ARBIT)
   2178   1.1     itohy 		njsc32_arbitration_failed(sc);
   2179   1.1     itohy 	else {
   2180   1.1     itohy 		sc->sc_curcmd = NULL;
   2181   1.1     itohy 		sc->sc_stat = NJSC32_STAT_IDLE;
   2182   1.1     itohy 		njsc32_end_cmd(sc, cmd, XS_TIMEOUT);
   2183   1.1     itohy 	}
   2184   1.1     itohy 
   2185   1.1     itohy 	/* XXX? */
   2186   1.1     itohy 	njsc32_init(sc, 1);	/* bus reset */
   2187   1.1     itohy 
   2188   1.1     itohy 	splx(s);
   2189   1.1     itohy }
   2190   1.1     itohy 
   2191   1.1     itohy static void
   2192   1.2   thorpej njsc32_reseltimeout(void *arg)
   2193   1.1     itohy {
   2194   1.1     itohy 	struct njsc32_cmd *cmd = arg;
   2195   1.1     itohy 	struct njsc32_softc *sc;
   2196   1.1     itohy 	int s;
   2197   1.1     itohy 
   2198   1.1     itohy 	PRINTC(cmd, ("reselection timeout\n"));
   2199   1.1     itohy 
   2200   1.1     itohy 	sc = cmd->c_sc;
   2201   1.1     itohy 
   2202   1.1     itohy 	s = splbio();
   2203   1.1     itohy 
   2204   1.1     itohy 	/* remove from disconnected list */
   2205   1.1     itohy 	if (cmd->c_flags & NJSC32_CMD_TAGGED) {
   2206   1.1     itohy 		/* I_T_L_Q */
   2207   1.1     itohy 		KASSERT(cmd->c_lu->lu_cmd == NULL);
   2208   1.1     itohy 		TAILQ_REMOVE(&cmd->c_lu->lu_q, cmd, c_q);
   2209   1.1     itohy 	} else {
   2210   1.1     itohy 		/* I_T_L */
   2211   1.1     itohy 		KASSERT(cmd->c_lu->lu_cmd == cmd);
   2212   1.1     itohy 		cmd->c_lu->lu_cmd = NULL;
   2213   1.1     itohy 	}
   2214   1.1     itohy 
   2215   1.1     itohy 	njsc32_end_cmd(sc, cmd, XS_TIMEOUT);
   2216   1.1     itohy 
   2217   1.1     itohy 	/* XXX? */
   2218   1.1     itohy 	njsc32_init(sc, 1);	/* bus reset */
   2219   1.1     itohy 
   2220   1.1     itohy 	splx(s);
   2221   1.1     itohy }
   2222   1.1     itohy 
   2223   1.5     perry static inline void
   2224   1.2   thorpej njsc32_end_auto(struct njsc32_softc *sc, struct njsc32_cmd *cmd, int auto_phase)
   2225   1.1     itohy {
   2226   1.1     itohy 	struct scsipi_xfer *xs;
   2227   1.1     itohy 
   2228   1.1     itohy 	if (auto_phase & NJSC32_XPHASE_MSGIN_02) {
   2229   1.1     itohy 		/* Message In: 0x02 Save Data Pointer */
   2230   1.1     itohy 
   2231   1.1     itohy 		/*
   2232   1.1     itohy 		 * Adjust saved data pointer
   2233   1.1     itohy 		 * if the command is not completed yet.
   2234   1.1     itohy 		 */
   2235   1.1     itohy 		if ((auto_phase & NJSC32_XPHASE_MSGIN_00) == 0 &&
   2236   1.1     itohy 		    (auto_phase &
   2237   1.1     itohy 		     (NJSC32_XPHASE_DATA_IN | NJSC32_XPHASE_DATA_OUT)) != 0) {
   2238   1.1     itohy 			njsc32_save_ptr(cmd);
   2239   1.1     itohy 		}
   2240   1.1     itohy 		TPRINTF(("BM %u, SGT %u, SACK %u, SAVED_ACK %u\n",
   2241   1.1     itohy 		    njsc32_read_4(sc, NJSC32_REG_BM_CNT),
   2242   1.1     itohy 		    njsc32_read_4(sc, NJSC32_REG_SGT_ADR),
   2243   1.1     itohy 		    njsc32_read_4(sc, NJSC32_REG_SACK_CNT),
   2244   1.1     itohy 		    njsc32_read_4(sc, NJSC32_REG_SAVED_ACK_CNT)));
   2245   1.1     itohy 	}
   2246   1.1     itohy 
   2247   1.1     itohy 	xs = cmd->c_xs;
   2248   1.1     itohy 
   2249   1.1     itohy 	if (auto_phase & NJSC32_XPHASE_MSGIN_00) {
   2250   1.1     itohy 		/* Command Complete */
   2251   1.1     itohy 		TPRINTC(cmd, ("njsc32_intr: Command Complete\n"));
   2252   1.1     itohy 		switch (xs->status) {
   2253   1.1     itohy 		case SCSI_CHECK: case SCSI_QUEUE_FULL: case SCSI_BUSY:
   2254   1.1     itohy 			/*
   2255   1.1     itohy 			 * scsipi layer will automatically handle the error
   2256   1.1     itohy 			 */
   2257   1.1     itohy 			njsc32_end_cmd(sc, cmd, XS_BUSY);
   2258   1.1     itohy 			break;
   2259   1.1     itohy 		default:
   2260   1.1     itohy 			xs->resid -= cmd->c_dp_max;
   2261   1.1     itohy 			njsc32_end_cmd(sc, cmd, XS_NOERROR);
   2262   1.1     itohy 			break;
   2263   1.1     itohy 		}
   2264   1.1     itohy 	} else if (auto_phase & NJSC32_XPHASE_MSGIN_04) {
   2265   1.1     itohy 		/* Disconnect */
   2266   1.1     itohy 		TPRINTC(cmd, ("njsc32_intr: Disconnect\n"));
   2267   1.1     itohy 
   2268   1.1     itohy 		/* for ill-designed devices */
   2269   1.1     itohy 		if ((xs->xs_periph->periph_quirks & PQUIRK_AUTOSAVE) != 0)
   2270   1.1     itohy 			njsc32_save_ptr(cmd);
   2271   1.1     itohy 
   2272   1.1     itohy 		/*
   2273   1.1     itohy 		 * move current cmd to disconnected list
   2274   1.1     itohy 		 */
   2275   1.1     itohy 		if (cmd->c_flags & NJSC32_CMD_TAGGED) {
   2276   1.1     itohy 			/* I_T_L_Q */
   2277   1.1     itohy 			if (cmd->c_flags & NJSC32_CMD_TAGGED_HEAD)
   2278   1.1     itohy 				TAILQ_INSERT_HEAD(&cmd->c_lu->lu_q, cmd, c_q);
   2279   1.1     itohy 			else
   2280   1.1     itohy 				TAILQ_INSERT_TAIL(&cmd->c_lu->lu_q, cmd, c_q);
   2281   1.1     itohy 		} else {
   2282   1.1     itohy 			/* I_T_L */
   2283   1.1     itohy 			cmd->c_lu->lu_cmd = cmd;
   2284   1.1     itohy 		}
   2285   1.1     itohy 
   2286   1.1     itohy 		/*
   2287   1.1     itohy 		 * schedule timeout -- avoid being
   2288   1.1     itohy 		 * disconnected forever
   2289   1.1     itohy 		 */
   2290   1.1     itohy 		if ((xs->xs_control & XS_CTL_POLL) == 0) {
   2291   1.1     itohy 			callout_stop(&xs->xs_callout);
   2292   1.1     itohy 			callout_reset(&xs->xs_callout, mstohz(xs->timeout),
   2293   1.1     itohy 			    njsc32_reseltimeout, cmd);
   2294   1.1     itohy 		}
   2295   1.1     itohy 
   2296   1.1     itohy 	} else {
   2297   1.1     itohy 		/*
   2298   1.1     itohy 		 * target has come to Bus Free phase
   2299   1.1     itohy 		 * probably to notify an error
   2300   1.1     itohy 		 */
   2301   1.1     itohy 		PRINTC(cmd, ("njsc32_intr: unexpected bus free\n"));
   2302   1.1     itohy 		/* try Request Sense */
   2303   1.1     itohy 		xs->status = SCSI_CHECK;
   2304   1.1     itohy 		njsc32_end_cmd(sc, cmd, XS_BUSY);
   2305   1.1     itohy 	}
   2306   1.1     itohy }
   2307   1.1     itohy 
   2308   1.1     itohy int
   2309   1.2   thorpej njsc32_intr(void *arg)
   2310   1.1     itohy {
   2311   1.1     itohy 	struct njsc32_softc *sc = arg;
   2312   1.1     itohy 	u_int16_t intr;
   2313   1.1     itohy 	u_int8_t arbstat, bus_phase;
   2314   1.1     itohy 	int auto_phase;
   2315   1.1     itohy 	int idbit;
   2316   1.1     itohy 	struct njsc32_cmd *cmd;
   2317   1.1     itohy 
   2318   1.1     itohy 	intr = njsc32_read_2(sc, NJSC32_REG_IRQ);
   2319   1.1     itohy 	if ((intr & NJSC32_IRQ_INTR_PENDING) == 0)
   2320   1.1     itohy 		return 0;	/* not mine */
   2321   1.1     itohy 
   2322   1.1     itohy 	TPRINTF(("%s: njsc32_intr: %#x\n", sc->sc_dev.dv_xname, intr));
   2323   1.1     itohy 
   2324   1.1     itohy #if 0	/* I don't think this is required */
   2325   1.1     itohy 	/* mask interrupts */
   2326   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_IRQ, NJSC32_IRQ_MASK_ALL);
   2327   1.1     itohy #endif
   2328   1.1     itohy 
   2329   1.1     itohy 	/* we got an interrupt, so stop the timer */
   2330   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_TIMER, NJSC32_TIMER_STOP);
   2331   1.1     itohy 
   2332   1.1     itohy 	if (intr & NJSC32_IRQ_SCSIRESET) {
   2333   1.1     itohy 		printf("%s: detected bus reset\n", sc->sc_dev.dv_xname);
   2334   1.1     itohy 		/* clear current request */
   2335   1.1     itohy 		njsc32_reset_detected(sc);
   2336   1.1     itohy 		goto out;
   2337   1.1     itohy 	}
   2338   1.1     itohy 
   2339   1.1     itohy 	if (sc->sc_stat == NJSC32_STAT_ARBIT) {
   2340   1.1     itohy 		cmd = sc->sc_curcmd;
   2341   1.1     itohy 		KASSERT(cmd);
   2342   1.1     itohy 		arbstat = njsc32_read_1(sc, NJSC32_REG_ARBITRATION_STAT);
   2343   1.1     itohy 		if (arbstat & (NJSC32_ARBSTAT_WIN | NJSC32_ARBSTAT_FAIL)) {
   2344   1.1     itohy 			/*
   2345   1.1     itohy 			 * arbitration done
   2346   1.1     itohy 			 */
   2347   1.1     itohy 			/* clear arbitration status */
   2348   1.1     itohy 			njsc32_write_1(sc, NJSC32_REG_SET_ARBITRATION,
   2349   1.1     itohy 			    NJSC32_SETARB_CLEAR);
   2350   1.1     itohy 
   2351   1.1     itohy 			if (arbstat & NJSC32_ARBSTAT_WIN) {
   2352   1.1     itohy 				TPRINTC(cmd,
   2353   1.1     itohy 				    ("njsc32_intr: arbitration won\n"));
   2354   1.1     itohy 
   2355   1.1     itohy 				TAILQ_REMOVE(&sc->sc_reqcmd, cmd, c_q);
   2356   1.1     itohy 
   2357   1.1     itohy 				sc->sc_stat = NJSC32_STAT_CONNECT;
   2358   1.1     itohy 			} else {
   2359   1.1     itohy 				TPRINTC(cmd,
   2360   1.1     itohy 				    ("njsc32_intr: arbitration failed\n"));
   2361   1.1     itohy 
   2362   1.1     itohy 				njsc32_arbitration_failed(sc);
   2363   1.1     itohy 
   2364   1.1     itohy 				/* XXX delay */
   2365   1.1     itohy 				/* XXX retry counter */
   2366   1.1     itohy 			}
   2367   1.1     itohy 		}
   2368   1.1     itohy 	}
   2369   1.1     itohy 
   2370   1.1     itohy 	if (intr & NJSC32_IRQ_TIMER) {
   2371   1.1     itohy 		TPRINTF(("%s: njsc32_intr: timer interrupt\n",
   2372   1.1     itohy 		    sc->sc_dev.dv_xname));
   2373   1.1     itohy 	}
   2374   1.1     itohy 
   2375   1.1     itohy 	if (intr & NJSC32_IRQ_RESELECT) {
   2376   1.1     itohy 		/* Reselection from a target */
   2377   1.1     itohy 		njsc32_arbitration_failed(sc);	/* just in case */
   2378   1.1     itohy 		if ((cmd = sc->sc_curcmd) != NULL) {
   2379   1.1     itohy 			/* ? */
   2380   1.1     itohy 			printf("%s: unexpected reselection\n",
   2381   1.1     itohy 			    sc->sc_dev.dv_xname);
   2382   1.1     itohy 			sc->sc_curcmd = NULL;
   2383   1.1     itohy 			sc->sc_stat = NJSC32_STAT_IDLE;
   2384   1.1     itohy 			njsc32_end_cmd(sc, cmd, XS_DRIVER_STUFFUP);
   2385   1.1     itohy 		}
   2386   1.1     itohy 
   2387   1.1     itohy 		idbit = njsc32_read_1(sc, NJSC32_REG_RESELECT_ID);
   2388   1.1     itohy 		if ((idbit & (1 << NJSC32_INITIATOR_ID)) == 0 ||
   2389   1.1     itohy 		    (sc->sc_reselid = ffs(idbit & ~NJSC32_INITIATOR_ID) -1)
   2390   1.1     itohy 		    < 0) {
   2391   1.1     itohy 			printf("%s: invalid reselection (id: %#x)\n",
   2392   1.1     itohy 			    sc->sc_dev.dv_xname, idbit);
   2393   1.1     itohy 			sc->sc_stat = NJSC32_STAT_IDLE;	/* XXX ? */
   2394   1.1     itohy 		} else {
   2395   1.1     itohy 			sc->sc_stat = NJSC32_STAT_RESEL;
   2396   1.1     itohy 			TPRINTF(("%s: njsc32_intr: reselection from %d\n",
   2397   1.1     itohy 			    sc->sc_dev.dv_xname, sc->sc_reselid));
   2398   1.1     itohy 		}
   2399   1.1     itohy 	}
   2400   1.1     itohy 
   2401   1.1     itohy 	if (intr & NJSC32_IRQ_PHASE_CHANGE) {
   2402   1.1     itohy #if 1	/* XXX probably not needed */
   2403   1.1     itohy 		if (sc->sc_stat == NJSC32_STAT_ARBIT)
   2404   1.1     itohy 			PRINTC(sc->sc_curcmd,
   2405   1.1     itohy 			    ("njsc32_intr: cancel arbitration phase\n"));
   2406   1.1     itohy 		njsc32_arbitration_failed(sc);
   2407   1.1     itohy #endif
   2408   1.1     itohy 		/* current bus phase */
   2409   1.1     itohy 		bus_phase = njsc32_read_1(sc, NJSC32_REG_SCSI_BUS_MONITOR) &
   2410   1.1     itohy 		    NJSC32_BUSMON_PHASE_MASK;
   2411   1.1     itohy 
   2412   1.1     itohy 		switch (bus_phase) {
   2413   1.1     itohy 		case NJSC32_PHASE_MESSAGE_IN:
   2414   1.1     itohy 			njsc32_msgin(sc);
   2415   1.1     itohy 			break;
   2416   1.1     itohy 
   2417   1.1     itohy 		/*
   2418   1.1     itohy 		 * target may suddenly become Status / Bus Free phase
   2419   1.1     itohy 		 * to notify an error condition
   2420   1.1     itohy 		 */
   2421   1.1     itohy 		case NJSC32_PHASE_STATUS:
   2422   1.1     itohy 			printf("%s: unexpected bus phase: Status\n",
   2423   1.1     itohy 			    sc->sc_dev.dv_xname);
   2424   1.1     itohy 			if ((cmd = sc->sc_curcmd) != NULL) {
   2425   1.1     itohy 				cmd->c_xs->status =
   2426   1.1     itohy 				    njsc32_read_1(sc, NJSC32_REG_SCSI_CSB_IN);
   2427   1.1     itohy 				TPRINTC(cmd, ("njsc32_intr: Status %d\n",
   2428   1.1     itohy 				    cmd->c_xs->status));
   2429   1.1     itohy 			}
   2430   1.1     itohy 			break;
   2431   1.1     itohy 		case NJSC32_PHASE_BUSFREE:
   2432   1.1     itohy 			printf("%s: unexpected bus phase: Bus Free\n",
   2433   1.1     itohy 			    sc->sc_dev.dv_xname);
   2434   1.1     itohy 			if ((cmd = sc->sc_curcmd) != NULL) {
   2435   1.1     itohy 				sc->sc_curcmd = NULL;
   2436   1.1     itohy 				sc->sc_stat = NJSC32_STAT_IDLE;
   2437   1.1     itohy 				if (cmd->c_xs->status != SCSI_QUEUE_FULL &&
   2438   1.1     itohy 				    cmd->c_xs->status != SCSI_BUSY)
   2439   1.1     itohy 					cmd->c_xs->status = SCSI_CHECK;/* XXX */
   2440   1.1     itohy 				njsc32_end_cmd(sc, cmd, XS_BUSY);
   2441   1.1     itohy 			}
   2442   1.1     itohy 			goto out;
   2443   1.1     itohy 		default:
   2444   1.1     itohy #ifdef NJSC32_DEBUG
   2445   1.1     itohy 			printf("%s: unexpected bus phase: ",
   2446   1.1     itohy 			    sc->sc_dev.dv_xname);
   2447   1.1     itohy 			switch (bus_phase) {
   2448   1.1     itohy 			case NJSC32_PHASE_COMMAND:
   2449   1.1     itohy 				printf("Command\n");	break;
   2450   1.1     itohy 			case NJSC32_PHASE_MESSAGE_OUT:
   2451   1.1     itohy 				printf("Message Out\n");break;
   2452   1.1     itohy 			case NJSC32_PHASE_DATA_IN:
   2453   1.1     itohy 				printf("Data In\n");	break;
   2454   1.1     itohy 			case NJSC32_PHASE_DATA_OUT:
   2455   1.1     itohy 				printf("Data Out\n");	break;
   2456   1.1     itohy 			case NJSC32_PHASE_RESELECT:
   2457   1.1     itohy 				printf("Reselect\n");break;
   2458   1.1     itohy 			default: printf("%#x\n", bus_phase);	break;
   2459   1.1     itohy 			}
   2460   1.1     itohy #else
   2461   1.1     itohy 			printf("%s: unexpected bus phase: %#x",
   2462   1.1     itohy 			    sc->sc_dev.dv_xname, bus_phase);
   2463   1.1     itohy #endif
   2464   1.1     itohy 			break;
   2465   1.1     itohy 		}
   2466   1.1     itohy 	}
   2467   1.1     itohy 
   2468   1.1     itohy 	if (intr & NJSC32_IRQ_AUTOSCSI) {
   2469   1.1     itohy 		/*
   2470   1.1     itohy 		 * AutoSCSI interrupt
   2471   1.1     itohy 		 */
   2472   1.1     itohy 		auto_phase = njsc32_read_2(sc, NJSC32_REG_EXECUTE_PHASE);
   2473   1.1     itohy 		TPRINTF(("%s: njsc32_intr: AutoSCSI: %#x\n",
   2474   1.1     itohy 		    sc->sc_dev.dv_xname, auto_phase));
   2475   1.1     itohy 		njsc32_write_2(sc, NJSC32_REG_EXECUTE_PHASE, 0);
   2476   1.1     itohy 
   2477   1.1     itohy 		if (auto_phase & NJSC32_XPHASE_SEL_TIMEOUT) {
   2478   1.1     itohy 			cmd = sc->sc_curcmd;
   2479   1.1     itohy 			if (cmd == NULL) {
   2480   1.1     itohy 				printf("%s: sel no cmd\n",
   2481   1.1     itohy 				    sc->sc_dev.dv_xname);
   2482   1.1     itohy 				goto out;
   2483   1.1     itohy 			}
   2484   1.1     itohy 			DPRINTC(cmd, ("njsc32_intr: selection timeout\n"));
   2485   1.1     itohy 
   2486   1.1     itohy 			sc->sc_curcmd = NULL;
   2487   1.1     itohy 			sc->sc_stat = NJSC32_STAT_IDLE;
   2488   1.1     itohy 			njsc32_end_cmd(sc, cmd, XS_SELTIMEOUT);
   2489   1.1     itohy 
   2490   1.1     itohy 			goto out;
   2491   1.1     itohy 		}
   2492   1.1     itohy 
   2493   1.1     itohy #ifdef NJSC32_TRACE
   2494   1.1     itohy 		if (auto_phase & NJSC32_XPHASE_COMMAND) {
   2495   1.1     itohy 			/* Command phase has been automatically processed */
   2496   1.1     itohy 			TPRINTF(("%s: njsc32_intr: Command\n",
   2497   1.1     itohy 			    sc->sc_dev.dv_xname));
   2498   1.1     itohy 		}
   2499   1.1     itohy #endif
   2500   1.1     itohy #ifdef NJSC32_DEBUG
   2501   1.1     itohy 		if (auto_phase & NJSC32_XPHASE_ILLEGAL) {
   2502   1.1     itohy 			printf("%s: njsc32_intr: Illegal phase\n",
   2503   1.1     itohy 			    sc->sc_dev.dv_xname);
   2504   1.1     itohy 		}
   2505   1.1     itohy #endif
   2506   1.1     itohy 
   2507   1.1     itohy 		if (auto_phase & NJSC32_XPHASE_PAUSED_MSG_IN) {
   2508   1.1     itohy 			TPRINTF(("%s: njsc32_intr: Process Message In\n",
   2509   1.1     itohy 			    sc->sc_dev.dv_xname));
   2510   1.1     itohy 			njsc32_msgin(sc);
   2511   1.1     itohy 		}
   2512   1.1     itohy 
   2513   1.1     itohy 		if (auto_phase & NJSC32_XPHASE_PAUSED_MSG_OUT) {
   2514   1.1     itohy 			TPRINTF(("%s: njsc32_intr: Process Message Out\n",
   2515   1.1     itohy 			    sc->sc_dev.dv_xname));
   2516   1.1     itohy 			njsc32_msgout(sc);
   2517   1.1     itohy 		}
   2518   1.1     itohy 
   2519   1.1     itohy 		cmd = sc->sc_curcmd;
   2520   1.1     itohy 		if (cmd == NULL) {
   2521   1.1     itohy 			TPRINTF(("%s: njsc32_intr: no cmd\n",
   2522   1.1     itohy 			    sc->sc_dev.dv_xname));
   2523   1.1     itohy 			goto out;
   2524   1.1     itohy 		}
   2525   1.1     itohy 
   2526   1.1     itohy 		if (auto_phase &
   2527   1.1     itohy 		    (NJSC32_XPHASE_DATA_IN | NJSC32_XPHASE_DATA_OUT)) {
   2528   1.6     itohy 			u_int32_t sackcnt, cntoffset;
   2529   1.6     itohy 
   2530   1.1     itohy #ifdef NJSC32_TRACE
   2531   1.1     itohy 			if (auto_phase & NJSC32_XPHASE_DATA_IN)
   2532   1.1     itohy 				PRINTC(cmd, ("njsc32_intr: data in done\n"));
   2533   1.1     itohy 			if (auto_phase & NJSC32_XPHASE_DATA_OUT)
   2534   1.1     itohy 				PRINTC(cmd, ("njsc32_intr: data out done\n"));
   2535   1.1     itohy 			printf("BM %u, SGT %u, SACK %u, SAVED_ACK %u\n",
   2536   1.1     itohy 				njsc32_read_4(sc, NJSC32_REG_BM_CNT),
   2537   1.1     itohy 				njsc32_read_4(sc, NJSC32_REG_SGT_ADR),
   2538   1.1     itohy 				njsc32_read_4(sc, NJSC32_REG_SACK_CNT),
   2539   1.1     itohy 				njsc32_read_4(sc, NJSC32_REG_SAVED_ACK_CNT));
   2540   1.1     itohy #endif
   2541   1.1     itohy 
   2542   1.1     itohy 			/*
   2543   1.1     itohy 			 * detected parity error on data transfer?
   2544   1.1     itohy 			 */
   2545   1.1     itohy 			if (njsc32_read_1(sc, NJSC32_REG_PARITY_STATUS) &
   2546   1.1     itohy 			    (NJSC32_PARITYSTATUS_ERROR_LSB|
   2547   1.1     itohy 			     NJSC32_PARITYSTATUS_ERROR_MSB)) {
   2548   1.1     itohy 
   2549   1.1     itohy 				PRINTC(cmd, ("datain: parity error\n"));
   2550   1.1     itohy 
   2551   1.1     itohy 				/* clear parity error */
   2552   1.1     itohy 				njsc32_write_1(sc, NJSC32_REG_PARITY_CONTROL,
   2553   1.1     itohy 				    NJSC32_PARITYCTL_CHECK_ENABLE |
   2554   1.1     itohy 				    NJSC32_PARITYCTL_CLEAR_ERROR);
   2555   1.1     itohy 
   2556   1.1     itohy 				if (auto_phase & NJSC32_XPHASE_BUS_FREE) {
   2557   1.1     itohy 					/*
   2558   1.1     itohy 					 * XXX command has already finished
   2559   1.1     itohy 					 * -- what can we do?
   2560   1.1     itohy 					 *
   2561   1.1     itohy 					 * It is not clear current command
   2562   1.1     itohy 					 * caused the error -- reset everything.
   2563   1.1     itohy 					 */
   2564   1.1     itohy 					njsc32_init(sc, 1);	/* XXX */
   2565   1.1     itohy 				} else {
   2566   1.1     itohy 					/* XXX does this case occur? */
   2567   1.1     itohy #if 1
   2568   1.1     itohy 					printf("%s: datain: parity error\n",
   2569   1.1     itohy 					    sc->sc_dev.dv_xname);
   2570   1.1     itohy #endif
   2571   1.1     itohy 					/*
   2572   1.1     itohy 					 * Make attention condition and try
   2573   1.1     itohy 					 * to send Initiator Detected Error
   2574   1.1     itohy 					 * message.
   2575   1.1     itohy 					 */
   2576   1.1     itohy 					njsc32_init_msgout(sc);
   2577   1.1     itohy 					njsc32_add_msgout(sc,
   2578   1.1     itohy 					    MSG_INITIATOR_DET_ERR);
   2579   1.1     itohy 					njsc32_write_4(sc,
   2580   1.1     itohy 					    NJSC32_REG_SCSI_MSG_OUT,
   2581   1.1     itohy 					    njsc32_get_auto_msgout(sc));
   2582   1.1     itohy 					/* restart autoscsi with ATN */
   2583   1.1     itohy 					njsc32_write_2(sc,
   2584   1.1     itohy 					    NJSC32_REG_COMMAND_CONTROL,
   2585   1.1     itohy 					    NJSC32_CMD_CLEAR_CDB_FIFO_PTR |
   2586   1.1     itohy 					    NJSC32_CMD_AUTO_COMMAND_PHASE |
   2587   1.1     itohy 					    NJSC32_CMD_AUTO_SCSI_RESTART |
   2588   1.1     itohy 					    NJSC32_CMD_AUTO_MSGIN_00_04 |
   2589   1.1     itohy 					    NJSC32_CMD_AUTO_MSGIN_02 |
   2590   1.1     itohy 					    NJSC32_CMD_AUTO_ATN);
   2591   1.1     itohy 				}
   2592   1.1     itohy 				goto out;
   2593   1.1     itohy 			}
   2594   1.1     itohy 
   2595   1.1     itohy 			/*
   2596   1.1     itohy 			 * data has been transferred, and current pointer
   2597   1.1     itohy 			 * is changed
   2598   1.1     itohy 			 */
   2599   1.6     itohy 			sackcnt = njsc32_read_4(sc, NJSC32_REG_SACK_CNT);
   2600   1.6     itohy 
   2601   1.6     itohy 			/*
   2602   1.6     itohy 			 * The controller returns extra ACK count
   2603   1.6     itohy 			 * if the DMA buffer is not 4byte aligned.
   2604   1.6     itohy 			 */
   2605   1.6     itohy 			cntoffset = le32toh(cmd->c_sgt[0].sg_addr) & 3;
   2606   1.6     itohy #ifdef NJSC32_DEBUG
   2607   1.6     itohy 			if (cntoffset != 0) {
   2608   1.6     itohy 				printf("sackcnt %u, cntoffset %u\n",
   2609   1.6     itohy 				    sackcnt, cntoffset);
   2610   1.6     itohy 			}
   2611   1.6     itohy #endif
   2612   1.6     itohy 			/* advance SCSI pointer */
   2613   1.6     itohy 			njsc32_set_cur_ptr(cmd,
   2614   1.6     itohy 			    cmd->c_dp_cur + sackcnt - cntoffset);
   2615   1.1     itohy 		}
   2616   1.1     itohy 
   2617   1.1     itohy 		if (auto_phase & NJSC32_XPHASE_MSGOUT) {
   2618   1.1     itohy 			/* Message Out phase has been automatically processed */
   2619   1.1     itohy 			TPRINTC(cmd, ("njsc32_intr: Message Out\n"));
   2620   1.1     itohy 			if ((auto_phase & NJSC32_XPHASE_PAUSED_MSG_IN) == 0 &&
   2621   1.1     itohy 			    sc->sc_msgoutlen <= NJSC32_MSGOUT_MAX_AUTO) {
   2622   1.1     itohy 				njsc32_init_msgout(sc);
   2623   1.1     itohy 			}
   2624   1.1     itohy 		}
   2625   1.1     itohy 
   2626   1.1     itohy 		if (auto_phase & NJSC32_XPHASE_STATUS) {
   2627   1.1     itohy 			/* Status phase has been automatically processed */
   2628   1.1     itohy 			cmd->c_xs->status =
   2629   1.1     itohy 			    njsc32_read_1(sc, NJSC32_REG_SCSI_CSB_IN);
   2630   1.1     itohy 			TPRINTC(cmd, ("njsc32_intr: Status %#x\n",
   2631   1.1     itohy 			    cmd->c_xs->status));
   2632   1.1     itohy 		}
   2633   1.1     itohy 
   2634   1.1     itohy 		if (auto_phase & NJSC32_XPHASE_BUS_FREE) {
   2635   1.1     itohy 			/* AutoSCSI is finished */
   2636   1.1     itohy 
   2637   1.1     itohy 			TPRINTC(cmd, ("njsc32_intr: Bus Free\n"));
   2638   1.1     itohy 
   2639   1.1     itohy 			sc->sc_stat = NJSC32_STAT_IDLE;
   2640   1.1     itohy 			sc->sc_curcmd = NULL;
   2641   1.1     itohy 
   2642   1.1     itohy 			njsc32_end_auto(sc, cmd, auto_phase);
   2643   1.1     itohy 		}
   2644   1.1     itohy 		goto out;
   2645   1.1     itohy 	}
   2646   1.1     itohy 
   2647   1.1     itohy 	if (intr & NJSC32_IRQ_FIFO_THRESHOLD) {
   2648   1.1     itohy 		/* XXX We use DMA, and this shouldn't happen */
   2649   1.1     itohy 		printf("%s: njsc32_intr: FIFO\n", sc->sc_dev.dv_xname);
   2650   1.1     itohy 		njsc32_init(sc, 1);
   2651   1.1     itohy 		goto out;
   2652   1.1     itohy 	}
   2653   1.1     itohy 	if (intr & NJSC32_IRQ_PCI) {
   2654   1.1     itohy 		/* XXX? */
   2655   1.1     itohy 		printf("%s: njsc32_intr: PCI\n", sc->sc_dev.dv_xname);
   2656   1.1     itohy 	}
   2657   1.1     itohy 	if (intr & NJSC32_IRQ_BMCNTERR) {
   2658   1.1     itohy 		/* XXX? */
   2659   1.1     itohy 		printf("%s: njsc32_intr: BM\n", sc->sc_dev.dv_xname);
   2660   1.1     itohy 	}
   2661   1.1     itohy 
   2662   1.1     itohy out:
   2663   1.1     itohy 	/* go next command if controller is idle */
   2664   1.1     itohy 	if (sc->sc_stat == NJSC32_STAT_IDLE)
   2665   1.1     itohy 		njsc32_start(sc);
   2666   1.1     itohy 
   2667   1.1     itohy #if 0
   2668   1.1     itohy 	/* enable interrupts */
   2669   1.1     itohy 	njsc32_write_2(sc, NJSC32_REG_IRQ, 0);
   2670   1.1     itohy #endif
   2671   1.1     itohy 
   2672   1.1     itohy 	return 1;	/* processed */
   2673   1.1     itohy }
   2674