Home | History | Annotate | Line # | Download | only in ic
aic7xxx.c revision 1.100
      1  1.100      fvdl /*	$NetBSD: aic7xxx.c,v 1.100 2003/04/21 18:12:22 fvdl Exp $	*/
      2  1.100      fvdl 
      3    1.1   mycroft /*
      4   1.96      fvdl  * Core routines and tables shareable across OS platforms.
      5    1.1   mycroft  *
      6   1.96      fvdl  * Copyright (c) 1994-2002 Justin T. Gibbs.
      7   1.96      fvdl  * Copyright (c) 2000-2002 Adaptec Inc.
      8    1.6   mycroft  * All rights reserved.
      9    1.1   mycroft  *
     10    1.6   mycroft  * Redistribution and use in source and binary forms, with or without
     11    1.6   mycroft  * modification, are permitted provided that the following conditions
     12    1.6   mycroft  * are met:
     13    1.6   mycroft  * 1. Redistributions of source code must retain the above copyright
     14   1.42      fvdl  *    notice, this list of conditions, and the following disclaimer,
     15   1.42      fvdl  *    without modification.
     16   1.96      fvdl  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
     17   1.96      fvdl  *    substantially similar to the "NO WARRANTY" disclaimer below
     18   1.96      fvdl  *    ("Disclaimer") and any redistribution must be conditioned upon
     19   1.96      fvdl  *    including a substantially similar Disclaimer requirement for further
     20   1.96      fvdl  *    binary redistribution.
     21   1.96      fvdl  * 3. Neither the names of the above-listed copyright holders nor the names
     22   1.96      fvdl  *    of any contributors may be used to endorse or promote products derived
     23   1.96      fvdl  *    from this software without specific prior written permission.
     24    1.1   mycroft  *
     25   1.42      fvdl  * Alternatively, this software may be distributed under the terms of the
     26   1.96      fvdl  * GNU General Public License ("GPL") version 2 as published by the Free
     27   1.96      fvdl  * Software Foundation.
     28   1.42      fvdl  *
     29   1.96      fvdl  * NO WARRANTY
     30   1.96      fvdl  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
     31   1.96      fvdl  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
     32   1.96      fvdl  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
     33   1.96      fvdl  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
     34   1.96      fvdl  * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     35    1.6   mycroft  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     36    1.6   mycroft  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     37   1.96      fvdl  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     38   1.96      fvdl  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
     39   1.96      fvdl  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     40   1.96      fvdl  * POSSIBILITY OF SUCH DAMAGES.
     41   1.96      fvdl  *
     42  1.100      fvdl  * $Id: aic7xxx.c,v 1.100 2003/04/21 18:12:22 fvdl Exp $
     43    1.9  explorer  *
     44   1.96      fvdl  * //depot/aic7xxx/aic7xxx/aic7xxx.c#112 $
     45   1.96      fvdl  *
     46   1.96      fvdl  * $FreeBSD: /repoman/r/ncvs/src/sys/dev/aic7xxx/aic7xxx.c,v 1.88 2003/01/20 20:44:55 gibbs Exp $
     47    1.1   mycroft  */
     48    1.1   mycroft /*
     49   1.96      fvdl  * Ported from FreeBSD by Pascal Renauld, Network Storage Solutions, Inc. - April 2003
     50    1.1   mycroft  */
     51   1.83     lukem 
     52   1.96      fvdl #include <dev/ic/aic7xxx_osm.h>
     53   1.96      fvdl #include <dev/ic/aic7xxx_inline.h>
     54   1.96      fvdl #include <dev/ic/aic7xxx_cam.h>
     55    1.1   mycroft 
     56   1.96      fvdl /****************************** Softc Data ************************************/
     57   1.96      fvdl struct ahc_softc_tailq ahc_tailq = TAILQ_HEAD_INITIALIZER(ahc_tailq);
     58   1.42      fvdl 
     59   1.96      fvdl /***************************** Lookup Tables **********************************/
     60   1.96      fvdl char *ahc_chip_names[] =
     61   1.42      fvdl {
     62   1.42      fvdl 	"NONE",
     63   1.42      fvdl 	"aic7770",
     64   1.42      fvdl 	"aic7850",
     65   1.42      fvdl 	"aic7855",
     66   1.42      fvdl 	"aic7859",
     67   1.42      fvdl 	"aic7860",
     68   1.42      fvdl 	"aic7870",
     69   1.42      fvdl 	"aic7880",
     70   1.96      fvdl 	"aic7895",
     71   1.96      fvdl 	"aic7895C",
     72   1.42      fvdl 	"aic7890/91",
     73   1.96      fvdl 	"aic7896/97",
     74   1.42      fvdl 	"aic7892",
     75   1.42      fvdl 	"aic7899"
     76   1.42      fvdl };
     77   1.96      fvdl static const u_int num_chip_names = NUM_ELEMENTS(ahc_chip_names);
     78    1.1   mycroft 
     79   1.96      fvdl /*
     80   1.96      fvdl  * Hardware error codes.
     81   1.96      fvdl  */
     82   1.96      fvdl struct ahc_hard_error_entry {
     83   1.96      fvdl         uint8_t errno;
     84   1.96      fvdl 	char *errmesg;
     85   1.42      fvdl };
     86   1.28       leo 
     87   1.96      fvdl static struct ahc_hard_error_entry ahc_hard_errors[] = {
     88   1.96      fvdl 	{ ILLHADDR,	"Illegal Host Access" },
     89   1.96      fvdl 	{ ILLSADDR,	"Illegal Sequencer Address referrenced" },
     90   1.96      fvdl 	{ ILLOPCODE,	"Illegal Opcode in sequencer program" },
     91   1.96      fvdl 	{ SQPARERR,	"Sequencer Parity Error" },
     92   1.96      fvdl 	{ DPARERR,	"Data-path Parity Error" },
     93   1.96      fvdl 	{ MPARERR,	"Scratch or SCB Memory Parity Error" },
     94   1.96      fvdl 	{ PCIERRSTAT,	"PCI Error detected" },
     95   1.96      fvdl 	{ CIOPARERR,	"CIOBUS Parity Error" },
     96   1.96      fvdl };
     97   1.96      fvdl static const u_int num_errors = NUM_ELEMENTS(ahc_hard_errors);
     98    1.1   mycroft 
     99   1.96      fvdl static struct ahc_phase_table_entry ahc_phase_table[] =
    100   1.42      fvdl {
    101   1.96      fvdl 	{ P_DATAOUT,	MSG_NOOP,		"in Data-out phase"	},
    102   1.96      fvdl 	{ P_DATAIN,	MSG_INITIATOR_DET_ERR,	"in Data-in phase"	},
    103   1.96      fvdl 	{ P_DATAOUT_DT,	MSG_NOOP,		"in DT Data-out phase"	},
    104   1.96      fvdl 	{ P_DATAIN_DT,	MSG_INITIATOR_DET_ERR,	"in DT Data-in phase"	},
    105   1.96      fvdl 	{ P_COMMAND,	MSG_NOOP,		"in Command phase"	},
    106   1.96      fvdl 	{ P_MESGOUT,	MSG_NOOP,		"in Message-out phase"	},
    107   1.96      fvdl 	{ P_STATUS,	MSG_INITIATOR_DET_ERR,	"in Status phase"	},
    108   1.96      fvdl 	{ P_MESGIN,	MSG_PARITY_ERROR,	"in Message-in phase"	},
    109   1.96      fvdl 	{ P_BUSFREE,	MSG_NOOP,		"while idle"		},
    110   1.96      fvdl 	{ 0,		MSG_NOOP,		"in unknown phase"	}
    111   1.96      fvdl };
    112    1.1   mycroft 
    113    1.1   mycroft /*
    114   1.96      fvdl  * In most cases we only wish to itterate over real phases, so
    115   1.96      fvdl  * exclude the last element from the count.
    116    1.1   mycroft  */
    117   1.96      fvdl static const u_int num_phases = NUM_ELEMENTS(ahc_phase_table) - 1;
    118    1.1   mycroft 
    119   1.96      fvdl /*
    120   1.96      fvdl  * Valid SCSIRATE values.  (p. 3-17)
    121   1.96      fvdl  * Provides a mapping of tranfer periods in ns to the proper value to
    122   1.96      fvdl  * stick in the scsixfer reg.
    123   1.96      fvdl  */
    124   1.96      fvdl static struct ahc_syncrate ahc_syncrates[] =
    125   1.42      fvdl {
    126   1.96      fvdl       /* ultra2    fast/ultra  period     rate */
    127   1.96      fvdl 	{ 0x42,      0x000,      9,      "80.0" },
    128   1.96      fvdl 	{ 0x03,      0x000,     10,      "40.0" },
    129   1.96      fvdl 	{ 0x04,      0x000,     11,      "33.0" },
    130   1.96      fvdl 	{ 0x05,      0x100,     12,      "20.0" },
    131   1.96      fvdl 	{ 0x06,      0x110,     15,      "16.0" },
    132   1.96      fvdl 	{ 0x07,      0x120,     18,      "13.4" },
    133   1.96      fvdl 	{ 0x08,      0x000,     25,      "10.0" },
    134   1.96      fvdl 	{ 0x19,      0x010,     31,      "8.0"  },
    135   1.96      fvdl 	{ 0x1a,      0x020,     37,      "6.67" },
    136   1.96      fvdl 	{ 0x1b,      0x030,     43,      "5.7"  },
    137   1.96      fvdl 	{ 0x1c,      0x040,     50,      "5.0"  },
    138   1.96      fvdl 	{ 0x00,      0x050,     56,      "4.4"  },
    139   1.96      fvdl 	{ 0x00,      0x060,     62,      "4.0"  },
    140   1.96      fvdl 	{ 0x00,      0x070,     68,      "3.6"  },
    141   1.96      fvdl 	{ 0x00,      0x000,      0,      NULL   }
    142   1.96      fvdl };
    143    1.1   mycroft 
    144   1.96      fvdl /* Our Sequencer Program */
    145   1.96      fvdl #include <dev/microcode/aic7xxx/aic7xxx_seq.h>
    146    1.1   mycroft 
    147   1.96      fvdl /**************************** Function Declarations ***************************/
    148   1.96      fvdl static void		ahc_force_renegotiation(struct ahc_softc *ahc);
    149   1.96      fvdl static struct ahc_tmode_tstate*
    150   1.96      fvdl 			ahc_alloc_tstate(struct ahc_softc *ahc,
    151   1.96      fvdl 					 u_int scsi_id, char channel);
    152   1.96      fvdl #ifdef AHC_TARGET_MODE
    153   1.96      fvdl static void		ahc_free_tstate(struct ahc_softc *ahc,
    154   1.96      fvdl 					u_int scsi_id, char channel, int force);
    155   1.96      fvdl #endif
    156   1.96      fvdl static struct ahc_syncrate*
    157   1.96      fvdl 			ahc_devlimited_syncrate(struct ahc_softc *ahc,
    158   1.96      fvdl 					        struct ahc_initiator_tinfo *,
    159   1.96      fvdl 						u_int *period,
    160   1.96      fvdl 						u_int *ppr_options,
    161   1.96      fvdl 						role_t role);
    162   1.96      fvdl static void		ahc_update_pending_scbs(struct ahc_softc *ahc);
    163   1.96      fvdl static void		ahc_fetch_devinfo(struct ahc_softc *ahc,
    164   1.96      fvdl 					  struct ahc_devinfo *devinfo);
    165   1.96      fvdl static void		ahc_scb_devinfo(struct ahc_softc *ahc,
    166   1.96      fvdl 					struct ahc_devinfo *devinfo,
    167   1.96      fvdl 					struct scb *scb);
    168   1.96      fvdl static void		ahc_assert_atn(struct ahc_softc *ahc);
    169   1.96      fvdl static void		ahc_setup_initiator_msgout(struct ahc_softc *ahc,
    170   1.96      fvdl 						   struct ahc_devinfo *devinfo,
    171   1.96      fvdl 						   struct scb *scb);
    172   1.96      fvdl static void		ahc_build_transfer_msg(struct ahc_softc *ahc,
    173   1.96      fvdl 					       struct ahc_devinfo *devinfo);
    174   1.96      fvdl static void		ahc_construct_sdtr(struct ahc_softc *ahc,
    175   1.96      fvdl 					   struct ahc_devinfo *devinfo,
    176   1.96      fvdl 					   u_int period, u_int offset);
    177   1.96      fvdl static void		ahc_construct_wdtr(struct ahc_softc *ahc,
    178   1.96      fvdl 					   struct ahc_devinfo *devinfo,
    179   1.96      fvdl 					   u_int bus_width);
    180   1.96      fvdl static void		ahc_construct_ppr(struct ahc_softc *ahc,
    181   1.96      fvdl 					  struct ahc_devinfo *devinfo,
    182   1.96      fvdl 					  u_int period, u_int offset,
    183   1.96      fvdl 					  u_int bus_width, u_int ppr_options);
    184   1.96      fvdl static void		ahc_clear_msg_state(struct ahc_softc *ahc);
    185   1.96      fvdl static void		ahc_handle_proto_violation(struct ahc_softc *ahc);
    186   1.96      fvdl static void		ahc_handle_message_phase(struct ahc_softc *ahc);
    187   1.96      fvdl typedef enum {
    188   1.96      fvdl 	AHCMSG_1B,
    189   1.96      fvdl 	AHCMSG_2B,
    190   1.96      fvdl 	AHCMSG_EXT
    191   1.96      fvdl } ahc_msgtype;
    192   1.96      fvdl static int		ahc_sent_msg(struct ahc_softc *ahc, ahc_msgtype type,
    193   1.96      fvdl 				     u_int msgval, int full);
    194   1.96      fvdl static int		ahc_parse_msg(struct ahc_softc *ahc,
    195   1.96      fvdl 				      struct ahc_devinfo *devinfo);
    196   1.96      fvdl static int		ahc_handle_msg_reject(struct ahc_softc *ahc,
    197   1.96      fvdl 					      struct ahc_devinfo *devinfo);
    198   1.96      fvdl static void		ahc_handle_ign_wide_residue(struct ahc_softc *ahc,
    199   1.96      fvdl 						struct ahc_devinfo *devinfo);
    200   1.96      fvdl static void		ahc_reinitialize_dataptrs(struct ahc_softc *ahc);
    201   1.96      fvdl static void		ahc_handle_devreset(struct ahc_softc *ahc,
    202   1.96      fvdl 					    struct ahc_devinfo *devinfo,
    203   1.96      fvdl 					    cam_status status, char *message,
    204   1.96      fvdl 					    int verbose_level);
    205   1.96      fvdl #if AHC_TARGET_MODE
    206   1.96      fvdl static void		ahc_setup_target_msgin(struct ahc_softc *ahc,
    207   1.96      fvdl 					       struct ahc_devinfo *devinfo,
    208   1.96      fvdl 					       struct scb *scb);
    209   1.96      fvdl #endif
    210   1.96      fvdl 
    211   1.96      fvdl //static bus_dmamap_callback_t	ahc_dmamap_cb;
    212   1.96      fvdl static void			ahc_build_free_scb_list(struct ahc_softc *ahc);
    213   1.96      fvdl static int			ahc_init_scbdata(struct ahc_softc *ahc);
    214   1.96      fvdl static void			ahc_fini_scbdata(struct ahc_softc *ahc);
    215   1.96      fvdl static void		ahc_qinfifo_requeue(struct ahc_softc *ahc,
    216   1.96      fvdl 					    struct scb *prev_scb,
    217   1.96      fvdl 					    struct scb *scb);
    218   1.96      fvdl static int		ahc_qinfifo_count(struct ahc_softc *ahc);
    219   1.96      fvdl static u_int		ahc_rem_scb_from_disc_list(struct ahc_softc *ahc,
    220   1.96      fvdl 						   u_int prev, u_int scbptr);
    221   1.96      fvdl static void		ahc_add_curscb_to_free_list(struct ahc_softc *ahc);
    222   1.96      fvdl static u_int		ahc_rem_wscb(struct ahc_softc *ahc,
    223   1.96      fvdl 				     u_int scbpos, u_int prev);
    224   1.96      fvdl static void		ahc_reset_current_bus(struct ahc_softc *ahc);
    225   1.96      fvdl #ifdef AHC_DUMP_SEQ
    226   1.96      fvdl static void		ahc_dumpseq(struct ahc_softc *ahc);
    227   1.96      fvdl #endif
    228   1.96      fvdl static void		ahc_loadseq(struct ahc_softc *ahc);
    229   1.96      fvdl static int		ahc_check_patch(struct ahc_softc *ahc,
    230   1.96      fvdl 					struct patch **start_patch,
    231   1.96      fvdl 					u_int start_instr, u_int *skip_addr);
    232   1.96      fvdl static void		ahc_download_instr(struct ahc_softc *ahc,
    233   1.96      fvdl 					   u_int instrptr, uint8_t *dconsts);
    234   1.96      fvdl #ifdef AHC_TARGET_MODE
    235   1.96      fvdl static void		ahc_queue_lstate_event(struct ahc_softc *ahc,
    236   1.96      fvdl 					       struct ahc_tmode_lstate *lstate,
    237   1.96      fvdl 					       u_int initiator_id,
    238   1.96      fvdl 					       u_int event_type,
    239   1.96      fvdl 					       u_int event_arg);
    240   1.96      fvdl static void		ahc_update_scsiid(struct ahc_softc *ahc,
    241   1.96      fvdl 					  u_int targid_mask);
    242   1.96      fvdl static int		ahc_handle_target_cmd(struct ahc_softc *ahc,
    243   1.96      fvdl 					      struct target_cmd *cmd);
    244   1.96      fvdl #endif
    245   1.96      fvdl 
    246   1.96      fvdl /************************** Added for porting to NetBSD ***********************/
    247   1.96      fvdl static int ahc_createdmamem(bus_dma_tag_t tag,
    248   1.96      fvdl 			    int size,
    249   1.96      fvdl 			    int flags,
    250   1.96      fvdl 			    bus_dmamap_t *mapp,
    251   1.96      fvdl 			    caddr_t *vaddr,
    252   1.96      fvdl 			    bus_addr_t *baddr,
    253   1.96      fvdl 			    bus_dma_segment_t *seg,
    254   1.96      fvdl 			    int *nseg,
    255   1.96      fvdl 			    const char *myname, const char *what);
    256   1.96      fvdl static void ahc_freedmamem(bus_dma_tag_t tag,
    257   1.96      fvdl 			   int size,
    258   1.96      fvdl 			   bus_dmamap_t map,
    259   1.96      fvdl 			   caddr_t vaddr,
    260   1.96      fvdl 			   bus_dma_segment_t *seg,
    261   1.96      fvdl 			   int nseg);
    262    1.1   mycroft 
    263   1.96      fvdl /************************* Sequencer Execution Control ************************/
    264    1.1   mycroft /*
    265   1.42      fvdl  * Restart the sequencer program from address zero
    266    1.1   mycroft  */
    267   1.96      fvdl void
    268   1.96      fvdl ahc_restart(struct ahc_softc *ahc)
    269   1.42      fvdl {
    270    1.1   mycroft 
    271   1.96      fvdl 	ahc_pause(ahc);
    272   1.96      fvdl 
    273   1.96      fvdl 	/* No more pending messages. */
    274   1.96      fvdl 	ahc_clear_msg_state(ahc);
    275   1.96      fvdl 
    276   1.96      fvdl 	ahc_outb(ahc, SCSISIGO, 0);		/* De-assert BSY */
    277   1.96      fvdl 	ahc_outb(ahc, MSG_OUT, MSG_NOOP);	/* No message to send */
    278   1.96      fvdl 	ahc_outb(ahc, SXFRCTL1, ahc_inb(ahc, SXFRCTL1) & ~BITBUCKET);
    279   1.96      fvdl 	ahc_outb(ahc, LASTPHASE, P_BUSFREE);
    280   1.96      fvdl 	ahc_outb(ahc, SAVED_SCSIID, 0xFF);
    281   1.96      fvdl 	ahc_outb(ahc, SAVED_LUN, 0xFF);
    282    1.1   mycroft 
    283    1.6   mycroft 	/*
    284   1.96      fvdl 	 * Ensure that the sequencer's idea of TQINPOS
    285   1.96      fvdl 	 * matches our own.  The sequencer increments TQINPOS
    286   1.96      fvdl 	 * only after it sees a DMA complete and a reset could
    287   1.96      fvdl 	 * occur before the increment leaving the kernel to believe
    288   1.96      fvdl 	 * the command arrived but the sequencer to not.
    289    1.6   mycroft 	 */
    290   1.96      fvdl 	ahc_outb(ahc, TQINPOS, ahc->tqinfifonext);
    291    1.1   mycroft 
    292   1.96      fvdl 	/* Always allow reselection */
    293   1.96      fvdl 	ahc_outb(ahc, SCSISEQ,
    294   1.96      fvdl 		 ahc_inb(ahc, SCSISEQ_TEMPLATE) & (ENSELI|ENRSELI|ENAUTOATNP));
    295   1.96      fvdl 	if ((ahc->features & AHC_CMD_CHAN) != 0) {
    296   1.96      fvdl 		/* Ensure that no DMA operations are in progress */
    297   1.96      fvdl 		ahc_outb(ahc, CCSCBCNT, 0);
    298   1.96      fvdl 		ahc_outb(ahc, CCSGCTL, 0);
    299   1.96      fvdl 		ahc_outb(ahc, CCSCBCTL, 0);
    300   1.14     gibbs 	}
    301   1.18   thorpej 	/*
    302   1.96      fvdl 	 * If we were in the process of DMA'ing SCB data into
    303   1.96      fvdl 	 * an SCB, replace that SCB on the free list.  This prevents
    304   1.96      fvdl 	 * an SCB leak.
    305   1.18   thorpej 	 */
    306   1.96      fvdl 	if ((ahc_inb(ahc, SEQ_FLAGS2) & SCB_DMA) != 0) {
    307   1.96      fvdl 		ahc_add_curscb_to_free_list(ahc);
    308   1.96      fvdl 		ahc_outb(ahc, SEQ_FLAGS2,
    309   1.96      fvdl 			 ahc_inb(ahc, SEQ_FLAGS2) & ~SCB_DMA);
    310   1.96      fvdl 	}
    311   1.96      fvdl 	ahc_outb(ahc, MWI_RESIDUAL, 0);
    312   1.96      fvdl 	ahc_outb(ahc, SEQCTL, FASTMODE);
    313   1.96      fvdl 	ahc_outb(ahc, SEQADDR0, 0);
    314   1.96      fvdl 	ahc_outb(ahc, SEQADDR1, 0);
    315   1.96      fvdl 	ahc_unpause(ahc);
    316   1.42      fvdl }
    317   1.18   thorpej 
    318   1.96      fvdl /************************* Input/Output Queues ********************************/
    319   1.96      fvdl void
    320   1.42      fvdl ahc_run_qoutfifo(struct ahc_softc *ahc)
    321   1.42      fvdl {
    322   1.42      fvdl 	struct scb *scb;
    323   1.42      fvdl 	u_int  scb_index;
    324   1.32   thorpej 
    325   1.96      fvdl 	ahc_sync_qoutfifo(ahc, BUS_DMASYNC_POSTREAD);
    326   1.96      fvdl 	while (ahc->qoutfifo[ahc->qoutfifonext] != SCB_LIST_NULL) {
    327   1.32   thorpej 
    328   1.42      fvdl 		scb_index = ahc->qoutfifo[ahc->qoutfifonext];
    329   1.96      fvdl 		if ((ahc->qoutfifonext & 0x03) == 0x03) {
    330   1.96      fvdl 			u_int modnext;
    331   1.96      fvdl 
    332   1.96      fvdl 			/*
    333   1.96      fvdl 			 * Clear 32bits of QOUTFIFO at a time
    334   1.96      fvdl 			 * so that we don't clobber an incoming
    335   1.96      fvdl 			 * byte DMA to the array on architectures
    336   1.96      fvdl 			 * that only support 32bit load and store
    337   1.96      fvdl 			 * operations.
    338   1.96      fvdl 			 */
    339   1.96      fvdl 			modnext = ahc->qoutfifonext & ~0x3;
    340   1.96      fvdl 			*((uint32_t *)(&ahc->qoutfifo[modnext])) = 0xFFFFFFFFUL;
    341   1.96      fvdl 			ahc_dmamap_sync(ahc, ahc->parent_dmat /*shared_data_dmat*/,
    342   1.96      fvdl 					ahc->shared_data_dmamap,
    343   1.96      fvdl 					/*offset*/modnext, /*len*/4,
    344   1.96      fvdl 					BUS_DMASYNC_PREREAD);
    345   1.96      fvdl 		}
    346   1.96      fvdl 		ahc->qoutfifonext++;
    347   1.42      fvdl 
    348   1.96      fvdl 		scb = ahc_lookup_scb(ahc, scb_index);
    349   1.96      fvdl 		if (scb == NULL) {
    350   1.42      fvdl 			printf("%s: WARNING no command for scb %d "
    351   1.42      fvdl 			       "(cmdcmplt)\nQOUTPOS = %d\n",
    352   1.42      fvdl 			       ahc_name(ahc), scb_index,
    353   1.96      fvdl 			       (ahc->qoutfifonext - 1) & 0xFF);
    354   1.42      fvdl 			continue;
    355   1.42      fvdl 		}
    356    1.6   mycroft 
    357    1.6   mycroft 		/*
    358   1.42      fvdl 		 * Save off the residual
    359   1.42      fvdl 		 * if there is one.
    360    1.6   mycroft 		 */
    361   1.96      fvdl 		ahc_update_residual(ahc, scb);
    362   1.42      fvdl 		ahc_done(ahc, scb);
    363    1.1   mycroft 	}
    364    1.1   mycroft }
    365    1.1   mycroft 
    366   1.96      fvdl void
    367   1.96      fvdl ahc_run_untagged_queues(struct ahc_softc *ahc)
    368   1.59        pk {
    369   1.96      fvdl 	int i;
    370   1.42      fvdl 
    371   1.96      fvdl 	for (i = 0; i < 16; i++)
    372   1.96      fvdl 		ahc_run_untagged_queue(ahc, &ahc->untagged_queues[i]);
    373   1.96      fvdl }
    374   1.42      fvdl 
    375   1.96      fvdl void
    376   1.96      fvdl ahc_run_untagged_queue(struct ahc_softc *ahc, struct scb_tailq *queue)
    377   1.96      fvdl {
    378   1.96      fvdl 	struct scb *scb;
    379   1.28       leo 
    380   1.96      fvdl 	if (ahc->untagged_queue_lock != 0)
    381   1.96      fvdl 		return;
    382    1.6   mycroft 
    383   1.96      fvdl 	if ((scb = TAILQ_FIRST(queue)) != NULL
    384   1.96      fvdl 	    && (scb->flags & SCB_ACTIVE) == 0) {
    385   1.96      fvdl 		scb->flags |= SCB_ACTIVE;
    386   1.96      fvdl 		ahc_queue_scb(ahc, scb);
    387   1.42      fvdl 	}
    388   1.96      fvdl }
    389    1.6   mycroft 
    390   1.96      fvdl /************************* Interrupt Handling *********************************/
    391   1.96      fvdl void
    392   1.96      fvdl ahc_handle_brkadrint(struct ahc_softc *ahc)
    393   1.96      fvdl {
    394   1.96      fvdl 	/*
    395   1.96      fvdl 	 * We upset the sequencer :-(
    396   1.96      fvdl 	 * Lookup the error message
    397   1.96      fvdl 	 */
    398   1.96      fvdl 	int i;
    399   1.96      fvdl 	int error;
    400    1.6   mycroft 
    401   1.96      fvdl 	error = ahc_inb(ahc, ERROR);
    402   1.96      fvdl 	for (i = 0; error != 1 && i < num_errors; i++)
    403   1.96      fvdl 		error >>= 1;
    404   1.96      fvdl 	printf("%s: brkadrint, %s at seqaddr = 0x%x\n",
    405   1.96      fvdl 	       ahc_name(ahc), ahc_hard_errors[i].errmesg,
    406   1.96      fvdl 	       ahc_inb(ahc, SEQADDR0) |
    407   1.96      fvdl 	       (ahc_inb(ahc, SEQADDR1) << 8));
    408   1.96      fvdl 
    409   1.96      fvdl 	ahc_dump_card_state(ahc);
    410   1.96      fvdl 
    411   1.96      fvdl 	/* Tell everyone that this HBA is no longer availible */
    412   1.96      fvdl 	ahc_abort_scbs(ahc, CAM_TARGET_WILDCARD, ALL_CHANNELS,
    413   1.96      fvdl 		       CAM_LUN_WILDCARD, SCB_LIST_NULL, ROLE_UNKNOWN,
    414   1.96      fvdl 		       CAM_NO_HBA);
    415   1.29       leo 
    416   1.96      fvdl 	/* Disable all interrupt sources by resetting the controller */
    417   1.96      fvdl 	ahc_shutdown(ahc);
    418    1.6   mycroft }
    419    1.6   mycroft 
    420   1.96      fvdl void
    421   1.96      fvdl ahc_handle_seqint(struct ahc_softc *ahc, u_int intstat)
    422   1.42      fvdl {
    423   1.96      fvdl 	struct scb *scb;
    424   1.96      fvdl 	struct ahc_devinfo devinfo;
    425   1.96      fvdl 
    426   1.96      fvdl 	ahc_fetch_devinfo(ahc, &devinfo);
    427   1.96      fvdl 
    428   1.96      fvdl 	/*
    429   1.96      fvdl 	 * Clear the upper byte that holds SEQINT status
    430   1.96      fvdl 	 * codes and clear the SEQINT bit. We will unpause
    431   1.96      fvdl 	 * the sequencer, if appropriate, after servicing
    432   1.96      fvdl 	 * the request.
    433   1.96      fvdl 	 */
    434   1.96      fvdl 	ahc_outb(ahc, CLRINT, CLRSEQINT);
    435   1.96      fvdl 	switch (intstat & SEQINT_MASK) {
    436   1.96      fvdl 	case BAD_STATUS:
    437   1.96      fvdl 	{
    438   1.96      fvdl 		u_int  scb_index;
    439   1.96      fvdl 		struct hardware_scb *hscb;
    440   1.42      fvdl 
    441   1.96      fvdl 		/*
    442   1.96      fvdl 		 * Set the default return value to 0 (don't
    443   1.96      fvdl 		 * send sense).  The sense code will change
    444   1.96      fvdl 		 * this if needed.
    445   1.96      fvdl 		 */
    446   1.96      fvdl 		ahc_outb(ahc, RETURN_1, 0);
    447   1.96      fvdl 
    448   1.96      fvdl 		/*
    449   1.96      fvdl 		 * The sequencer will notify us when a command
    450   1.96      fvdl 		 * has an error that would be of interest to
    451   1.96      fvdl 		 * the kernel.  This allows us to leave the sequencer
    452   1.96      fvdl 		 * running in the common case of command completes
    453   1.96      fvdl 		 * without error.  The sequencer will already have
    454   1.96      fvdl 		 * dma'd the SCB back up to us, so we can reference
    455   1.96      fvdl 		 * the in kernel copy directly.
    456   1.96      fvdl 		 */
    457   1.96      fvdl 		scb_index = ahc_inb(ahc, SCB_TAG);
    458   1.96      fvdl 		scb = ahc_lookup_scb(ahc, scb_index);
    459   1.96      fvdl 		if (scb == NULL) {
    460   1.96      fvdl 			ahc_print_devinfo(ahc, &devinfo);
    461   1.96      fvdl 			printf("ahc_intr - referenced scb "
    462   1.96      fvdl 			       "not valid during seqint 0x%x scb(%d)\n",
    463   1.96      fvdl 			       intstat, scb_index);
    464   1.96      fvdl 			ahc_dump_card_state(ahc);
    465   1.96      fvdl 			panic("for safety");
    466   1.96      fvdl 			goto unpause;
    467   1.96      fvdl 		}
    468   1.42      fvdl 
    469   1.96      fvdl 		hscb = scb->hscb;
    470   1.42      fvdl 
    471   1.96      fvdl 		/* Don't want to clobber the original sense code */
    472   1.96      fvdl 		if ((scb->flags & SCB_SENSE) != 0) {
    473   1.96      fvdl 			/*
    474   1.96      fvdl 			 * Clear the SCB_SENSE Flag and have
    475   1.96      fvdl 			 * the sequencer do a normal command
    476   1.96      fvdl 			 * complete.
    477   1.96      fvdl 			 */
    478   1.96      fvdl 			scb->flags &= ~SCB_SENSE;
    479   1.96      fvdl 			break;
    480   1.96      fvdl 		}
    481   1.96      fvdl 		/* Freeze the queue until the client sees the error. */
    482   1.96      fvdl 		ahc_freeze_devq(ahc, scb);
    483   1.96      fvdl 		ahc_freeze_scb(scb);
    484   1.96      fvdl 		ahc_set_scsi_status(scb, hscb->shared_data.status.scsi_status);
    485   1.96      fvdl 		switch (hscb->shared_data.status.scsi_status) {
    486   1.96      fvdl 		case SCSI_STATUS_OK:
    487   1.96      fvdl 			printf("%s: Interrupted for status of 0 (???)\n",
    488   1.96      fvdl 			       ahc_name(ahc));
    489   1.96      fvdl 			break;
    490   1.96      fvdl 		case SCSI_STATUS_CMD_TERMINATED:
    491   1.96      fvdl 		case SCSI_STATUS_CHECK_COND:
    492   1.96      fvdl 		{
    493   1.96      fvdl 			struct ahc_dma_seg *sg;
    494   1.96      fvdl 			struct scsipi_sense *sc;
    495   1.96      fvdl 			struct ahc_initiator_tinfo *targ_info;
    496   1.96      fvdl 			struct ahc_tmode_tstate *tstate;
    497   1.96      fvdl 			struct ahc_transinfo *tinfo;
    498   1.42      fvdl #ifdef AHC_DEBUG
    499   1.96      fvdl 			if (ahc_debug & AHC_SHOW_SENSE) {
    500   1.96      fvdl 				ahc_print_path(ahc, scb);
    501   1.96      fvdl 				printf("SCB %d: requests Check Status\n",
    502   1.96      fvdl 				       scb->hscb->tag);
    503   1.96      fvdl 			}
    504   1.42      fvdl #endif
    505   1.42      fvdl 
    506   1.96      fvdl 			if (ahc_perform_autosense(scb) == 0)
    507   1.96      fvdl 				break;
    508   1.42      fvdl 
    509   1.96      fvdl 			targ_info = ahc_fetch_transinfo(ahc,
    510   1.96      fvdl 							devinfo.channel,
    511   1.96      fvdl 							devinfo.our_scsiid,
    512   1.96      fvdl 							devinfo.target,
    513   1.96      fvdl 							&tstate);
    514   1.96      fvdl 			tinfo = &targ_info->curr;
    515   1.96      fvdl 			sg = scb->sg_list;
    516   1.96      fvdl 			sc = (struct scsipi_sense *)(&hscb->shared_data.cdb);
    517   1.96      fvdl 			/*
    518   1.96      fvdl 			 * Save off the residual if there is one.
    519   1.96      fvdl 			 */
    520   1.96      fvdl 			ahc_update_residual(ahc, scb);
    521   1.96      fvdl #ifdef AHC_DEBUG
    522   1.96      fvdl 			if (ahc_debug & AHC_SHOW_SENSE) {
    523   1.96      fvdl 				ahc_print_path(ahc, scb);
    524   1.96      fvdl 				printf("Sending Sense\n");
    525   1.96      fvdl 			}
    526   1.96      fvdl #endif
    527   1.96      fvdl 			sg->addr = ahc_get_sense_bufaddr(ahc, scb);
    528   1.96      fvdl 			sg->len = ahc_get_sense_bufsize(ahc, scb);
    529   1.96      fvdl 			sg->len |= AHC_DMA_LAST_SEG;
    530   1.96      fvdl 
    531   1.96      fvdl 			/* Fixup byte order */
    532   1.96      fvdl 			sg->addr = ahc_htole32(sg->addr);
    533   1.96      fvdl 			sg->len = ahc_htole32(sg->len);
    534   1.96      fvdl 
    535   1.96      fvdl 			sc->opcode = REQUEST_SENSE;
    536   1.96      fvdl 			sc->byte2 = 0;
    537   1.96      fvdl 			if (tinfo->protocol_version <= SCSI_REV_2
    538   1.96      fvdl 			    && SCB_GET_LUN(scb) < 8)
    539   1.96      fvdl 				sc->byte2 = SCB_GET_LUN(scb) << 5;
    540   1.96      fvdl 			sc->unused[0] = 0;
    541   1.96      fvdl 			sc->unused[1] = 0;
    542   1.96      fvdl 			sc->length = sg->len;
    543   1.96      fvdl 			sc->control = 0;
    544   1.42      fvdl 
    545   1.96      fvdl 			/*
    546   1.96      fvdl 			 * We can't allow the target to disconnect.
    547   1.96      fvdl 			 * This will be an untagged transaction and
    548   1.96      fvdl 			 * having the target disconnect will make this
    549   1.96      fvdl 			 * transaction indestinguishable from outstanding
    550   1.96      fvdl 			 * tagged transactions.
    551   1.96      fvdl 			 */
    552   1.96      fvdl 			hscb->control = 0;
    553   1.42      fvdl 
    554   1.96      fvdl 			/*
    555   1.96      fvdl 			 * This request sense could be because the
    556   1.96      fvdl 			 * the device lost power or in some other
    557   1.96      fvdl 			 * way has lost our transfer negotiations.
    558   1.96      fvdl 			 * Renegotiate if appropriate.  Unit attention
    559   1.96      fvdl 			 * errors will be reported before any data
    560   1.96      fvdl 			 * phases occur.
    561   1.96      fvdl 			 */
    562   1.96      fvdl 			if (ahc_get_residual(scb)
    563   1.96      fvdl 			    == ahc_get_transfer_length(scb)) {
    564   1.96      fvdl 				ahc_update_neg_request(ahc, &devinfo,
    565   1.96      fvdl 						       tstate, targ_info,
    566   1.96      fvdl 						       AHC_NEG_IF_NON_ASYNC);
    567   1.96      fvdl 			}
    568   1.96      fvdl 			if (tstate->auto_negotiate & devinfo.target_mask) {
    569   1.96      fvdl 				hscb->control |= MK_MESSAGE;
    570   1.96      fvdl 				scb->flags &= ~SCB_NEGOTIATE;
    571   1.96      fvdl 				scb->flags |= SCB_AUTO_NEGOTIATE;
    572   1.96      fvdl 			}
    573   1.96      fvdl 			hscb->cdb_len = sizeof(*sc);
    574   1.96      fvdl 			hscb->dataptr = sg->addr;
    575   1.96      fvdl 			hscb->datacnt = sg->len;
    576   1.96      fvdl 			hscb->sgptr = scb->sg_list_phys | SG_FULL_RESID;
    577   1.96      fvdl 			hscb->sgptr = ahc_htole32(hscb->sgptr);
    578   1.96      fvdl 			scb->sg_count = 1;
    579   1.96      fvdl 			scb->flags |= SCB_SENSE;
    580   1.96      fvdl 			ahc_qinfifo_requeue_tail(ahc, scb);
    581   1.96      fvdl 			ahc_outb(ahc, RETURN_1, SEND_SENSE);
    582   1.96      fvdl 			/*
    583   1.96      fvdl 			 * Ensure we have enough time to actually
    584   1.96      fvdl 			 * retrieve the sense.
    585   1.96      fvdl 			 */
    586   1.96      fvdl 			ahc_scb_timer_reset(scb, 5 * 1000000);
    587   1.96      fvdl 			break;
    588   1.96      fvdl 		}
    589   1.96      fvdl 		default:
    590   1.96      fvdl 			break;
    591   1.96      fvdl 		}
    592   1.96      fvdl 		break;
    593   1.96      fvdl 	}
    594   1.96      fvdl 	case NO_MATCH:
    595   1.96      fvdl 	{
    596   1.96      fvdl 		/* Ensure we don't leave the selection hardware on */
    597   1.96      fvdl 		ahc_outb(ahc, SCSISEQ,
    598   1.96      fvdl 			 ahc_inb(ahc, SCSISEQ) & (ENSELI|ENRSELI|ENAUTOATNP));
    599   1.96      fvdl 
    600   1.96      fvdl 		printf("%s:%c:%d: no active SCB for reconnecting "
    601   1.96      fvdl 		       "target - issuing BUS DEVICE RESET\n",
    602   1.96      fvdl 		       ahc_name(ahc), devinfo.channel, devinfo.target);
    603   1.96      fvdl 		printf("SAVED_SCSIID == 0x%x, SAVED_LUN == 0x%x, "
    604   1.96      fvdl 		       "ARG_1 == 0x%x ACCUM = 0x%x\n",
    605   1.96      fvdl 		       ahc_inb(ahc, SAVED_SCSIID), ahc_inb(ahc, SAVED_LUN),
    606   1.96      fvdl 		       ahc_inb(ahc, ARG_1), ahc_inb(ahc, ACCUM));
    607   1.96      fvdl 		printf("SEQ_FLAGS == 0x%x, SCBPTR == 0x%x, BTT == 0x%x, "
    608   1.96      fvdl 		       "SINDEX == 0x%x\n",
    609   1.96      fvdl 		       ahc_inb(ahc, SEQ_FLAGS), ahc_inb(ahc, SCBPTR),
    610   1.96      fvdl 		       ahc_index_busy_tcl(ahc,
    611   1.96      fvdl 			    BUILD_TCL(ahc_inb(ahc, SAVED_SCSIID),
    612   1.96      fvdl 				      ahc_inb(ahc, SAVED_LUN))),
    613   1.96      fvdl 		       ahc_inb(ahc, SINDEX));
    614   1.96      fvdl 		printf("SCSIID == 0x%x, SCB_SCSIID == 0x%x, SCB_LUN == 0x%x, "
    615   1.96      fvdl 		       "SCB_TAG == 0x%x, SCB_CONTROL == 0x%x\n",
    616   1.96      fvdl 		       ahc_inb(ahc, SCSIID), ahc_inb(ahc, SCB_SCSIID),
    617   1.96      fvdl 		       ahc_inb(ahc, SCB_LUN), ahc_inb(ahc, SCB_TAG),
    618   1.96      fvdl 		       ahc_inb(ahc, SCB_CONTROL));
    619   1.96      fvdl 		printf("SCSIBUSL == 0x%x, SCSISIGI == 0x%x\n",
    620   1.96      fvdl 		       ahc_inb(ahc, SCSIBUSL), ahc_inb(ahc, SCSISIGI));
    621   1.96      fvdl 		printf("SXFRCTL0 == 0x%x\n", ahc_inb(ahc, SXFRCTL0));
    622   1.96      fvdl 		printf("SEQCTL == 0x%x\n", ahc_inb(ahc, SEQCTL));
    623   1.96      fvdl 		ahc_dump_card_state(ahc);
    624   1.96      fvdl 		ahc->msgout_buf[0] = MSG_BUS_DEV_RESET;
    625   1.96      fvdl 		ahc->msgout_len = 1;
    626   1.96      fvdl 		ahc->msgout_index = 0;
    627   1.96      fvdl 		ahc->msg_type = MSG_TYPE_INITIATOR_MSGOUT;
    628   1.96      fvdl 		ahc_outb(ahc, MSG_OUT, HOST_MSG);
    629   1.96      fvdl 		ahc_assert_atn(ahc);
    630   1.96      fvdl 		break;
    631   1.96      fvdl 	}
    632   1.96      fvdl 	case SEND_REJECT:
    633   1.96      fvdl 	{
    634   1.96      fvdl 		u_int rejbyte = ahc_inb(ahc, ACCUM);
    635   1.96      fvdl 		printf("%s:%c:%d: Warning - unknown message received from "
    636   1.96      fvdl 		       "target (0x%x).  Rejecting\n",
    637   1.96      fvdl 		       ahc_name(ahc), devinfo.channel, devinfo.target, rejbyte);
    638   1.96      fvdl 		break;
    639   1.96      fvdl 	}
    640   1.96      fvdl 	case PROTO_VIOLATION:
    641   1.96      fvdl 	{
    642   1.96      fvdl 		ahc_handle_proto_violation(ahc);
    643   1.96      fvdl 		break;
    644   1.96      fvdl 	}
    645   1.96      fvdl 	case IGN_WIDE_RES:
    646   1.96      fvdl 		ahc_handle_ign_wide_residue(ahc, &devinfo);
    647   1.96      fvdl 		break;
    648   1.96      fvdl 	case PDATA_REINIT:
    649   1.96      fvdl 		ahc_reinitialize_dataptrs(ahc);
    650   1.96      fvdl 		break;
    651   1.96      fvdl 	case BAD_PHASE:
    652   1.96      fvdl 	{
    653   1.96      fvdl 		u_int lastphase;
    654   1.96      fvdl 
    655   1.96      fvdl 		lastphase = ahc_inb(ahc, LASTPHASE);
    656   1.96      fvdl 		printf("%s:%c:%d: unknown scsi bus phase %x, "
    657   1.96      fvdl 		       "lastphase = 0x%x.  Attempting to continue\n",
    658   1.96      fvdl 		       ahc_name(ahc), devinfo.channel, devinfo.target,
    659   1.96      fvdl 		       lastphase, ahc_inb(ahc, SCSISIGI));
    660   1.96      fvdl 		break;
    661   1.96      fvdl 	}
    662   1.96      fvdl 	case MISSED_BUSFREE:
    663   1.96      fvdl 	{
    664   1.96      fvdl 		u_int lastphase;
    665   1.96      fvdl 
    666   1.96      fvdl 		lastphase = ahc_inb(ahc, LASTPHASE);
    667   1.96      fvdl 		printf("%s:%c:%d: Missed busfree. "
    668   1.96      fvdl 		       "Lastphase = 0x%x, Curphase = 0x%x\n",
    669   1.96      fvdl 		       ahc_name(ahc), devinfo.channel, devinfo.target,
    670   1.96      fvdl 		       lastphase, ahc_inb(ahc, SCSISIGI));
    671   1.96      fvdl 		ahc_restart(ahc);
    672   1.96      fvdl 		return;
    673   1.96      fvdl 	}
    674   1.96      fvdl 	case HOST_MSG_LOOP:
    675   1.96      fvdl 	{
    676   1.96      fvdl 		/*
    677   1.96      fvdl 		 * The sequencer has encountered a message phase
    678   1.96      fvdl 		 * that requires host assistance for completion.
    679   1.96      fvdl 		 * While handling the message phase(s), we will be
    680   1.96      fvdl 		 * notified by the sequencer after each byte is
    681   1.96      fvdl 		 * transfered so we can track bus phase changes.
    682   1.96      fvdl 		 *
    683   1.96      fvdl 		 * If this is the first time we've seen a HOST_MSG_LOOP
    684   1.96      fvdl 		 * interrupt, initialize the state of the host message
    685   1.96      fvdl 		 * loop.
    686   1.96      fvdl 		 */
    687   1.96      fvdl 		if (ahc->msg_type == MSG_TYPE_NONE) {
    688   1.96      fvdl 			struct scb *scb;
    689   1.96      fvdl 			u_int scb_index;
    690   1.96      fvdl 			u_int bus_phase;
    691   1.96      fvdl 
    692   1.96      fvdl 			bus_phase = ahc_inb(ahc, SCSISIGI) & PHASE_MASK;
    693   1.96      fvdl 			if (bus_phase != P_MESGIN
    694   1.96      fvdl 			 && bus_phase != P_MESGOUT) {
    695   1.96      fvdl 				printf("ahc_intr: HOST_MSG_LOOP bad "
    696   1.96      fvdl 				       "phase 0x%x\n",
    697   1.96      fvdl 				      bus_phase);
    698   1.96      fvdl 				/*
    699   1.96      fvdl 				 * Probably transitioned to bus free before
    700   1.96      fvdl 				 * we got here.  Just punt the message.
    701   1.96      fvdl 				 */
    702   1.96      fvdl 				ahc_clear_intstat(ahc);
    703   1.96      fvdl 				ahc_restart(ahc);
    704   1.96      fvdl 				return;
    705   1.96      fvdl 			}
    706   1.96      fvdl 
    707   1.96      fvdl 			scb_index = ahc_inb(ahc, SCB_TAG);
    708   1.96      fvdl 			scb = ahc_lookup_scb(ahc, scb_index);
    709   1.96      fvdl 			if (devinfo.role == ROLE_INITIATOR) {
    710   1.96      fvdl 				if (scb == NULL)
    711   1.96      fvdl 					panic("HOST_MSG_LOOP with "
    712   1.96      fvdl 					      "invalid SCB %x\n", scb_index);
    713   1.96      fvdl 
    714   1.96      fvdl 				if (bus_phase == P_MESGOUT)
    715   1.96      fvdl 					ahc_setup_initiator_msgout(ahc,
    716   1.96      fvdl 								   &devinfo,
    717   1.96      fvdl 								   scb);
    718   1.96      fvdl 				else {
    719   1.96      fvdl 					ahc->msg_type =
    720   1.96      fvdl 					    MSG_TYPE_INITIATOR_MSGIN;
    721   1.96      fvdl 					ahc->msgin_index = 0;
    722   1.96      fvdl 				}
    723   1.96      fvdl 			}
    724   1.96      fvdl #if AHC_TARGET_MODE
    725   1.96      fvdl 			else {
    726   1.96      fvdl 				if (bus_phase == P_MESGOUT) {
    727   1.96      fvdl 					ahc->msg_type =
    728   1.96      fvdl 					    MSG_TYPE_TARGET_MSGOUT;
    729   1.96      fvdl 					ahc->msgin_index = 0;
    730   1.96      fvdl 				}
    731   1.96      fvdl 				else
    732   1.96      fvdl 					ahc_setup_target_msgin(ahc,
    733   1.96      fvdl 							       &devinfo,
    734   1.96      fvdl 							       scb);
    735   1.96      fvdl 			}
    736   1.96      fvdl #endif
    737   1.96      fvdl 		}
    738   1.96      fvdl 
    739   1.96      fvdl 		ahc_handle_message_phase(ahc);
    740   1.96      fvdl 		break;
    741   1.96      fvdl 	}
    742   1.96      fvdl 	case PERR_DETECTED:
    743   1.96      fvdl 	{
    744   1.96      fvdl 		/*
    745   1.96      fvdl 		 * If we've cleared the parity error interrupt
    746   1.96      fvdl 		 * but the sequencer still believes that SCSIPERR
    747   1.96      fvdl 		 * is true, it must be that the parity error is
    748   1.96      fvdl 		 * for the currently presented byte on the bus,
    749   1.96      fvdl 		 * and we are not in a phase (data-in) where we will
    750   1.96      fvdl 		 * eventually ack this byte.  Ack the byte and
    751   1.96      fvdl 		 * throw it away in the hope that the target will
    752   1.96      fvdl 		 * take us to message out to deliver the appropriate
    753   1.96      fvdl 		 * error message.
    754   1.96      fvdl 		 */
    755   1.96      fvdl 		if ((intstat & SCSIINT) == 0
    756   1.96      fvdl 		 && (ahc_inb(ahc, SSTAT1) & SCSIPERR) != 0) {
    757   1.96      fvdl 
    758   1.96      fvdl 			if ((ahc->features & AHC_DT) == 0) {
    759   1.96      fvdl 				u_int curphase;
    760   1.96      fvdl 
    761   1.96      fvdl 				/*
    762   1.96      fvdl 				 * The hardware will only let you ack bytes
    763   1.96      fvdl 				 * if the expected phase in SCSISIGO matches
    764   1.96      fvdl 				 * the current phase.  Make sure this is
    765   1.96      fvdl 				 * currently the case.
    766   1.96      fvdl 				 */
    767   1.96      fvdl 				curphase = ahc_inb(ahc, SCSISIGI) & PHASE_MASK;
    768   1.96      fvdl 				ahc_outb(ahc, LASTPHASE, curphase);
    769   1.96      fvdl 				ahc_outb(ahc, SCSISIGO, curphase);
    770   1.96      fvdl 			}
    771   1.96      fvdl 			if ((ahc_inb(ahc, SCSISIGI) & (CDI|MSGI)) == 0) {
    772   1.96      fvdl 				int wait;
    773   1.96      fvdl 
    774   1.96      fvdl 				/*
    775   1.96      fvdl 				 * In a data phase.  Faster to bitbucket
    776   1.96      fvdl 				 * the data than to individually ack each
    777   1.96      fvdl 				 * byte.  This is also the only strategy
    778   1.96      fvdl 				 * that will work with AUTOACK enabled.
    779   1.96      fvdl 				 */
    780   1.96      fvdl 				ahc_outb(ahc, SXFRCTL1,
    781   1.96      fvdl 					 ahc_inb(ahc, SXFRCTL1) | BITBUCKET);
    782   1.96      fvdl 				wait = 5000;
    783   1.96      fvdl 				while (--wait != 0) {
    784   1.96      fvdl 					if ((ahc_inb(ahc, SCSISIGI)
    785   1.96      fvdl 					  & (CDI|MSGI)) != 0)
    786   1.96      fvdl 						break;
    787   1.96      fvdl 					ahc_delay(100);
    788   1.96      fvdl 				}
    789   1.96      fvdl 				ahc_outb(ahc, SXFRCTL1,
    790   1.96      fvdl 					 ahc_inb(ahc, SXFRCTL1) & ~BITBUCKET);
    791   1.96      fvdl 				if (wait == 0) {
    792   1.96      fvdl 					struct	scb *scb;
    793   1.96      fvdl 					u_int	scb_index;
    794   1.96      fvdl 
    795   1.96      fvdl 					ahc_print_devinfo(ahc, &devinfo);
    796   1.96      fvdl 					printf("Unable to clear parity error.  "
    797   1.96      fvdl 					       "Resetting bus.\n");
    798   1.96      fvdl 					scb_index = ahc_inb(ahc, SCB_TAG);
    799   1.96      fvdl 					scb = ahc_lookup_scb(ahc, scb_index);
    800   1.96      fvdl 					if (scb != NULL)
    801   1.96      fvdl 						ahc_set_transaction_status(scb,
    802   1.96      fvdl 						    CAM_UNCOR_PARITY);
    803   1.96      fvdl 					ahc_reset_channel(ahc, devinfo.channel,
    804   1.96      fvdl 							  /*init reset*/TRUE);
    805   1.96      fvdl 				}
    806   1.96      fvdl 			} else {
    807   1.96      fvdl 				ahc_inb(ahc, SCSIDATL);
    808   1.96      fvdl 			}
    809   1.96      fvdl 		}
    810   1.96      fvdl 		break;
    811   1.96      fvdl 	}
    812   1.96      fvdl 	case DATA_OVERRUN:
    813   1.96      fvdl 	{
    814   1.96      fvdl 		/*
    815   1.96      fvdl 		 * When the sequencer detects an overrun, it
    816   1.96      fvdl 		 * places the controller in "BITBUCKET" mode
    817   1.96      fvdl 		 * and allows the target to complete its transfer.
    818   1.96      fvdl 		 * Unfortunately, none of the counters get updated
    819   1.96      fvdl 		 * when the controller is in this mode, so we have
    820   1.96      fvdl 		 * no way of knowing how large the overrun was.
    821   1.96      fvdl 		 */
    822   1.96      fvdl 		u_int scbindex = ahc_inb(ahc, SCB_TAG);
    823   1.96      fvdl 		u_int lastphase = ahc_inb(ahc, LASTPHASE);
    824   1.96      fvdl 		u_int i;
    825   1.96      fvdl 
    826   1.96      fvdl 		scb = ahc_lookup_scb(ahc, scbindex);
    827   1.96      fvdl 		for (i = 0; i < num_phases; i++) {
    828   1.96      fvdl 			if (lastphase == ahc_phase_table[i].phase)
    829   1.96      fvdl 				break;
    830   1.96      fvdl 		}
    831   1.96      fvdl 		ahc_print_path(ahc, scb);
    832   1.96      fvdl 		printf("data overrun detected %s."
    833   1.96      fvdl 		       "  Tag == 0x%x.\n",
    834   1.96      fvdl 		       ahc_phase_table[i].phasemsg,
    835   1.96      fvdl   		       scb->hscb->tag);
    836   1.96      fvdl 		ahc_print_path(ahc, scb);
    837   1.96      fvdl 		printf("%s seen Data Phase.  Length = %ld.  NumSGs = %d.\n",
    838   1.96      fvdl 		       ahc_inb(ahc, SEQ_FLAGS) & DPHASE ? "Have" : "Haven't",
    839   1.96      fvdl 		       ahc_get_transfer_length(scb), scb->sg_count);
    840   1.96      fvdl 		if (scb->sg_count > 0) {
    841   1.96      fvdl 			for (i = 0; i < scb->sg_count; i++) {
    842   1.96      fvdl 
    843   1.96      fvdl 				printf("sg[%d] - Addr 0x%x%x : Length %d\n",
    844   1.96      fvdl 				       i,
    845   1.96      fvdl 				       (ahc_le32toh(scb->sg_list[i].len) >> 24
    846   1.96      fvdl 				        & SG_HIGH_ADDR_BITS),
    847   1.96      fvdl 				       ahc_le32toh(scb->sg_list[i].addr),
    848   1.96      fvdl 				       ahc_le32toh(scb->sg_list[i].len)
    849   1.96      fvdl 				       & AHC_SG_LEN_MASK);
    850   1.96      fvdl 			}
    851   1.96      fvdl 		}
    852   1.96      fvdl 		/*
    853   1.96      fvdl 		 * Set this and it will take effect when the
    854   1.96      fvdl 		 * target does a command complete.
    855   1.96      fvdl 		 */
    856   1.96      fvdl 		ahc_freeze_devq(ahc, scb);
    857   1.96      fvdl 		if ((scb->flags & SCB_SENSE) == 0) {
    858   1.96      fvdl 			ahc_set_transaction_status(scb, CAM_DATA_RUN_ERR);
    859   1.96      fvdl 		} else {
    860   1.96      fvdl 			scb->flags &= ~SCB_SENSE;
    861   1.96      fvdl 			ahc_set_transaction_status(scb, CAM_AUTOSENSE_FAIL);
    862   1.96      fvdl 		}
    863   1.96      fvdl 		ahc_freeze_scb(scb);
    864   1.96      fvdl 
    865   1.96      fvdl 		if ((ahc->features & AHC_ULTRA2) != 0) {
    866   1.96      fvdl 			/*
    867   1.96      fvdl 			 * Clear the channel in case we return
    868   1.96      fvdl 			 * to data phase later.
    869   1.96      fvdl 			 */
    870   1.96      fvdl 			ahc_outb(ahc, SXFRCTL0,
    871   1.96      fvdl 				 ahc_inb(ahc, SXFRCTL0) | CLRSTCNT|CLRCHN);
    872   1.96      fvdl 			ahc_outb(ahc, SXFRCTL0,
    873   1.96      fvdl 				 ahc_inb(ahc, SXFRCTL0) | CLRSTCNT|CLRCHN);
    874   1.96      fvdl 		}
    875   1.96      fvdl 		if ((ahc->flags & AHC_39BIT_ADDRESSING) != 0) {
    876   1.96      fvdl 			u_int dscommand1;
    877   1.96      fvdl 
    878   1.96      fvdl 			/* Ensure HHADDR is 0 for future DMA operations. */
    879   1.96      fvdl 			dscommand1 = ahc_inb(ahc, DSCOMMAND1);
    880   1.96      fvdl 			ahc_outb(ahc, DSCOMMAND1, dscommand1 | HADDLDSEL0);
    881   1.96      fvdl 			ahc_outb(ahc, HADDR, 0);
    882   1.96      fvdl 			ahc_outb(ahc, DSCOMMAND1, dscommand1);
    883   1.96      fvdl 		}
    884   1.96      fvdl 		break;
    885   1.96      fvdl 	}
    886   1.96      fvdl 	case MKMSG_FAILED:
    887   1.96      fvdl 	{
    888   1.96      fvdl 		u_int scbindex;
    889   1.96      fvdl 
    890   1.96      fvdl 		printf("%s:%c:%d:%d: Attempt to issue message failed\n",
    891   1.96      fvdl 		       ahc_name(ahc), devinfo.channel, devinfo.target,
    892   1.96      fvdl 		       devinfo.lun);
    893   1.96      fvdl 		scbindex = ahc_inb(ahc, SCB_TAG);
    894   1.96      fvdl 		scb = ahc_lookup_scb(ahc, scbindex);
    895   1.96      fvdl 		if (scb != NULL
    896   1.96      fvdl 		 && (scb->flags & SCB_RECOVERY_SCB) != 0)
    897   1.96      fvdl 			/*
    898   1.96      fvdl 			 * Ensure that we didn't put a second instance of this
    899   1.96      fvdl 			 * SCB into the QINFIFO.
    900   1.96      fvdl 			 */
    901   1.96      fvdl 			ahc_search_qinfifo(ahc, SCB_GET_TARGET(ahc, scb),
    902   1.96      fvdl 					   SCB_GET_CHANNEL(ahc, scb),
    903   1.96      fvdl 					   SCB_GET_LUN(scb), scb->hscb->tag,
    904   1.96      fvdl 					   ROLE_INITIATOR, /*status*/0,
    905   1.96      fvdl 					   SEARCH_REMOVE);
    906   1.96      fvdl 		break;
    907   1.96      fvdl 	}
    908   1.96      fvdl 	case NO_FREE_SCB:
    909   1.96      fvdl 	{
    910   1.96      fvdl 		printf("%s: No free or disconnected SCBs\n", ahc_name(ahc));
    911   1.96      fvdl 		ahc_dump_card_state(ahc);
    912   1.96      fvdl 		panic("for safety");
    913   1.96      fvdl 		break;
    914   1.96      fvdl 	}
    915   1.96      fvdl 	case SCB_MISMATCH:
    916   1.96      fvdl 	{
    917   1.96      fvdl 		u_int scbptr;
    918   1.96      fvdl 
    919   1.96      fvdl 		scbptr = ahc_inb(ahc, SCBPTR);
    920   1.96      fvdl 		printf("Bogus TAG after DMA.  SCBPTR %d, tag %d, our tag %d\n",
    921   1.96      fvdl 		       scbptr, ahc_inb(ahc, ARG_1),
    922   1.96      fvdl 		       ahc->scb_data->hscbs[scbptr].tag);
    923   1.96      fvdl 		ahc_dump_card_state(ahc);
    924   1.96      fvdl 		panic("for saftey");
    925   1.96      fvdl 		break;
    926   1.96      fvdl 	}
    927   1.96      fvdl 	case OUT_OF_RANGE:
    928   1.96      fvdl 	{
    929   1.96      fvdl 		printf("%s: BTT calculation out of range\n", ahc_name(ahc));
    930   1.96      fvdl 		printf("SAVED_SCSIID == 0x%x, SAVED_LUN == 0x%x, "
    931   1.96      fvdl 		       "ARG_1 == 0x%x ACCUM = 0x%x\n",
    932   1.96      fvdl 		       ahc_inb(ahc, SAVED_SCSIID), ahc_inb(ahc, SAVED_LUN),
    933   1.96      fvdl 		       ahc_inb(ahc, ARG_1), ahc_inb(ahc, ACCUM));
    934   1.96      fvdl 		printf("SEQ_FLAGS == 0x%x, SCBPTR == 0x%x, BTT == 0x%x, "
    935   1.96      fvdl 		       "SINDEX == 0x%x\n, A == 0x%x\n",
    936   1.96      fvdl 		       ahc_inb(ahc, SEQ_FLAGS), ahc_inb(ahc, SCBPTR),
    937   1.96      fvdl 		       ahc_index_busy_tcl(ahc,
    938   1.96      fvdl 			    BUILD_TCL(ahc_inb(ahc, SAVED_SCSIID),
    939   1.96      fvdl 				      ahc_inb(ahc, SAVED_LUN))),
    940   1.96      fvdl 		       ahc_inb(ahc, SINDEX),
    941   1.96      fvdl 		       ahc_inb(ahc, ACCUM));
    942   1.96      fvdl 		printf("SCSIID == 0x%x, SCB_SCSIID == 0x%x, SCB_LUN == 0x%x, "
    943   1.96      fvdl 		       "SCB_TAG == 0x%x, SCB_CONTROL == 0x%x\n",
    944   1.96      fvdl 		       ahc_inb(ahc, SCSIID), ahc_inb(ahc, SCB_SCSIID),
    945   1.96      fvdl 		       ahc_inb(ahc, SCB_LUN), ahc_inb(ahc, SCB_TAG),
    946   1.96      fvdl 		       ahc_inb(ahc, SCB_CONTROL));
    947   1.96      fvdl 		printf("SCSIBUSL == 0x%x, SCSISIGI == 0x%x\n",
    948   1.96      fvdl 		       ahc_inb(ahc, SCSIBUSL), ahc_inb(ahc, SCSISIGI));
    949   1.96      fvdl 		ahc_dump_card_state(ahc);
    950   1.96      fvdl 		panic("for safety");
    951   1.96      fvdl 		break;
    952   1.96      fvdl 	}
    953   1.96      fvdl 	default:
    954   1.96      fvdl 		printf("ahc_intr: seqint, "
    955   1.96      fvdl 		       "intstat == 0x%x, scsisigi = 0x%x\n",
    956   1.96      fvdl 		       intstat, ahc_inb(ahc, SCSISIGI));
    957   1.96      fvdl 		break;
    958   1.96      fvdl 	}
    959   1.96      fvdl unpause:
    960   1.96      fvdl 	/*
    961   1.96      fvdl 	 *  The sequencer is paused immediately on
    962   1.96      fvdl 	 *  a SEQINT, so we should restart it when
    963   1.96      fvdl 	 *  we're done.
    964   1.96      fvdl 	 */
    965   1.96      fvdl 	ahc_unpause(ahc);
    966   1.96      fvdl }
    967   1.96      fvdl 
    968   1.96      fvdl void
    969   1.96      fvdl ahc_handle_scsiint(struct ahc_softc *ahc, u_int intstat)
    970   1.96      fvdl {
    971   1.96      fvdl 	u_int	scb_index;
    972   1.96      fvdl 	u_int	status0;
    973   1.96      fvdl 	u_int	status;
    974   1.96      fvdl 	struct	scb *scb;
    975   1.96      fvdl 	char	cur_channel;
    976   1.96      fvdl 	char	intr_channel;
    977   1.96      fvdl 
    978   1.96      fvdl 	if ((ahc->features & AHC_TWIN) != 0
    979   1.96      fvdl 	    && ((ahc_inb(ahc, SBLKCTL) & SELBUSB) != 0))
    980   1.96      fvdl 		cur_channel = 'B';
    981   1.96      fvdl 	else
    982   1.96      fvdl 		cur_channel = 'A';
    983   1.96      fvdl 	intr_channel = cur_channel;
    984   1.96      fvdl 
    985   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0)
    986   1.96      fvdl 		status0 = ahc_inb(ahc, SSTAT0) & IOERR;
    987   1.96      fvdl 	else
    988   1.96      fvdl 		status0 = 0;
    989   1.96      fvdl 	status = ahc_inb(ahc, SSTAT1) & (SELTO|SCSIRSTI|BUSFREE|SCSIPERR);
    990   1.96      fvdl 	if (status == 0 && status0 == 0) {
    991   1.96      fvdl 		if ((ahc->features & AHC_TWIN) != 0) {
    992   1.96      fvdl 			/* Try the other channel */
    993   1.96      fvdl 		 	ahc_outb(ahc, SBLKCTL, ahc_inb(ahc, SBLKCTL) ^ SELBUSB);
    994   1.96      fvdl 			status = ahc_inb(ahc, SSTAT1)
    995   1.96      fvdl 			       & (SELTO|SCSIRSTI|BUSFREE|SCSIPERR);
    996   1.96      fvdl 			intr_channel = (cur_channel == 'A') ? 'B' : 'A';
    997   1.96      fvdl 		}
    998   1.96      fvdl 		if (status == 0) {
    999   1.96      fvdl 			printf("%s: Spurious SCSI interrupt\n", ahc_name(ahc));
   1000   1.96      fvdl 			ahc_outb(ahc, CLRINT, CLRSCSIINT);
   1001   1.96      fvdl 			ahc_unpause(ahc);
   1002   1.96      fvdl 			return;
   1003   1.96      fvdl 		}
   1004   1.96      fvdl 	}
   1005   1.96      fvdl 
   1006   1.96      fvdl 	/* Make sure the sequencer is in a safe location. */
   1007   1.96      fvdl 	ahc_clear_critical_section(ahc);
   1008   1.96      fvdl 
   1009   1.96      fvdl 	scb_index = ahc_inb(ahc, SCB_TAG);
   1010   1.96      fvdl 	scb = ahc_lookup_scb(ahc, scb_index);
   1011   1.96      fvdl 	if (scb != NULL
   1012   1.96      fvdl 	 && (ahc_inb(ahc, SEQ_FLAGS) & NOT_IDENTIFIED) != 0)
   1013   1.96      fvdl 		scb = NULL;
   1014   1.96      fvdl 
   1015   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0
   1016   1.96      fvdl 	 && (status0 & IOERR) != 0) {
   1017   1.96      fvdl 		int now_lvd;
   1018   1.96      fvdl 
   1019   1.96      fvdl 		now_lvd = ahc_inb(ahc, SBLKCTL) & ENAB40;
   1020   1.96      fvdl 		printf("%s: Transceiver State Has Changed to %s mode\n",
   1021   1.96      fvdl 		       ahc_name(ahc), now_lvd ? "LVD" : "SE");
   1022   1.96      fvdl 		ahc_outb(ahc, CLRSINT0, CLRIOERR);
   1023   1.96      fvdl 		/*
   1024   1.96      fvdl 		 * When transitioning to SE mode, the reset line
   1025   1.96      fvdl 		 * glitches, triggering an arbitration bug in some
   1026   1.96      fvdl 		 * Ultra2 controllers.  This bug is cleared when we
   1027   1.96      fvdl 		 * assert the reset line.  Since a reset glitch has
   1028   1.96      fvdl 		 * already occurred with this transition and a
   1029   1.96      fvdl 		 * transceiver state change is handled just like
   1030   1.96      fvdl 		 * a bus reset anyway, asserting the reset line
   1031   1.96      fvdl 		 * ourselves is safe.
   1032   1.96      fvdl 		 */
   1033   1.96      fvdl 		ahc_reset_channel(ahc, intr_channel,
   1034   1.96      fvdl 				 /*Initiate Reset*/now_lvd == 0);
   1035   1.96      fvdl 	} else if ((status & SCSIRSTI) != 0) {
   1036   1.96      fvdl 		printf("%s: Someone reset channel %c\n",
   1037   1.96      fvdl 			ahc_name(ahc), intr_channel);
   1038   1.96      fvdl 		if (intr_channel != cur_channel)
   1039   1.96      fvdl 		 	ahc_outb(ahc, SBLKCTL, ahc_inb(ahc, SBLKCTL) ^ SELBUSB);
   1040   1.96      fvdl 		ahc_reset_channel(ahc, intr_channel, /*Initiate Reset*/FALSE);
   1041   1.96      fvdl 	} else if ((status & SCSIPERR) != 0) {
   1042   1.96      fvdl 		/*
   1043   1.96      fvdl 		 * Determine the bus phase and queue an appropriate message.
   1044   1.96      fvdl 		 * SCSIPERR is latched true as soon as a parity error
   1045   1.96      fvdl 		 * occurs.  If the sequencer acked the transfer that
   1046   1.96      fvdl 		 * caused the parity error and the currently presented
   1047   1.96      fvdl 		 * transfer on the bus has correct parity, SCSIPERR will
   1048   1.96      fvdl 		 * be cleared by CLRSCSIPERR.  Use this to determine if
   1049   1.96      fvdl 		 * we should look at the last phase the sequencer recorded,
   1050   1.96      fvdl 		 * or the current phase presented on the bus.
   1051   1.96      fvdl 		 */
   1052   1.96      fvdl 		u_int mesg_out;
   1053   1.96      fvdl 		u_int curphase;
   1054   1.96      fvdl 		u_int errorphase;
   1055   1.96      fvdl 		u_int lastphase;
   1056   1.96      fvdl 		u_int scsirate;
   1057   1.96      fvdl 		u_int i;
   1058   1.96      fvdl 		u_int sstat2;
   1059   1.96      fvdl 		int   silent;
   1060   1.96      fvdl 
   1061   1.96      fvdl 		lastphase = ahc_inb(ahc, LASTPHASE);
   1062   1.96      fvdl 		curphase = ahc_inb(ahc, SCSISIGI) & PHASE_MASK;
   1063   1.96      fvdl 		sstat2 = ahc_inb(ahc, SSTAT2);
   1064   1.96      fvdl 		ahc_outb(ahc, CLRSINT1, CLRSCSIPERR);
   1065   1.96      fvdl 		/*
   1066   1.96      fvdl 		 * For all phases save DATA, the sequencer won't
   1067   1.96      fvdl 		 * automatically ack a byte that has a parity error
   1068   1.96      fvdl 		 * in it.  So the only way that the current phase
   1069   1.96      fvdl 		 * could be 'data-in' is if the parity error is for
   1070   1.96      fvdl 		 * an already acked byte in the data phase.  During
   1071   1.96      fvdl 		 * synchronous data-in transfers, we may actually
   1072   1.96      fvdl 		 * ack bytes before latching the current phase in
   1073   1.96      fvdl 		 * LASTPHASE, leading to the discrepancy between
   1074   1.96      fvdl 		 * curphase and lastphase.
   1075   1.96      fvdl 		 */
   1076   1.96      fvdl 		if ((ahc_inb(ahc, SSTAT1) & SCSIPERR) != 0
   1077   1.96      fvdl 		 || curphase == P_DATAIN || curphase == P_DATAIN_DT)
   1078   1.96      fvdl 			errorphase = curphase;
   1079   1.96      fvdl 		else
   1080   1.96      fvdl 			errorphase = lastphase;
   1081   1.96      fvdl 
   1082   1.96      fvdl 		for (i = 0; i < num_phases; i++) {
   1083   1.96      fvdl 			if (errorphase == ahc_phase_table[i].phase)
   1084   1.96      fvdl 				break;
   1085   1.96      fvdl 		}
   1086   1.96      fvdl 		mesg_out = ahc_phase_table[i].mesg_out;
   1087   1.96      fvdl 		silent = FALSE;
   1088   1.96      fvdl 		if (scb != NULL) {
   1089   1.96      fvdl 			if (SCB_IS_SILENT(scb))
   1090   1.96      fvdl 				silent = TRUE;
   1091   1.96      fvdl 			else
   1092   1.96      fvdl 				ahc_print_path(ahc, scb);
   1093   1.96      fvdl 			scb->flags |= SCB_TRANSMISSION_ERROR;
   1094   1.96      fvdl 		} else
   1095   1.96      fvdl 			printf("%s:%c:%d: ", ahc_name(ahc), intr_channel,
   1096   1.96      fvdl 			       SCSIID_TARGET(ahc, ahc_inb(ahc, SAVED_SCSIID)));
   1097   1.96      fvdl 		scsirate = ahc_inb(ahc, SCSIRATE);
   1098   1.96      fvdl 		if (silent == FALSE) {
   1099   1.96      fvdl 			printf("parity error detected %s. "
   1100   1.96      fvdl 			       "SEQADDR(0x%x) SCSIRATE(0x%x)\n",
   1101   1.96      fvdl 			       ahc_phase_table[i].phasemsg,
   1102   1.96      fvdl 			       ahc_inw(ahc, SEQADDR0),
   1103   1.96      fvdl 			       scsirate);
   1104   1.96      fvdl 			if ((ahc->features & AHC_DT) != 0) {
   1105   1.96      fvdl 				if ((sstat2 & CRCVALERR) != 0)
   1106   1.96      fvdl 					printf("\tCRC Value Mismatch\n");
   1107   1.96      fvdl 				if ((sstat2 & CRCENDERR) != 0)
   1108   1.96      fvdl 					printf("\tNo terminal CRC packet "
   1109   1.96      fvdl 					       "recevied\n");
   1110   1.96      fvdl 				if ((sstat2 & CRCREQERR) != 0)
   1111   1.96      fvdl 					printf("\tIllegal CRC packet "
   1112   1.96      fvdl 					       "request\n");
   1113   1.96      fvdl 				if ((sstat2 & DUAL_EDGE_ERR) != 0)
   1114   1.96      fvdl 					printf("\tUnexpected %sDT Data Phase\n",
   1115   1.96      fvdl 					       (scsirate & SINGLE_EDGE)
   1116   1.96      fvdl 					     ? "" : "non-");
   1117   1.96      fvdl 			}
   1118   1.96      fvdl 		}
   1119   1.96      fvdl 
   1120   1.96      fvdl 		if ((ahc->features & AHC_DT) != 0
   1121   1.96      fvdl 		 && (sstat2 & DUAL_EDGE_ERR) != 0) {
   1122   1.96      fvdl 			/*
   1123   1.96      fvdl 			 * This error applies regardless of
   1124   1.96      fvdl 			 * data direction, so ignore the value
   1125   1.96      fvdl 			 * in the phase table.
   1126   1.96      fvdl 			 */
   1127   1.96      fvdl 			mesg_out = MSG_INITIATOR_DET_ERR;
   1128   1.96      fvdl 		}
   1129   1.96      fvdl 
   1130   1.96      fvdl 		/*
   1131   1.96      fvdl 		 * We've set the hardware to assert ATN if we
   1132   1.96      fvdl 		 * get a parity error on "in" phases, so all we
   1133   1.96      fvdl 		 * need to do is stuff the message buffer with
   1134   1.96      fvdl 		 * the appropriate message.  "In" phases have set
   1135   1.96      fvdl 		 * mesg_out to something other than MSG_NOP.
   1136   1.96      fvdl 		 */
   1137   1.96      fvdl 		if (mesg_out != MSG_NOOP) {
   1138   1.96      fvdl 			if (ahc->msg_type != MSG_TYPE_NONE)
   1139   1.96      fvdl 				ahc->send_msg_perror = TRUE;
   1140   1.96      fvdl 			else
   1141   1.96      fvdl 				ahc_outb(ahc, MSG_OUT, mesg_out);
   1142   1.96      fvdl 		}
   1143   1.96      fvdl 		/*
   1144   1.96      fvdl 		 * Force a renegotiation with this target just in
   1145   1.96      fvdl 		 * case we are out of sync for some external reason
   1146   1.96      fvdl 		 * unknown (or unreported) by the target.
   1147   1.96      fvdl 		 */
   1148   1.96      fvdl 		ahc_force_renegotiation(ahc);
   1149   1.96      fvdl 		ahc_outb(ahc, CLRINT, CLRSCSIINT);
   1150   1.96      fvdl 		ahc_unpause(ahc);
   1151   1.96      fvdl 	} else if ((status & SELTO) != 0) {
   1152   1.96      fvdl 		u_int	scbptr;
   1153   1.96      fvdl 
   1154   1.96      fvdl 		/* Stop the selection */
   1155   1.96      fvdl 		ahc_outb(ahc, SCSISEQ, 0);
   1156   1.96      fvdl 
   1157   1.96      fvdl 		/* No more pending messages */
   1158   1.96      fvdl 		ahc_clear_msg_state(ahc);
   1159   1.96      fvdl 
   1160   1.96      fvdl 		/* Clear interrupt state */
   1161   1.96      fvdl 		ahc_outb(ahc, SIMODE1, ahc_inb(ahc, SIMODE1) & ~ENBUSFREE);
   1162   1.96      fvdl 		ahc_outb(ahc, CLRSINT1, CLRSELTIMEO|CLRBUSFREE|CLRSCSIPERR);
   1163   1.96      fvdl 
   1164   1.96      fvdl 		/*
   1165   1.96      fvdl 		 * Although the driver does not care about the
   1166   1.96      fvdl 		 * 'Selection in Progress' status bit, the busy
   1167   1.96      fvdl 		 * LED does.  SELINGO is only cleared by a sucessfull
   1168   1.96      fvdl 		 * selection, so we must manually clear it to insure
   1169   1.96      fvdl 		 * the LED turns off just incase no future successful
   1170   1.96      fvdl 		 * selections occur (e.g. no devices on the bus).
   1171   1.96      fvdl 		 */
   1172   1.96      fvdl 		ahc_outb(ahc, CLRSINT0, CLRSELINGO);
   1173   1.96      fvdl 
   1174   1.96      fvdl 		scbptr = ahc_inb(ahc, WAITING_SCBH);
   1175   1.96      fvdl 		ahc_outb(ahc, SCBPTR, scbptr);
   1176   1.96      fvdl 		scb_index = ahc_inb(ahc, SCB_TAG);
   1177   1.96      fvdl 
   1178   1.96      fvdl 		scb = ahc_lookup_scb(ahc, scb_index);
   1179   1.96      fvdl 		if (scb == NULL) {
   1180   1.96      fvdl 			printf("%s: ahc_intr - referenced scb not "
   1181   1.96      fvdl 			       "valid during SELTO scb(%d, %d)\n",
   1182   1.96      fvdl 			       ahc_name(ahc), scbptr, scb_index);
   1183   1.96      fvdl 			ahc_dump_card_state(ahc);
   1184   1.96      fvdl 		} else {
   1185   1.96      fvdl #ifdef AHC_DEBUG
   1186   1.96      fvdl 			if ((ahc_debug & AHC_SHOW_SELTO) != 0) {
   1187   1.96      fvdl 				ahc_print_path(ahc, scb);
   1188   1.96      fvdl 				printf("Saw Selection Timeout for SCB 0x%x\n",
   1189   1.96      fvdl 				       scb_index);
   1190   1.96      fvdl 			}
   1191   1.96      fvdl #endif
   1192   1.96      fvdl 			/*
   1193   1.96      fvdl 			 * Force a renegotiation with this target just in
   1194   1.96      fvdl 			 * case the cable was pulled and will later be
   1195   1.96      fvdl 			 * re-attached.  The target may forget its negotiation
   1196   1.96      fvdl 			 * settings with us should it attempt to reselect
   1197   1.96      fvdl 			 * during the interruption.  The target will not issue
   1198   1.96      fvdl 			 * a unit attention in this case, so we must always
   1199   1.96      fvdl 			 * renegotiate.
   1200   1.96      fvdl 			 */
   1201   1.96      fvdl 			ahc_force_renegotiation(ahc);
   1202   1.96      fvdl 			ahc_set_transaction_status(scb, CAM_SEL_TIMEOUT);
   1203   1.96      fvdl 			ahc_freeze_devq(ahc, scb);
   1204   1.96      fvdl 		}
   1205   1.96      fvdl 		ahc_outb(ahc, CLRINT, CLRSCSIINT);
   1206   1.96      fvdl 		ahc_restart(ahc);
   1207   1.96      fvdl 	} else if ((status & BUSFREE) != 0
   1208   1.96      fvdl 		&& (ahc_inb(ahc, SIMODE1) & ENBUSFREE) != 0) {
   1209   1.96      fvdl 		u_int lastphase;
   1210   1.96      fvdl 		u_int saved_scsiid;
   1211   1.96      fvdl 		u_int saved_lun;
   1212   1.96      fvdl 		u_int target;
   1213   1.96      fvdl 		u_int initiator_role_id;
   1214   1.96      fvdl 		char channel;
   1215   1.96      fvdl 		int printerror;
   1216   1.96      fvdl 
   1217   1.96      fvdl 		/*
   1218   1.96      fvdl 		 * Clear our selection hardware as soon as possible.
   1219   1.96      fvdl 		 * We may have an entry in the waiting Q for this target,
   1220   1.96      fvdl 		 * that is affected by this busfree and we don't want to
   1221   1.96      fvdl 		 * go about selecting the target while we handle the event.
   1222   1.96      fvdl 		 */
   1223   1.96      fvdl 		ahc_outb(ahc, SCSISEQ,
   1224   1.96      fvdl 			 ahc_inb(ahc, SCSISEQ) & (ENSELI|ENRSELI|ENAUTOATNP));
   1225   1.96      fvdl 
   1226   1.96      fvdl 		/*
   1227   1.96      fvdl 		 * Disable busfree interrupts and clear the busfree
   1228   1.96      fvdl 		 * interrupt status.  We do this here so that several
   1229   1.96      fvdl 		 * bus transactions occur prior to clearing the SCSIINT
   1230   1.96      fvdl 		 * latch.  It can take a bit for the clearing to take effect.
   1231   1.96      fvdl 		 */
   1232   1.96      fvdl 		ahc_outb(ahc, SIMODE1, ahc_inb(ahc, SIMODE1) & ~ENBUSFREE);
   1233   1.96      fvdl 		ahc_outb(ahc, CLRSINT1, CLRBUSFREE|CLRSCSIPERR);
   1234   1.96      fvdl 
   1235   1.96      fvdl 		/*
   1236   1.96      fvdl 		 * Look at what phase we were last in.
   1237   1.96      fvdl 		 * If its message out, chances are pretty good
   1238   1.96      fvdl 		 * that the busfree was in response to one of
   1239   1.96      fvdl 		 * our abort requests.
   1240   1.96      fvdl 		 */
   1241   1.96      fvdl 		lastphase = ahc_inb(ahc, LASTPHASE);
   1242   1.96      fvdl 		saved_scsiid = ahc_inb(ahc, SAVED_SCSIID);
   1243   1.96      fvdl 		saved_lun = ahc_inb(ahc, SAVED_LUN);
   1244   1.96      fvdl 		target = SCSIID_TARGET(ahc, saved_scsiid);
   1245   1.96      fvdl 		initiator_role_id = SCSIID_OUR_ID(saved_scsiid);
   1246   1.96      fvdl 		channel = SCSIID_CHANNEL(ahc, saved_scsiid);
   1247   1.96      fvdl 		printerror = 1;
   1248   1.96      fvdl 
   1249   1.96      fvdl 		if (lastphase == P_MESGOUT) {
   1250   1.96      fvdl 			struct ahc_devinfo devinfo;
   1251   1.96      fvdl 			u_int tag;
   1252   1.96      fvdl 
   1253   1.96      fvdl 			ahc_fetch_devinfo(ahc, &devinfo);
   1254   1.96      fvdl 			tag = SCB_LIST_NULL;
   1255   1.96      fvdl 			if (ahc_sent_msg(ahc, AHCMSG_1B, MSG_ABORT_TAG, TRUE)
   1256   1.96      fvdl 			    || ahc_sent_msg(ahc, AHCMSG_1B, MSG_ABORT, TRUE)) {
   1257   1.96      fvdl 				if (ahc->msgout_buf[ahc->msgout_index - 1]
   1258   1.96      fvdl 				    == MSG_ABORT_TAG)
   1259   1.96      fvdl 				tag = scb->hscb->tag;
   1260   1.96      fvdl 				ahc_print_path(ahc, scb);
   1261   1.96      fvdl 				printf("SCB %d - Abort%s Completed.\n",
   1262   1.96      fvdl 				       scb->hscb->tag, tag == SCB_LIST_NULL ?
   1263   1.96      fvdl 				       "" : " Tag");
   1264   1.96      fvdl 				ahc_abort_scbs(ahc, target, channel,
   1265   1.96      fvdl 					       saved_lun, tag,
   1266   1.96      fvdl 					       ROLE_INITIATOR,
   1267   1.96      fvdl 					       CAM_REQ_ABORTED);
   1268   1.96      fvdl 				printerror = 0;
   1269   1.96      fvdl 			} else if (ahc_sent_msg(ahc, AHCMSG_1B,
   1270   1.96      fvdl 						MSG_BUS_DEV_RESET, TRUE)) {
   1271   1.96      fvdl #ifdef __FreeBSD__
   1272   1.96      fvdl 				/*
   1273   1.96      fvdl 				 * Don't mark the user's request for this BDR
   1274   1.96      fvdl 				 * as completing with CAM_BDR_SENT.  CAM3
   1275   1.96      fvdl 				 * specifies CAM_REQ_CMP.
   1276   1.96      fvdl 				 */
   1277   1.96      fvdl 				if (scb != NULL
   1278   1.96      fvdl 				 && scb->io_ctx->ccb_h.func_code== XPT_RESET_DEV
   1279   1.96      fvdl 				 && ahc_match_scb(ahc, scb, target, channel,
   1280   1.96      fvdl 						  CAM_LUN_WILDCARD,
   1281   1.96      fvdl 						  SCB_LIST_NULL,
   1282   1.96      fvdl 						  ROLE_INITIATOR)) {
   1283   1.96      fvdl 					ahc_set_transaction_status(scb, CAM_REQ_CMP);
   1284   1.96      fvdl 				}
   1285   1.96      fvdl #endif
   1286   1.96      fvdl 				ahc_compile_devinfo(&devinfo,
   1287   1.96      fvdl 						    initiator_role_id,
   1288   1.96      fvdl 						    target,
   1289   1.96      fvdl 						    CAM_LUN_WILDCARD,
   1290   1.96      fvdl 						    channel,
   1291   1.96      fvdl 						    ROLE_INITIATOR);
   1292   1.96      fvdl 				ahc_handle_devreset(ahc, &devinfo,
   1293   1.96      fvdl 						    CAM_BDR_SENT,
   1294   1.96      fvdl 						    "Bus Device Reset",
   1295   1.96      fvdl 						    /*verbose_level*/0);
   1296   1.96      fvdl 				printerror = 0;
   1297   1.96      fvdl 			} else if (ahc_sent_msg(ahc, AHCMSG_EXT,
   1298   1.96      fvdl 						MSG_EXT_PPR, FALSE)) {
   1299   1.96      fvdl 				struct ahc_initiator_tinfo *tinfo;
   1300   1.96      fvdl 				struct ahc_tmode_tstate *tstate;
   1301   1.96      fvdl 
   1302   1.96      fvdl 				/*
   1303   1.96      fvdl 				 * PPR Rejected.  Try non-ppr negotiation
   1304   1.96      fvdl 				 * and retry command.
   1305   1.96      fvdl 				 */
   1306   1.96      fvdl 				tinfo = ahc_fetch_transinfo(ahc,
   1307   1.96      fvdl 							    devinfo.channel,
   1308   1.96      fvdl 							    devinfo.our_scsiid,
   1309   1.96      fvdl 							    devinfo.target,
   1310   1.96      fvdl 							    &tstate);
   1311   1.96      fvdl 				tinfo->curr.transport_version = 2;
   1312   1.96      fvdl 				tinfo->goal.transport_version = 2;
   1313   1.96      fvdl 				tinfo->goal.ppr_options = 0;
   1314   1.96      fvdl 				ahc_qinfifo_requeue_tail(ahc, scb);
   1315   1.96      fvdl 				printerror = 0;
   1316   1.96      fvdl 			} else if (ahc_sent_msg(ahc, AHCMSG_EXT,
   1317   1.96      fvdl 						MSG_EXT_WDTR, FALSE)
   1318   1.96      fvdl 				|| ahc_sent_msg(ahc, AHCMSG_EXT,
   1319   1.96      fvdl 						MSG_EXT_SDTR, FALSE)) {
   1320   1.96      fvdl 				/*
   1321   1.96      fvdl 				 * Negotiation Rejected.  Go-async and
   1322   1.96      fvdl 				 * retry command.
   1323   1.96      fvdl 				 */
   1324   1.96      fvdl 				ahc_set_width(ahc, &devinfo,
   1325   1.96      fvdl 					      MSG_EXT_WDTR_BUS_8_BIT,
   1326   1.96      fvdl 					      AHC_TRANS_CUR|AHC_TRANS_GOAL,
   1327   1.96      fvdl 					      /*paused*/TRUE);
   1328   1.96      fvdl 				ahc_set_syncrate(ahc, &devinfo,
   1329   1.96      fvdl 						/*syncrate*/NULL,
   1330   1.96      fvdl 						/*period*/0, /*offset*/0,
   1331   1.96      fvdl 						/*ppr_options*/0,
   1332   1.96      fvdl 						AHC_TRANS_CUR|AHC_TRANS_GOAL,
   1333   1.96      fvdl 						/*paused*/TRUE);
   1334   1.96      fvdl 				ahc_qinfifo_requeue_tail(ahc, scb);
   1335   1.96      fvdl 				printerror = 0;
   1336   1.96      fvdl 			}
   1337   1.96      fvdl 		}
   1338   1.96      fvdl 		if (printerror != 0) {
   1339   1.96      fvdl 			u_int i;
   1340   1.96      fvdl 
   1341   1.96      fvdl 			if (scb != NULL) {
   1342   1.96      fvdl 				u_int tag;
   1343   1.96      fvdl 
   1344   1.96      fvdl 				if ((scb->hscb->control & TAG_ENB) != 0)
   1345   1.96      fvdl 					tag = scb->hscb->tag;
   1346   1.96      fvdl 				else
   1347   1.96      fvdl 					tag = SCB_LIST_NULL;
   1348   1.96      fvdl 				ahc_print_path(ahc, scb);
   1349   1.96      fvdl 				ahc_abort_scbs(ahc, target, channel,
   1350   1.96      fvdl 					       SCB_GET_LUN(scb), tag,
   1351   1.96      fvdl 					       ROLE_INITIATOR,
   1352   1.96      fvdl 					       CAM_UNEXP_BUSFREE);
   1353   1.96      fvdl 			} else {
   1354   1.96      fvdl 				/*
   1355   1.96      fvdl 				 * We had not fully identified this connection,
   1356   1.96      fvdl 				 * so we cannot abort anything.
   1357   1.96      fvdl 				 */
   1358   1.96      fvdl 				printf("%s: ", ahc_name(ahc));
   1359   1.96      fvdl 			}
   1360   1.96      fvdl 			for (i = 0; i < num_phases; i++) {
   1361   1.96      fvdl 				if (lastphase == ahc_phase_table[i].phase)
   1362   1.96      fvdl 					break;
   1363   1.96      fvdl 			}
   1364   1.96      fvdl 			/*
   1365   1.96      fvdl 			 * Renegotiate with this device at the
   1366   1.96      fvdl 			 * next oportunity just in case this busfree
   1367   1.96      fvdl 			 * is due to a negotiation mismatch with the
   1368   1.96      fvdl 			 * device.
   1369   1.96      fvdl 			 */
   1370   1.96      fvdl 			ahc_force_renegotiation(ahc);
   1371   1.96      fvdl 			printf("Unexpected busfree %s\n"
   1372   1.96      fvdl 			       "SEQADDR == 0x%x\n",
   1373   1.96      fvdl 			       ahc_phase_table[i].phasemsg,
   1374   1.96      fvdl 			       ahc_inb(ahc, SEQADDR0)
   1375   1.96      fvdl 				| (ahc_inb(ahc, SEQADDR1) << 8));
   1376   1.96      fvdl 		}
   1377   1.96      fvdl 		ahc_outb(ahc, CLRINT, CLRSCSIINT);
   1378   1.96      fvdl 		ahc_restart(ahc);
   1379   1.96      fvdl 	} else {
   1380   1.96      fvdl 		printf("%s: Missing case in ahc_handle_scsiint. status = %x\n",
   1381   1.96      fvdl 		       ahc_name(ahc), status);
   1382   1.96      fvdl 		ahc_outb(ahc, CLRINT, CLRSCSIINT);
   1383   1.96      fvdl 	}
   1384   1.96      fvdl }
   1385   1.96      fvdl 
   1386   1.96      fvdl /*
   1387   1.96      fvdl  * Force renegotiation to occur the next time we initiate
   1388   1.96      fvdl  * a command to the current device.
   1389   1.96      fvdl  */
   1390   1.96      fvdl static void
   1391   1.96      fvdl ahc_force_renegotiation(struct ahc_softc *ahc)
   1392   1.96      fvdl {
   1393   1.96      fvdl 	struct	ahc_devinfo devinfo;
   1394   1.96      fvdl 	struct	ahc_initiator_tinfo *targ_info;
   1395   1.96      fvdl 	struct	ahc_tmode_tstate *tstate;
   1396   1.96      fvdl 
   1397   1.96      fvdl 	ahc_fetch_devinfo(ahc, &devinfo);
   1398   1.96      fvdl 	targ_info = ahc_fetch_transinfo(ahc,
   1399   1.96      fvdl 					devinfo.channel,
   1400   1.96      fvdl 					devinfo.our_scsiid,
   1401   1.96      fvdl 					devinfo.target,
   1402   1.96      fvdl 					&tstate);
   1403   1.96      fvdl 	ahc_update_neg_request(ahc, &devinfo, tstate,
   1404   1.96      fvdl 			       targ_info, AHC_NEG_IF_NON_ASYNC);
   1405   1.96      fvdl }
   1406   1.96      fvdl 
   1407   1.96      fvdl #define AHC_MAX_STEPS 2000
   1408   1.96      fvdl void
   1409   1.96      fvdl ahc_clear_critical_section(struct ahc_softc *ahc)
   1410   1.96      fvdl {
   1411   1.96      fvdl 	int	stepping;
   1412   1.96      fvdl 	int	steps;
   1413   1.96      fvdl 	u_int	simode0;
   1414   1.96      fvdl 	u_int	simode1;
   1415   1.96      fvdl 
   1416   1.96      fvdl 	if (ahc->num_critical_sections == 0)
   1417   1.96      fvdl 		return;
   1418   1.96      fvdl 
   1419   1.96      fvdl 	stepping = FALSE;
   1420   1.96      fvdl 	steps = 0;
   1421   1.96      fvdl 	simode0 = 0;
   1422   1.96      fvdl 	simode1 = 0;
   1423   1.96      fvdl 	for (;;) {
   1424   1.96      fvdl 		struct	cs *cs;
   1425   1.96      fvdl 		u_int	seqaddr;
   1426   1.96      fvdl 		u_int	i;
   1427   1.96      fvdl 
   1428   1.96      fvdl 		seqaddr = ahc_inb(ahc, SEQADDR0)
   1429   1.96      fvdl 			| (ahc_inb(ahc, SEQADDR1) << 8);
   1430   1.96      fvdl 
   1431   1.96      fvdl 		/*
   1432   1.96      fvdl 		 * Seqaddr represents the next instruction to execute,
   1433   1.96      fvdl 		 * so we are really executing the instruction just
   1434   1.96      fvdl 		 * before it.
   1435   1.96      fvdl 		 */
   1436   1.96      fvdl 		if (seqaddr != 0)
   1437   1.96      fvdl 			seqaddr -= 1;
   1438   1.96      fvdl 		cs = ahc->critical_sections;
   1439   1.96      fvdl 		for (i = 0; i < ahc->num_critical_sections; i++, cs++) {
   1440   1.96      fvdl 
   1441   1.96      fvdl 			if (cs->begin < seqaddr && cs->end >= seqaddr)
   1442   1.96      fvdl 				break;
   1443   1.96      fvdl 		}
   1444   1.96      fvdl 
   1445   1.96      fvdl 		if (i == ahc->num_critical_sections)
   1446   1.96      fvdl 			break;
   1447   1.96      fvdl 
   1448   1.96      fvdl 		if (steps > AHC_MAX_STEPS) {
   1449   1.96      fvdl 			printf("%s: Infinite loop in critical section\n",
   1450   1.96      fvdl 			       ahc_name(ahc));
   1451   1.96      fvdl 			ahc_dump_card_state(ahc);
   1452   1.96      fvdl 			panic("critical section loop");
   1453   1.96      fvdl 		}
   1454   1.96      fvdl 
   1455   1.96      fvdl 		steps++;
   1456   1.96      fvdl 		if (stepping == FALSE) {
   1457   1.96      fvdl 
   1458   1.96      fvdl 			/*
   1459   1.96      fvdl 			 * Disable all interrupt sources so that the
   1460   1.96      fvdl 			 * sequencer will not be stuck by a pausing
   1461   1.96      fvdl 			 * interrupt condition while we attempt to
   1462   1.96      fvdl 			 * leave a critical section.
   1463   1.96      fvdl 			 */
   1464   1.96      fvdl 			simode0 = ahc_inb(ahc, SIMODE0);
   1465   1.96      fvdl 			ahc_outb(ahc, SIMODE0, 0);
   1466   1.96      fvdl 			simode1 = ahc_inb(ahc, SIMODE1);
   1467   1.96      fvdl 			if ((ahc->features & AHC_DT) != 0)
   1468   1.96      fvdl 				/*
   1469   1.96      fvdl 				 * On DT class controllers, we
   1470   1.96      fvdl 				 * use the enhanced busfree logic.
   1471   1.96      fvdl 				 * Unfortunately we cannot re-enable
   1472   1.96      fvdl 				 * busfree detection within the
   1473   1.96      fvdl 				 * current connection, so we must
   1474   1.96      fvdl 				 * leave it on while single stepping.
   1475   1.96      fvdl 				 */
   1476   1.96      fvdl 				ahc_outb(ahc, SIMODE1, ENBUSFREE);
   1477   1.96      fvdl 			else
   1478   1.96      fvdl 				ahc_outb(ahc, SIMODE1, 0);
   1479   1.96      fvdl 			ahc_outb(ahc, CLRINT, CLRSCSIINT);
   1480   1.96      fvdl 			ahc_outb(ahc, SEQCTL, ahc_inb(ahc, SEQCTL) | STEP);
   1481   1.96      fvdl 			stepping = TRUE;
   1482   1.96      fvdl 		}
   1483   1.96      fvdl 		if ((ahc->features & AHC_DT) != 0) {
   1484   1.96      fvdl 			ahc_outb(ahc, CLRSINT1, CLRBUSFREE);
   1485   1.96      fvdl 			ahc_outb(ahc, CLRINT, CLRSCSIINT);
   1486   1.96      fvdl 		}
   1487   1.96      fvdl 		ahc_outb(ahc, HCNTRL, ahc->unpause);
   1488   1.96      fvdl 		while (!ahc_is_paused(ahc))
   1489   1.96      fvdl 			ahc_delay(200);
   1490   1.96      fvdl 	}
   1491   1.96      fvdl 	if (stepping) {
   1492   1.96      fvdl 		ahc_outb(ahc, SIMODE0, simode0);
   1493   1.96      fvdl 		ahc_outb(ahc, SIMODE1, simode1);
   1494   1.96      fvdl 		ahc_outb(ahc, SEQCTL, ahc_inb(ahc, SEQCTL) & ~STEP);
   1495   1.96      fvdl 	}
   1496   1.96      fvdl }
   1497   1.96      fvdl 
   1498   1.96      fvdl /*
   1499   1.96      fvdl  * Clear any pending interrupt status.
   1500   1.96      fvdl  */
   1501   1.96      fvdl void
   1502   1.96      fvdl ahc_clear_intstat(struct ahc_softc *ahc)
   1503   1.96      fvdl {
   1504   1.96      fvdl 	/* Clear any interrupt conditions this may have caused */
   1505   1.96      fvdl 	ahc_outb(ahc, CLRSINT1, CLRSELTIMEO|CLRATNO|CLRSCSIRSTI
   1506   1.96      fvdl 				|CLRBUSFREE|CLRSCSIPERR|CLRPHASECHG|
   1507   1.96      fvdl 				CLRREQINIT);
   1508   1.96      fvdl 	ahc_flush_device_writes(ahc);
   1509   1.96      fvdl 	ahc_outb(ahc, CLRSINT0, CLRSELDO|CLRSELDI|CLRSELINGO);
   1510   1.96      fvdl  	ahc_flush_device_writes(ahc);
   1511   1.96      fvdl 	ahc_outb(ahc, CLRINT, CLRSCSIINT);
   1512   1.96      fvdl 	ahc_flush_device_writes(ahc);
   1513   1.96      fvdl }
   1514   1.96      fvdl 
   1515   1.96      fvdl /**************************** Debugging Routines ******************************/
   1516   1.96      fvdl #ifdef AHC_DEBUG
   1517   1.96      fvdl uint32_t ahc_debug = 0; /* AHC_SHOW_MISC|AHC_SHOW_SENSE|AHC_DEBUG_OPTS;*/
   1518   1.96      fvdl #endif
   1519   1.96      fvdl 
   1520   1.96      fvdl void
   1521   1.96      fvdl ahc_print_scb(struct scb *scb)
   1522   1.96      fvdl {
   1523   1.96      fvdl 	int i;
   1524   1.96      fvdl 
   1525   1.96      fvdl 	struct hardware_scb *hscb = scb->hscb;
   1526   1.96      fvdl 
   1527   1.96      fvdl 	printf("scb:%p control:0x%x scsiid:0x%x lun:%d cdb_len:%d\n",
   1528   1.96      fvdl 	       (void *)scb,
   1529   1.96      fvdl 	       hscb->control,
   1530   1.96      fvdl 	       hscb->scsiid,
   1531   1.96      fvdl 	       hscb->lun,
   1532   1.96      fvdl 	       hscb->cdb_len);
   1533   1.96      fvdl 	printf("Shared Data: ");
   1534   1.96      fvdl 	for (i = 0; i < sizeof(hscb->shared_data.cdb); i++)
   1535   1.96      fvdl 		printf("%#02x", hscb->shared_data.cdb[i]);
   1536   1.96      fvdl 	printf("        dataptr:%#x datacnt:%#x sgptr:%#x tag:%#x\n",
   1537   1.96      fvdl 		ahc_le32toh(hscb->dataptr),
   1538   1.96      fvdl 		ahc_le32toh(hscb->datacnt),
   1539   1.96      fvdl 		ahc_le32toh(hscb->sgptr),
   1540   1.96      fvdl 		hscb->tag);
   1541   1.96      fvdl 	if (scb->sg_count > 0) {
   1542   1.96      fvdl 		for (i = 0; i < scb->sg_count; i++) {
   1543   1.96      fvdl 			printf("sg[%d] - Addr 0x%x%x : Length %d\n",
   1544   1.96      fvdl 			       i,
   1545   1.96      fvdl 			       (ahc_le32toh(scb->sg_list[i].len) >> 24
   1546   1.96      fvdl 			        & SG_HIGH_ADDR_BITS),
   1547   1.96      fvdl 			       ahc_le32toh(scb->sg_list[i].addr),
   1548   1.96      fvdl 			       ahc_le32toh(scb->sg_list[i].len));
   1549   1.96      fvdl 		}
   1550   1.96      fvdl 	}
   1551   1.96      fvdl }
   1552   1.96      fvdl 
   1553   1.96      fvdl /************************* Transfer Negotiation *******************************/
   1554   1.96      fvdl /*
   1555   1.96      fvdl  * Allocate per target mode instance (ID we respond to as a target)
   1556   1.96      fvdl  * transfer negotiation data structures.
   1557   1.96      fvdl  */
   1558   1.96      fvdl static struct ahc_tmode_tstate *
   1559   1.96      fvdl ahc_alloc_tstate(struct ahc_softc *ahc, u_int scsi_id, char channel)
   1560   1.96      fvdl {
   1561   1.96      fvdl 	struct ahc_tmode_tstate *master_tstate;
   1562   1.96      fvdl 	struct ahc_tmode_tstate *tstate;
   1563   1.96      fvdl 	int i;
   1564   1.96      fvdl 
   1565   1.96      fvdl 	master_tstate = ahc->enabled_targets[ahc->our_id];
   1566   1.96      fvdl 	if (channel == 'B') {
   1567   1.96      fvdl 		scsi_id += 8;
   1568   1.96      fvdl 		master_tstate = ahc->enabled_targets[ahc->our_id_b + 8];
   1569   1.96      fvdl 	}
   1570   1.96      fvdl 	if (ahc->enabled_targets[scsi_id] != NULL
   1571   1.96      fvdl 	    && ahc->enabled_targets[scsi_id] != master_tstate)
   1572   1.96      fvdl 		panic("%s: ahc_alloc_tstate - Target already allocated",
   1573   1.96      fvdl 		      ahc_name(ahc));
   1574   1.96      fvdl 	tstate = (struct ahc_tmode_tstate*)malloc(sizeof(*tstate),
   1575   1.96      fvdl 						   M_DEVBUF, M_NOWAIT);
   1576   1.96      fvdl 	if (tstate == NULL)
   1577   1.96      fvdl 		return (NULL);
   1578   1.96      fvdl 
   1579   1.96      fvdl 	/*
   1580   1.96      fvdl 	 * If we have allocated a master tstate, copy user settings from
   1581   1.96      fvdl 	 * the master tstate (taken from SRAM or the EEPROM) for this
   1582   1.96      fvdl 	 * channel, but reset our current and goal settings to async/narrow
   1583   1.96      fvdl 	 * until an initiator talks to us.
   1584   1.96      fvdl 	 */
   1585   1.96      fvdl 	if (master_tstate != NULL) {
   1586   1.96      fvdl 		memcpy(tstate, master_tstate, sizeof(*tstate));
   1587   1.96      fvdl 		memset(tstate->enabled_luns, 0, sizeof(tstate->enabled_luns));
   1588   1.96      fvdl 		tstate->ultraenb = 0;
   1589   1.96      fvdl 		for (i = 0; i < AHC_NUM_TARGETS; i++) {
   1590   1.96      fvdl 			memset(&tstate->transinfo[i].curr, 0,
   1591   1.96      fvdl 			      sizeof(tstate->transinfo[i].curr));
   1592   1.96      fvdl 			memset(&tstate->transinfo[i].goal, 0,
   1593   1.96      fvdl 			      sizeof(tstate->transinfo[i].goal));
   1594   1.96      fvdl 		}
   1595   1.96      fvdl 	} else
   1596   1.96      fvdl 		memset(tstate, 0, sizeof(*tstate));
   1597   1.96      fvdl 	ahc->enabled_targets[scsi_id] = tstate;
   1598   1.96      fvdl 	return (tstate);
   1599   1.96      fvdl }
   1600   1.96      fvdl 
   1601   1.96      fvdl #ifdef AHC_TARGET_MODE
   1602   1.96      fvdl /*
   1603   1.96      fvdl  * Free per target mode instance (ID we respond to as a target)
   1604   1.96      fvdl  * transfer negotiation data structures.
   1605   1.96      fvdl  */
   1606   1.96      fvdl static void
   1607   1.96      fvdl ahc_free_tstate(struct ahc_softc *ahc, u_int scsi_id, char channel, int force)
   1608   1.96      fvdl {
   1609   1.96      fvdl 	struct ahc_tmode_tstate *tstate;
   1610   1.96      fvdl 
   1611   1.96      fvdl 	/*
   1612   1.96      fvdl 	 * Don't clean up our "master" tstate.
   1613   1.96      fvdl 	 * It has our default user settings.
   1614   1.96      fvdl 	 */
   1615   1.96      fvdl 	if (((channel == 'B' && scsi_id == ahc->our_id_b)
   1616   1.96      fvdl 	  || (channel == 'A' && scsi_id == ahc->our_id))
   1617   1.96      fvdl 	 && force == FALSE)
   1618   1.96      fvdl 		return;
   1619   1.96      fvdl 
   1620   1.96      fvdl 	if (channel == 'B')
   1621   1.96      fvdl 		scsi_id += 8;
   1622   1.96      fvdl 	tstate = ahc->enabled_targets[scsi_id];
   1623   1.96      fvdl 	if (tstate != NULL)
   1624   1.96      fvdl 		free(tstate, M_DEVBUF);
   1625   1.96      fvdl 	ahc->enabled_targets[scsi_id] = NULL;
   1626   1.96      fvdl }
   1627   1.96      fvdl #endif
   1628   1.96      fvdl 
   1629   1.96      fvdl /*
   1630   1.96      fvdl  * Called when we have an active connection to a target on the bus,
   1631   1.96      fvdl  * this function finds the nearest syncrate to the input period limited
   1632   1.96      fvdl  * by the capabilities of the bus connectivity of and sync settings for
   1633   1.96      fvdl  * the target.
   1634   1.96      fvdl  */
   1635   1.96      fvdl struct ahc_syncrate *
   1636   1.96      fvdl ahc_devlimited_syncrate(struct ahc_softc *ahc,
   1637   1.96      fvdl 			struct ahc_initiator_tinfo *tinfo,
   1638   1.96      fvdl 			u_int *period, u_int *ppr_options, role_t role)
   1639   1.96      fvdl {
   1640   1.96      fvdl 	struct	ahc_transinfo *transinfo;
   1641   1.96      fvdl 	u_int	maxsync;
   1642   1.96      fvdl 
   1643   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0) {
   1644   1.96      fvdl 		if ((ahc_inb(ahc, SBLKCTL) & ENAB40) != 0
   1645   1.96      fvdl 		 && (ahc_inb(ahc, SSTAT2) & EXP_ACTIVE) == 0) {
   1646   1.96      fvdl 			maxsync = AHC_SYNCRATE_DT;
   1647   1.96      fvdl 		} else {
   1648   1.96      fvdl 			maxsync = AHC_SYNCRATE_ULTRA;
   1649   1.96      fvdl 			/* Can't do DT on an SE bus */
   1650   1.96      fvdl 			*ppr_options &= ~MSG_EXT_PPR_DT_REQ;
   1651   1.96      fvdl 		}
   1652   1.96      fvdl 	} else if ((ahc->features & AHC_ULTRA) != 0) {
   1653   1.96      fvdl 		maxsync = AHC_SYNCRATE_ULTRA;
   1654   1.96      fvdl 	} else {
   1655   1.96      fvdl 		maxsync = AHC_SYNCRATE_FAST;
   1656   1.96      fvdl 	}
   1657   1.96      fvdl 	/*
   1658   1.96      fvdl 	 * Never allow a value higher than our current goal
   1659   1.96      fvdl 	 * period otherwise we may allow a target initiated
   1660   1.96      fvdl 	 * negotiation to go above the limit as set by the
   1661   1.96      fvdl 	 * user.  In the case of an initiator initiated
   1662   1.96      fvdl 	 * sync negotiation, we limit based on the user
   1663   1.96      fvdl 	 * setting.  This allows the system to still accept
   1664   1.96      fvdl 	 * incoming negotiations even if target initiated
   1665   1.96      fvdl 	 * negotiation is not performed.
   1666   1.96      fvdl 	 */
   1667   1.96      fvdl 	if (role == ROLE_TARGET)
   1668   1.96      fvdl 		transinfo = &tinfo->user;
   1669   1.96      fvdl 	else
   1670   1.96      fvdl 		transinfo = &tinfo->goal;
   1671   1.96      fvdl 	*ppr_options &= transinfo->ppr_options;
   1672   1.96      fvdl 	if (transinfo->width == MSG_EXT_WDTR_BUS_8_BIT) {
   1673   1.96      fvdl 		maxsync = MAX(maxsync, AHC_SYNCRATE_ULTRA2);
   1674   1.96      fvdl 		*ppr_options &= ~MSG_EXT_PPR_DT_REQ;
   1675   1.96      fvdl 	}
   1676   1.96      fvdl 	if (transinfo->period == 0) {
   1677   1.96      fvdl 		*period = 0;
   1678   1.96      fvdl 		*ppr_options = 0;
   1679   1.96      fvdl 		return (NULL);
   1680   1.96      fvdl 	}
   1681   1.96      fvdl 	*period = MAX(*period, transinfo->period);
   1682   1.96      fvdl 	return (ahc_find_syncrate(ahc, period, ppr_options, maxsync));
   1683   1.96      fvdl }
   1684   1.96      fvdl 
   1685   1.96      fvdl /*
   1686   1.96      fvdl  * Look up the valid period to SCSIRATE conversion in our table.
   1687   1.96      fvdl  * Return the period and offset that should be sent to the target
   1688   1.96      fvdl  * if this was the beginning of an SDTR.
   1689   1.96      fvdl  */
   1690   1.96      fvdl struct ahc_syncrate *
   1691   1.96      fvdl ahc_find_syncrate(struct ahc_softc *ahc, u_int *period,
   1692   1.96      fvdl 		  u_int *ppr_options, u_int maxsync)
   1693   1.96      fvdl {
   1694   1.96      fvdl 	struct ahc_syncrate *syncrate;
   1695   1.96      fvdl 
   1696   1.96      fvdl 	if ((ahc->features & AHC_DT) == 0)
   1697   1.96      fvdl 		*ppr_options &= ~MSG_EXT_PPR_DT_REQ;
   1698   1.96      fvdl 
   1699   1.96      fvdl 	/* Skip all DT only entries if DT is not available */
   1700   1.96      fvdl 	if ((*ppr_options & MSG_EXT_PPR_DT_REQ) == 0
   1701   1.96      fvdl 	 && maxsync < AHC_SYNCRATE_ULTRA2)
   1702   1.96      fvdl 		maxsync = AHC_SYNCRATE_ULTRA2;
   1703   1.96      fvdl 
   1704   1.96      fvdl 	for (syncrate = &ahc_syncrates[maxsync];
   1705   1.96      fvdl 	     syncrate->rate != NULL;
   1706   1.96      fvdl 	     syncrate++) {
   1707   1.96      fvdl 
   1708   1.96      fvdl 		/*
   1709   1.96      fvdl 		 * The Ultra2 table doesn't go as low
   1710   1.96      fvdl 		 * as for the Fast/Ultra cards.
   1711   1.96      fvdl 		 */
   1712   1.96      fvdl 		if ((ahc->features & AHC_ULTRA2) != 0
   1713   1.96      fvdl 		 && (syncrate->sxfr_u2 == 0))
   1714   1.96      fvdl 			break;
   1715   1.96      fvdl 
   1716   1.96      fvdl 		if (*period <= syncrate->period) {
   1717   1.96      fvdl 			/*
   1718   1.96      fvdl 			 * When responding to a target that requests
   1719   1.96      fvdl 			 * sync, the requested rate may fall between
   1720   1.96      fvdl 			 * two rates that we can output, but still be
   1721   1.96      fvdl 			 * a rate that we can receive.  Because of this,
   1722   1.96      fvdl 			 * we want to respond to the target with
   1723   1.96      fvdl 			 * the same rate that it sent to us even
   1724   1.96      fvdl 			 * if the period we use to send data to it
   1725   1.96      fvdl 			 * is lower.  Only lower the response period
   1726   1.96      fvdl 			 * if we must.
   1727   1.96      fvdl 			 */
   1728   1.96      fvdl 			if (syncrate == &ahc_syncrates[maxsync])
   1729   1.96      fvdl 				*period = syncrate->period;
   1730   1.96      fvdl 
   1731   1.96      fvdl 			/*
   1732   1.96      fvdl 			 * At some speeds, we only support
   1733   1.96      fvdl 			 * ST transfers.
   1734   1.96      fvdl 			 */
   1735   1.96      fvdl 		 	if ((syncrate->sxfr_u2 & ST_SXFR) != 0)
   1736   1.96      fvdl 				*ppr_options &= ~MSG_EXT_PPR_DT_REQ;
   1737   1.96      fvdl 			break;
   1738   1.96      fvdl 		}
   1739   1.96      fvdl 	}
   1740   1.96      fvdl 
   1741   1.96      fvdl 	if ((*period == 0)
   1742   1.96      fvdl 	 || (syncrate->rate == NULL)
   1743   1.96      fvdl 	 || ((ahc->features & AHC_ULTRA2) != 0
   1744   1.96      fvdl 	  && (syncrate->sxfr_u2 == 0))) {
   1745   1.96      fvdl 		/* Use asynchronous transfers. */
   1746   1.96      fvdl 		*period = 0;
   1747   1.96      fvdl 		syncrate = NULL;
   1748   1.96      fvdl 		*ppr_options &= ~MSG_EXT_PPR_DT_REQ;
   1749   1.96      fvdl 	}
   1750   1.96      fvdl 	return (syncrate);
   1751   1.96      fvdl }
   1752   1.96      fvdl 
   1753   1.96      fvdl /*
   1754   1.96      fvdl  * Convert from an entry in our syncrate table to the SCSI equivalent
   1755   1.96      fvdl  * sync "period" factor.
   1756   1.96      fvdl  */
   1757   1.96      fvdl u_int
   1758   1.96      fvdl ahc_find_period(struct ahc_softc *ahc, u_int scsirate, u_int maxsync)
   1759   1.96      fvdl {
   1760   1.96      fvdl 	struct ahc_syncrate *syncrate;
   1761   1.96      fvdl 
   1762   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0)
   1763   1.96      fvdl 		scsirate &= SXFR_ULTRA2;
   1764   1.96      fvdl 	else
   1765   1.96      fvdl 		scsirate &= SXFR;
   1766   1.96      fvdl 
   1767   1.96      fvdl 	syncrate = &ahc_syncrates[maxsync];
   1768   1.96      fvdl 	while (syncrate->rate != NULL) {
   1769   1.96      fvdl 
   1770   1.96      fvdl 		if ((ahc->features & AHC_ULTRA2) != 0) {
   1771   1.96      fvdl 			if (syncrate->sxfr_u2 == 0)
   1772   1.96      fvdl 				break;
   1773   1.96      fvdl 			else if (scsirate == (syncrate->sxfr_u2 & SXFR_ULTRA2))
   1774   1.96      fvdl 				return (syncrate->period);
   1775   1.96      fvdl 		} else if (scsirate == (syncrate->sxfr & SXFR)) {
   1776   1.96      fvdl 				return (syncrate->period);
   1777   1.96      fvdl 		}
   1778   1.96      fvdl 		syncrate++;
   1779   1.96      fvdl 	}
   1780   1.96      fvdl 	return (0); /* async */
   1781   1.96      fvdl }
   1782   1.96      fvdl 
   1783   1.96      fvdl /*
   1784   1.96      fvdl  * Truncate the given synchronous offset to a value the
   1785   1.96      fvdl  * current adapter type and syncrate are capable of.
   1786   1.96      fvdl  */
   1787   1.96      fvdl void
   1788   1.96      fvdl ahc_validate_offset(struct ahc_softc *ahc,
   1789   1.96      fvdl 		    struct ahc_initiator_tinfo *tinfo,
   1790   1.96      fvdl 		    struct ahc_syncrate *syncrate,
   1791   1.96      fvdl 		    u_int *offset, int wide, role_t role)
   1792   1.96      fvdl {
   1793   1.96      fvdl 	u_int maxoffset;
   1794   1.96      fvdl 
   1795   1.96      fvdl 	/* Limit offset to what we can do */
   1796   1.96      fvdl 	if (syncrate == NULL) {
   1797   1.96      fvdl 		maxoffset = 0;
   1798   1.96      fvdl 	} else if ((ahc->features & AHC_ULTRA2) != 0) {
   1799   1.96      fvdl 		maxoffset = MAX_OFFSET_ULTRA2;
   1800   1.96      fvdl 	} else {
   1801   1.96      fvdl 		if (wide)
   1802   1.96      fvdl 			maxoffset = MAX_OFFSET_16BIT;
   1803   1.96      fvdl 		else
   1804   1.96      fvdl 			maxoffset = MAX_OFFSET_8BIT;
   1805   1.96      fvdl 	}
   1806   1.96      fvdl 	*offset = MIN(*offset, maxoffset);
   1807   1.96      fvdl 	if (tinfo != NULL) {
   1808   1.96      fvdl 		if (role == ROLE_TARGET)
   1809   1.96      fvdl 			*offset = MIN(*offset, tinfo->user.offset);
   1810   1.96      fvdl 		else
   1811   1.96      fvdl 			*offset = MIN(*offset, tinfo->goal.offset);
   1812   1.96      fvdl 	}
   1813   1.96      fvdl }
   1814   1.96      fvdl 
   1815   1.96      fvdl /*
   1816   1.96      fvdl  * Truncate the given transfer width parameter to a value the
   1817   1.96      fvdl  * current adapter type is capable of.
   1818   1.96      fvdl  */
   1819   1.96      fvdl void
   1820   1.96      fvdl ahc_validate_width(struct ahc_softc *ahc, struct ahc_initiator_tinfo *tinfo,
   1821   1.96      fvdl 		   u_int *bus_width, role_t role)
   1822   1.96      fvdl {
   1823   1.96      fvdl 	switch (*bus_width) {
   1824   1.96      fvdl 	default:
   1825   1.96      fvdl 		if (ahc->features & AHC_WIDE) {
   1826   1.96      fvdl 			/* Respond Wide */
   1827   1.96      fvdl 			*bus_width = MSG_EXT_WDTR_BUS_16_BIT;
   1828   1.96      fvdl 			break;
   1829   1.96      fvdl 		}
   1830   1.96      fvdl 		/* FALLTHROUGH */
   1831   1.96      fvdl 	case MSG_EXT_WDTR_BUS_8_BIT:
   1832   1.96      fvdl 		*bus_width = MSG_EXT_WDTR_BUS_8_BIT;
   1833   1.96      fvdl 		break;
   1834   1.96      fvdl 	}
   1835   1.96      fvdl 	if (tinfo != NULL) {
   1836   1.96      fvdl 		if (role == ROLE_TARGET)
   1837   1.96      fvdl 			*bus_width = MIN(tinfo->user.width, *bus_width);
   1838   1.96      fvdl 		else
   1839   1.96      fvdl 			*bus_width = MIN(tinfo->goal.width, *bus_width);
   1840   1.96      fvdl 	}
   1841   1.96      fvdl }
   1842   1.96      fvdl 
   1843   1.96      fvdl /*
   1844   1.96      fvdl  * Update the bitmask of targets for which the controller should
   1845   1.96      fvdl  * negotiate with at the next convenient oportunity.  This currently
   1846   1.96      fvdl  * means the next time we send the initial identify messages for
   1847   1.96      fvdl  * a new transaction.
   1848   1.96      fvdl  */
   1849   1.96      fvdl int
   1850   1.96      fvdl ahc_update_neg_request(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   1851   1.96      fvdl 		       struct ahc_tmode_tstate *tstate,
   1852   1.96      fvdl 		       struct ahc_initiator_tinfo *tinfo, ahc_neg_type neg_type)
   1853   1.96      fvdl {
   1854   1.96      fvdl 	u_int auto_negotiate_orig;
   1855   1.96      fvdl 
   1856   1.96      fvdl 	auto_negotiate_orig = tstate->auto_negotiate;
   1857   1.96      fvdl 	if (neg_type == AHC_NEG_ALWAYS) {
   1858   1.96      fvdl 		/*
   1859   1.96      fvdl 		 * Force our "current" settings to be
   1860   1.96      fvdl 		 * unknown so that unless a bus reset
   1861   1.96      fvdl 		 * occurs the need to renegotiate is
   1862   1.96      fvdl 		 * recorded persistently.
   1863   1.96      fvdl 		 */
   1864   1.96      fvdl 		if ((ahc->features & AHC_WIDE) != 0)
   1865   1.96      fvdl 			tinfo->curr.width = AHC_WIDTH_UNKNOWN;
   1866   1.96      fvdl 		tinfo->curr.period = AHC_PERIOD_UNKNOWN;
   1867   1.96      fvdl 		tinfo->curr.offset = AHC_OFFSET_UNKNOWN;
   1868   1.96      fvdl 	}
   1869   1.96      fvdl 	if (tinfo->curr.period != tinfo->goal.period
   1870   1.96      fvdl 	 || tinfo->curr.width != tinfo->goal.width
   1871   1.96      fvdl 	 || tinfo->curr.offset != tinfo->goal.offset
   1872   1.96      fvdl 	 || tinfo->curr.ppr_options != tinfo->goal.ppr_options
   1873   1.96      fvdl 	 || (neg_type == AHC_NEG_IF_NON_ASYNC
   1874   1.96      fvdl 	  && (tinfo->goal.offset != 0
   1875   1.96      fvdl 	   || tinfo->goal.width != MSG_EXT_WDTR_BUS_8_BIT
   1876   1.96      fvdl 	   || tinfo->goal.ppr_options != 0)))
   1877   1.96      fvdl 		tstate->auto_negotiate |= devinfo->target_mask;
   1878   1.96      fvdl 	else
   1879   1.96      fvdl 		tstate->auto_negotiate &= ~devinfo->target_mask;
   1880   1.96      fvdl 
   1881   1.96      fvdl 	return (auto_negotiate_orig != tstate->auto_negotiate);
   1882   1.96      fvdl }
   1883   1.96      fvdl 
   1884   1.96      fvdl /*
   1885   1.96      fvdl  * Update the user/goal/curr tables of synchronous negotiation
   1886   1.96      fvdl  * parameters as well as, in the case of a current or active update,
   1887   1.96      fvdl  * any data structures on the host controller.  In the case of an
   1888   1.96      fvdl  * active update, the specified target is currently talking to us on
   1889   1.96      fvdl  * the bus, so the transfer parameter update must take effect
   1890   1.96      fvdl  * immediately.
   1891   1.96      fvdl  */
   1892   1.96      fvdl void
   1893   1.96      fvdl ahc_set_syncrate(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   1894   1.96      fvdl 		 struct ahc_syncrate *syncrate, u_int period,
   1895   1.96      fvdl 		 u_int offset, u_int ppr_options, u_int type, int paused)
   1896   1.96      fvdl {
   1897   1.96      fvdl 	struct	ahc_initiator_tinfo *tinfo;
   1898   1.96      fvdl 	struct	ahc_tmode_tstate *tstate;
   1899   1.96      fvdl 	u_int	old_period;
   1900   1.96      fvdl 	u_int	old_offset;
   1901   1.96      fvdl 	u_int	old_ppr;
   1902   1.96      fvdl 	int	active;
   1903   1.96      fvdl 	int	update_needed;
   1904   1.96      fvdl 
   1905   1.96      fvdl 	active = (type & AHC_TRANS_ACTIVE) == AHC_TRANS_ACTIVE;
   1906   1.96      fvdl 	update_needed = 0;
   1907   1.96      fvdl 
   1908   1.96      fvdl 	if (syncrate == NULL) {
   1909   1.96      fvdl 		period = 0;
   1910   1.96      fvdl 		offset = 0;
   1911   1.96      fvdl 	}
   1912   1.96      fvdl 
   1913   1.96      fvdl 	tinfo = ahc_fetch_transinfo(ahc, devinfo->channel, devinfo->our_scsiid,
   1914   1.96      fvdl 				    devinfo->target, &tstate);
   1915   1.96      fvdl 
   1916   1.96      fvdl 	if ((type & AHC_TRANS_USER) != 0) {
   1917   1.96      fvdl 		tinfo->user.period = period;
   1918   1.96      fvdl 		tinfo->user.offset = offset;
   1919   1.96      fvdl 		tinfo->user.ppr_options = ppr_options;
   1920   1.96      fvdl 	}
   1921   1.96      fvdl 
   1922   1.96      fvdl 	if ((type & AHC_TRANS_GOAL) != 0) {
   1923   1.96      fvdl 		tinfo->goal.period = period;
   1924   1.96      fvdl 		tinfo->goal.offset = offset;
   1925   1.96      fvdl 		tinfo->goal.ppr_options = ppr_options;
   1926   1.96      fvdl 	}
   1927   1.96      fvdl 
   1928   1.96      fvdl 	old_period = tinfo->curr.period;
   1929   1.96      fvdl 	old_offset = tinfo->curr.offset;
   1930   1.96      fvdl 	old_ppr	   = tinfo->curr.ppr_options;
   1931   1.96      fvdl 
   1932   1.96      fvdl 	if ((type & AHC_TRANS_CUR) != 0
   1933   1.96      fvdl 	 && (old_period != period
   1934   1.96      fvdl 	  || old_offset != offset
   1935   1.96      fvdl 	  || old_ppr != ppr_options)) {
   1936   1.96      fvdl 		u_int	scsirate;
   1937   1.96      fvdl 
   1938   1.96      fvdl 		update_needed++;
   1939   1.96      fvdl 		scsirate = tinfo->scsirate;
   1940   1.96      fvdl 		if ((ahc->features & AHC_ULTRA2) != 0) {
   1941   1.96      fvdl 
   1942   1.96      fvdl 			scsirate &= ~(SXFR_ULTRA2|SINGLE_EDGE|ENABLE_CRC);
   1943   1.96      fvdl 			if (syncrate != NULL) {
   1944   1.96      fvdl 				scsirate |= syncrate->sxfr_u2;
   1945   1.96      fvdl 				if ((ppr_options & MSG_EXT_PPR_DT_REQ) != 0)
   1946   1.96      fvdl 					scsirate |= ENABLE_CRC;
   1947   1.96      fvdl 				else
   1948   1.96      fvdl 					scsirate |= SINGLE_EDGE;
   1949   1.96      fvdl 			}
   1950   1.96      fvdl 		} else {
   1951   1.96      fvdl 
   1952   1.96      fvdl 			scsirate &= ~(SXFR|SOFS);
   1953   1.96      fvdl 			/*
   1954   1.96      fvdl 			 * Ensure Ultra mode is set properly for
   1955   1.96      fvdl 			 * this target.
   1956   1.96      fvdl 			 */
   1957   1.96      fvdl 			tstate->ultraenb &= ~devinfo->target_mask;
   1958   1.96      fvdl 			if (syncrate != NULL) {
   1959   1.96      fvdl 				if (syncrate->sxfr & ULTRA_SXFR) {
   1960   1.96      fvdl 					tstate->ultraenb |=
   1961   1.96      fvdl 						devinfo->target_mask;
   1962   1.96      fvdl 				}
   1963   1.96      fvdl 				scsirate |= syncrate->sxfr & SXFR;
   1964   1.96      fvdl 				scsirate |= offset & SOFS;
   1965   1.96      fvdl 			}
   1966   1.96      fvdl 			if (active) {
   1967   1.96      fvdl 				u_int sxfrctl0;
   1968   1.96      fvdl 
   1969   1.96      fvdl 				sxfrctl0 = ahc_inb(ahc, SXFRCTL0);
   1970   1.96      fvdl 				sxfrctl0 &= ~FAST20;
   1971   1.96      fvdl 				if (tstate->ultraenb & devinfo->target_mask)
   1972   1.96      fvdl 					sxfrctl0 |= FAST20;
   1973   1.96      fvdl 				ahc_outb(ahc, SXFRCTL0, sxfrctl0);
   1974   1.96      fvdl 			}
   1975   1.96      fvdl 		}
   1976   1.96      fvdl 		if (active) {
   1977   1.96      fvdl 			ahc_outb(ahc, SCSIRATE, scsirate);
   1978   1.96      fvdl 			if ((ahc->features & AHC_ULTRA2) != 0)
   1979   1.96      fvdl 				ahc_outb(ahc, SCSIOFFSET, offset);
   1980   1.96      fvdl 		}
   1981   1.96      fvdl 
   1982   1.96      fvdl 		tinfo->scsirate = scsirate;
   1983   1.96      fvdl 		tinfo->curr.period = period;
   1984   1.96      fvdl 		tinfo->curr.offset = offset;
   1985   1.96      fvdl 		tinfo->curr.ppr_options = ppr_options;
   1986   1.96      fvdl 
   1987   1.96      fvdl 		ahc_send_async(ahc, devinfo->channel, devinfo->target,
   1988   1.96      fvdl 		  CAM_LUN_WILDCARD, AC_TRANSFER_NEG, NULL);
   1989   1.96      fvdl 		if (bootverbose) {
   1990   1.96      fvdl 			if (offset != 0) {
   1991   1.96      fvdl 				printf("%s: target %d synchronous at %sMHz%s, "
   1992   1.96      fvdl 				       "offset = 0x%x\n", ahc_name(ahc),
   1993   1.96      fvdl 				       devinfo->target, syncrate->rate,
   1994   1.96      fvdl 				       (ppr_options & MSG_EXT_PPR_DT_REQ)
   1995   1.96      fvdl 				       ? " DT" : "", offset);
   1996   1.96      fvdl 			} else {
   1997   1.96      fvdl 				printf("%s: target %d using "
   1998   1.96      fvdl 				       "asynchronous transfers\n",
   1999   1.96      fvdl 				       ahc_name(ahc), devinfo->target);
   2000   1.96      fvdl 			}
   2001   1.96      fvdl 		}
   2002   1.96      fvdl 	}
   2003   1.96      fvdl 
   2004   1.96      fvdl 	update_needed += ahc_update_neg_request(ahc, devinfo, tstate,
   2005   1.96      fvdl 						tinfo, AHC_NEG_TO_GOAL);
   2006   1.96      fvdl 
   2007   1.96      fvdl 	if (update_needed)
   2008   1.96      fvdl 		ahc_update_pending_scbs(ahc);
   2009   1.96      fvdl }
   2010   1.96      fvdl 
   2011   1.96      fvdl /*
   2012   1.96      fvdl  * Update the user/goal/curr tables of wide negotiation
   2013   1.96      fvdl  * parameters as well as, in the case of a current or active update,
   2014   1.96      fvdl  * any data structures on the host controller.  In the case of an
   2015   1.96      fvdl  * active update, the specified target is currently talking to us on
   2016   1.96      fvdl  * the bus, so the transfer parameter update must take effect
   2017   1.96      fvdl  * immediately.
   2018   1.96      fvdl  */
   2019   1.96      fvdl void
   2020   1.96      fvdl ahc_set_width(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   2021   1.96      fvdl 	      u_int width, u_int type, int paused)
   2022   1.96      fvdl {
   2023   1.96      fvdl 	struct	ahc_initiator_tinfo *tinfo;
   2024   1.96      fvdl 	struct	ahc_tmode_tstate *tstate;
   2025   1.96      fvdl 	u_int	oldwidth;
   2026   1.96      fvdl 	int	active;
   2027   1.96      fvdl 	int	update_needed;
   2028   1.96      fvdl 
   2029   1.96      fvdl 	active = (type & AHC_TRANS_ACTIVE) == AHC_TRANS_ACTIVE;
   2030   1.96      fvdl 	update_needed = 0;
   2031   1.96      fvdl 	tinfo = ahc_fetch_transinfo(ahc, devinfo->channel, devinfo->our_scsiid,
   2032   1.96      fvdl 				    devinfo->target, &tstate);
   2033   1.96      fvdl 
   2034   1.96      fvdl 	if ((type & AHC_TRANS_USER) != 0)
   2035   1.96      fvdl 		tinfo->user.width = width;
   2036   1.96      fvdl 
   2037   1.96      fvdl 	if ((type & AHC_TRANS_GOAL) != 0)
   2038   1.96      fvdl 		tinfo->goal.width = width;
   2039   1.96      fvdl 
   2040   1.96      fvdl 	oldwidth = tinfo->curr.width;
   2041   1.96      fvdl 	if ((type & AHC_TRANS_CUR) != 0 && oldwidth != width) {
   2042   1.96      fvdl 		u_int	scsirate;
   2043   1.96      fvdl 
   2044   1.96      fvdl 		update_needed++;
   2045   1.96      fvdl 		scsirate =  tinfo->scsirate;
   2046   1.96      fvdl 		scsirate &= ~WIDEXFER;
   2047   1.96      fvdl 		if (width == MSG_EXT_WDTR_BUS_16_BIT)
   2048   1.96      fvdl 			scsirate |= WIDEXFER;
   2049   1.96      fvdl 
   2050   1.96      fvdl 		tinfo->scsirate = scsirate;
   2051   1.96      fvdl 
   2052   1.96      fvdl 		if (active)
   2053   1.96      fvdl 			ahc_outb(ahc, SCSIRATE, scsirate);
   2054   1.96      fvdl 
   2055   1.96      fvdl 		tinfo->curr.width = width;
   2056   1.96      fvdl 
   2057   1.96      fvdl 		ahc_send_async(ahc, devinfo->channel, devinfo->target,
   2058   1.96      fvdl 			       CAM_LUN_WILDCARD, AC_TRANSFER_NEG, NULL);
   2059   1.96      fvdl 		if (bootverbose) {
   2060   1.96      fvdl 			printf("%s: target %d using %dbit transfers\n",
   2061   1.96      fvdl 			       ahc_name(ahc), devinfo->target,
   2062   1.96      fvdl 			       8 * (0x01 << width));
   2063   1.96      fvdl 		}
   2064   1.96      fvdl 	}
   2065   1.96      fvdl 
   2066   1.96      fvdl 	update_needed += ahc_update_neg_request(ahc, devinfo, tstate,
   2067   1.96      fvdl 						tinfo, AHC_NEG_TO_GOAL);
   2068   1.96      fvdl 	if (update_needed)
   2069   1.96      fvdl 		ahc_update_pending_scbs(ahc);
   2070   1.96      fvdl }
   2071   1.96      fvdl 
   2072   1.96      fvdl /*
   2073   1.96      fvdl  * Update the current state of tagged queuing for a given target.
   2074   1.96      fvdl  */
   2075   1.96      fvdl void
   2076   1.96      fvdl ahc_set_tags(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   2077   1.96      fvdl 	     ahc_queue_alg alg)
   2078   1.96      fvdl {
   2079   1.96      fvdl  	ahc_platform_set_tags(ahc, devinfo, alg);
   2080   1.96      fvdl }
   2081   1.96      fvdl 
   2082   1.96      fvdl /*
   2083   1.96      fvdl  * When the transfer settings for a connection change, update any
   2084   1.96      fvdl  * in-transit SCBs to contain the new data so the hardware will
   2085   1.96      fvdl  * be set correctly during future (re)selections.
   2086   1.96      fvdl  */
   2087   1.96      fvdl static void
   2088   1.96      fvdl ahc_update_pending_scbs(struct ahc_softc *ahc)
   2089   1.96      fvdl {
   2090   1.96      fvdl 	struct	scb *pending_scb;
   2091   1.96      fvdl 	int	pending_scb_count;
   2092   1.96      fvdl 	int	i;
   2093   1.96      fvdl 	int	paused;
   2094   1.96      fvdl 	u_int	saved_scbptr;
   2095   1.96      fvdl 
   2096   1.96      fvdl 	/*
   2097   1.96      fvdl 	 * Traverse the pending SCB list and ensure that all of the
   2098   1.96      fvdl 	 * SCBs there have the proper settings.
   2099   1.96      fvdl 	 */
   2100   1.96      fvdl 	pending_scb_count = 0;
   2101   1.96      fvdl 	LIST_FOREACH(pending_scb, &ahc->pending_scbs, pending_links) {
   2102   1.96      fvdl 		struct ahc_devinfo devinfo;
   2103   1.96      fvdl 		struct hardware_scb *pending_hscb;
   2104   1.96      fvdl 		struct ahc_initiator_tinfo *tinfo;
   2105   1.96      fvdl 		struct ahc_tmode_tstate *tstate;
   2106   1.96      fvdl 
   2107   1.96      fvdl 		ahc_scb_devinfo(ahc, &devinfo, pending_scb);
   2108   1.96      fvdl 		tinfo = ahc_fetch_transinfo(ahc, devinfo.channel,
   2109   1.96      fvdl 					    devinfo.our_scsiid,
   2110   1.96      fvdl 					    devinfo.target, &tstate);
   2111   1.96      fvdl 		pending_hscb = pending_scb->hscb;
   2112   1.96      fvdl 		pending_hscb->control &= ~ULTRAENB;
   2113   1.96      fvdl 		if ((tstate->ultraenb & devinfo.target_mask) != 0)
   2114   1.96      fvdl 			pending_hscb->control |= ULTRAENB;
   2115   1.96      fvdl 		pending_hscb->scsirate = tinfo->scsirate;
   2116   1.96      fvdl 		pending_hscb->scsioffset = tinfo->curr.offset;
   2117   1.96      fvdl 		if ((tstate->auto_negotiate & devinfo.target_mask) == 0
   2118   1.96      fvdl 		 && (pending_scb->flags & SCB_AUTO_NEGOTIATE) != 0) {
   2119   1.96      fvdl 			pending_scb->flags &= ~SCB_AUTO_NEGOTIATE;
   2120   1.96      fvdl 			pending_hscb->control &= ~MK_MESSAGE;
   2121   1.96      fvdl 		}
   2122   1.96      fvdl 		ahc_sync_scb(ahc, pending_scb,
   2123   1.96      fvdl 			     BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   2124   1.96      fvdl 		pending_scb_count++;
   2125   1.96      fvdl 	}
   2126   1.96      fvdl 
   2127   1.96      fvdl 	if (pending_scb_count == 0)
   2128   1.96      fvdl 		return;
   2129   1.96      fvdl 
   2130   1.96      fvdl 	if (ahc_is_paused(ahc)) {
   2131   1.96      fvdl 		paused = 1;
   2132   1.96      fvdl 	} else {
   2133   1.96      fvdl 		paused = 0;
   2134   1.96      fvdl 		ahc_pause(ahc);
   2135   1.96      fvdl 	}
   2136   1.96      fvdl 
   2137   1.96      fvdl 	saved_scbptr = ahc_inb(ahc, SCBPTR);
   2138   1.96      fvdl 	/* Ensure that the hscbs down on the card match the new information */
   2139   1.96      fvdl 	for (i = 0; i < ahc->scb_data->maxhscbs; i++) {
   2140   1.96      fvdl 		struct	hardware_scb *pending_hscb;
   2141   1.96      fvdl 		u_int	control;
   2142   1.96      fvdl 		u_int	scb_tag;
   2143   1.96      fvdl 
   2144   1.96      fvdl 		ahc_outb(ahc, SCBPTR, i);
   2145   1.96      fvdl 		scb_tag = ahc_inb(ahc, SCB_TAG);
   2146   1.96      fvdl 		pending_scb = ahc_lookup_scb(ahc, scb_tag);
   2147   1.96      fvdl 		if (pending_scb == NULL)
   2148   1.96      fvdl 			continue;
   2149   1.96      fvdl 
   2150   1.96      fvdl 		pending_hscb = pending_scb->hscb;
   2151   1.96      fvdl 		control = ahc_inb(ahc, SCB_CONTROL);
   2152   1.96      fvdl 		control &= ~(ULTRAENB|MK_MESSAGE);
   2153   1.96      fvdl 		control |= pending_hscb->control & (ULTRAENB|MK_MESSAGE);
   2154   1.96      fvdl 		ahc_outb(ahc, SCB_CONTROL, control);
   2155   1.96      fvdl 		ahc_outb(ahc, SCB_SCSIRATE, pending_hscb->scsirate);
   2156   1.96      fvdl 		ahc_outb(ahc, SCB_SCSIOFFSET, pending_hscb->scsioffset);
   2157   1.96      fvdl 	}
   2158   1.96      fvdl 	ahc_outb(ahc, SCBPTR, saved_scbptr);
   2159   1.96      fvdl 
   2160   1.96      fvdl 	if (paused == 0)
   2161   1.96      fvdl 		ahc_unpause(ahc);
   2162   1.96      fvdl }
   2163   1.96      fvdl 
   2164   1.96      fvdl /**************************** Pathing Information *****************************/
   2165   1.96      fvdl static void
   2166   1.96      fvdl ahc_fetch_devinfo(struct ahc_softc *ahc, struct ahc_devinfo *devinfo)
   2167   1.96      fvdl {
   2168   1.96      fvdl 	u_int	saved_scsiid;
   2169   1.96      fvdl 	role_t	role;
   2170   1.96      fvdl 	int	our_id;
   2171   1.96      fvdl 
   2172   1.96      fvdl 	if (ahc_inb(ahc, SSTAT0) & TARGET)
   2173   1.96      fvdl 		role = ROLE_TARGET;
   2174   1.96      fvdl 	else
   2175   1.96      fvdl 		role = ROLE_INITIATOR;
   2176   1.96      fvdl 
   2177   1.96      fvdl 	if (role == ROLE_TARGET
   2178   1.96      fvdl 	 && (ahc->features & AHC_MULTI_TID) != 0
   2179   1.96      fvdl 	 && (ahc_inb(ahc, SEQ_FLAGS)
   2180   1.96      fvdl  	   & (CMDPHASE_PENDING|TARG_CMD_PENDING|NO_DISCONNECT)) != 0) {
   2181   1.96      fvdl 		/* We were selected, so pull our id from TARGIDIN */
   2182   1.96      fvdl 		our_id = ahc_inb(ahc, TARGIDIN) & OID;
   2183   1.96      fvdl 	} else if ((ahc->features & AHC_ULTRA2) != 0)
   2184   1.96      fvdl 		our_id = ahc_inb(ahc, SCSIID_ULTRA2) & OID;
   2185   1.96      fvdl 	else
   2186   1.96      fvdl 		our_id = ahc_inb(ahc, SCSIID) & OID;
   2187   1.96      fvdl 
   2188   1.96      fvdl 	saved_scsiid = ahc_inb(ahc, SAVED_SCSIID);
   2189   1.96      fvdl 	ahc_compile_devinfo(devinfo,
   2190   1.96      fvdl 			    our_id,
   2191   1.96      fvdl 			    SCSIID_TARGET(ahc, saved_scsiid),
   2192   1.96      fvdl 			    ahc_inb(ahc, SAVED_LUN),
   2193   1.96      fvdl 			    SCSIID_CHANNEL(ahc, saved_scsiid),
   2194   1.96      fvdl 			    role);
   2195   1.96      fvdl }
   2196   1.96      fvdl 
   2197   1.96      fvdl struct ahc_phase_table_entry*
   2198   1.96      fvdl ahc_lookup_phase_entry(int phase)
   2199   1.96      fvdl {
   2200   1.96      fvdl 	struct ahc_phase_table_entry *entry;
   2201   1.96      fvdl 	struct ahc_phase_table_entry *last_entry;
   2202   1.96      fvdl 
   2203   1.96      fvdl 	/*
   2204   1.96      fvdl 	 * num_phases doesn't include the default entry which
   2205   1.96      fvdl 	 * will be returned if the phase doesn't match.
   2206   1.96      fvdl 	 */
   2207   1.96      fvdl 	last_entry = &ahc_phase_table[num_phases];
   2208   1.96      fvdl 	for (entry = ahc_phase_table; entry < last_entry; entry++) {
   2209   1.96      fvdl 		if (phase == entry->phase)
   2210   1.96      fvdl 			break;
   2211   1.96      fvdl 	}
   2212   1.96      fvdl 	return (entry);
   2213   1.96      fvdl }
   2214   1.96      fvdl 
   2215   1.96      fvdl void
   2216   1.96      fvdl ahc_compile_devinfo(struct ahc_devinfo *devinfo, u_int our_id, u_int target,
   2217   1.96      fvdl 		    u_int lun, char channel, role_t role)
   2218   1.96      fvdl {
   2219   1.96      fvdl 	devinfo->our_scsiid = our_id;
   2220   1.96      fvdl 	devinfo->target = target;
   2221   1.96      fvdl 	devinfo->lun = lun;
   2222   1.96      fvdl 	devinfo->target_offset = target;
   2223   1.96      fvdl 	devinfo->channel = channel;
   2224   1.96      fvdl 	devinfo->role = role;
   2225   1.96      fvdl 	if (channel == 'B')
   2226   1.96      fvdl 		devinfo->target_offset += 8;
   2227   1.96      fvdl 	devinfo->target_mask = (0x01 << devinfo->target_offset);
   2228   1.96      fvdl }
   2229   1.96      fvdl 
   2230   1.96      fvdl void
   2231   1.96      fvdl ahc_print_devinfo(struct ahc_softc *ahc, struct ahc_devinfo *devinfo)
   2232   1.96      fvdl {
   2233   1.96      fvdl 	printf("%s:%c:%d:%d: ", ahc_name(ahc), devinfo->channel,
   2234   1.96      fvdl 	       devinfo->target, devinfo->lun);
   2235   1.96      fvdl }
   2236   1.96      fvdl 
   2237   1.96      fvdl static void
   2238   1.96      fvdl ahc_scb_devinfo(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   2239   1.96      fvdl 		struct scb *scb)
   2240   1.96      fvdl {
   2241   1.96      fvdl 	role_t	role;
   2242   1.96      fvdl 	int	our_id;
   2243   1.96      fvdl 
   2244   1.96      fvdl 	our_id = SCSIID_OUR_ID(scb->hscb->scsiid);
   2245   1.96      fvdl 	role = ROLE_INITIATOR;
   2246   1.96      fvdl 	if ((scb->flags & SCB_TARGET_SCB) != 0)
   2247   1.96      fvdl 		role = ROLE_TARGET;
   2248   1.96      fvdl 	ahc_compile_devinfo(devinfo, our_id, SCB_GET_TARGET(ahc, scb),
   2249   1.96      fvdl 			    SCB_GET_LUN(scb), SCB_GET_CHANNEL(ahc, scb), role);
   2250   1.96      fvdl }
   2251   1.96      fvdl 
   2252   1.96      fvdl 
   2253   1.96      fvdl /************************ Message Phase Processing ****************************/
   2254   1.96      fvdl static void
   2255   1.96      fvdl ahc_assert_atn(struct ahc_softc *ahc)
   2256   1.96      fvdl {
   2257   1.96      fvdl 	u_int scsisigo;
   2258   1.96      fvdl 
   2259   1.96      fvdl 	scsisigo = ATNO;
   2260   1.96      fvdl 	if ((ahc->features & AHC_DT) == 0)
   2261   1.96      fvdl 		scsisigo |= ahc_inb(ahc, SCSISIGI);
   2262   1.96      fvdl 	ahc_outb(ahc, SCSISIGO, scsisigo);
   2263   1.96      fvdl }
   2264   1.96      fvdl 
   2265   1.96      fvdl /*
   2266   1.96      fvdl  * When an initiator transaction with the MK_MESSAGE flag either reconnects
   2267   1.96      fvdl  * or enters the initial message out phase, we are interrupted.  Fill our
   2268   1.96      fvdl  * outgoing message buffer with the appropriate message and beging handing
   2269   1.96      fvdl  * the message phase(s) manually.
   2270   1.96      fvdl  */
   2271   1.96      fvdl static void
   2272   1.96      fvdl ahc_setup_initiator_msgout(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   2273   1.96      fvdl 			   struct scb *scb)
   2274   1.96      fvdl {
   2275   1.96      fvdl 	/*
   2276   1.96      fvdl 	 * To facilitate adding multiple messages together,
   2277   1.96      fvdl 	 * each routine should increment the index and len
   2278   1.96      fvdl 	 * variables instead of setting them explicitly.
   2279   1.96      fvdl 	 */
   2280   1.96      fvdl 	ahc->msgout_index = 0;
   2281   1.96      fvdl 	ahc->msgout_len = 0;
   2282   1.96      fvdl 
   2283   1.96      fvdl 	if ((scb->flags & SCB_DEVICE_RESET) == 0
   2284   1.96      fvdl 	 && ahc_inb(ahc, MSG_OUT) == MSG_IDENTIFYFLAG) {
   2285   1.96      fvdl 		u_int identify_msg;
   2286   1.96      fvdl 
   2287   1.96      fvdl 		identify_msg = MSG_IDENTIFYFLAG | SCB_GET_LUN(scb);
   2288   1.96      fvdl 		if ((scb->hscb->control & DISCENB) != 0)
   2289   1.96      fvdl 			identify_msg |= MSG_IDENTIFY_DISCFLAG;
   2290   1.96      fvdl 		ahc->msgout_buf[ahc->msgout_index++] = identify_msg;
   2291   1.96      fvdl 		ahc->msgout_len++;
   2292   1.96      fvdl 
   2293   1.96      fvdl 		if ((scb->hscb->control & TAG_ENB) != 0) {
   2294   1.96      fvdl 			ahc->msgout_buf[ahc->msgout_index++] =
   2295   1.96      fvdl 			    scb->hscb->control & (TAG_ENB|SCB_TAG_TYPE);
   2296   1.96      fvdl 			ahc->msgout_buf[ahc->msgout_index++] = scb->hscb->tag;
   2297   1.96      fvdl 			ahc->msgout_len += 2;
   2298   1.96      fvdl 		}
   2299   1.96      fvdl 	}
   2300   1.96      fvdl 
   2301   1.96      fvdl 	if (scb->flags & SCB_DEVICE_RESET) {
   2302   1.96      fvdl 		ahc->msgout_buf[ahc->msgout_index++] = MSG_BUS_DEV_RESET;
   2303   1.96      fvdl 		ahc->msgout_len++;
   2304   1.96      fvdl 		ahc_print_path(ahc, scb);
   2305   1.96      fvdl 		printf("Bus Device Reset Message Sent\n");
   2306   1.96      fvdl 		/*
   2307   1.96      fvdl 		 * Clear our selection hardware in advance of
   2308   1.96      fvdl 		 * the busfree.  We may have an entry in the waiting
   2309   1.96      fvdl 		 * Q for this target, and we don't want to go about
   2310   1.96      fvdl 		 * selecting while we handle the busfree and blow it
   2311   1.96      fvdl 		 * away.
   2312   1.96      fvdl 		 */
   2313   1.96      fvdl 		ahc_outb(ahc, SCSISEQ, (ahc_inb(ahc, SCSISEQ) & ~ENSELO));
   2314   1.96      fvdl 	} else if ((scb->flags & SCB_ABORT) != 0) {
   2315   1.96      fvdl 		if ((scb->hscb->control & TAG_ENB) != 0)
   2316   1.96      fvdl 			ahc->msgout_buf[ahc->msgout_index++] = MSG_ABORT_TAG;
   2317   1.96      fvdl 		else
   2318   1.96      fvdl 			ahc->msgout_buf[ahc->msgout_index++] = MSG_ABORT;
   2319   1.96      fvdl 		ahc->msgout_len++;
   2320   1.96      fvdl 		ahc_print_path(ahc, scb);
   2321   1.96      fvdl 		printf("Abort%s Message Sent\n",
   2322   1.96      fvdl 		       (scb->hscb->control & TAG_ENB) != 0 ? " Tag" : "");
   2323   1.96      fvdl 		/*
   2324   1.96      fvdl 		 * Clear our selection hardware in advance of
   2325   1.96      fvdl 		 * the busfree.  We may have an entry in the waiting
   2326   1.96      fvdl 		 * Q for this target, and we don't want to go about
   2327   1.96      fvdl 		 * selecting while we handle the busfree and blow it
   2328   1.96      fvdl 		 * away.
   2329   1.96      fvdl 		 */
   2330   1.96      fvdl 		ahc_outb(ahc, SCSISEQ, (ahc_inb(ahc, SCSISEQ) & ~ENSELO));
   2331   1.96      fvdl 	} else if ((scb->flags & (SCB_AUTO_NEGOTIATE|SCB_NEGOTIATE)) != 0) {
   2332   1.96      fvdl 		ahc_build_transfer_msg(ahc, devinfo);
   2333   1.96      fvdl 	} else {
   2334   1.96      fvdl 		printf("ahc_intr: AWAITING_MSG for an SCB that "
   2335   1.96      fvdl 		       "does not have a waiting message\n");
   2336   1.96      fvdl 		printf("SCSIID = %x, target_mask = %x\n", scb->hscb->scsiid,
   2337   1.96      fvdl 		       devinfo->target_mask);
   2338   1.96      fvdl 		panic("SCB = %d, SCB Control = %x, MSG_OUT = %x "
   2339   1.96      fvdl 		      "SCB flags = %x", scb->hscb->tag, scb->hscb->control,
   2340   1.96      fvdl 		      ahc_inb(ahc, MSG_OUT), scb->flags);
   2341   1.96      fvdl 	}
   2342   1.96      fvdl 
   2343   1.96      fvdl 	/*
   2344   1.96      fvdl 	 * Clear the MK_MESSAGE flag from the SCB so we aren't
   2345   1.96      fvdl 	 * asked to send this message again.
   2346   1.96      fvdl 	 */
   2347   1.96      fvdl 	ahc_outb(ahc, SCB_CONTROL, ahc_inb(ahc, SCB_CONTROL) & ~MK_MESSAGE);
   2348   1.96      fvdl 	scb->hscb->control &= ~MK_MESSAGE;
   2349   1.96      fvdl 	ahc->msgout_index = 0;
   2350   1.96      fvdl 	ahc->msg_type = MSG_TYPE_INITIATOR_MSGOUT;
   2351   1.96      fvdl }
   2352   1.96      fvdl 
   2353   1.96      fvdl /*
   2354   1.96      fvdl  * Build an appropriate transfer negotiation message for the
   2355   1.96      fvdl  * currently active target.
   2356   1.96      fvdl  */
   2357   1.96      fvdl static void
   2358   1.96      fvdl ahc_build_transfer_msg(struct ahc_softc *ahc, struct ahc_devinfo *devinfo)
   2359   1.96      fvdl {
   2360   1.96      fvdl 	/*
   2361   1.96      fvdl 	 * We need to initiate transfer negotiations.
   2362   1.96      fvdl 	 * If our current and goal settings are identical,
   2363   1.96      fvdl 	 * we want to renegotiate due to a check condition.
   2364   1.96      fvdl 	 */
   2365   1.96      fvdl 	struct	ahc_initiator_tinfo *tinfo;
   2366   1.96      fvdl 	struct	ahc_tmode_tstate *tstate;
   2367   1.96      fvdl 	struct	ahc_syncrate *rate;
   2368   1.96      fvdl 	int	dowide;
   2369   1.96      fvdl 	int	dosync;
   2370   1.96      fvdl 	int	doppr;
   2371   1.96      fvdl 	u_int	period;
   2372   1.96      fvdl 	u_int	ppr_options;
   2373   1.96      fvdl 	u_int	offset;
   2374   1.96      fvdl 
   2375   1.96      fvdl 	tinfo = ahc_fetch_transinfo(ahc, devinfo->channel, devinfo->our_scsiid,
   2376   1.96      fvdl 				    devinfo->target, &tstate);
   2377   1.96      fvdl 	/*
   2378   1.96      fvdl 	 * Filter our period based on the current connection.
   2379   1.96      fvdl 	 * If we can't perform DT transfers on this segment (not in LVD
   2380   1.96      fvdl 	 * mode for instance), then our decision to issue a PPR message
   2381   1.96      fvdl 	 * may change.
   2382   1.96      fvdl 	 */
   2383   1.96      fvdl 	period = tinfo->goal.period;
   2384   1.96      fvdl 	ppr_options = tinfo->goal.ppr_options;
   2385   1.96      fvdl 	/* Target initiated PPR is not allowed in the SCSI spec */
   2386   1.96      fvdl 	if (devinfo->role == ROLE_TARGET)
   2387   1.96      fvdl 		ppr_options = 0;
   2388   1.96      fvdl 	rate = ahc_devlimited_syncrate(ahc, tinfo, &period,
   2389   1.96      fvdl 				       &ppr_options, devinfo->role);
   2390   1.96      fvdl 	dowide = tinfo->curr.width != tinfo->goal.width;
   2391   1.96      fvdl 	dosync = tinfo->curr.period != period;
   2392   1.96      fvdl 	/*
   2393   1.96      fvdl 	 * Only use PPR if we have options that need it, even if the device
   2394   1.96      fvdl 	 * claims to support it.  There might be an expander in the way
   2395   1.96      fvdl 	 * that doesn't.
   2396   1.96      fvdl 	 */
   2397   1.96      fvdl 	doppr = ppr_options != 0;
   2398   1.96      fvdl 
   2399   1.96      fvdl 	if (!dowide && !dosync && !doppr) {
   2400   1.96      fvdl 		dowide = tinfo->goal.width != MSG_EXT_WDTR_BUS_8_BIT;
   2401   1.96      fvdl 		dosync = tinfo->goal.offset != 0;
   2402   1.96      fvdl 	}
   2403   1.96      fvdl 
   2404   1.96      fvdl 	if (!dowide && !dosync && !doppr) {
   2405   1.96      fvdl 		/*
   2406   1.96      fvdl 		 * Force async with a WDTR message if we have a wide bus,
   2407   1.96      fvdl 		 * or just issue an SDTR with a 0 offset.
   2408   1.96      fvdl 		 */
   2409   1.96      fvdl 		if ((ahc->features & AHC_WIDE) != 0)
   2410   1.96      fvdl 			dowide = 1;
   2411   1.96      fvdl 		else
   2412   1.96      fvdl 			dosync = 1;
   2413   1.96      fvdl 
   2414   1.96      fvdl 		if (bootverbose) {
   2415   1.96      fvdl 			ahc_print_devinfo(ahc, devinfo);
   2416   1.96      fvdl 			printf("Ensuring async\n");
   2417   1.96      fvdl 		}
   2418   1.96      fvdl 	}
   2419   1.96      fvdl 
   2420   1.96      fvdl 	/* Target initiated PPR is not allowed in the SCSI spec */
   2421   1.96      fvdl 	if (devinfo->role == ROLE_TARGET)
   2422   1.96      fvdl 		doppr = 0;
   2423   1.96      fvdl 
   2424   1.96      fvdl 	/*
   2425   1.96      fvdl 	 * Both the PPR message and SDTR message require the
   2426   1.96      fvdl 	 * goal syncrate to be limited to what the target device
   2427   1.96      fvdl 	 * is capable of handling (based on whether an LVD->SE
   2428   1.96      fvdl 	 * expander is on the bus), so combine these two cases.
   2429   1.96      fvdl 	 * Regardless, guarantee that if we are using WDTR and SDTR
   2430   1.96      fvdl 	 * messages that WDTR comes first.
   2431   1.96      fvdl 	 */
   2432   1.96      fvdl 	if (doppr || (dosync && !dowide)) {
   2433   1.96      fvdl 
   2434   1.96      fvdl 		offset = tinfo->goal.offset;
   2435   1.96      fvdl 		ahc_validate_offset(ahc, tinfo, rate, &offset,
   2436   1.96      fvdl 				    doppr ? tinfo->goal.width
   2437   1.96      fvdl 					  : tinfo->curr.width,
   2438   1.96      fvdl 				    devinfo->role);
   2439   1.96      fvdl 		if (doppr) {
   2440   1.96      fvdl 			ahc_construct_ppr(ahc, devinfo, period, offset,
   2441   1.96      fvdl 					  tinfo->goal.width, ppr_options);
   2442   1.96      fvdl 		} else {
   2443   1.96      fvdl 			ahc_construct_sdtr(ahc, devinfo, period, offset);
   2444   1.96      fvdl 		}
   2445   1.96      fvdl 	} else {
   2446   1.96      fvdl 		ahc_construct_wdtr(ahc, devinfo, tinfo->goal.width);
   2447   1.96      fvdl 	}
   2448   1.96      fvdl }
   2449   1.96      fvdl 
   2450   1.96      fvdl /*
   2451   1.96      fvdl  * Build a synchronous negotiation message in our message
   2452   1.96      fvdl  * buffer based on the input parameters.
   2453   1.96      fvdl  */
   2454   1.96      fvdl static void
   2455   1.96      fvdl ahc_construct_sdtr(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   2456   1.96      fvdl 		   u_int period, u_int offset)
   2457   1.96      fvdl {
   2458   1.96      fvdl 	if (offset == 0)
   2459   1.96      fvdl 		period = AHC_ASYNC_XFER_PERIOD;
   2460   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = MSG_EXTENDED;
   2461   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = MSG_EXT_SDTR_LEN;
   2462   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = MSG_EXT_SDTR;
   2463   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = period;
   2464   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = offset;
   2465   1.96      fvdl 	ahc->msgout_len += 5;
   2466   1.96      fvdl 	if (bootverbose) {
   2467   1.96      fvdl 		printf("(%s:%c:%d:%d): Sending SDTR period %x, offset %x\n",
   2468   1.96      fvdl 		       ahc_name(ahc), devinfo->channel, devinfo->target,
   2469   1.96      fvdl 		       devinfo->lun, period, offset);
   2470   1.96      fvdl 	}
   2471   1.96      fvdl }
   2472   1.96      fvdl 
   2473   1.96      fvdl /*
   2474   1.96      fvdl  * Build a wide negotiation message in our message
   2475   1.96      fvdl  * buffer based on the input parameters.
   2476   1.96      fvdl  */
   2477   1.96      fvdl static void
   2478   1.96      fvdl ahc_construct_wdtr(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   2479   1.96      fvdl 		   u_int bus_width)
   2480   1.96      fvdl {
   2481   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = MSG_EXTENDED;
   2482   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = MSG_EXT_WDTR_LEN;
   2483   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = MSG_EXT_WDTR;
   2484   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = bus_width;
   2485   1.96      fvdl 	ahc->msgout_len += 4;
   2486   1.96      fvdl 	if (bootverbose) {
   2487   1.96      fvdl 		printf("(%s:%c:%d:%d): Sending WDTR %x\n",
   2488   1.96      fvdl 		       ahc_name(ahc), devinfo->channel, devinfo->target,
   2489   1.96      fvdl 		       devinfo->lun, bus_width);
   2490   1.96      fvdl 	}
   2491   1.96      fvdl }
   2492   1.96      fvdl 
   2493   1.96      fvdl /*
   2494   1.96      fvdl  * Build a parallel protocol request message in our message
   2495   1.96      fvdl  * buffer based on the input parameters.
   2496   1.96      fvdl  */
   2497   1.96      fvdl static void
   2498   1.96      fvdl ahc_construct_ppr(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   2499   1.96      fvdl 		  u_int period, u_int offset, u_int bus_width,
   2500   1.96      fvdl 		  u_int ppr_options)
   2501   1.96      fvdl {
   2502   1.96      fvdl 	if (offset == 0)
   2503   1.96      fvdl 		period = AHC_ASYNC_XFER_PERIOD;
   2504   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = MSG_EXTENDED;
   2505   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = MSG_EXT_PPR_LEN;
   2506   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = MSG_EXT_PPR;
   2507   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = period;
   2508   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = 0;
   2509   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = offset;
   2510   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = bus_width;
   2511   1.96      fvdl 	ahc->msgout_buf[ahc->msgout_index++] = ppr_options;
   2512   1.96      fvdl 	ahc->msgout_len += 8;
   2513   1.96      fvdl 	if (bootverbose) {
   2514   1.96      fvdl 		printf("(%s:%c:%d:%d): Sending PPR bus_width %x, period %x, "
   2515   1.96      fvdl 		       "offset %x, ppr_options %x\n", ahc_name(ahc),
   2516   1.96      fvdl 		       devinfo->channel, devinfo->target, devinfo->lun,
   2517   1.96      fvdl 		       bus_width, period, offset, ppr_options);
   2518   1.96      fvdl 	}
   2519   1.96      fvdl }
   2520   1.96      fvdl 
   2521   1.96      fvdl /*
   2522   1.96      fvdl  * Clear any active message state.
   2523   1.96      fvdl  */
   2524   1.96      fvdl static void
   2525   1.96      fvdl ahc_clear_msg_state(struct ahc_softc *ahc)
   2526   1.96      fvdl {
   2527   1.96      fvdl 	ahc->msgout_len = 0;
   2528   1.96      fvdl 	ahc->msgin_index = 0;
   2529   1.96      fvdl 	ahc->msg_type = MSG_TYPE_NONE;
   2530   1.96      fvdl 	if ((ahc_inb(ahc, SCSISIGI) & ATNI) != 0) {
   2531   1.96      fvdl 		/*
   2532   1.96      fvdl 		 * The target didn't care to respond to our
   2533   1.96      fvdl 		 * message request, so clear ATN.
   2534   1.96      fvdl 		 */
   2535   1.96      fvdl 		ahc_outb(ahc, CLRSINT1, CLRATNO);
   2536   1.96      fvdl 	}
   2537   1.96      fvdl 	ahc_outb(ahc, MSG_OUT, MSG_NOOP);
   2538   1.96      fvdl 	ahc_outb(ahc, SEQ_FLAGS2,
   2539   1.96      fvdl 		 ahc_inb(ahc, SEQ_FLAGS2) & ~TARGET_MSG_PENDING);
   2540   1.96      fvdl }
   2541   1.96      fvdl 
   2542   1.96      fvdl static void
   2543   1.96      fvdl ahc_handle_proto_violation(struct ahc_softc *ahc)
   2544   1.96      fvdl {
   2545   1.96      fvdl 	struct	ahc_devinfo devinfo;
   2546   1.96      fvdl 	struct	scb *scb;
   2547   1.96      fvdl 	u_int	scbid;
   2548   1.96      fvdl 	u_int	seq_flags;
   2549   1.96      fvdl 	u_int	curphase;
   2550   1.96      fvdl 	u_int	lastphase;
   2551   1.96      fvdl 	int	found;
   2552   1.96      fvdl 
   2553   1.96      fvdl 	ahc_fetch_devinfo(ahc, &devinfo);
   2554   1.96      fvdl 	scbid = ahc_inb(ahc, SCB_TAG);
   2555   1.96      fvdl 	scb = ahc_lookup_scb(ahc, scbid);
   2556   1.96      fvdl 	seq_flags = ahc_inb(ahc, SEQ_FLAGS);
   2557   1.96      fvdl 	curphase = ahc_inb(ahc, SCSISIGI) & PHASE_MASK;
   2558   1.96      fvdl 	lastphase = ahc_inb(ahc, LASTPHASE);
   2559   1.96      fvdl 	if ((seq_flags & NOT_IDENTIFIED) != 0) {
   2560   1.96      fvdl 
   2561   1.96      fvdl 		/*
   2562   1.96      fvdl 		 * The reconnecting target either did not send an
   2563   1.96      fvdl 		 * identify message, or did, but we didn't find an SCB
   2564   1.96      fvdl 		 * to match.
   2565   1.96      fvdl 		 */
   2566   1.96      fvdl 		ahc_print_devinfo(ahc, &devinfo);
   2567   1.96      fvdl 		printf("Target did not send an IDENTIFY message. "
   2568   1.96      fvdl 		       "LASTPHASE = 0x%x.\n", lastphase);
   2569   1.96      fvdl 		scb = NULL;
   2570   1.96      fvdl 	} else if (scb == NULL) {
   2571   1.96      fvdl 		/*
   2572   1.96      fvdl 		 * We don't seem to have an SCB active for this
   2573   1.96      fvdl 		 * transaction.  Print an error and reset the bus.
   2574   1.96      fvdl 		 */
   2575   1.96      fvdl 		ahc_print_devinfo(ahc, &devinfo);
   2576   1.96      fvdl 		printf("No SCB found during protocol violation\n");
   2577   1.96      fvdl 		goto proto_violation_reset;
   2578   1.96      fvdl 	} else {
   2579   1.96      fvdl 		ahc_set_transaction_status(scb, CAM_SEQUENCE_FAIL);
   2580   1.96      fvdl 		if ((seq_flags & NO_CDB_SENT) != 0) {
   2581   1.96      fvdl 			ahc_print_path(ahc, scb);
   2582   1.96      fvdl 			printf("No or incomplete CDB sent to device.\n");
   2583   1.96      fvdl 		} else if ((ahc_inb(ahc, SCB_CONTROL) & STATUS_RCVD) == 0) {
   2584   1.96      fvdl 			/*
   2585   1.96      fvdl 			 * The target never bothered to provide status to
   2586   1.96      fvdl 			 * us prior to completing the command.  Since we don't
   2587   1.96      fvdl 			 * know the disposition of this command, we must attempt
   2588   1.96      fvdl 			 * to abort it.  Assert ATN and prepare to send an abort
   2589   1.96      fvdl 			 * message.
   2590   1.96      fvdl 			 */
   2591   1.96      fvdl 			ahc_print_path(ahc, scb);
   2592   1.96      fvdl 			printf("Completed command without status.\n");
   2593   1.96      fvdl 		} else {
   2594   1.96      fvdl 			ahc_print_path(ahc, scb);
   2595   1.96      fvdl 			printf("Unknown protocol violation.\n");
   2596   1.96      fvdl 			ahc_dump_card_state(ahc);
   2597   1.96      fvdl 		}
   2598   1.96      fvdl 	}
   2599   1.96      fvdl 	if ((lastphase & ~P_DATAIN_DT) == 0
   2600   1.96      fvdl 	 || lastphase == P_COMMAND) {
   2601   1.96      fvdl proto_violation_reset:
   2602   1.96      fvdl 		/*
   2603   1.96      fvdl 		 * Target either went directly to data/command
   2604   1.96      fvdl 		 * phase or didn't respond to our ATN.
   2605   1.96      fvdl 		 * The only safe thing to do is to blow
   2606   1.96      fvdl 		 * it away with a bus reset.
   2607   1.96      fvdl 		 */
   2608   1.96      fvdl 		found = ahc_reset_channel(ahc, 'A', TRUE);
   2609   1.96      fvdl 		printf("%s: Issued Channel %c Bus Reset. "
   2610   1.96      fvdl 		       "%d SCBs aborted\n", ahc_name(ahc), 'A', found);
   2611   1.96      fvdl 	} else {
   2612   1.96      fvdl 		/*
   2613   1.96      fvdl 		 * Leave the selection hardware off in case
   2614   1.96      fvdl 		 * this abort attempt will affect yet to
   2615   1.96      fvdl 		 * be sent commands.
   2616   1.96      fvdl 		 */
   2617   1.96      fvdl 		ahc_outb(ahc, SCSISEQ,
   2618   1.96      fvdl 			 ahc_inb(ahc, SCSISEQ) & ~ENSELO);
   2619   1.96      fvdl 		ahc_assert_atn(ahc);
   2620   1.96      fvdl 		ahc_outb(ahc, MSG_OUT, HOST_MSG);
   2621   1.96      fvdl 		if (scb == NULL) {
   2622   1.96      fvdl 			ahc_print_devinfo(ahc, &devinfo);
   2623   1.96      fvdl 			ahc->msgout_buf[0] = MSG_ABORT_TASK;
   2624   1.96      fvdl 			ahc->msgout_len = 1;
   2625   1.96      fvdl 			ahc->msgout_index = 0;
   2626   1.96      fvdl 			ahc->msg_type = MSG_TYPE_INITIATOR_MSGOUT;
   2627   1.96      fvdl 		} else {
   2628   1.96      fvdl 			ahc_print_path(ahc, scb);
   2629   1.96      fvdl 			scb->flags |= SCB_ABORT;
   2630   1.96      fvdl 		}
   2631   1.96      fvdl 		printf("Protocol violation %s.  Attempting to abort.\n",
   2632   1.96      fvdl 		       ahc_lookup_phase_entry(curphase)->phasemsg);
   2633   1.96      fvdl 	}
   2634   1.96      fvdl }
   2635   1.96      fvdl 
   2636   1.96      fvdl /*
   2637   1.96      fvdl  * Manual message loop handler.
   2638   1.96      fvdl  */
   2639   1.96      fvdl static void
   2640   1.96      fvdl ahc_handle_message_phase(struct ahc_softc *ahc)
   2641   1.96      fvdl {
   2642   1.96      fvdl 	struct	ahc_devinfo devinfo;
   2643   1.96      fvdl 	u_int	bus_phase;
   2644   1.96      fvdl 	int	end_session;
   2645   1.96      fvdl 
   2646   1.96      fvdl 	ahc_fetch_devinfo(ahc, &devinfo);
   2647   1.96      fvdl 	end_session = FALSE;
   2648   1.96      fvdl 	bus_phase = ahc_inb(ahc, SCSISIGI) & PHASE_MASK;
   2649   1.96      fvdl 
   2650   1.96      fvdl reswitch:
   2651   1.96      fvdl 	switch (ahc->msg_type) {
   2652   1.96      fvdl 	case MSG_TYPE_INITIATOR_MSGOUT:
   2653   1.96      fvdl 	{
   2654   1.96      fvdl 		int lastbyte;
   2655   1.96      fvdl 		int phasemis;
   2656   1.96      fvdl 		int msgdone;
   2657   1.96      fvdl 
   2658   1.96      fvdl 		if (ahc->msgout_len == 0)
   2659   1.96      fvdl 			panic("HOST_MSG_LOOP interrupt with no active message");
   2660   1.96      fvdl 
   2661   1.96      fvdl #ifdef AHC_DEBUG
   2662   1.96      fvdl 		if ((ahc_debug & AHC_SHOW_MESSAGES) != 0) {
   2663   1.96      fvdl 			ahc_print_devinfo(ahc, &devinfo);
   2664   1.96      fvdl 			printf("INITIATOR_MSG_OUT");
   2665   1.96      fvdl 		}
   2666   1.96      fvdl #endif
   2667   1.96      fvdl 		phasemis = bus_phase != P_MESGOUT;
   2668   1.96      fvdl 		if (phasemis) {
   2669   1.96      fvdl #ifdef AHC_DEBUG
   2670   1.96      fvdl 			if ((ahc_debug & AHC_SHOW_MESSAGES) != 0) {
   2671   1.96      fvdl 				printf(" PHASEMIS %s\n",
   2672   1.96      fvdl 				       ahc_lookup_phase_entry(bus_phase)
   2673   1.96      fvdl 							     ->phasemsg);
   2674   1.96      fvdl 			}
   2675   1.96      fvdl #endif
   2676   1.96      fvdl 			if (bus_phase == P_MESGIN) {
   2677   1.96      fvdl 				/*
   2678   1.96      fvdl 				 * Change gears and see if
   2679   1.96      fvdl 				 * this messages is of interest to
   2680   1.96      fvdl 				 * us or should be passed back to
   2681   1.96      fvdl 				 * the sequencer.
   2682   1.96      fvdl 				 */
   2683   1.96      fvdl 				ahc_outb(ahc, CLRSINT1, CLRATNO);
   2684   1.96      fvdl 				ahc->send_msg_perror = FALSE;
   2685   1.96      fvdl 				ahc->msg_type = MSG_TYPE_INITIATOR_MSGIN;
   2686   1.96      fvdl 				ahc->msgin_index = 0;
   2687   1.96      fvdl 				goto reswitch;
   2688   1.96      fvdl 			}
   2689   1.96      fvdl 			end_session = TRUE;
   2690   1.96      fvdl 			break;
   2691   1.96      fvdl 		}
   2692   1.96      fvdl 
   2693   1.96      fvdl 		if (ahc->send_msg_perror) {
   2694   1.96      fvdl 			ahc_outb(ahc, CLRSINT1, CLRATNO);
   2695   1.96      fvdl 			ahc_outb(ahc, CLRSINT1, CLRREQINIT);
   2696   1.96      fvdl #ifdef AHC_DEBUG
   2697   1.96      fvdl 			if ((ahc_debug & AHC_SHOW_MESSAGES) != 0)
   2698   1.96      fvdl 				printf(" byte 0x%x\n", ahc->send_msg_perror);
   2699   1.96      fvdl #endif
   2700   1.96      fvdl 			ahc_outb(ahc, SCSIDATL, MSG_PARITY_ERROR);
   2701   1.96      fvdl 			break;
   2702   1.96      fvdl 		}
   2703   1.96      fvdl 
   2704   1.96      fvdl 		msgdone	= ahc->msgout_index == ahc->msgout_len;
   2705   1.96      fvdl 		if (msgdone) {
   2706   1.96      fvdl 			/*
   2707   1.96      fvdl 			 * The target has requested a retry.
   2708   1.96      fvdl 			 * Re-assert ATN, reset our message index to
   2709   1.96      fvdl 			 * 0, and try again.
   2710   1.96      fvdl 			 */
   2711   1.96      fvdl 			ahc->msgout_index = 0;
   2712   1.96      fvdl 			ahc_assert_atn(ahc);
   2713   1.96      fvdl 		}
   2714   1.96      fvdl 
   2715   1.96      fvdl 		lastbyte = ahc->msgout_index == (ahc->msgout_len - 1);
   2716   1.96      fvdl 		if (lastbyte) {
   2717   1.96      fvdl 			/* Last byte is signified by dropping ATN */
   2718   1.96      fvdl 			ahc_outb(ahc, CLRSINT1, CLRATNO);
   2719   1.96      fvdl 		}
   2720   1.96      fvdl 
   2721   1.96      fvdl 		/*
   2722   1.96      fvdl 		 * Clear our interrupt status and present
   2723   1.96      fvdl 		 * the next byte on the bus.
   2724   1.96      fvdl 		 */
   2725   1.96      fvdl 		ahc_outb(ahc, CLRSINT1, CLRREQINIT);
   2726   1.96      fvdl #ifdef AHC_DEBUG
   2727   1.96      fvdl 		if ((ahc_debug & AHC_SHOW_MESSAGES) != 0)
   2728   1.96      fvdl 			printf(" byte 0x%x\n",
   2729   1.96      fvdl 			       ahc->msgout_buf[ahc->msgout_index]);
   2730   1.96      fvdl #endif
   2731   1.96      fvdl 		ahc_outb(ahc, SCSIDATL, ahc->msgout_buf[ahc->msgout_index++]);
   2732   1.96      fvdl 		break;
   2733   1.42      fvdl 	}
   2734   1.96      fvdl 	case MSG_TYPE_INITIATOR_MSGIN:
   2735   1.96      fvdl 	{
   2736   1.96      fvdl 		int phasemis;
   2737   1.96      fvdl 		int message_done;
   2738   1.96      fvdl 
   2739   1.96      fvdl #ifdef AHC_DEBUG
   2740   1.96      fvdl 		if ((ahc_debug & AHC_SHOW_MESSAGES) != 0) {
   2741   1.96      fvdl 			ahc_print_devinfo(ahc, &devinfo);
   2742   1.96      fvdl 			printf("INITIATOR_MSG_IN");
   2743   1.96      fvdl 		}
   2744   1.96      fvdl #endif
   2745   1.96      fvdl 		phasemis = bus_phase != P_MESGIN;
   2746   1.96      fvdl 		if (phasemis) {
   2747   1.96      fvdl #ifdef AHC_DEBUG
   2748   1.96      fvdl 			if ((ahc_debug & AHC_SHOW_MESSAGES) != 0) {
   2749   1.96      fvdl 				printf(" PHASEMIS %s\n",
   2750   1.96      fvdl 				       ahc_lookup_phase_entry(bus_phase)
   2751   1.96      fvdl 							     ->phasemsg);
   2752   1.96      fvdl 			}
   2753   1.96      fvdl #endif
   2754   1.96      fvdl 			ahc->msgin_index = 0;
   2755   1.96      fvdl 			if (bus_phase == P_MESGOUT
   2756   1.96      fvdl 			 && (ahc->send_msg_perror == TRUE
   2757   1.96      fvdl 			  || (ahc->msgout_len != 0
   2758   1.96      fvdl 			   && ahc->msgout_index == 0))) {
   2759   1.96      fvdl 				ahc->msg_type = MSG_TYPE_INITIATOR_MSGOUT;
   2760   1.96      fvdl 				goto reswitch;
   2761   1.96      fvdl 			}
   2762   1.96      fvdl 			end_session = TRUE;
   2763   1.96      fvdl 			break;
   2764   1.96      fvdl 		}
   2765   1.42      fvdl 
   2766   1.96      fvdl 		/* Pull the byte in without acking it */
   2767   1.96      fvdl 		ahc->msgin_buf[ahc->msgin_index] = ahc_inb(ahc, SCSIBUSL);
   2768   1.96      fvdl #ifdef AHC_DEBUG
   2769   1.96      fvdl 		if ((ahc_debug & AHC_SHOW_MESSAGES) != 0)
   2770   1.96      fvdl 			printf(" byte 0x%x\n",
   2771   1.96      fvdl 			       ahc->msgin_buf[ahc->msgin_index]);
   2772   1.96      fvdl #endif
   2773   1.42      fvdl 
   2774   1.96      fvdl 		message_done = ahc_parse_msg(ahc, &devinfo);
   2775   1.42      fvdl 
   2776   1.96      fvdl 		if (message_done) {
   2777   1.96      fvdl 			/*
   2778   1.96      fvdl 			 * Clear our incoming message buffer in case there
   2779   1.96      fvdl 			 * is another message following this one.
   2780   1.96      fvdl 			 */
   2781   1.96      fvdl 			ahc->msgin_index = 0;
   2782   1.42      fvdl 
   2783   1.96      fvdl 			/*
   2784   1.96      fvdl 			 * If this message illicited a response,
   2785   1.96      fvdl 			 * assert ATN so the target takes us to the
   2786   1.96      fvdl 			 * message out phase.
   2787   1.96      fvdl 			 */
   2788   1.96      fvdl 			if (ahc->msgout_len != 0) {
   2789   1.42      fvdl #ifdef AHC_DEBUG
   2790   1.96      fvdl 				if ((ahc_debug & AHC_SHOW_MESSAGES) != 0) {
   2791   1.96      fvdl 					ahc_print_devinfo(ahc, &devinfo);
   2792   1.96      fvdl 					printf("Asserting ATN for response\n");
   2793   1.96      fvdl 				}
   2794   1.42      fvdl #endif
   2795   1.96      fvdl 				ahc_assert_atn(ahc);
   2796   1.96      fvdl 			}
   2797   1.96      fvdl 		} else
   2798   1.96      fvdl 			ahc->msgin_index++;
   2799   1.42      fvdl 
   2800   1.96      fvdl 		if (message_done == MSGLOOP_TERMINATED) {
   2801   1.96      fvdl 			end_session = TRUE;
   2802   1.96      fvdl 		} else {
   2803   1.96      fvdl 			/* Ack the byte */
   2804   1.96      fvdl 			ahc_outb(ahc, CLRSINT1, CLRREQINIT);
   2805   1.96      fvdl 			ahc_inb(ahc, SCSIDATL);
   2806   1.96      fvdl 		}
   2807   1.42      fvdl 		break;
   2808   1.42      fvdl 	}
   2809   1.96      fvdl 	case MSG_TYPE_TARGET_MSGIN:
   2810   1.96      fvdl 	{
   2811   1.96      fvdl 		int msgdone;
   2812   1.96      fvdl 		int msgout_request;
   2813   1.42      fvdl 
   2814   1.96      fvdl 		if (ahc->msgout_len == 0)
   2815   1.96      fvdl 			panic("Target MSGIN with no active message");
   2816   1.42      fvdl 
   2817   1.96      fvdl 		/*
   2818   1.96      fvdl 		 * If we interrupted a mesgout session, the initiator
   2819   1.96      fvdl 		 * will not know this until our first REQ.  So, we
   2820   1.96      fvdl 		 * only honor mesgout requests after we've sent our
   2821   1.96      fvdl 		 * first byte.
   2822   1.96      fvdl 		 */
   2823   1.96      fvdl 		if ((ahc_inb(ahc, SCSISIGI) & ATNI) != 0
   2824   1.96      fvdl 		 && ahc->msgout_index > 0)
   2825   1.96      fvdl 			msgout_request = TRUE;
   2826   1.96      fvdl 		else
   2827   1.96      fvdl 			msgout_request = FALSE;
   2828   1.42      fvdl 
   2829   1.96      fvdl 		if (msgout_request) {
   2830   1.42      fvdl 
   2831   1.96      fvdl 			/*
   2832   1.96      fvdl 			 * Change gears and see if
   2833   1.96      fvdl 			 * this messages is of interest to
   2834   1.96      fvdl 			 * us or should be passed back to
   2835   1.96      fvdl 			 * the sequencer.
   2836   1.96      fvdl 			 */
   2837   1.96      fvdl 			ahc->msg_type = MSG_TYPE_TARGET_MSGOUT;
   2838   1.96      fvdl 			ahc_outb(ahc, SCSISIGO, P_MESGOUT | BSYO);
   2839   1.96      fvdl 			ahc->msgin_index = 0;
   2840   1.96      fvdl 			/* Dummy read to REQ for first byte */
   2841   1.96      fvdl 			ahc_inb(ahc, SCSIDATL);
   2842   1.96      fvdl 			ahc_outb(ahc, SXFRCTL0,
   2843   1.96      fvdl 				 ahc_inb(ahc, SXFRCTL0) | SPIOEN);
   2844   1.96      fvdl 			break;
   2845   1.96      fvdl 		}
   2846   1.42      fvdl 
   2847   1.96      fvdl 		msgdone = ahc->msgout_index == ahc->msgout_len;
   2848   1.96      fvdl 		if (msgdone) {
   2849   1.96      fvdl 			ahc_outb(ahc, SXFRCTL0,
   2850   1.96      fvdl 				 ahc_inb(ahc, SXFRCTL0) & ~SPIOEN);
   2851   1.96      fvdl 			end_session = TRUE;
   2852   1.96      fvdl 			break;
   2853   1.96      fvdl 		}
   2854   1.42      fvdl 
   2855   1.96      fvdl 		/*
   2856   1.96      fvdl 		 * Present the next byte on the bus.
   2857   1.96      fvdl 		 */
   2858   1.96      fvdl 		ahc_outb(ahc, SXFRCTL0, ahc_inb(ahc, SXFRCTL0) | SPIOEN);
   2859   1.96      fvdl 		ahc_outb(ahc, SCSIDATL, ahc->msgout_buf[ahc->msgout_index++]);
   2860   1.96      fvdl 		break;
   2861   1.96      fvdl 	}
   2862   1.96      fvdl 	case MSG_TYPE_TARGET_MSGOUT:
   2863   1.96      fvdl 	{
   2864   1.96      fvdl 		int lastbyte;
   2865   1.96      fvdl 		int msgdone;
   2866   1.42      fvdl 
   2867   1.96      fvdl 		/*
   2868   1.96      fvdl 		 * The initiator signals that this is
   2869   1.96      fvdl 		 * the last byte by dropping ATN.
   2870   1.96      fvdl 		 */
   2871   1.96      fvdl 		lastbyte = (ahc_inb(ahc, SCSISIGI) & ATNI) == 0;
   2872   1.42      fvdl 
   2873   1.96      fvdl 		/*
   2874   1.96      fvdl 		 * Read the latched byte, but turn off SPIOEN first
   2875   1.96      fvdl 		 * so that we don't inadvertently cause a REQ for the
   2876   1.96      fvdl 		 * next byte.
   2877   1.96      fvdl 		 */
   2878   1.96      fvdl 		ahc_outb(ahc, SXFRCTL0, ahc_inb(ahc, SXFRCTL0) & ~SPIOEN);
   2879   1.96      fvdl 		ahc->msgin_buf[ahc->msgin_index] = ahc_inb(ahc, SCSIDATL);
   2880   1.96      fvdl 		msgdone = ahc_parse_msg(ahc, &devinfo);
   2881   1.96      fvdl 		if (msgdone == MSGLOOP_TERMINATED) {
   2882   1.96      fvdl 			/*
   2883   1.96      fvdl 			 * The message is *really* done in that it caused
   2884   1.96      fvdl 			 * us to go to bus free.  The sequencer has already
   2885   1.96      fvdl 			 * been reset at this point, so pull the ejection
   2886   1.96      fvdl 			 * handle.
   2887   1.96      fvdl 			 */
   2888   1.96      fvdl 			return;
   2889   1.96      fvdl 		}
   2890   1.96      fvdl 
   2891   1.96      fvdl 		ahc->msgin_index++;
   2892   1.42      fvdl 
   2893   1.96      fvdl 		/*
   2894   1.96      fvdl 		 * XXX Read spec about initiator dropping ATN too soon
   2895   1.96      fvdl 		 *     and use msgdone to detect it.
   2896   1.96      fvdl 		 */
   2897   1.96      fvdl 		if (msgdone == MSGLOOP_MSGCOMPLETE) {
   2898   1.96      fvdl 			ahc->msgin_index = 0;
   2899   1.42      fvdl 
   2900   1.96      fvdl 			/*
   2901   1.96      fvdl 			 * If this message illicited a response, transition
   2902   1.96      fvdl 			 * to the Message in phase and send it.
   2903   1.96      fvdl 			 */
   2904   1.96      fvdl 			if (ahc->msgout_len != 0) {
   2905   1.96      fvdl 				ahc_outb(ahc, SCSISIGO, P_MESGIN | BSYO);
   2906   1.96      fvdl 				ahc_outb(ahc, SXFRCTL0,
   2907   1.96      fvdl 					 ahc_inb(ahc, SXFRCTL0) | SPIOEN);
   2908   1.96      fvdl 				ahc->msg_type = MSG_TYPE_TARGET_MSGIN;
   2909   1.96      fvdl 				ahc->msgin_index = 0;
   2910   1.96      fvdl 				break;
   2911   1.96      fvdl 			}
   2912   1.96      fvdl 		}
   2913   1.42      fvdl 
   2914   1.96      fvdl 		if (lastbyte)
   2915   1.96      fvdl 			end_session = TRUE;
   2916   1.96      fvdl 		else {
   2917   1.96      fvdl 			/* Ask for the next byte. */
   2918   1.96      fvdl 			ahc_outb(ahc, SXFRCTL0,
   2919   1.96      fvdl 				 ahc_inb(ahc, SXFRCTL0) | SPIOEN);
   2920   1.96      fvdl 		}
   2921   1.42      fvdl 
   2922   1.96      fvdl 		break;
   2923   1.96      fvdl 	}
   2924   1.96      fvdl 	default:
   2925   1.96      fvdl 		panic("Unknown REQINIT message type");
   2926   1.96      fvdl 	}
   2927   1.42      fvdl 
   2928   1.96      fvdl 	if (end_session) {
   2929   1.96      fvdl 		ahc_clear_msg_state(ahc);
   2930   1.96      fvdl 		ahc_outb(ahc, RETURN_1, EXIT_MSG_LOOP);
   2931   1.96      fvdl 	} else
   2932   1.96      fvdl 		ahc_outb(ahc, RETURN_1, CONT_MSG_LOOP);
   2933   1.42      fvdl }
   2934   1.42      fvdl 
   2935   1.96      fvdl /*
   2936   1.96      fvdl  * See if we sent a particular extended message to the target.
   2937   1.96      fvdl  * If "full" is true, return true only if the target saw the full
   2938   1.96      fvdl  * message.  If "full" is false, return true if the target saw at
   2939   1.96      fvdl  * least the first byte of the message.
   2940   1.96      fvdl  */
   2941   1.42      fvdl static int
   2942   1.96      fvdl ahc_sent_msg(struct ahc_softc *ahc, ahc_msgtype type, u_int msgval, int full)
   2943   1.42      fvdl {
   2944   1.96      fvdl 	int found;
   2945   1.96      fvdl 	u_int index;
   2946   1.42      fvdl 
   2947   1.96      fvdl 	found = FALSE;
   2948   1.96      fvdl 	index = 0;
   2949   1.42      fvdl 
   2950   1.96      fvdl 	while (index < ahc->msgout_len) {
   2951   1.96      fvdl 		if (ahc->msgout_buf[index] == MSG_EXTENDED) {
   2952   1.96      fvdl 			u_int end_index;
   2953   1.42      fvdl 
   2954   1.96      fvdl 			end_index = index + 1 + ahc->msgout_buf[index + 1];
   2955   1.96      fvdl 			if (ahc->msgout_buf[index+2] == msgval
   2956   1.96      fvdl 			 && type == AHCMSG_EXT) {
   2957   1.42      fvdl 
   2958   1.96      fvdl 				if (full) {
   2959   1.96      fvdl 					if (ahc->msgout_index > end_index)
   2960   1.96      fvdl 						found = TRUE;
   2961   1.96      fvdl 				} else if (ahc->msgout_index > index)
   2962   1.96      fvdl 					found = TRUE;
   2963   1.96      fvdl 			}
   2964   1.96      fvdl 			index = end_index;
   2965   1.96      fvdl 		} else if (ahc->msgout_buf[index] >= MSG_SIMPLE_TASK
   2966   1.96      fvdl 			&& ahc->msgout_buf[index] <= MSG_IGN_WIDE_RESIDUE) {
   2967   1.42      fvdl 
   2968   1.96      fvdl 			/* Skip tag type and tag id or residue param*/
   2969   1.96      fvdl 			index += 2;
   2970   1.96      fvdl 		} else {
   2971   1.96      fvdl 			/* Single byte message */
   2972   1.96      fvdl 			if (type == AHCMSG_1B
   2973   1.96      fvdl 			 && ahc->msgout_buf[index] == msgval
   2974   1.96      fvdl 			 && ahc->msgout_index > index)
   2975   1.96      fvdl 				found = TRUE;
   2976   1.96      fvdl 			index++;
   2977   1.96      fvdl 		}
   2978   1.42      fvdl 
   2979   1.96      fvdl 		if (found)
   2980   1.96      fvdl 			break;
   2981   1.42      fvdl 	}
   2982   1.96      fvdl 	return (found);
   2983   1.96      fvdl }
   2984   1.42      fvdl 
   2985   1.96      fvdl /*
   2986   1.96      fvdl  * Wait for a complete incoming message, parse it, and respond accordingly.
   2987   1.96      fvdl  */
   2988   1.96      fvdl static int
   2989   1.96      fvdl ahc_parse_msg(struct ahc_softc *ahc, struct ahc_devinfo *devinfo)
   2990   1.96      fvdl {
   2991   1.96      fvdl 	struct	ahc_initiator_tinfo *tinfo;
   2992   1.96      fvdl 	struct	ahc_tmode_tstate *tstate;
   2993   1.96      fvdl 	int	reject;
   2994   1.96      fvdl 	int	done;
   2995   1.96      fvdl 	int	response;
   2996   1.96      fvdl 	u_int	targ_scsirate;
   2997   1.42      fvdl 
   2998   1.96      fvdl 	done = MSGLOOP_IN_PROG;
   2999   1.96      fvdl 	response = FALSE;
   3000   1.96      fvdl 	reject = FALSE;
   3001   1.96      fvdl 	tinfo = ahc_fetch_transinfo(ahc, devinfo->channel, devinfo->our_scsiid,
   3002   1.96      fvdl 				    devinfo->target, &tstate);
   3003   1.96      fvdl 	targ_scsirate = tinfo->scsirate;
   3004   1.42      fvdl 
   3005   1.42      fvdl 	/*
   3006   1.96      fvdl 	 * Parse as much of the message as is availible,
   3007   1.96      fvdl 	 * rejecting it if we don't support it.  When
   3008   1.96      fvdl 	 * the entire message is availible and has been
   3009   1.96      fvdl 	 * handled, return MSGLOOP_MSGCOMPLETE, indicating
   3010   1.96      fvdl 	 * that we have parsed an entire message.
   3011   1.42      fvdl 	 *
   3012   1.96      fvdl 	 * In the case of extended messages, we accept the length
   3013   1.96      fvdl 	 * byte outright and perform more checking once we know the
   3014   1.96      fvdl 	 * extended message type.
   3015   1.42      fvdl 	 */
   3016   1.96      fvdl 	switch (ahc->msgin_buf[0]) {
   3017   1.96      fvdl 	case MSG_DISCONNECT:
   3018   1.96      fvdl 	case MSG_SAVEDATAPOINTER:
   3019   1.96      fvdl 	case MSG_CMDCOMPLETE:
   3020   1.96      fvdl 	case MSG_RESTOREPOINTERS:
   3021   1.96      fvdl 	case MSG_IGN_WIDE_RESIDUE:
   3022   1.96      fvdl 		/*
   3023   1.96      fvdl 		 * End our message loop as these are messages
   3024   1.96      fvdl 		 * the sequencer handles on its own.
   3025   1.96      fvdl 		 */
   3026   1.96      fvdl 		done = MSGLOOP_TERMINATED;
   3027   1.96      fvdl 		break;
   3028   1.96      fvdl 	case MSG_MESSAGE_REJECT:
   3029   1.96      fvdl 		response = ahc_handle_msg_reject(ahc, devinfo);
   3030   1.96      fvdl 		/* FALLTHROUGH */
   3031   1.96      fvdl 	case MSG_NOOP:
   3032   1.96      fvdl 		done = MSGLOOP_MSGCOMPLETE;
   3033   1.96      fvdl 		break;
   3034   1.96      fvdl 	case MSG_EXTENDED:
   3035   1.96      fvdl 	{
   3036   1.96      fvdl 		/* Wait for enough of the message to begin validation */
   3037   1.96      fvdl 		if (ahc->msgin_index < 2)
   3038   1.96      fvdl 			break;
   3039   1.96      fvdl 		switch (ahc->msgin_buf[2]) {
   3040   1.96      fvdl 		case MSG_EXT_SDTR:
   3041   1.96      fvdl 		{
   3042   1.96      fvdl 			struct	 ahc_syncrate *syncrate;
   3043   1.96      fvdl 			u_int	 period;
   3044   1.96      fvdl 			u_int	 ppr_options;
   3045   1.96      fvdl 			u_int	 offset;
   3046   1.96      fvdl 			u_int	 saved_offset;
   3047   1.96      fvdl 
   3048   1.96      fvdl 			if (ahc->msgin_buf[1] != MSG_EXT_SDTR_LEN) {
   3049   1.96      fvdl 				reject = TRUE;
   3050   1.96      fvdl 				break;
   3051   1.96      fvdl 			}
   3052   1.42      fvdl 
   3053   1.96      fvdl 			/*
   3054   1.96      fvdl 			 * Wait until we have both args before validating
   3055   1.96      fvdl 			 * and acting on this message.
   3056   1.96      fvdl 			 *
   3057   1.96      fvdl 			 * Add one to MSG_EXT_SDTR_LEN to account for
   3058   1.96      fvdl 			 * the extended message preamble.
   3059   1.96      fvdl 			 */
   3060   1.96      fvdl 			if (ahc->msgin_index < (MSG_EXT_SDTR_LEN + 1))
   3061   1.96      fvdl 				break;
   3062   1.42      fvdl 
   3063   1.96      fvdl 			period = ahc->msgin_buf[3];
   3064   1.96      fvdl 			ppr_options = 0;
   3065   1.96      fvdl 			saved_offset = offset = ahc->msgin_buf[4];
   3066   1.96      fvdl 			syncrate = ahc_devlimited_syncrate(ahc, tinfo, &period,
   3067   1.96      fvdl 							   &ppr_options,
   3068   1.96      fvdl 							   devinfo->role);
   3069   1.96      fvdl 			ahc_validate_offset(ahc, tinfo, syncrate, &offset,
   3070   1.96      fvdl 					    targ_scsirate & WIDEXFER,
   3071   1.96      fvdl 					    devinfo->role);
   3072   1.96      fvdl 			if (bootverbose) {
   3073   1.96      fvdl 				printf("(%s:%c:%d:%d): Received "
   3074   1.96      fvdl 				       "SDTR period %x, offset %x\n\t"
   3075   1.96      fvdl 				       "Filtered to period %x, offset %x\n",
   3076   1.96      fvdl 				       ahc_name(ahc), devinfo->channel,
   3077   1.96      fvdl 				       devinfo->target, devinfo->lun,
   3078   1.96      fvdl 				       ahc->msgin_buf[3], saved_offset,
   3079   1.96      fvdl 				       period, offset);
   3080   1.96      fvdl 			}
   3081   1.96      fvdl 			ahc_set_syncrate(ahc, devinfo,
   3082   1.96      fvdl 					 syncrate, period,
   3083   1.96      fvdl 					 offset, ppr_options,
   3084   1.96      fvdl 					 AHC_TRANS_ACTIVE|AHC_TRANS_GOAL,
   3085   1.96      fvdl 					 /*paused*/TRUE);
   3086   1.42      fvdl 
   3087   1.96      fvdl 			/*
   3088   1.96      fvdl 			 * See if we initiated Sync Negotiation
   3089   1.96      fvdl 			 * and didn't have to fall down to async
   3090   1.96      fvdl 			 * transfers.
   3091   1.96      fvdl 			 */
   3092   1.96      fvdl 			if (ahc_sent_msg(ahc, AHCMSG_EXT, MSG_EXT_SDTR, TRUE)) {
   3093   1.96      fvdl 				/* We started it */
   3094   1.96      fvdl 				if (saved_offset != offset) {
   3095   1.96      fvdl 					/* Went too low - force async */
   3096   1.96      fvdl 					reject = TRUE;
   3097   1.96      fvdl 				}
   3098   1.96      fvdl 			} else {
   3099   1.96      fvdl 				/*
   3100   1.96      fvdl 				 * Send our own SDTR in reply
   3101   1.96      fvdl 				 */
   3102   1.96      fvdl 				if (bootverbose
   3103   1.96      fvdl 				 && devinfo->role == ROLE_INITIATOR) {
   3104   1.96      fvdl 					printf("(%s:%c:%d:%d): Target "
   3105   1.96      fvdl 					       "Initiated SDTR\n",
   3106   1.96      fvdl 					       ahc_name(ahc), devinfo->channel,
   3107   1.96      fvdl 					       devinfo->target, devinfo->lun);
   3108   1.96      fvdl 				}
   3109   1.96      fvdl 				ahc->msgout_index = 0;
   3110   1.96      fvdl 				ahc->msgout_len = 0;
   3111   1.96      fvdl 				ahc_construct_sdtr(ahc, devinfo,
   3112   1.96      fvdl 						   period, offset);
   3113   1.96      fvdl 				ahc->msgout_index = 0;
   3114   1.96      fvdl 				response = TRUE;
   3115   1.96      fvdl 			}
   3116   1.96      fvdl 			done = MSGLOOP_MSGCOMPLETE;
   3117   1.96      fvdl 			break;
   3118   1.96      fvdl 		}
   3119   1.96      fvdl 		case MSG_EXT_WDTR:
   3120   1.96      fvdl 		{
   3121   1.96      fvdl 			u_int bus_width;
   3122   1.96      fvdl 			u_int saved_width;
   3123   1.96      fvdl 			u_int sending_reply;
   3124   1.42      fvdl 
   3125   1.96      fvdl 			sending_reply = FALSE;
   3126   1.96      fvdl 			if (ahc->msgin_buf[1] != MSG_EXT_WDTR_LEN) {
   3127   1.96      fvdl 				reject = TRUE;
   3128   1.96      fvdl 				break;
   3129   1.96      fvdl 			}
   3130   1.42      fvdl 
   3131   1.96      fvdl 			/*
   3132   1.96      fvdl 			 * Wait until we have our arg before validating
   3133   1.96      fvdl 			 * and acting on this message.
   3134   1.96      fvdl 			 *
   3135   1.96      fvdl 			 * Add one to MSG_EXT_WDTR_LEN to account for
   3136   1.96      fvdl 			 * the extended message preamble.
   3137   1.96      fvdl 			 */
   3138   1.96      fvdl 			if (ahc->msgin_index < (MSG_EXT_WDTR_LEN + 1))
   3139   1.96      fvdl 				break;
   3140   1.42      fvdl 
   3141   1.96      fvdl 			bus_width = ahc->msgin_buf[3];
   3142   1.96      fvdl 			saved_width = bus_width;
   3143   1.96      fvdl 			ahc_validate_width(ahc, tinfo, &bus_width,
   3144   1.96      fvdl 					   devinfo->role);
   3145   1.96      fvdl 			if (bootverbose) {
   3146   1.96      fvdl 				printf("(%s:%c:%d:%d): Received WDTR "
   3147   1.96      fvdl 				       "%x filtered to %x\n",
   3148   1.96      fvdl 				       ahc_name(ahc), devinfo->channel,
   3149   1.96      fvdl 				       devinfo->target, devinfo->lun,
   3150   1.96      fvdl 				       saved_width, bus_width);
   3151   1.96      fvdl 			}
   3152   1.42      fvdl 
   3153   1.96      fvdl 			if (ahc_sent_msg(ahc, AHCMSG_EXT, MSG_EXT_WDTR, TRUE)) {
   3154   1.96      fvdl 				/*
   3155   1.96      fvdl 				 * Don't send a WDTR back to the
   3156   1.96      fvdl 				 * target, since we asked first.
   3157   1.96      fvdl 				 * If the width went higher than our
   3158   1.96      fvdl 				 * request, reject it.
   3159   1.96      fvdl 				 */
   3160   1.96      fvdl 				if (saved_width > bus_width) {
   3161   1.96      fvdl 					reject = TRUE;
   3162   1.96      fvdl 					printf("(%s:%c:%d:%d): requested %dBit "
   3163   1.96      fvdl 					       "transfers.  Rejecting...\n",
   3164   1.96      fvdl 					       ahc_name(ahc), devinfo->channel,
   3165   1.96      fvdl 					       devinfo->target, devinfo->lun,
   3166   1.96      fvdl 					       8 * (0x01 << bus_width));
   3167   1.96      fvdl 					bus_width = 0;
   3168   1.96      fvdl 				}
   3169   1.96      fvdl 			} else {
   3170   1.96      fvdl 				/*
   3171   1.96      fvdl 				 * Send our own WDTR in reply
   3172   1.96      fvdl 				 */
   3173   1.96      fvdl 				if (bootverbose
   3174   1.96      fvdl 				 && devinfo->role == ROLE_INITIATOR) {
   3175   1.96      fvdl 					printf("(%s:%c:%d:%d): Target "
   3176   1.96      fvdl 					       "Initiated WDTR\n",
   3177   1.96      fvdl 					       ahc_name(ahc), devinfo->channel,
   3178   1.96      fvdl 					       devinfo->target, devinfo->lun);
   3179   1.96      fvdl 				}
   3180   1.96      fvdl 				ahc->msgout_index = 0;
   3181   1.96      fvdl 				ahc->msgout_len = 0;
   3182   1.96      fvdl 				ahc_construct_wdtr(ahc, devinfo, bus_width);
   3183   1.96      fvdl 				ahc->msgout_index = 0;
   3184   1.96      fvdl 				response = TRUE;
   3185   1.96      fvdl 				sending_reply = TRUE;
   3186   1.96      fvdl 			}
   3187   1.96      fvdl 			ahc_set_width(ahc, devinfo, bus_width,
   3188   1.96      fvdl 				      AHC_TRANS_ACTIVE|AHC_TRANS_GOAL,
   3189   1.96      fvdl 				      /*paused*/TRUE);
   3190   1.96      fvdl 			/* After a wide message, we are async */
   3191   1.96      fvdl 			ahc_set_syncrate(ahc, devinfo,
   3192   1.96      fvdl 					 /*syncrate*/NULL, /*period*/0,
   3193   1.96      fvdl 					 /*offset*/0, /*ppr_options*/0,
   3194   1.96      fvdl 					 AHC_TRANS_ACTIVE, /*paused*/TRUE);
   3195   1.96      fvdl 			if (sending_reply == FALSE && reject == FALSE) {
   3196   1.42      fvdl 
   3197   1.96      fvdl 				if (tinfo->goal.offset) {
   3198   1.96      fvdl 					ahc->msgout_index = 0;
   3199   1.96      fvdl 					ahc->msgout_len = 0;
   3200   1.96      fvdl 					ahc_build_transfer_msg(ahc, devinfo);
   3201   1.96      fvdl 					ahc->msgout_index = 0;
   3202   1.96      fvdl 					response = TRUE;
   3203   1.96      fvdl 				}
   3204   1.96      fvdl 			}
   3205   1.96      fvdl 			done = MSGLOOP_MSGCOMPLETE;
   3206   1.96      fvdl 			break;
   3207   1.96      fvdl 		}
   3208   1.96      fvdl 		case MSG_EXT_PPR:
   3209   1.96      fvdl 		{
   3210   1.96      fvdl 			struct	ahc_syncrate *syncrate;
   3211   1.96      fvdl 			u_int	period;
   3212   1.96      fvdl 			u_int	offset;
   3213   1.96      fvdl 			u_int	bus_width;
   3214   1.96      fvdl 			u_int	ppr_options;
   3215   1.96      fvdl 			u_int	saved_width;
   3216   1.96      fvdl 			u_int	saved_offset;
   3217   1.96      fvdl 			u_int	saved_ppr_options;
   3218   1.42      fvdl 
   3219   1.96      fvdl 			if (ahc->msgin_buf[1] != MSG_EXT_PPR_LEN) {
   3220   1.96      fvdl 				reject = TRUE;
   3221   1.96      fvdl 				break;
   3222   1.96      fvdl 			}
   3223   1.42      fvdl 
   3224   1.96      fvdl 			/*
   3225   1.96      fvdl 			 * Wait until we have all args before validating
   3226   1.96      fvdl 			 * and acting on this message.
   3227   1.96      fvdl 			 *
   3228   1.96      fvdl 			 * Add one to MSG_EXT_PPR_LEN to account for
   3229   1.96      fvdl 			 * the extended message preamble.
   3230   1.96      fvdl 			 */
   3231   1.96      fvdl 			if (ahc->msgin_index < (MSG_EXT_PPR_LEN + 1))
   3232   1.96      fvdl 				break;
   3233   1.42      fvdl 
   3234   1.96      fvdl 			period = ahc->msgin_buf[3];
   3235   1.96      fvdl 			offset = ahc->msgin_buf[5];
   3236   1.96      fvdl 			bus_width = ahc->msgin_buf[6];
   3237   1.96      fvdl 			saved_width = bus_width;
   3238   1.96      fvdl 			ppr_options = ahc->msgin_buf[7];
   3239   1.96      fvdl 			/*
   3240   1.96      fvdl 			 * According to the spec, a DT only
   3241   1.96      fvdl 			 * period factor with no DT option
   3242   1.96      fvdl 			 * set implies async.
   3243   1.96      fvdl 			 */
   3244   1.96      fvdl 			if ((ppr_options & MSG_EXT_PPR_DT_REQ) == 0
   3245   1.96      fvdl 			 && period == 9)
   3246   1.96      fvdl 				offset = 0;
   3247   1.96      fvdl 			saved_ppr_options = ppr_options;
   3248   1.96      fvdl 			saved_offset = offset;
   3249   1.42      fvdl 
   3250   1.96      fvdl 			/*
   3251   1.96      fvdl 			 * Mask out any options we don't support
   3252   1.96      fvdl 			 * on any controller.  Transfer options are
   3253   1.96      fvdl 			 * only available if we are negotiating wide.
   3254   1.96      fvdl 			 */
   3255   1.96      fvdl 			ppr_options &= MSG_EXT_PPR_DT_REQ;
   3256   1.96      fvdl 			if (bus_width == 0)
   3257   1.96      fvdl 				ppr_options = 0;
   3258   1.96      fvdl 
   3259   1.96      fvdl 			ahc_validate_width(ahc, tinfo, &bus_width,
   3260   1.96      fvdl 					   devinfo->role);
   3261   1.96      fvdl 			syncrate = ahc_devlimited_syncrate(ahc, tinfo, &period,
   3262   1.96      fvdl 							   &ppr_options,
   3263   1.96      fvdl 							   devinfo->role);
   3264   1.96      fvdl 			ahc_validate_offset(ahc, tinfo, syncrate,
   3265   1.96      fvdl 					    &offset, bus_width,
   3266   1.96      fvdl 					    devinfo->role);
   3267   1.42      fvdl 
   3268   1.96      fvdl 			if (ahc_sent_msg(ahc, AHCMSG_EXT, MSG_EXT_PPR, TRUE)) {
   3269   1.96      fvdl 				/*
   3270   1.96      fvdl 				 * If we are unable to do any of the
   3271   1.96      fvdl 				 * requested options (we went too low),
   3272   1.96      fvdl 				 * then we'll have to reject the message.
   3273   1.96      fvdl 				 */
   3274   1.96      fvdl 				if (saved_width > bus_width
   3275   1.96      fvdl 				 || saved_offset != offset
   3276   1.96      fvdl 				 || saved_ppr_options != ppr_options) {
   3277   1.96      fvdl 					reject = TRUE;
   3278   1.96      fvdl 					period = 0;
   3279   1.96      fvdl 					offset = 0;
   3280   1.96      fvdl 					bus_width = 0;
   3281   1.96      fvdl 					ppr_options = 0;
   3282   1.96      fvdl 					syncrate = NULL;
   3283   1.96      fvdl 				}
   3284   1.96      fvdl 			} else {
   3285   1.96      fvdl 				if (devinfo->role != ROLE_TARGET)
   3286   1.96      fvdl 					printf("(%s:%c:%d:%d): Target "
   3287   1.96      fvdl 					       "Initiated PPR\n",
   3288   1.96      fvdl 					       ahc_name(ahc), devinfo->channel,
   3289   1.96      fvdl 					       devinfo->target, devinfo->lun);
   3290   1.96      fvdl 				else
   3291   1.96      fvdl 					printf("(%s:%c:%d:%d): Initiator "
   3292   1.96      fvdl 					       "Initiated PPR\n",
   3293   1.96      fvdl 					       ahc_name(ahc), devinfo->channel,
   3294   1.96      fvdl 					       devinfo->target, devinfo->lun);
   3295   1.96      fvdl 				ahc->msgout_index = 0;
   3296   1.96      fvdl 				ahc->msgout_len = 0;
   3297   1.96      fvdl 				ahc_construct_ppr(ahc, devinfo, period, offset,
   3298   1.96      fvdl 						  bus_width, ppr_options);
   3299   1.96      fvdl 				ahc->msgout_index = 0;
   3300   1.96      fvdl 				response = TRUE;
   3301   1.96      fvdl 			}
   3302   1.96      fvdl 			if (bootverbose) {
   3303   1.96      fvdl 				printf("(%s:%c:%d:%d): Received PPR width %x, "
   3304   1.96      fvdl 				       "period %x, offset %x,options %x\n"
   3305   1.96      fvdl 				       "\tFiltered to width %x, period %x, "
   3306   1.96      fvdl 				       "offset %x, options %x\n",
   3307   1.96      fvdl 				       ahc_name(ahc), devinfo->channel,
   3308   1.96      fvdl 				       devinfo->target, devinfo->lun,
   3309   1.96      fvdl 				       saved_width, ahc->msgin_buf[3],
   3310   1.96      fvdl 				       saved_offset, saved_ppr_options,
   3311   1.96      fvdl 				       bus_width, period, offset, ppr_options);
   3312   1.96      fvdl 			}
   3313   1.96      fvdl 			ahc_set_width(ahc, devinfo, bus_width,
   3314   1.96      fvdl 				      AHC_TRANS_ACTIVE|AHC_TRANS_GOAL,
   3315   1.96      fvdl 				      /*paused*/TRUE);
   3316   1.96      fvdl 			ahc_set_syncrate(ahc, devinfo,
   3317   1.96      fvdl 					 syncrate, period,
   3318   1.96      fvdl 					 offset, ppr_options,
   3319   1.96      fvdl 					 AHC_TRANS_ACTIVE|AHC_TRANS_GOAL,
   3320   1.96      fvdl 					 /*paused*/TRUE);
   3321   1.96      fvdl 			done = MSGLOOP_MSGCOMPLETE;
   3322   1.96      fvdl 			break;
   3323   1.96      fvdl 		}
   3324   1.96      fvdl 		default:
   3325   1.96      fvdl 			/* Unknown extended message.  Reject it. */
   3326   1.96      fvdl 			reject = TRUE;
   3327   1.96      fvdl 			break;
   3328   1.96      fvdl 		}
   3329   1.96      fvdl 		break;
   3330   1.96      fvdl 	}
   3331   1.96      fvdl #ifdef AHC_TARGET_MODE
   3332   1.96      fvdl 	case MSG_BUS_DEV_RESET:
   3333   1.96      fvdl 		ahc_handle_devreset(ahc, devinfo,
   3334   1.96      fvdl 				    CAM_BDR_SENT,
   3335   1.96      fvdl 				    "Bus Device Reset Received",
   3336   1.96      fvdl 				    /*verbose_level*/0);
   3337   1.96      fvdl 		ahc_restart(ahc);
   3338   1.96      fvdl 		done = MSGLOOP_TERMINATED;
   3339   1.96      fvdl 		break;
   3340   1.96      fvdl 	case MSG_ABORT_TAG:
   3341   1.96      fvdl 	case MSG_ABORT:
   3342   1.96      fvdl 	case MSG_CLEAR_QUEUE:
   3343   1.42      fvdl 	{
   3344   1.96      fvdl 		int tag;
   3345   1.42      fvdl 
   3346   1.96      fvdl 		/* Target mode messages */
   3347   1.96      fvdl 		if (devinfo->role != ROLE_TARGET) {
   3348   1.96      fvdl 			reject = TRUE;
   3349   1.96      fvdl 			break;
   3350   1.42      fvdl 		}
   3351   1.96      fvdl 		tag = SCB_LIST_NULL;
   3352   1.96      fvdl 		if (ahc->msgin_buf[0] == MSG_ABORT_TAG)
   3353   1.96      fvdl 			tag = ahc_inb(ahc, INITIATOR_TAG);
   3354   1.96      fvdl 		ahc_abort_scbs(ahc, devinfo->target, devinfo->channel,
   3355   1.96      fvdl 			       devinfo->lun, tag, ROLE_TARGET,
   3356   1.96      fvdl 			       CAM_REQ_ABORTED);
   3357   1.42      fvdl 
   3358   1.96      fvdl 		tstate = ahc->enabled_targets[devinfo->our_scsiid];
   3359   1.96      fvdl 		if (tstate != NULL) {
   3360   1.96      fvdl 			struct ahc_tmode_lstate* lstate;
   3361   1.42      fvdl 
   3362   1.96      fvdl 			lstate = tstate->enabled_luns[devinfo->lun];
   3363   1.96      fvdl 			if (lstate != NULL) {
   3364   1.96      fvdl 				ahc_queue_lstate_event(ahc, lstate,
   3365   1.96      fvdl 						       devinfo->our_scsiid,
   3366   1.96      fvdl 						       ahc->msgin_buf[0],
   3367   1.96      fvdl 						       /*arg*/tag);
   3368   1.96      fvdl 				ahc_send_lstate_events(ahc, lstate);
   3369   1.96      fvdl 			}
   3370   1.96      fvdl 		}
   3371   1.96      fvdl 		ahc_restart(ahc);
   3372   1.96      fvdl 		done = MSGLOOP_TERMINATED;
   3373   1.42      fvdl 		break;
   3374   1.96      fvdl 	}
   3375   1.96      fvdl #endif
   3376   1.96      fvdl 	case MSG_TERM_IO_PROC:
   3377   1.96      fvdl 	default:
   3378   1.96      fvdl 		reject = TRUE;
   3379   1.42      fvdl 		break;
   3380   1.42      fvdl 	}
   3381   1.42      fvdl 
   3382   1.96      fvdl 	if (reject) {
   3383   1.96      fvdl 		/*
   3384   1.96      fvdl 		 * Setup to reject the message.
   3385   1.96      fvdl 		 */
   3386   1.96      fvdl 		ahc->msgout_index = 0;
   3387   1.96      fvdl 		ahc->msgout_len = 1;
   3388   1.96      fvdl 		ahc->msgout_buf[0] = MSG_MESSAGE_REJECT;
   3389   1.96      fvdl 		done = MSGLOOP_MSGCOMPLETE;
   3390   1.96      fvdl 		response = TRUE;
   3391   1.96      fvdl 	}
   3392   1.42      fvdl 
   3393   1.96      fvdl 	if (done != MSGLOOP_IN_PROG && !response)
   3394   1.96      fvdl 		/* Clear the outgoing message buffer */
   3395   1.96      fvdl 		ahc->msgout_len = 0;
   3396   1.42      fvdl 
   3397   1.96      fvdl 	return (done);
   3398   1.42      fvdl }
   3399   1.42      fvdl 
   3400   1.42      fvdl /*
   3401   1.96      fvdl  * Process a message reject message.
   3402   1.42      fvdl  */
   3403   1.96      fvdl static int
   3404   1.96      fvdl ahc_handle_msg_reject(struct ahc_softc *ahc, struct ahc_devinfo *devinfo)
   3405   1.42      fvdl {
   3406   1.96      fvdl 	/*
   3407   1.96      fvdl 	 * What we care about here is if we had an
   3408   1.96      fvdl 	 * outstanding SDTR or WDTR message for this
   3409   1.96      fvdl 	 * target.  If we did, this is a signal that
   3410   1.96      fvdl 	 * the target is refusing negotiation.
   3411   1.96      fvdl 	 */
   3412   1.96      fvdl 	struct scb *scb;
   3413   1.96      fvdl 	struct ahc_initiator_tinfo *tinfo;
   3414   1.96      fvdl 	struct ahc_tmode_tstate *tstate;
   3415   1.96      fvdl 	u_int scb_index;
   3416   1.96      fvdl 	u_int last_msg;
   3417   1.96      fvdl 	int   response = 0;
   3418   1.42      fvdl 
   3419   1.96      fvdl 	scb_index = ahc_inb(ahc, SCB_TAG);
   3420   1.96      fvdl 	scb = ahc_lookup_scb(ahc, scb_index);
   3421   1.96      fvdl 	tinfo = ahc_fetch_transinfo(ahc, devinfo->channel,
   3422   1.96      fvdl 				    devinfo->our_scsiid,
   3423   1.96      fvdl 				    devinfo->target, &tstate);
   3424   1.96      fvdl 	/* Might be necessary */
   3425   1.96      fvdl 	last_msg = ahc_inb(ahc, LAST_MSG);
   3426   1.42      fvdl 
   3427   1.96      fvdl 	if (ahc_sent_msg(ahc, AHCMSG_EXT, MSG_EXT_PPR, /*full*/FALSE)) {
   3428   1.96      fvdl 		/*
   3429   1.96      fvdl 		 * Target does not support the PPR message.
   3430   1.96      fvdl 		 * Attempt to negotiate SPI-2 style.
   3431   1.96      fvdl 		 */
   3432   1.96      fvdl 		if (bootverbose) {
   3433   1.96      fvdl 			printf("(%s:%c:%d:%d): PPR Rejected. "
   3434   1.96      fvdl 			       "Trying WDTR/SDTR\n",
   3435   1.96      fvdl 			       ahc_name(ahc), devinfo->channel,
   3436   1.96      fvdl 			       devinfo->target, devinfo->lun);
   3437   1.96      fvdl 		}
   3438   1.96      fvdl 		tinfo->goal.ppr_options = 0;
   3439   1.96      fvdl 		tinfo->curr.transport_version = 2;
   3440   1.96      fvdl 		tinfo->goal.transport_version = 2;
   3441   1.96      fvdl 		ahc->msgout_index = 0;
   3442   1.96      fvdl 		ahc->msgout_len = 0;
   3443   1.96      fvdl 		ahc_build_transfer_msg(ahc, devinfo);
   3444   1.96      fvdl 		ahc->msgout_index = 0;
   3445   1.96      fvdl 		response = 1;
   3446   1.96      fvdl 	} else if (ahc_sent_msg(ahc, AHCMSG_EXT, MSG_EXT_WDTR, /*full*/FALSE)) {
   3447   1.42      fvdl 
   3448   1.96      fvdl 		/* note 8bit xfers */
   3449   1.96      fvdl 		if (bootverbose)
   3450   1.96      fvdl 			printf("(%s:%c:%d:%d): refuses WIDE negotiation. Using "
   3451   1.96      fvdl 			       "8bit transfers\n", ahc_name(ahc),
   3452   1.96      fvdl 			       devinfo->channel, devinfo->target, devinfo->lun);
   3453   1.96      fvdl 		ahc_set_width(ahc, devinfo, MSG_EXT_WDTR_BUS_8_BIT,
   3454   1.96      fvdl 			      AHC_TRANS_ACTIVE|AHC_TRANS_GOAL,
   3455   1.96      fvdl 			      /*paused*/TRUE);
   3456   1.96      fvdl 		/*
   3457   1.96      fvdl 		 * No need to clear the sync rate.  If the target
   3458   1.96      fvdl 		 * did not accept the command, our syncrate is
   3459   1.96      fvdl 		 * unaffected.  If the target started the negotiation,
   3460   1.96      fvdl 		 * but rejected our response, we already cleared the
   3461   1.96      fvdl 		 * sync rate before sending our WDTR.
   3462   1.96      fvdl 		 */
   3463   1.96      fvdl 		if (tinfo->goal.offset != tinfo->curr.offset) {
   3464   1.42      fvdl 
   3465   1.96      fvdl 			/* Start the sync negotiation */
   3466   1.96      fvdl 			ahc->msgout_index = 0;
   3467   1.96      fvdl 			ahc->msgout_len = 0;
   3468   1.96      fvdl 			ahc_build_transfer_msg(ahc, devinfo);
   3469   1.96      fvdl 			ahc->msgout_index = 0;
   3470   1.96      fvdl 			response = 1;
   3471   1.96      fvdl 		}
   3472   1.96      fvdl 	} else if (ahc_sent_msg(ahc, AHCMSG_EXT, MSG_EXT_SDTR, /*full*/FALSE)) {
   3473   1.96      fvdl 		/* note asynch xfers and clear flag */
   3474   1.96      fvdl 		ahc_set_syncrate(ahc, devinfo, /*syncrate*/NULL, /*period*/0,
   3475   1.96      fvdl 				 /*offset*/0, /*ppr_options*/0,
   3476   1.96      fvdl 				 AHC_TRANS_ACTIVE|AHC_TRANS_GOAL,
   3477   1.96      fvdl 				 /*paused*/TRUE);
   3478   1.96      fvdl 		if (bootverbose)
   3479   1.96      fvdl 			printf("(%s:%c:%d:%d): refuses synchronous negotiation."
   3480   1.96      fvdl 			       " Using asynchronous transfers\n",
   3481   1.96      fvdl 			       ahc_name(ahc), devinfo->channel,
   3482   1.96      fvdl 			       devinfo->target, devinfo->lun);
   3483   1.96      fvdl 	} else if ((scb->hscb->control & MSG_SIMPLE_TASK) != 0) {
   3484   1.96      fvdl 		int tag_type;
   3485   1.96      fvdl 		int mask;
   3486   1.96      fvdl 
   3487   1.96      fvdl 		tag_type = (scb->hscb->control & MSG_SIMPLE_TASK);
   3488   1.96      fvdl 
   3489   1.96      fvdl 		if (tag_type == MSG_SIMPLE_TASK) {
   3490   1.96      fvdl 			if (bootverbose)
   3491   1.96      fvdl 				printf("(%s:%c:%d:%d): refuses tagged commands."
   3492   1.96      fvdl 				       " Performing non-tagged I/O\n",
   3493   1.96      fvdl 					ahc_name(ahc), devinfo->channel,
   3494   1.96      fvdl 					devinfo->target, devinfo->lun);
   3495   1.96      fvdl 			ahc_set_tags(ahc, devinfo, AHC_QUEUE_NONE);
   3496   1.96      fvdl 			mask = ~0x23;
   3497   1.96      fvdl 		} else {
   3498   1.96      fvdl 			if (bootverbose)
   3499   1.96      fvdl 				printf("(%s:%c:%d:%d): refuses %s tagged "
   3500   1.96      fvdl 				       "commands. Performing simple queue "
   3501   1.96      fvdl 				       "tagged I/O only\n",
   3502   1.96      fvdl 				       ahc_name(ahc), devinfo->channel,
   3503   1.96      fvdl 				       devinfo->target, devinfo->lun,
   3504   1.96      fvdl 				       tag_type == MSG_ORDERED_TASK
   3505   1.96      fvdl 				         ? "ordered" : "head of queue");
   3506   1.96      fvdl 			ahc_set_tags(ahc, devinfo, AHC_QUEUE_BASIC);
   3507   1.96      fvdl 			mask = ~0x03;
   3508   1.96      fvdl 		}
   3509   1.42      fvdl 
   3510   1.96      fvdl 		/*
   3511   1.96      fvdl 		 * Resend the identify for this CCB as the target
   3512   1.96      fvdl 		 * may believe that the selection is invalid otherwise.
   3513   1.96      fvdl 		 */
   3514   1.96      fvdl 		ahc_outb(ahc, SCB_CONTROL,
   3515   1.96      fvdl 			 ahc_inb(ahc, SCB_CONTROL) & mask);
   3516   1.96      fvdl 	 	scb->hscb->control &= mask;
   3517   1.96      fvdl 		ahc_set_transaction_tag(scb, /*enabled*/FALSE,
   3518   1.96      fvdl 					/*type*/MSG_SIMPLE_TASK);
   3519   1.96      fvdl 		ahc_outb(ahc, MSG_OUT, MSG_IDENTIFYFLAG);
   3520   1.96      fvdl 		ahc_assert_atn(ahc);
   3521   1.42      fvdl 
   3522   1.96      fvdl 		/*
   3523   1.96      fvdl 		 * This transaction is now at the head of
   3524   1.96      fvdl 		 * the untagged queue for this target.
   3525   1.96      fvdl 		 */
   3526   1.96      fvdl 		if ((ahc->flags & AHC_SCB_BTT) == 0) {
   3527   1.96      fvdl 			struct scb_tailq *untagged_q;
   3528   1.42      fvdl 
   3529   1.96      fvdl 			untagged_q =
   3530   1.96      fvdl 			    &(ahc->untagged_queues[devinfo->target_offset]);
   3531   1.96      fvdl 			TAILQ_INSERT_HEAD(untagged_q, scb, links.tqe);
   3532   1.96      fvdl 			scb->flags |= SCB_UNTAGGEDQ;
   3533   1.42      fvdl 		}
   3534   1.96      fvdl 		ahc_busy_tcl(ahc, BUILD_TCL(scb->hscb->scsiid, devinfo->lun),
   3535   1.96      fvdl 			     scb->hscb->tag);
   3536   1.96      fvdl 
   3537   1.96      fvdl 		/*
   3538   1.96      fvdl 		 * Requeue all tagged commands for this target
   3539   1.96      fvdl 		 * currently in our posession so they can be
   3540   1.96      fvdl 		 * converted to untagged commands.
   3541   1.96      fvdl 		 */
   3542   1.96      fvdl 		ahc_search_qinfifo(ahc, SCB_GET_TARGET(ahc, scb),
   3543   1.96      fvdl 				   SCB_GET_CHANNEL(ahc, scb),
   3544   1.96      fvdl 				   SCB_GET_LUN(scb), /*tag*/SCB_LIST_NULL,
   3545   1.96      fvdl 				   ROLE_INITIATOR, CAM_REQUEUE_REQ,
   3546   1.96      fvdl 				   SEARCH_COMPLETE);
   3547   1.96      fvdl 	} else {
   3548   1.96      fvdl 		/*
   3549   1.96      fvdl 		 * Otherwise, we ignore it.
   3550   1.96      fvdl 		 */
   3551   1.96      fvdl 		if (bootverbose)
   3552   1.96      fvdl 			printf("%s:%c:%d: Message reject for %x -- ignored\n",
   3553   1.96      fvdl 			       ahc_name(ahc), devinfo->channel, devinfo->target,
   3554   1.96      fvdl 			       last_msg);
   3555   1.42      fvdl 	}
   3556   1.96      fvdl 	return (response);
   3557   1.42      fvdl }
   3558   1.42      fvdl 
   3559   1.96      fvdl /*
   3560   1.96      fvdl  * Process an ingnore wide residue message.
   3561   1.96      fvdl  */
   3562   1.42      fvdl static void
   3563   1.96      fvdl ahc_handle_ign_wide_residue(struct ahc_softc *ahc, struct ahc_devinfo *devinfo)
   3564   1.42      fvdl {
   3565   1.96      fvdl 	u_int scb_index;
   3566   1.96      fvdl 	struct scb *scb;
   3567   1.42      fvdl 
   3568   1.96      fvdl 	scb_index = ahc_inb(ahc, SCB_TAG);
   3569   1.96      fvdl 	scb = ahc_lookup_scb(ahc, scb_index);
   3570   1.96      fvdl 	/*
   3571   1.96      fvdl 	 * XXX Actually check data direction in the sequencer?
   3572   1.96      fvdl 	 * Perhaps add datadir to some spare bits in the hscb?
   3573   1.96      fvdl 	 */
   3574   1.96      fvdl 	if ((ahc_inb(ahc, SEQ_FLAGS) & DPHASE) == 0
   3575   1.96      fvdl 	 || ahc_get_transfer_dir(scb) != CAM_DIR_IN) {
   3576   1.96      fvdl 		/*
   3577   1.96      fvdl 		 * Ignore the message if we haven't
   3578   1.96      fvdl 		 * seen an appropriate data phase yet.
   3579   1.96      fvdl 		 */
   3580   1.42      fvdl 	} else {
   3581   1.96      fvdl 		/*
   3582   1.96      fvdl 		 * If the residual occurred on the last
   3583   1.96      fvdl 		 * transfer and the transfer request was
   3584   1.96      fvdl 		 * expected to end on an odd count, do
   3585   1.96      fvdl 		 * nothing.  Otherwise, subtract a byte
   3586   1.96      fvdl 		 * and update the residual count accordingly.
   3587   1.96      fvdl 		 */
   3588   1.96      fvdl 		uint32_t sgptr;
   3589   1.42      fvdl 
   3590   1.96      fvdl 		sgptr = ahc_inb(ahc, SCB_RESIDUAL_SGPTR);
   3591   1.96      fvdl 		if ((sgptr & SG_LIST_NULL) != 0
   3592   1.96      fvdl 		 && ahc_inb(ahc, DATA_COUNT_ODD) == 1) {
   3593   1.96      fvdl 			/*
   3594   1.96      fvdl 			 * If the residual occurred on the last
   3595   1.96      fvdl 			 * transfer and the transfer request was
   3596   1.96      fvdl 			 * expected to end on an odd count, do
   3597   1.96      fvdl 			 * nothing.
   3598   1.96      fvdl 			 */
   3599   1.42      fvdl 		} else {
   3600   1.96      fvdl 			struct ahc_dma_seg *sg;
   3601   1.96      fvdl 			uint32_t data_cnt;
   3602   1.96      fvdl 			uint32_t data_addr;
   3603   1.96      fvdl 			uint32_t sglen;
   3604   1.96      fvdl 
   3605   1.96      fvdl 			/* Pull in the rest of the sgptr */
   3606   1.96      fvdl 			sgptr |= (ahc_inb(ahc, SCB_RESIDUAL_SGPTR + 3) << 24)
   3607   1.96      fvdl 			      | (ahc_inb(ahc, SCB_RESIDUAL_SGPTR + 2) << 16)
   3608   1.96      fvdl 			      | (ahc_inb(ahc, SCB_RESIDUAL_SGPTR + 1) << 8);
   3609   1.96      fvdl 			sgptr &= SG_PTR_MASK;
   3610   1.96      fvdl 			data_cnt = (ahc_inb(ahc, SCB_RESIDUAL_DATACNT+3) << 24)
   3611   1.96      fvdl 				 | (ahc_inb(ahc, SCB_RESIDUAL_DATACNT+2) << 16)
   3612   1.96      fvdl 				 | (ahc_inb(ahc, SCB_RESIDUAL_DATACNT+1) << 8)
   3613   1.96      fvdl 				 | (ahc_inb(ahc, SCB_RESIDUAL_DATACNT));
   3614   1.42      fvdl 
   3615   1.96      fvdl 			data_addr = (ahc_inb(ahc, SHADDR + 3) << 24)
   3616   1.96      fvdl 				  | (ahc_inb(ahc, SHADDR + 2) << 16)
   3617   1.96      fvdl 				  | (ahc_inb(ahc, SHADDR + 1) << 8)
   3618   1.96      fvdl 				  | (ahc_inb(ahc, SHADDR));
   3619   1.42      fvdl 
   3620   1.96      fvdl 			data_cnt += 1;
   3621   1.96      fvdl 			data_addr -= 1;
   3622   1.42      fvdl 
   3623   1.96      fvdl 			sg = ahc_sg_bus_to_virt(scb, sgptr);
   3624   1.42      fvdl 			/*
   3625   1.96      fvdl 			 * The residual sg ptr points to the next S/G
   3626   1.96      fvdl 			 * to load so we must go back one.
   3627   1.42      fvdl 			 */
   3628   1.96      fvdl 			sg--;
   3629   1.96      fvdl 			sglen = ahc_le32toh(sg->len) & AHC_SG_LEN_MASK;
   3630   1.96      fvdl 			if (sg != scb->sg_list
   3631   1.96      fvdl 			 && sglen < (data_cnt & AHC_SG_LEN_MASK)) {
   3632   1.96      fvdl 
   3633   1.96      fvdl 				sg--;
   3634   1.96      fvdl 				sglen = ahc_le32toh(sg->len);
   3635   1.96      fvdl 				/*
   3636   1.96      fvdl 				 * Preserve High Address and SG_LIST bits
   3637   1.96      fvdl 				 * while setting the count to 1.
   3638   1.96      fvdl 				 */
   3639   1.96      fvdl 				data_cnt = 1 | (sglen & (~AHC_SG_LEN_MASK));
   3640   1.96      fvdl 				data_addr = ahc_le32toh(sg->addr)
   3641   1.96      fvdl 					  + (sglen & AHC_SG_LEN_MASK) - 1;
   3642   1.96      fvdl 
   3643   1.96      fvdl 				/*
   3644   1.96      fvdl 				 * Increment sg so it points to the
   3645   1.96      fvdl 				 * "next" sg.
   3646   1.96      fvdl 				 */
   3647   1.96      fvdl 				sg++;
   3648   1.96      fvdl 				sgptr = ahc_sg_virt_to_bus(scb, sg);
   3649   1.96      fvdl 				ahc_outb(ahc, SCB_RESIDUAL_SGPTR + 3,
   3650   1.96      fvdl 					 sgptr >> 24);
   3651   1.96      fvdl 				ahc_outb(ahc, SCB_RESIDUAL_SGPTR + 2,
   3652   1.96      fvdl 					 sgptr >> 16);
   3653   1.96      fvdl 				ahc_outb(ahc, SCB_RESIDUAL_SGPTR + 1,
   3654   1.96      fvdl 					 sgptr >> 8);
   3655   1.96      fvdl 				ahc_outb(ahc, SCB_RESIDUAL_SGPTR, sgptr);
   3656   1.42      fvdl 			}
   3657   1.42      fvdl 
   3658   1.96      fvdl 			ahc_outb(ahc, SCB_RESIDUAL_DATACNT + 3, data_cnt >> 24);
   3659   1.96      fvdl 			ahc_outb(ahc, SCB_RESIDUAL_DATACNT + 2, data_cnt >> 16);
   3660   1.96      fvdl 			ahc_outb(ahc, SCB_RESIDUAL_DATACNT + 1, data_cnt >> 8);
   3661   1.96      fvdl 			ahc_outb(ahc, SCB_RESIDUAL_DATACNT, data_cnt);
   3662   1.42      fvdl 		}
   3663   1.96      fvdl 	}
   3664   1.96      fvdl }
   3665   1.42      fvdl 
   3666   1.42      fvdl 
   3667   1.96      fvdl /*
   3668   1.96      fvdl  * Reinitialize the data pointers for the active transfer
   3669   1.96      fvdl  * based on its current residual.
   3670   1.96      fvdl  */
   3671   1.96      fvdl static void
   3672   1.96      fvdl ahc_reinitialize_dataptrs(struct ahc_softc *ahc)
   3673   1.96      fvdl {
   3674   1.96      fvdl 	struct	 scb *scb;
   3675   1.96      fvdl 	struct	 ahc_dma_seg *sg;
   3676   1.96      fvdl 	u_int	 scb_index;
   3677   1.96      fvdl 	uint32_t sgptr;
   3678   1.96      fvdl 	uint32_t resid;
   3679   1.96      fvdl 	uint32_t dataptr;
   3680   1.42      fvdl 
   3681   1.96      fvdl 	scb_index = ahc_inb(ahc, SCB_TAG);
   3682   1.96      fvdl 	scb = ahc_lookup_scb(ahc, scb_index);
   3683   1.96      fvdl 	sgptr = (ahc_inb(ahc, SCB_RESIDUAL_SGPTR + 3) << 24)
   3684   1.96      fvdl 	      | (ahc_inb(ahc, SCB_RESIDUAL_SGPTR + 2) << 16)
   3685   1.96      fvdl 	      | (ahc_inb(ahc, SCB_RESIDUAL_SGPTR + 1) << 8)
   3686   1.96      fvdl 	      |	ahc_inb(ahc, SCB_RESIDUAL_SGPTR);
   3687   1.96      fvdl 
   3688   1.96      fvdl 	sgptr &= SG_PTR_MASK;
   3689   1.96      fvdl 	sg = ahc_sg_bus_to_virt(scb, sgptr);
   3690   1.96      fvdl 
   3691   1.96      fvdl 	/* The residual sg_ptr always points to the next sg */
   3692   1.96      fvdl 	sg--;
   3693   1.96      fvdl 
   3694   1.96      fvdl 	resid = (ahc_inb(ahc, SCB_RESIDUAL_DATACNT + 2) << 16)
   3695   1.96      fvdl 	      | (ahc_inb(ahc, SCB_RESIDUAL_DATACNT + 1) << 8)
   3696   1.96      fvdl 	      | ahc_inb(ahc, SCB_RESIDUAL_DATACNT);
   3697   1.96      fvdl 
   3698   1.96      fvdl 	dataptr = ahc_le32toh(sg->addr)
   3699   1.96      fvdl 		+ (ahc_le32toh(sg->len) & AHC_SG_LEN_MASK)
   3700   1.96      fvdl 		- resid;
   3701   1.96      fvdl 	if ((ahc->flags & AHC_39BIT_ADDRESSING) != 0) {
   3702   1.96      fvdl 		u_int dscommand1;
   3703   1.96      fvdl 
   3704   1.96      fvdl 		dscommand1 = ahc_inb(ahc, DSCOMMAND1);
   3705   1.96      fvdl 		ahc_outb(ahc, DSCOMMAND1, dscommand1 | HADDLDSEL0);
   3706   1.96      fvdl 		ahc_outb(ahc, HADDR,
   3707   1.96      fvdl 			 (ahc_le32toh(sg->len) >> 24) & SG_HIGH_ADDR_BITS);
   3708   1.96      fvdl 		ahc_outb(ahc, DSCOMMAND1, dscommand1);
   3709   1.96      fvdl 	}
   3710   1.96      fvdl 	ahc_outb(ahc, HADDR + 3, dataptr >> 24);
   3711   1.96      fvdl 	ahc_outb(ahc, HADDR + 2, dataptr >> 16);
   3712   1.96      fvdl 	ahc_outb(ahc, HADDR + 1, dataptr >> 8);
   3713   1.96      fvdl 	ahc_outb(ahc, HADDR, dataptr);
   3714   1.96      fvdl 	ahc_outb(ahc, HCNT + 2, resid >> 16);
   3715   1.96      fvdl 	ahc_outb(ahc, HCNT + 1, resid >> 8);
   3716   1.96      fvdl 	ahc_outb(ahc, HCNT, resid);
   3717   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) == 0) {
   3718   1.96      fvdl 		ahc_outb(ahc, STCNT + 2, resid >> 16);
   3719   1.96      fvdl 		ahc_outb(ahc, STCNT + 1, resid >> 8);
   3720   1.96      fvdl 		ahc_outb(ahc, STCNT, resid);
   3721   1.42      fvdl 	}
   3722   1.42      fvdl }
   3723   1.42      fvdl 
   3724   1.96      fvdl /*
   3725   1.96      fvdl  * Handle the effects of issuing a bus device reset message.
   3726   1.96      fvdl  */
   3727   1.42      fvdl static void
   3728   1.96      fvdl ahc_handle_devreset(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   3729   1.96      fvdl 		    cam_status status, char *message, int verbose_level)
   3730   1.42      fvdl {
   3731   1.96      fvdl #ifdef AHC_TARGET_MODE
   3732   1.96      fvdl 	struct ahc_tmode_tstate* tstate;
   3733   1.96      fvdl 	u_int lun;
   3734   1.96      fvdl #endif
   3735   1.96      fvdl 	int found;
   3736   1.42      fvdl 
   3737   1.96      fvdl 	found = ahc_abort_scbs(ahc, devinfo->target, devinfo->channel,
   3738   1.96      fvdl 			       CAM_LUN_WILDCARD, SCB_LIST_NULL, devinfo->role,
   3739   1.96      fvdl 			       status);
   3740   1.42      fvdl 
   3741   1.96      fvdl #ifdef AHC_TARGET_MODE
   3742   1.96      fvdl 	/*
   3743   1.96      fvdl 	 * Send an immediate notify ccb to all target mord peripheral
   3744   1.96      fvdl 	 * drivers affected by this action.
   3745   1.96      fvdl 	 */
   3746   1.96      fvdl 	tstate = ahc->enabled_targets[devinfo->our_scsiid];
   3747   1.96      fvdl 	if (tstate != NULL) {
   3748   1.96      fvdl 		for (lun = 0; lun < AHC_NUM_LUNS; lun++) {
   3749   1.96      fvdl 			struct ahc_tmode_lstate* lstate;
   3750   1.42      fvdl 
   3751   1.96      fvdl 			lstate = tstate->enabled_luns[lun];
   3752   1.96      fvdl 			if (lstate == NULL)
   3753   1.96      fvdl 				continue;
   3754   1.42      fvdl 
   3755   1.96      fvdl 			ahc_queue_lstate_event(ahc, lstate, devinfo->our_scsiid,
   3756   1.96      fvdl 					       MSG_BUS_DEV_RESET, /*arg*/0);
   3757   1.96      fvdl 			ahc_send_lstate_events(ahc, lstate);
   3758   1.96      fvdl 		}
   3759   1.42      fvdl 	}
   3760   1.96      fvdl #endif
   3761   1.42      fvdl 
   3762   1.96      fvdl 	/*
   3763   1.96      fvdl 	 * Go back to async/narrow transfers and renegotiate.
   3764   1.96      fvdl 	 */
   3765   1.96      fvdl 	ahc_set_width(ahc, devinfo, MSG_EXT_WDTR_BUS_8_BIT,
   3766   1.96      fvdl 		      AHC_TRANS_CUR, /*paused*/TRUE);
   3767   1.96      fvdl 	ahc_set_syncrate(ahc, devinfo, /*syncrate*/NULL,
   3768   1.96      fvdl 			 /*period*/0, /*offset*/0, /*ppr_options*/0,
   3769   1.96      fvdl 			 AHC_TRANS_CUR, /*paused*/TRUE);
   3770   1.96      fvdl 
   3771   1.96      fvdl 	ahc_send_async(ahc, devinfo->channel, devinfo->target,
   3772   1.96      fvdl 	  CAM_LUN_WILDCARD, AC_SENT_BDR, NULL);
   3773   1.42      fvdl 
   3774   1.96      fvdl 	if (message != NULL
   3775   1.96      fvdl 	 && (verbose_level <= bootverbose))
   3776   1.96      fvdl 		printf("%s: %s on %c:%d. %d SCBs aborted\n", ahc_name(ahc),
   3777   1.96      fvdl 		       message, devinfo->channel, devinfo->target, found);
   3778   1.42      fvdl }
   3779   1.42      fvdl 
   3780   1.96      fvdl #ifdef AHC_TARGET_MODE
   3781   1.42      fvdl static void
   3782   1.96      fvdl ahc_setup_target_msgin(struct ahc_softc *ahc, struct ahc_devinfo *devinfo,
   3783   1.96      fvdl 		       struct scb *scb)
   3784   1.42      fvdl {
   3785   1.42      fvdl 
   3786   1.96      fvdl 	/*
   3787   1.96      fvdl 	 * To facilitate adding multiple messages together,
   3788   1.96      fvdl 	 * each routine should increment the index and len
   3789   1.96      fvdl 	 * variables instead of setting them explicitly.
   3790   1.96      fvdl 	 */
   3791   1.96      fvdl 	ahc->msgout_index = 0;
   3792   1.96      fvdl 	ahc->msgout_len = 0;
   3793   1.96      fvdl 
   3794   1.96      fvdl 	if (scb != NULL && (scb->flags & SCB_AUTO_NEGOTIATE) != 0)
   3795   1.96      fvdl 		ahc_build_transfer_msg(ahc, devinfo);
   3796   1.96      fvdl 	else
   3797   1.96      fvdl 		panic("ahc_intr: AWAITING target message with no message");
   3798   1.96      fvdl 
   3799   1.96      fvdl 	ahc->msgout_index = 0;
   3800   1.96      fvdl 	ahc->msg_type = MSG_TYPE_TARGET_MSGIN;
   3801   1.96      fvdl }
   3802   1.96      fvdl #endif
   3803   1.96      fvdl 
   3804   1.96      fvdl int
   3805   1.96      fvdl ahc_softc_init(struct ahc_softc *ahc)
   3806   1.96      fvdl {
   3807   1.42      fvdl 
   3808   1.96      fvdl 	/* The IRQMS bit is only valid on VL and EISA chips */
   3809   1.96      fvdl 	if ((ahc->chip & AHC_PCI) == 0)
   3810   1.96      fvdl 		ahc->unpause = ahc_inb(ahc, HCNTRL) & IRQMS;
   3811   1.96      fvdl 	else
   3812   1.96      fvdl 		ahc->unpause = 0;
   3813   1.96      fvdl 	ahc->pause = ahc->unpause | PAUSE;
   3814   1.96      fvdl 	/* XXX The shared scb data stuff should be deprecated */
   3815   1.96      fvdl 	if (ahc->scb_data == NULL) {
   3816   1.96      fvdl 		ahc->scb_data = malloc(sizeof(*ahc->scb_data),
   3817   1.96      fvdl 				       M_DEVBUF, M_NOWAIT);
   3818   1.96      fvdl 		if (ahc->scb_data == NULL)
   3819   1.96      fvdl 			return (ENOMEM);
   3820   1.96      fvdl 		memset(ahc->scb_data, 0, sizeof(*ahc->scb_data));
   3821   1.49      fvdl 	}
   3822   1.96      fvdl 
   3823   1.96      fvdl 	return (0);
   3824   1.42      fvdl }
   3825   1.42      fvdl 
   3826   1.96      fvdl void
   3827   1.96      fvdl ahc_softc_insert(struct ahc_softc *ahc)
   3828   1.71    bouyer {
   3829   1.96      fvdl 	struct ahc_softc *list_ahc;
   3830   1.71    bouyer 
   3831   1.96      fvdl #if AHC_PCI_CONFIG > 0
   3832   1.96      fvdl 	/*
   3833   1.96      fvdl 	 * Second Function PCI devices need to inherit some
   3834   1.96      fvdl 	 * settings from function 0.
   3835   1.96      fvdl 	 */
   3836   1.96      fvdl 	if ((ahc->chip & AHC_BUS_MASK) == AHC_PCI
   3837   1.96      fvdl 	 && (ahc->features & AHC_MULTI_FUNC) != 0) {
   3838   1.96      fvdl 		TAILQ_FOREACH(list_ahc, &ahc_tailq, links) {
   3839   1.96      fvdl 			ahc_dev_softc_t list_pci;
   3840   1.96      fvdl 			ahc_dev_softc_t pci;
   3841   1.96      fvdl 
   3842   1.96      fvdl 			list_pci = list_ahc->dev_softc;
   3843   1.96      fvdl 			pci = ahc->dev_softc;
   3844   1.96      fvdl 			if (ahc_get_pci_slot(list_pci) == ahc_get_pci_slot(pci)
   3845   1.96      fvdl 			 && ahc_get_pci_bus(list_pci) == ahc_get_pci_bus(pci)) {
   3846   1.96      fvdl 				struct ahc_softc *master;
   3847   1.96      fvdl 				struct ahc_softc *slave;
   3848   1.96      fvdl 
   3849   1.96      fvdl 				if (ahc_get_pci_function(list_pci) == 0) {
   3850   1.96      fvdl 					master = list_ahc;
   3851   1.96      fvdl 					slave = ahc;
   3852   1.96      fvdl 				} else {
   3853   1.96      fvdl 					master = ahc;
   3854   1.96      fvdl 					slave = list_ahc;
   3855   1.96      fvdl 				}
   3856   1.96      fvdl 				slave->flags &= ~AHC_BIOS_ENABLED;
   3857   1.96      fvdl 				slave->flags |=
   3858   1.96      fvdl 				    master->flags & AHC_BIOS_ENABLED;
   3859   1.96      fvdl 				slave->flags &= ~AHC_PRIMARY_CHANNEL;
   3860   1.96      fvdl 				slave->flags |=
   3861   1.96      fvdl 				    master->flags & AHC_PRIMARY_CHANNEL;
   3862   1.96      fvdl 				break;
   3863   1.96      fvdl 			}
   3864   1.96      fvdl 		}
   3865   1.96      fvdl 	}
   3866   1.96      fvdl #endif
   3867   1.71    bouyer 
   3868   1.96      fvdl 	/*
   3869   1.96      fvdl 	 * Insertion sort into our list of softcs.
   3870   1.96      fvdl 	 */
   3871   1.96      fvdl 	list_ahc = TAILQ_FIRST(&ahc_tailq);
   3872   1.96      fvdl 	while (list_ahc != NULL
   3873   1.96      fvdl 	    && ahc_softc_comp(list_ahc, ahc) <= 0)
   3874   1.96      fvdl 		list_ahc = TAILQ_NEXT(list_ahc, links);
   3875   1.96      fvdl 	if (list_ahc != NULL)
   3876   1.96      fvdl 		TAILQ_INSERT_BEFORE(list_ahc, ahc, links);
   3877   1.96      fvdl 	else
   3878   1.96      fvdl 		TAILQ_INSERT_TAIL(&ahc_tailq, ahc, links);
   3879   1.96      fvdl 	ahc->init_level++;
   3880   1.71    bouyer }
   3881   1.71    bouyer 
   3882   1.42      fvdl /*
   3883   1.96      fvdl  * Verify that the passed in softc pointer is for a
   3884   1.96      fvdl  * controller that is still configured.
   3885   1.42      fvdl  */
   3886   1.96      fvdl struct ahc_softc *
   3887   1.96      fvdl ahc_find_softc(struct ahc_softc *ahc)
   3888   1.42      fvdl {
   3889   1.96      fvdl 	struct ahc_softc *list_ahc;
   3890   1.42      fvdl 
   3891   1.96      fvdl 	TAILQ_FOREACH(list_ahc, &ahc_tailq, links) {
   3892   1.96      fvdl 		if (list_ahc == ahc)
   3893   1.96      fvdl 			return (ahc);
   3894   1.42      fvdl 	}
   3895   1.96      fvdl 	return (NULL);
   3896   1.86    ichiro }
   3897   1.86    ichiro 
   3898   1.96      fvdl void
   3899   1.96      fvdl ahc_set_unit(struct ahc_softc *ahc, int unit)
   3900   1.86    ichiro {
   3901   1.96      fvdl 	ahc->unit = unit;
   3902   1.96      fvdl }
   3903   1.86    ichiro 
   3904   1.96      fvdl void
   3905   1.96      fvdl ahc_set_name(struct ahc_softc *ahc, char *name)
   3906   1.96      fvdl {
   3907   1.96      fvdl 	if (ahc->name != NULL)
   3908   1.96      fvdl 		free(ahc->name, M_DEVBUF);
   3909   1.96      fvdl 	ahc->name = name;
   3910   1.86    ichiro }
   3911   1.86    ichiro 
   3912   1.96      fvdl void
   3913   1.96      fvdl ahc_free(struct ahc_softc *ahc)
   3914   1.86    ichiro {
   3915   1.96      fvdl 	int i;
   3916   1.86    ichiro 
   3917   1.96      fvdl 	ahc_fini_scbdata(ahc);
   3918   1.96      fvdl 	switch (ahc->init_level) {
   3919   1.96      fvdl 	default:
   3920   1.96      fvdl 	case 2:
   3921   1.96      fvdl 		ahc_shutdown(ahc);
   3922   1.96      fvdl 		TAILQ_REMOVE(&ahc_tailq, ahc, links);
   3923   1.96      fvdl 		/* FALLTHROUGH */
   3924   1.96      fvdl 	case 1:
   3925   1.96      fvdl 		bus_dmamap_unload(ahc->parent_dmat, ahc->shared_data_dmamap);
   3926   1.96      fvdl 		bus_dmamap_destroy(ahc->parent_dmat, ahc->shared_data_dmamap);
   3927   1.96      fvdl 		bus_dmamem_unmap(ahc->parent_dmat, (caddr_t)ahc->qoutfifo, ahc->shared_data_size);
   3928   1.96      fvdl 		bus_dmamem_free(ahc->parent_dmat, &ahc->shared_data_seg, ahc->shared_data_nseg);
   3929   1.86    ichiro 		break;
   3930   1.96      fvdl 	case 0:
   3931   1.86    ichiro 		break;
   3932   1.86    ichiro 	}
   3933   1.86    ichiro 
   3934   1.96      fvdl 	ahc_platform_free(ahc);
   3935   1.96      fvdl 	for (i = 0; i < AHC_NUM_TARGETS; i++) {
   3936   1.96      fvdl 		struct ahc_tmode_tstate *tstate;
   3937   1.96      fvdl 
   3938   1.96      fvdl 		tstate = ahc->enabled_targets[i];
   3939   1.96      fvdl 		if (tstate != NULL) {
   3940   1.96      fvdl #if AHC_TARGET_MODE
   3941   1.96      fvdl 			int j;
   3942   1.96      fvdl 
   3943   1.96      fvdl 			for (j = 0; j < AHC_NUM_LUNS; j++) {
   3944   1.96      fvdl 				struct ahc_tmode_lstate *lstate;
   3945   1.96      fvdl 
   3946   1.96      fvdl 				lstate = tstate->enabled_luns[j];
   3947   1.96      fvdl 				if (lstate != NULL) {
   3948   1.96      fvdl 					  /*xpt_free_path(lstate->path);*/
   3949   1.96      fvdl 					free(lstate, M_DEVBUF);
   3950   1.96      fvdl 				}
   3951   1.96      fvdl 			}
   3952   1.96      fvdl #endif
   3953   1.96      fvdl 			free(tstate, M_DEVBUF);
   3954   1.96      fvdl 		}
   3955   1.96      fvdl 	}
   3956   1.96      fvdl #if AHC_TARGET_MODE
   3957   1.96      fvdl 	if (ahc->black_hole != NULL) {
   3958   1.96      fvdl 	  /*xpt_free_path(ahc->black_hole->path);*/
   3959   1.96      fvdl 		free(ahc->black_hole, M_DEVBUF);
   3960   1.96      fvdl 	}
   3961   1.96      fvdl #endif
   3962   1.96      fvdl 	if (ahc->name != NULL)
   3963   1.96      fvdl 		free(ahc->name, M_DEVBUF);
   3964   1.96      fvdl 	if (ahc->seep_config != NULL)
   3965   1.96      fvdl 		free(ahc->seep_config, M_DEVBUF);
   3966   1.96      fvdl #ifndef __FreeBSD__
   3967   1.96      fvdl 	free(ahc, M_DEVBUF);
   3968   1.96      fvdl #endif
   3969   1.96      fvdl 	return;
   3970   1.42      fvdl }
   3971   1.42      fvdl 
   3972   1.96      fvdl void
   3973   1.96      fvdl ahc_shutdown(void *arg)
   3974   1.42      fvdl {
   3975   1.96      fvdl 	struct	ahc_softc *ahc;
   3976   1.96      fvdl 	int	i;
   3977   1.42      fvdl 
   3978   1.96      fvdl 	ahc = (struct ahc_softc *)arg;
   3979   1.42      fvdl 
   3980   1.96      fvdl 	/* This will reset most registers to 0, but not all */
   3981   1.96      fvdl 	ahc_reset(ahc);
   3982   1.96      fvdl 	ahc_outb(ahc, SCSISEQ, 0);
   3983   1.96      fvdl 	ahc_outb(ahc, SXFRCTL0, 0);
   3984   1.96      fvdl 	ahc_outb(ahc, DSPCISTATUS, 0);
   3985   1.42      fvdl 
   3986   1.96      fvdl 	for (i = TARG_SCSIRATE; i < SCSICONF; i++)
   3987   1.96      fvdl 		ahc_outb(ahc, i, 0);
   3988   1.42      fvdl }
   3989   1.42      fvdl 
   3990   1.42      fvdl /*
   3991   1.96      fvdl  * Reset the controller and record some information about it
   3992   1.96      fvdl  * that is only available just after a reset.
   3993   1.42      fvdl  */
   3994   1.42      fvdl int
   3995   1.96      fvdl ahc_reset(struct ahc_softc *ahc)
   3996   1.42      fvdl {
   3997   1.96      fvdl 	u_int	sblkctl;
   3998   1.96      fvdl 	u_int	sxfrctl1_a, sxfrctl1_b;
   3999   1.96      fvdl 	int	wait;
   4000   1.96      fvdl 
   4001   1.96      fvdl 	/*
   4002   1.96      fvdl 	 * Preserve the value of the SXFRCTL1 register for all channels.
   4003   1.96      fvdl 	 * It contains settings that affect termination and we don't want
   4004   1.96      fvdl 	 * to disturb the integrity of the bus.
   4005   1.96      fvdl 	 */
   4006   1.96      fvdl 	ahc_pause(ahc);
   4007   1.96      fvdl 	if ((ahc_inb(ahc, HCNTRL) & CHIPRST) != 0) {
   4008   1.96      fvdl 		/*
   4009   1.96      fvdl 		 * The chip has not been initialized since
   4010   1.96      fvdl 		 * PCI/EISA/VLB bus reset.  Don't trust
   4011   1.96      fvdl 		 * "left over BIOS data".
   4012   1.96      fvdl 		 */
   4013   1.96      fvdl 		ahc->flags |= AHC_NO_BIOS_INIT;
   4014   1.96      fvdl 	}
   4015   1.96      fvdl 	sxfrctl1_b = 0;
   4016   1.96      fvdl 	if ((ahc->chip & AHC_CHIPID_MASK) == AHC_AIC7770) {
   4017   1.96      fvdl 		u_int sblkctl;
   4018   1.42      fvdl 
   4019   1.96      fvdl 		/*
   4020   1.96      fvdl 		 * Save channel B's settings in case this chip
   4021   1.96      fvdl 		 * is setup for TWIN channel operation.
   4022   1.96      fvdl 		 */
   4023   1.96      fvdl 		sblkctl = ahc_inb(ahc, SBLKCTL);
   4024   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, sblkctl | SELBUSB);
   4025   1.96      fvdl 		sxfrctl1_b = ahc_inb(ahc, SXFRCTL1);
   4026   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, sblkctl & ~SELBUSB);
   4027   1.96      fvdl 	}
   4028   1.96      fvdl 	sxfrctl1_a = ahc_inb(ahc, SXFRCTL1);
   4029   1.42      fvdl 
   4030   1.96      fvdl 	ahc_outb(ahc, HCNTRL, CHIPRST | ahc->pause);
   4031   1.42      fvdl 
   4032   1.42      fvdl 	/*
   4033   1.96      fvdl 	 * Ensure that the reset has finished.  We delay 1000us
   4034   1.96      fvdl 	 * prior to reading the register to make sure the chip
   4035   1.96      fvdl 	 * has sufficiently completed its reset to handle register
   4036   1.96      fvdl 	 * accesses.
   4037   1.42      fvdl 	 */
   4038   1.96      fvdl 	wait = 1000;
   4039   1.96      fvdl 	do {
   4040   1.96      fvdl 		ahc_delay(1000);
   4041   1.96      fvdl 	} while (--wait && !(ahc_inb(ahc, HCNTRL) & CHIPRSTACK));
   4042   1.42      fvdl 
   4043   1.96      fvdl 	if (wait == 0) {
   4044   1.96      fvdl 		printf("%s: WARNING - Failed chip reset!  "
   4045   1.96      fvdl 		       "Trying to initialize anyway.\n", ahc_name(ahc));
   4046   1.42      fvdl 	}
   4047   1.96      fvdl 	ahc_outb(ahc, HCNTRL, ahc->pause);
   4048   1.42      fvdl 
   4049   1.96      fvdl 	/* Determine channel configuration */
   4050   1.96      fvdl 	sblkctl = ahc_inb(ahc, SBLKCTL) & (SELBUSB|SELWIDE);
   4051   1.96      fvdl 	/* No Twin Channel PCI cards */
   4052   1.96      fvdl 	if ((ahc->chip & AHC_PCI) != 0)
   4053   1.96      fvdl 		sblkctl &= ~SELBUSB;
   4054   1.96      fvdl 	switch (sblkctl) {
   4055   1.96      fvdl 	case 0:
   4056   1.96      fvdl 		/* Single Narrow Channel */
   4057   1.96      fvdl 		break;
   4058   1.96      fvdl 	case 2:
   4059   1.96      fvdl 		/* Wide Channel */
   4060   1.96      fvdl 		ahc->features |= AHC_WIDE;
   4061   1.96      fvdl 		break;
   4062   1.96      fvdl 	case 8:
   4063   1.96      fvdl 		/* Twin Channel */
   4064   1.96      fvdl 		ahc->features |= AHC_TWIN;
   4065   1.96      fvdl 		break;
   4066   1.96      fvdl 	default:
   4067   1.96      fvdl 		printf(" Unsupported adapter type (0x%x).  Ignoring\n", sblkctl);
   4068   1.96      fvdl 		return(-1);
   4069   1.42      fvdl 	}
   4070   1.42      fvdl 
   4071   1.96      fvdl 	/*
   4072   1.96      fvdl 	 * Reload sxfrctl1.
   4073   1.96      fvdl 	 *
   4074   1.96      fvdl 	 * We must always initialize STPWEN to 1 before we
   4075   1.96      fvdl 	 * restore the saved values.  STPWEN is initialized
   4076   1.96      fvdl 	 * to a tri-state condition which can only be cleared
   4077   1.96      fvdl 	 * by turning it on.
   4078   1.96      fvdl 	 */
   4079   1.96      fvdl 	if ((ahc->features & AHC_TWIN) != 0) {
   4080   1.96      fvdl 		u_int sblkctl;
   4081   1.42      fvdl 
   4082   1.96      fvdl 		sblkctl = ahc_inb(ahc, SBLKCTL);
   4083   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, sblkctl | SELBUSB);
   4084   1.96      fvdl 		ahc_outb(ahc, SXFRCTL1, sxfrctl1_b);
   4085   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, sblkctl & ~SELBUSB);
   4086   1.42      fvdl 	}
   4087   1.96      fvdl 	ahc_outb(ahc, SXFRCTL1, sxfrctl1_a);
   4088   1.42      fvdl 
   4089   1.96      fvdl #ifdef AHC_DUMP_SEQ
   4090   1.96      fvdl 	if (ahc->init_level == 0)
   4091   1.96      fvdl 		ahc_dumpseq(ahc);
   4092   1.96      fvdl #endif
   4093   1.42      fvdl 
   4094   1.96      fvdl 	return (0);
   4095   1.42      fvdl }
   4096   1.42      fvdl 
   4097   1.96      fvdl /*
   4098   1.96      fvdl  * Determine the number of SCBs available on the controller
   4099   1.96      fvdl  */
   4100   1.96      fvdl int
   4101   1.96      fvdl ahc_probe_scbs(struct ahc_softc *ahc) {
   4102   1.96      fvdl 	int i;
   4103   1.96      fvdl 
   4104   1.96      fvdl 	for (i = 0; i < AHC_SCB_MAX; i++) {
   4105   1.42      fvdl 
   4106   1.96      fvdl 		ahc_outb(ahc, SCBPTR, i);
   4107   1.96      fvdl 		ahc_outb(ahc, SCB_BASE, i);
   4108   1.96      fvdl 		if (ahc_inb(ahc, SCB_BASE) != i)
   4109   1.96      fvdl 			break;
   4110   1.96      fvdl 		ahc_outb(ahc, SCBPTR, 0);
   4111   1.96      fvdl 		if (ahc_inb(ahc, SCB_BASE) != 0)
   4112   1.96      fvdl 			break;
   4113   1.42      fvdl 	}
   4114   1.96      fvdl 	return (i);
   4115   1.42      fvdl }
   4116   1.42      fvdl 
   4117   1.96      fvdl #if 0
   4118   1.42      fvdl static void
   4119   1.96      fvdl ahc_dmamap_cb(void *arg, bus_dma_segment_t *segs, int nseg, int error)
   4120   1.42      fvdl {
   4121   1.96      fvdl 	bus_addr_t *baddr;
   4122   1.42      fvdl 
   4123   1.96      fvdl 	baddr = (bus_addr_t *)arg;
   4124   1.96      fvdl 	*baddr = segs->ds_addr;
   4125   1.42      fvdl }
   4126   1.42      fvdl #endif
   4127   1.42      fvdl 
   4128   1.42      fvdl static void
   4129   1.96      fvdl ahc_build_free_scb_list(struct ahc_softc *ahc)
   4130   1.42      fvdl {
   4131   1.96      fvdl 	int scbsize;
   4132   1.96      fvdl 	int i;
   4133   1.59        pk 
   4134   1.96      fvdl 	scbsize = 32;
   4135   1.96      fvdl 	if ((ahc->flags & AHC_LSCBS_ENABLED) != 0)
   4136   1.96      fvdl 		scbsize = 64;
   4137   1.42      fvdl 
   4138   1.96      fvdl 	for (i = 0; i < ahc->scb_data->maxhscbs; i++) {
   4139   1.96      fvdl 		int j;
   4140   1.42      fvdl 
   4141   1.96      fvdl 		ahc_outb(ahc, SCBPTR, i);
   4142   1.42      fvdl 
   4143   1.42      fvdl 		/*
   4144   1.96      fvdl 		 * Touch all SCB bytes to avoid parity errors
   4145   1.96      fvdl 		 * should one of our debugging routines read
   4146   1.96      fvdl 		 * an otherwise uninitiatlized byte.
   4147   1.42      fvdl 		 */
   4148   1.96      fvdl 		for (j = 0; j < scbsize; j++)
   4149   1.96      fvdl 			ahc_outb(ahc, SCB_BASE+j, 0xFF);
   4150   1.42      fvdl 
   4151   1.96      fvdl 		/* Clear the control byte. */
   4152   1.96      fvdl 		ahc_outb(ahc, SCB_CONTROL, 0);
   4153   1.42      fvdl 
   4154   1.96      fvdl 		/* Set the next pointer */
   4155   1.96      fvdl 		if ((ahc->flags & AHC_PAGESCBS) != 0)
   4156   1.96      fvdl 			ahc_outb(ahc, SCB_NEXT, i+1);
   4157   1.96      fvdl 		else
   4158   1.96      fvdl 			ahc_outb(ahc, SCB_NEXT, SCB_LIST_NULL);
   4159   1.42      fvdl 
   4160   1.96      fvdl 		/* Make the tag number, SCSIID, and lun invalid */
   4161   1.96      fvdl 		ahc_outb(ahc, SCB_TAG, SCB_LIST_NULL);
   4162   1.96      fvdl 		ahc_outb(ahc, SCB_SCSIID, 0xFF);
   4163   1.96      fvdl 		ahc_outb(ahc, SCB_LUN, 0xFF);
   4164   1.96      fvdl 	}
   4165   1.42      fvdl 
   4166   1.96      fvdl 	/* Make sure that the last SCB terminates the free list */
   4167   1.96      fvdl 	ahc_outb(ahc, SCBPTR, i-1);
   4168   1.96      fvdl 	ahc_outb(ahc, SCB_NEXT, SCB_LIST_NULL);
   4169   1.96      fvdl }
   4170   1.42      fvdl 
   4171   1.96      fvdl static int
   4172   1.96      fvdl ahc_init_scbdata(struct ahc_softc *ahc)
   4173   1.96      fvdl {
   4174   1.96      fvdl 	struct scb_data *scb_data;
   4175   1.42      fvdl 
   4176   1.96      fvdl 	scb_data = ahc->scb_data;
   4177   1.96      fvdl 	SLIST_INIT(&scb_data->free_scbs);
   4178   1.96      fvdl 	SLIST_INIT(&scb_data->sg_maps);
   4179   1.42      fvdl 
   4180   1.96      fvdl 	/* Allocate SCB resources */
   4181   1.96      fvdl 	scb_data->scbarray =
   4182   1.96      fvdl 	    (struct scb *)malloc(sizeof(struct scb) * AHC_SCB_MAX_ALLOC,
   4183   1.96      fvdl 				 M_DEVBUF, M_NOWAIT);
   4184   1.96      fvdl 	if (scb_data->scbarray == NULL)
   4185   1.96      fvdl 		return (ENOMEM);
   4186   1.96      fvdl 	memset(scb_data->scbarray, 0, sizeof(struct scb) * AHC_SCB_MAX_ALLOC);
   4187   1.42      fvdl 
   4188   1.96      fvdl 	/* Determine the number of hardware SCBs and initialize them */
   4189   1.42      fvdl 
   4190   1.96      fvdl 	scb_data->maxhscbs = ahc_probe_scbs(ahc);
   4191   1.96      fvdl 	if ((ahc->flags & AHC_PAGESCBS) != 0) {
   4192   1.96      fvdl 		/* SCB 0 heads the free list */
   4193   1.96      fvdl 		ahc_outb(ahc, FREE_SCBH, 0);
   4194   1.96      fvdl 	} else {
   4195   1.96      fvdl 		ahc_outb(ahc, FREE_SCBH, SCB_LIST_NULL);
   4196   1.42      fvdl 	}
   4197   1.42      fvdl 
   4198   1.96      fvdl 	if (ahc->scb_data->maxhscbs == 0) {
   4199   1.96      fvdl 		printf("%s: No SCB space found\n", ahc_name(ahc));
   4200   1.96      fvdl 		return (ENXIO);
   4201   1.42      fvdl 	}
   4202   1.42      fvdl 
   4203   1.96      fvdl 	ahc_build_free_scb_list(ahc);
   4204   1.59        pk 
   4205   1.42      fvdl 	/*
   4206   1.96      fvdl 	 * Create our DMA tags.  These tags define the kinds of device
   4207   1.96      fvdl 	 * accessible memory allocations and memory mappings we will
   4208   1.96      fvdl 	 * need to perform during normal operation.
   4209   1.96      fvdl 	 *
   4210   1.96      fvdl 	 * Unless we need to further restrict the allocation, we rely
   4211   1.96      fvdl 	 * on the restrictions of the parent dmat, hence the common
   4212   1.96      fvdl 	 * use of MAXADDR and MAXSIZE.
   4213   1.42      fvdl 	 */
   4214    1.6   mycroft 
   4215   1.96      fvdl 	if (ahc_createdmamem(ahc->parent_dmat,
   4216   1.96      fvdl 			     AHC_SCB_MAX * sizeof(struct hardware_scb), ahc->sc_dmaflags,
   4217   1.96      fvdl 			     &scb_data->hscb_dmamap,
   4218   1.96      fvdl 			     (caddr_t *)&scb_data->hscbs, &scb_data->hscb_busaddr,
   4219   1.96      fvdl 			     &scb_data->hscb_seg, &scb_data->hscb_nseg, ahc_name(ahc),
   4220   1.96      fvdl 			     "hardware SCB structures") < 0)
   4221   1.96      fvdl 		goto error_exit;
   4222   1.96      fvdl 
   4223   1.96      fvdl 	scb_data->init_level++;
   4224   1.96      fvdl 
   4225   1.96      fvdl 	if (ahc_createdmamem(ahc->parent_dmat,
   4226   1.96      fvdl 			     AHC_SCB_MAX * sizeof(struct scsipi_sense_data), ahc->sc_dmaflags,
   4227   1.96      fvdl 			     &scb_data->sense_dmamap, (caddr_t *)&scb_data->sense,
   4228   1.96      fvdl 			     &scb_data->sense_busaddr, &scb_data->sense_seg,
   4229   1.96      fvdl 			     &scb_data->sense_nseg, ahc_name(ahc), "sense buffers") < 0)
   4230   1.96      fvdl 		goto error_exit;
   4231   1.96      fvdl 
   4232   1.96      fvdl 	scb_data->init_level++;
   4233    1.6   mycroft 
   4234   1.96      fvdl 	/* Perform initial CCB allocation */
   4235   1.96      fvdl 	memset(scb_data->hscbs, 0,
   4236   1.96      fvdl 	       AHC_SCB_MAX_ALLOC * sizeof(struct hardware_scb));
   4237   1.96      fvdl 	ahc_alloc_scbs(ahc);
   4238    1.1   mycroft 
   4239   1.96      fvdl 	if (scb_data->numscbs == 0) {
   4240   1.96      fvdl 		printf("%s: ahc_init_scbdata - "
   4241   1.96      fvdl 		       "Unable to allocate initial scbs\n",
   4242   1.96      fvdl 		       ahc_name(ahc));
   4243   1.96      fvdl 		goto error_exit;
   4244   1.42      fvdl 	}
   4245    1.6   mycroft 
   4246   1.96      fvdl 	/*
   4247   1.96      fvdl 	 * Tell the sequencer which SCB will be the next one it receives.
   4248   1.96      fvdl 	 */
   4249   1.96      fvdl 	ahc->next_queued_scb = ahc_get_scb(ahc);
   4250   1.96      fvdl 	ahc_outb(ahc, NEXT_QUEUED_SCB, ahc->next_queued_scb->hscb->tag);
   4251   1.96      fvdl 
   4252   1.96      fvdl 	/*
   4253   1.96      fvdl 	 * Note that we were successfull
   4254   1.96      fvdl 	 */
   4255   1.96      fvdl 	return (0);
   4256    1.6   mycroft 
   4257   1.96      fvdl error_exit:
   4258   1.42      fvdl 
   4259   1.96      fvdl 	return (ENOMEM);
   4260   1.96      fvdl }
   4261    1.6   mycroft 
   4262   1.96      fvdl static void
   4263   1.96      fvdl ahc_fini_scbdata(struct ahc_softc *ahc)
   4264   1.96      fvdl {
   4265   1.96      fvdl 	struct scb_data *scb_data;
   4266    1.6   mycroft 
   4267   1.96      fvdl 	scb_data = ahc->scb_data;
   4268   1.96      fvdl 	if (scb_data == NULL)
   4269   1.96      fvdl 		return;
   4270   1.42      fvdl 
   4271   1.96      fvdl 	switch (scb_data->init_level) {
   4272   1.96      fvdl 	default:
   4273   1.96      fvdl 	case 3:
   4274   1.96      fvdl 	{
   4275   1.96      fvdl 		struct sg_map_node *sg_map;
   4276   1.42      fvdl 
   4277   1.96      fvdl 		while ((sg_map = SLIST_FIRST(&scb_data->sg_maps))!= NULL) {
   4278   1.96      fvdl 			SLIST_REMOVE_HEAD(&scb_data->sg_maps, links);
   4279   1.96      fvdl 			ahc_freedmamem(ahc->parent_dmat, PAGE_SIZE,
   4280   1.96      fvdl 			    sg_map->sg_dmamap, (caddr_t)sg_map->sg_vaddr,
   4281   1.96      fvdl 			    &sg_map->sg_dmasegs, sg_map->sg_nseg);
   4282   1.96      fvdl 			free(sg_map, M_DEVBUF);
   4283   1.96      fvdl 		}
   4284   1.96      fvdl 	}
   4285   1.96      fvdl 	/*FALLTHROUGH*/
   4286   1.96      fvdl 	case 2:
   4287   1.96      fvdl 		ahc_freedmamem(ahc->parent_dmat,
   4288   1.96      fvdl 		    AHC_SCB_MAX * sizeof(struct scsipi_sense_data),
   4289   1.96      fvdl 		    scb_data->sense_dmamap, (caddr_t)scb_data->sense,
   4290   1.96      fvdl 		    &scb_data->sense_seg, scb_data->sense_nseg);
   4291   1.96      fvdl 	/*FALLTHROUGH*/
   4292   1.96      fvdl 	case 1:
   4293   1.96      fvdl 		ahc_freedmamem(ahc->parent_dmat,
   4294   1.96      fvdl 		    AHC_SCB_MAX * sizeof(struct hardware_scb),
   4295   1.96      fvdl 		    scb_data->hscb_dmamap, (caddr_t)scb_data->hscbs,
   4296   1.96      fvdl 		    &scb_data->hscb_seg, scb_data->hscb_nseg);
   4297   1.96      fvdl 	/*FALLTHROUGH*/
   4298   1.96      fvdl 	}
   4299   1.96      fvdl 	if (scb_data->scbarray != NULL)
   4300   1.96      fvdl 		free(scb_data->scbarray, M_DEVBUF);
   4301   1.96      fvdl }
   4302    1.6   mycroft 
   4303   1.96      fvdl void
   4304   1.96      fvdl ahc_alloc_scbs(struct ahc_softc *ahc)
   4305   1.96      fvdl {
   4306   1.96      fvdl 	struct scb_data *scb_data;
   4307   1.96      fvdl 	struct scb *next_scb;
   4308   1.96      fvdl 	struct sg_map_node *sg_map;
   4309   1.96      fvdl 	bus_addr_t physaddr;
   4310   1.96      fvdl 	struct ahc_dma_seg *segs;
   4311   1.96      fvdl 	int newcount;
   4312   1.96      fvdl 	int i;
   4313    1.6   mycroft 
   4314   1.96      fvdl 	scb_data = ahc->scb_data;
   4315   1.96      fvdl 	if (scb_data->numscbs >= AHC_SCB_MAX_ALLOC)
   4316   1.96      fvdl 		/* Can't allocate any more */
   4317   1.96      fvdl 		return;
   4318    1.6   mycroft 
   4319   1.96      fvdl 	next_scb = &scb_data->scbarray[scb_data->numscbs];
   4320    1.6   mycroft 
   4321   1.96      fvdl 	sg_map = malloc(sizeof(*sg_map), M_DEVBUF, M_NOWAIT);
   4322   1.42      fvdl 
   4323   1.96      fvdl 	if (sg_map == NULL)
   4324   1.96      fvdl 		return;
   4325    1.6   mycroft 
   4326   1.96      fvdl 	/* Allocate S/G space for the next batch of SCBS */
   4327   1.96      fvdl 	if (ahc_createdmamem(ahc->parent_dmat, PAGE_SIZE, ahc->sc_dmaflags,
   4328   1.96      fvdl 			     &sg_map->sg_dmamap,
   4329   1.96      fvdl 			     (caddr_t *)&sg_map->sg_vaddr, &sg_map->sg_physaddr,
   4330   1.96      fvdl 			     &sg_map->sg_dmasegs, &sg_map->sg_nseg, ahc_name(ahc),
   4331   1.96      fvdl 			     "SG space") < 0) {
   4332   1.96      fvdl 		free(sg_map, M_DEVBUF);
   4333   1.96      fvdl 		return;
   4334   1.96      fvdl 	}
   4335    1.6   mycroft 
   4336   1.96      fvdl 	SLIST_INSERT_HEAD(&scb_data->sg_maps, sg_map, links);
   4337    1.6   mycroft 
   4338   1.96      fvdl 	segs = sg_map->sg_vaddr;
   4339   1.96      fvdl 	physaddr = sg_map->sg_physaddr;
   4340    1.6   mycroft 
   4341   1.96      fvdl 	newcount = (PAGE_SIZE / (AHC_NSEG * sizeof(struct ahc_dma_seg)));
   4342   1.96      fvdl 	newcount = MIN(newcount, (AHC_SCB_MAX_ALLOC - scb_data->numscbs));
   4343   1.96      fvdl 	for (i = 0; i < newcount; i++) {
   4344   1.96      fvdl 		struct scb_platform_data *pdata;
   4345   1.96      fvdl 		int error;
   4346    1.6   mycroft 
   4347   1.96      fvdl 		pdata = (struct scb_platform_data *)malloc(sizeof(*pdata),
   4348   1.96      fvdl 							   M_DEVBUF, M_NOWAIT);
   4349   1.96      fvdl 		if (pdata == NULL)
   4350   1.96      fvdl 			break;
   4351   1.96      fvdl 		next_scb->platform_data = pdata;
   4352   1.96      fvdl 		next_scb->sg_map = sg_map;
   4353   1.96      fvdl 		next_scb->sg_list = segs;
   4354   1.42      fvdl 		/*
   4355   1.96      fvdl 		 * The sequencer always starts with the second entry.
   4356   1.96      fvdl 		 * The first entry is embedded in the scb.
   4357   1.42      fvdl 		 */
   4358   1.96      fvdl 		next_scb->sg_list_phys = physaddr + sizeof(struct ahc_dma_seg);
   4359   1.96      fvdl 		next_scb->ahc_softc = ahc;
   4360   1.96      fvdl 		next_scb->flags = SCB_FREE;
   4361   1.96      fvdl 
   4362   1.96      fvdl 		error = bus_dmamap_create(ahc->parent_dmat,
   4363   1.96      fvdl 					  AHC_MAXTRANSFER_SIZE, AHC_NSEG, MAXBSIZE, 0,
   4364   1.96      fvdl 					  BUS_DMA_NOWAIT|BUS_DMA_ALLOCNOW,
   4365   1.96      fvdl 					  &next_scb->dmamap);
   4366   1.96      fvdl 		if (error != 0)
   4367   1.96      fvdl 			break;
   4368    1.6   mycroft 
   4369   1.96      fvdl 		next_scb->hscb = &scb_data->hscbs[scb_data->numscbs];
   4370   1.96      fvdl 		next_scb->hscb->tag = ahc->scb_data->numscbs;
   4371   1.96      fvdl 		SLIST_INSERT_HEAD(&ahc->scb_data->free_scbs,
   4372   1.96      fvdl 				  next_scb, links.sle);
   4373   1.96      fvdl 		segs += AHC_NSEG;
   4374   1.96      fvdl 		physaddr += (AHC_NSEG * sizeof(struct ahc_dma_seg));
   4375   1.96      fvdl 		next_scb++;
   4376   1.96      fvdl 		ahc->scb_data->numscbs++;
   4377    1.6   mycroft 	}
   4378    1.1   mycroft }
   4379    1.1   mycroft 
   4380   1.96      fvdl void
   4381   1.96      fvdl ahc_controller_info(struct ahc_softc *ahc, char *buf)
   4382    1.1   mycroft {
   4383   1.96      fvdl 	int len;
   4384   1.42      fvdl 
   4385   1.96      fvdl 	len = sprintf(buf, "%s: ", ahc_chip_names[ahc->chip & AHC_CHIPID_MASK]);
   4386   1.96      fvdl 	buf += len;
   4387   1.96      fvdl 	if ((ahc->features & AHC_TWIN) != 0)
   4388   1.96      fvdl  		len = sprintf(buf, "Twin Channel, A SCSI Id=%d, "
   4389   1.96      fvdl 			      "B SCSI Id=%d, primary %c, ",
   4390   1.96      fvdl 			      ahc->our_id, ahc->our_id_b,
   4391   1.96      fvdl 			      (ahc->flags & AHC_PRIMARY_CHANNEL) + 'A');
   4392   1.96      fvdl 	else {
   4393   1.96      fvdl 		const char *speed;
   4394   1.96      fvdl 		const char *type;
   4395   1.96      fvdl 
   4396   1.96      fvdl 		speed = "";
   4397   1.96      fvdl 		if ((ahc->features & AHC_ULTRA) != 0) {
   4398   1.96      fvdl 			speed = "Ultra ";
   4399   1.96      fvdl 		} else if ((ahc->features & AHC_DT) != 0) {
   4400   1.96      fvdl 			speed = "Ultra160 ";
   4401   1.96      fvdl 		} else if ((ahc->features & AHC_ULTRA2) != 0) {
   4402   1.96      fvdl 			speed = "Ultra2 ";
   4403   1.96      fvdl 		}
   4404   1.96      fvdl 		if ((ahc->features & AHC_WIDE) != 0) {
   4405   1.96      fvdl 			type = "Wide";
   4406   1.96      fvdl 		} else {
   4407   1.96      fvdl 			type = "Single";
   4408   1.96      fvdl 		}
   4409   1.96      fvdl 		len = sprintf(buf, "%s%s Channel %c, SCSI Id=%d, ",
   4410   1.96      fvdl 			      speed, type, ahc->channel, ahc->our_id);
   4411   1.42      fvdl 	}
   4412   1.96      fvdl 	buf += len;
   4413   1.42      fvdl 
   4414   1.96      fvdl 	if ((ahc->flags & AHC_PAGESCBS) != 0)
   4415   1.96      fvdl 		sprintf(buf, "%d/%d SCBs",
   4416   1.96      fvdl 			ahc->scb_data->maxhscbs, AHC_MAX_QUEUE);
   4417   1.96      fvdl 	else
   4418   1.96      fvdl 		sprintf(buf, "%d SCBs", ahc->scb_data->maxhscbs);
   4419   1.42      fvdl }
   4420    1.1   mycroft 
   4421   1.96      fvdl /*
   4422   1.96      fvdl  * Start the board, ready for normal operation
   4423   1.96      fvdl  */
   4424   1.96      fvdl int
   4425   1.96      fvdl ahc_init(struct ahc_softc *ahc)
   4426   1.42      fvdl {
   4427   1.96      fvdl 	int	 max_targ;
   4428   1.96      fvdl 	int	 i;
   4429   1.96      fvdl 	int	 term;
   4430   1.96      fvdl 	u_int	 scsi_conf;
   4431   1.96      fvdl 	u_int	 scsiseq_template;
   4432   1.96      fvdl 	u_int	 ultraenb;
   4433   1.96      fvdl 	u_int	 discenable;
   4434   1.96      fvdl 	u_int	 tagenable;
   4435   1.96      fvdl 	size_t	 driver_data_size;
   4436   1.96      fvdl 	uint32_t physaddr;
   4437   1.42      fvdl 
   4438   1.96      fvdl #ifdef AHC_DEBUG
   4439   1.96      fvdl 	if ((ahc_debug & AHC_DEBUG_SEQUENCER) != 0)
   4440   1.96      fvdl 		ahc->flags |= AHC_SEQUENCER_DEBUG;
   4441   1.96      fvdl #endif
   4442   1.42      fvdl 
   4443   1.96      fvdl #ifdef AHC_PRINT_SRAM
   4444   1.96      fvdl 	printf("Scratch Ram:");
   4445   1.96      fvdl 	for (i = 0x20; i < 0x5f; i++) {
   4446   1.96      fvdl 		if (((i % 8) == 0) && (i != 0)) {
   4447   1.96      fvdl 			printf ("\n              ");
   4448   1.42      fvdl 		}
   4449   1.96      fvdl 		printf (" 0x%x", ahc_inb(ahc, i));
   4450   1.42      fvdl 	}
   4451   1.96      fvdl 	if ((ahc->features & AHC_MORE_SRAM) != 0) {
   4452   1.96      fvdl 		for (i = 0x70; i < 0x7f; i++) {
   4453   1.96      fvdl 			if (((i % 8) == 0) && (i != 0)) {
   4454   1.96      fvdl 				printf ("\n              ");
   4455   1.96      fvdl 			}
   4456   1.96      fvdl 			printf (" 0x%x", ahc_inb(ahc, i));
   4457   1.96      fvdl 		}
   4458   1.42      fvdl 	}
   4459   1.96      fvdl 	printf ("\n");
   4460   1.96      fvdl 	/*
   4461   1.96      fvdl 	 * Reading uninitialized scratch ram may
   4462   1.96      fvdl 	 * generate parity errors.
   4463   1.96      fvdl 	 */
   4464   1.96      fvdl 	ahc_outb(ahc, CLRINT, CLRPARERR);
   4465   1.96      fvdl 	ahc_outb(ahc, CLRINT, CLRBRKADRINT);
   4466   1.96      fvdl #endif
   4467   1.96      fvdl 	max_targ = 15;
   4468    1.6   mycroft 
   4469   1.42      fvdl 	/*
   4470   1.96      fvdl 	 * Assume we have a board at this stage and it has been reset.
   4471   1.42      fvdl 	 */
   4472   1.96      fvdl 	if ((ahc->flags & AHC_USEDEFAULTS) != 0)
   4473   1.96      fvdl 		ahc->our_id = ahc->our_id_b = 7;
   4474   1.96      fvdl 
   4475   1.59        pk 	/*
   4476   1.96      fvdl 	 * Default to allowing initiator operations.
   4477   1.59        pk 	 */
   4478   1.96      fvdl 	ahc->flags |= AHC_INITIATORROLE;
   4479    1.6   mycroft 
   4480    1.1   mycroft 	/*
   4481   1.96      fvdl 	 * Only allow target mode features if this unit has them enabled.
   4482    1.1   mycroft 	 */
   4483   1.96      fvdl 	//if ((AHC_TMODE_ENABLE & (0x1 << ahc->unit)) == 0)
   4484   1.96      fvdl 		ahc->features &= ~AHC_TARGETMODE;
   4485   1.42      fvdl 
   4486   1.96      fvdl 	/*
   4487   1.96      fvdl 	 * DMA tag for our command fifos and other data in system memory
   4488   1.96      fvdl 	 * the card's sequencer must be able to access.  For initiator
   4489   1.96      fvdl 	 * roles, we need to allocate space for the qinfifo and qoutfifo.
   4490   1.96      fvdl 	 * The qinfifo and qoutfifo are composed of 256 1 byte elements.
   4491   1.96      fvdl 	 * When providing for the target mode role, we must additionally
   4492   1.96      fvdl 	 * provide space for the incoming target command fifo and an extra
   4493   1.96      fvdl 	 * byte to deal with a dma bug in some chip versions.
   4494   1.96      fvdl 	 */
   4495   1.96      fvdl 	driver_data_size = 2 * 256 * sizeof(uint8_t);
   4496   1.96      fvdl 	if ((ahc->features & AHC_TARGETMODE) != 0)
   4497   1.96      fvdl 		driver_data_size += AHC_TMODE_CMDS * sizeof(struct target_cmd)
   4498   1.96      fvdl 				 + /*DMA WideOdd Bug Buffer*/1;
   4499   1.42      fvdl 
   4500   1.96      fvdl 	if (ahc_createdmamem(ahc->parent_dmat, driver_data_size,
   4501   1.96      fvdl 			     ahc->sc_dmaflags,
   4502   1.96      fvdl 			     &ahc->shared_data_dmamap, (caddr_t *)&ahc->qoutfifo,
   4503   1.96      fvdl 			     &ahc->shared_data_busaddr, &ahc->shared_data_seg,
   4504   1.96      fvdl 			     &ahc->shared_data_nseg, ahc_name(ahc), "shared data") < 0)
   4505   1.96      fvdl 		return (ENOMEM);
   4506    1.6   mycroft 
   4507   1.96      fvdl 	ahc->init_level++;
   4508    1.1   mycroft 
   4509   1.96      fvdl 	if ((ahc->features & AHC_TARGETMODE) != 0) {
   4510   1.96      fvdl 		ahc->targetcmds = (struct target_cmd *)ahc->qoutfifo;
   4511   1.96      fvdl 		ahc->qoutfifo = (uint8_t *)&ahc->targetcmds[AHC_TMODE_CMDS];
   4512   1.96      fvdl 		ahc->dma_bug_buf = ahc->shared_data_busaddr
   4513   1.96      fvdl 				 + driver_data_size - 1;
   4514   1.96      fvdl 		/* All target command blocks start out invalid. */
   4515   1.96      fvdl 		for (i = 0; i < AHC_TMODE_CMDS; i++)
   4516   1.96      fvdl 			ahc->targetcmds[i].cmd_valid = 0;
   4517   1.96      fvdl 		ahc_sync_tqinfifo(ahc, BUS_DMASYNC_PREREAD);
   4518   1.96      fvdl 		ahc->tqinfifonext = 1;
   4519   1.96      fvdl 		ahc_outb(ahc, KERNEL_TQINPOS, ahc->tqinfifonext - 1);
   4520   1.96      fvdl 		ahc_outb(ahc, TQINPOS, ahc->tqinfifonext);
   4521   1.96      fvdl 		ahc->qoutfifo = (uint8_t *)&ahc->targetcmds[256];
   4522   1.42      fvdl 	}
   4523   1.96      fvdl 	ahc->qinfifo = &ahc->qoutfifo[256];
   4524   1.14     gibbs 
   4525   1.96      fvdl 	ahc->init_level++;
   4526   1.14     gibbs 
   4527   1.96      fvdl 	/* Allocate SCB data now that buffer_dmat is initialized */
   4528   1.96      fvdl 	if (ahc->scb_data->maxhscbs == 0)
   4529   1.96      fvdl 		if (ahc_init_scbdata(ahc) != 0)
   4530   1.96      fvdl 		  return (ENOMEM);
   4531   1.42      fvdl 
   4532   1.96      fvdl 	if (bootverbose)
   4533   1.96      fvdl 		printf("%s: found %d SCBs\n", ahc_name(ahc),
   4534   1.96      fvdl 		    ahc->scb_data->maxhscbs);
   4535   1.42      fvdl 
   4536   1.96      fvdl 	/*
   4537   1.96      fvdl 	 * Allocate a tstate to house information for our
   4538   1.96      fvdl 	 * initiator presence on the bus as well as the user
   4539   1.96      fvdl 	 * data for any target mode initiator.
   4540   1.96      fvdl 	 */
   4541   1.96      fvdl 	if (ahc_alloc_tstate(ahc, ahc->our_id, 'A') == NULL) {
   4542   1.96      fvdl 		printf("%s: unable to allocate ahc_tmode_tstate.  "
   4543   1.96      fvdl 		       "Failing attach\n", ahc_name(ahc));
   4544   1.96      fvdl 		return (ENOMEM);
   4545   1.96      fvdl 	}
   4546   1.42      fvdl 
   4547   1.96      fvdl 	if ((ahc->features & AHC_TWIN) != 0) {
   4548   1.96      fvdl 		if (ahc_alloc_tstate(ahc, ahc->our_id_b, 'B') == NULL) {
   4549   1.96      fvdl 			printf("%s: unable to allocate ahc_tmode_tstate.  "
   4550   1.96      fvdl 			       "Failing attach\n", ahc_name(ahc));
   4551   1.96      fvdl 			return (ENOMEM);
   4552   1.96      fvdl 		}
   4553   1.96      fvdl 	}
   4554   1.42      fvdl 
   4555   1.96      fvdl 	ahc_outb(ahc, SEQ_FLAGS, 0);
   4556   1.96      fvdl 	ahc_outb(ahc, SEQ_FLAGS2, 0);
   4557   1.42      fvdl 
   4558   1.96      fvdl 	if (ahc->scb_data->maxhscbs < AHC_SCB_MAX_ALLOC) {
   4559   1.96      fvdl 		ahc->flags |= AHC_PAGESCBS;
   4560   1.96      fvdl 	} else {
   4561   1.96      fvdl 		ahc->flags &= ~AHC_PAGESCBS;
   4562   1.96      fvdl 	}
   4563   1.42      fvdl 
   4564   1.96      fvdl #ifdef AHC_DEBUG
   4565   1.96      fvdl 	if (ahc_debug & AHC_SHOW_MISC) {
   4566   1.97     bjh21 		printf("%s: hardware scb %lu bytes; kernel scb %lu bytes; "
   4567   1.97     bjh21 		       "ahc_dma %lu bytes\n",
   4568   1.96      fvdl 			ahc_name(ahc),
   4569   1.97     bjh21 			(u_long)sizeof(struct hardware_scb),
   4570   1.97     bjh21 			(u_long)sizeof(struct scb),
   4571   1.97     bjh21 			(u_long)sizeof(struct ahc_dma_seg));
   4572   1.96      fvdl 	}
   4573   1.96      fvdl #endif /* AHC_DEBUG */
   4574   1.42      fvdl 
   4575   1.96      fvdl 	/* Set the SCSI Id, SXFRCTL0, SXFRCTL1, and SIMODE1, for both channels*/
   4576   1.96      fvdl 	if (ahc->features & AHC_TWIN) {
   4577   1.42      fvdl 
   4578   1.42      fvdl 		/*
   4579   1.96      fvdl 		 * The device is gated to channel B after a chip reset,
   4580   1.96      fvdl 		 * so set those values first
   4581   1.42      fvdl 		 */
   4582   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, ahc_inb(ahc, SBLKCTL) | SELBUSB);
   4583   1.96      fvdl 		term = (ahc->flags & AHC_TERM_ENB_B) != 0 ? STPWEN : 0;
   4584   1.96      fvdl 		ahc_outb(ahc, SCSIID, ahc->our_id_b);
   4585   1.96      fvdl 		scsi_conf = ahc_inb(ahc, SCSICONF + 1);
   4586   1.96      fvdl 		ahc_outb(ahc, SXFRCTL1, (scsi_conf & (ENSPCHK|STIMESEL))
   4587   1.96      fvdl 					|term|ahc->seltime_b|ENSTIMER|ACTNEGEN);
   4588   1.96      fvdl 		if ((ahc->features & AHC_ULTRA2) != 0)
   4589   1.96      fvdl 			ahc_outb(ahc, SIMODE0, ahc_inb(ahc, SIMODE0)|ENIOERR);
   4590   1.96      fvdl 		ahc_outb(ahc, SIMODE1, ENSELTIMO|ENSCSIRST|ENSCSIPERR);
   4591   1.96      fvdl 		ahc_outb(ahc, SXFRCTL0, DFON|SPIOEN);
   4592   1.96      fvdl 
   4593   1.96      fvdl 		if ((scsi_conf & RESET_SCSI) != 0
   4594   1.96      fvdl 		 && (ahc->flags & AHC_INITIATORROLE) != 0)
   4595   1.96      fvdl 			ahc->flags |= AHC_RESET_BUS_B;
   4596   1.96      fvdl 
   4597   1.96      fvdl 		/* Select Channel A */
   4598   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, ahc_inb(ahc, SBLKCTL) & ~SELBUSB);
   4599   1.42      fvdl 	}
   4600   1.42      fvdl 
   4601   1.96      fvdl 	term = (ahc->flags & AHC_TERM_ENB_A) != 0 ? STPWEN : 0;
   4602   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0)
   4603   1.96      fvdl 		ahc_outb(ahc, SCSIID_ULTRA2, ahc->our_id);
   4604   1.96      fvdl 	else
   4605   1.96      fvdl 		ahc_outb(ahc, SCSIID, ahc->our_id);
   4606   1.96      fvdl 	scsi_conf = ahc_inb(ahc, SCSICONF);
   4607   1.96      fvdl 	ahc_outb(ahc, SXFRCTL1, (scsi_conf & (ENSPCHK|STIMESEL))
   4608   1.96      fvdl 				|term|ahc->seltime
   4609   1.96      fvdl 				|ENSTIMER|ACTNEGEN);
   4610   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0)
   4611   1.96      fvdl 		ahc_outb(ahc, SIMODE0, ahc_inb(ahc, SIMODE0)|ENIOERR);
   4612   1.96      fvdl 	ahc_outb(ahc, SIMODE1, ENSELTIMO|ENSCSIRST|ENSCSIPERR);
   4613   1.96      fvdl 	ahc_outb(ahc, SXFRCTL0, DFON|SPIOEN);
   4614   1.96      fvdl 
   4615   1.96      fvdl 	if ((scsi_conf & RESET_SCSI) != 0
   4616   1.96      fvdl 	 && (ahc->flags & AHC_INITIATORROLE) != 0)
   4617   1.96      fvdl 		ahc->flags |= AHC_RESET_BUS_A;
   4618   1.96      fvdl 
   4619   1.96      fvdl 	/*
   4620   1.96      fvdl 	 * Look at the information that board initialization or
   4621   1.96      fvdl 	 * the board bios has left us.
   4622   1.96      fvdl 	 */
   4623   1.96      fvdl 	ultraenb = 0;
   4624   1.96      fvdl 	tagenable = ALL_TARGETS_MASK;
   4625   1.42      fvdl 
   4626   1.96      fvdl 	/* Grab the disconnection disable table and invert it for our needs */
   4627   1.96      fvdl 	if ((ahc->flags & AHC_USEDEFAULTS) != 0) {
   4628   1.96      fvdl 		printf("%s: Host Adapter Bios disabled.  Using default SCSI "
   4629   1.96      fvdl 			"device parameters\n", ahc_name(ahc));
   4630   1.96      fvdl 		ahc->flags |= AHC_EXTENDED_TRANS_A|AHC_EXTENDED_TRANS_B|
   4631   1.96      fvdl 			      AHC_TERM_ENB_A|AHC_TERM_ENB_B;
   4632   1.96      fvdl 		discenable = ALL_TARGETS_MASK;
   4633   1.96      fvdl 		if ((ahc->features & AHC_ULTRA) != 0)
   4634   1.96      fvdl 			ultraenb = ALL_TARGETS_MASK;
   4635   1.96      fvdl 	} else {
   4636   1.96      fvdl 		discenable = ~((ahc_inb(ahc, DISC_DSB + 1) << 8)
   4637   1.96      fvdl 			   | ahc_inb(ahc, DISC_DSB));
   4638   1.96      fvdl 		if ((ahc->features & (AHC_ULTRA|AHC_ULTRA2)) != 0)
   4639   1.96      fvdl 			ultraenb = (ahc_inb(ahc, ULTRA_ENB + 1) << 8)
   4640   1.96      fvdl 				      | ahc_inb(ahc, ULTRA_ENB);
   4641   1.96      fvdl 	}
   4642   1.42      fvdl 
   4643   1.96      fvdl 	if ((ahc->features & (AHC_WIDE|AHC_TWIN)) == 0)
   4644   1.96      fvdl 		max_targ = 7;
   4645   1.42      fvdl 
   4646   1.96      fvdl 	for (i = 0; i <= max_targ; i++) {
   4647   1.96      fvdl 		struct ahc_initiator_tinfo *tinfo;
   4648   1.96      fvdl 		struct ahc_tmode_tstate *tstate;
   4649   1.96      fvdl 		u_int our_id;
   4650   1.96      fvdl 		u_int target_id;
   4651   1.96      fvdl 		char channel;
   4652   1.42      fvdl 
   4653   1.96      fvdl 		channel = 'A';
   4654   1.96      fvdl 		our_id = ahc->our_id;
   4655   1.96      fvdl 		target_id = i;
   4656   1.96      fvdl 		if (i > 7 && (ahc->features & AHC_TWIN) != 0) {
   4657   1.96      fvdl 			channel = 'B';
   4658   1.96      fvdl 			our_id = ahc->our_id_b;
   4659   1.96      fvdl 			target_id = i % 8;
   4660   1.96      fvdl 		}
   4661   1.96      fvdl 		tinfo = ahc_fetch_transinfo(ahc, channel, our_id,
   4662   1.96      fvdl 					    target_id, &tstate);
   4663   1.96      fvdl 		/* Default to async narrow across the board */
   4664   1.96      fvdl 		memset(tinfo, 0, sizeof(*tinfo));
   4665   1.96      fvdl 		if (ahc->flags & AHC_USEDEFAULTS) {
   4666   1.96      fvdl 			if ((ahc->features & AHC_WIDE) != 0)
   4667   1.96      fvdl 				tinfo->user.width = MSG_EXT_WDTR_BUS_16_BIT;
   4668   1.42      fvdl 
   4669   1.42      fvdl 			/*
   4670   1.96      fvdl 			 * These will be truncated when we determine the
   4671   1.96      fvdl 			 * connection type we have with the target.
   4672   1.42      fvdl 			 */
   4673   1.96      fvdl 			tinfo->user.period = ahc_syncrates->period;
   4674   1.96      fvdl 			tinfo->user.offset = ~0;
   4675   1.96      fvdl 		} else {
   4676   1.96      fvdl 			u_int scsirate;
   4677   1.96      fvdl 			uint16_t mask;
   4678   1.42      fvdl 
   4679   1.96      fvdl 			/* Take the settings leftover in scratch RAM. */
   4680   1.96      fvdl 			scsirate = ahc_inb(ahc, TARG_SCSIRATE + i);
   4681   1.96      fvdl 			mask = (0x01 << i);
   4682   1.96      fvdl 			if ((ahc->features & AHC_ULTRA2) != 0) {
   4683   1.96      fvdl 				u_int offset;
   4684   1.96      fvdl 				u_int maxsync;
   4685   1.42      fvdl 
   4686   1.96      fvdl 				if ((scsirate & SOFS) == 0x0F) {
   4687   1.96      fvdl 					/*
   4688   1.96      fvdl 					 * Haven't negotiated yet,
   4689   1.96      fvdl 					 * so the format is different.
   4690   1.96      fvdl 					 */
   4691   1.96      fvdl 					scsirate = (scsirate & SXFR) >> 4
   4692   1.96      fvdl 						 | (ultraenb & mask)
   4693   1.96      fvdl 						  ? 0x08 : 0x0
   4694   1.96      fvdl 						 | (scsirate & WIDEXFER);
   4695   1.96      fvdl 					offset = MAX_OFFSET_ULTRA2;
   4696   1.96      fvdl 				} else
   4697   1.96      fvdl 					offset = ahc_inb(ahc, TARG_OFFSET + i);
   4698   1.96      fvdl 				if ((scsirate & ~WIDEXFER) == 0 && offset != 0)
   4699   1.96      fvdl 					/* Set to the lowest sync rate, 5MHz */
   4700   1.96      fvdl 					scsirate |= 0x1c;
   4701   1.96      fvdl 				maxsync = AHC_SYNCRATE_ULTRA2;
   4702   1.96      fvdl 				if ((ahc->features & AHC_DT) != 0)
   4703   1.96      fvdl 					maxsync = AHC_SYNCRATE_DT;
   4704   1.96      fvdl 				tinfo->user.period =
   4705   1.96      fvdl 				    ahc_find_period(ahc, scsirate, maxsync);
   4706   1.96      fvdl 				if (offset == 0)
   4707   1.96      fvdl 					tinfo->user.period = 0;
   4708   1.96      fvdl 				else
   4709   1.96      fvdl 					tinfo->user.offset = ~0;
   4710   1.96      fvdl 				if ((scsirate & SXFR_ULTRA2) <= 8/*10MHz*/
   4711   1.96      fvdl 				 && (ahc->features & AHC_DT) != 0)
   4712   1.96      fvdl 					tinfo->user.ppr_options =
   4713   1.96      fvdl 					    MSG_EXT_PPR_DT_REQ;
   4714   1.96      fvdl 			} else if ((scsirate & SOFS) != 0) {
   4715   1.96      fvdl 				if ((scsirate & SXFR) == 0x40
   4716   1.96      fvdl 				 && (ultraenb & mask) != 0) {
   4717   1.96      fvdl 					/* Treat 10MHz as a non-ultra speed */
   4718   1.96      fvdl 					scsirate &= ~SXFR;
   4719   1.96      fvdl 				 	ultraenb &= ~mask;
   4720   1.96      fvdl 				}
   4721   1.96      fvdl 				tinfo->user.period =
   4722   1.96      fvdl 				    ahc_find_period(ahc, scsirate,
   4723   1.96      fvdl 						    (ultraenb & mask)
   4724   1.96      fvdl 						   ? AHC_SYNCRATE_ULTRA
   4725   1.96      fvdl 						   : AHC_SYNCRATE_FAST);
   4726   1.96      fvdl 				if (tinfo->user.period != 0)
   4727   1.96      fvdl 					tinfo->user.offset = ~0;
   4728   1.96      fvdl 			}
   4729   1.96      fvdl 			if (tinfo->user.period == 0)
   4730   1.96      fvdl 				tinfo->user.offset = 0;
   4731   1.96      fvdl 			if ((scsirate & WIDEXFER) != 0
   4732   1.96      fvdl 			 && (ahc->features & AHC_WIDE) != 0)
   4733   1.96      fvdl 				tinfo->user.width = MSG_EXT_WDTR_BUS_16_BIT;
   4734   1.96      fvdl 			tinfo->user.protocol_version = 4;
   4735   1.96      fvdl 			if ((ahc->features & AHC_DT) != 0)
   4736   1.96      fvdl 				tinfo->user.transport_version = 3;
   4737   1.96      fvdl 			else
   4738   1.96      fvdl 				tinfo->user.transport_version = 2;
   4739   1.96      fvdl 			tinfo->goal.protocol_version = 2;
   4740   1.96      fvdl 			tinfo->goal.transport_version = 2;
   4741   1.96      fvdl 			tinfo->curr.protocol_version = 2;
   4742   1.96      fvdl 			tinfo->curr.transport_version = 2;
   4743   1.42      fvdl 		}
   4744   1.96      fvdl 		tstate->ultraenb = 0;
   4745   1.96      fvdl 		tstate->discenable = discenable;
   4746   1.42      fvdl 	}
   4747   1.96      fvdl 	ahc->user_discenable = discenable;
   4748   1.96      fvdl 	ahc->user_tagenable = tagenable;
   4749   1.42      fvdl 
   4750   1.96      fvdl 	/* There are no untagged SCBs active yet. */
   4751   1.96      fvdl 	for (i = 0; i < 16; i++) {
   4752   1.96      fvdl 		ahc_unbusy_tcl(ahc, BUILD_TCL(i << 4, 0));
   4753   1.96      fvdl 		if ((ahc->flags & AHC_SCB_BTT) != 0) {
   4754   1.96      fvdl 			int lun;
   4755   1.42      fvdl 
   4756   1.42      fvdl 			/*
   4757   1.96      fvdl 			 * The SCB based BTT allows an entry per
   4758   1.96      fvdl 			 * target and lun pair.
   4759   1.42      fvdl 			 */
   4760   1.96      fvdl 			for (lun = 1; lun < AHC_NUM_LUNS; lun++)
   4761   1.96      fvdl 				ahc_unbusy_tcl(ahc, BUILD_TCL(i << 4, lun));
   4762   1.42      fvdl 		}
   4763   1.96      fvdl 	}
   4764   1.59        pk 
   4765   1.96      fvdl 	/* All of our queues are empty */
   4766   1.96      fvdl 	for (i = 0; i < 256; i++)
   4767   1.96      fvdl 		ahc->qoutfifo[i] = SCB_LIST_NULL;
   4768   1.42      fvdl 
   4769   1.96      fvdl 	ahc_sync_qoutfifo(ahc, BUS_DMASYNC_PREREAD);
   4770    1.9  explorer 
   4771   1.96      fvdl 	for (i = 0; i < 256; i++)
   4772   1.96      fvdl 		ahc->qinfifo[i] = SCB_LIST_NULL;
   4773    1.9  explorer 
   4774   1.96      fvdl 	if ((ahc->features & AHC_MULTI_TID) != 0) {
   4775   1.96      fvdl 		ahc_outb(ahc, TARGID, 0);
   4776   1.96      fvdl 		ahc_outb(ahc, TARGID + 1, 0);
   4777   1.14     gibbs 	}
   4778   1.14     gibbs 
   4779   1.96      fvdl 	/*
   4780   1.96      fvdl 	 * Tell the sequencer where it can find our arrays in memory.
   4781   1.96      fvdl 	 */
   4782   1.96      fvdl 	physaddr = ahc->scb_data->hscb_busaddr;
   4783   1.96      fvdl 	ahc_outb(ahc, HSCB_ADDR, physaddr & 0xFF);
   4784   1.96      fvdl 	ahc_outb(ahc, HSCB_ADDR + 1, (physaddr >> 8) & 0xFF);
   4785   1.96      fvdl 	ahc_outb(ahc, HSCB_ADDR + 2, (physaddr >> 16) & 0xFF);
   4786   1.96      fvdl 	ahc_outb(ahc, HSCB_ADDR + 3, (physaddr >> 24) & 0xFF);
   4787   1.14     gibbs 
   4788   1.96      fvdl 	physaddr = ahc->shared_data_busaddr;
   4789   1.96      fvdl 	ahc_outb(ahc, SHARED_DATA_ADDR, physaddr & 0xFF);
   4790   1.96      fvdl 	ahc_outb(ahc, SHARED_DATA_ADDR + 1, (physaddr >> 8) & 0xFF);
   4791   1.96      fvdl 	ahc_outb(ahc, SHARED_DATA_ADDR + 2, (physaddr >> 16) & 0xFF);
   4792   1.96      fvdl 	ahc_outb(ahc, SHARED_DATA_ADDR + 3, (physaddr >> 24) & 0xFF);
   4793   1.14     gibbs 
   4794   1.96      fvdl 	/*
   4795   1.96      fvdl 	 * Initialize the group code to command length table.
   4796   1.96      fvdl 	 * This overrides the values in TARG_SCSIRATE, so only
   4797   1.96      fvdl 	 * setup the table after we have processed that information.
   4798   1.96      fvdl 	 */
   4799   1.96      fvdl 	ahc_outb(ahc, CMDSIZE_TABLE, 5);
   4800   1.96      fvdl 	ahc_outb(ahc, CMDSIZE_TABLE + 1, 9);
   4801   1.96      fvdl 	ahc_outb(ahc, CMDSIZE_TABLE + 2, 9);
   4802   1.96      fvdl 	ahc_outb(ahc, CMDSIZE_TABLE + 3, 0);
   4803   1.96      fvdl 	ahc_outb(ahc, CMDSIZE_TABLE + 4, 15);
   4804   1.96      fvdl 	ahc_outb(ahc, CMDSIZE_TABLE + 5, 11);
   4805   1.96      fvdl 	ahc_outb(ahc, CMDSIZE_TABLE + 6, 0);
   4806   1.96      fvdl 	ahc_outb(ahc, CMDSIZE_TABLE + 7, 0);
   4807   1.96      fvdl 
   4808   1.96      fvdl 	/* Tell the sequencer of our initial queue positions */
   4809   1.96      fvdl 	ahc_outb(ahc, KERNEL_QINPOS, 0);
   4810   1.96      fvdl 	ahc_outb(ahc, QINPOS, 0);
   4811   1.96      fvdl 	ahc_outb(ahc, QOUTPOS, 0);
   4812   1.14     gibbs 
   4813   1.96      fvdl 	/*
   4814   1.96      fvdl 	 * Use the built in queue management registers
   4815   1.96      fvdl 	 * if they are available.
   4816   1.96      fvdl 	 */
   4817   1.96      fvdl 	if ((ahc->features & AHC_QUEUE_REGS) != 0) {
   4818   1.96      fvdl 		ahc_outb(ahc, QOFF_CTLSTA, SCB_QSIZE_256);
   4819   1.96      fvdl 		ahc_outb(ahc, SDSCB_QOFF, 0);
   4820   1.96      fvdl 		ahc_outb(ahc, SNSCB_QOFF, 0);
   4821   1.96      fvdl 		ahc_outb(ahc, HNSCB_QOFF, 0);
   4822   1.96      fvdl 	}
   4823   1.14     gibbs 
   4824   1.42      fvdl 
   4825   1.96      fvdl 	/* We don't have any waiting selections */
   4826   1.96      fvdl 	ahc_outb(ahc, WAITING_SCBH, SCB_LIST_NULL);
   4827   1.14     gibbs 
   4828   1.96      fvdl 	/* Our disconnection list is empty too */
   4829   1.96      fvdl 	ahc_outb(ahc, DISCONNECTED_SCBH, SCB_LIST_NULL);
   4830   1.42      fvdl 
   4831   1.96      fvdl 	/* Message out buffer starts empty */
   4832   1.96      fvdl 	ahc_outb(ahc, MSG_OUT, MSG_NOOP);
   4833   1.42      fvdl 
   4834   1.42      fvdl 	/*
   4835   1.96      fvdl 	 * Setup the allowed SCSI Sequences based on operational mode.
   4836   1.96      fvdl 	 * If we are a target, we'll enalbe select in operations once
   4837   1.96      fvdl 	 * we've had a lun enabled.
   4838   1.42      fvdl 	 */
   4839   1.96      fvdl 	scsiseq_template = ENSELO|ENAUTOATNO|ENAUTOATNP;
   4840   1.96      fvdl 	if ((ahc->flags & AHC_INITIATORROLE) != 0)
   4841   1.96      fvdl 		scsiseq_template |= ENRSELI;
   4842   1.96      fvdl 	ahc_outb(ahc, SCSISEQ_TEMPLATE, scsiseq_template);
   4843   1.42      fvdl 
   4844   1.96      fvdl 	/*
   4845   1.96      fvdl 	 * Load the Sequencer program and Enable the adapter
   4846   1.96      fvdl 	 * in "fast" mode.
   4847   1.96      fvdl 	 */
   4848   1.96      fvdl 	if (bootverbose)
   4849   1.96      fvdl 		printf("%s: Downloading Sequencer Program...",
   4850   1.96      fvdl 		       ahc_name(ahc));
   4851   1.14     gibbs 
   4852   1.96      fvdl 	ahc_loadseq(ahc);
   4853   1.42      fvdl 
   4854   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0) {
   4855   1.96      fvdl 		int wait;
   4856   1.14     gibbs 
   4857   1.96      fvdl 		/*
   4858   1.96      fvdl 		 * Wait for up to 500ms for our transceivers
   4859   1.96      fvdl 		 * to settle.  If the adapter does not have
   4860   1.96      fvdl 		 * a cable attached, the tranceivers may
   4861   1.96      fvdl 		 * never settle, so don't complain if we
   4862   1.96      fvdl 		 * fail here.
   4863   1.96      fvdl 		 */
   4864   1.96      fvdl 		ahc_pause(ahc);
   4865   1.96      fvdl 		for (wait = 5000;
   4866   1.96      fvdl 		     (ahc_inb(ahc, SBLKCTL) & (ENAB40|ENAB20)) == 0 && wait;
   4867   1.96      fvdl 		     wait--)
   4868   1.96      fvdl 			ahc_delay(100);
   4869   1.96      fvdl 		ahc_unpause(ahc);
   4870   1.96      fvdl 	}
   4871    1.1   mycroft 
   4872   1.96      fvdl 	/* We have to wait until after any system dumps... */
   4873   1.96      fvdl 	ahc->shutdown_hook = shutdownhook_establish(ahc_shutdown, ahc);
   4874    1.1   mycroft 
   4875   1.96      fvdl 	return (0);
   4876   1.96      fvdl }
   4877    1.1   mycroft 
   4878   1.96      fvdl void
   4879   1.96      fvdl ahc_intr_enable(struct ahc_softc *ahc, int enable)
   4880   1.96      fvdl {
   4881   1.96      fvdl 	u_int hcntrl;
   4882   1.42      fvdl 
   4883   1.96      fvdl 	hcntrl = ahc_inb(ahc, HCNTRL);
   4884   1.96      fvdl 	hcntrl &= ~INTEN;
   4885   1.96      fvdl 	ahc->pause &= ~INTEN;
   4886   1.96      fvdl 	ahc->unpause &= ~INTEN;
   4887   1.96      fvdl 	if (enable) {
   4888   1.96      fvdl 		hcntrl |= INTEN;
   4889   1.96      fvdl 		ahc->pause |= INTEN;
   4890   1.96      fvdl 		ahc->unpause |= INTEN;
   4891   1.96      fvdl 	}
   4892   1.96      fvdl 	ahc_outb(ahc, HCNTRL, hcntrl);
   4893   1.96      fvdl }
   4894   1.42      fvdl 
   4895   1.96      fvdl /*
   4896   1.96      fvdl  * Ensure that the card is paused in a location
   4897   1.96      fvdl  * outside of all critical sections and that all
   4898   1.96      fvdl  * pending work is completed prior to returning.
   4899   1.96      fvdl  * This routine should only be called from outside
   4900   1.96      fvdl  * an interrupt context.
   4901   1.96      fvdl  */
   4902   1.96      fvdl void
   4903   1.96      fvdl ahc_pause_and_flushwork(struct ahc_softc *ahc)
   4904   1.96      fvdl {
   4905   1.96      fvdl 	int intstat;
   4906   1.96      fvdl 	int maxloops;
   4907   1.96      fvdl 	int paused;
   4908   1.96      fvdl 
   4909   1.96      fvdl 	maxloops = 1000;
   4910   1.96      fvdl 	ahc->flags |= AHC_ALL_INTERRUPTS;
   4911   1.96      fvdl 	intstat = 0;
   4912   1.96      fvdl 	paused = FALSE;
   4913   1.96      fvdl 	do {
   4914   1.96      fvdl 		if (paused)
   4915   1.96      fvdl 			ahc_unpause(ahc);
   4916   1.96      fvdl 		ahc_intr(ahc);
   4917   1.96      fvdl 		ahc_pause(ahc);
   4918   1.96      fvdl 		paused = TRUE;
   4919   1.96      fvdl 		ahc_outb(ahc, SCSISEQ, ahc_inb(ahc, SCSISEQ) & ~ENSELO);
   4920   1.96      fvdl 		ahc_clear_critical_section(ahc);
   4921   1.96      fvdl 		if (intstat == 0xFF && (ahc->features & AHC_REMOVABLE) != 0)
   4922   1.42      fvdl 			break;
   4923   1.96      fvdl 	} while (--maxloops
   4924   1.96      fvdl 	      && (((intstat = ahc_inb(ahc, INTSTAT)) & INT_PEND) != 0
   4925   1.96      fvdl 	       || (ahc_inb(ahc, SSTAT0) & (SELDO|SELINGO))));
   4926   1.96      fvdl 	if (maxloops == 0) {
   4927   1.96      fvdl 		printf("Infinite interrupt loop, INTSTAT = %x",
   4928   1.96      fvdl 		       ahc_inb(ahc, INTSTAT));
   4929   1.14     gibbs 	}
   4930   1.96      fvdl 	ahc_platform_flushwork(ahc);
   4931   1.96      fvdl 	ahc->flags &= ~AHC_ALL_INTERRUPTS;
   4932   1.96      fvdl }
   4933   1.96      fvdl 
   4934   1.96      fvdl int
   4935   1.96      fvdl ahc_suspend(struct ahc_softc *ahc)
   4936   1.96      fvdl {
   4937   1.96      fvdl 	uint8_t *ptr;
   4938   1.96      fvdl 	int	 i;
   4939   1.96      fvdl 
   4940   1.96      fvdl 	ahc_pause_and_flushwork(ahc);
   4941   1.42      fvdl 
   4942   1.96      fvdl 	if (LIST_FIRST(&ahc->pending_scbs) != NULL)
   4943   1.96      fvdl 		return (EBUSY);
   4944   1.42      fvdl 
   4945   1.96      fvdl #if AHC_TARGET_MODE
   4946   1.96      fvdl 	/*
   4947   1.96      fvdl 	 * XXX What about ATIOs that have not yet been serviced?
   4948   1.96      fvdl 	 * Perhaps we should just refuse to be suspended if we
   4949   1.96      fvdl 	 * are acting in a target role.
   4950   1.96      fvdl 	 */
   4951   1.96      fvdl 	if (ahc->pending_device != NULL)
   4952   1.96      fvdl 		return (EBUSY);
   4953   1.42      fvdl #endif
   4954   1.96      fvdl 
   4955   1.96      fvdl 	/* Save volatile registers */
   4956   1.96      fvdl 	if ((ahc->features & AHC_TWIN) != 0) {
   4957   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, ahc_inb(ahc, SBLKCTL) | SELBUSB);
   4958   1.96      fvdl 		ahc->suspend_state.channel[1].scsiseq = ahc_inb(ahc, SCSISEQ);
   4959   1.96      fvdl 		ahc->suspend_state.channel[1].sxfrctl0 = ahc_inb(ahc, SXFRCTL0);
   4960   1.96      fvdl 		ahc->suspend_state.channel[1].sxfrctl1 = ahc_inb(ahc, SXFRCTL1);
   4961   1.96      fvdl 		ahc->suspend_state.channel[1].simode0 = ahc_inb(ahc, SIMODE0);
   4962   1.96      fvdl 		ahc->suspend_state.channel[1].simode1 = ahc_inb(ahc, SIMODE1);
   4963   1.96      fvdl 		ahc->suspend_state.channel[1].seltimer = ahc_inb(ahc, SELTIMER);
   4964   1.96      fvdl 		ahc->suspend_state.channel[1].seqctl = ahc_inb(ahc, SEQCTL);
   4965   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, ahc_inb(ahc, SBLKCTL) & ~SELBUSB);
   4966   1.96      fvdl 	}
   4967   1.96      fvdl 	ahc->suspend_state.channel[0].scsiseq = ahc_inb(ahc, SCSISEQ);
   4968   1.96      fvdl 	ahc->suspend_state.channel[0].sxfrctl0 = ahc_inb(ahc, SXFRCTL0);
   4969   1.96      fvdl 	ahc->suspend_state.channel[0].sxfrctl1 = ahc_inb(ahc, SXFRCTL1);
   4970   1.96      fvdl 	ahc->suspend_state.channel[0].simode0 = ahc_inb(ahc, SIMODE0);
   4971   1.96      fvdl 	ahc->suspend_state.channel[0].simode1 = ahc_inb(ahc, SIMODE1);
   4972   1.96      fvdl 	ahc->suspend_state.channel[0].seltimer = ahc_inb(ahc, SELTIMER);
   4973   1.96      fvdl 	ahc->suspend_state.channel[0].seqctl = ahc_inb(ahc, SEQCTL);
   4974   1.96      fvdl 
   4975   1.96      fvdl 	if ((ahc->chip & AHC_PCI) != 0) {
   4976   1.96      fvdl 		ahc->suspend_state.dscommand0 = ahc_inb(ahc, DSCOMMAND0);
   4977   1.96      fvdl 		ahc->suspend_state.dspcistatus = ahc_inb(ahc, DSPCISTATUS);
   4978   1.96      fvdl 	}
   4979   1.96      fvdl 
   4980   1.96      fvdl 	if ((ahc->features & AHC_DT) != 0) {
   4981   1.96      fvdl 		u_int sfunct;
   4982   1.96      fvdl 
   4983   1.96      fvdl 		sfunct = ahc_inb(ahc, SFUNCT) & ~ALT_MODE;
   4984   1.96      fvdl 		ahc_outb(ahc, SFUNCT, sfunct | ALT_MODE);
   4985   1.96      fvdl 		ahc->suspend_state.optionmode = ahc_inb(ahc, OPTIONMODE);
   4986   1.96      fvdl 		ahc_outb(ahc, SFUNCT, sfunct);
   4987   1.96      fvdl 		ahc->suspend_state.crccontrol1 = ahc_inb(ahc, CRCCONTROL1);
   4988   1.14     gibbs 	}
   4989    1.6   mycroft 
   4990   1.96      fvdl 	if ((ahc->features & AHC_MULTI_FUNC) != 0)
   4991   1.96      fvdl 		ahc->suspend_state.scbbaddr = ahc_inb(ahc, SCBBADDR);
   4992   1.96      fvdl 
   4993   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0)
   4994   1.96      fvdl 		ahc->suspend_state.dff_thrsh = ahc_inb(ahc, DFF_THRSH);
   4995   1.96      fvdl 
   4996   1.96      fvdl 	ptr = ahc->suspend_state.scratch_ram;
   4997   1.96      fvdl 	for (i = 0; i < 64; i++)
   4998   1.96      fvdl 		*ptr++ = ahc_inb(ahc, SRAM_BASE + i);
   4999   1.96      fvdl 
   5000   1.96      fvdl 	if ((ahc->features & AHC_MORE_SRAM) != 0) {
   5001   1.96      fvdl 		for (i = 0; i < 16; i++)
   5002   1.96      fvdl 			*ptr++ = ahc_inb(ahc, TARG_OFFSET + i);
   5003   1.42      fvdl 	}
   5004    1.1   mycroft 
   5005   1.96      fvdl 	ptr = ahc->suspend_state.btt;
   5006   1.96      fvdl 	if ((ahc->flags & AHC_SCB_BTT) != 0) {
   5007   1.96      fvdl 		for (i = 0;i < AHC_NUM_TARGETS; i++) {
   5008   1.96      fvdl 			int j;
   5009   1.96      fvdl 
   5010   1.96      fvdl 			for (j = 0;j < AHC_NUM_LUNS; j++) {
   5011   1.96      fvdl 				u_int tcl;
   5012    1.1   mycroft 
   5013   1.96      fvdl 				tcl = BUILD_TCL(i << 4, j);
   5014   1.96      fvdl 				*ptr = ahc_index_busy_tcl(ahc, tcl);
   5015   1.96      fvdl 			}
   5016   1.96      fvdl 		}
   5017   1.96      fvdl 	}
   5018   1.96      fvdl 	ahc_shutdown(ahc);
   5019   1.96      fvdl 	return (0);
   5020   1.42      fvdl }
   5021    1.1   mycroft 
   5022   1.96      fvdl int
   5023   1.96      fvdl ahc_resume(struct ahc_softc *ahc)
   5024   1.42      fvdl {
   5025   1.96      fvdl 	uint8_t *ptr;
   5026   1.96      fvdl 	int	 i;
   5027   1.96      fvdl 
   5028   1.96      fvdl 	ahc_reset(ahc);
   5029   1.96      fvdl 
   5030   1.96      fvdl 	ahc_build_free_scb_list(ahc);
   5031   1.96      fvdl 
   5032   1.96      fvdl 	/* Restore volatile registers */
   5033   1.96      fvdl 	if ((ahc->features & AHC_TWIN) != 0) {
   5034   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, ahc_inb(ahc, SBLKCTL) | SELBUSB);
   5035   1.96      fvdl 		ahc_outb(ahc, SCSIID, ahc->our_id);
   5036   1.96      fvdl 		ahc_outb(ahc, SCSISEQ, ahc->suspend_state.channel[1].scsiseq);
   5037   1.96      fvdl 		ahc_outb(ahc, SXFRCTL0, ahc->suspend_state.channel[1].sxfrctl0);
   5038   1.96      fvdl 		ahc_outb(ahc, SXFRCTL1, ahc->suspend_state.channel[1].sxfrctl1);
   5039   1.96      fvdl 		ahc_outb(ahc, SIMODE0, ahc->suspend_state.channel[1].simode0);
   5040   1.96      fvdl 		ahc_outb(ahc, SIMODE1, ahc->suspend_state.channel[1].simode1);
   5041   1.96      fvdl 		ahc_outb(ahc, SELTIMER, ahc->suspend_state.channel[1].seltimer);
   5042   1.96      fvdl 		ahc_outb(ahc, SEQCTL, ahc->suspend_state.channel[1].seqctl);
   5043   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, ahc_inb(ahc, SBLKCTL) & ~SELBUSB);
   5044   1.96      fvdl 	}
   5045   1.96      fvdl 	ahc_outb(ahc, SCSISEQ, ahc->suspend_state.channel[0].scsiseq);
   5046   1.96      fvdl 	ahc_outb(ahc, SXFRCTL0, ahc->suspend_state.channel[0].sxfrctl0);
   5047   1.96      fvdl 	ahc_outb(ahc, SXFRCTL1, ahc->suspend_state.channel[0].sxfrctl1);
   5048   1.96      fvdl 	ahc_outb(ahc, SIMODE0, ahc->suspend_state.channel[0].simode0);
   5049   1.96      fvdl 	ahc_outb(ahc, SIMODE1, ahc->suspend_state.channel[0].simode1);
   5050   1.96      fvdl 	ahc_outb(ahc, SELTIMER, ahc->suspend_state.channel[0].seltimer);
   5051   1.96      fvdl 	ahc_outb(ahc, SEQCTL, ahc->suspend_state.channel[0].seqctl);
   5052   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0)
   5053   1.96      fvdl 		ahc_outb(ahc, SCSIID_ULTRA2, ahc->our_id);
   5054   1.96      fvdl 	else
   5055   1.96      fvdl 		ahc_outb(ahc, SCSIID, ahc->our_id);
   5056   1.22       cgd 
   5057   1.96      fvdl 	if ((ahc->chip & AHC_PCI) != 0) {
   5058   1.96      fvdl 		ahc_outb(ahc, DSCOMMAND0, ahc->suspend_state.dscommand0);
   5059   1.96      fvdl 		ahc_outb(ahc, DSPCISTATUS, ahc->suspend_state.dspcistatus);
   5060   1.96      fvdl 	}
   5061    1.6   mycroft 
   5062   1.96      fvdl 	if ((ahc->features & AHC_DT) != 0) {
   5063   1.96      fvdl 		u_int sfunct;
   5064   1.42      fvdl 
   5065   1.96      fvdl 		sfunct = ahc_inb(ahc, SFUNCT) & ~ALT_MODE;
   5066   1.96      fvdl 		ahc_outb(ahc, SFUNCT, sfunct | ALT_MODE);
   5067   1.96      fvdl 		ahc_outb(ahc, OPTIONMODE, ahc->suspend_state.optionmode);
   5068   1.96      fvdl 		ahc_outb(ahc, SFUNCT, sfunct);
   5069   1.96      fvdl 		ahc_outb(ahc, CRCCONTROL1, ahc->suspend_state.crccontrol1);
   5070   1.96      fvdl 	}
   5071   1.42      fvdl 
   5072   1.96      fvdl 	if ((ahc->features & AHC_MULTI_FUNC) != 0)
   5073   1.96      fvdl 		ahc_outb(ahc, SCBBADDR, ahc->suspend_state.scbbaddr);
   5074   1.42      fvdl 
   5075   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0)
   5076   1.96      fvdl 		ahc_outb(ahc, DFF_THRSH, ahc->suspend_state.dff_thrsh);
   5077   1.42      fvdl 
   5078   1.96      fvdl 	ptr = ahc->suspend_state.scratch_ram;
   5079   1.96      fvdl 	for (i = 0; i < 64; i++)
   5080   1.96      fvdl 		ahc_outb(ahc, SRAM_BASE + i, *ptr++);
   5081   1.59        pk 
   5082   1.96      fvdl 	if ((ahc->features & AHC_MORE_SRAM) != 0) {
   5083   1.96      fvdl 		for (i = 0; i < 16; i++)
   5084   1.96      fvdl 			ahc_outb(ahc, TARG_OFFSET + i, *ptr++);
   5085    1.6   mycroft 	}
   5086   1.14     gibbs 
   5087   1.96      fvdl 	ptr = ahc->suspend_state.btt;
   5088   1.96      fvdl 	if ((ahc->flags & AHC_SCB_BTT) != 0) {
   5089   1.96      fvdl 		for (i = 0;i < AHC_NUM_TARGETS; i++) {
   5090   1.96      fvdl 			int j;
   5091   1.14     gibbs 
   5092   1.96      fvdl 			for (j = 0;j < AHC_NUM_LUNS; j++) {
   5093   1.96      fvdl 				u_int tcl;
   5094   1.59        pk 
   5095   1.96      fvdl 				tcl = BUILD_TCL(i << 4, j);
   5096   1.96      fvdl 				ahc_busy_tcl(ahc, tcl, *ptr);
   5097   1.96      fvdl 			}
   5098   1.96      fvdl 		}
   5099   1.96      fvdl 	}
   5100   1.96      fvdl 	return (0);
   5101    1.1   mycroft }
   5102    1.1   mycroft 
   5103   1.96      fvdl /************************** Busy Target Table *********************************/
   5104    1.1   mycroft /*
   5105   1.96      fvdl  * Return the untagged transaction id for a given target/channel lun.
   5106   1.96      fvdl  * Optionally, clear the entry.
   5107    1.1   mycroft  */
   5108   1.96      fvdl u_int
   5109   1.96      fvdl ahc_index_busy_tcl(struct ahc_softc *ahc, u_int tcl)
   5110    1.1   mycroft {
   5111   1.96      fvdl 	u_int scbid;
   5112   1.96      fvdl 	u_int target_offset;
   5113   1.96      fvdl 
   5114   1.96      fvdl 	if ((ahc->flags & AHC_SCB_BTT) != 0) {
   5115   1.96      fvdl 		u_int saved_scbptr;
   5116   1.96      fvdl 
   5117   1.96      fvdl 		saved_scbptr = ahc_inb(ahc, SCBPTR);
   5118   1.96      fvdl 		ahc_outb(ahc, SCBPTR, TCL_LUN(tcl));
   5119   1.96      fvdl 		scbid = ahc_inb(ahc, SCB_64_BTT + TCL_TARGET_OFFSET(tcl));
   5120   1.96      fvdl 		ahc_outb(ahc, SCBPTR, saved_scbptr);
   5121   1.96      fvdl 	} else {
   5122   1.96      fvdl 		target_offset = TCL_TARGET_OFFSET(tcl);
   5123   1.96      fvdl 		scbid = ahc_inb(ahc, BUSY_TARGETS + target_offset);
   5124   1.96      fvdl 	}
   5125   1.96      fvdl 
   5126   1.96      fvdl 	return (scbid);
   5127   1.96      fvdl }
   5128   1.59        pk 
   5129   1.96      fvdl void
   5130   1.96      fvdl ahc_unbusy_tcl(struct ahc_softc *ahc, u_int tcl)
   5131   1.96      fvdl {
   5132   1.96      fvdl 	u_int target_offset;
   5133   1.42      fvdl 
   5134   1.96      fvdl 	if ((ahc->flags & AHC_SCB_BTT) != 0) {
   5135   1.96      fvdl 		u_int saved_scbptr;
   5136   1.96      fvdl 
   5137   1.96      fvdl 		saved_scbptr = ahc_inb(ahc, SCBPTR);
   5138   1.96      fvdl 		ahc_outb(ahc, SCBPTR, TCL_LUN(tcl));
   5139   1.96      fvdl 		ahc_outb(ahc, SCB_64_BTT+TCL_TARGET_OFFSET(tcl), SCB_LIST_NULL);
   5140   1.96      fvdl 		ahc_outb(ahc, SCBPTR, saved_scbptr);
   5141   1.96      fvdl 	} else {
   5142   1.96      fvdl 		target_offset = TCL_TARGET_OFFSET(tcl);
   5143   1.96      fvdl 		ahc_outb(ahc, BUSY_TARGETS + target_offset, SCB_LIST_NULL);
   5144   1.96      fvdl 	}
   5145   1.96      fvdl }
   5146   1.42      fvdl 
   5147   1.96      fvdl void
   5148   1.96      fvdl ahc_busy_tcl(struct ahc_softc *ahc, u_int tcl, u_int scbid)
   5149   1.96      fvdl {
   5150   1.96      fvdl 	u_int target_offset;
   5151   1.42      fvdl 
   5152   1.96      fvdl 	if ((ahc->flags & AHC_SCB_BTT) != 0) {
   5153   1.96      fvdl 		u_int saved_scbptr;
   5154   1.96      fvdl 
   5155   1.96      fvdl 		saved_scbptr = ahc_inb(ahc, SCBPTR);
   5156   1.96      fvdl 		ahc_outb(ahc, SCBPTR, TCL_LUN(tcl));
   5157   1.96      fvdl 		ahc_outb(ahc, SCB_64_BTT + TCL_TARGET_OFFSET(tcl), scbid);
   5158   1.96      fvdl 		ahc_outb(ahc, SCBPTR, saved_scbptr);
   5159   1.96      fvdl 	} else {
   5160   1.96      fvdl 		target_offset = TCL_TARGET_OFFSET(tcl);
   5161   1.96      fvdl 		ahc_outb(ahc, BUSY_TARGETS + target_offset, scbid);
   5162   1.42      fvdl 	}
   5163   1.96      fvdl }
   5164    1.6   mycroft 
   5165   1.96      fvdl /************************** SCB and SCB queue management **********************/
   5166   1.96      fvdl int
   5167   1.96      fvdl ahc_match_scb(struct ahc_softc *ahc, struct scb *scb, int target,
   5168   1.96      fvdl 	      char channel, int lun, u_int tag, role_t role)
   5169   1.96      fvdl {
   5170   1.96      fvdl 	int targ = SCB_GET_TARGET(ahc, scb);
   5171   1.96      fvdl 	char chan = SCB_GET_CHANNEL(ahc, scb);
   5172   1.96      fvdl 	int slun = SCB_GET_LUN(scb);
   5173   1.96      fvdl 	int match;
   5174   1.28       leo 
   5175   1.96      fvdl 	match = ((chan == channel) || (channel == ALL_CHANNELS));
   5176   1.96      fvdl 	if (match != 0)
   5177   1.96      fvdl 		match = ((targ == target) || (target == CAM_TARGET_WILDCARD));
   5178   1.96      fvdl 	if (match != 0)
   5179   1.96      fvdl 		match = ((lun == slun) || (lun == CAM_LUN_WILDCARD));
   5180   1.96      fvdl 	if (match != 0) {
   5181   1.96      fvdl #if 0
   5182   1.96      fvdl #if AHC_TARGET_MODE
   5183   1.96      fvdl 		int group;
   5184   1.42      fvdl 
   5185   1.96      fvdl 		group = XPT_FC_GROUP(scb->io_ctx->ccb_h.func_code);
   5186   1.96      fvdl 		if (role == ROLE_INITIATOR) {
   5187   1.96      fvdl 			match = (group != XPT_FC_GROUP_TMODE)
   5188   1.96      fvdl 			      && ((tag == scb->hscb->tag)
   5189   1.96      fvdl 			       || (tag == SCB_LIST_NULL));
   5190   1.96      fvdl 		} else if (role == ROLE_TARGET) {
   5191   1.96      fvdl 			match = (group == XPT_FC_GROUP_TMODE)
   5192   1.96      fvdl 			      && ((tag == scb->io_ctx->csio.tag_id)
   5193   1.96      fvdl 			       || (tag == SCB_LIST_NULL));
   5194   1.96      fvdl 		}
   5195   1.96      fvdl #else /* !AHC_TARGET_MODE */
   5196   1.96      fvdl 		match = ((tag == scb->hscb->tag) || (tag == SCB_LIST_NULL));
   5197   1.96      fvdl #endif /* AHC_TARGET_MODE */
   5198   1.96      fvdl #endif
   5199   1.28       leo 	}
   5200   1.42      fvdl 
   5201   1.96      fvdl 	return match;
   5202   1.96      fvdl }
   5203   1.96      fvdl 
   5204   1.96      fvdl void
   5205   1.96      fvdl ahc_freeze_devq(struct ahc_softc *ahc, struct scb *scb)
   5206   1.96      fvdl {
   5207   1.96      fvdl 	int	target;
   5208   1.96      fvdl 	char	channel;
   5209   1.96      fvdl 	int	lun;
   5210   1.42      fvdl 
   5211   1.96      fvdl 	target = SCB_GET_TARGET(ahc, scb);
   5212   1.96      fvdl 	lun = SCB_GET_LUN(scb);
   5213   1.96      fvdl 	channel = SCB_GET_CHANNEL(ahc, scb);
   5214   1.96      fvdl 
   5215   1.96      fvdl 	ahc_search_qinfifo(ahc, target, channel, lun,
   5216   1.96      fvdl 			   /*tag*/SCB_LIST_NULL, ROLE_UNKNOWN,
   5217   1.96      fvdl 			   CAM_REQUEUE_REQ, SEARCH_COMPLETE);
   5218   1.42      fvdl 
   5219   1.96      fvdl 	ahc_platform_freeze_devq(ahc, scb);
   5220   1.96      fvdl }
   5221   1.42      fvdl 
   5222   1.96      fvdl void
   5223   1.96      fvdl ahc_qinfifo_requeue_tail(struct ahc_softc *ahc, struct scb *scb)
   5224   1.96      fvdl {
   5225   1.96      fvdl 	struct scb *prev_scb;
   5226   1.42      fvdl 
   5227   1.96      fvdl 	prev_scb = NULL;
   5228   1.96      fvdl 	if (ahc_qinfifo_count(ahc) != 0) {
   5229   1.96      fvdl 		u_int prev_tag;
   5230   1.96      fvdl 		uint8_t prev_pos;
   5231   1.42      fvdl 
   5232   1.96      fvdl 		prev_pos = ahc->qinfifonext - 1;
   5233   1.96      fvdl 		prev_tag = ahc->qinfifo[prev_pos];
   5234   1.96      fvdl 		prev_scb = ahc_lookup_scb(ahc, prev_tag);
   5235   1.42      fvdl 	}
   5236   1.96      fvdl 	ahc_qinfifo_requeue(ahc, prev_scb, scb);
   5237   1.96      fvdl 	if ((ahc->features & AHC_QUEUE_REGS) != 0) {
   5238   1.96      fvdl 		ahc_outb(ahc, HNSCB_QOFF, ahc->qinfifonext);
   5239   1.96      fvdl 	} else {
   5240   1.96      fvdl 		ahc_outb(ahc, KERNEL_QINPOS, ahc->qinfifonext);
   5241    1.1   mycroft 	}
   5242   1.96      fvdl }
   5243   1.42      fvdl 
   5244   1.96      fvdl static void
   5245   1.96      fvdl ahc_qinfifo_requeue(struct ahc_softc *ahc, struct scb *prev_scb,
   5246   1.96      fvdl 		    struct scb *scb)
   5247   1.96      fvdl {
   5248   1.96      fvdl 	if (prev_scb == NULL) {
   5249   1.96      fvdl 		ahc_outb(ahc, NEXT_QUEUED_SCB, scb->hscb->tag);
   5250   1.96      fvdl 	} else {
   5251   1.96      fvdl 		prev_scb->hscb->next = scb->hscb->tag;
   5252   1.96      fvdl 		ahc_sync_scb(ahc, prev_scb,
   5253   1.96      fvdl 			     BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   5254   1.96      fvdl 	}
   5255   1.96      fvdl 	ahc->qinfifo[ahc->qinfifonext++] = scb->hscb->tag;
   5256   1.96      fvdl 	scb->hscb->next = ahc->next_queued_scb->hscb->tag;
   5257   1.96      fvdl 	ahc_sync_scb(ahc, scb, BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   5258   1.42      fvdl }
   5259   1.42      fvdl 
   5260   1.96      fvdl static int
   5261   1.96      fvdl ahc_qinfifo_count(struct ahc_softc *ahc)
   5262   1.96      fvdl {
   5263   1.96      fvdl 	uint8_t qinpos;
   5264   1.96      fvdl 	uint8_t diff;
   5265   1.42      fvdl 
   5266   1.96      fvdl 	if ((ahc->features & AHC_QUEUE_REGS) != 0) {
   5267   1.96      fvdl 		qinpos = ahc_inb(ahc, SNSCB_QOFF);
   5268   1.96      fvdl 		ahc_outb(ahc, SNSCB_QOFF, qinpos);
   5269   1.96      fvdl 	} else
   5270   1.96      fvdl 		qinpos = ahc_inb(ahc, QINPOS);
   5271   1.96      fvdl 	diff = ahc->qinfifonext - qinpos;
   5272   1.96      fvdl 	return (diff);
   5273    1.1   mycroft }
   5274    1.1   mycroft 
   5275    1.1   mycroft int
   5276   1.96      fvdl ahc_search_qinfifo(struct ahc_softc *ahc, int target, char channel,
   5277   1.96      fvdl 		   int lun, u_int tag, role_t role, uint32_t status,
   5278   1.96      fvdl 		   ahc_search_action action)
   5279    1.1   mycroft {
   5280   1.96      fvdl 	struct	scb *scb;
   5281   1.96      fvdl 	struct	scb *prev_scb;
   5282   1.96      fvdl 	uint8_t qinstart;
   5283   1.96      fvdl 	uint8_t qinpos;
   5284   1.96      fvdl 	uint8_t qintail;
   5285   1.96      fvdl 	uint8_t next;
   5286   1.96      fvdl 	uint8_t prev;
   5287   1.96      fvdl 	uint8_t curscbptr;
   5288   1.96      fvdl 	int	found;
   5289   1.96      fvdl 	int	have_qregs;
   5290   1.96      fvdl 
   5291   1.96      fvdl 	qintail = ahc->qinfifonext;
   5292   1.96      fvdl 	have_qregs = (ahc->features & AHC_QUEUE_REGS) != 0;
   5293   1.96      fvdl 	if (have_qregs) {
   5294   1.96      fvdl 		qinstart = ahc_inb(ahc, SNSCB_QOFF);
   5295   1.96      fvdl 		ahc_outb(ahc, SNSCB_QOFF, qinstart);
   5296   1.96      fvdl 	} else
   5297   1.96      fvdl 		qinstart = ahc_inb(ahc, QINPOS);
   5298   1.96      fvdl 	qinpos = qinstart;
   5299   1.96      fvdl 	found = 0;
   5300   1.96      fvdl 	prev_scb = NULL;
   5301   1.42      fvdl 
   5302   1.96      fvdl 	if (action == SEARCH_COMPLETE) {
   5303   1.96      fvdl 		/*
   5304   1.96      fvdl 		 * Don't attempt to run any queued untagged transactions
   5305   1.96      fvdl 		 * until we are done with the abort process.
   5306   1.96      fvdl 		 */
   5307   1.96      fvdl 		ahc_freeze_untagged_queues(ahc);
   5308   1.42      fvdl 	}
   5309   1.28       leo 
   5310    1.1   mycroft 	/*
   5311   1.96      fvdl 	 * Start with an empty queue.  Entries that are not chosen
   5312   1.96      fvdl 	 * for removal will be re-added to the queue as we go.
   5313    1.1   mycroft 	 */
   5314   1.96      fvdl 	ahc->qinfifonext = qinpos;
   5315   1.96      fvdl 	ahc_outb(ahc, NEXT_QUEUED_SCB, ahc->next_queued_scb->hscb->tag);
   5316   1.59        pk 
   5317   1.96      fvdl 	while (qinpos != qintail) {
   5318   1.96      fvdl 		scb = ahc_lookup_scb(ahc, ahc->qinfifo[qinpos]);
   5319   1.96      fvdl 		if (scb == NULL) {
   5320   1.96      fvdl 			printf("qinpos = %d, SCB index = %d\n",
   5321   1.96      fvdl 				qinpos, ahc->qinfifo[qinpos]);
   5322   1.96      fvdl 			panic("Loop 1\n");
   5323   1.96      fvdl 		}
   5324    1.1   mycroft 
   5325   1.96      fvdl 		if (ahc_match_scb(ahc, scb, target, channel, lun, tag, role)) {
   5326   1.96      fvdl 			/*
   5327   1.96      fvdl 			 * We found an scb that needs to be acted on.
   5328   1.96      fvdl 			 */
   5329   1.96      fvdl 			found++;
   5330   1.96      fvdl 			switch (action) {
   5331   1.96      fvdl 			case SEARCH_COMPLETE:
   5332   1.96      fvdl 			{
   5333   1.96      fvdl 				cam_status ostat;
   5334   1.96      fvdl 				cam_status cstat;
   5335    1.6   mycroft 
   5336   1.96      fvdl 				ostat = ahc_get_transaction_status(scb);
   5337   1.96      fvdl 				if (ostat == CAM_REQ_INPROG)
   5338   1.96      fvdl 					ahc_set_transaction_status(scb, status);
   5339   1.96      fvdl 				cstat = ahc_get_transaction_status(scb);
   5340   1.96      fvdl 				if (cstat != CAM_REQ_CMP)
   5341   1.96      fvdl 					ahc_freeze_scb(scb);
   5342   1.96      fvdl 				if ((scb->flags & SCB_ACTIVE) == 0)
   5343   1.96      fvdl 					printf("Inactive SCB in qinfifo\n");
   5344   1.96      fvdl 				ahc_done(ahc, scb);
   5345    1.1   mycroft 
   5346   1.96      fvdl 				/* FALLTHROUGH */
   5347   1.96      fvdl 			}
   5348   1.96      fvdl 			case SEARCH_REMOVE:
   5349   1.96      fvdl 				break;
   5350   1.96      fvdl 			case SEARCH_COUNT:
   5351   1.96      fvdl 				ahc_qinfifo_requeue(ahc, prev_scb, scb);
   5352   1.96      fvdl 				prev_scb = scb;
   5353   1.96      fvdl 				break;
   5354   1.96      fvdl 			}
   5355   1.96      fvdl 		} else {
   5356   1.96      fvdl 			ahc_qinfifo_requeue(ahc, prev_scb, scb);
   5357   1.96      fvdl 			prev_scb = scb;
   5358   1.96      fvdl 		}
   5359   1.96      fvdl 		qinpos++;
   5360   1.96      fvdl 	}
   5361    1.1   mycroft 
   5362   1.96      fvdl 	if ((ahc->features & AHC_QUEUE_REGS) != 0) {
   5363   1.96      fvdl 		ahc_outb(ahc, HNSCB_QOFF, ahc->qinfifonext);
   5364   1.96      fvdl 	} else {
   5365   1.96      fvdl 		ahc_outb(ahc, KERNEL_QINPOS, ahc->qinfifonext);
   5366   1.96      fvdl 	}
   5367    1.1   mycroft 
   5368   1.96      fvdl 	if (action != SEARCH_COUNT
   5369   1.96      fvdl 	 && (found != 0)
   5370   1.96      fvdl 	 && (qinstart != ahc->qinfifonext)) {
   5371   1.96      fvdl 		/*
   5372   1.96      fvdl 		 * The sequencer may be in the process of dmaing
   5373   1.96      fvdl 		 * down the SCB at the beginning of the queue.
   5374   1.96      fvdl 		 * This could be problematic if either the first,
   5375   1.96      fvdl 		 * or the second SCB is removed from the queue
   5376   1.96      fvdl 		 * (the first SCB includes a pointer to the "next"
   5377   1.96      fvdl 		 * SCB to dma). If we have removed any entries, swap
   5378   1.96      fvdl 		 * the first element in the queue with the next HSCB
   5379   1.96      fvdl 		 * so the sequencer will notice that NEXT_QUEUED_SCB
   5380   1.96      fvdl 		 * has changed during its dma attempt and will retry
   5381   1.96      fvdl 		 * the DMA.
   5382   1.96      fvdl 		 */
   5383   1.96      fvdl 		scb = ahc_lookup_scb(ahc, ahc->qinfifo[qinstart]);
   5384    1.6   mycroft 
   5385   1.96      fvdl 		if (scb == NULL) {
   5386   1.96      fvdl 			printf("found = %d, qinstart = %d, qinfifionext = %d\n",
   5387   1.96      fvdl 				found, qinstart, ahc->qinfifonext);
   5388   1.96      fvdl 			panic("First/Second Qinfifo fixup\n");
   5389   1.96      fvdl 		}
   5390   1.96      fvdl 		/*
   5391   1.96      fvdl 		 * ahc_swap_with_next_hscb forces our next pointer to
   5392   1.96      fvdl 		 * point to the reserved SCB for future commands.  Save
   5393   1.96      fvdl 		 * and restore our original next pointer to maintain
   5394   1.96      fvdl 		 * queue integrity.
   5395   1.96      fvdl 		 */
   5396   1.96      fvdl 		next = scb->hscb->next;
   5397   1.96      fvdl 		ahc->scb_data->scbindex[scb->hscb->tag] = NULL;
   5398   1.96      fvdl 		ahc_swap_with_next_hscb(ahc, scb);
   5399   1.96      fvdl 		scb->hscb->next = next;
   5400   1.96      fvdl 		ahc->qinfifo[qinstart] = scb->hscb->tag;
   5401   1.96      fvdl 
   5402   1.96      fvdl 		/* Tell the card about the new head of the qinfifo. */
   5403   1.96      fvdl 		ahc_outb(ahc, NEXT_QUEUED_SCB, scb->hscb->tag);
   5404   1.96      fvdl 
   5405   1.96      fvdl 		/* Fixup the tail "next" pointer. */
   5406   1.96      fvdl 		qintail = ahc->qinfifonext - 1;
   5407   1.96      fvdl 		scb = ahc_lookup_scb(ahc, ahc->qinfifo[qintail]);
   5408   1.96      fvdl 		scb->hscb->next = ahc->next_queued_scb->hscb->tag;
   5409   1.96      fvdl 	}
   5410    1.6   mycroft 
   5411   1.28       leo 	/*
   5412   1.96      fvdl 	 * Search waiting for selection list.
   5413   1.28       leo 	 */
   5414   1.96      fvdl 	curscbptr = ahc_inb(ahc, SCBPTR);
   5415   1.96      fvdl 	next = ahc_inb(ahc, WAITING_SCBH);  /* Start at head of list. */
   5416   1.96      fvdl 	prev = SCB_LIST_NULL;
   5417   1.96      fvdl 
   5418   1.96      fvdl 	while (next != SCB_LIST_NULL) {
   5419   1.96      fvdl 		uint8_t scb_index;
   5420   1.42      fvdl 
   5421   1.96      fvdl 		ahc_outb(ahc, SCBPTR, next);
   5422   1.96      fvdl 		scb_index = ahc_inb(ahc, SCB_TAG);
   5423   1.96      fvdl 		if (scb_index >= ahc->scb_data->numscbs) {
   5424   1.96      fvdl 			printf("Waiting List inconsistency. "
   5425   1.96      fvdl 			       "SCB index == %d, yet numscbs == %d.",
   5426   1.96      fvdl 			       scb_index, ahc->scb_data->numscbs);
   5427   1.96      fvdl 			ahc_dump_card_state(ahc);
   5428   1.96      fvdl 			panic("for safety");
   5429   1.96      fvdl 		}
   5430   1.96      fvdl 		scb = ahc_lookup_scb(ahc, scb_index);
   5431   1.96      fvdl 		if (scb == NULL) {
   5432   1.96      fvdl 			printf("scb_index = %d, next = %d\n",
   5433   1.96      fvdl 				scb_index, next);
   5434   1.96      fvdl 			panic("Waiting List traversal\n");
   5435   1.42      fvdl 		}
   5436   1.96      fvdl 		if (ahc_match_scb(ahc, scb, target, channel,
   5437   1.96      fvdl 				  lun, SCB_LIST_NULL, role)) {
   5438   1.96      fvdl 			/*
   5439   1.96      fvdl 			 * We found an scb that needs to be acted on.
   5440   1.96      fvdl 			 */
   5441   1.96      fvdl 			found++;
   5442   1.96      fvdl 			switch (action) {
   5443   1.96      fvdl 			case SEARCH_COMPLETE:
   5444   1.96      fvdl 			{
   5445   1.96      fvdl 				cam_status ostat;
   5446   1.96      fvdl 				cam_status cstat;
   5447   1.96      fvdl 
   5448   1.96      fvdl 				ostat = ahc_get_transaction_status(scb);
   5449   1.96      fvdl 				if (ostat == CAM_REQ_INPROG)
   5450   1.96      fvdl 					ahc_set_transaction_status(scb, status);
   5451   1.96      fvdl 				cstat = ahc_get_transaction_status(scb);
   5452   1.96      fvdl 				if (cstat != CAM_REQ_CMP)
   5453   1.96      fvdl 					ahc_freeze_scb(scb);
   5454   1.96      fvdl 				if ((scb->flags & SCB_ACTIVE) == 0)
   5455   1.96      fvdl 					printf("Inactive SCB in Waiting List\n");
   5456   1.96      fvdl 				ahc_done(ahc, scb);
   5457   1.96      fvdl 				/* FALLTHROUGH */
   5458   1.96      fvdl 			}
   5459   1.96      fvdl 			case SEARCH_REMOVE:
   5460   1.96      fvdl 				next = ahc_rem_wscb(ahc, next, prev);
   5461   1.96      fvdl 				break;
   5462   1.96      fvdl 			case SEARCH_COUNT:
   5463   1.96      fvdl 				prev = next;
   5464   1.96      fvdl 				next = ahc_inb(ahc, SCB_NEXT);
   5465   1.96      fvdl 				break;
   5466   1.96      fvdl 			}
   5467   1.42      fvdl 		} else {
   5468   1.96      fvdl 
   5469   1.96      fvdl 			prev = next;
   5470   1.96      fvdl 			next = ahc_inb(ahc, SCB_NEXT);
   5471   1.42      fvdl 		}
   5472   1.28       leo 	}
   5473   1.96      fvdl 	ahc_outb(ahc, SCBPTR, curscbptr);
   5474   1.42      fvdl 
   5475   1.96      fvdl 	found += ahc_search_untagged_queues(ahc, /*ahc_io_ctx_t*/NULL, target,
   5476   1.96      fvdl 					    channel, lun, status, action);
   5477   1.42      fvdl 
   5478   1.96      fvdl 	if (action == SEARCH_COMPLETE)
   5479   1.96      fvdl 		ahc_release_untagged_queues(ahc);
   5480   1.96      fvdl 	return (found);
   5481   1.96      fvdl }
   5482    1.6   mycroft 
   5483   1.96      fvdl int
   5484   1.96      fvdl ahc_search_untagged_queues(struct ahc_softc *ahc, struct scsipi_xfer *xs, /*ahc_io_ctx_t ctx,*/
   5485   1.96      fvdl 			   int target, char channel, int lun, uint32_t status,
   5486   1.96      fvdl 			   ahc_search_action action)
   5487   1.96      fvdl {
   5488   1.96      fvdl 	struct	scb *scb;
   5489   1.96      fvdl 	int	maxtarget;
   5490   1.96      fvdl 	int	found;
   5491   1.96      fvdl 	int	i;
   5492   1.42      fvdl 
   5493   1.96      fvdl 	if (action == SEARCH_COMPLETE) {
   5494    1.1   mycroft 		/*
   5495   1.96      fvdl 		 * Don't attempt to run any queued untagged transactions
   5496   1.96      fvdl 		 * until we are done with the abort process.
   5497    1.1   mycroft 		 */
   5498   1.96      fvdl 		ahc_freeze_untagged_queues(ahc);
   5499    1.6   mycroft 	}
   5500   1.42      fvdl 
   5501   1.96      fvdl 	found = 0;
   5502   1.96      fvdl 	i = 0;
   5503   1.96      fvdl 	if ((ahc->flags & AHC_SCB_BTT) == 0) {
   5504    1.6   mycroft 
   5505   1.96      fvdl 		maxtarget = 16;
   5506   1.96      fvdl 		if (target != CAM_TARGET_WILDCARD) {
   5507    1.1   mycroft 
   5508   1.96      fvdl 			i = target;
   5509   1.96      fvdl 			if (channel == 'B')
   5510   1.96      fvdl 				i += 8;
   5511   1.96      fvdl 			maxtarget = i + 1;
   5512   1.96      fvdl 		}
   5513   1.42      fvdl 	} else {
   5514   1.96      fvdl 		maxtarget = 0;
   5515    1.6   mycroft 	}
   5516    1.6   mycroft 
   5517   1.96      fvdl 	for (; i < maxtarget; i++) {
   5518   1.96      fvdl 		struct scb_tailq *untagged_q;
   5519   1.96      fvdl 		struct scb *next_scb;
   5520    1.6   mycroft 
   5521   1.96      fvdl 		untagged_q = &(ahc->untagged_queues[i]);
   5522   1.96      fvdl 		next_scb = TAILQ_FIRST(untagged_q);
   5523   1.96      fvdl 		while (next_scb != NULL) {
   5524   1.42      fvdl 
   5525   1.96      fvdl 			scb = next_scb;
   5526   1.96      fvdl 			next_scb = TAILQ_NEXT(scb, links.tqe);
   5527   1.42      fvdl 
   5528   1.42      fvdl 			/*
   5529   1.96      fvdl 			 * The head of the list may be the currently
   5530   1.96      fvdl 			 * active untagged command for a device.
   5531   1.96      fvdl 			 * We're only searching for commands that
   5532   1.96      fvdl 			 * have not been started.  A transaction
   5533   1.96      fvdl 			 * marked active but still in the qinfifo
   5534   1.96      fvdl 			 * is removed by the qinfifo scanning code
   5535   1.96      fvdl 			 * above.
   5536   1.42      fvdl 			 */
   5537   1.96      fvdl 			if ((scb->flags & SCB_ACTIVE) != 0)
   5538   1.96      fvdl 				continue;
   5539   1.96      fvdl 
   5540   1.96      fvdl 			if (ahc_match_scb(ahc, scb, target, channel, lun,
   5541   1.96      fvdl 					  SCB_LIST_NULL, ROLE_INITIATOR) == 0
   5542   1.96      fvdl 			    /*|| (ctx != NULL && ctx != scb->io_ctx)*/)
   5543   1.96      fvdl 				continue;
   5544   1.42      fvdl 
   5545   1.96      fvdl 			/*
   5546   1.96      fvdl 			 * We found an scb that needs to be acted on.
   5547   1.96      fvdl 			 */
   5548   1.96      fvdl 			found++;
   5549   1.96      fvdl 			switch (action) {
   5550   1.96      fvdl 			case SEARCH_COMPLETE:
   5551   1.96      fvdl 			{
   5552   1.96      fvdl 				cam_status ostat;
   5553   1.96      fvdl 				cam_status cstat;
   5554    1.6   mycroft 
   5555   1.96      fvdl 				ostat = ahc_get_transaction_status(scb);
   5556   1.96      fvdl 				if (ostat == CAM_REQ_INPROG)
   5557   1.96      fvdl 					ahc_set_transaction_status(scb, status);
   5558   1.96      fvdl 				cstat = ahc_get_transaction_status(scb);
   5559   1.96      fvdl 				if (cstat != CAM_REQ_CMP)
   5560   1.96      fvdl 					ahc_freeze_scb(scb);
   5561   1.96      fvdl 				if ((scb->flags & SCB_ACTIVE) == 0)
   5562   1.96      fvdl 					printf("Inactive SCB in untaggedQ\n");
   5563   1.96      fvdl 				ahc_done(ahc, scb);
   5564   1.96      fvdl 				break;
   5565   1.96      fvdl 			}
   5566   1.96      fvdl 			case SEARCH_REMOVE:
   5567   1.96      fvdl 				scb->flags &= ~SCB_UNTAGGEDQ;
   5568   1.96      fvdl 				TAILQ_REMOVE(untagged_q, scb, links.tqe);
   5569   1.96      fvdl 				break;
   5570   1.96      fvdl 			case SEARCH_COUNT:
   5571   1.96      fvdl 				break;
   5572    1.6   mycroft 			}
   5573   1.42      fvdl 		}
   5574   1.42      fvdl 	}
   5575   1.42      fvdl 
   5576   1.96      fvdl 	if (action == SEARCH_COMPLETE)
   5577   1.96      fvdl 		ahc_release_untagged_queues(ahc);
   5578   1.96      fvdl 	return (found);
   5579   1.96      fvdl }
   5580   1.42      fvdl 
   5581   1.96      fvdl int
   5582   1.96      fvdl ahc_search_disc_list(struct ahc_softc *ahc, int target, char channel,
   5583   1.96      fvdl 		     int lun, u_int tag, int stop_on_first, int remove,
   5584   1.96      fvdl 		     int save_state)
   5585   1.96      fvdl {
   5586   1.96      fvdl 	struct	scb *scbp;
   5587   1.96      fvdl 	u_int	next;
   5588   1.96      fvdl 	u_int	prev;
   5589   1.96      fvdl 	u_int	count;
   5590   1.96      fvdl 	u_int	active_scb;
   5591   1.42      fvdl 
   5592   1.96      fvdl 	count = 0;
   5593   1.96      fvdl 	next = ahc_inb(ahc, DISCONNECTED_SCBH);
   5594   1.96      fvdl 	prev = SCB_LIST_NULL;
   5595   1.59        pk 
   5596   1.96      fvdl 	if (save_state) {
   5597   1.96      fvdl 		/* restore this when we're done */
   5598   1.96      fvdl 		active_scb = ahc_inb(ahc, SCBPTR);
   5599   1.96      fvdl 	} else
   5600   1.96      fvdl 		/* Silence compiler */
   5601   1.96      fvdl 		active_scb = SCB_LIST_NULL;
   5602    1.9  explorer 
   5603   1.96      fvdl 	while (next != SCB_LIST_NULL) {
   5604   1.96      fvdl 		u_int scb_index;
   5605    1.1   mycroft 
   5606   1.96      fvdl 		ahc_outb(ahc, SCBPTR, next);
   5607   1.96      fvdl 		scb_index = ahc_inb(ahc, SCB_TAG);
   5608   1.96      fvdl 		if (scb_index >= ahc->scb_data->numscbs) {
   5609   1.96      fvdl 			printf("Disconnected List inconsistency. "
   5610   1.96      fvdl 			       "SCB index == %d, yet numscbs == %d.",
   5611   1.96      fvdl 			       scb_index, ahc->scb_data->numscbs);
   5612   1.96      fvdl 			ahc_dump_card_state(ahc);
   5613   1.96      fvdl 			panic("for safety");
   5614   1.96      fvdl 		}
   5615    1.1   mycroft 
   5616   1.96      fvdl 		if (next == prev) {
   5617   1.96      fvdl 			panic("Disconnected List Loop. "
   5618   1.96      fvdl 			      "cur SCBPTR == %x, prev SCBPTR == %x.",
   5619   1.96      fvdl 			      next, prev);
   5620   1.96      fvdl 		}
   5621   1.96      fvdl 		scbp = ahc_lookup_scb(ahc, scb_index);
   5622   1.96      fvdl 		if (ahc_match_scb(ahc, scbp, target, channel, lun,
   5623   1.96      fvdl 				  tag, ROLE_INITIATOR)) {
   5624   1.96      fvdl 			count++;
   5625   1.96      fvdl 			if (remove) {
   5626   1.96      fvdl 				next =
   5627   1.96      fvdl 				    ahc_rem_scb_from_disc_list(ahc, prev, next);
   5628   1.96      fvdl 			} else {
   5629   1.96      fvdl 				prev = next;
   5630   1.96      fvdl 				next = ahc_inb(ahc, SCB_NEXT);
   5631   1.96      fvdl 			}
   5632   1.96      fvdl 			if (stop_on_first)
   5633   1.96      fvdl 				break;
   5634   1.96      fvdl 		} else {
   5635   1.96      fvdl 			prev = next;
   5636   1.96      fvdl 			next = ahc_inb(ahc, SCB_NEXT);
   5637   1.96      fvdl 		}
   5638   1.42      fvdl 	}
   5639   1.96      fvdl 	if (save_state)
   5640   1.96      fvdl 		ahc_outb(ahc, SCBPTR, active_scb);
   5641   1.96      fvdl 	return (count);
   5642   1.96      fvdl }
   5643    1.1   mycroft 
   5644   1.96      fvdl /*
   5645   1.96      fvdl  * Remove an SCB from the on chip list of disconnected transactions.
   5646   1.96      fvdl  * This is empty/unused if we are not performing SCB paging.
   5647   1.96      fvdl  */
   5648   1.96      fvdl static u_int
   5649   1.96      fvdl ahc_rem_scb_from_disc_list(struct ahc_softc *ahc, u_int prev, u_int scbptr)
   5650   1.96      fvdl {
   5651   1.96      fvdl 	u_int next;
   5652   1.96      fvdl 
   5653   1.96      fvdl 	ahc_outb(ahc, SCBPTR, scbptr);
   5654   1.96      fvdl 	next = ahc_inb(ahc, SCB_NEXT);
   5655   1.96      fvdl 
   5656   1.96      fvdl 	ahc_outb(ahc, SCB_CONTROL, 0);
   5657    1.6   mycroft 
   5658   1.96      fvdl 	ahc_add_curscb_to_free_list(ahc);
   5659    1.6   mycroft 
   5660   1.96      fvdl 	if (prev != SCB_LIST_NULL) {
   5661   1.96      fvdl 		ahc_outb(ahc, SCBPTR, prev);
   5662   1.96      fvdl 		ahc_outb(ahc, SCB_NEXT, next);
   5663   1.96      fvdl 	} else
   5664   1.96      fvdl 		ahc_outb(ahc, DISCONNECTED_SCBH, next);
   5665    1.6   mycroft 
   5666   1.96      fvdl 	return (next);
   5667   1.96      fvdl }
   5668   1.42      fvdl 
   5669   1.96      fvdl /*
   5670   1.96      fvdl  * Add the SCB as selected by SCBPTR onto the on chip list of
   5671   1.96      fvdl  * free hardware SCBs.  This list is empty/unused if we are not
   5672   1.96      fvdl  * performing SCB paging.
   5673   1.96      fvdl  */
   5674   1.96      fvdl static void
   5675   1.96      fvdl ahc_add_curscb_to_free_list(struct ahc_softc *ahc)
   5676   1.96      fvdl {
   5677   1.42      fvdl 	/*
   5678   1.96      fvdl 	 * Invalidate the tag so that our abort
   5679   1.96      fvdl 	 * routines don't think it's active.
   5680   1.42      fvdl 	 */
   5681   1.96      fvdl 	ahc_outb(ahc, SCB_TAG, SCB_LIST_NULL);
   5682   1.96      fvdl 
   5683   1.96      fvdl 	if ((ahc->flags & AHC_PAGESCBS) != 0) {
   5684   1.96      fvdl 		ahc_outb(ahc, SCB_NEXT, ahc_inb(ahc, FREE_SCBH));
   5685   1.96      fvdl 		ahc_outb(ahc, FREE_SCBH, ahc_inb(ahc, SCBPTR));
   5686   1.96      fvdl 	}
   5687   1.96      fvdl }
   5688   1.96      fvdl 
   5689   1.96      fvdl /*
   5690   1.96      fvdl  * Manipulate the waiting for selection list and return the
   5691   1.96      fvdl  * scb that follows the one that we remove.
   5692   1.96      fvdl  */
   5693   1.96      fvdl static u_int
   5694   1.96      fvdl ahc_rem_wscb(struct ahc_softc *ahc, u_int scbpos, u_int prev)
   5695   1.96      fvdl {
   5696   1.96      fvdl 	u_int curscb, next;
   5697    1.6   mycroft 
   5698    1.6   mycroft 	/*
   5699   1.96      fvdl 	 * Select the SCB we want to abort and
   5700   1.96      fvdl 	 * pull the next pointer out of it.
   5701   1.96      fvdl 	 */
   5702   1.96      fvdl 	curscb = ahc_inb(ahc, SCBPTR);
   5703   1.96      fvdl 	ahc_outb(ahc, SCBPTR, scbpos);
   5704   1.96      fvdl 	next = ahc_inb(ahc, SCB_NEXT);
   5705    1.6   mycroft 
   5706   1.96      fvdl 	/* Clear the necessary fields */
   5707   1.96      fvdl 	ahc_outb(ahc, SCB_CONTROL, 0);
   5708    1.6   mycroft 
   5709   1.96      fvdl 	ahc_add_curscb_to_free_list(ahc);
   5710    1.1   mycroft 
   5711   1.96      fvdl 	/* update the waiting list */
   5712   1.96      fvdl 	if (prev == SCB_LIST_NULL) {
   5713   1.96      fvdl 		/* First in the list */
   5714   1.96      fvdl 		ahc_outb(ahc, WAITING_SCBH, next);
   5715   1.52      fvdl 
   5716   1.96      fvdl 		/*
   5717   1.96      fvdl 		 * Ensure we aren't attempting to perform
   5718   1.96      fvdl 		 * selection for this entry.
   5719   1.96      fvdl 		 */
   5720   1.96      fvdl 		ahc_outb(ahc, SCSISEQ, (ahc_inb(ahc, SCSISEQ) & ~ENSELO));
   5721   1.96      fvdl 	} else {
   5722   1.96      fvdl 		/*
   5723   1.96      fvdl 		 * Select the scb that pointed to us
   5724   1.96      fvdl 		 * and update its next pointer.
   5725   1.96      fvdl 		 */
   5726   1.96      fvdl 		ahc_outb(ahc, SCBPTR, prev);
   5727   1.96      fvdl 		ahc_outb(ahc, SCB_NEXT, next);
   5728   1.52      fvdl 	}
   5729   1.52      fvdl 
   5730   1.96      fvdl 	/*
   5731   1.96      fvdl 	 * Point us back at the original scb position.
   5732   1.96      fvdl 	 */
   5733   1.96      fvdl 	ahc_outb(ahc, SCBPTR, curscb);
   5734   1.96      fvdl 	return next;
   5735   1.52      fvdl }
   5736   1.52      fvdl 
   5737   1.96      fvdl /******************************** Error Handling ******************************/
   5738    1.1   mycroft /*
   5739   1.96      fvdl  * Abort all SCBs that match the given description (target/channel/lun/tag),
   5740   1.96      fvdl  * setting their status to the passed in status if the status has not already
   5741   1.96      fvdl  * been modified from CAM_REQ_INPROG.  This routine assumes that the sequencer
   5742   1.96      fvdl  * is paused before it is called.
   5743    1.1   mycroft  */
   5744   1.96      fvdl int
   5745   1.96      fvdl ahc_abort_scbs(struct ahc_softc *ahc, int target, char channel,
   5746   1.96      fvdl 	       int lun, u_int tag, role_t role, uint32_t status)
   5747    1.1   mycroft {
   5748   1.96      fvdl 	struct	scb *scbp;
   5749   1.96      fvdl 	struct	scb *scbp_next;
   5750   1.96      fvdl 	u_int	active_scb;
   5751   1.96      fvdl 	int	i, j;
   5752   1.96      fvdl 	int	maxtarget;
   5753   1.96      fvdl 	int	minlun;
   5754   1.96      fvdl 	int	maxlun;
   5755   1.42      fvdl 
   5756   1.96      fvdl 	int	found;
   5757   1.18   thorpej 
   5758   1.96      fvdl 	/*
   5759   1.96      fvdl 	 * Don't attempt to run any queued untagged transactions
   5760   1.96      fvdl 	 * until we are done with the abort process.
   5761   1.96      fvdl 	 */
   5762   1.96      fvdl 	ahc_freeze_untagged_queues(ahc);
   5763   1.18   thorpej 
   5764   1.96      fvdl 	/* restore this when we're done */
   5765   1.96      fvdl 	active_scb = ahc_inb(ahc, SCBPTR);
   5766   1.18   thorpej 
   5767   1.96      fvdl 	found = ahc_search_qinfifo(ahc, target, channel, lun, SCB_LIST_NULL,
   5768   1.96      fvdl 				   role, CAM_REQUEUE_REQ, SEARCH_COMPLETE);
   5769   1.42      fvdl 
   5770   1.96      fvdl 	/*
   5771   1.96      fvdl 	 * Clean out the busy target table for any untagged commands.
   5772   1.96      fvdl 	 */
   5773   1.96      fvdl 	i = 0;
   5774   1.96      fvdl 	maxtarget = 16;
   5775   1.96      fvdl 	if (target != CAM_TARGET_WILDCARD) {
   5776   1.96      fvdl 		i = target;
   5777   1.96      fvdl 		if (channel == 'B')
   5778   1.96      fvdl 			i += 8;
   5779   1.96      fvdl 		maxtarget = i + 1;
   5780   1.96      fvdl 	}
   5781   1.96      fvdl 
   5782   1.96      fvdl 	if (lun == CAM_LUN_WILDCARD) {
   5783   1.96      fvdl 
   5784   1.96      fvdl 		/*
   5785   1.96      fvdl 		 * Unless we are using an SCB based
   5786   1.96      fvdl 		 * busy targets table, there is only
   5787   1.96      fvdl 		 * one table entry for all luns of
   5788   1.96      fvdl 		 * a target.
   5789   1.96      fvdl 		 */
   5790   1.96      fvdl 		minlun = 0;
   5791   1.96      fvdl 		maxlun = 1;
   5792   1.96      fvdl 		if ((ahc->flags & AHC_SCB_BTT) != 0)
   5793   1.96      fvdl 			maxlun = AHC_NUM_LUNS;
   5794   1.96      fvdl 	} else {
   5795   1.96      fvdl 		minlun = lun;
   5796   1.96      fvdl 		maxlun = lun + 1;
   5797   1.96      fvdl 	}
   5798   1.42      fvdl 
   5799   1.96      fvdl 	if (role != ROLE_TARGET) {
   5800   1.96      fvdl 		for (;i < maxtarget; i++) {
   5801   1.96      fvdl 			for (j = minlun;j < maxlun; j++) {
   5802   1.96      fvdl 				u_int scbid;
   5803   1.96      fvdl 				u_int tcl;
   5804   1.96      fvdl 
   5805   1.96      fvdl 				tcl = BUILD_TCL(i << 4, j);
   5806   1.96      fvdl 				scbid = ahc_index_busy_tcl(ahc, tcl);
   5807   1.96      fvdl 				scbp = ahc_lookup_scb(ahc, scbid);
   5808   1.96      fvdl 				if (scbp == NULL
   5809   1.96      fvdl 				 || ahc_match_scb(ahc, scbp, target, channel,
   5810   1.96      fvdl 						  lun, tag, role) == 0)
   5811   1.96      fvdl 					continue;
   5812   1.96      fvdl 				ahc_unbusy_tcl(ahc, BUILD_TCL(i << 4, j));
   5813   1.70    bouyer 			}
   5814   1.18   thorpej 		}
   5815   1.18   thorpej 
   5816   1.18   thorpej 		/*
   5817   1.96      fvdl 		 * Go through the disconnected list and remove any entries we
   5818   1.96      fvdl 		 * have queued for completion, 0'ing their control byte too.
   5819   1.96      fvdl 		 * We save the active SCB and restore it ourselves, so there
   5820   1.96      fvdl 		 * is no reason for this search to restore it too.
   5821   1.96      fvdl 		 */
   5822   1.96      fvdl 		ahc_search_disc_list(ahc, target, channel, lun, tag,
   5823   1.96      fvdl 				     /*stop_on_first*/FALSE, /*remove*/TRUE,
   5824   1.96      fvdl 				     /*save_state*/FALSE);
   5825   1.96      fvdl 	}
   5826   1.42      fvdl 
   5827   1.96      fvdl 	/*
   5828   1.96      fvdl 	 * Go through the hardware SCB array looking for commands that
   5829   1.96      fvdl 	 * were active but not on any list.  In some cases, these remnants
   5830   1.96      fvdl 	 * might not still have mappings in the scbindex array (e.g. unexpected
   5831   1.96      fvdl 	 * bus free with the same scb queued for an abort).  Don't hold this
   5832   1.96      fvdl 	 * against them.
   5833   1.96      fvdl 	 */
   5834   1.96      fvdl 	for (i = 0; i < ahc->scb_data->maxhscbs; i++) {
   5835   1.96      fvdl 		u_int scbid;
   5836   1.42      fvdl 
   5837   1.96      fvdl 		ahc_outb(ahc, SCBPTR, i);
   5838   1.96      fvdl 		scbid = ahc_inb(ahc, SCB_TAG);
   5839   1.96      fvdl 		scbp = ahc_lookup_scb(ahc, scbid);
   5840   1.96      fvdl 		if ((scbp == NULL && scbid != SCB_LIST_NULL)
   5841   1.96      fvdl 		 || (scbp != NULL
   5842   1.96      fvdl 		  && ahc_match_scb(ahc, scbp, target, channel, lun, tag, role)))
   5843   1.96      fvdl 			ahc_add_curscb_to_free_list(ahc);
   5844   1.96      fvdl 	}
   5845   1.42      fvdl 
   5846   1.96      fvdl 	/*
   5847   1.96      fvdl 	 * Go through the pending CCB list and look for
   5848   1.96      fvdl 	 * commands for this target that are still active.
   5849   1.96      fvdl 	 * These are other tagged commands that were
   5850   1.96      fvdl 	 * disconnected when the reset occurred.
   5851   1.96      fvdl 	 */
   5852   1.96      fvdl 	scbp_next = LIST_FIRST(&ahc->pending_scbs);
   5853   1.96      fvdl 	while (scbp_next != NULL) {
   5854   1.96      fvdl 		scbp = scbp_next;
   5855   1.96      fvdl 		scbp_next = LIST_NEXT(scbp, pending_links);
   5856   1.96      fvdl 		if (ahc_match_scb(ahc, scbp, target, channel, lun, tag, role)) {
   5857   1.96      fvdl 			cam_status ostat;
   5858   1.96      fvdl 
   5859   1.96      fvdl 			ostat = ahc_get_transaction_status(scbp);
   5860   1.96      fvdl 			if (ostat == CAM_REQ_INPROG)
   5861   1.96      fvdl 				ahc_set_transaction_status(scbp, status);
   5862   1.96      fvdl 			if (ahc_get_transaction_status(scbp) != CAM_REQ_CMP)
   5863   1.96      fvdl 				ahc_freeze_scb(scbp);
   5864   1.96      fvdl 			if ((scbp->flags & SCB_ACTIVE) == 0)
   5865   1.96      fvdl 				printf("Inactive SCB on pending list\n");
   5866   1.96      fvdl 			ahc_done(ahc, scbp);
   5867   1.96      fvdl 			found++;
   5868   1.70    bouyer 		}
   5869   1.42      fvdl 	}
   5870   1.96      fvdl 	ahc_outb(ahc, SCBPTR, active_scb);
   5871   1.96      fvdl 	ahc_platform_abort_scbs(ahc, target, channel, lun, tag, role, status);
   5872   1.96      fvdl 	ahc_release_untagged_queues(ahc);
   5873   1.96      fvdl 	return found;
   5874   1.42      fvdl }
   5875   1.42      fvdl 
   5876   1.70    bouyer static void
   5877   1.96      fvdl ahc_reset_current_bus(struct ahc_softc *ahc)
   5878   1.42      fvdl {
   5879   1.96      fvdl 	uint8_t scsiseq;
   5880   1.96      fvdl 
   5881   1.96      fvdl 	ahc_outb(ahc, SIMODE1, ahc_inb(ahc, SIMODE1) & ~ENSCSIRST);
   5882   1.96      fvdl 	scsiseq = ahc_inb(ahc, SCSISEQ);
   5883   1.96      fvdl 	ahc_outb(ahc, SCSISEQ, scsiseq | SCSIRSTO);
   5884   1.96      fvdl 	ahc_flush_device_writes(ahc);
   5885   1.96      fvdl 	ahc_delay(AHC_BUSRESET_DELAY);
   5886   1.96      fvdl 	/* Turn off the bus reset */
   5887   1.96      fvdl 	ahc_outb(ahc, SCSISEQ, scsiseq & ~SCSIRSTO);
   5888   1.42      fvdl 
   5889   1.96      fvdl 	ahc_clear_intstat(ahc);
   5890   1.42      fvdl 
   5891   1.96      fvdl 	/* Re-enable reset interrupts */
   5892   1.96      fvdl 	ahc_outb(ahc, SIMODE1, ahc_inb(ahc, SIMODE1) | ENSCSIRST);
   5893   1.96      fvdl }
   5894   1.42      fvdl 
   5895   1.96      fvdl int
   5896   1.96      fvdl ahc_reset_channel(struct ahc_softc *ahc, char channel, int initiate_reset)
   5897   1.96      fvdl {
   5898   1.96      fvdl 	struct	ahc_devinfo devinfo;
   5899   1.96      fvdl 	u_int	initiator, target, max_scsiid;
   5900   1.96      fvdl 	u_int	sblkctl;
   5901   1.96      fvdl 	u_int	scsiseq;
   5902   1.96      fvdl 	u_int	simode1;
   5903   1.96      fvdl 	int	found;
   5904   1.96      fvdl 	int	restart_needed;
   5905   1.96      fvdl 	char	cur_channel;
   5906   1.18   thorpej 
   5907   1.96      fvdl 	ahc->pending_device = NULL;
   5908   1.59        pk 
   5909   1.96      fvdl 	ahc_compile_devinfo(&devinfo,
   5910   1.96      fvdl 			    CAM_TARGET_WILDCARD,
   5911   1.96      fvdl 			    CAM_TARGET_WILDCARD,
   5912   1.96      fvdl 			    CAM_LUN_WILDCARD,
   5913   1.96      fvdl 			    channel, ROLE_UNKNOWN);
   5914   1.96      fvdl 	ahc_pause(ahc);
   5915   1.18   thorpej 
   5916   1.96      fvdl 	/* Make sure the sequencer is in a safe location. */
   5917   1.96      fvdl 	ahc_clear_critical_section(ahc);
   5918   1.18   thorpej 
   5919    1.9  explorer 	/*
   5920   1.96      fvdl 	 * Run our command complete fifos to ensure that we perform
   5921   1.96      fvdl 	 * completion processing on any commands that 'completed'
   5922   1.96      fvdl 	 * before the reset occurred.
   5923   1.96      fvdl 	 */
   5924   1.96      fvdl 	ahc_run_qoutfifo(ahc);
   5925   1.96      fvdl #if AHC_TARGET_MODE
   5926   1.96      fvdl 	/*
   5927   1.96      fvdl 	 * XXX - In Twin mode, the tqinfifo may have commands
   5928   1.96      fvdl 	 *	 for an unaffected channel in it.  However, if
   5929   1.96      fvdl 	 *	 we have run out of ATIO resources to drain that
   5930   1.96      fvdl 	 *	 queue, we may not get them all out here.  Further,
   5931   1.96      fvdl 	 *	 the blocked transactions for the reset channel
   5932   1.96      fvdl 	 *	 should just be killed off, irrespecitve of whether
   5933   1.96      fvdl 	 *	 we are blocked on ATIO resources.  Write a routine
   5934   1.96      fvdl 	 *	 to compact the tqinfifo appropriately.
   5935    1.9  explorer 	 */
   5936   1.96      fvdl 	if ((ahc->flags & AHC_TARGETROLE) != 0) {
   5937   1.96      fvdl 		ahc_run_tqinfifo(ahc, /*paused*/TRUE);
   5938   1.42      fvdl 	}
   5939   1.96      fvdl #endif
   5940    1.6   mycroft 
   5941   1.96      fvdl 	/*
   5942   1.96      fvdl 	 * Reset the bus if we are initiating this reset
   5943   1.96      fvdl 	 */
   5944   1.96      fvdl 	sblkctl = ahc_inb(ahc, SBLKCTL);
   5945   1.96      fvdl 	cur_channel = 'A';
   5946   1.96      fvdl 	if ((ahc->features & AHC_TWIN) != 0
   5947   1.96      fvdl 	 && ((sblkctl & SELBUSB) != 0))
   5948   1.96      fvdl 	    cur_channel = 'B';
   5949   1.96      fvdl 	scsiseq = ahc_inb(ahc, SCSISEQ_TEMPLATE);
   5950   1.96      fvdl 	if (cur_channel != channel) {
   5951   1.96      fvdl 		/* Case 1: Command for another bus is active
   5952   1.96      fvdl 		 * Stealthily reset the other bus without
   5953   1.96      fvdl 		 * upsetting the current bus.
   5954   1.96      fvdl 		 */
   5955   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, sblkctl ^ SELBUSB);
   5956   1.96      fvdl 		simode1 = ahc_inb(ahc, SIMODE1) & ~(ENBUSFREE|ENSCSIRST);
   5957   1.96      fvdl #if AHC_TARGET_MODE
   5958   1.96      fvdl 		/*
   5959   1.96      fvdl 		 * Bus resets clear ENSELI, so we cannot
   5960   1.96      fvdl 		 * defer re-enabling bus reset interrupts
   5961   1.96      fvdl 		 * if we are in target mode.
   5962   1.96      fvdl 		 */
   5963   1.96      fvdl 		if ((ahc->flags & AHC_TARGETROLE) != 0)
   5964   1.96      fvdl 			simode1 |= ENSCSIRST;
   5965   1.96      fvdl #endif
   5966   1.96      fvdl 		ahc_outb(ahc, SIMODE1, simode1);
   5967   1.96      fvdl 		if (initiate_reset)
   5968   1.96      fvdl 			ahc_reset_current_bus(ahc);
   5969   1.96      fvdl 		ahc_clear_intstat(ahc);
   5970   1.96      fvdl 		ahc_outb(ahc, SCSISEQ, scsiseq & (ENSELI|ENRSELI|ENAUTOATNP));
   5971   1.96      fvdl 		ahc_outb(ahc, SBLKCTL, sblkctl);
   5972   1.96      fvdl 		restart_needed = FALSE;
   5973   1.96      fvdl 	} else {
   5974   1.96      fvdl 		/* Case 2: A command from this bus is active or we're idle */
   5975   1.96      fvdl 		simode1 = ahc_inb(ahc, SIMODE1) & ~(ENBUSFREE|ENSCSIRST);
   5976   1.96      fvdl #if AHC_TARGET_MODE
   5977   1.96      fvdl 		/*
   5978   1.96      fvdl 		 * Bus resets clear ENSELI, so we cannot
   5979   1.96      fvdl 		 * defer re-enabling bus reset interrupts
   5980   1.96      fvdl 		 * if we are in target mode.
   5981   1.96      fvdl 		 */
   5982   1.96      fvdl 		if ((ahc->flags & AHC_TARGETROLE) != 0)
   5983   1.96      fvdl 			simode1 |= ENSCSIRST;
   5984   1.29       leo #endif
   5985   1.96      fvdl 		ahc_outb(ahc, SIMODE1, simode1);
   5986   1.96      fvdl 		if (initiate_reset)
   5987   1.96      fvdl 			ahc_reset_current_bus(ahc);
   5988   1.96      fvdl 		ahc_clear_intstat(ahc);
   5989   1.96      fvdl 		ahc_outb(ahc, SCSISEQ, scsiseq & (ENSELI|ENRSELI|ENAUTOATNP));
   5990   1.96      fvdl 		restart_needed = TRUE;
   5991   1.96      fvdl 	}
   5992    1.6   mycroft 
   5993   1.96      fvdl 	/*
   5994   1.96      fvdl 	 * Clean up all the state information for the
   5995   1.96      fvdl 	 * pending transactions on this bus.
   5996   1.96      fvdl 	 */
   5997   1.96      fvdl 	found = ahc_abort_scbs(ahc, CAM_TARGET_WILDCARD, channel,
   5998   1.96      fvdl 			       CAM_LUN_WILDCARD, SCB_LIST_NULL,
   5999   1.96      fvdl 			       ROLE_UNKNOWN, CAM_SCSI_BUS_RESET);
   6000   1.59        pk 
   6001   1.96      fvdl 	max_scsiid = (ahc->features & AHC_WIDE) ? 15 : 7;
   6002    1.6   mycroft 
   6003   1.96      fvdl #ifdef AHC_TARGET_MODE
   6004   1.96      fvdl 	/*
   6005   1.96      fvdl 	 * Send an immediate notify ccb to all target more peripheral
   6006   1.96      fvdl 	 * drivers affected by this action.
   6007   1.96      fvdl 	 */
   6008   1.96      fvdl 	for (target = 0; target <= max_scsiid; target++) {
   6009   1.96      fvdl 		struct ahc_tmode_tstate* tstate;
   6010   1.96      fvdl 		u_int lun;
   6011    1.6   mycroft 
   6012   1.96      fvdl 		tstate = ahc->enabled_targets[target];
   6013   1.96      fvdl 		if (tstate == NULL)
   6014   1.96      fvdl 			continue;
   6015   1.96      fvdl 		for (lun = 0; lun < AHC_NUM_LUNS; lun++) {
   6016   1.96      fvdl 			struct ahc_tmode_lstate* lstate;
   6017   1.42      fvdl 
   6018   1.96      fvdl 			lstate = tstate->enabled_luns[lun];
   6019   1.96      fvdl 			if (lstate == NULL)
   6020   1.96      fvdl 				continue;
   6021    1.6   mycroft 
   6022   1.96      fvdl 			ahc_queue_lstate_event(ahc, lstate, CAM_TARGET_WILDCARD,
   6023   1.96      fvdl 					       EVENT_TYPE_BUS_RESET, /*arg*/0);
   6024   1.96      fvdl 			ahc_send_lstate_events(ahc, lstate);
   6025   1.42      fvdl 		}
   6026   1.42      fvdl 	}
   6027    1.1   mycroft #endif
   6028    1.1   mycroft 	/*
   6029   1.96      fvdl 	 * Revert to async/narrow transfers until we renegotiate.
   6030    1.1   mycroft 	 */
   6031   1.96      fvdl 	for (target = 0; target <= max_scsiid; target++) {
   6032    1.1   mycroft 
   6033   1.96      fvdl 		if (ahc->enabled_targets[target] == NULL)
   6034   1.96      fvdl 			continue;
   6035   1.96      fvdl 		for (initiator = 0; initiator <= max_scsiid; initiator++) {
   6036   1.96      fvdl 			struct ahc_devinfo devinfo;
   6037   1.42      fvdl 
   6038   1.96      fvdl 			ahc_compile_devinfo(&devinfo, target, initiator,
   6039   1.96      fvdl 					    CAM_LUN_WILDCARD,
   6040   1.96      fvdl 					    channel, ROLE_UNKNOWN);
   6041   1.96      fvdl 			ahc_set_width(ahc, &devinfo, MSG_EXT_WDTR_BUS_8_BIT,
   6042   1.96      fvdl 				      AHC_TRANS_CUR, /*paused*/TRUE);
   6043   1.96      fvdl 			ahc_set_syncrate(ahc, &devinfo, /*syncrate*/NULL,
   6044   1.96      fvdl 					 /*period*/0, /*offset*/0,
   6045   1.96      fvdl 					 /*ppr_options*/0, AHC_TRANS_CUR,
   6046   1.96      fvdl 					 /*paused*/TRUE);
   6047   1.96      fvdl 		}
   6048   1.42      fvdl 	}
   6049   1.59        pk 
   6050   1.96      fvdl 	if (restart_needed)
   6051   1.96      fvdl 		ahc_restart(ahc);
   6052   1.96      fvdl 	else
   6053   1.96      fvdl 		ahc_unpause(ahc);
   6054   1.96      fvdl 	return found;
   6055   1.42      fvdl }
   6056   1.42      fvdl 
   6057   1.96      fvdl 
   6058   1.96      fvdl /***************************** Residual Processing ****************************/
   6059   1.96      fvdl /*
   6060   1.96      fvdl  * Calculate the residual for a just completed SCB.
   6061   1.96      fvdl  */
   6062   1.96      fvdl void
   6063   1.96      fvdl ahc_calc_residual(struct ahc_softc *ahc, struct scb *scb)
   6064   1.42      fvdl {
   6065   1.42      fvdl 	struct hardware_scb *hscb;
   6066   1.96      fvdl 	struct status_pkt *spkt;
   6067   1.96      fvdl 	uint32_t sgptr;
   6068   1.96      fvdl 	uint32_t resid_sgptr;
   6069   1.96      fvdl 	uint32_t resid;
   6070   1.96      fvdl 
   6071   1.96      fvdl 	/*
   6072   1.96      fvdl 	 * 5 cases.
   6073   1.96      fvdl 	 * 1) No residual.
   6074   1.96      fvdl 	 *    SG_RESID_VALID clear in sgptr.
   6075   1.96      fvdl 	 * 2) Transferless command
   6076   1.96      fvdl 	 * 3) Never performed any transfers.
   6077   1.96      fvdl 	 *    sgptr has SG_FULL_RESID set.
   6078   1.96      fvdl 	 * 4) No residual but target did not
   6079   1.96      fvdl 	 *    save data pointers after the
   6080   1.96      fvdl 	 *    last transfer, so sgptr was
   6081   1.96      fvdl 	 *    never updated.
   6082   1.96      fvdl 	 * 5) We have a partial residual.
   6083   1.96      fvdl 	 *    Use residual_sgptr to determine
   6084   1.96      fvdl 	 *    where we are.
   6085   1.96      fvdl 	 */
   6086   1.59        pk 
   6087   1.42      fvdl 	hscb = scb->hscb;
   6088   1.96      fvdl 	sgptr = ahc_le32toh(hscb->sgptr);
   6089   1.96      fvdl 	if ((sgptr & SG_RESID_VALID) == 0)
   6090   1.96      fvdl 		/* Case 1 */
   6091   1.96      fvdl 		return;
   6092   1.96      fvdl 	sgptr &= ~SG_RESID_VALID;
   6093   1.59        pk 
   6094   1.96      fvdl 	if ((sgptr & SG_LIST_NULL) != 0)
   6095   1.96      fvdl 		/* Case 2 */
   6096   1.96      fvdl 		return;
   6097   1.42      fvdl 
   6098   1.96      fvdl 	spkt = &hscb->shared_data.status;
   6099   1.96      fvdl 	resid_sgptr = ahc_le32toh(spkt->residual_sg_ptr);
   6100   1.96      fvdl 	if ((sgptr & SG_FULL_RESID) != 0) {
   6101   1.96      fvdl 		/* Case 3 */
   6102   1.96      fvdl 		resid = ahc_get_transfer_length(scb);
   6103   1.96      fvdl 	} else if ((resid_sgptr & SG_LIST_NULL) != 0) {
   6104   1.96      fvdl 		/* Case 4 */
   6105   1.96      fvdl 		return;
   6106   1.96      fvdl 	} else if ((resid_sgptr & ~SG_PTR_MASK) != 0) {
   6107   1.96      fvdl 		panic("Bogus resid sgptr value 0x%x\n", resid_sgptr);
   6108   1.42      fvdl 	} else {
   6109   1.96      fvdl 		struct ahc_dma_seg *sg;
   6110   1.42      fvdl 
   6111   1.96      fvdl 		/*
   6112   1.96      fvdl 		 * Remainder of the SG where the transfer
   6113   1.96      fvdl 		 * stopped.
   6114   1.96      fvdl 		 */
   6115   1.96      fvdl 		resid = ahc_le32toh(spkt->residual_datacnt) & AHC_SG_LEN_MASK;
   6116   1.96      fvdl 		sg = ahc_sg_bus_to_virt(scb, resid_sgptr & SG_PTR_MASK);
   6117   1.42      fvdl 
   6118   1.96      fvdl 		/* The residual sg_ptr always points to the next sg */
   6119   1.96      fvdl 		sg--;
   6120   1.42      fvdl 
   6121   1.96      fvdl 		/*
   6122   1.96      fvdl 		 * Add up the contents of all residual
   6123   1.96      fvdl 		 * SG segments that are after the SG where
   6124   1.96      fvdl 		 * the transfer stopped.
   6125   1.96      fvdl 		 */
   6126   1.96      fvdl 		while ((ahc_le32toh(sg->len) & AHC_DMA_LAST_SEG) == 0) {
   6127   1.96      fvdl 			sg++;
   6128   1.96      fvdl 			resid += ahc_le32toh(sg->len) & AHC_SG_LEN_MASK;
   6129   1.96      fvdl 		}
   6130   1.96      fvdl 	}
   6131   1.96      fvdl 	if ((scb->flags & SCB_SENSE) == 0)
   6132   1.96      fvdl 		ahc_set_residual(scb, resid);
   6133   1.96      fvdl 	else
   6134   1.96      fvdl 		ahc_set_sense_residual(scb, resid);
   6135   1.42      fvdl 
   6136   1.96      fvdl #ifdef AHC_DEBUG
   6137   1.96      fvdl 	if ((ahc_debug & AHC_SHOW_MISC) != 0) {
   6138   1.96      fvdl 		ahc_print_path(ahc, scb);
   6139   1.96      fvdl 		printf("Handled %sResidual of %d bytes\n",
   6140   1.96      fvdl 		       (scb->flags & SCB_SENSE) ? "Sense " : "", resid);
   6141   1.42      fvdl 	}
   6142   1.96      fvdl #endif
   6143   1.96      fvdl }
   6144   1.96      fvdl 
   6145   1.96      fvdl /******************************* Target Mode **********************************/
   6146   1.96      fvdl #ifdef AHC_TARGET_MODE
   6147   1.96      fvdl /*
   6148   1.96      fvdl  * Add a target mode event to this lun's queue
   6149   1.96      fvdl  */
   6150   1.96      fvdl static void
   6151   1.96      fvdl ahc_queue_lstate_event(struct ahc_softc *ahc, struct ahc_tmode_lstate *lstate,
   6152   1.96      fvdl 		       u_int initiator_id, u_int event_type, u_int event_arg)
   6153   1.96      fvdl {
   6154   1.96      fvdl 	struct ahc_tmode_event *event;
   6155   1.96      fvdl 	int pending;
   6156    1.1   mycroft 
   6157   1.96      fvdl 	xpt_freeze_devq(lstate->path, /*count*/1);
   6158   1.96      fvdl 	if (lstate->event_w_idx >= lstate->event_r_idx)
   6159   1.96      fvdl 		pending = lstate->event_w_idx - lstate->event_r_idx;
   6160   1.96      fvdl 	else
   6161   1.96      fvdl 		pending = AHC_TMODE_EVENT_BUFFER_SIZE + 1
   6162   1.96      fvdl 			- (lstate->event_r_idx - lstate->event_w_idx);
   6163   1.42      fvdl 
   6164   1.96      fvdl 	if (event_type == EVENT_TYPE_BUS_RESET
   6165   1.96      fvdl 	 || event_type == MSG_BUS_DEV_RESET) {
   6166   1.96      fvdl 		/*
   6167   1.96      fvdl 		 * Any earlier events are irrelevant, so reset our buffer.
   6168   1.96      fvdl 		 * This has the effect of allowing us to deal with reset
   6169   1.96      fvdl 		 * floods (an external device holding down the reset line)
   6170   1.96      fvdl 		 * without losing the event that is really interesting.
   6171   1.96      fvdl 		 */
   6172   1.96      fvdl 		lstate->event_r_idx = 0;
   6173   1.96      fvdl 		lstate->event_w_idx = 0;
   6174   1.96      fvdl 		xpt_release_devq(lstate->path, pending, /*runqueue*/FALSE);
   6175   1.96      fvdl 	}
   6176   1.96      fvdl 
   6177   1.96      fvdl 	if (pending == AHC_TMODE_EVENT_BUFFER_SIZE) {
   6178   1.96      fvdl 		xpt_print_path(lstate->path);
   6179   1.96      fvdl 		printf("immediate event %x:%x lost\n",
   6180   1.96      fvdl 		       lstate->event_buffer[lstate->event_r_idx].event_type,
   6181   1.96      fvdl 		       lstate->event_buffer[lstate->event_r_idx].event_arg);
   6182   1.96      fvdl 		lstate->event_r_idx++;
   6183   1.96      fvdl 		if (lstate->event_r_idx == AHC_TMODE_EVENT_BUFFER_SIZE)
   6184   1.96      fvdl 			lstate->event_r_idx = 0;
   6185   1.96      fvdl 		xpt_release_devq(lstate->path, /*count*/1, /*runqueue*/FALSE);
   6186   1.96      fvdl 	}
   6187   1.96      fvdl 
   6188   1.96      fvdl 	event = &lstate->event_buffer[lstate->event_w_idx];
   6189   1.96      fvdl 	event->initiator_id = initiator_id;
   6190   1.96      fvdl 	event->event_type = event_type;
   6191   1.96      fvdl 	event->event_arg = event_arg;
   6192   1.96      fvdl 	lstate->event_w_idx++;
   6193   1.96      fvdl 	if (lstate->event_w_idx == AHC_TMODE_EVENT_BUFFER_SIZE)
   6194   1.96      fvdl 		lstate->event_w_idx = 0;
   6195   1.96      fvdl }
   6196    1.1   mycroft 
   6197   1.96      fvdl /*
   6198   1.96      fvdl  * Send any target mode events queued up waiting
   6199   1.96      fvdl  * for immediate notify resources.
   6200   1.96      fvdl  */
   6201   1.96      fvdl void
   6202   1.96      fvdl ahc_send_lstate_events(struct ahc_softc *ahc, struct ahc_tmode_lstate *lstate)
   6203   1.96      fvdl {
   6204   1.96      fvdl 	struct ccb_hdr *ccbh;
   6205   1.96      fvdl 	struct ccb_immed_notify *inot;
   6206    1.9  explorer 
   6207   1.96      fvdl 	while (lstate->event_r_idx != lstate->event_w_idx
   6208   1.96      fvdl 	    && (ccbh = SLIST_FIRST(&lstate->immed_notifies)) != NULL) {
   6209   1.96      fvdl 		struct ahc_tmode_event *event;
   6210   1.96      fvdl 
   6211   1.96      fvdl 		event = &lstate->event_buffer[lstate->event_r_idx];
   6212   1.96      fvdl 		SLIST_REMOVE_HEAD(&lstate->immed_notifies, sim_links.sle);
   6213   1.96      fvdl 		inot = (struct ccb_immed_notify *)ccbh;
   6214   1.96      fvdl 		switch (event->event_type) {
   6215   1.96      fvdl 		case EVENT_TYPE_BUS_RESET:
   6216   1.96      fvdl 			ccbh->status = CAM_SCSI_BUS_RESET|CAM_DEV_QFRZN;
   6217   1.96      fvdl 			break;
   6218   1.96      fvdl 		default:
   6219   1.96      fvdl 			ccbh->status = CAM_MESSAGE_RECV|CAM_DEV_QFRZN;
   6220   1.96      fvdl 			inot->message_args[0] = event->event_type;
   6221   1.96      fvdl 			inot->message_args[1] = event->event_arg;
   6222   1.42      fvdl 			break;
   6223   1.96      fvdl 		}
   6224   1.96      fvdl 		inot->initiator_id = event->initiator_id;
   6225   1.96      fvdl 		inot->sense_len = 0;
   6226   1.96      fvdl 		xpt_done((union ccb *)inot);
   6227   1.96      fvdl 		lstate->event_r_idx++;
   6228   1.96      fvdl 		if (lstate->event_r_idx == AHC_TMODE_EVENT_BUFFER_SIZE)
   6229   1.96      fvdl 			lstate->event_r_idx = 0;
   6230    1.6   mycroft 	}
   6231   1.96      fvdl }
   6232   1.42      fvdl #endif
   6233   1.96      fvdl 
   6234   1.96      fvdl /******************** Sequencer Program Patching/Download *********************/
   6235   1.42      fvdl 
   6236   1.42      fvdl #ifdef AHC_DUMP_SEQ
   6237   1.96      fvdl void
   6238   1.42      fvdl ahc_dumpseq(struct ahc_softc* ahc)
   6239   1.42      fvdl {
   6240   1.42      fvdl 	int i;
   6241   1.42      fvdl 	int max_prog;
   6242   1.42      fvdl 
   6243   1.42      fvdl 	if ((ahc->chip & AHC_BUS_MASK) < AHC_PCI)
   6244   1.42      fvdl 		max_prog = 448;
   6245   1.42      fvdl 	else if ((ahc->features & AHC_ULTRA2) != 0)
   6246   1.42      fvdl 		max_prog = 768;
   6247   1.42      fvdl 	else
   6248   1.42      fvdl 		max_prog = 512;
   6249   1.42      fvdl 
   6250   1.42      fvdl 	ahc_outb(ahc, SEQCTL, PERRORDIS|FAILDIS|FASTMODE|LOADRAM);
   6251   1.42      fvdl 	ahc_outb(ahc, SEQADDR0, 0);
   6252   1.42      fvdl 	ahc_outb(ahc, SEQADDR1, 0);
   6253   1.42      fvdl 	for (i = 0; i < max_prog; i++) {
   6254   1.96      fvdl 		uint8_t ins_bytes[4];
   6255   1.42      fvdl 
   6256   1.42      fvdl 		ahc_insb(ahc, SEQRAM, ins_bytes, 4);
   6257   1.42      fvdl 		printf("0x%08x\n", ins_bytes[0] << 24
   6258   1.42      fvdl 				 | ins_bytes[1] << 16
   6259   1.42      fvdl 				 | ins_bytes[2] << 8
   6260   1.42      fvdl 				 | ins_bytes[3]);
   6261    1.6   mycroft 	}
   6262   1.42      fvdl }
   6263   1.42      fvdl #endif
   6264   1.42      fvdl 
   6265   1.42      fvdl static void
   6266   1.42      fvdl ahc_loadseq(struct ahc_softc *ahc)
   6267   1.42      fvdl {
   6268   1.96      fvdl 	struct	cs cs_table[num_critical_sections];
   6269   1.96      fvdl 	u_int	begin_set[num_critical_sections];
   6270   1.96      fvdl 	u_int	end_set[num_critical_sections];
   6271   1.96      fvdl 	struct	patch *cur_patch;
   6272   1.96      fvdl 	u_int	cs_count;
   6273   1.96      fvdl 	u_int	cur_cs;
   6274   1.96      fvdl 	u_int	i;
   6275   1.96      fvdl 	int	downloaded;
   6276   1.96      fvdl 	u_int	skip_addr;
   6277   1.96      fvdl 	u_int	sg_prefetch_cnt;
   6278   1.96      fvdl 	uint8_t	download_consts[7];
   6279   1.96      fvdl 
   6280   1.96      fvdl 	/*
   6281   1.96      fvdl 	 * Start out with 0 critical sections
   6282   1.96      fvdl 	 * that apply to this firmware load.
   6283   1.96      fvdl 	 */
   6284   1.96      fvdl 	cs_count = 0;
   6285   1.96      fvdl 	cur_cs = 0;
   6286   1.96      fvdl 	memset(begin_set, 0, sizeof(begin_set));
   6287   1.96      fvdl 	memset(end_set, 0, sizeof(end_set));
   6288   1.42      fvdl 
   6289   1.42      fvdl 	/* Setup downloadable constant table */
   6290   1.96      fvdl 	download_consts[QOUTFIFO_OFFSET] = 0;
   6291   1.96      fvdl 	if (ahc->targetcmds != NULL)
   6292   1.96      fvdl 		download_consts[QOUTFIFO_OFFSET] += 32;
   6293   1.96      fvdl 	download_consts[QINFIFO_OFFSET] = download_consts[QOUTFIFO_OFFSET] + 1;
   6294   1.96      fvdl 	download_consts[CACHESIZE_MASK] = ahc->pci_cachesize - 1;
   6295   1.96      fvdl 	download_consts[INVERTED_CACHESIZE_MASK] = ~(ahc->pci_cachesize - 1);
   6296   1.96      fvdl 	sg_prefetch_cnt = ahc->pci_cachesize;
   6297   1.96      fvdl 	if (sg_prefetch_cnt < (2 * sizeof(struct ahc_dma_seg)))
   6298   1.96      fvdl 		sg_prefetch_cnt = 2 * sizeof(struct ahc_dma_seg);
   6299   1.96      fvdl 	download_consts[SG_PREFETCH_CNT] = sg_prefetch_cnt;
   6300   1.96      fvdl 	download_consts[SG_PREFETCH_ALIGN_MASK] = ~(sg_prefetch_cnt - 1);
   6301   1.96      fvdl 	download_consts[SG_PREFETCH_ADDR_MASK] = (sg_prefetch_cnt - 1);
   6302   1.42      fvdl 
   6303   1.42      fvdl 	cur_patch = patches;
   6304   1.42      fvdl 	downloaded = 0;
   6305   1.42      fvdl 	skip_addr = 0;
   6306   1.42      fvdl 	ahc_outb(ahc, SEQCTL, PERRORDIS|FAILDIS|FASTMODE|LOADRAM);
   6307   1.42      fvdl 	ahc_outb(ahc, SEQADDR0, 0);
   6308   1.42      fvdl 	ahc_outb(ahc, SEQADDR1, 0);
   6309   1.42      fvdl 
   6310   1.42      fvdl 	for (i = 0; i < sizeof(seqprog)/4; i++) {
   6311   1.42      fvdl 		if (ahc_check_patch(ahc, &cur_patch, i, &skip_addr) == 0) {
   6312    1.6   mycroft 			/*
   6313   1.42      fvdl 			 * Don't download this instruction as it
   6314   1.42      fvdl 			 * is in a patch that was removed.
   6315    1.6   mycroft 			 */
   6316   1.96      fvdl 			continue;
   6317   1.96      fvdl 		}
   6318   1.96      fvdl 		/*
   6319   1.96      fvdl 		 * Move through the CS table until we find a CS
   6320   1.96      fvdl 		 * that might apply to this instruction.
   6321   1.96      fvdl 		 */
   6322   1.96      fvdl 		for (; cur_cs < num_critical_sections; cur_cs++) {
   6323   1.96      fvdl 			if (critical_sections[cur_cs].end <= i) {
   6324   1.96      fvdl 				if (begin_set[cs_count] == TRUE
   6325   1.96      fvdl 				 && end_set[cs_count] == FALSE) {
   6326   1.96      fvdl 					cs_table[cs_count].end = downloaded;
   6327   1.96      fvdl 				 	end_set[cs_count] = TRUE;
   6328   1.96      fvdl 					cs_count++;
   6329   1.96      fvdl 				}
   6330   1.96      fvdl 				continue;
   6331   1.96      fvdl 			}
   6332   1.96      fvdl 			if (critical_sections[cur_cs].begin <= i
   6333   1.96      fvdl 			 && begin_set[cs_count] == FALSE) {
   6334   1.96      fvdl 				cs_table[cs_count].begin = downloaded;
   6335   1.96      fvdl 				begin_set[cs_count] = TRUE;
   6336   1.96      fvdl 			}
   6337   1.96      fvdl 			break;
   6338   1.42      fvdl 		}
   6339   1.42      fvdl 		ahc_download_instr(ahc, i, download_consts);
   6340   1.42      fvdl 		downloaded++;
   6341    1.6   mycroft 	}
   6342   1.96      fvdl 
   6343   1.96      fvdl 	ahc->num_critical_sections = cs_count;
   6344   1.96      fvdl 	if (cs_count != 0) {
   6345   1.96      fvdl 
   6346   1.96      fvdl 		cs_count *= sizeof(struct cs);
   6347   1.96      fvdl 		ahc->critical_sections = malloc(cs_count, M_DEVBUF, M_NOWAIT);
   6348   1.96      fvdl 		if (ahc->critical_sections == NULL)
   6349   1.96      fvdl 			panic("ahc_loadseq: Could not malloc");
   6350   1.96      fvdl 		memcpy(ahc->critical_sections, cs_table, cs_count);
   6351   1.96      fvdl 	}
   6352   1.42      fvdl 	ahc_outb(ahc, SEQCTL, PERRORDIS|FAILDIS|FASTMODE);
   6353   1.96      fvdl 	ahc_restart(ahc);
   6354   1.42      fvdl 
   6355   1.96      fvdl 	if (bootverbose) {
   6356   1.96      fvdl 		printf(" %d instructions downloaded\n", downloaded);
   6357   1.96      fvdl 		printf("%s: Features 0x%x, Bugs 0x%x, Flags 0x%x\n",
   6358   1.96      fvdl 		       ahc_name(ahc), ahc->features, ahc->bugs, ahc->flags);
   6359   1.96      fvdl 	}
   6360    1.1   mycroft }
   6361    1.1   mycroft 
   6362   1.42      fvdl static int
   6363   1.96      fvdl ahc_check_patch(struct ahc_softc *ahc, struct patch **start_patch,
   6364   1.96      fvdl 		u_int start_instr, u_int *skip_addr)
   6365   1.42      fvdl {
   6366   1.96      fvdl 	struct	patch *cur_patch;
   6367   1.96      fvdl 	struct	patch *last_patch;
   6368   1.96      fvdl 	u_int	num_patches;
   6369   1.42      fvdl 
   6370   1.42      fvdl 	num_patches = sizeof(patches)/sizeof(struct patch);
   6371   1.42      fvdl 	last_patch = &patches[num_patches];
   6372   1.42      fvdl 	cur_patch = *start_patch;
   6373   1.42      fvdl 
   6374   1.42      fvdl 	while (cur_patch < last_patch && start_instr == cur_patch->begin) {
   6375   1.42      fvdl 
   6376   1.42      fvdl 		if (cur_patch->patch_func(ahc) == 0) {
   6377   1.42      fvdl 
   6378   1.42      fvdl 			/* Start rejecting code */
   6379   1.42      fvdl 			*skip_addr = start_instr + cur_patch->skip_instr;
   6380   1.42      fvdl 			cur_patch += cur_patch->skip_patch;
   6381   1.42      fvdl 		} else {
   6382   1.42      fvdl 			/* Accepted this patch.  Advance to the next
   6383   1.42      fvdl 			 * one and wait for our intruction pointer to
   6384   1.42      fvdl 			 * hit this point.
   6385   1.42      fvdl 			 */
   6386   1.42      fvdl 			cur_patch++;
   6387   1.28       leo 		}
   6388   1.28       leo 	}
   6389   1.42      fvdl 
   6390   1.42      fvdl 	*start_patch = cur_patch;
   6391   1.42      fvdl 	if (start_instr < *skip_addr)
   6392   1.42      fvdl 		/* Still skipping */
   6393   1.42      fvdl 		return (0);
   6394   1.42      fvdl 
   6395   1.42      fvdl 	return (1);
   6396   1.28       leo }
   6397   1.28       leo 
   6398   1.42      fvdl static void
   6399   1.96      fvdl ahc_download_instr(struct ahc_softc *ahc, u_int instrptr, uint8_t *dconsts)
   6400    1.1   mycroft {
   6401   1.42      fvdl 	union	ins_formats instr;
   6402   1.42      fvdl 	struct	ins_format1 *fmt1_ins;
   6403   1.42      fvdl 	struct	ins_format3 *fmt3_ins;
   6404   1.42      fvdl 	u_int	opcode;
   6405   1.42      fvdl 
   6406   1.96      fvdl 	/*
   6407   1.96      fvdl 	 * The firmware is always compiled into a little endian format.
   6408   1.96      fvdl 	 */
   6409   1.96      fvdl 	instr.integer = ahc_le32toh(*(uint32_t*)&seqprog[instrptr * 4]);
   6410   1.42      fvdl 
   6411   1.42      fvdl 	fmt1_ins = &instr.format1;
   6412   1.42      fvdl 	fmt3_ins = NULL;
   6413   1.42      fvdl 
   6414   1.42      fvdl 	/* Pull the opcode */
   6415   1.42      fvdl 	opcode = instr.format1.opcode;
   6416   1.42      fvdl 	switch (opcode) {
   6417   1.42      fvdl 	case AIC_OP_JMP:
   6418   1.42      fvdl 	case AIC_OP_JC:
   6419   1.42      fvdl 	case AIC_OP_JNC:
   6420   1.42      fvdl 	case AIC_OP_CALL:
   6421   1.42      fvdl 	case AIC_OP_JNE:
   6422   1.42      fvdl 	case AIC_OP_JNZ:
   6423   1.42      fvdl 	case AIC_OP_JE:
   6424   1.42      fvdl 	case AIC_OP_JZ:
   6425   1.42      fvdl 	{
   6426   1.96      fvdl 		struct patch *cur_patch;
   6427   1.42      fvdl 		int address_offset;
   6428   1.42      fvdl 		u_int address;
   6429   1.96      fvdl 		u_int skip_addr;
   6430   1.96      fvdl 		u_int i;
   6431   1.42      fvdl 
   6432   1.42      fvdl 		fmt3_ins = &instr.format3;
   6433   1.42      fvdl 		address_offset = 0;
   6434   1.42      fvdl 		address = fmt3_ins->address;
   6435   1.42      fvdl 		cur_patch = patches;
   6436   1.42      fvdl 		skip_addr = 0;
   6437   1.42      fvdl 		for (i = 0; i < address;) {
   6438   1.42      fvdl 			ahc_check_patch(ahc, &cur_patch, i, &skip_addr);
   6439   1.42      fvdl 
   6440   1.42      fvdl 			if (skip_addr > i) {
   6441   1.42      fvdl 				int end_addr;
   6442   1.42      fvdl 
   6443   1.42      fvdl 				end_addr = MIN(address, skip_addr);
   6444   1.42      fvdl 				address_offset += end_addr - i;
   6445   1.42      fvdl 				i = skip_addr;
   6446   1.42      fvdl 			} else {
   6447   1.42      fvdl 				i++;
   6448   1.42      fvdl 			}
   6449    1.1   mycroft 		}
   6450   1.42      fvdl 		address -= address_offset;
   6451   1.42      fvdl 		fmt3_ins->address = address;
   6452   1.42      fvdl 		/* FALLTHROUGH */
   6453   1.42      fvdl 	}
   6454   1.42      fvdl 	case AIC_OP_OR:
   6455   1.42      fvdl 	case AIC_OP_AND:
   6456   1.42      fvdl 	case AIC_OP_XOR:
   6457   1.42      fvdl 	case AIC_OP_ADD:
   6458   1.42      fvdl 	case AIC_OP_ADC:
   6459   1.42      fvdl 	case AIC_OP_BMOV:
   6460   1.42      fvdl 		if (fmt1_ins->parity != 0) {
   6461   1.42      fvdl 			fmt1_ins->immediate = dconsts[fmt1_ins->immediate];
   6462   1.42      fvdl 		}
   6463   1.42      fvdl 		fmt1_ins->parity = 0;
   6464   1.96      fvdl 		if ((ahc->features & AHC_CMD_CHAN) == 0
   6465   1.96      fvdl 		 && opcode == AIC_OP_BMOV) {
   6466   1.96      fvdl 			/*
   6467   1.96      fvdl 			 * Block move was added at the same time
   6468   1.96      fvdl 			 * as the command channel.  Verify that
   6469   1.96      fvdl 			 * this is only a move of a single element
   6470   1.96      fvdl 			 * and convert the BMOV to a MOV
   6471   1.96      fvdl 			 * (AND with an immediate of FF).
   6472   1.96      fvdl 			 */
   6473   1.96      fvdl 			if (fmt1_ins->immediate != 1)
   6474   1.96      fvdl 				panic("%s: BMOV not supported\n",
   6475   1.96      fvdl 				      ahc_name(ahc));
   6476   1.96      fvdl 			fmt1_ins->opcode = AIC_OP_AND;
   6477   1.96      fvdl 			fmt1_ins->immediate = 0xff;
   6478   1.96      fvdl 		}
   6479   1.42      fvdl 		/* FALLTHROUGH */
   6480   1.42      fvdl 	case AIC_OP_ROL:
   6481   1.42      fvdl 		if ((ahc->features & AHC_ULTRA2) != 0) {
   6482   1.42      fvdl 			int i, count;
   6483   1.42      fvdl 
   6484   1.42      fvdl 			/* Calculate odd parity for the instruction */
   6485   1.42      fvdl 			for (i = 0, count = 0; i < 31; i++) {
   6486   1.96      fvdl 				uint32_t mask;
   6487   1.42      fvdl 
   6488   1.42      fvdl 				mask = 0x01 << i;
   6489   1.42      fvdl 				if ((instr.integer & mask) != 0)
   6490   1.42      fvdl 					count++;
   6491   1.42      fvdl 			}
   6492   1.42      fvdl 			if ((count & 0x01) == 0)
   6493   1.42      fvdl 				instr.format1.parity = 1;
   6494   1.42      fvdl 		} else {
   6495   1.42      fvdl 			/* Compress the instruction for older sequencers */
   6496   1.42      fvdl 			if (fmt3_ins != NULL) {
   6497   1.42      fvdl 				instr.integer =
   6498   1.42      fvdl 					fmt3_ins->immediate
   6499   1.42      fvdl 				      | (fmt3_ins->source << 8)
   6500   1.42      fvdl 				      | (fmt3_ins->address << 16)
   6501   1.42      fvdl 				      |	(fmt3_ins->opcode << 25);
   6502   1.42      fvdl 			} else {
   6503   1.42      fvdl 				instr.integer =
   6504   1.42      fvdl 					fmt1_ins->immediate
   6505   1.42      fvdl 				      | (fmt1_ins->source << 8)
   6506   1.42      fvdl 				      | (fmt1_ins->destination << 16)
   6507   1.42      fvdl 				      |	(fmt1_ins->ret << 24)
   6508   1.42      fvdl 				      |	(fmt1_ins->opcode << 25);
   6509    1.1   mycroft 			}
   6510    1.1   mycroft 		}
   6511   1.96      fvdl 		/* The sequencer is a little endian cpu */
   6512   1.96      fvdl 		instr.integer = ahc_htole32(instr.integer);
   6513   1.42      fvdl 		ahc_outsb(ahc, SEQRAM, instr.bytes, 4);
   6514   1.42      fvdl 		break;
   6515   1.42      fvdl 	default:
   6516   1.42      fvdl 		panic("Unknown opcode encountered in seq program");
   6517    1.6   mycroft 		break;
   6518    1.1   mycroft 	}
   6519    1.1   mycroft }
   6520    1.1   mycroft 
   6521   1.96      fvdl int
   6522   1.96      fvdl ahc_print_register(ahc_reg_parse_entry_t *table, u_int num_entries,
   6523   1.96      fvdl 		   const char *name, u_int address, u_int value,
   6524   1.96      fvdl 		   u_int *cur_column, u_int wrap_point)
   6525   1.96      fvdl {
   6526   1.96      fvdl 	int	printed;
   6527   1.96      fvdl 	u_int	printed_mask;
   6528   1.98      fvdl 	char    line[1024];
   6529   1.96      fvdl 
   6530   1.99      fvdl 	line[0] = 0;
   6531   1.96      fvdl 
   6532   1.96      fvdl 	if (cur_column != NULL && *cur_column >= wrap_point) {
   6533   1.96      fvdl 		printf("\n");
   6534   1.96      fvdl 		*cur_column = 0;
   6535   1.96      fvdl 	}
   6536   1.99      fvdl 	printed = snprintf(line, sizeof(line), "%s[0x%x]", name, value);
   6537   1.96      fvdl 	if (table == NULL) {
   6538   1.99      fvdl 		printed += snprintf(&line[printed], (sizeof line) - printed,
   6539   1.99      fvdl 		    " ");
   6540   1.98      fvdl 		printf("%s", line);
   6541   1.98      fvdl 		if (cur_column != NULL)
   6542   1.98      fvdl 			*cur_column += printed;
   6543   1.96      fvdl 		return (printed);
   6544   1.96      fvdl 	}
   6545   1.96      fvdl 	printed_mask = 0;
   6546   1.96      fvdl 	while (printed_mask != 0xFF) {
   6547   1.96      fvdl 		int entry;
   6548   1.96      fvdl 
   6549   1.96      fvdl 		for (entry = 0; entry < num_entries; entry++) {
   6550   1.96      fvdl 			if (((value & table[entry].mask)
   6551   1.96      fvdl 			  != table[entry].value)
   6552   1.96      fvdl 			 || ((printed_mask & table[entry].mask)
   6553   1.96      fvdl 			  == table[entry].mask))
   6554   1.96      fvdl 				continue;
   6555   1.98      fvdl 			printed += snprintf(&line[printed],
   6556   1.98      fvdl 			    (sizeof line) - printed, "%s%s",
   6557   1.96      fvdl 				printed_mask == 0 ? ":(" : "|",
   6558   1.96      fvdl 				table[entry].name);
   6559   1.96      fvdl 			printed_mask |= table[entry].mask;
   6560   1.96      fvdl 
   6561   1.96      fvdl 			break;
   6562   1.42      fvdl 		}
   6563   1.96      fvdl 		if (entry >= num_entries)
   6564   1.96      fvdl 			break;
   6565    1.6   mycroft 	}
   6566   1.96      fvdl 	if (printed_mask != 0)
   6567   1.98      fvdl 		printed += snprintf(&line[printed],
   6568   1.98      fvdl 		    (sizeof line) - printed, ") ");
   6569   1.96      fvdl 	else
   6570   1.98      fvdl 		printed += snprintf(&line[printed],
   6571   1.98      fvdl 		    (sizeof line) - printed, " ");
   6572   1.96      fvdl 	if (cur_column != NULL)
   6573   1.96      fvdl 		*cur_column += printed;
   6574   1.98      fvdl 	printf("%s", line);
   6575   1.96      fvdl 
   6576   1.96      fvdl 	return (printed);
   6577    1.6   mycroft }
   6578    1.6   mycroft 
   6579   1.96      fvdl void
   6580   1.96      fvdl ahc_dump_card_state(struct ahc_softc *ahc)
   6581    1.6   mycroft {
   6582   1.42      fvdl 	struct	scb *scb;
   6583   1.96      fvdl 	struct	scb_tailq *untagged_q;
   6584   1.96      fvdl 	u_int	cur_col;
   6585   1.96      fvdl 	int	paused;
   6586   1.42      fvdl 	int	target;
   6587   1.96      fvdl 	int	maxtarget;
   6588   1.42      fvdl 	int	i;
   6589   1.96      fvdl 	uint8_t last_phase;
   6590   1.96      fvdl 	uint8_t qinpos;
   6591   1.96      fvdl 	uint8_t qintail;
   6592   1.96      fvdl 	uint8_t qoutpos;
   6593   1.96      fvdl 	uint8_t scb_index;
   6594   1.96      fvdl 	uint8_t saved_scbptr;
   6595    1.6   mycroft 
   6596   1.96      fvdl 	if (ahc_is_paused(ahc)) {
   6597   1.96      fvdl 		paused = 1;
   6598   1.96      fvdl 	} else {
   6599   1.96      fvdl 		paused = 0;
   6600   1.96      fvdl 		ahc_pause(ahc);
   6601    1.6   mycroft 	}
   6602    1.6   mycroft 
   6603   1.96      fvdl 	saved_scbptr = ahc_inb(ahc, SCBPTR);
   6604   1.42      fvdl 	last_phase = ahc_inb(ahc, LASTPHASE);
   6605   1.96      fvdl 	printf(">>>>>>>>>>>>>>>>>> Dump Card State Begins <<<<<<<<<<<<<<<<<\n"
   6606   1.96      fvdl 	       "%s: Dumping Card State %s, at SEQADDR 0x%x\n",
   6607   1.96      fvdl 	       ahc_name(ahc), ahc_lookup_phase_entry(last_phase)->phasemsg,
   6608   1.42      fvdl 	       ahc_inb(ahc, SEQADDR0) | (ahc_inb(ahc, SEQADDR1) << 8));
   6609   1.96      fvdl 	if (paused)
   6610   1.96      fvdl 		printf("Card was paused\n");
   6611   1.96      fvdl 	printf("ACCUM = 0x%x, SINDEX = 0x%x, DINDEX = 0x%x, ARG_2 = 0x%x\n",
   6612   1.96      fvdl 	       ahc_inb(ahc, ACCUM), ahc_inb(ahc, SINDEX), ahc_inb(ahc, DINDEX),
   6613   1.96      fvdl 	       ahc_inb(ahc, ARG_2));
   6614   1.96      fvdl 	printf("HCNT = 0x%x SCBPTR = 0x%x\n", ahc_inb(ahc, HCNT),
   6615   1.96      fvdl 	       ahc_inb(ahc, SCBPTR));
   6616   1.96      fvdl 	cur_col = 0;
   6617   1.96      fvdl 	if ((ahc->features & AHC_DT) != 0)
   6618   1.96      fvdl 		ahc_scsiphase_print(ahc_inb(ahc, SCSIPHASE), &cur_col, 50);
   6619   1.96      fvdl 	ahc_scsisigi_print(ahc_inb(ahc, SCSISIGI), &cur_col, 50);
   6620   1.96      fvdl 	ahc_error_print(ahc_inb(ahc, ERROR), &cur_col, 50);
   6621   1.96      fvdl 	ahc_scsibusl_print(ahc_inb(ahc, SCSIBUSL), &cur_col, 50);
   6622   1.96      fvdl 	ahc_lastphase_print(ahc_inb(ahc, LASTPHASE), &cur_col, 50);
   6623   1.96      fvdl 	ahc_scsiseq_print(ahc_inb(ahc, SCSISEQ), &cur_col, 50);
   6624   1.96      fvdl 	ahc_sblkctl_print(ahc_inb(ahc, SBLKCTL), &cur_col, 50);
   6625   1.96      fvdl 	ahc_scsirate_print(ahc_inb(ahc, SCSIRATE), &cur_col, 50);
   6626   1.96      fvdl 	ahc_seqctl_print(ahc_inb(ahc, SEQCTL), &cur_col, 50);
   6627   1.96      fvdl 	ahc_seq_flags_print(ahc_inb(ahc, SEQ_FLAGS), &cur_col, 50);
   6628   1.96      fvdl 	ahc_sstat0_print(ahc_inb(ahc, SSTAT0), &cur_col, 50);
   6629   1.96      fvdl 	ahc_sstat1_print(ahc_inb(ahc, SSTAT1), &cur_col, 50);
   6630   1.96      fvdl 	ahc_sstat2_print(ahc_inb(ahc, SSTAT2), &cur_col, 50);
   6631   1.96      fvdl 	ahc_sstat3_print(ahc_inb(ahc, SSTAT3), &cur_col, 50);
   6632   1.96      fvdl 	ahc_simode0_print(ahc_inb(ahc, SIMODE0), &cur_col, 50);
   6633   1.96      fvdl 	ahc_simode1_print(ahc_inb(ahc, SIMODE1), &cur_col, 50);
   6634   1.96      fvdl 	ahc_sxfrctl0_print(ahc_inb(ahc, SXFRCTL0), &cur_col, 50);
   6635   1.96      fvdl 	ahc_dfcntrl_print(ahc_inb(ahc, DFCNTRL), &cur_col, 50);
   6636   1.96      fvdl 	ahc_dfstatus_print(ahc_inb(ahc, DFSTATUS), &cur_col, 50);
   6637   1.96      fvdl 	if (cur_col != 0)
   6638   1.96      fvdl 		printf("\n");
   6639   1.96      fvdl 	printf("STACK:");
   6640   1.96      fvdl 	for (i = 0; i < STACK_SIZE; i++)
   6641   1.96      fvdl 	       printf(" 0x%x", ahc_inb(ahc, STACK)|(ahc_inb(ahc, STACK) << 8));
   6642   1.96      fvdl 	printf("\nSCB count = %d\n", ahc->scb_data->numscbs);
   6643   1.96      fvdl 	printf("Kernel NEXTQSCB = %d\n", ahc->next_queued_scb->hscb->tag);
   6644   1.96      fvdl 	printf("Card NEXTQSCB = %d\n", ahc_inb(ahc, NEXT_QUEUED_SCB));
   6645   1.96      fvdl 	/* QINFIFO */
   6646   1.96      fvdl 	printf("QINFIFO entries: ");
   6647   1.96      fvdl 	if ((ahc->features & AHC_QUEUE_REGS) != 0) {
   6648   1.96      fvdl 		qinpos = ahc_inb(ahc, SNSCB_QOFF);
   6649   1.96      fvdl 		ahc_outb(ahc, SNSCB_QOFF, qinpos);
   6650   1.96      fvdl 	} else
   6651   1.96      fvdl 		qinpos = ahc_inb(ahc, QINPOS);
   6652   1.42      fvdl 	qintail = ahc->qinfifonext;
   6653   1.42      fvdl 	while (qinpos != qintail) {
   6654   1.96      fvdl 		printf("%d ", ahc->qinfifo[qinpos]);
   6655   1.42      fvdl 		qinpos++;
   6656   1.42      fvdl 	}
   6657   1.96      fvdl 	printf("\n");
   6658   1.42      fvdl 
   6659   1.96      fvdl 	printf("Waiting Queue entries: ");
   6660   1.96      fvdl 	scb_index = ahc_inb(ahc, WAITING_SCBH);
   6661   1.96      fvdl 	i = 0;
   6662   1.96      fvdl 	while (scb_index != SCB_LIST_NULL && i++ < 256) {
   6663   1.96      fvdl 		ahc_outb(ahc, SCBPTR, scb_index);
   6664   1.96      fvdl 		printf("%d:%d ", scb_index, ahc_inb(ahc, SCB_TAG));
   6665   1.96      fvdl 		scb_index = ahc_inb(ahc, SCB_NEXT);
   6666    1.6   mycroft 	}
   6667   1.96      fvdl 	printf("\n");
   6668    1.1   mycroft 
   6669   1.96      fvdl 	printf("Disconnected Queue entries: ");
   6670   1.96      fvdl 	scb_index = ahc_inb(ahc, DISCONNECTED_SCBH);
   6671   1.96      fvdl 	i = 0;
   6672   1.96      fvdl 	while (scb_index != SCB_LIST_NULL && i++ < 256) {
   6673   1.96      fvdl 		ahc_outb(ahc, SCBPTR, scb_index);
   6674   1.96      fvdl 		printf("%d:%d ", scb_index, ahc_inb(ahc, SCB_TAG));
   6675   1.96      fvdl 		scb_index = ahc_inb(ahc, SCB_NEXT);
   6676   1.96      fvdl 	}
   6677   1.96      fvdl 	printf("\n");
   6678   1.96      fvdl 
   6679   1.96      fvdl 	ahc_sync_qoutfifo(ahc, BUS_DMASYNC_POSTREAD);
   6680   1.96      fvdl 	printf("QOUTFIFO entries: ");
   6681   1.96      fvdl 	qoutpos = ahc->qoutfifonext;
   6682   1.96      fvdl 	i = 0;
   6683   1.96      fvdl 	while (ahc->qoutfifo[qoutpos] != SCB_LIST_NULL && i++ < 256) {
   6684   1.96      fvdl 		printf("%d ", ahc->qoutfifo[qoutpos]);
   6685   1.96      fvdl 		qoutpos++;
   6686    1.1   mycroft 	}
   6687   1.96      fvdl 	printf("\n");
   6688   1.42      fvdl 
   6689   1.96      fvdl 	printf("Sequencer Free SCB List: ");
   6690   1.96      fvdl 	scb_index = ahc_inb(ahc, FREE_SCBH);
   6691   1.96      fvdl 	i = 0;
   6692   1.96      fvdl 	while (scb_index != SCB_LIST_NULL && i++ < 256) {
   6693   1.96      fvdl 		ahc_outb(ahc, SCBPTR, scb_index);
   6694   1.96      fvdl 		printf("%d ", scb_index);
   6695   1.96      fvdl 		scb_index = ahc_inb(ahc, SCB_NEXT);
   6696   1.96      fvdl 	}
   6697   1.96      fvdl 	printf("\n");
   6698   1.42      fvdl 
   6699   1.96      fvdl 	printf("Sequencer SCB Info: ");
   6700   1.96      fvdl 	for (i = 0; i < ahc->scb_data->maxhscbs; i++) {
   6701   1.42      fvdl 		ahc_outb(ahc, SCBPTR, i);
   6702   1.96      fvdl 		/*cur_col =*/ printf("\n%3d ", i);
   6703   1.96      fvdl 
   6704   1.96      fvdl 		ahc_scb_control_print(ahc_inb(ahc, SCB_CONTROL), &cur_col, 60);
   6705   1.96      fvdl 		ahc_scb_scsiid_print(ahc_inb(ahc, SCB_SCSIID), &cur_col, 60);
   6706   1.96      fvdl 		ahc_scb_lun_print(ahc_inb(ahc, SCB_LUN), &cur_col, 60);
   6707   1.96      fvdl 		ahc_scb_tag_print(ahc_inb(ahc, SCB_TAG), &cur_col, 60);
   6708   1.42      fvdl 	}
   6709   1.96      fvdl 	printf("\n");
   6710   1.42      fvdl 
   6711   1.96      fvdl 	printf("Pending list: ");
   6712   1.96      fvdl 	i = 0;
   6713   1.96      fvdl 	LIST_FOREACH(scb, &ahc->pending_scbs, pending_links) {
   6714   1.96      fvdl 		if (i++ > 256)
   6715   1.96      fvdl 			break;
   6716   1.96      fvdl 		/*cur_col =*/ printf("\n%3d ", scb->hscb->tag);
   6717   1.96      fvdl 		ahc_scb_control_print(scb->hscb->control, &cur_col, 60);
   6718   1.96      fvdl 		ahc_scb_scsiid_print(scb->hscb->scsiid, &cur_col, 60);
   6719   1.96      fvdl 		ahc_scb_lun_print(scb->hscb->lun, &cur_col, 60);
   6720   1.96      fvdl 		if ((ahc->flags & AHC_PAGESCBS) == 0) {
   6721   1.96      fvdl 			ahc_outb(ahc, SCBPTR, scb->hscb->tag);
   6722   1.96      fvdl 			printf("(");
   6723   1.96      fvdl 			ahc_scb_control_print(ahc_inb(ahc, SCB_CONTROL),
   6724   1.96      fvdl 					      &cur_col, 60);
   6725   1.96      fvdl 			ahc_scb_tag_print(ahc_inb(ahc, SCB_TAG), &cur_col, 60);
   6726   1.96      fvdl 			printf(")");
   6727    1.6   mycroft 		}
   6728   1.42      fvdl 	}
   6729   1.96      fvdl 	printf("\n");
   6730    1.6   mycroft 
   6731   1.96      fvdl 	printf("Kernel Free SCB list: ");
   6732   1.96      fvdl 	i = 0;
   6733   1.96      fvdl 	SLIST_FOREACH(scb, &ahc->scb_data->free_scbs, links.sle) {
   6734   1.96      fvdl 		if (i++ > 256)
   6735   1.96      fvdl 			break;
   6736   1.96      fvdl 		printf("%d ", scb->hscb->tag);
   6737   1.96      fvdl 	}
   6738   1.96      fvdl 	printf("\n");
   6739   1.42      fvdl 
   6740   1.96      fvdl 	maxtarget = (ahc->features & (AHC_WIDE|AHC_TWIN)) ? 15 : 7;
   6741   1.96      fvdl 	for (target = 0; target <= maxtarget; target++) {
   6742   1.96      fvdl 		untagged_q = &ahc->untagged_queues[target];
   6743   1.96      fvdl 		if (TAILQ_FIRST(untagged_q) == NULL)
   6744   1.96      fvdl 			continue;
   6745   1.96      fvdl 		printf("Untagged Q(%d): ", target);
   6746   1.96      fvdl 		i = 0;
   6747   1.96      fvdl 		TAILQ_FOREACH(scb, untagged_q, links.tqe) {
   6748   1.96      fvdl 			if (i++ > 256)
   6749   1.42      fvdl 				break;
   6750   1.96      fvdl 			printf("%d ", scb->hscb->tag);
   6751   1.42      fvdl 		}
   6752   1.96      fvdl 		printf("\n");
   6753   1.42      fvdl 	}
   6754   1.96      fvdl 
   6755   1.96      fvdl 	ahc_platform_dump_card_state(ahc);
   6756   1.96      fvdl 	printf("\n<<<<<<<<<<<<<<<<< Dump Card State Ends >>>>>>>>>>>>>>>>>>\n");
   6757   1.96      fvdl 	ahc_outb(ahc, SCBPTR, saved_scbptr);
   6758   1.96      fvdl 	if (paused == 0)
   6759   1.96      fvdl 		ahc_unpause(ahc);
   6760   1.42      fvdl }
   6761   1.42      fvdl 
   6762   1.96      fvdl /************************* Target Mode ****************************************/
   6763   1.96      fvdl #ifdef AHC_TARGET_MODE
   6764   1.96      fvdl cam_status
   6765   1.96      fvdl ahc_find_tmode_devs(struct ahc_softc *ahc, struct cam_sim *sim, union ccb *ccb,
   6766   1.96      fvdl 		    struct ahc_tmode_tstate **tstate,
   6767   1.96      fvdl 		    struct ahc_tmode_lstate **lstate,
   6768   1.96      fvdl 		    int notfound_failure)
   6769   1.42      fvdl {
   6770   1.42      fvdl 
   6771   1.96      fvdl 	if ((ahc->features & AHC_TARGETMODE) == 0)
   6772   1.96      fvdl 		return (CAM_REQ_INVALID);
   6773   1.42      fvdl 
   6774   1.96      fvdl 	/*
   6775   1.96      fvdl 	 * Handle the 'black hole' device that sucks up
   6776   1.96      fvdl 	 * requests to unattached luns on enabled targets.
   6777   1.96      fvdl 	 */
   6778   1.96      fvdl 	if (ccb->ccb_h.target_id == CAM_TARGET_WILDCARD
   6779   1.96      fvdl 	 && ccb->ccb_h.target_lun == CAM_LUN_WILDCARD) {
   6780   1.96      fvdl 		*tstate = NULL;
   6781   1.96      fvdl 		*lstate = ahc->black_hole;
   6782   1.96      fvdl 	} else {
   6783   1.96      fvdl 		u_int max_id;
   6784   1.42      fvdl 
   6785   1.96      fvdl 		max_id = (ahc->features & AHC_WIDE) ? 15 : 7;
   6786   1.96      fvdl 		if (ccb->ccb_h.target_id > max_id)
   6787   1.96      fvdl 			return (CAM_TID_INVALID);
   6788   1.42      fvdl 
   6789   1.96      fvdl 		if (ccb->ccb_h.target_lun >= AHC_NUM_LUNS)
   6790   1.96      fvdl 			return (CAM_LUN_INVALID);
   6791   1.42      fvdl 
   6792   1.96      fvdl 		*tstate = ahc->enabled_targets[ccb->ccb_h.target_id];
   6793   1.96      fvdl 		*lstate = NULL;
   6794   1.96      fvdl 		if (*tstate != NULL)
   6795   1.96      fvdl 			*lstate =
   6796   1.96      fvdl 			    (*tstate)->enabled_luns[ccb->ccb_h.target_lun];
   6797   1.96      fvdl 	}
   6798   1.42      fvdl 
   6799   1.96      fvdl 	if (notfound_failure != 0 && *lstate == NULL)
   6800   1.96      fvdl 		return (CAM_PATH_INVALID);
   6801   1.42      fvdl 
   6802   1.96      fvdl 	return (CAM_REQ_CMP);
   6803   1.42      fvdl }
   6804   1.42      fvdl 
   6805   1.96      fvdl void
   6806   1.96      fvdl ahc_handle_en_lun(struct ahc_softc *ahc, struct cam_sim *sim, union ccb *ccb)
   6807   1.59        pk {
   6808   1.96      fvdl 	struct	   ahc_tmode_tstate *tstate;
   6809   1.96      fvdl 	struct	   ahc_tmode_lstate *lstate;
   6810   1.96      fvdl 	struct	   ccb_en_lun *cel;
   6811   1.96      fvdl 	cam_status status;
   6812   1.96      fvdl 	u_int	   target;
   6813   1.96      fvdl 	u_int	   lun;
   6814   1.96      fvdl 	u_int	   target_mask;
   6815   1.96      fvdl 	u_int	   our_id;
   6816   1.96      fvdl 	u_long	   s;
   6817   1.96      fvdl 	char	   channel;
   6818    1.6   mycroft 
   6819   1.96      fvdl 	status = ahc_find_tmode_devs(ahc, sim, ccb, &tstate, &lstate,
   6820   1.96      fvdl 				     /*notfound_failure*/FALSE);
   6821   1.42      fvdl 
   6822   1.96      fvdl 	if (status != CAM_REQ_CMP) {
   6823   1.96      fvdl 		ccb->ccb_h.status = status;
   6824   1.96      fvdl 		return;
   6825   1.96      fvdl 	}
   6826    1.6   mycroft 
   6827   1.96      fvdl 	if (cam_sim_bus(sim) == 0)
   6828   1.96      fvdl 		our_id = ahc->our_id;
   6829   1.96      fvdl 	else
   6830   1.96      fvdl 		our_id = ahc->our_id_b;
   6831   1.42      fvdl 
   6832   1.96      fvdl 	if (ccb->ccb_h.target_id != our_id) {
   6833   1.42      fvdl 		/*
   6834   1.96      fvdl 		 * our_id represents our initiator ID, or
   6835   1.96      fvdl 		 * the ID of the first target to have an
   6836   1.96      fvdl 		 * enabled lun in target mode.  There are
   6837   1.96      fvdl 		 * two cases that may preclude enabling a
   6838   1.96      fvdl 		 * target id other than our_id.
   6839   1.96      fvdl 		 *
   6840   1.96      fvdl 		 *   o our_id is for an active initiator role.
   6841   1.96      fvdl 		 *     Since the hardware does not support
   6842   1.96      fvdl 		 *     reselections to the initiator role at
   6843   1.96      fvdl 		 *     anything other than our_id, and our_id
   6844   1.96      fvdl 		 *     is used by the hardware to indicate the
   6845   1.96      fvdl 		 *     ID to use for both select-out and
   6846   1.96      fvdl 		 *     reselect-out operations, the only target
   6847   1.96      fvdl 		 *     ID we can support in this mode is our_id.
   6848   1.96      fvdl 		 *
   6849   1.96      fvdl 		 *   o The MULTARGID feature is not available and
   6850   1.96      fvdl 		 *     a previous target mode ID has been enabled.
   6851   1.42      fvdl 		 */
   6852   1.96      fvdl 		if ((ahc->features & AHC_MULTIROLE) != 0) {
   6853   1.96      fvdl 
   6854   1.96      fvdl 			if ((ahc->features & AHC_MULTI_TID) != 0
   6855   1.96      fvdl 		   	 && (ahc->flags & AHC_INITIATORROLE) != 0) {
   6856   1.96      fvdl 				/*
   6857   1.96      fvdl 				 * Only allow additional targets if
   6858   1.96      fvdl 				 * the initiator role is disabled.
   6859   1.96      fvdl 				 * The hardware cannot handle a re-select-in
   6860   1.96      fvdl 				 * on the initiator id during a re-select-out
   6861   1.96      fvdl 				 * on a different target id.
   6862   1.96      fvdl 				 */
   6863   1.96      fvdl 				status = CAM_TID_INVALID;
   6864   1.96      fvdl 			} else if ((ahc->flags & AHC_INITIATORROLE) != 0
   6865   1.96      fvdl 				|| ahc->enabled_luns > 0) {
   6866   1.96      fvdl 				/*
   6867   1.96      fvdl 				 * Only allow our target id to change
   6868   1.96      fvdl 				 * if the initiator role is not configured
   6869   1.96      fvdl 				 * and there are no enabled luns which
   6870   1.96      fvdl 				 * are attached to the currently registered
   6871   1.96      fvdl 				 * scsi id.
   6872   1.96      fvdl 				 */
   6873   1.96      fvdl 				status = CAM_TID_INVALID;
   6874   1.96      fvdl 			}
   6875   1.96      fvdl 		} else if ((ahc->features & AHC_MULTI_TID) == 0
   6876   1.96      fvdl 			&& ahc->enabled_luns > 0) {
   6877   1.96      fvdl 
   6878   1.96      fvdl 			status = CAM_TID_INVALID;
   6879   1.96      fvdl 		}
   6880   1.96      fvdl 	}
   6881   1.96      fvdl 
   6882   1.96      fvdl 	if (status != CAM_REQ_CMP) {
   6883   1.96      fvdl 		ccb->ccb_h.status = status;
   6884   1.96      fvdl 		return;
   6885    1.1   mycroft 	}
   6886   1.42      fvdl 
   6887    1.1   mycroft 	/*
   6888   1.96      fvdl 	 * We now have an id that is valid.
   6889   1.96      fvdl 	 * If we aren't in target mode, switch modes.
   6890   1.42      fvdl 	 */
   6891   1.96      fvdl 	if ((ahc->flags & AHC_TARGETROLE) == 0
   6892   1.96      fvdl 	 && ccb->ccb_h.target_id != CAM_TARGET_WILDCARD) {
   6893   1.96      fvdl 		u_long	s;
   6894   1.96      fvdl 
   6895   1.96      fvdl 		printf("Configuring Target Mode\n");
   6896   1.96      fvdl 		ahc_lock(ahc, &s);
   6897   1.96      fvdl 		if (LIST_FIRST(&ahc->pending_scbs) != NULL) {
   6898   1.96      fvdl 			ccb->ccb_h.status = CAM_BUSY;
   6899   1.96      fvdl 			ahc_unlock(ahc, &s);
   6900   1.96      fvdl 			return;
   6901   1.96      fvdl 		}
   6902   1.96      fvdl 		ahc->flags |= AHC_TARGETROLE;
   6903   1.96      fvdl 		if ((ahc->features & AHC_MULTIROLE) == 0)
   6904   1.96      fvdl 			ahc->flags &= ~AHC_INITIATORROLE;
   6905   1.96      fvdl 		ahc_pause(ahc);
   6906   1.96      fvdl 		ahc_loadseq(ahc);
   6907   1.96      fvdl 		ahc_unlock(ahc, &s);
   6908   1.96      fvdl 	}
   6909   1.96      fvdl 	cel = &ccb->cel;
   6910   1.96      fvdl 	target = ccb->ccb_h.target_id;
   6911   1.96      fvdl 	lun = ccb->ccb_h.target_lun;
   6912   1.96      fvdl 	channel = SIM_CHANNEL(ahc, sim);
   6913   1.96      fvdl 	target_mask = 0x01 << target;
   6914   1.96      fvdl 	if (channel == 'B')
   6915   1.96      fvdl 		target_mask <<= 8;
   6916   1.42      fvdl 
   6917   1.96      fvdl 	if (cel->enable != 0) {
   6918   1.96      fvdl 		u_int scsiseq;
   6919   1.42      fvdl 
   6920   1.96      fvdl 		/* Are we already enabled?? */
   6921   1.96      fvdl 		if (lstate != NULL) {
   6922   1.96      fvdl 			xpt_print_path(ccb->ccb_h.path);
   6923   1.96      fvdl 			printf("Lun already enabled\n");
   6924   1.96      fvdl 			ccb->ccb_h.status = CAM_LUN_ALRDY_ENA;
   6925   1.96      fvdl 			return;
   6926   1.96      fvdl 		}
   6927   1.42      fvdl 
   6928   1.96      fvdl 		if (cel->grp6_len != 0
   6929   1.96      fvdl 		 || cel->grp7_len != 0) {
   6930   1.96      fvdl 			/*
   6931   1.96      fvdl 			 * Don't (yet?) support vendor
   6932   1.96      fvdl 			 * specific commands.
   6933   1.96      fvdl 			 */
   6934   1.96      fvdl 			ccb->ccb_h.status = CAM_REQ_INVALID;
   6935   1.96      fvdl 			printf("Non-zero Group Codes\n");
   6936   1.96      fvdl 			return;
   6937   1.96      fvdl 		}
   6938   1.42      fvdl 
   6939   1.96      fvdl 		/*
   6940   1.96      fvdl 		 * Seems to be okay.
   6941   1.96      fvdl 		 * Setup our data structures.
   6942   1.96      fvdl 		 */
   6943   1.96      fvdl 		if (target != CAM_TARGET_WILDCARD && tstate == NULL) {
   6944   1.96      fvdl 			tstate = ahc_alloc_tstate(ahc, target, channel);
   6945   1.96      fvdl 			if (tstate == NULL) {
   6946   1.96      fvdl 				xpt_print_path(ccb->ccb_h.path);
   6947   1.96      fvdl 				printf("Couldn't allocate tstate\n");
   6948   1.96      fvdl 				ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
   6949   1.96      fvdl 				return;
   6950   1.96      fvdl 			}
   6951   1.96      fvdl 		}
   6952   1.96      fvdl 		lstate = malloc(sizeof(*lstate), M_DEVBUF, M_NOWAIT);
   6953   1.96      fvdl 		if (lstate == NULL) {
   6954   1.96      fvdl 			xpt_print_path(ccb->ccb_h.path);
   6955   1.96      fvdl 			printf("Couldn't allocate lstate\n");
   6956   1.96      fvdl 			ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
   6957   1.96      fvdl 			return;
   6958   1.96      fvdl 		}
   6959   1.96      fvdl 		memset(lstate, 0, sizeof(*lstate));
   6960   1.96      fvdl 		status = xpt_create_path(&lstate->path, /*periph*/NULL,
   6961   1.96      fvdl 					 xpt_path_path_id(ccb->ccb_h.path),
   6962   1.96      fvdl 					 xpt_path_target_id(ccb->ccb_h.path),
   6963   1.96      fvdl 					 xpt_path_lun_id(ccb->ccb_h.path));
   6964   1.96      fvdl 		if (status != CAM_REQ_CMP) {
   6965   1.96      fvdl 			free(lstate, M_DEVBUF);
   6966   1.96      fvdl 			xpt_print_path(ccb->ccb_h.path);
   6967   1.96      fvdl 			printf("Couldn't allocate path\n");
   6968   1.96      fvdl 			ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
   6969   1.96      fvdl 			return;
   6970   1.96      fvdl 		}
   6971   1.96      fvdl 		SLIST_INIT(&lstate->accept_tios);
   6972   1.96      fvdl 		SLIST_INIT(&lstate->immed_notifies);
   6973   1.96      fvdl 		ahc_lock(ahc, &s);
   6974   1.96      fvdl 		ahc_pause(ahc);
   6975   1.96      fvdl 		if (target != CAM_TARGET_WILDCARD) {
   6976   1.96      fvdl 			tstate->enabled_luns[lun] = lstate;
   6977   1.96      fvdl 			ahc->enabled_luns++;
   6978   1.96      fvdl 
   6979   1.96      fvdl 			if ((ahc->features & AHC_MULTI_TID) != 0) {
   6980   1.96      fvdl 				u_int targid_mask;
   6981   1.96      fvdl 
   6982   1.96      fvdl 				targid_mask = ahc_inb(ahc, TARGID)
   6983   1.96      fvdl 					    | (ahc_inb(ahc, TARGID + 1) << 8);
   6984   1.96      fvdl 
   6985   1.96      fvdl 				targid_mask |= target_mask;
   6986   1.96      fvdl 				ahc_outb(ahc, TARGID, targid_mask);
   6987   1.96      fvdl 				ahc_outb(ahc, TARGID+1, (targid_mask >> 8));
   6988   1.96      fvdl 
   6989   1.96      fvdl 				ahc_update_scsiid(ahc, targid_mask);
   6990   1.96      fvdl 			} else {
   6991   1.96      fvdl 				u_int our_id;
   6992   1.96      fvdl 				char  channel;
   6993   1.42      fvdl 
   6994   1.96      fvdl 				channel = SIM_CHANNEL(ahc, sim);
   6995   1.96      fvdl 				our_id = SIM_SCSI_ID(ahc, sim);
   6996   1.42      fvdl 
   6997   1.96      fvdl 				/*
   6998   1.96      fvdl 				 * This can only happen if selections
   6999   1.96      fvdl 				 * are not enabled
   7000   1.96      fvdl 				 */
   7001   1.96      fvdl 				if (target != our_id) {
   7002   1.96      fvdl 					u_int sblkctl;
   7003   1.96      fvdl 					char  cur_channel;
   7004   1.96      fvdl 					int   swap;
   7005   1.96      fvdl 
   7006   1.96      fvdl 					sblkctl = ahc_inb(ahc, SBLKCTL);
   7007   1.96      fvdl 					cur_channel = (sblkctl & SELBUSB)
   7008   1.96      fvdl 						    ? 'B' : 'A';
   7009   1.96      fvdl 					if ((ahc->features & AHC_TWIN) == 0)
   7010   1.96      fvdl 						cur_channel = 'A';
   7011   1.96      fvdl 					swap = cur_channel != channel;
   7012   1.96      fvdl 					if (channel == 'A')
   7013   1.96      fvdl 						ahc->our_id = target;
   7014   1.96      fvdl 					else
   7015   1.96      fvdl 						ahc->our_id_b = target;
   7016   1.96      fvdl 
   7017   1.96      fvdl 					if (swap)
   7018   1.96      fvdl 						ahc_outb(ahc, SBLKCTL,
   7019   1.96      fvdl 							 sblkctl ^ SELBUSB);
   7020   1.42      fvdl 
   7021   1.96      fvdl 					ahc_outb(ahc, SCSIID, target);
   7022   1.42      fvdl 
   7023   1.96      fvdl 					if (swap)
   7024   1.96      fvdl 						ahc_outb(ahc, SBLKCTL, sblkctl);
   7025   1.96      fvdl 				}
   7026   1.96      fvdl 			}
   7027   1.96      fvdl 		} else
   7028   1.96      fvdl 			ahc->black_hole = lstate;
   7029   1.96      fvdl 		/* Allow select-in operations */
   7030   1.96      fvdl 		if (ahc->black_hole != NULL && ahc->enabled_luns > 0) {
   7031   1.96      fvdl 			scsiseq = ahc_inb(ahc, SCSISEQ_TEMPLATE);
   7032   1.96      fvdl 			scsiseq |= ENSELI;
   7033   1.96      fvdl 			ahc_outb(ahc, SCSISEQ_TEMPLATE, scsiseq);
   7034   1.96      fvdl 			scsiseq = ahc_inb(ahc, SCSISEQ);
   7035   1.96      fvdl 			scsiseq |= ENSELI;
   7036   1.96      fvdl 			ahc_outb(ahc, SCSISEQ, scsiseq);
   7037   1.96      fvdl 		}
   7038   1.96      fvdl 		ahc_unpause(ahc);
   7039   1.96      fvdl 		ahc_unlock(ahc, &s);
   7040   1.96      fvdl 		ccb->ccb_h.status = CAM_REQ_CMP;
   7041   1.96      fvdl 		xpt_print_path(ccb->ccb_h.path);
   7042   1.96      fvdl 		printf("Lun now enabled for target mode\n");
   7043   1.42      fvdl 	} else {
   7044   1.96      fvdl 		struct scb *scb;
   7045   1.96      fvdl 		int i, empty;
   7046    1.6   mycroft 
   7047   1.96      fvdl 		if (lstate == NULL) {
   7048   1.96      fvdl 			ccb->ccb_h.status = CAM_LUN_INVALID;
   7049   1.96      fvdl 			return;
   7050   1.96      fvdl 		}
   7051   1.42      fvdl 
   7052   1.96      fvdl 		ahc_lock(ahc, &s);
   7053   1.96      fvdl 
   7054   1.96      fvdl 		ccb->ccb_h.status = CAM_REQ_CMP;
   7055   1.96      fvdl 		LIST_FOREACH(scb, &ahc->pending_scbs, pending_links) {
   7056   1.96      fvdl 			struct ccb_hdr *ccbh;
   7057   1.96      fvdl 
   7058   1.96      fvdl 			ccbh = &scb->io_ctx->ccb_h;
   7059   1.96      fvdl 			if (ccbh->func_code == XPT_CONT_TARGET_IO
   7060   1.96      fvdl 			 && !xpt_path_comp(ccbh->path, ccb->ccb_h.path)){
   7061   1.96      fvdl 				printf("CTIO pending\n");
   7062   1.96      fvdl 				ccb->ccb_h.status = CAM_REQ_INVALID;
   7063   1.96      fvdl 				ahc_unlock(ahc, &s);
   7064   1.96      fvdl 				return;
   7065   1.96      fvdl 			}
   7066   1.96      fvdl 		}
   7067   1.42      fvdl 
   7068   1.96      fvdl 		if (SLIST_FIRST(&lstate->accept_tios) != NULL) {
   7069   1.96      fvdl 			printf("ATIOs pending\n");
   7070   1.96      fvdl 			ccb->ccb_h.status = CAM_REQ_INVALID;
   7071   1.96      fvdl 		}
   7072   1.42      fvdl 
   7073   1.96      fvdl 		if (SLIST_FIRST(&lstate->immed_notifies) != NULL) {
   7074   1.96      fvdl 			printf("INOTs pending\n");
   7075   1.96      fvdl 			ccb->ccb_h.status = CAM_REQ_INVALID;
   7076   1.96      fvdl 		}
   7077   1.42      fvdl 
   7078   1.96      fvdl 		if (ccb->ccb_h.status != CAM_REQ_CMP) {
   7079   1.96      fvdl 			ahc_unlock(ahc, &s);
   7080   1.96      fvdl 			return;
   7081   1.42      fvdl 		}
   7082   1.42      fvdl 
   7083   1.96      fvdl 		xpt_print_path(ccb->ccb_h.path);
   7084   1.96      fvdl 		printf("Target mode disabled\n");
   7085   1.96      fvdl 		xpt_free_path(lstate->path);
   7086   1.96      fvdl 		free(lstate, M_DEVBUF);
   7087   1.96      fvdl 
   7088   1.96      fvdl 		ahc_pause(ahc);
   7089   1.96      fvdl 		/* Can we clean up the target too? */
   7090   1.96      fvdl 		if (target != CAM_TARGET_WILDCARD) {
   7091   1.96      fvdl 			tstate->enabled_luns[lun] = NULL;
   7092   1.96      fvdl 			ahc->enabled_luns--;
   7093   1.96      fvdl 			for (empty = 1, i = 0; i < 8; i++)
   7094   1.96      fvdl 				if (tstate->enabled_luns[i] != NULL) {
   7095   1.96      fvdl 					empty = 0;
   7096   1.96      fvdl 					break;
   7097   1.96      fvdl 				}
   7098   1.42      fvdl 
   7099   1.96      fvdl 			if (empty) {
   7100   1.96      fvdl 				ahc_free_tstate(ahc, target, channel,
   7101   1.96      fvdl 						/*force*/FALSE);
   7102   1.96      fvdl 				if (ahc->features & AHC_MULTI_TID) {
   7103   1.96      fvdl 					u_int targid_mask;
   7104   1.96      fvdl 
   7105   1.96      fvdl 					targid_mask = ahc_inb(ahc, TARGID)
   7106   1.96      fvdl 						    | (ahc_inb(ahc, TARGID + 1)
   7107   1.96      fvdl 						       << 8);
   7108   1.96      fvdl 
   7109   1.96      fvdl 					targid_mask &= ~target_mask;
   7110   1.96      fvdl 					ahc_outb(ahc, TARGID, targid_mask);
   7111   1.96      fvdl 					ahc_outb(ahc, TARGID+1,
   7112   1.96      fvdl 					 	 (targid_mask >> 8));
   7113   1.96      fvdl 					ahc_update_scsiid(ahc, targid_mask);
   7114   1.96      fvdl 				}
   7115   1.96      fvdl 			}
   7116   1.96      fvdl 		} else {
   7117   1.42      fvdl 
   7118   1.96      fvdl 			ahc->black_hole = NULL;
   7119   1.42      fvdl 
   7120   1.96      fvdl 			/*
   7121   1.96      fvdl 			 * We can't allow selections without
   7122   1.96      fvdl 			 * our black hole device.
   7123   1.96      fvdl 			 */
   7124   1.96      fvdl 			empty = TRUE;
   7125   1.96      fvdl 		}
   7126   1.96      fvdl 		if (ahc->enabled_luns == 0) {
   7127   1.96      fvdl 			/* Disallow select-in */
   7128   1.96      fvdl 			u_int scsiseq;
   7129   1.96      fvdl 
   7130   1.96      fvdl 			scsiseq = ahc_inb(ahc, SCSISEQ_TEMPLATE);
   7131   1.96      fvdl 			scsiseq &= ~ENSELI;
   7132   1.96      fvdl 			ahc_outb(ahc, SCSISEQ_TEMPLATE, scsiseq);
   7133   1.96      fvdl 			scsiseq = ahc_inb(ahc, SCSISEQ);
   7134   1.96      fvdl 			scsiseq &= ~ENSELI;
   7135   1.96      fvdl 			ahc_outb(ahc, SCSISEQ, scsiseq);
   7136   1.96      fvdl 
   7137   1.96      fvdl 			if ((ahc->features & AHC_MULTIROLE) == 0) {
   7138   1.96      fvdl 				printf("Configuring Initiator Mode\n");
   7139   1.96      fvdl 				ahc->flags &= ~AHC_TARGETROLE;
   7140   1.96      fvdl 				ahc->flags |= AHC_INITIATORROLE;
   7141   1.96      fvdl 				ahc_pause(ahc);
   7142   1.96      fvdl 				ahc_loadseq(ahc);
   7143   1.96      fvdl 			}
   7144   1.96      fvdl 		}
   7145   1.96      fvdl 		ahc_unpause(ahc);
   7146   1.96      fvdl 		ahc_unlock(ahc, &s);
   7147   1.96      fvdl 	}
   7148    1.6   mycroft }
   7149    1.6   mycroft 
   7150    1.6   mycroft static void
   7151   1.96      fvdl ahc_update_scsiid(struct ahc_softc *ahc, u_int targid_mask)
   7152    1.6   mycroft {
   7153   1.96      fvdl 	u_int scsiid_mask;
   7154   1.96      fvdl 	u_int scsiid;
   7155   1.96      fvdl 
   7156   1.96      fvdl 	if ((ahc->features & AHC_MULTI_TID) == 0)
   7157   1.96      fvdl 		panic("ahc_update_scsiid called on non-multitid unit\n");
   7158   1.96      fvdl 
   7159   1.96      fvdl 	/*
   7160   1.96      fvdl 	 * Since we will rely on the TARGID mask
   7161   1.96      fvdl 	 * for selection enables, ensure that OID
   7162   1.96      fvdl 	 * in SCSIID is not set to some other ID
   7163   1.96      fvdl 	 * that we don't want to allow selections on.
   7164   1.96      fvdl 	 */
   7165   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0)
   7166   1.96      fvdl 		scsiid = ahc_inb(ahc, SCSIID_ULTRA2);
   7167   1.96      fvdl 	else
   7168   1.96      fvdl 		scsiid = ahc_inb(ahc, SCSIID);
   7169   1.96      fvdl 	scsiid_mask = 0x1 << (scsiid & OID);
   7170   1.96      fvdl 	if ((targid_mask & scsiid_mask) == 0) {
   7171   1.96      fvdl 		u_int our_id;
   7172    1.1   mycroft 
   7173   1.96      fvdl 		/* ffs counts from 1 */
   7174   1.96      fvdl 		our_id = ffs(targid_mask);
   7175   1.96      fvdl 		if (our_id == 0)
   7176   1.96      fvdl 			our_id = ahc->our_id;
   7177   1.96      fvdl 		else
   7178   1.96      fvdl 			our_id--;
   7179   1.96      fvdl 		scsiid &= TID;
   7180   1.96      fvdl 		scsiid |= our_id;
   7181   1.96      fvdl 	}
   7182   1.96      fvdl 	if ((ahc->features & AHC_ULTRA2) != 0)
   7183   1.96      fvdl 		ahc_outb(ahc, SCSIID_ULTRA2, scsiid);
   7184   1.96      fvdl 	else
   7185   1.96      fvdl 		ahc_outb(ahc, SCSIID, scsiid);
   7186    1.1   mycroft }
   7187    1.1   mycroft 
   7188   1.96      fvdl void
   7189   1.96      fvdl ahc_run_tqinfifo(struct ahc_softc *ahc, int paused)
   7190    1.1   mycroft {
   7191   1.96      fvdl 	struct target_cmd *cmd;
   7192    1.6   mycroft 
   7193    1.6   mycroft 	/*
   7194   1.96      fvdl 	 * If the card supports auto-access pause,
   7195   1.96      fvdl 	 * we can access the card directly regardless
   7196   1.96      fvdl 	 * of whether it is paused or not.
   7197   1.96      fvdl 	 */
   7198   1.96      fvdl 	if ((ahc->features & AHC_AUTOPAUSE) != 0)
   7199   1.96      fvdl 		paused = TRUE;
   7200   1.59        pk 
   7201   1.96      fvdl 	ahc_sync_tqinfifo(ahc, BUS_DMASYNC_POSTREAD);
   7202   1.96      fvdl 	while ((cmd = &ahc->targetcmds[ahc->tqinfifonext])->cmd_valid != 0) {
   7203    1.1   mycroft 
   7204    1.6   mycroft 		/*
   7205   1.96      fvdl 		 * Only advance through the queue if we
   7206   1.96      fvdl 		 * have the resources to process the command.
   7207    1.6   mycroft 		 */
   7208   1.96      fvdl 		if (ahc_handle_target_cmd(ahc, cmd) != 0)
   7209   1.96      fvdl 			break;
   7210   1.42      fvdl 
   7211   1.96      fvdl 		cmd->cmd_valid = 0;
   7212   1.96      fvdl 		ahc_dmamap_sync(ahc, ahc->parent_dmat/*shared_data_dmat*/,
   7213   1.96      fvdl 				ahc->shared_data_dmamap,
   7214   1.96      fvdl 				ahc_targetcmd_offset(ahc, ahc->tqinfifonext),
   7215   1.96      fvdl 				sizeof(struct target_cmd),
   7216   1.96      fvdl 				BUS_DMASYNC_PREREAD);
   7217   1.96      fvdl 		ahc->tqinfifonext++;
   7218   1.96      fvdl 
   7219   1.96      fvdl 		/*
   7220   1.96      fvdl 		 * Lazily update our position in the target mode incoming
   7221   1.96      fvdl 		 * command queue as seen by the sequencer.
   7222   1.96      fvdl 		 */
   7223   1.96      fvdl 		if ((ahc->tqinfifonext & (HOST_TQINPOS - 1)) == 1) {
   7224   1.96      fvdl 			if ((ahc->features & AHC_HS_MAILBOX) != 0) {
   7225   1.96      fvdl 				u_int hs_mailbox;
   7226   1.96      fvdl 
   7227   1.96      fvdl 				hs_mailbox = ahc_inb(ahc, HS_MAILBOX);
   7228   1.96      fvdl 				hs_mailbox &= ~HOST_TQINPOS;
   7229   1.96      fvdl 				hs_mailbox |= ahc->tqinfifonext & HOST_TQINPOS;
   7230   1.96      fvdl 				ahc_outb(ahc, HS_MAILBOX, hs_mailbox);
   7231   1.96      fvdl 			} else {
   7232   1.96      fvdl 				if (!paused)
   7233   1.96      fvdl 					ahc_pause(ahc);
   7234   1.96      fvdl 				ahc_outb(ahc, KERNEL_TQINPOS,
   7235   1.96      fvdl 					 ahc->tqinfifonext & HOST_TQINPOS);
   7236   1.96      fvdl 				if (!paused)
   7237   1.96      fvdl 					ahc_unpause(ahc);
   7238   1.96      fvdl 			}
   7239    1.6   mycroft 		}
   7240   1.42      fvdl 	}
   7241   1.96      fvdl }
   7242   1.96      fvdl 
   7243   1.96      fvdl static int
   7244   1.96      fvdl ahc_handle_target_cmd(struct ahc_softc *ahc, struct target_cmd *cmd)
   7245   1.96      fvdl {
   7246   1.96      fvdl 	struct	  ahc_tmode_tstate *tstate;
   7247   1.96      fvdl 	struct	  ahc_tmode_lstate *lstate;
   7248   1.96      fvdl 	struct	  ccb_accept_tio *atio;
   7249   1.96      fvdl 	uint8_t *byte;
   7250   1.96      fvdl 	int	  initiator;
   7251   1.96      fvdl 	int	  target;
   7252   1.96      fvdl 	int	  lun;
   7253   1.96      fvdl 
   7254   1.96      fvdl 	initiator = SCSIID_TARGET(ahc, cmd->scsiid);
   7255   1.96      fvdl 	target = SCSIID_OUR_ID(cmd->scsiid);
   7256   1.96      fvdl 	lun    = (cmd->identify & MSG_IDENTIFY_LUNMASK);
   7257   1.96      fvdl 
   7258   1.96      fvdl 	byte = cmd->bytes;
   7259   1.96      fvdl 	tstate = ahc->enabled_targets[target];
   7260   1.96      fvdl 	lstate = NULL;
   7261   1.96      fvdl 	if (tstate != NULL)
   7262   1.96      fvdl 		lstate = tstate->enabled_luns[lun];
   7263   1.42      fvdl 
   7264   1.42      fvdl 	/*
   7265   1.96      fvdl 	 * Commands for disabled luns go to the black hole driver.
   7266   1.42      fvdl 	 */
   7267   1.96      fvdl 	if (lstate == NULL)
   7268   1.96      fvdl 		lstate = ahc->black_hole;
   7269   1.42      fvdl 
   7270   1.96      fvdl 	atio = (struct ccb_accept_tio*)SLIST_FIRST(&lstate->accept_tios);
   7271   1.96      fvdl 	if (atio == NULL) {
   7272   1.96      fvdl 		ahc->flags |= AHC_TQINFIFO_BLOCKED;
   7273   1.96      fvdl 		/*
   7274   1.96      fvdl 		 * Wait for more ATIOs from the peripheral driver for this lun.
   7275   1.96      fvdl 		 */
   7276   1.96      fvdl 		if (bootverbose)
   7277   1.96      fvdl 			printf("%s: ATIOs exhausted\n", ahc_name(ahc));
   7278   1.96      fvdl 		return (1);
   7279   1.96      fvdl 	} else
   7280   1.96      fvdl 		ahc->flags &= ~AHC_TQINFIFO_BLOCKED;
   7281   1.96      fvdl #if 0
   7282   1.96      fvdl 	printf("Incoming command from %d for %d:%d%s\n",
   7283   1.96      fvdl 	       initiator, target, lun,
   7284   1.96      fvdl 	       lstate == ahc->black_hole ? "(Black Holed)" : "");
   7285   1.42      fvdl #endif
   7286   1.96      fvdl 	SLIST_REMOVE_HEAD(&lstate->accept_tios, sim_links.sle);
   7287   1.42      fvdl 
   7288   1.96      fvdl 	if (lstate == ahc->black_hole) {
   7289   1.96      fvdl 		/* Fill in the wildcards */
   7290   1.96      fvdl 		atio->ccb_h.target_id = target;
   7291   1.96      fvdl 		atio->ccb_h.target_lun = lun;
   7292   1.96      fvdl 	}
   7293   1.42      fvdl 
   7294   1.42      fvdl 	/*
   7295   1.96      fvdl 	 * Package it up and send it off to
   7296   1.96      fvdl 	 * whomever has this lun enabled.
   7297   1.42      fvdl 	 */
   7298   1.96      fvdl 	atio->sense_len = 0;
   7299   1.96      fvdl 	atio->init_id = initiator;
   7300   1.96      fvdl 	if (byte[0] != 0xFF) {
   7301   1.96      fvdl 		/* Tag was included */
   7302   1.96      fvdl 		atio->tag_action = *byte++;
   7303   1.96      fvdl 		atio->tag_id = *byte++;
   7304   1.96      fvdl 		atio->ccb_h.flags = CAM_TAG_ACTION_VALID;
   7305   1.96      fvdl 	} else {
   7306   1.96      fvdl 		atio->ccb_h.flags = 0;
   7307   1.42      fvdl 	}
   7308   1.96      fvdl 	byte++;
   7309   1.42      fvdl 
   7310   1.96      fvdl 	/* Okay.  Now determine the cdb size based on the command code */
   7311   1.96      fvdl 	switch (*byte >> CMD_GROUP_CODE_SHIFT) {
   7312   1.96      fvdl 	case 0:
   7313   1.96      fvdl 		atio->cdb_len = 6;
   7314   1.96      fvdl 		break;
   7315   1.96      fvdl 	case 1:
   7316   1.96      fvdl 	case 2:
   7317   1.96      fvdl 		atio->cdb_len = 10;
   7318   1.96      fvdl 		break;
   7319   1.96      fvdl 	case 4:
   7320   1.96      fvdl 		atio->cdb_len = 16;
   7321   1.96      fvdl 		break;
   7322   1.96      fvdl 	case 5:
   7323   1.96      fvdl 		atio->cdb_len = 12;
   7324   1.96      fvdl 		break;
   7325   1.96      fvdl 	case 3:
   7326   1.96      fvdl 	default:
   7327   1.96      fvdl 		/* Only copy the opcode. */
   7328   1.96      fvdl 		atio->cdb_len = 1;
   7329   1.96      fvdl 		printf("Reserved or VU command code type encountered\n");
   7330   1.96      fvdl 		break;
   7331    1.1   mycroft 	}
   7332   1.96      fvdl 
   7333   1.96      fvdl 	memcpy(atio->cdb_io.cdb_bytes, byte, atio->cdb_len);
   7334   1.42      fvdl 
   7335   1.96      fvdl 	atio->ccb_h.status |= CAM_CDB_RECVD;
   7336   1.42      fvdl 
   7337   1.96      fvdl 	if ((cmd->identify & MSG_IDENTIFY_DISCFLAG) == 0) {
   7338   1.96      fvdl 		/*
   7339   1.96      fvdl 		 * We weren't allowed to disconnect.
   7340   1.96      fvdl 		 * We're hanging on the bus until a
   7341   1.96      fvdl 		 * continue target I/O comes in response
   7342   1.96      fvdl 		 * to this accept tio.
   7343   1.96      fvdl 		 */
   7344   1.96      fvdl #if 0
   7345   1.96      fvdl 		printf("Received Immediate Command %d:%d:%d - %p\n",
   7346   1.96      fvdl 		       initiator, target, lun, ahc->pending_device);
   7347   1.96      fvdl #endif
   7348   1.96      fvdl 		ahc->pending_device = lstate;
   7349   1.96      fvdl 		ahc_freeze_ccb((union ccb *)atio);
   7350   1.96      fvdl 		atio->ccb_h.flags |= CAM_DIS_DISCONNECT;
   7351    1.1   mycroft 	}
   7352   1.96      fvdl 	xpt_done((union ccb*)atio);
   7353   1.96      fvdl 	return (0);
   7354    1.6   mycroft }
   7355   1.42      fvdl #endif
   7356   1.42      fvdl 
   7357   1.96      fvdl static int
   7358   1.96      fvdl ahc_createdmamem(tag, size, flags, mapp, vaddr, baddr, seg, nseg, myname, what)
   7359   1.96      fvdl 	bus_dma_tag_t tag;
   7360   1.96      fvdl 	int size;
   7361   1.96      fvdl 	int flags;
   7362   1.96      fvdl 	bus_dmamap_t *mapp;
   7363   1.96      fvdl 	caddr_t *vaddr;
   7364   1.96      fvdl 	bus_addr_t *baddr;
   7365   1.96      fvdl 	bus_dma_segment_t *seg;
   7366   1.96      fvdl 	int *nseg;
   7367   1.96      fvdl 	const char *myname, *what;
   7368    1.6   mycroft {
   7369   1.96      fvdl 	int error, level = 0;
   7370   1.42      fvdl 
   7371   1.96      fvdl 	if ((error = bus_dmamem_alloc(tag, size, PAGE_SIZE, 0,
   7372   1.96      fvdl 				      seg, 1, nseg, BUS_DMA_NOWAIT)) != 0) {
   7373   1.96      fvdl 		printf("%s: failed to allocate DMA mem for %s, error = %d\n",
   7374   1.96      fvdl 			myname, what, error);
   7375   1.96      fvdl 		goto out;
   7376   1.96      fvdl 	}
   7377   1.96      fvdl 	level++;
   7378   1.42      fvdl 
   7379   1.96      fvdl 	if ((error = bus_dmamem_map(tag, seg, *nseg, size, vaddr,
   7380   1.96      fvdl 				    BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) != 0) {
   7381   1.96      fvdl 		printf("%s: failed to map DMA mem for %s, error = %d\n",
   7382   1.96      fvdl 			myname, what, error);
   7383   1.96      fvdl 		goto out;
   7384   1.96      fvdl 	}
   7385   1.96      fvdl 	level++;
   7386   1.42      fvdl 
   7387   1.96      fvdl 	if ((error = bus_dmamap_create(tag, size, 1, size, 0,
   7388   1.96      fvdl 				       BUS_DMA_NOWAIT | flags, mapp)) != 0) {
   7389   1.96      fvdl                 printf("%s: failed to create DMA map for %s, error = %d\n",
   7390   1.96      fvdl 			myname, what, error);
   7391   1.96      fvdl 		goto out;
   7392   1.96      fvdl         }
   7393   1.96      fvdl 	level++;
   7394   1.42      fvdl 
   7395   1.42      fvdl 
   7396   1.96      fvdl 	if ((error = bus_dmamap_load(tag, *mapp, *vaddr, size, NULL,
   7397   1.96      fvdl 				     BUS_DMA_NOWAIT)) != 0) {
   7398   1.96      fvdl                 printf("%s: failed to load DMA map for %s, error = %d\n",
   7399   1.96      fvdl 			myname, what, error);
   7400   1.96      fvdl 		goto out;
   7401   1.96      fvdl         }
   7402   1.42      fvdl 
   7403   1.96      fvdl 	*baddr = (*mapp)->dm_segs[0].ds_addr;
   7404    1.1   mycroft 
   7405   1.96      fvdl 	return 0;
   7406   1.96      fvdl out:
   7407   1.96      fvdl 	printf("ahc_createdmamem error (%d)\n", level);
   7408   1.96      fvdl 	switch (level) {
   7409   1.96      fvdl 	case 3:
   7410   1.96      fvdl 		bus_dmamap_destroy(tag, *mapp);
   7411   1.96      fvdl 		/* FALLTHROUGH */
   7412   1.96      fvdl 	case 2:
   7413   1.96      fvdl 		bus_dmamem_unmap(tag, *vaddr, size);
   7414   1.96      fvdl 		/* FALLTHROUGH */
   7415   1.96      fvdl 	case 1:
   7416   1.96      fvdl 		bus_dmamem_free(tag, seg, *nseg);
   7417   1.96      fvdl 		break;
   7418   1.96      fvdl 	default:
   7419   1.96      fvdl 		break;
   7420   1.42      fvdl 	}
   7421   1.14     gibbs 
   7422   1.96      fvdl 	return error;
   7423   1.14     gibbs }
   7424   1.14     gibbs 
   7425   1.14     gibbs static void
   7426   1.96      fvdl ahc_freedmamem(tag, size, map, vaddr, seg, nseg)
   7427   1.96      fvdl 	bus_dma_tag_t tag;
   7428   1.96      fvdl 	int size;
   7429   1.96      fvdl 	bus_dmamap_t map;
   7430   1.96      fvdl 	caddr_t vaddr;
   7431   1.96      fvdl 	bus_dma_segment_t *seg;
   7432   1.96      fvdl 	int nseg;
   7433   1.14     gibbs {
   7434   1.42      fvdl 
   7435   1.96      fvdl 	bus_dmamap_unload(tag, map);
   7436   1.96      fvdl 	bus_dmamap_destroy(tag, map);
   7437   1.96      fvdl 	bus_dmamem_unmap(tag, vaddr, size);
   7438   1.96      fvdl 	bus_dmamem_free(tag, seg, nseg);
   7439   1.45      fvdl }
   7440