Home | History | Annotate | Line # | Download | only in pci
trm.c revision 1.21.6.2
      1  1.21.6.2    kardel /*	$NetBSD: trm.c,v 1.21.6.2 2006/06/01 22:36:49 kardel Exp $	*/
      2       1.1   tsutsui /*
      3       1.1   tsutsui  * Device Driver for Tekram DC395U/UW/F, DC315/U
      4       1.1   tsutsui  * PCI SCSI Bus Master Host Adapter
      5       1.1   tsutsui  * (SCSI chip set used Tekram ASIC TRM-S1040)
      6       1.1   tsutsui  *
      7       1.7   tsutsui  * Copyright (c) 2002 Izumi Tsutsui
      8       1.1   tsutsui  * Copyright (c) 2001 Rui-Xiang Guo
      9       1.1   tsutsui  * All rights reserved.
     10       1.1   tsutsui  *
     11       1.1   tsutsui  * Redistribution and use in source and binary forms, with or without
     12       1.1   tsutsui  * modification, are permitted provided that the following conditions
     13       1.1   tsutsui  * are met:
     14       1.1   tsutsui  * 1. Redistributions of source code must retain the above copyright
     15       1.1   tsutsui  *    notice, this list of conditions and the following disclaimer.
     16       1.1   tsutsui  * 2. Redistributions in binary form must reproduce the above copyright
     17       1.1   tsutsui  *    notice, this list of conditions and the following disclaimer in the
     18       1.1   tsutsui  *    documentation and/or other materials provided with the distribution.
     19       1.1   tsutsui  * 3. The name of the author may not be used to endorse or promote products
     20       1.1   tsutsui  *    derived from this software without specific prior written permission.
     21       1.1   tsutsui  *
     22       1.1   tsutsui  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23       1.1   tsutsui  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24       1.1   tsutsui  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25       1.1   tsutsui  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26       1.1   tsutsui  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27       1.1   tsutsui  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28       1.1   tsutsui  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29       1.1   tsutsui  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30       1.1   tsutsui  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     31       1.1   tsutsui  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32       1.1   tsutsui  */
     33       1.1   tsutsui /*
     34       1.1   tsutsui  * Ported from
     35       1.1   tsutsui  *   dc395x_trm.c
     36       1.1   tsutsui  *
     37       1.1   tsutsui  * Written for NetBSD 1.4.x by
     38       1.1   tsutsui  *   Erich Chen     (erich (at) tekram.com.tw)
     39       1.1   tsutsui  *
     40       1.1   tsutsui  * Provided by
     41       1.1   tsutsui  *   (C)Copyright 1995-1999 Tekram Technology Co., Ltd. All rights reserved.
     42       1.1   tsutsui  */
     43       1.4     lukem 
     44       1.4     lukem #include <sys/cdefs.h>
     45  1.21.6.2    kardel __KERNEL_RCSID(0, "$NetBSD: trm.c,v 1.21.6.2 2006/06/01 22:36:49 kardel Exp $");
     46       1.1   tsutsui 
     47       1.2   tsutsui /* #define TRM_DEBUG */
     48       1.7   tsutsui #ifdef TRM_DEBUG
     49       1.7   tsutsui int trm_debug = 1;
     50       1.7   tsutsui #define DPRINTF(arg)	if (trm_debug > 0) printf arg;
     51       1.7   tsutsui #else
     52       1.7   tsutsui #define DPRINTF(arg)
     53       1.7   tsutsui #endif
     54       1.1   tsutsui 
     55       1.1   tsutsui #include <sys/param.h>
     56       1.1   tsutsui #include <sys/systm.h>
     57       1.1   tsutsui #include <sys/malloc.h>
     58       1.1   tsutsui #include <sys/buf.h>
     59       1.1   tsutsui #include <sys/kernel.h>
     60       1.1   tsutsui #include <sys/device.h>
     61       1.7   tsutsui #include <sys/queue.h>
     62       1.1   tsutsui 
     63       1.1   tsutsui #include <machine/bus.h>
     64       1.1   tsutsui #include <machine/intr.h>
     65       1.1   tsutsui 
     66       1.1   tsutsui #include <uvm/uvm_extern.h>
     67       1.1   tsutsui 
     68      1.17   thorpej #include <dev/scsipi/scsi_spc.h>
     69       1.1   tsutsui #include <dev/scsipi/scsi_all.h>
     70       1.1   tsutsui #include <dev/scsipi/scsi_message.h>
     71       1.1   tsutsui #include <dev/scsipi/scsipi_all.h>
     72       1.1   tsutsui #include <dev/scsipi/scsiconf.h>
     73       1.1   tsutsui 
     74       1.1   tsutsui #include <dev/pci/pcidevs.h>
     75       1.1   tsutsui #include <dev/pci/pcireg.h>
     76       1.1   tsutsui #include <dev/pci/pcivar.h>
     77       1.1   tsutsui #include <dev/pci/trmreg.h>
     78       1.1   tsutsui 
     79       1.1   tsutsui /*
     80       1.1   tsutsui  * feature of chip set MAX value
     81       1.1   tsutsui  */
     82       1.1   tsutsui #define TRM_MAX_TARGETS		16
     83       1.7   tsutsui #define TRM_MAX_LUNS		8
     84       1.1   tsutsui #define TRM_MAX_SG_ENTRIES	(MAXPHYS / PAGE_SIZE + 1)
     85       1.7   tsutsui #define TRM_MAX_SRB		32 /* XXX */
     86       1.7   tsutsui #define TRM_MAX_TAG		TRM_MAX_SRB /* XXX */
     87       1.7   tsutsui #define TRM_MAX_OFFSET		15
     88       1.7   tsutsui #define TRM_MAX_PERIOD		125
     89       1.1   tsutsui 
     90       1.1   tsutsui /*
     91       1.1   tsutsui  * Segment Entry
     92       1.1   tsutsui  */
     93       1.1   tsutsui struct trm_sg_entry {
     94      1.16   tsutsui 	uint32_t address;
     95      1.16   tsutsui 	uint32_t length;
     96       1.1   tsutsui };
     97       1.1   tsutsui 
     98       1.1   tsutsui #define TRM_SG_SIZE	(sizeof(struct trm_sg_entry) * TRM_MAX_SG_ENTRIES)
     99       1.1   tsutsui 
    100       1.1   tsutsui /*
    101       1.1   tsutsui  **********************************************************************
    102       1.1   tsutsui  * The SEEPROM structure for TRM_S1040
    103       1.1   tsutsui  **********************************************************************
    104       1.1   tsutsui  */
    105       1.1   tsutsui struct nvram_target {
    106      1.16   tsutsui 	uint8_t config0;		/* Target configuration byte 0 */
    107       1.1   tsutsui #define NTC_DO_WIDE_NEGO	0x20	/* Wide negotiate	     */
    108       1.8       wiz #define NTC_DO_TAG_QUEUING	0x10	/* Enable SCSI tagged queuing  */
    109       1.1   tsutsui #define NTC_DO_SEND_START	0x08	/* Send start command SPINUP */
    110       1.1   tsutsui #define NTC_DO_DISCONNECT	0x04	/* Enable SCSI disconnect    */
    111       1.1   tsutsui #define NTC_DO_SYNC_NEGO	0x02	/* Sync negotiation	     */
    112       1.5   tsutsui #define NTC_DO_PARITY_CHK	0x01	/* Parity check enable 	     */
    113      1.16   tsutsui 	uint8_t period;			/* Target period	       */
    114      1.16   tsutsui 	uint8_t config2;		/* Target configuration byte 2 */
    115      1.16   tsutsui 	uint8_t config3;		/* Target configuration byte 3 */
    116       1.1   tsutsui };
    117       1.1   tsutsui 
    118       1.1   tsutsui struct trm_nvram {
    119      1.16   tsutsui 	uint8_t subvendor_id[2];		/* 0,1 Sub Vendor ID */
    120      1.16   tsutsui 	uint8_t subsys_id[2];			/* 2,3 Sub System ID */
    121      1.16   tsutsui 	uint8_t subclass;			/* 4   Sub Class */
    122      1.16   tsutsui 	uint8_t vendor_id[2];			/* 5,6 Vendor ID */
    123      1.16   tsutsui 	uint8_t device_id[2];			/* 7,8 Device ID */
    124      1.16   tsutsui 	uint8_t reserved0;			/* 9   Reserved */
    125       1.1   tsutsui 	struct nvram_target target[TRM_MAX_TARGETS];
    126       1.1   tsutsui 						/* 10,11,12,13
    127       1.1   tsutsui 						 * 14,15,16,17
    128       1.1   tsutsui 						 * ....
    129       1.1   tsutsui 						 * 70,71,72,73 */
    130      1.16   tsutsui 	uint8_t scsi_id;			/* 74 Host Adapter SCSI ID */
    131      1.16   tsutsui 	uint8_t channel_cfg;			/* 75 Channel configuration */
    132       1.1   tsutsui #define NAC_SCANLUN		0x20	/* Include LUN as BIOS device */
    133       1.3   tsutsui #define NAC_DO_PARITY_CHK	0x08    /* Parity check enable        */
    134       1.1   tsutsui #define NAC_POWERON_SCSI_RESET	0x04	/* Power on reset enable      */
    135       1.1   tsutsui #define NAC_GREATER_1G		0x02	/* > 1G support enable	      */
    136       1.1   tsutsui #define NAC_GT2DRIVES		0x01	/* Support more than 2 drives */
    137      1.16   tsutsui 	uint8_t delay_time;			/* 76 Power on delay time */
    138      1.16   tsutsui 	uint8_t max_tag;			/* 77 Maximum tags */
    139      1.16   tsutsui 	uint8_t reserved1;			/* 78 */
    140      1.16   tsutsui 	uint8_t boot_target;			/* 79 */
    141      1.16   tsutsui 	uint8_t boot_lun;			/* 80 */
    142      1.16   tsutsui 	uint8_t reserved2;			/* 81 */
    143      1.16   tsutsui 	uint8_t reserved3[44];			/* 82,..125 */
    144      1.16   tsutsui 	uint8_t checksum0;			/* 126 */
    145      1.16   tsutsui 	uint8_t checksum1;			/* 127 */
    146       1.1   tsutsui #define TRM_NVRAM_CKSUM	0x1234
    147       1.1   tsutsui };
    148       1.1   tsutsui 
    149       1.1   tsutsui /* Nvram Initiater bits definition */
    150       1.1   tsutsui #define MORE2_DRV		0x00000001
    151       1.1   tsutsui #define GREATER_1G		0x00000002
    152       1.1   tsutsui #define RST_SCSI_BUS		0x00000004
    153       1.1   tsutsui #define ACTIVE_NEGATION		0x00000008
    154       1.1   tsutsui #define NO_SEEK			0x00000010
    155       1.1   tsutsui #define LUN_CHECK		0x00000020
    156       1.1   tsutsui 
    157       1.7   tsutsui #define trm_eeprom_wait()	DELAY(30)
    158       1.1   tsutsui 
    159       1.1   tsutsui /*
    160       1.1   tsutsui  *-----------------------------------------------------------------------
    161       1.1   tsutsui  *			SCSI Request Block
    162       1.1   tsutsui  *-----------------------------------------------------------------------
    163       1.1   tsutsui  */
    164       1.1   tsutsui struct trm_srb {
    165       1.7   tsutsui 	TAILQ_ENTRY(trm_srb) next;
    166       1.1   tsutsui 
    167       1.1   tsutsui 	struct trm_sg_entry *sgentry;
    168       1.5   tsutsui 	struct scsipi_xfer *xs;		/* scsipi_xfer for this cmd */
    169       1.1   tsutsui 	bus_dmamap_t dmap;
    170       1.1   tsutsui 	bus_size_t sgoffset;		/* Xfer buf offset */
    171       1.1   tsutsui 
    172      1.16   tsutsui 	uint32_t buflen;		/* Total xfer length */
    173      1.16   tsutsui 	uint32_t sgaddr;		/* SGList physical starting address */
    174       1.1   tsutsui 
    175       1.1   tsutsui 	int sgcnt;
    176       1.1   tsutsui 	int sgindex;
    177       1.1   tsutsui 
    178       1.1   tsutsui 	int hastat;			/* Host Adapter Status */
    179       1.1   tsutsui #define H_STATUS_GOOD		0x00
    180       1.1   tsutsui #define H_SEL_TIMEOUT		0x11
    181       1.1   tsutsui #define H_OVER_UNDER_RUN	0x12
    182       1.1   tsutsui #define H_UNEXP_BUS_FREE	0x13
    183       1.1   tsutsui #define H_TARGET_PHASE_F	0x14
    184       1.1   tsutsui #define H_INVALID_CCB_OP	0x16
    185       1.1   tsutsui #define H_LINK_CCB_BAD		0x17
    186       1.1   tsutsui #define H_BAD_TARGET_DIR	0x18
    187       1.1   tsutsui #define H_DUPLICATE_CCB		0x19
    188       1.1   tsutsui #define H_BAD_CCB_OR_SG		0x1A
    189       1.1   tsutsui #define H_ABORT			0xFF
    190       1.1   tsutsui 	int tastat;			/* Target SCSI Status Byte */
    191       1.1   tsutsui 	int flag;			/* SRBFlag */
    192       1.1   tsutsui #define AUTO_REQSENSE		0x0001
    193       1.7   tsutsui #define PARITY_ERROR		0x0002
    194       1.7   tsutsui #define SRB_TIMEOUT		0x0004
    195       1.1   tsutsui 
    196       1.1   tsutsui 	int cmdlen;			/* SCSI command length */
    197      1.16   tsutsui 	uint8_t cmd[12];	       	/* SCSI command */
    198       1.1   tsutsui 
    199      1.16   tsutsui 	uint8_t tag[2];
    200       1.1   tsutsui };
    201       1.1   tsutsui 
    202       1.1   tsutsui /*
    203       1.7   tsutsui  * some info about each target and lun on the SCSI bus
    204       1.1   tsutsui  */
    205       1.7   tsutsui struct trm_linfo {
    206       1.7   tsutsui 	int used;		/* number of slots in use */
    207       1.7   tsutsui 	int avail;		/* where to start scanning */
    208       1.7   tsutsui 	int busy;		/* lun in use */
    209       1.7   tsutsui 	struct trm_srb *untagged;
    210       1.7   tsutsui 	struct trm_srb *queued[TRM_MAX_TAG];
    211       1.7   tsutsui };
    212       1.1   tsutsui 
    213       1.7   tsutsui struct trm_tinfo {
    214       1.7   tsutsui 	u_int flag;		/* Sync mode ? (1 sync):(0 async)  */
    215       1.7   tsutsui #define SYNC_NEGO_ENABLE	0x0001
    216       1.7   tsutsui #define SYNC_NEGO_DOING		0x0002
    217       1.7   tsutsui #define SYNC_NEGO_DONE		0x0004
    218       1.7   tsutsui #define WIDE_NEGO_ENABLE	0x0008
    219       1.7   tsutsui #define WIDE_NEGO_DOING		0x0010
    220       1.7   tsutsui #define WIDE_NEGO_DONE		0x0020
    221       1.7   tsutsui #define USE_TAG_QUEUING		0x0040
    222       1.7   tsutsui #define NO_RESELECT		0x0080
    223       1.7   tsutsui 	struct trm_linfo *linfo[TRM_MAX_LUNS];
    224       1.1   tsutsui 
    225      1.16   tsutsui 	uint8_t config0;	/* Target Config */
    226      1.16   tsutsui 	uint8_t period;		/* Max Period for nego. */
    227      1.16   tsutsui 	uint8_t synctl;		/* Sync control for reg. */
    228      1.16   tsutsui 	uint8_t offset;		/* Sync offset for reg. and nego.(low nibble) */
    229       1.1   tsutsui };
    230       1.1   tsutsui 
    231       1.1   tsutsui /*
    232       1.1   tsutsui  *-----------------------------------------------------------------------
    233       1.1   tsutsui  *			Adapter Control Block
    234       1.1   tsutsui  *-----------------------------------------------------------------------
    235       1.1   tsutsui  */
    236       1.1   tsutsui struct trm_softc {
    237       1.1   tsutsui 	struct device sc_dev;
    238       1.1   tsutsui 
    239       1.1   tsutsui 	bus_space_tag_t sc_iot;
    240       1.1   tsutsui 	bus_space_handle_t sc_ioh;
    241       1.1   tsutsui 	bus_dma_tag_t sc_dmat;
    242       1.1   tsutsui 	bus_dmamap_t sc_dmamap;	/* Map the control structures */
    243       1.1   tsutsui 
    244       1.7   tsutsui 	struct trm_srb *sc_actsrb;
    245       1.7   tsutsui 	struct trm_tinfo sc_tinfo[TRM_MAX_TARGETS];
    246       1.1   tsutsui 
    247       1.7   tsutsui 	TAILQ_HEAD(, trm_srb) sc_freesrb,
    248       1.7   tsutsui 			      sc_readysrb;
    249       1.1   tsutsui 	struct trm_srb *sc_srb;	/* SRB array */
    250       1.1   tsutsui 
    251       1.1   tsutsui 	struct trm_sg_entry *sc_sglist;
    252       1.1   tsutsui 
    253       1.7   tsutsui 	int sc_maxid;
    254       1.1   tsutsui 	/*
    255       1.1   tsutsui 	 * Link to the generic SCSI driver
    256       1.1   tsutsui 	 */
    257       1.1   tsutsui 	struct scsipi_channel sc_channel;
    258       1.1   tsutsui 	struct scsipi_adapter sc_adapter;
    259       1.1   tsutsui 
    260       1.1   tsutsui 	int sc_id;		/* Adapter SCSI Target ID */
    261       1.1   tsutsui 
    262       1.7   tsutsui 	int sc_state;			/* SRB State */
    263       1.7   tsutsui #define TRM_IDLE		0
    264       1.7   tsutsui #define TRM_WAIT		1
    265       1.7   tsutsui #define TRM_READY		2
    266       1.7   tsutsui #define TRM_MSGOUT		3	/* arbitration+msg_out 1st byte */
    267       1.7   tsutsui #define TRM_MSGIN		4
    268       1.7   tsutsui #define TRM_EXTEND_MSGIN	5
    269       1.7   tsutsui #define TRM_COMMAND		6
    270       1.7   tsutsui #define TRM_START		7	/* arbitration+msg_out+command_out */
    271       1.7   tsutsui #define TRM_DISCONNECTED	8
    272       1.7   tsutsui #define TRM_DATA_XFER		9
    273       1.7   tsutsui #define TRM_XFERPAD		10
    274       1.7   tsutsui #define TRM_STATUS		11
    275       1.7   tsutsui #define TRM_COMPLETED		12
    276       1.7   tsutsui #define TRM_ABORT_SENT		13
    277       1.7   tsutsui #define TRM_UNEXPECT_RESEL	14
    278       1.1   tsutsui 
    279       1.7   tsutsui 	int sc_phase;			/* SCSI phase */
    280       1.7   tsutsui 	int sc_config;
    281       1.7   tsutsui #define HCC_WIDE_CARD		0x01
    282       1.7   tsutsui #define HCC_SCSI_RESET		0x02
    283       1.7   tsutsui #define HCC_PARITY		0x04
    284       1.7   tsutsui #define HCC_AUTOTERM		0x08
    285       1.7   tsutsui #define HCC_LOW8TERM		0x10
    286       1.7   tsutsui #define HCC_UP8TERM		0x20
    287       1.1   tsutsui 
    288       1.1   tsutsui 	int sc_flag;
    289       1.1   tsutsui #define RESET_DEV		0x01
    290       1.1   tsutsui #define RESET_DETECT		0x02
    291       1.1   tsutsui #define RESET_DONE		0x04
    292       1.7   tsutsui #define WAIT_TAGMSG		0x08	/* XXX */
    293       1.7   tsutsui 
    294       1.7   tsutsui 	int sc_msgcnt;
    295       1.7   tsutsui 
    296       1.7   tsutsui 	int resel_target; /* XXX */
    297       1.7   tsutsui 	int resel_lun; /* XXX */
    298       1.7   tsutsui 
    299      1.16   tsutsui 	uint8_t *sc_msg;
    300      1.16   tsutsui 	uint8_t sc_msgbuf[6];
    301       1.1   tsutsui };
    302       1.1   tsutsui 
    303       1.1   tsutsui /*
    304       1.1   tsutsui  * SCSI Status codes not defined in scsi_all.h
    305       1.1   tsutsui  */
    306       1.1   tsutsui #define SCSI_COND_MET		0x04	/* Condition Met              */
    307       1.1   tsutsui #define SCSI_INTERM_COND_MET	0x14	/* Intermediate condition met */
    308       1.8       wiz #define SCSI_UNEXP_BUS_FREE	0xFD	/* Unexpected Bus Free        */
    309       1.8       wiz #define SCSI_BUS_RST_DETECT	0xFE	/* SCSI Bus Reset detected    */
    310       1.8       wiz #define SCSI_SEL_TIMEOUT	0xFF	/* Selection Timeout          */
    311       1.1   tsutsui 
    312       1.7   tsutsui static int  trm_probe(struct device *, struct cfdata *, void *);
    313       1.7   tsutsui static void trm_attach(struct device *, struct device *, void *);
    314       1.7   tsutsui 
    315       1.7   tsutsui static int  trm_init(struct trm_softc *);
    316       1.7   tsutsui 
    317       1.7   tsutsui static void trm_scsipi_request(struct scsipi_channel *, scsipi_adapter_req_t,
    318       1.7   tsutsui     void *);
    319       1.7   tsutsui static void trm_update_xfer_mode(struct trm_softc *, int);
    320       1.7   tsutsui static void trm_sched(struct trm_softc *);
    321       1.7   tsutsui static int  trm_select(struct trm_softc *, struct trm_srb *);
    322       1.7   tsutsui static void trm_reset(struct trm_softc *);
    323       1.7   tsutsui static void trm_timeout(void *);
    324       1.1   tsutsui static int  trm_intr(void *);
    325       1.1   tsutsui 
    326       1.7   tsutsui static void trm_dataout_phase0(struct trm_softc *, int);
    327       1.7   tsutsui static void trm_datain_phase0(struct trm_softc *, int);
    328       1.7   tsutsui static void trm_status_phase0(struct trm_softc *);
    329       1.7   tsutsui static void trm_msgin_phase0(struct trm_softc *);
    330       1.7   tsutsui static void trm_command_phase1(struct trm_softc *);
    331       1.7   tsutsui static void trm_status_phase1(struct trm_softc *);
    332       1.7   tsutsui static void trm_msgout_phase1(struct trm_softc *);
    333       1.7   tsutsui static void trm_msgin_phase1(struct trm_softc *);
    334       1.7   tsutsui 
    335       1.7   tsutsui static void trm_dataio_xfer(struct trm_softc *, int);
    336       1.1   tsutsui static void trm_disconnect(struct trm_softc *);
    337       1.1   tsutsui static void trm_reselect(struct trm_softc *);
    338       1.7   tsutsui static void trm_done(struct trm_softc *, struct trm_srb *);
    339       1.7   tsutsui static int  trm_request_sense(struct trm_softc *, struct trm_srb *);
    340       1.7   tsutsui static void trm_dequeue(struct trm_softc *, struct trm_srb *);
    341       1.7   tsutsui 
    342       1.1   tsutsui static void trm_scsi_reset_detect(struct trm_softc *);
    343       1.1   tsutsui static void trm_reset_scsi_bus(struct trm_softc *);
    344       1.7   tsutsui 
    345       1.1   tsutsui static void trm_check_eeprom(struct trm_softc *, struct trm_nvram *);
    346       1.1   tsutsui static void trm_eeprom_read_all(struct trm_softc *, struct trm_nvram *);
    347       1.1   tsutsui static void trm_eeprom_write_all(struct trm_softc *, struct trm_nvram *);
    348      1.16   tsutsui static void trm_eeprom_set_data(struct trm_softc *, uint8_t, uint8_t);
    349      1.16   tsutsui static void trm_eeprom_write_cmd(struct trm_softc *, uint8_t, uint8_t);
    350      1.16   tsutsui static uint8_t trm_eeprom_get_data(struct trm_softc *, uint8_t);
    351       1.1   tsutsui 
    352      1.12   thorpej CFATTACH_DECL(trm, sizeof(struct trm_softc),
    353      1.13   thorpej     trm_probe, trm_attach, NULL, NULL);
    354       1.1   tsutsui 
    355       1.7   tsutsui /* real period: */
    356      1.16   tsutsui static const uint8_t trm_clock_period[] = {
    357       1.7   tsutsui 	12,	/*  48 ns 20.0 MB/sec */
    358       1.7   tsutsui 	18,	/*  72 ns 13.3 MB/sec */
    359       1.7   tsutsui 	25,	/* 100 ns 10.0 MB/sec */
    360       1.7   tsutsui 	31,	/* 124 ns  8.0 MB/sec */
    361       1.7   tsutsui 	37,	/* 148 ns  6.6 MB/sec */
    362       1.7   tsutsui 	43,	/* 172 ns  5.7 MB/sec */
    363       1.7   tsutsui 	50,	/* 200 ns  5.0 MB/sec */
    364       1.7   tsutsui 	62	/* 248 ns  4.0 MB/sec */
    365       1.1   tsutsui };
    366       1.7   tsutsui #define NPERIOD	(sizeof(trm_clock_period)/sizeof(trm_clock_period[0]))
    367       1.1   tsutsui 
    368       1.7   tsutsui static int
    369      1.15   tsutsui trm_probe(struct device *parent, struct cfdata *match, void *aux)
    370       1.7   tsutsui {
    371       1.7   tsutsui 	struct pci_attach_args *pa = aux;
    372       1.1   tsutsui 
    373       1.7   tsutsui 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_TEKRAM2)
    374       1.7   tsutsui 		switch (PCI_PRODUCT(pa->pa_id)) {
    375       1.7   tsutsui 		case PCI_PRODUCT_TEKRAM2_DC315:
    376       1.7   tsutsui 			return (1);
    377       1.7   tsutsui 		}
    378       1.7   tsutsui 	return (0);
    379       1.7   tsutsui }
    380       1.1   tsutsui 
    381       1.1   tsutsui /*
    382       1.7   tsutsui  * attach and init a host adapter
    383       1.1   tsutsui  */
    384       1.1   tsutsui static void
    385      1.15   tsutsui trm_attach(struct device *parent, struct device *self, void *aux)
    386       1.1   tsutsui {
    387       1.7   tsutsui 	struct pci_attach_args *const pa = aux;
    388       1.7   tsutsui 	struct trm_softc *sc = (struct trm_softc *)self;
    389       1.7   tsutsui 	bus_space_tag_t iot;
    390       1.7   tsutsui 	bus_space_handle_t ioh;
    391       1.7   tsutsui 	pci_intr_handle_t ih;
    392       1.7   tsutsui 	pcireg_t command;
    393       1.7   tsutsui 	const char *intrstr;
    394       1.7   tsutsui 
    395       1.7   tsutsui 	/*
    396       1.7   tsutsui 	 * These cards do not allow memory mapped accesses
    397       1.7   tsutsui 	 * pa_pc:  chipset tag
    398       1.7   tsutsui 	 * pa_tag: pci tag
    399       1.7   tsutsui 	 */
    400       1.7   tsutsui 	command = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
    401       1.7   tsutsui 	if ((command & (PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MASTER_ENABLE)) !=
    402       1.7   tsutsui 	    (PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MASTER_ENABLE)) {
    403       1.7   tsutsui 		command |= PCI_COMMAND_IO_ENABLE | PCI_COMMAND_MASTER_ENABLE;
    404       1.7   tsutsui 		pci_conf_write(pa->pa_pc, pa->pa_tag,
    405       1.7   tsutsui 		    PCI_COMMAND_STATUS_REG, command);
    406       1.7   tsutsui 	}
    407       1.7   tsutsui 	/*
    408       1.7   tsutsui 	 * mask for get correct base address of pci IO port
    409       1.7   tsutsui 	 */
    410       1.7   tsutsui 	if (pci_mapreg_map(pa, PCI_MAPREG_START, PCI_MAPREG_TYPE_IO, 0,
    411       1.7   tsutsui 	    &iot, &ioh, NULL, NULL)) {
    412       1.7   tsutsui 		printf("%s: unable to map registers\n", sc->sc_dev.dv_xname);
    413       1.7   tsutsui 		return;
    414       1.7   tsutsui 	}
    415       1.7   tsutsui 	/*
    416       1.7   tsutsui 	 * test checksum of eeprom.. & initialize softc...
    417       1.7   tsutsui 	 */
    418       1.7   tsutsui 	sc->sc_iot = iot;
    419       1.7   tsutsui 	sc->sc_ioh = ioh;
    420       1.7   tsutsui 	sc->sc_dmat = pa->pa_dmat;
    421       1.1   tsutsui 
    422       1.7   tsutsui 	if (trm_init(sc) != 0) {
    423       1.7   tsutsui 		/*
    424       1.7   tsutsui 		 * Error during initialization!
    425       1.7   tsutsui 		 */
    426       1.7   tsutsui 		printf(": Error during initialization\n");
    427       1.7   tsutsui 		return;
    428       1.7   tsutsui 	}
    429       1.7   tsutsui 	/*
    430       1.7   tsutsui 	 * Now try to attach all the sub-devices
    431       1.7   tsutsui 	 */
    432       1.7   tsutsui 	if ((sc->sc_config & HCC_WIDE_CARD) != 0)
    433       1.7   tsutsui 		printf(": Tekram DC395UW/F (TRM-S1040) Fast40 "
    434       1.7   tsutsui 		    "Ultra Wide SCSI Adapter\n");
    435       1.7   tsutsui 	else
    436       1.7   tsutsui 		printf(": Tekram DC395U, DC315/U (TRM-S1040) Fast20 "
    437       1.7   tsutsui 		    "Ultra SCSI Adapter\n");
    438       1.1   tsutsui 
    439       1.7   tsutsui 	/*
    440       1.7   tsutsui 	 * Now tell the generic SCSI layer about our bus.
    441       1.7   tsutsui 	 * map and establish interrupt
    442       1.7   tsutsui 	 */
    443       1.7   tsutsui 	if (pci_intr_map(pa, &ih)) {
    444       1.7   tsutsui 		printf("%s: couldn't map interrupt\n", sc->sc_dev.dv_xname);
    445       1.7   tsutsui 		return;
    446       1.7   tsutsui 	}
    447       1.7   tsutsui 	intrstr = pci_intr_string(pa->pa_pc, ih);
    448       1.1   tsutsui 
    449       1.7   tsutsui 	if (pci_intr_establish(pa->pa_pc, ih, IPL_BIO, trm_intr, sc) == NULL) {
    450       1.7   tsutsui 		printf("%s: couldn't establish interrupt", sc->sc_dev.dv_xname);
    451       1.7   tsutsui 		if (intrstr != NULL)
    452       1.7   tsutsui 			printf(" at %s", intrstr);
    453       1.7   tsutsui 		printf("\n");
    454       1.7   tsutsui 		return;
    455       1.1   tsutsui 	}
    456       1.7   tsutsui 	if (intrstr != NULL)
    457       1.7   tsutsui 		printf("%s: interrupting at %s\n",
    458       1.7   tsutsui 		    sc->sc_dev.dv_xname, intrstr);
    459       1.7   tsutsui 
    460       1.7   tsutsui 	sc->sc_adapter.adapt_dev = &sc->sc_dev;
    461       1.7   tsutsui 	sc->sc_adapter.adapt_nchannels = 1;
    462       1.7   tsutsui 	sc->sc_adapter.adapt_openings = TRM_MAX_SRB;
    463       1.7   tsutsui 	sc->sc_adapter.adapt_max_periph = TRM_MAX_SRB;
    464       1.7   tsutsui 	sc->sc_adapter.adapt_request = trm_scsipi_request;
    465       1.7   tsutsui 	sc->sc_adapter.adapt_minphys = minphys;
    466       1.7   tsutsui 
    467       1.7   tsutsui 	sc->sc_channel.chan_adapter = &sc->sc_adapter;
    468       1.7   tsutsui 	sc->sc_channel.chan_bustype = &scsi_bustype;
    469       1.7   tsutsui 	sc->sc_channel.chan_channel = 0;
    470       1.7   tsutsui 	sc->sc_channel.chan_ntargets = sc->sc_maxid + 1;
    471       1.7   tsutsui 	sc->sc_channel.chan_nluns = 8;
    472       1.7   tsutsui 	sc->sc_channel.chan_id = sc->sc_id;
    473       1.1   tsutsui 
    474       1.7   tsutsui 	config_found(&sc->sc_dev, &sc->sc_channel, scsiprint);
    475       1.1   tsutsui }
    476       1.1   tsutsui 
    477       1.7   tsutsui /*
    478       1.7   tsutsui  * initialize the internal structures for a given SCSI host
    479       1.7   tsutsui  */
    480       1.7   tsutsui static int
    481      1.15   tsutsui trm_init(struct trm_softc *sc)
    482       1.1   tsutsui {
    483       1.7   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
    484       1.7   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
    485       1.7   tsutsui 	bus_dma_segment_t seg;
    486       1.7   tsutsui 	struct trm_nvram eeprom;
    487       1.1   tsutsui 	struct trm_srb *srb;
    488       1.7   tsutsui 	struct trm_tinfo *ti;
    489       1.7   tsutsui 	struct nvram_target *tconf;
    490       1.7   tsutsui 	int error, rseg, all_sgsize;
    491       1.7   tsutsui 	int i, target;
    492      1.16   tsutsui 	uint8_t bval;
    493       1.7   tsutsui 
    494       1.7   tsutsui 	DPRINTF(("\n"));
    495       1.1   tsutsui 
    496       1.7   tsutsui 	/*
    497       1.7   tsutsui 	 * allocate the space for all SCSI control blocks (SRB) for DMA memory
    498       1.7   tsutsui 	 */
    499       1.7   tsutsui 	all_sgsize = TRM_MAX_SRB * TRM_SG_SIZE;
    500       1.7   tsutsui 	if ((error = bus_dmamem_alloc(sc->sc_dmat, all_sgsize, PAGE_SIZE,
    501       1.7   tsutsui 	    0, &seg, 1, &rseg, BUS_DMA_NOWAIT)) != 0) {
    502       1.7   tsutsui 		printf(": unable to allocate SCSI REQUEST BLOCKS, "
    503       1.7   tsutsui 		    "error = %d\n", error);
    504       1.7   tsutsui 		return (1);
    505       1.7   tsutsui 	}
    506       1.7   tsutsui 	if ((error = bus_dmamem_map(sc->sc_dmat, &seg, rseg,
    507       1.7   tsutsui 	    all_sgsize, (caddr_t *) &sc->sc_sglist,
    508       1.7   tsutsui 	    BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
    509       1.7   tsutsui 		printf(": unable to map SCSI REQUEST BLOCKS, "
    510       1.7   tsutsui 		    "error = %d\n", error);
    511       1.7   tsutsui 		return (1);
    512       1.7   tsutsui 	}
    513       1.7   tsutsui 	if ((error = bus_dmamap_create(sc->sc_dmat, all_sgsize, 1,
    514       1.7   tsutsui 	    all_sgsize, 0, BUS_DMA_NOWAIT, &sc->sc_dmamap)) != 0) {
    515       1.7   tsutsui 		printf(": unable to create SRB DMA maps, "
    516       1.7   tsutsui 		    "error = %d\n", error);
    517       1.7   tsutsui 		return (1);
    518       1.7   tsutsui 	}
    519       1.7   tsutsui 	if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap,
    520       1.7   tsutsui 	    sc->sc_sglist, all_sgsize, NULL, BUS_DMA_NOWAIT)) != 0) {
    521       1.7   tsutsui 		printf(": unable to load SRB DMA maps, "
    522       1.7   tsutsui 		    "error = %d\n", error);
    523       1.7   tsutsui 		return (1);
    524       1.7   tsutsui 	}
    525       1.7   tsutsui 	DPRINTF(("all_sgsize=%x\n", all_sgsize));
    526       1.7   tsutsui 	memset(sc->sc_sglist, 0, all_sgsize);
    527       1.1   tsutsui 
    528       1.7   tsutsui 	/*
    529       1.7   tsutsui 	 * EEPROM CHECKSUM
    530       1.7   tsutsui 	 */
    531       1.7   tsutsui 	trm_check_eeprom(sc, &eeprom);
    532       1.1   tsutsui 
    533       1.7   tsutsui 	sc->sc_maxid = 7;
    534       1.7   tsutsui 	sc->sc_config = HCC_AUTOTERM | HCC_PARITY;
    535       1.7   tsutsui 	if (bus_space_read_1(iot, ioh, TRM_GEN_STATUS) & WIDESCSI) {
    536       1.7   tsutsui 		sc->sc_config |= HCC_WIDE_CARD;
    537       1.7   tsutsui 		sc->sc_maxid = 15;
    538       1.1   tsutsui 	}
    539       1.7   tsutsui 	if (eeprom.channel_cfg & NAC_POWERON_SCSI_RESET)
    540       1.7   tsutsui 		sc->sc_config |= HCC_SCSI_RESET;
    541       1.1   tsutsui 
    542       1.7   tsutsui 	sc->sc_actsrb = NULL;
    543       1.7   tsutsui 	sc->sc_id = eeprom.scsi_id;
    544       1.7   tsutsui 	sc->sc_flag = 0;
    545       1.1   tsutsui 
    546       1.1   tsutsui 	/*
    547       1.8       wiz 	 * initialize and link all device's SRB queues of this adapter
    548       1.1   tsutsui 	 */
    549       1.7   tsutsui 	TAILQ_INIT(&sc->sc_freesrb);
    550       1.7   tsutsui 	TAILQ_INIT(&sc->sc_readysrb);
    551       1.1   tsutsui 
    552       1.7   tsutsui 	sc->sc_srb = malloc(sizeof(struct trm_srb) * TRM_MAX_SRB,
    553       1.7   tsutsui 	    M_DEVBUF, M_NOWAIT|M_ZERO);
    554       1.7   tsutsui 	DPRINTF(("all SRB size=%x\n", sizeof(struct trm_srb) * TRM_MAX_SRB));
    555       1.7   tsutsui 	if (sc->sc_srb == NULL) {
    556       1.7   tsutsui 		printf(": can not allocate SRB\n");
    557       1.7   tsutsui 		return (1);
    558       1.1   tsutsui 	}
    559       1.7   tsutsui 
    560       1.7   tsutsui 	for (i = 0, srb = sc->sc_srb; i < TRM_MAX_SRB; i++) {
    561       1.7   tsutsui 		srb->sgentry = sc->sc_sglist + TRM_MAX_SG_ENTRIES * i;
    562       1.7   tsutsui 		srb->sgoffset = TRM_SG_SIZE * i;
    563       1.7   tsutsui 		srb->sgaddr = sc->sc_dmamap->dm_segs[0].ds_addr + srb->sgoffset;
    564       1.1   tsutsui 		/*
    565       1.7   tsutsui 		 * map all SRB space to SRB_array
    566       1.1   tsutsui 		 */
    567       1.7   tsutsui 		if (bus_dmamap_create(sc->sc_dmat,
    568       1.7   tsutsui 		    MAXPHYS, TRM_MAX_SG_ENTRIES, MAXPHYS, 0,
    569       1.7   tsutsui 		    BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &srb->dmap)) {
    570       1.9    mjacob 			printf(": unable to create DMA transfer map...\n");
    571       1.7   tsutsui 			free(sc->sc_srb, M_DEVBUF);
    572       1.7   tsutsui 			return (1);
    573       1.1   tsutsui 		}
    574       1.7   tsutsui 		TAILQ_INSERT_TAIL(&sc->sc_freesrb, srb, next);
    575       1.7   tsutsui 		srb++;
    576       1.7   tsutsui 	}
    577       1.7   tsutsui 
    578       1.7   tsutsui 	/*
    579       1.8       wiz 	 * initialize all target info structures
    580       1.7   tsutsui 	 */
    581       1.7   tsutsui 	for (target = 0; target < TRM_MAX_TARGETS; target++) {
    582       1.7   tsutsui 		ti = &sc->sc_tinfo[target];
    583       1.7   tsutsui 		ti->synctl = 0;
    584       1.7   tsutsui 		ti->offset = 0;
    585       1.7   tsutsui 		tconf = &eeprom.target[target];
    586       1.7   tsutsui 		ti->config0 = tconf->config0;
    587       1.7   tsutsui 		ti->period = trm_clock_period[tconf->period & 0x07];
    588       1.7   tsutsui 		ti->flag = 0;
    589       1.7   tsutsui 		if ((ti->config0 & NTC_DO_DISCONNECT) != 0) {
    590       1.7   tsutsui #ifdef notyet
    591       1.7   tsutsui 			if ((ti->config0 & NTC_DO_TAG_QUEUING) != 0)
    592       1.7   tsutsui 				ti->flag |= USE_TAG_QUEUING;
    593       1.7   tsutsui #endif
    594       1.7   tsutsui 		} else
    595       1.7   tsutsui 			ti->flag |= NO_RESELECT;
    596       1.7   tsutsui 
    597       1.7   tsutsui 		DPRINTF(("target %d: config0 = 0x%02x, period = 0x%02x",
    598       1.7   tsutsui 		    target, ti->config0, ti->period));
    599       1.7   tsutsui 		DPRINTF((", flag = 0x%02x\n", ti->flag));
    600       1.1   tsutsui 	}
    601       1.1   tsutsui 
    602       1.7   tsutsui 	/* program configuration 0 */
    603       1.7   tsutsui 	bval = PHASELATCH | INITIATOR | BLOCKRST;
    604       1.7   tsutsui 	if ((sc->sc_config & HCC_PARITY) != 0)
    605       1.7   tsutsui 		bval |= PARITYCHECK;
    606       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_CONFIG0, bval);
    607       1.7   tsutsui 
    608       1.7   tsutsui 	/* program configuration 1 */
    609       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_CONFIG1,
    610       1.7   tsutsui 	    ACTIVE_NEG | ACTIVE_NEGPLUS);
    611       1.7   tsutsui 
    612       1.7   tsutsui 	/* 250ms selection timeout */
    613       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_TIMEOUT, SEL_TIMEOUT);
    614       1.7   tsutsui 
    615       1.8       wiz 	/* Mask all interrupts */
    616       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_DMA_INTEN, 0);
    617       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_INTEN, 0);
    618       1.7   tsutsui 
    619       1.7   tsutsui 	/* Reset SCSI module */
    620       1.7   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_RSTMODULE);
    621       1.7   tsutsui 
    622       1.7   tsutsui 	/* program Host ID */
    623       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_HOSTID, sc->sc_id);
    624       1.7   tsutsui 
    625       1.8       wiz 	/* set asynchronous transfer */
    626       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_OFFSET, 0);
    627       1.7   tsutsui 
    628       1.8       wiz 	/* Turn LED control off */
    629       1.7   tsutsui 	bus_space_write_2(iot, ioh, TRM_GEN_CONTROL,
    630       1.7   tsutsui 	    bus_space_read_2(iot, ioh, TRM_GEN_CONTROL) & ~EN_LED);
    631       1.7   tsutsui 
    632       1.7   tsutsui 	/* DMA config */
    633       1.7   tsutsui 	bus_space_write_2(iot, ioh, TRM_DMA_CONFIG,
    634       1.7   tsutsui 	    bus_space_read_2(iot, ioh, TRM_DMA_CONFIG) | DMA_ENHANCE);
    635       1.7   tsutsui 
    636       1.7   tsutsui 	/* Clear pending interrupt status */
    637  1.21.6.2    kardel 	(void)bus_space_read_1(iot, ioh, TRM_SCSI_INTSTATUS);
    638       1.7   tsutsui 
    639       1.7   tsutsui 	/* Enable SCSI interrupt */
    640       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_INTEN,
    641       1.7   tsutsui 	    EN_SELECT | EN_SELTIMEOUT | EN_DISCONNECT | EN_RESELECTED |
    642       1.7   tsutsui 	    EN_SCSIRESET | EN_BUSSERVICE | EN_CMDDONE);
    643       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_DMA_INTEN, EN_SCSIINTR);
    644       1.7   tsutsui 
    645       1.7   tsutsui 	trm_reset(sc);
    646       1.7   tsutsui 
    647       1.7   tsutsui 	return (0);
    648       1.7   tsutsui }
    649       1.1   tsutsui 
    650       1.1   tsutsui /*
    651       1.1   tsutsui  * enqueues a SCSI command
    652       1.7   tsutsui  * called by the higher level SCSI driver
    653       1.1   tsutsui  */
    654       1.7   tsutsui static void
    655      1.15   tsutsui trm_scsipi_request(struct scsipi_channel *chan, scsipi_adapter_req_t req,
    656      1.15   tsutsui     void *arg)
    657       1.1   tsutsui {
    658       1.1   tsutsui 	bus_space_tag_t iot;
    659       1.1   tsutsui 	bus_space_handle_t ioh;
    660       1.1   tsutsui 	struct trm_softc *sc;
    661       1.1   tsutsui 	struct trm_srb *srb;
    662       1.1   tsutsui 	struct scsipi_xfer *xs;
    663       1.7   tsutsui 	int error, i, target, lun, s;
    664       1.1   tsutsui 
    665       1.1   tsutsui 	sc = (struct trm_softc *)chan->chan_adapter->adapt_dev;
    666       1.1   tsutsui 	iot = sc->sc_iot;
    667       1.1   tsutsui 	ioh = sc->sc_ioh;
    668       1.1   tsutsui 
    669       1.1   tsutsui 	switch (req) {
    670       1.1   tsutsui 	case ADAPTER_REQ_RUN_XFER:
    671       1.1   tsutsui 		xs = arg;
    672       1.7   tsutsui 		target = xs->xs_periph->periph_target;
    673       1.1   tsutsui 		lun = xs->xs_periph->periph_lun;
    674       1.7   tsutsui 		DPRINTF(("trm_scsipi_request.....\n"));
    675       1.7   tsutsui 		DPRINTF(("target= %d lun= %d\n", target, lun));
    676       1.1   tsutsui 		if (xs->xs_control & XS_CTL_RESET) {
    677       1.1   tsutsui 			trm_reset(sc);
    678       1.1   tsutsui 			xs->error = XS_NOERROR | XS_RESET;
    679       1.1   tsutsui 			return;
    680       1.1   tsutsui 		}
    681       1.1   tsutsui 		if (xs->xs_status & XS_STS_DONE) {
    682       1.1   tsutsui 			printf("%s: Is it done?\n", sc->sc_dev.dv_xname);
    683       1.1   tsutsui 			xs->xs_status &= ~XS_STS_DONE;
    684       1.1   tsutsui 		}
    685       1.1   tsutsui 
    686       1.1   tsutsui 		s = splbio();
    687       1.1   tsutsui 
    688       1.1   tsutsui 		/* Get SRB */
    689       1.7   tsutsui 		srb = TAILQ_FIRST(&sc->sc_freesrb);
    690       1.1   tsutsui 		if (srb != NULL) {
    691       1.7   tsutsui 			TAILQ_REMOVE(&sc->sc_freesrb, srb, next);
    692       1.1   tsutsui 		} else {
    693       1.1   tsutsui 			xs->error = XS_RESOURCE_SHORTAGE;
    694       1.1   tsutsui 			scsipi_done(xs);
    695       1.1   tsutsui 			splx(s);
    696       1.1   tsutsui 			return;
    697       1.1   tsutsui 		}
    698       1.7   tsutsui 
    699       1.1   tsutsui 		srb->xs = xs;
    700       1.1   tsutsui 		srb->cmdlen = xs->cmdlen;
    701       1.1   tsutsui 		memcpy(srb->cmd, xs->cmd, xs->cmdlen);
    702       1.7   tsutsui 
    703       1.5   tsutsui 		if (xs->xs_control & (XS_CTL_DATA_IN | XS_CTL_DATA_OUT)) {
    704       1.1   tsutsui 			if ((error = bus_dmamap_load(sc->sc_dmat, srb->dmap,
    705       1.1   tsutsui 			    xs->data, xs->datalen, NULL,
    706       1.5   tsutsui 			    ((xs->xs_control & XS_CTL_NOSLEEP) ?
    707       1.5   tsutsui 			    BUS_DMA_NOWAIT : BUS_DMA_WAITOK) |
    708       1.5   tsutsui 			    BUS_DMA_STREAMING |
    709       1.5   tsutsui 			    ((xs->xs_control & XS_CTL_DATA_IN) ?
    710       1.5   tsutsui 			    BUS_DMA_READ : BUS_DMA_WRITE))) != 0) {
    711       1.1   tsutsui 				printf("%s: DMA transfer map unable to load, "
    712       1.1   tsutsui 				    "error = %d\n", sc->sc_dev.dv_xname, error);
    713       1.1   tsutsui 				xs->error = XS_DRIVER_STUFFUP;
    714       1.1   tsutsui 				/*
    715       1.1   tsutsui 				 * free SRB
    716       1.1   tsutsui 				 */
    717       1.7   tsutsui 				TAILQ_INSERT_TAIL(&sc->sc_freesrb, srb, next);
    718       1.3   tsutsui 				splx(s);
    719       1.1   tsutsui 				return;
    720       1.1   tsutsui 			}
    721       1.1   tsutsui 			bus_dmamap_sync(sc->sc_dmat, srb->dmap, 0,
    722       1.1   tsutsui 			    srb->dmap->dm_mapsize,
    723       1.1   tsutsui 			    (xs->xs_control & XS_CTL_DATA_IN) ?
    724       1.1   tsutsui 			    BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
    725       1.1   tsutsui 
    726       1.1   tsutsui 			/* Set up the scatter gather list */
    727       1.1   tsutsui 			for (i = 0; i < srb->dmap->dm_nsegs; i++) {
    728       1.1   tsutsui 				srb->sgentry[i].address =
    729       1.1   tsutsui 				    htole32(srb->dmap->dm_segs[i].ds_addr);
    730       1.1   tsutsui 				srb->sgentry[i].length =
    731       1.1   tsutsui 				    htole32(srb->dmap->dm_segs[i].ds_len);
    732       1.1   tsutsui 			}
    733       1.1   tsutsui 			srb->buflen = xs->datalen;
    734       1.1   tsutsui 			srb->sgcnt = srb->dmap->dm_nsegs;
    735       1.1   tsutsui 		} else {
    736       1.1   tsutsui 			srb->sgentry[0].address = 0;
    737       1.1   tsutsui 			srb->sgentry[0].length = 0;
    738       1.1   tsutsui 			srb->buflen = 0;
    739       1.1   tsutsui 			srb->sgcnt = 0;
    740       1.1   tsutsui 		}
    741       1.1   tsutsui 		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
    742       1.1   tsutsui 		    srb->sgoffset, TRM_SG_SIZE, BUS_DMASYNC_PREWRITE);
    743       1.1   tsutsui 
    744       1.7   tsutsui 		sc->sc_phase = PH_BUS_FREE;	/* SCSI bus free Phase */
    745       1.7   tsutsui 
    746       1.1   tsutsui 		srb->sgindex = 0;
    747       1.1   tsutsui 		srb->hastat = 0;
    748       1.1   tsutsui 		srb->tastat = 0;
    749       1.1   tsutsui 		srb->flag = 0;
    750       1.1   tsutsui 
    751       1.7   tsutsui 		TAILQ_INSERT_TAIL(&sc->sc_readysrb, srb, next);
    752       1.7   tsutsui 		if (sc->sc_actsrb == NULL)
    753       1.7   tsutsui 			trm_sched(sc);
    754       1.1   tsutsui 		splx(s);
    755       1.1   tsutsui 
    756       1.7   tsutsui 		if ((xs->xs_control & XS_CTL_POLL) != 0) {
    757       1.1   tsutsui 			int timeout = xs->timeout;
    758       1.7   tsutsui 
    759       1.1   tsutsui 			s = splbio();
    760       1.1   tsutsui 			do {
    761       1.7   tsutsui 				while (--timeout) {
    762       1.1   tsutsui 					DELAY(1000);
    763       1.1   tsutsui 					if (bus_space_read_2(iot, ioh,
    764       1.1   tsutsui 					    TRM_SCSI_STATUS) & SCSIINTERRUPT)
    765       1.1   tsutsui 						break;
    766       1.1   tsutsui 				}
    767       1.7   tsutsui 				if (timeout == 0) {
    768       1.1   tsutsui 					trm_timeout(srb);
    769       1.1   tsutsui 					break;
    770       1.1   tsutsui 				} else
    771       1.1   tsutsui 					trm_intr(sc);
    772       1.1   tsutsui 			} while ((xs->xs_status & XS_STS_DONE) == 0);
    773       1.1   tsutsui 			splx(s);
    774       1.1   tsutsui 		}
    775       1.1   tsutsui 		return;
    776       1.1   tsutsui 
    777       1.1   tsutsui 	case ADAPTER_REQ_GROW_RESOURCES:
    778       1.1   tsutsui 		/* XXX Not supported. */
    779       1.1   tsutsui 		return;
    780       1.1   tsutsui 
    781       1.1   tsutsui 	case ADAPTER_REQ_SET_XFER_MODE:
    782       1.7   tsutsui 		{
    783       1.7   tsutsui 			struct trm_tinfo *ti;
    784       1.7   tsutsui 			struct scsipi_xfer_mode *xm;
    785       1.7   tsutsui 
    786       1.7   tsutsui 			xm = arg;
    787       1.7   tsutsui 			ti = &sc->sc_tinfo[xm->xm_target];
    788       1.7   tsutsui 			ti->flag &= ~(SYNC_NEGO_ENABLE|WIDE_NEGO_ENABLE);
    789       1.7   tsutsui 
    790       1.7   tsutsui #ifdef notyet
    791       1.7   tsutsui 			if ((xm->xm_mode & PERIPH_CAP_TQING) != 0)
    792       1.7   tsutsui 				ti->flag |= USE_TAG_QUEUING;
    793       1.7   tsutsui 			else
    794       1.7   tsutsui #endif
    795       1.7   tsutsui 				ti->flag &= ~USE_TAG_QUEUING;
    796       1.7   tsutsui 
    797      1.19    bouyer 			if ((xm->xm_mode & PERIPH_CAP_WIDE16) != 0 &&
    798      1.19    bouyer 			    (sc->sc_config & HCC_WIDE_CARD) != 0 &&
    799      1.19    bouyer 			    (ti->config0 & NTC_DO_WIDE_NEGO) != 0) {
    800       1.7   tsutsui 				ti->flag |= WIDE_NEGO_ENABLE;
    801       1.7   tsutsui 				ti->flag &= ~WIDE_NEGO_DONE;
    802       1.7   tsutsui 			}
    803       1.7   tsutsui 
    804      1.19    bouyer 			if ((xm->xm_mode & PERIPH_CAP_SYNC) != 0 &&
    805      1.19    bouyer 			    (ti->config0 & NTC_DO_SYNC_NEGO) != 0) {
    806       1.7   tsutsui 				ti->flag |= SYNC_NEGO_ENABLE;
    807       1.7   tsutsui 				ti->flag &= ~SYNC_NEGO_DONE;
    808       1.7   tsutsui 				ti->period = trm_clock_period[0];
    809       1.7   tsutsui 			}
    810       1.7   tsutsui 
    811       1.7   tsutsui 			/*
    812       1.7   tsutsui 			 * If we're not going to negotiate, send the
    813       1.7   tsutsui 			 * notification now, since it won't happen later.
    814       1.7   tsutsui 			 */
    815       1.7   tsutsui 			if ((ti->flag & (WIDE_NEGO_DONE|SYNC_NEGO_DONE)) ==
    816       1.7   tsutsui 			    (WIDE_NEGO_DONE|SYNC_NEGO_DONE))
    817       1.7   tsutsui 				trm_update_xfer_mode(sc, xm->xm_target);
    818       1.7   tsutsui 
    819       1.7   tsutsui 			return;
    820       1.7   tsutsui 		}
    821       1.1   tsutsui 	}
    822       1.1   tsutsui }
    823       1.1   tsutsui 
    824       1.1   tsutsui static void
    825      1.15   tsutsui trm_update_xfer_mode(struct trm_softc *sc, int target)
    826       1.1   tsutsui {
    827       1.7   tsutsui 	struct scsipi_xfer_mode xm;
    828       1.7   tsutsui 	struct trm_tinfo *ti;
    829       1.1   tsutsui 
    830       1.7   tsutsui 	ti = &sc->sc_tinfo[target];
    831       1.7   tsutsui 	xm.xm_target = target;
    832       1.7   tsutsui 	xm.xm_mode = 0;
    833       1.7   tsutsui 	xm.xm_period = 0;
    834       1.7   tsutsui 	xm.xm_offset = 0;
    835       1.1   tsutsui 
    836       1.7   tsutsui 	if ((ti->synctl & WIDE_SYNC) != 0)
    837       1.7   tsutsui 		xm.xm_mode |= PERIPH_CAP_WIDE16;
    838       1.1   tsutsui 
    839       1.7   tsutsui 	if (ti->period > 0) {
    840       1.7   tsutsui 		xm.xm_mode |= PERIPH_CAP_SYNC;
    841       1.7   tsutsui 		xm.xm_period = ti->period;
    842       1.7   tsutsui 		xm.xm_offset = ti->offset;
    843       1.1   tsutsui 	}
    844       1.7   tsutsui 
    845       1.7   tsutsui #ifdef notyet
    846       1.7   tsutsui 	if ((ti->flag & USE_TAG_QUEUING) != 0)
    847       1.7   tsutsui 		xm.xm_mode |= PERIPH_CAP_TQING;
    848       1.7   tsutsui #endif
    849       1.7   tsutsui 
    850       1.7   tsutsui 	scsipi_async_event(&sc->sc_channel, ASYNC_EVENT_XFER_MODE, &xm);
    851       1.1   tsutsui }
    852       1.1   tsutsui 
    853       1.1   tsutsui static void
    854      1.15   tsutsui trm_sched(struct trm_softc *sc)
    855       1.1   tsutsui {
    856       1.7   tsutsui 	struct trm_srb *srb;
    857       1.7   tsutsui 	struct scsipi_periph *periph;
    858       1.7   tsutsui 	struct trm_tinfo *ti;
    859       1.7   tsutsui 	struct trm_linfo *li;
    860       1.7   tsutsui 	int s, lun, tag;
    861       1.7   tsutsui 
    862       1.7   tsutsui 	DPRINTF(("trm_sched...\n"));
    863       1.7   tsutsui 
    864       1.7   tsutsui 	TAILQ_FOREACH(srb, &sc->sc_readysrb, next) {
    865       1.7   tsutsui 		periph = srb->xs->xs_periph;
    866       1.7   tsutsui 		ti = &sc->sc_tinfo[periph->periph_target];
    867       1.7   tsutsui 		lun = periph->periph_lun;
    868       1.7   tsutsui 
    869       1.7   tsutsui 		/* select type of tag for this command */
    870       1.7   tsutsui 		if ((ti->flag & NO_RESELECT) != 0 ||
    871       1.7   tsutsui 		    (ti->flag & USE_TAG_QUEUING) == 0 ||
    872       1.7   tsutsui 		    (srb->flag & AUTO_REQSENSE) != 0 ||
    873       1.7   tsutsui 		    (srb->xs->xs_control & XS_CTL_REQSENSE) != 0)
    874       1.7   tsutsui 			tag = 0;
    875       1.7   tsutsui 		else
    876       1.7   tsutsui 			tag = srb->xs->xs_tag_type;
    877       1.7   tsutsui #if 0
    878       1.7   tsutsui 		/* XXX use tags for polled commands? */
    879       1.7   tsutsui 		if (srb->xs->xs_control & XS_CTL_POLL)
    880       1.7   tsutsui 			tag = 0;
    881       1.7   tsutsui #endif
    882       1.1   tsutsui 
    883       1.7   tsutsui 		s = splbio();
    884       1.7   tsutsui 		li = ti->linfo[lun];
    885       1.7   tsutsui 		if (li == NULL) {
    886       1.7   tsutsui 			/* initialize lun info */
    887       1.7   tsutsui 			if ((li = malloc(sizeof(*li), M_DEVBUF,
    888       1.7   tsutsui 			    M_NOWAIT|M_ZERO)) == NULL) {
    889       1.7   tsutsui 				splx(s);
    890       1.7   tsutsui 				continue;
    891       1.7   tsutsui 			}
    892       1.7   tsutsui 			ti->linfo[lun] = li;
    893       1.7   tsutsui 		}
    894       1.1   tsutsui 
    895       1.7   tsutsui 		if (tag == 0) {
    896       1.7   tsutsui 			/* try to issue this srb as an un-tagged command */
    897       1.7   tsutsui 			if (li->untagged == NULL)
    898       1.7   tsutsui 				li->untagged = srb;
    899       1.7   tsutsui 		}
    900       1.7   tsutsui 		if (li->untagged != NULL) {
    901       1.7   tsutsui 			tag = 0;
    902       1.7   tsutsui 			if (li->busy != 1 && li->used == 0) {
    903       1.7   tsutsui 				/* we need to issue the untagged command now */
    904       1.7   tsutsui 				srb = li->untagged;
    905       1.7   tsutsui 				periph = srb->xs->xs_periph;
    906       1.1   tsutsui 			} else {
    907       1.7   tsutsui 				/* not ready yet */
    908       1.7   tsutsui 				splx(s);
    909       1.7   tsutsui 				continue;
    910       1.1   tsutsui 			}
    911       1.1   tsutsui 		}
    912       1.7   tsutsui 		srb->tag[0] = tag;
    913       1.7   tsutsui 		if (tag != 0) {
    914       1.7   tsutsui 			li->queued[srb->xs->xs_tag_id] = srb;
    915       1.7   tsutsui 			srb->tag[1] = srb->xs->xs_tag_id;
    916       1.7   tsutsui 			li->used++;
    917       1.7   tsutsui 		}
    918       1.7   tsutsui 
    919       1.7   tsutsui 		if (li->untagged != NULL && li->busy != 1) {
    920       1.7   tsutsui 			li->busy = 1;
    921       1.7   tsutsui 			TAILQ_REMOVE(&sc->sc_readysrb, srb, next);
    922       1.7   tsutsui 			sc->sc_actsrb = srb;
    923       1.7   tsutsui 			trm_select(sc, srb);
    924       1.7   tsutsui 			splx(s);
    925       1.7   tsutsui 			break;
    926       1.7   tsutsui 		}
    927       1.7   tsutsui 		if (li->untagged == NULL && tag != 0) {
    928       1.7   tsutsui 			TAILQ_REMOVE(&sc->sc_readysrb, srb, next);
    929       1.7   tsutsui 			sc->sc_actsrb = srb;
    930       1.7   tsutsui 			trm_select(sc, srb);
    931       1.7   tsutsui 			splx(s);
    932       1.7   tsutsui 			break;
    933       1.7   tsutsui 		} else
    934       1.7   tsutsui 			splx(s);
    935       1.7   tsutsui 	}
    936       1.7   tsutsui }
    937       1.7   tsutsui 
    938       1.7   tsutsui static int
    939      1.15   tsutsui trm_select(struct trm_softc *sc, struct trm_srb *srb)
    940       1.7   tsutsui {
    941       1.7   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
    942       1.7   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
    943       1.7   tsutsui 	struct scsipi_periph *periph = srb->xs->xs_periph;
    944       1.7   tsutsui 	int target = periph->periph_target;
    945       1.7   tsutsui 	int lun = periph->periph_lun;
    946       1.7   tsutsui 	struct trm_tinfo *ti = &sc->sc_tinfo[target];
    947      1.16   tsutsui 	uint8_t scsicmd;
    948       1.7   tsutsui 
    949       1.7   tsutsui 	DPRINTF(("trm_select.....\n"));
    950       1.7   tsutsui 
    951       1.7   tsutsui 	if ((srb->xs->xs_control & XS_CTL_POLL) == 0) {
    952      1.10    bouyer 		callout_reset(&srb->xs->xs_callout, mstohz(srb->xs->timeout),
    953      1.10    bouyer 		    trm_timeout, srb);
    954       1.7   tsutsui 	}
    955       1.7   tsutsui 
    956       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_HOSTID, sc->sc_id);
    957       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_TARGETID, target);
    958       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_SYNC, ti->synctl);
    959       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_OFFSET, ti->offset);
    960       1.7   tsutsui 	/* Flush FIFO */
    961       1.7   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_CLRFIFO);
    962       1.7   tsutsui 	DELAY(10);
    963       1.7   tsutsui 
    964       1.7   tsutsui 	sc->sc_phase = PH_BUS_FREE;	/* initial phase */
    965       1.7   tsutsui 
    966       1.7   tsutsui 	DPRINTF(("cmd = 0x%02x\n", srb->cmd[0]));
    967       1.7   tsutsui 
    968       1.7   tsutsui 	if (((ti->flag & WIDE_NEGO_ENABLE) &&
    969       1.7   tsutsui 	     (ti->flag & WIDE_NEGO_DONE) == 0) ||
    970       1.7   tsutsui 	    ((ti->flag & SYNC_NEGO_ENABLE) &&
    971       1.7   tsutsui 	     (ti->flag & SYNC_NEGO_DONE) == 0)) {
    972       1.7   tsutsui 		sc->sc_state = TRM_MSGOUT;
    973       1.7   tsutsui 		bus_space_write_1(iot, ioh, TRM_SCSI_FIFO,
    974       1.7   tsutsui 		    MSG_IDENTIFY(lun, 0));
    975       1.7   tsutsui 		bus_space_write_multi_1(iot, ioh,
    976       1.7   tsutsui 		    TRM_SCSI_FIFO, srb->cmd, srb->cmdlen);
    977       1.7   tsutsui 		/* it's important for atn stop */
    978       1.7   tsutsui 		bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL,
    979       1.7   tsutsui 		    DO_DATALATCH | DO_HWRESELECT);
    980       1.7   tsutsui 		/* SCSI command */
    981       1.7   tsutsui 		bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND, SCMD_SEL_ATNSTOP);
    982       1.7   tsutsui 		DPRINTF(("select with SEL_ATNSTOP\n"));
    983       1.7   tsutsui 		return (0);
    984       1.1   tsutsui 	}
    985       1.7   tsutsui 
    986       1.7   tsutsui 	if (srb->tag[0] != 0) {
    987       1.7   tsutsui 		/* Send identify message */
    988       1.7   tsutsui 		bus_space_write_1(iot, ioh, TRM_SCSI_FIFO,
    989       1.7   tsutsui 		    MSG_IDENTIFY(lun, 1));
    990       1.7   tsutsui 		/* Send Tag id */
    991       1.7   tsutsui 		bus_space_write_1(iot, ioh, TRM_SCSI_FIFO, srb->tag[0]);
    992       1.7   tsutsui 		bus_space_write_1(iot, ioh, TRM_SCSI_FIFO, srb->tag[1]);
    993       1.7   tsutsui 		scsicmd = SCMD_SEL_ATN3;
    994       1.7   tsutsui 		DPRINTF(("select with SEL_ATN3\n"));
    995       1.7   tsutsui 	} else {
    996       1.7   tsutsui 		/* Send identify message */
    997       1.7   tsutsui 		bus_space_write_1(iot, ioh, TRM_SCSI_FIFO,
    998       1.7   tsutsui 		    MSG_IDENTIFY(lun,
    999       1.7   tsutsui 		    (ti->flag & NO_RESELECT) == 0 &&
   1000       1.7   tsutsui 		    (srb->flag & AUTO_REQSENSE) == 0 &&
   1001       1.7   tsutsui 		    (srb->xs->xs_control & XS_CTL_REQSENSE) == 0));
   1002       1.7   tsutsui 		scsicmd = SCMD_SEL_ATN;
   1003       1.7   tsutsui 		DPRINTF(("select with SEL_ATN\n"));
   1004       1.7   tsutsui 	}
   1005       1.7   tsutsui 	sc->sc_state = TRM_START;
   1006       1.7   tsutsui 
   1007       1.7   tsutsui 	/*
   1008       1.7   tsutsui 	 * Send CDB ..command block...
   1009       1.7   tsutsui 	 */
   1010       1.7   tsutsui 	bus_space_write_multi_1(iot, ioh, TRM_SCSI_FIFO, srb->cmd, srb->cmdlen);
   1011       1.7   tsutsui 
   1012       1.7   tsutsui 	/*
   1013       1.8       wiz 	 * If trm_select returns 0: current interrupt status
   1014       1.7   tsutsui 	 * is interrupt enable.  It's said that SCSI processor is
   1015       1.7   tsutsui 	 * unoccupied.
   1016       1.7   tsutsui 	 */
   1017       1.7   tsutsui 	sc->sc_phase = PH_BUS_FREE;	/* SCSI bus free Phase */
   1018       1.7   tsutsui 	/* SCSI command */
   1019       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND, scsicmd);
   1020       1.7   tsutsui 	return (0);
   1021       1.1   tsutsui }
   1022       1.1   tsutsui 
   1023       1.1   tsutsui /*
   1024       1.1   tsutsui  * perform a hard reset on the SCSI bus (and TRM_S1040 chip).
   1025       1.1   tsutsui  */
   1026       1.1   tsutsui static void
   1027      1.15   tsutsui trm_reset(struct trm_softc *sc)
   1028       1.1   tsutsui {
   1029       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1030       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1031       1.1   tsutsui 	int s;
   1032       1.1   tsutsui 
   1033       1.7   tsutsui 	DPRINTF(("trm_reset.........\n"));
   1034       1.7   tsutsui 
   1035       1.1   tsutsui 	s = splbio();
   1036       1.1   tsutsui 
   1037       1.1   tsutsui 	/* disable SCSI and DMA interrupt */
   1038       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_DMA_INTEN, 0);
   1039       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_INTEN, 0);
   1040       1.1   tsutsui 
   1041       1.1   tsutsui 	trm_reset_scsi_bus(sc);
   1042       1.7   tsutsui 	DELAY(100000);
   1043       1.1   tsutsui 
   1044       1.1   tsutsui 	/* Enable SCSI interrupt */
   1045       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_INTEN,
   1046       1.1   tsutsui 	    EN_SELECT | EN_SELTIMEOUT | EN_DISCONNECT | EN_RESELECTED |
   1047       1.1   tsutsui 	    EN_SCSIRESET | EN_BUSSERVICE | EN_CMDDONE);
   1048       1.1   tsutsui 
   1049       1.1   tsutsui 	/* Enable DMA interrupt */
   1050       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_DMA_INTEN, EN_SCSIINTR);
   1051       1.1   tsutsui 
   1052       1.1   tsutsui 	/* Clear DMA FIFO */
   1053       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_DMA_CONTROL, CLRXFIFO);
   1054       1.1   tsutsui 
   1055       1.1   tsutsui 	/* Clear SCSI FIFO */
   1056       1.1   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_CLRFIFO);
   1057       1.1   tsutsui 
   1058       1.7   tsutsui 	sc->sc_actsrb = NULL;
   1059       1.1   tsutsui 	sc->sc_flag = 0;	/* RESET_DETECT, RESET_DONE, RESET_DEV */
   1060       1.1   tsutsui 
   1061       1.1   tsutsui 	splx(s);
   1062       1.1   tsutsui }
   1063       1.1   tsutsui 
   1064       1.1   tsutsui static void
   1065      1.15   tsutsui trm_timeout(void *arg)
   1066       1.1   tsutsui {
   1067       1.1   tsutsui 	struct trm_srb *srb = (struct trm_srb *)arg;
   1068  1.21.6.1    simonb 	struct scsipi_xfer *xs;
   1069  1.21.6.1    simonb 	struct scsipi_periph *periph;
   1070       1.1   tsutsui 	struct trm_softc *sc;
   1071       1.1   tsutsui 	int s;
   1072       1.1   tsutsui 
   1073  1.21.6.1    simonb 	if (srb == NULL) {
   1074  1.21.6.1    simonb 		printf("trm_timeout called with srb == NULL\n");
   1075  1.21.6.1    simonb 		return;
   1076  1.21.6.1    simonb 	}
   1077       1.1   tsutsui 
   1078  1.21.6.1    simonb 	xs = srb->xs;
   1079  1.21.6.1    simonb 	if (xs == NULL) {
   1080  1.21.6.1    simonb 		printf("trm_timeout called with xs == NULL\n");
   1081  1.21.6.1    simonb 		return;
   1082       1.1   tsutsui 	}
   1083       1.1   tsutsui 
   1084  1.21.6.1    simonb 	periph = xs->xs_periph;
   1085  1.21.6.1    simonb 	scsipi_printaddr(xs->xs_periph);
   1086  1.21.6.1    simonb 	printf("SCSI OpCode 0x%02x timed out\n", xs->cmd->opcode);
   1087  1.21.6.1    simonb 
   1088       1.1   tsutsui 	sc = (void *)periph->periph_channel->chan_adapter->adapt_dev;
   1089       1.1   tsutsui 
   1090       1.7   tsutsui 	trm_reset_scsi_bus(sc);
   1091       1.1   tsutsui 	s = splbio();
   1092       1.7   tsutsui 	srb->flag |= SRB_TIMEOUT;
   1093       1.7   tsutsui 	trm_done(sc, srb);
   1094       1.7   tsutsui 	/* XXX needs more.. */
   1095       1.1   tsutsui 	splx(s);
   1096       1.1   tsutsui }
   1097       1.1   tsutsui 
   1098       1.1   tsutsui /*
   1099       1.1   tsutsui  * Catch an interrupt from the adapter
   1100       1.1   tsutsui  * Process pending device interrupts.
   1101       1.1   tsutsui  */
   1102       1.1   tsutsui static int
   1103      1.15   tsutsui trm_intr(void *arg)
   1104       1.1   tsutsui {
   1105       1.1   tsutsui 	bus_space_tag_t iot;
   1106       1.1   tsutsui 	bus_space_handle_t ioh;
   1107       1.1   tsutsui 	struct trm_softc *sc;
   1108       1.7   tsutsui 	int intstat, stat;
   1109       1.7   tsutsui 
   1110       1.7   tsutsui 	DPRINTF(("trm_intr......\n"));
   1111       1.7   tsutsui 	sc = (struct trm_softc *)arg;
   1112       1.7   tsutsui 	if (sc == NULL)
   1113       1.7   tsutsui 		return (0);
   1114       1.1   tsutsui 
   1115       1.1   tsutsui 	iot = sc->sc_iot;
   1116       1.1   tsutsui 	ioh = sc->sc_ioh;
   1117       1.1   tsutsui 
   1118       1.1   tsutsui 	stat = bus_space_read_2(iot, ioh, TRM_SCSI_STATUS);
   1119       1.1   tsutsui 	if ((stat & SCSIINTERRUPT) == 0)
   1120       1.1   tsutsui 		return (0);
   1121       1.1   tsutsui 
   1122       1.7   tsutsui 	DPRINTF(("stat = %04x, ", stat));
   1123       1.1   tsutsui 	intstat = bus_space_read_1(iot, ioh, TRM_SCSI_INTSTATUS);
   1124       1.1   tsutsui 
   1125       1.7   tsutsui 	DPRINTF(("intstat=%02x, ", intstat));
   1126       1.1   tsutsui 	if (intstat & (INT_SELTIMEOUT | INT_DISCONNECT)) {
   1127       1.7   tsutsui 		DPRINTF(("\n"));
   1128       1.1   tsutsui 		trm_disconnect(sc);
   1129       1.1   tsutsui 		return (1);
   1130       1.1   tsutsui 	}
   1131       1.1   tsutsui 	if (intstat & INT_RESELECTED) {
   1132       1.7   tsutsui 		DPRINTF(("\n"));
   1133       1.1   tsutsui 		trm_reselect(sc);
   1134       1.1   tsutsui 		return (1);
   1135       1.1   tsutsui 	}
   1136       1.1   tsutsui 	if (intstat & INT_SCSIRESET) {
   1137       1.7   tsutsui 		DPRINTF(("\n"));
   1138       1.1   tsutsui 		trm_scsi_reset_detect(sc);
   1139       1.1   tsutsui 		return (1);
   1140       1.1   tsutsui 	}
   1141       1.1   tsutsui 	if (intstat & (INT_BUSSERVICE | INT_CMDDONE)) {
   1142       1.7   tsutsui 		DPRINTF(("sc->sc_phase = %2d, sc->sc_state = %2d\n",
   1143       1.7   tsutsui 		    sc->sc_phase, sc->sc_state));
   1144       1.1   tsutsui 		/*
   1145       1.1   tsutsui 		 * software sequential machine
   1146       1.1   tsutsui 		 */
   1147       1.1   tsutsui 
   1148       1.1   tsutsui 		/*
   1149       1.7   tsutsui 		 * call phase0 functions... "phase entry" handle
   1150       1.7   tsutsui 		 * every phase before start transfer
   1151       1.1   tsutsui 		 */
   1152       1.7   tsutsui 		switch (sc->sc_phase) {
   1153       1.7   tsutsui 		case PH_DATA_OUT:
   1154       1.7   tsutsui 			trm_dataout_phase0(sc, stat);
   1155       1.7   tsutsui 			break;
   1156       1.7   tsutsui 		case PH_DATA_IN:
   1157       1.7   tsutsui 			trm_datain_phase0(sc, stat);
   1158       1.7   tsutsui 			break;
   1159       1.7   tsutsui 		case PH_COMMAND:
   1160       1.7   tsutsui 			break;
   1161       1.7   tsutsui 		case PH_STATUS:
   1162       1.7   tsutsui 			trm_status_phase0(sc);
   1163       1.7   tsutsui 			stat = PH_BUS_FREE;
   1164       1.7   tsutsui 			break;
   1165       1.7   tsutsui 		case PH_MSG_OUT:
   1166       1.7   tsutsui 			if (sc->sc_state == TRM_UNEXPECT_RESEL ||
   1167       1.7   tsutsui 			    sc->sc_state == TRM_ABORT_SENT)
   1168       1.7   tsutsui 				stat = PH_BUS_FREE;
   1169       1.7   tsutsui 			break;
   1170       1.7   tsutsui 		case PH_MSG_IN:
   1171       1.7   tsutsui 			trm_msgin_phase0(sc);
   1172       1.7   tsutsui 			stat = PH_BUS_FREE;
   1173       1.7   tsutsui 			break;
   1174       1.7   tsutsui 		case PH_BUS_FREE:
   1175       1.7   tsutsui 			break;
   1176       1.7   tsutsui 		default:
   1177       1.7   tsutsui 			printf("%s: unexpected phase in trm_intr() phase0\n",
   1178       1.7   tsutsui 			    sc->sc_dev.dv_xname);
   1179       1.7   tsutsui 			break;
   1180       1.7   tsutsui 		}
   1181       1.1   tsutsui 
   1182       1.7   tsutsui 		sc->sc_phase = stat & PHASEMASK;
   1183       1.7   tsutsui 
   1184       1.7   tsutsui 		switch (sc->sc_phase) {
   1185       1.7   tsutsui 		case PH_DATA_OUT:
   1186       1.7   tsutsui 			trm_dataio_xfer(sc, XFERDATAOUT);
   1187       1.7   tsutsui 			break;
   1188       1.7   tsutsui 		case PH_DATA_IN:
   1189       1.7   tsutsui 			trm_dataio_xfer(sc, XFERDATAIN);
   1190       1.7   tsutsui 			break;
   1191       1.7   tsutsui 		case PH_COMMAND:
   1192       1.7   tsutsui 			trm_command_phase1(sc);
   1193       1.7   tsutsui 			break;
   1194       1.7   tsutsui 		case PH_STATUS:
   1195       1.7   tsutsui 			trm_status_phase1(sc);
   1196       1.7   tsutsui 			break;
   1197       1.7   tsutsui 		case PH_MSG_OUT:
   1198       1.7   tsutsui 			trm_msgout_phase1(sc);
   1199       1.7   tsutsui 			break;
   1200       1.7   tsutsui 		case PH_MSG_IN:
   1201       1.7   tsutsui 			trm_msgin_phase1(sc);
   1202       1.7   tsutsui 			break;
   1203       1.7   tsutsui 		case PH_BUS_FREE:
   1204       1.7   tsutsui 			break;
   1205       1.7   tsutsui 		default:
   1206       1.7   tsutsui 			printf("%s: unexpected phase in trm_intr() phase1\n",
   1207       1.7   tsutsui 			    sc->sc_dev.dv_xname);
   1208       1.7   tsutsui 			break;
   1209       1.7   tsutsui 		}
   1210       1.1   tsutsui 
   1211       1.1   tsutsui 		return (1);
   1212       1.1   tsutsui 	}
   1213       1.1   tsutsui 	return (0);
   1214       1.1   tsutsui }
   1215       1.1   tsutsui 
   1216       1.1   tsutsui static void
   1217      1.15   tsutsui trm_msgout_phase1(struct trm_softc *sc)
   1218       1.1   tsutsui {
   1219       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1220       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1221       1.7   tsutsui 	struct trm_srb *srb;
   1222       1.7   tsutsui 	struct scsipi_periph *periph;
   1223       1.7   tsutsui 	struct trm_tinfo *ti;
   1224       1.1   tsutsui 
   1225       1.1   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_CLRFIFO);
   1226       1.1   tsutsui 
   1227       1.7   tsutsui 	srb = sc->sc_actsrb;
   1228       1.7   tsutsui 
   1229       1.7   tsutsui 	/* message out phase */
   1230       1.7   tsutsui 	if (srb != NULL) {
   1231       1.7   tsutsui 		periph = srb->xs->xs_periph;
   1232       1.7   tsutsui 		ti = &sc->sc_tinfo[periph->periph_target];
   1233       1.7   tsutsui 
   1234       1.7   tsutsui 		if ((ti->flag & WIDE_NEGO_DOING) == 0 &&
   1235       1.7   tsutsui 		    (ti->flag & WIDE_NEGO_ENABLE)) {
   1236       1.7   tsutsui 			/* send WDTR */
   1237       1.7   tsutsui 			ti->flag &= ~SYNC_NEGO_DONE;
   1238       1.7   tsutsui 
   1239       1.7   tsutsui 			sc->sc_msgbuf[0] = MSG_IDENTIFY(periph->periph_lun, 0);
   1240       1.7   tsutsui 			sc->sc_msgbuf[1] = MSG_EXTENDED;
   1241       1.7   tsutsui 			sc->sc_msgbuf[2] = MSG_EXT_WDTR_LEN;
   1242       1.7   tsutsui 			sc->sc_msgbuf[3] = MSG_EXT_WDTR;
   1243       1.7   tsutsui 			sc->sc_msgbuf[4] = MSG_EXT_WDTR_BUS_16_BIT;
   1244       1.7   tsutsui 			sc->sc_msgcnt = 5;
   1245       1.7   tsutsui 
   1246       1.7   tsutsui 			ti->flag |= WIDE_NEGO_DOING;
   1247       1.7   tsutsui 		} else if ((ti->flag & SYNC_NEGO_DOING) == 0 &&
   1248       1.7   tsutsui 			   (ti->flag & SYNC_NEGO_ENABLE)) {
   1249       1.7   tsutsui 			/* send SDTR */
   1250       1.7   tsutsui 			int cnt = 0;
   1251       1.7   tsutsui 
   1252       1.7   tsutsui 			if ((ti->flag & WIDE_NEGO_DONE) == 0)
   1253       1.7   tsutsui 				sc->sc_msgbuf[cnt++] =
   1254       1.7   tsutsui 				    MSG_IDENTIFY(periph->periph_lun, 0);
   1255       1.7   tsutsui 
   1256       1.7   tsutsui 			sc->sc_msgbuf[cnt++] = MSG_EXTENDED;
   1257       1.7   tsutsui 			sc->sc_msgbuf[cnt++] = MSG_EXT_SDTR_LEN;
   1258       1.7   tsutsui 			sc->sc_msgbuf[cnt++] = MSG_EXT_SDTR;
   1259       1.7   tsutsui 			sc->sc_msgbuf[cnt++] = ti->period;
   1260       1.7   tsutsui 			sc->sc_msgbuf[cnt++] = TRM_MAX_OFFSET;
   1261       1.7   tsutsui 			sc->sc_msgcnt = cnt;
   1262       1.7   tsutsui 			ti->flag |= SYNC_NEGO_DOING;
   1263       1.7   tsutsui 		}
   1264       1.7   tsutsui 	}
   1265       1.7   tsutsui 	if (sc->sc_msgcnt == 0) {
   1266       1.7   tsutsui 		sc->sc_msgbuf[0] = MSG_ABORT;
   1267       1.7   tsutsui 		sc->sc_msgcnt = 1;
   1268       1.7   tsutsui 		sc->sc_state = TRM_ABORT_SENT;
   1269       1.7   tsutsui 	}
   1270       1.7   tsutsui 
   1271       1.7   tsutsui 	DPRINTF(("msgout: cnt = %d, ", sc->sc_msgcnt));
   1272       1.7   tsutsui 	DPRINTF(("msgbuf = %02x %02x %02x %02x %02x %02x\n",
   1273       1.7   tsutsui 	   sc->sc_msgbuf[0], sc->sc_msgbuf[1], sc->sc_msgbuf[2],
   1274       1.7   tsutsui 	   sc->sc_msgbuf[3], sc->sc_msgbuf[4], sc->sc_msgbuf[5]));
   1275       1.7   tsutsui 
   1276       1.7   tsutsui 	bus_space_write_multi_1(iot, ioh, TRM_SCSI_FIFO,
   1277       1.7   tsutsui 	    sc->sc_msgbuf, sc->sc_msgcnt);
   1278       1.7   tsutsui 	sc->sc_msgcnt = 0;
   1279       1.7   tsutsui 	memset(sc->sc_msgbuf, 0, sizeof(sc->sc_msgbuf));
   1280       1.7   tsutsui 
   1281       1.1   tsutsui 	/* it's important for atn stop */
   1282      1.18     perry 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_DATALATCH);
   1283       1.1   tsutsui 
   1284       1.1   tsutsui 	/*
   1285       1.8       wiz 	 * SCSI command
   1286       1.1   tsutsui 	 */
   1287       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND, SCMD_FIFO_OUT);
   1288       1.1   tsutsui }
   1289       1.1   tsutsui 
   1290       1.1   tsutsui static void
   1291      1.15   tsutsui trm_command_phase1(struct trm_softc *sc)
   1292       1.7   tsutsui {
   1293       1.7   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1294       1.7   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1295       1.1   tsutsui 	struct trm_srb *srb;
   1296       1.1   tsutsui 
   1297       1.7   tsutsui 	srb = sc->sc_actsrb;
   1298       1.7   tsutsui 	if (srb == NULL) {
   1299       1.7   tsutsui 		DPRINTF(("trm_command_phase1: no active srb\n"));
   1300       1.7   tsutsui 		return;
   1301       1.7   tsutsui 	}
   1302       1.1   tsutsui 
   1303       1.1   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_CLRATN | DO_CLRFIFO);
   1304       1.5   tsutsui 	bus_space_write_multi_1(iot, ioh, TRM_SCSI_FIFO, srb->cmd, srb->cmdlen);
   1305       1.1   tsutsui 
   1306       1.7   tsutsui 	sc->sc_state = TRM_COMMAND;
   1307       1.1   tsutsui 	/* it's important for atn stop */
   1308      1.18     perry 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_DATALATCH);
   1309       1.1   tsutsui 
   1310       1.1   tsutsui 	/*
   1311       1.8       wiz 	 * SCSI command
   1312       1.1   tsutsui 	 */
   1313       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND, SCMD_FIFO_OUT);
   1314       1.1   tsutsui }
   1315       1.1   tsutsui 
   1316       1.1   tsutsui static void
   1317      1.15   tsutsui trm_dataout_phase0(struct trm_softc *sc, int stat)
   1318       1.1   tsutsui {
   1319       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1320       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1321       1.7   tsutsui 	struct trm_srb *srb;
   1322       1.7   tsutsui 	struct scsipi_periph *periph;
   1323       1.7   tsutsui 	struct trm_tinfo *ti;
   1324       1.1   tsutsui 	struct trm_sg_entry *sg;
   1325       1.1   tsutsui 	int sgindex;
   1326      1.16   tsutsui 	uint32_t xferlen, leftcnt = 0;
   1327       1.1   tsutsui 
   1328       1.7   tsutsui 	if (sc->sc_state == TRM_XFERPAD)
   1329       1.7   tsutsui 		return;
   1330       1.7   tsutsui 
   1331       1.7   tsutsui 	srb = sc->sc_actsrb;
   1332       1.7   tsutsui 	if (srb == NULL) {
   1333       1.7   tsutsui 		DPRINTF(("trm_dataout_phase0: no active srb\n"));
   1334       1.7   tsutsui 		return;
   1335       1.7   tsutsui 	}
   1336       1.7   tsutsui 	periph = srb->xs->xs_periph;
   1337       1.7   tsutsui 	ti = &sc->sc_tinfo[periph->periph_target];
   1338       1.1   tsutsui 
   1339       1.7   tsutsui 	if ((stat & PARITYERROR) != 0)
   1340       1.7   tsutsui 		srb->flag |= PARITY_ERROR;
   1341       1.1   tsutsui 
   1342       1.7   tsutsui 	if ((stat & SCSIXFERDONE) == 0) {
   1343       1.7   tsutsui 		/*
   1344       1.7   tsutsui 		 * when data transfer from DMA FIFO to SCSI FIFO
   1345       1.7   tsutsui 		 * if there was some data left in SCSI FIFO
   1346       1.7   tsutsui 		 */
   1347       1.7   tsutsui 		leftcnt = bus_space_read_1(iot, ioh, TRM_SCSI_FIFOCNT) &
   1348       1.7   tsutsui 		    SCSI_FIFOCNT_MASK;
   1349       1.7   tsutsui 		if (ti->synctl & WIDE_SYNC)
   1350       1.1   tsutsui 			/*
   1351       1.7   tsutsui 			 * if WIDE scsi SCSI FIFOCNT unit is word
   1352       1.7   tsutsui 			 * so need to * 2
   1353       1.1   tsutsui 			 */
   1354       1.7   tsutsui 			leftcnt <<= 1;
   1355       1.7   tsutsui 	}
   1356       1.7   tsutsui 	/*
   1357       1.8       wiz 	 * calculate all the residue data that was not yet transferred
   1358       1.7   tsutsui 	 * SCSI transfer counter + left in SCSI FIFO data
   1359       1.7   tsutsui 	 *
   1360       1.7   tsutsui 	 * .....TRM_SCSI_XCNT (24bits)
   1361       1.8       wiz 	 * The counter always decrements by one for every SCSI
   1362       1.7   tsutsui 	 * byte transfer.
   1363       1.7   tsutsui 	 * .....TRM_SCSI_FIFOCNT ( 5bits)
   1364       1.7   tsutsui 	 * The counter is SCSI FIFO offset counter
   1365       1.7   tsutsui 	 */
   1366       1.7   tsutsui 	leftcnt += bus_space_read_4(iot, ioh, TRM_SCSI_XCNT);
   1367       1.7   tsutsui 	if (leftcnt == 1) {
   1368       1.7   tsutsui 		leftcnt = 0;
   1369       1.7   tsutsui 		bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_CLRFIFO);
   1370       1.7   tsutsui 	}
   1371       1.7   tsutsui 	if ((leftcnt == 0) || (stat & SCSIXFERCNT_2_ZERO)) {
   1372       1.7   tsutsui 		while ((bus_space_read_1(iot, ioh, TRM_DMA_STATUS) &
   1373       1.7   tsutsui 		    DMAXFERCOMP) == 0)
   1374       1.7   tsutsui 			;	/* XXX needs timeout */
   1375       1.7   tsutsui 
   1376       1.7   tsutsui 		srb->buflen = 0;
   1377       1.7   tsutsui 	} else {
   1378       1.7   tsutsui 		/* Update SG list */
   1379       1.7   tsutsui 
   1380       1.1   tsutsui 		/*
   1381       1.7   tsutsui 		 * if transfer not yet complete
   1382       1.7   tsutsui 		 * there were some data residue in SCSI FIFO or
   1383       1.7   tsutsui 		 * SCSI transfer counter not empty
   1384       1.1   tsutsui 		 */
   1385       1.7   tsutsui 		if (srb->buflen != leftcnt) {
   1386       1.7   tsutsui 			/* data that had transferred length */
   1387       1.7   tsutsui 			xferlen = srb->buflen - leftcnt;
   1388       1.7   tsutsui 
   1389       1.7   tsutsui 			/* next time to be transferred length */
   1390       1.7   tsutsui 			srb->buflen = leftcnt;
   1391       1.1   tsutsui 
   1392       1.1   tsutsui 			/*
   1393       1.7   tsutsui 			 * parsing from last time disconnect sgindex
   1394       1.1   tsutsui 			 */
   1395       1.7   tsutsui 			sg = srb->sgentry + srb->sgindex;
   1396       1.7   tsutsui 			for (sgindex = srb->sgindex;
   1397       1.7   tsutsui 			     sgindex < srb->sgcnt;
   1398       1.7   tsutsui 			     sgindex++, sg++) {
   1399       1.1   tsutsui 				/*
   1400       1.7   tsutsui 				 * find last time which SG transfer
   1401       1.7   tsutsui 				 * be disconnect
   1402       1.1   tsutsui 				 */
   1403       1.7   tsutsui 				if (xferlen >= le32toh(sg->length))
   1404       1.7   tsutsui 					xferlen -= le32toh(sg->length);
   1405       1.7   tsutsui 				else {
   1406       1.1   tsutsui 					/*
   1407       1.7   tsutsui 					 * update last time
   1408       1.7   tsutsui 					 * disconnected SG list
   1409       1.1   tsutsui 					 */
   1410       1.7   tsutsui 				        /* residue data length  */
   1411       1.7   tsutsui 					sg->length =
   1412       1.7   tsutsui 					    htole32(le32toh(sg->length)
   1413       1.7   tsutsui 					    - xferlen);
   1414       1.7   tsutsui 					/* residue data pointer */
   1415       1.7   tsutsui 					sg->address =
   1416       1.7   tsutsui 					    htole32(le32toh(sg->address)
   1417       1.7   tsutsui 					    + xferlen);
   1418       1.7   tsutsui 					srb->sgindex = sgindex;
   1419       1.7   tsutsui 					break;
   1420       1.1   tsutsui 				}
   1421       1.1   tsutsui 			}
   1422       1.7   tsutsui 			bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
   1423       1.7   tsutsui 			    srb->sgoffset, TRM_SG_SIZE, BUS_DMASYNC_PREWRITE);
   1424       1.1   tsutsui 		}
   1425       1.1   tsutsui 	}
   1426       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_DMA_CONTROL, STOPDMAXFER);
   1427       1.1   tsutsui }
   1428       1.1   tsutsui 
   1429       1.1   tsutsui static void
   1430      1.15   tsutsui trm_datain_phase0(struct trm_softc *sc, int stat)
   1431       1.1   tsutsui {
   1432       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1433       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1434       1.7   tsutsui 	struct trm_srb *srb;
   1435       1.1   tsutsui 	struct trm_sg_entry *sg;
   1436       1.1   tsutsui 	int sgindex;
   1437      1.16   tsutsui 	uint32_t xferlen, leftcnt = 0;
   1438       1.1   tsutsui 
   1439       1.7   tsutsui 	if (sc->sc_state == TRM_XFERPAD)
   1440       1.7   tsutsui 		return;
   1441       1.7   tsutsui 
   1442       1.7   tsutsui 	srb = sc->sc_actsrb;
   1443       1.7   tsutsui 	if (srb == NULL) {
   1444       1.7   tsutsui 		DPRINTF(("trm_datain_phase0: no active srb\n"));
   1445       1.7   tsutsui 		return;
   1446       1.7   tsutsui 	}
   1447       1.7   tsutsui 
   1448       1.7   tsutsui 	if (stat & PARITYERROR)
   1449       1.7   tsutsui 		srb->flag |= PARITY_ERROR;
   1450       1.7   tsutsui 
   1451       1.7   tsutsui 	leftcnt += bus_space_read_4(iot, ioh, TRM_SCSI_XCNT);
   1452       1.7   tsutsui 	if ((leftcnt == 0) || (stat & SCSIXFERCNT_2_ZERO)) {
   1453       1.7   tsutsui 		while ((bus_space_read_1(iot, ioh, TRM_DMA_STATUS) &
   1454       1.7   tsutsui 		    DMAXFERCOMP) == 0)
   1455       1.7   tsutsui 			;	/* XXX needs timeout */
   1456       1.1   tsutsui 
   1457       1.7   tsutsui 		srb->buflen = 0;
   1458       1.7   tsutsui 	} else {	/* phase changed */
   1459       1.7   tsutsui 		/*
   1460       1.7   tsutsui 		 * parsing the case:
   1461       1.7   tsutsui 		 * when a transfer not yet complete
   1462       1.8       wiz 		 * but be disconnected by upper layer
   1463       1.7   tsutsui 		 * if transfer not yet complete
   1464       1.7   tsutsui 		 * there were some data residue in SCSI FIFO or
   1465       1.7   tsutsui 		 * SCSI transfer counter not empty
   1466       1.7   tsutsui 		 */
   1467       1.7   tsutsui 		if (srb->buflen != leftcnt) {
   1468       1.1   tsutsui 			/*
   1469       1.7   tsutsui 			 * data that had transferred length
   1470       1.1   tsutsui 			 */
   1471       1.7   tsutsui 			xferlen = srb->buflen - leftcnt;
   1472       1.1   tsutsui 
   1473       1.7   tsutsui 			/*
   1474       1.7   tsutsui 			 * next time to be transferred length
   1475       1.7   tsutsui 			 */
   1476       1.7   tsutsui 			srb->buflen = leftcnt;
   1477       1.1   tsutsui 
   1478       1.7   tsutsui 			/*
   1479       1.7   tsutsui 			 * parsing from last time disconnect sgindex
   1480       1.7   tsutsui 			 */
   1481       1.7   tsutsui 			sg = srb->sgentry + srb->sgindex;
   1482       1.7   tsutsui 			for (sgindex = srb->sgindex;
   1483       1.7   tsutsui 			     sgindex < srb->sgcnt;
   1484       1.7   tsutsui 			     sgindex++, sg++) {
   1485       1.1   tsutsui 				/*
   1486       1.7   tsutsui 				 * find last time which SG transfer
   1487       1.7   tsutsui 				 * be disconnect
   1488       1.1   tsutsui 				 */
   1489       1.7   tsutsui 				if (xferlen >= le32toh(sg->length))
   1490       1.7   tsutsui 					xferlen -= le32toh(sg->length);
   1491       1.7   tsutsui 				else {
   1492       1.1   tsutsui 					/*
   1493       1.7   tsutsui 					 * update last time
   1494       1.7   tsutsui 					 * disconnected SG list
   1495       1.1   tsutsui 					 */
   1496       1.7   tsutsui 					/* residue data length  */
   1497       1.7   tsutsui 					sg->length =
   1498       1.7   tsutsui 					    htole32(le32toh(sg->length)
   1499       1.7   tsutsui 					    - xferlen);
   1500       1.7   tsutsui 					/* residue data pointer */
   1501       1.7   tsutsui 					sg->address =
   1502       1.7   tsutsui 					    htole32(le32toh(sg->address)
   1503       1.7   tsutsui 					    + xferlen);
   1504       1.7   tsutsui 					srb->sgindex = sgindex;
   1505       1.7   tsutsui 					break;
   1506       1.1   tsutsui 				}
   1507       1.1   tsutsui 			}
   1508       1.7   tsutsui 			bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
   1509       1.7   tsutsui 			    srb->sgoffset, TRM_SG_SIZE, BUS_DMASYNC_PREWRITE);
   1510       1.1   tsutsui 		}
   1511       1.1   tsutsui 	}
   1512       1.1   tsutsui }
   1513       1.1   tsutsui 
   1514       1.1   tsutsui static void
   1515      1.15   tsutsui trm_dataio_xfer(struct trm_softc *sc, int iodir)
   1516       1.1   tsutsui {
   1517       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1518       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1519       1.7   tsutsui 	struct trm_srb *srb;
   1520       1.7   tsutsui 	struct scsipi_periph *periph;
   1521       1.7   tsutsui 	struct trm_tinfo *ti;
   1522       1.7   tsutsui 
   1523       1.7   tsutsui 	srb = sc->sc_actsrb;
   1524       1.7   tsutsui 	if (srb == NULL) {
   1525       1.7   tsutsui 		DPRINTF(("trm_dataio_xfer: no active srb\n"));
   1526       1.7   tsutsui 		return;
   1527       1.7   tsutsui 	}
   1528       1.7   tsutsui 	periph = srb->xs->xs_periph;
   1529       1.7   tsutsui 	ti = &sc->sc_tinfo[periph->periph_target];
   1530       1.1   tsutsui 
   1531       1.1   tsutsui 	if (srb->sgindex < srb->sgcnt) {
   1532       1.1   tsutsui 		if (srb->buflen > 0) {
   1533       1.1   tsutsui 			/*
   1534       1.1   tsutsui 			 * load what physical address of Scatter/Gather
   1535       1.1   tsutsui 			 * list table want to be transfer
   1536       1.1   tsutsui 			 */
   1537       1.7   tsutsui 			sc->sc_state = TRM_DATA_XFER;
   1538       1.1   tsutsui 			bus_space_write_4(iot, ioh, TRM_DMA_XHIGHADDR, 0);
   1539       1.1   tsutsui 			bus_space_write_4(iot, ioh, TRM_DMA_XLOWADDR,
   1540       1.1   tsutsui 			    srb->sgaddr +
   1541       1.1   tsutsui 			    srb->sgindex * sizeof(struct trm_sg_entry));
   1542       1.1   tsutsui 			/*
   1543       1.1   tsutsui 			 * load how many bytes in the Scatter/Gather list table
   1544       1.1   tsutsui 			 */
   1545       1.1   tsutsui 			bus_space_write_4(iot, ioh, TRM_DMA_XCNT,
   1546       1.1   tsutsui 			    (srb->sgcnt - srb->sgindex)
   1547       1.1   tsutsui 			    * sizeof(struct trm_sg_entry));
   1548       1.1   tsutsui 			/*
   1549       1.1   tsutsui 			 * load total xfer length (24bits) max value 16Mbyte
   1550       1.1   tsutsui 			 */
   1551       1.1   tsutsui 			bus_space_write_4(iot, ioh, TRM_SCSI_XCNT, srb->buflen);
   1552       1.1   tsutsui 			/* Start DMA transfer */
   1553       1.1   tsutsui 			bus_space_write_1(iot, ioh, TRM_DMA_COMMAND,
   1554       1.1   tsutsui 			    iodir | SGXFER);
   1555       1.1   tsutsui 			bus_space_write_1(iot, ioh, TRM_DMA_CONTROL,
   1556       1.1   tsutsui 			    STARTDMAXFER);
   1557       1.1   tsutsui 
   1558       1.1   tsutsui 			/* Start SCSI transfer */
   1559       1.1   tsutsui 			/* it's important for atn stop */
   1560       1.1   tsutsui 			bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL,
   1561       1.1   tsutsui 			    DO_DATALATCH);
   1562      1.18     perry 
   1563       1.1   tsutsui 			/*
   1564       1.8       wiz 			 * SCSI command
   1565       1.1   tsutsui 			 */
   1566       1.1   tsutsui 			bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND,
   1567       1.1   tsutsui 			    (iodir == XFERDATAOUT) ?
   1568       1.1   tsutsui 			    SCMD_DMA_OUT : SCMD_DMA_IN);
   1569       1.1   tsutsui 		} else {	/* xfer pad */
   1570       1.1   tsutsui 			if (srb->sgcnt) {
   1571       1.1   tsutsui 				srb->hastat = H_OVER_UNDER_RUN;
   1572       1.1   tsutsui 			}
   1573       1.1   tsutsui 			bus_space_write_4(iot, ioh, TRM_SCSI_XCNT,
   1574       1.7   tsutsui 			    (ti->synctl & WIDE_SYNC) ? 2 : 1);
   1575       1.1   tsutsui 
   1576       1.1   tsutsui 			if (iodir == XFERDATAOUT)
   1577       1.1   tsutsui 				bus_space_write_2(iot, ioh, TRM_SCSI_FIFO, 0);
   1578       1.1   tsutsui 			else
   1579  1.21.6.2    kardel 				(void)bus_space_read_2(iot, ioh, TRM_SCSI_FIFO);
   1580       1.1   tsutsui 
   1581       1.7   tsutsui 			sc->sc_state = TRM_XFERPAD;
   1582       1.1   tsutsui 			/* it's important for atn stop */
   1583       1.1   tsutsui 			bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL,
   1584       1.1   tsutsui 			    DO_DATALATCH);
   1585      1.18     perry 
   1586       1.1   tsutsui 			/*
   1587       1.8       wiz 			 * SCSI command
   1588       1.1   tsutsui 			 */
   1589       1.1   tsutsui 			bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND,
   1590       1.1   tsutsui 			    (iodir == XFERDATAOUT) ?
   1591       1.1   tsutsui 			    SCMD_FIFO_OUT : SCMD_FIFO_IN);
   1592       1.1   tsutsui 		}
   1593       1.1   tsutsui 	}
   1594       1.1   tsutsui }
   1595       1.1   tsutsui 
   1596       1.1   tsutsui static void
   1597      1.15   tsutsui trm_status_phase0(struct trm_softc *sc)
   1598       1.1   tsutsui {
   1599       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1600       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1601       1.7   tsutsui 	struct trm_srb *srb;
   1602       1.1   tsutsui 
   1603       1.7   tsutsui 	srb = sc->sc_actsrb;
   1604       1.7   tsutsui 	if (srb == NULL) {
   1605       1.7   tsutsui 		DPRINTF(("trm_status_phase0: no active srb\n"));
   1606       1.7   tsutsui 		return;
   1607       1.7   tsutsui 	}
   1608       1.1   tsutsui 	srb->tastat = bus_space_read_1(iot, ioh, TRM_SCSI_FIFO);
   1609       1.7   tsutsui 	sc->sc_state = TRM_COMPLETED;
   1610       1.1   tsutsui 	/* it's important for atn stop */
   1611       1.1   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_DATALATCH);
   1612       1.1   tsutsui 
   1613       1.1   tsutsui 	/*
   1614       1.7   tsutsui 	 * SCSI command
   1615       1.1   tsutsui 	 */
   1616       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND, SCMD_MSGACCEPT);
   1617       1.1   tsutsui }
   1618       1.1   tsutsui 
   1619       1.1   tsutsui static void
   1620      1.15   tsutsui trm_status_phase1(struct trm_softc *sc)
   1621       1.1   tsutsui {
   1622       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1623       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1624       1.1   tsutsui 
   1625       1.1   tsutsui 	if (bus_space_read_1(iot, ioh, TRM_DMA_COMMAND) & XFERDATAIN) {
   1626       1.1   tsutsui 		if ((bus_space_read_1(iot, ioh, TRM_SCSI_FIFOCNT)
   1627       1.1   tsutsui 		    & SCSI_FIFO_EMPTY) == 0)
   1628       1.1   tsutsui 			bus_space_write_2(iot, ioh,
   1629       1.1   tsutsui 			    TRM_SCSI_CONTROL, DO_CLRFIFO);
   1630       1.1   tsutsui 		if ((bus_space_read_1(iot, ioh, TRM_DMA_FIFOSTATUS)
   1631       1.1   tsutsui 		    & DMA_FIFO_EMPTY) == 0)
   1632       1.1   tsutsui 			bus_space_write_1(iot, ioh, TRM_DMA_CONTROL, CLRXFIFO);
   1633       1.1   tsutsui 	} else {
   1634       1.1   tsutsui 		if ((bus_space_read_1(iot, ioh, TRM_DMA_FIFOSTATUS)
   1635       1.1   tsutsui 		    & DMA_FIFO_EMPTY) == 0)
   1636       1.1   tsutsui 			bus_space_write_1(iot, ioh, TRM_DMA_CONTROL, CLRXFIFO);
   1637       1.1   tsutsui 		if ((bus_space_read_1(iot, ioh, TRM_SCSI_FIFOCNT)
   1638       1.1   tsutsui 		    & SCSI_FIFO_EMPTY) == 0)
   1639       1.1   tsutsui 			bus_space_write_2(iot, ioh,
   1640       1.1   tsutsui 			    TRM_SCSI_CONTROL, DO_CLRFIFO);
   1641       1.1   tsutsui 	}
   1642       1.7   tsutsui 	sc->sc_state = TRM_STATUS;
   1643       1.1   tsutsui 	/* it's important for atn stop */
   1644       1.1   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_DATALATCH);
   1645       1.1   tsutsui 
   1646       1.1   tsutsui 	/*
   1647       1.8       wiz 	 * SCSI command
   1648       1.1   tsutsui 	 */
   1649       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND, SCMD_COMP);
   1650       1.1   tsutsui }
   1651       1.1   tsutsui 
   1652       1.1   tsutsui static void
   1653      1.15   tsutsui trm_msgin_phase0(struct trm_softc *sc)
   1654       1.1   tsutsui {
   1655       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1656       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1657       1.7   tsutsui 	struct trm_srb *srb;
   1658       1.7   tsutsui 	struct scsipi_periph *periph;
   1659       1.7   tsutsui 	struct trm_tinfo *ti;
   1660       1.7   tsutsui 	int index;
   1661      1.16   tsutsui 	uint8_t msgin_code;
   1662       1.1   tsutsui 
   1663       1.1   tsutsui 	msgin_code = bus_space_read_1(iot, ioh, TRM_SCSI_FIFO);
   1664       1.7   tsutsui 	if (sc->sc_state != TRM_EXTEND_MSGIN) {
   1665       1.7   tsutsui 		DPRINTF(("msgin: code = %02x\n", msgin_code));
   1666       1.7   tsutsui 		switch (msgin_code) {
   1667       1.7   tsutsui 		case MSG_DISCONNECT:
   1668       1.7   tsutsui 			sc->sc_state = TRM_DISCONNECTED;
   1669       1.7   tsutsui 			break;
   1670       1.7   tsutsui 
   1671       1.7   tsutsui 		case MSG_SAVEDATAPOINTER:
   1672       1.7   tsutsui 			break;
   1673       1.7   tsutsui 
   1674       1.7   tsutsui 		case MSG_EXTENDED:
   1675       1.7   tsutsui 		case MSG_SIMPLE_Q_TAG:
   1676       1.7   tsutsui 		case MSG_HEAD_OF_Q_TAG:
   1677       1.7   tsutsui 		case MSG_ORDERED_Q_TAG:
   1678       1.7   tsutsui 			sc->sc_state = TRM_EXTEND_MSGIN;
   1679       1.1   tsutsui 			/* extended message (01h) */
   1680       1.7   tsutsui 			sc->sc_msgbuf[0] = msgin_code;
   1681       1.1   tsutsui 
   1682       1.7   tsutsui 			sc->sc_msgcnt = 1;
   1683       1.1   tsutsui 			/* extended message length (n) */
   1684       1.7   tsutsui 			sc->sc_msg = &sc->sc_msgbuf[1];
   1685       1.1   tsutsui 
   1686       1.7   tsutsui 			break;
   1687       1.7   tsutsui 		case MSG_MESSAGE_REJECT:
   1688       1.1   tsutsui 			/* Reject message */
   1689       1.7   tsutsui 			srb = sc->sc_actsrb;
   1690       1.7   tsutsui 			if (srb == NULL) {
   1691       1.7   tsutsui 				DPRINTF(("trm_msgin_phase0: "
   1692       1.7   tsutsui 				    " message reject without actsrb\n"));
   1693       1.7   tsutsui 				break;
   1694       1.7   tsutsui 			}
   1695       1.7   tsutsui 			periph = srb->xs->xs_periph;
   1696       1.7   tsutsui 			ti = &sc->sc_tinfo[periph->periph_target];
   1697       1.7   tsutsui 
   1698       1.7   tsutsui 			if (ti->flag & WIDE_NEGO_ENABLE) {
   1699       1.7   tsutsui 				/* do wide nego reject */
   1700       1.7   tsutsui 				ti->flag |= WIDE_NEGO_DONE;
   1701       1.7   tsutsui 				ti->flag &=
   1702       1.7   tsutsui 				    ~(SYNC_NEGO_DONE | WIDE_NEGO_ENABLE);
   1703       1.7   tsutsui 				if ((ti->flag & SYNC_NEGO_ENABLE) &&
   1704       1.7   tsutsui 				    (ti->flag & SYNC_NEGO_DONE) == 0) {
   1705       1.1   tsutsui 					/* Set ATN, in case ATN was clear */
   1706       1.7   tsutsui 					sc->sc_state = TRM_MSGOUT;
   1707       1.1   tsutsui 					bus_space_write_2(iot, ioh,
   1708       1.1   tsutsui 					    TRM_SCSI_CONTROL, DO_SETATN);
   1709       1.1   tsutsui 				} else
   1710       1.1   tsutsui 					/* Clear ATN */
   1711       1.1   tsutsui 					bus_space_write_2(iot, ioh,
   1712       1.1   tsutsui 					    TRM_SCSI_CONTROL, DO_CLRATN);
   1713       1.7   tsutsui 			} else if (ti->flag & SYNC_NEGO_ENABLE) {
   1714       1.1   tsutsui 				/* do sync nego reject */
   1715       1.1   tsutsui 				bus_space_write_2(iot, ioh,
   1716       1.1   tsutsui 				    TRM_SCSI_CONTROL, DO_CLRATN);
   1717       1.7   tsutsui 				if (ti->flag & SYNC_NEGO_DOING) {
   1718       1.7   tsutsui 					ti->flag &=~(SYNC_NEGO_ENABLE |
   1719       1.1   tsutsui 					    SYNC_NEGO_DONE);
   1720       1.7   tsutsui 					ti->synctl = 0;
   1721       1.7   tsutsui 					ti->offset = 0;
   1722       1.7   tsutsui 					bus_space_write_1(iot, ioh,
   1723       1.7   tsutsui 					    TRM_SCSI_SYNC, ti->synctl);
   1724       1.7   tsutsui 					bus_space_write_1(iot, ioh,
   1725       1.7   tsutsui 					    TRM_SCSI_OFFSET, ti->offset);
   1726       1.1   tsutsui 				}
   1727       1.1   tsutsui 			}
   1728       1.7   tsutsui 			break;
   1729       1.7   tsutsui 
   1730       1.7   tsutsui 		case MSG_IGN_WIDE_RESIDUE:
   1731       1.1   tsutsui 			bus_space_write_4(iot, ioh, TRM_SCSI_XCNT, 1);
   1732  1.21.6.2    kardel 			(void)bus_space_read_1(iot, ioh, TRM_SCSI_FIFO);
   1733       1.7   tsutsui 			break;
   1734       1.7   tsutsui 
   1735       1.7   tsutsui 		default:
   1736       1.1   tsutsui 			/*
   1737       1.1   tsutsui 			 * Restore data pointer message
   1738       1.1   tsutsui 			 * Save data pointer message
   1739       1.1   tsutsui 			 * Completion message
   1740       1.1   tsutsui 			 * NOP message
   1741       1.1   tsutsui 			 */
   1742       1.7   tsutsui 			break;
   1743       1.1   tsutsui 		}
   1744       1.1   tsutsui 	} else {
   1745       1.1   tsutsui 		/*
   1746       1.7   tsutsui 		 * when extend message in: sc->sc_state = TRM_EXTEND_MSGIN
   1747       1.8       wiz 		 * Parsing incoming extented messages
   1748       1.1   tsutsui 		 */
   1749       1.7   tsutsui 		*sc->sc_msg++ = msgin_code;
   1750       1.7   tsutsui 		sc->sc_msgcnt++;
   1751       1.7   tsutsui 
   1752       1.7   tsutsui 		DPRINTF(("extended_msgin: cnt = %d, ", sc->sc_msgcnt));
   1753       1.7   tsutsui 		DPRINTF(("msgbuf = %02x %02x %02x %02x %02x %02x\n",
   1754       1.7   tsutsui 		    sc->sc_msgbuf[0], sc->sc_msgbuf[1], sc->sc_msgbuf[2],
   1755       1.7   tsutsui 		    sc->sc_msgbuf[3], sc->sc_msgbuf[4], sc->sc_msgbuf[5]));
   1756       1.7   tsutsui 
   1757       1.7   tsutsui 		switch (sc->sc_msgbuf[0]) {
   1758       1.7   tsutsui 		case MSG_SIMPLE_Q_TAG:
   1759       1.7   tsutsui 		case MSG_HEAD_OF_Q_TAG:
   1760       1.7   tsutsui 		case MSG_ORDERED_Q_TAG:
   1761       1.1   tsutsui 			/*
   1762       1.1   tsutsui 			 * is QUEUE tag message :
   1763       1.1   tsutsui 			 *
   1764       1.1   tsutsui 			 * byte 0:
   1765       1.1   tsutsui 			 *        HEAD    QUEUE TAG (20h)
   1766       1.1   tsutsui 			 *        ORDERED QUEUE TAG (21h)
   1767       1.1   tsutsui 			 *        SIMPLE  QUEUE TAG (22h)
   1768       1.1   tsutsui 			 * byte 1:
   1769       1.1   tsutsui 			 *        Queue tag (00h - FFh)
   1770       1.1   tsutsui 			 */
   1771       1.7   tsutsui 			if (sc->sc_msgcnt == 2 && sc->sc_actsrb == NULL) {
   1772       1.7   tsutsui 				/* XXX XXX XXX */
   1773       1.7   tsutsui 				struct trm_linfo *li;
   1774       1.7   tsutsui 				int tagid;
   1775       1.7   tsutsui 
   1776       1.7   tsutsui 				sc->sc_flag &= ~WAIT_TAGMSG;
   1777       1.7   tsutsui 				tagid = sc->sc_msgbuf[1];
   1778       1.7   tsutsui 				ti = &sc->sc_tinfo[sc->resel_target];
   1779       1.7   tsutsui 				li = ti->linfo[sc->resel_lun];
   1780       1.7   tsutsui 				srb = li->queued[tagid];
   1781       1.7   tsutsui 				if (srb != NULL) {
   1782       1.7   tsutsui 					sc->sc_actsrb = srb;
   1783       1.7   tsutsui 					sc->sc_state = TRM_DATA_XFER;
   1784       1.7   tsutsui 					break;
   1785       1.1   tsutsui 				} else {
   1786       1.7   tsutsui 					printf("%s: invalid tag id\n",
   1787       1.7   tsutsui 					   sc->sc_dev.dv_xname);
   1788       1.1   tsutsui 				}
   1789       1.7   tsutsui 
   1790       1.7   tsutsui 				sc->sc_state = TRM_UNEXPECT_RESEL;
   1791       1.7   tsutsui 				sc->sc_msgbuf[0] = MSG_ABORT_TAG;
   1792       1.7   tsutsui 				sc->sc_msgcnt = 1;
   1793       1.1   tsutsui 				bus_space_write_2(iot, ioh,
   1794       1.1   tsutsui 				    TRM_SCSI_CONTROL, DO_SETATN);
   1795       1.7   tsutsui 			} else
   1796       1.7   tsutsui 				sc->sc_state = TRM_IDLE;
   1797       1.7   tsutsui 			break;
   1798       1.7   tsutsui 
   1799       1.7   tsutsui 		case MSG_EXTENDED:
   1800       1.7   tsutsui 			srb = sc->sc_actsrb;
   1801       1.7   tsutsui 			if (srb == NULL) {
   1802       1.7   tsutsui 				DPRINTF(("trm_msgin_phase0: "
   1803       1.7   tsutsui 				    "extended message without actsrb\n"));
   1804       1.7   tsutsui 				break;
   1805       1.1   tsutsui 			}
   1806       1.7   tsutsui 			periph = srb->xs->xs_periph;
   1807       1.7   tsutsui 			ti = &sc->sc_tinfo[periph->periph_target];
   1808       1.7   tsutsui 
   1809       1.7   tsutsui 			if (sc->sc_msgbuf[2] == MSG_EXT_WDTR &&
   1810       1.7   tsutsui 			    sc->sc_msgcnt == 4) {
   1811       1.7   tsutsui 				/*
   1812       1.7   tsutsui 				 * is Wide data xfer Extended message :
   1813       1.7   tsutsui 				 * ======================================
   1814       1.7   tsutsui 				 * WIDE DATA TRANSFER REQUEST
   1815       1.7   tsutsui 				 * ======================================
   1816       1.7   tsutsui 				 * byte 0 :  Extended message (01h)
   1817       1.7   tsutsui 				 * byte 1 :  Extended message length (02h)
   1818       1.7   tsutsui 				 * byte 2 :  WIDE DATA TRANSFER code (03h)
   1819       1.7   tsutsui 				 * byte 3 :  Transfer width exponent
   1820       1.7   tsutsui 				 */
   1821       1.7   tsutsui 				if (sc->sc_msgbuf[1] != MSG_EXT_WDTR_LEN) {
   1822       1.7   tsutsui 					/* Length is wrong, reject it */
   1823       1.7   tsutsui 					ti->flag &= ~(WIDE_NEGO_ENABLE |
   1824       1.7   tsutsui 					    WIDE_NEGO_DONE);
   1825       1.7   tsutsui 					sc->sc_state = TRM_MSGOUT;
   1826       1.7   tsutsui 					sc->sc_msgbuf[0] = MSG_MESSAGE_REJECT;
   1827       1.7   tsutsui 					sc->sc_msgcnt = 1;
   1828       1.7   tsutsui 					bus_space_write_2(iot, ioh,
   1829       1.7   tsutsui 					    TRM_SCSI_CONTROL, DO_SETATN);
   1830       1.7   tsutsui 					break;
   1831       1.7   tsutsui 				}
   1832       1.7   tsutsui 
   1833       1.7   tsutsui 				if ((ti->flag & WIDE_NEGO_ENABLE) == 0)
   1834       1.7   tsutsui 					sc->sc_msgbuf[3] =
   1835       1.7   tsutsui 					    MSG_EXT_WDTR_BUS_8_BIT;
   1836       1.7   tsutsui 
   1837       1.7   tsutsui 				if (sc->sc_msgbuf[3] >
   1838       1.7   tsutsui 				    MSG_EXT_WDTR_BUS_32_BIT) {
   1839       1.1   tsutsui 					/* reject_msg: */
   1840       1.7   tsutsui 					ti->flag &= ~(WIDE_NEGO_ENABLE |
   1841       1.1   tsutsui 					    WIDE_NEGO_DONE);
   1842       1.7   tsutsui 					sc->sc_state = TRM_MSGOUT;
   1843       1.7   tsutsui 					sc->sc_msgbuf[0] = MSG_MESSAGE_REJECT;
   1844       1.7   tsutsui 					sc->sc_msgcnt = 1;
   1845       1.1   tsutsui 					bus_space_write_2(iot, ioh,
   1846       1.1   tsutsui 					    TRM_SCSI_CONTROL, DO_SETATN);
   1847       1.7   tsutsui 					break;
   1848       1.1   tsutsui 				}
   1849       1.7   tsutsui 				if (sc->sc_msgbuf[3] == MSG_EXT_WDTR_BUS_32_BIT)
   1850       1.1   tsutsui 					/* do 16 bits */
   1851       1.7   tsutsui 					sc->sc_msgbuf[3] =
   1852       1.7   tsutsui 					    MSG_EXT_WDTR_BUS_16_BIT;
   1853       1.7   tsutsui 				if ((ti->flag & WIDE_NEGO_DONE) == 0) {
   1854       1.7   tsutsui 					ti->flag |= WIDE_NEGO_DONE;
   1855       1.7   tsutsui 					ti->flag &= ~(SYNC_NEGO_DONE |
   1856       1.7   tsutsui 					    WIDE_NEGO_ENABLE);
   1857       1.7   tsutsui 					if (sc->sc_msgbuf[3] !=
   1858       1.7   tsutsui 					    MSG_EXT_WDTR_BUS_8_BIT)
   1859       1.7   tsutsui 						/* is Wide data xfer */
   1860       1.7   tsutsui 						ti->synctl |= WIDE_SYNC;
   1861       1.7   tsutsui 					trm_update_xfer_mode(sc,
   1862       1.7   tsutsui 					    periph->periph_target);
   1863       1.1   tsutsui 				}
   1864       1.1   tsutsui 
   1865       1.7   tsutsui 				sc->sc_state = TRM_MSGOUT;
   1866       1.1   tsutsui 				bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL,
   1867       1.1   tsutsui 				    DO_SETATN);
   1868       1.7   tsutsui 				break;
   1869       1.1   tsutsui 
   1870       1.7   tsutsui 			} else if (sc->sc_msgbuf[2] == MSG_EXT_SDTR &&
   1871       1.7   tsutsui 			 	   sc->sc_msgcnt == 5) {
   1872       1.1   tsutsui 				/*
   1873       1.7   tsutsui 				 * is 8bit transfer Extended message :
   1874       1.7   tsutsui 				 * =================================
   1875       1.7   tsutsui 				 * SYNCHRONOUS DATA TRANSFER REQUEST
   1876       1.7   tsutsui 				 * =================================
   1877       1.7   tsutsui 				 * byte 0 :  Extended message (01h)
   1878       1.7   tsutsui 				 * byte 1 :  Extended message length (03)
   1879       1.7   tsutsui 				 * byte 2 :  SYNC DATA TRANSFER code (01h)
   1880       1.7   tsutsui 				 * byte 3 :  Transfer period factor
   1881       1.7   tsutsui 				 * byte 4 :  REQ/ACK offset
   1882       1.1   tsutsui 				 */
   1883       1.7   tsutsui 				if (sc->sc_msgbuf[1] != MSG_EXT_SDTR_LEN) {
   1884       1.7   tsutsui 					/* reject_msg */
   1885       1.7   tsutsui 					sc->sc_state = TRM_MSGOUT;
   1886       1.7   tsutsui 					sc->sc_msgbuf[0] = MSG_MESSAGE_REJECT;
   1887       1.7   tsutsui 					sc->sc_msgcnt = 1;
   1888       1.7   tsutsui 					bus_space_write_2(iot, ioh,
   1889       1.7   tsutsui 					    TRM_SCSI_CONTROL, DO_SETATN);
   1890       1.7   tsutsui 					break;
   1891       1.7   tsutsui 				}
   1892       1.7   tsutsui 
   1893       1.7   tsutsui 				if ((ti->flag & SYNC_NEGO_DONE) == 0) {
   1894       1.7   tsutsui 					ti->flag &=
   1895       1.7   tsutsui 					    ~(SYNC_NEGO_ENABLE|SYNC_NEGO_DOING);
   1896       1.7   tsutsui 					ti->flag |= SYNC_NEGO_DONE;
   1897       1.7   tsutsui 					if (sc->sc_msgbuf[3] >= TRM_MAX_PERIOD)
   1898       1.7   tsutsui 						sc->sc_msgbuf[3] = 0;
   1899       1.7   tsutsui 					if (sc->sc_msgbuf[4] > TRM_MAX_OFFSET)
   1900       1.7   tsutsui 						sc->sc_msgbuf[4] =
   1901       1.7   tsutsui 						    TRM_MAX_OFFSET;
   1902       1.7   tsutsui 
   1903       1.7   tsutsui 					if (sc->sc_msgbuf[3] == 0 ||
   1904       1.7   tsutsui 					    sc->sc_msgbuf[4] == 0) {
   1905       1.7   tsutsui 						/* set async */
   1906       1.7   tsutsui 						ti->synctl = 0;
   1907       1.7   tsutsui 						ti->offset = 0;
   1908       1.7   tsutsui 					} else {
   1909       1.7   tsutsui 						/* set sync */
   1910       1.7   tsutsui 						/* Transfer period factor */
   1911       1.7   tsutsui 						ti->period = sc->sc_msgbuf[3];
   1912       1.7   tsutsui 						/* REQ/ACK offset */
   1913       1.7   tsutsui 						ti->offset = sc->sc_msgbuf[4];
   1914       1.7   tsutsui 						for (index = 0;
   1915       1.7   tsutsui 						    index < NPERIOD;
   1916       1.7   tsutsui 						    index++)
   1917       1.7   tsutsui 							if (ti->period <=
   1918       1.7   tsutsui 							    trm_clock_period[
   1919       1.7   tsutsui 							    index])
   1920       1.7   tsutsui 								break;
   1921       1.7   tsutsui 
   1922       1.7   tsutsui 						ti->synctl |= ALT_SYNC | index;
   1923       1.7   tsutsui 					}
   1924       1.7   tsutsui 					/*
   1925       1.7   tsutsui 					 * program SCSI control register
   1926       1.7   tsutsui 					 */
   1927       1.7   tsutsui 					bus_space_write_1(iot, ioh,
   1928       1.7   tsutsui 					    TRM_SCSI_SYNC, ti->synctl);
   1929       1.7   tsutsui 					bus_space_write_1(iot, ioh,
   1930       1.7   tsutsui 					    TRM_SCSI_OFFSET, ti->offset);
   1931       1.7   tsutsui 					trm_update_xfer_mode(sc,
   1932       1.7   tsutsui 					    periph->periph_target);
   1933       1.1   tsutsui 				}
   1934       1.7   tsutsui 				sc->sc_state = TRM_IDLE;
   1935       1.1   tsutsui 			}
   1936       1.7   tsutsui 			break;
   1937       1.7   tsutsui 		default:
   1938       1.7   tsutsui 			break;
   1939       1.1   tsutsui 		}
   1940       1.1   tsutsui 	}
   1941       1.7   tsutsui 
   1942       1.1   tsutsui 	/* it's important for atn stop */
   1943       1.1   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_DATALATCH);
   1944       1.1   tsutsui 
   1945       1.1   tsutsui 	/*
   1946       1.8       wiz 	 * SCSI command
   1947       1.1   tsutsui 	 */
   1948       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND, SCMD_MSGACCEPT);
   1949       1.1   tsutsui }
   1950       1.1   tsutsui 
   1951       1.1   tsutsui static void
   1952      1.15   tsutsui trm_msgin_phase1(struct trm_softc *sc)
   1953       1.1   tsutsui {
   1954       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1955       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1956       1.1   tsutsui 
   1957       1.1   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_CLRFIFO);
   1958       1.1   tsutsui 	bus_space_write_4(iot, ioh, TRM_SCSI_XCNT, 1);
   1959       1.7   tsutsui 	if (sc->sc_state != TRM_MSGIN && sc->sc_state != TRM_EXTEND_MSGIN) {
   1960       1.7   tsutsui 		sc->sc_state = TRM_MSGIN;
   1961       1.1   tsutsui 	}
   1962       1.7   tsutsui 
   1963       1.1   tsutsui 	/* it's important for atn stop */
   1964      1.18     perry 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_DATALATCH);
   1965       1.1   tsutsui 
   1966       1.1   tsutsui 	/*
   1967       1.8       wiz 	 * SCSI command
   1968       1.1   tsutsui 	 */
   1969       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND, SCMD_FIFO_IN);
   1970       1.1   tsutsui }
   1971       1.1   tsutsui 
   1972       1.1   tsutsui static void
   1973      1.15   tsutsui trm_disconnect(struct trm_softc *sc)
   1974       1.1   tsutsui {
   1975       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   1976       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   1977       1.7   tsutsui 	struct trm_srb *srb;
   1978       1.7   tsutsui 	int s;
   1979       1.1   tsutsui 
   1980       1.1   tsutsui 	s = splbio();
   1981       1.1   tsutsui 
   1982       1.7   tsutsui 	srb = sc->sc_actsrb;
   1983       1.7   tsutsui 	DPRINTF(("trm_disconnect...............\n"));
   1984       1.7   tsutsui 
   1985       1.7   tsutsui 	if (srb == NULL) {
   1986       1.7   tsutsui 		DPRINTF(("trm_disconnect: no active srb\n"));
   1987       1.1   tsutsui 		DELAY(1000);	/* 1 msec */
   1988       1.1   tsutsui 
   1989       1.1   tsutsui 		bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL,
   1990       1.1   tsutsui 		    DO_CLRFIFO | DO_HWRESELECT);
   1991       1.1   tsutsui 		return;
   1992       1.1   tsutsui 	}
   1993       1.7   tsutsui 	sc->sc_phase = PH_BUS_FREE;	/* SCSI bus free Phase */
   1994       1.1   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL,
   1995       1.1   tsutsui 	    DO_CLRFIFO | DO_HWRESELECT);
   1996       1.1   tsutsui 	DELAY(100);
   1997       1.7   tsutsui 
   1998       1.7   tsutsui 	switch (sc->sc_state) {
   1999       1.7   tsutsui 	case TRM_UNEXPECT_RESEL:
   2000       1.7   tsutsui 		sc->sc_state = TRM_IDLE;
   2001       1.7   tsutsui 		break;
   2002       1.7   tsutsui 
   2003       1.7   tsutsui 	case TRM_ABORT_SENT:
   2004       1.7   tsutsui 		goto finish;
   2005       1.7   tsutsui 
   2006       1.7   tsutsui 	case TRM_START:
   2007       1.7   tsutsui 	case TRM_MSGOUT:
   2008       1.7   tsutsui 		{
   2009       1.7   tsutsui 			/* Selection time out - discard all LUNs if empty */
   2010       1.7   tsutsui 			struct scsipi_periph *periph;
   2011       1.7   tsutsui 			struct trm_tinfo *ti;
   2012       1.7   tsutsui 			struct trm_linfo *li;
   2013       1.7   tsutsui 			int lun;
   2014       1.7   tsutsui 
   2015       1.7   tsutsui 			DPRINTF(("selection timeout\n"));
   2016       1.7   tsutsui 
   2017       1.7   tsutsui 			srb->tastat = SCSI_SEL_TIMEOUT; /* XXX Ok? */
   2018       1.7   tsutsui 
   2019       1.7   tsutsui 			periph = srb->xs->xs_periph;
   2020       1.7   tsutsui 			ti = &sc->sc_tinfo[periph->periph_target];
   2021       1.7   tsutsui 			for (lun = 0; lun < TRM_MAX_LUNS; lun++) {
   2022       1.7   tsutsui 				li = ti->linfo[lun];
   2023       1.7   tsutsui 				if (li != NULL &&
   2024       1.7   tsutsui 				    li->untagged == NULL && li->used == 0) {
   2025       1.7   tsutsui 					ti->linfo[lun] = NULL;
   2026       1.7   tsutsui 					free(li, M_DEVBUF);
   2027       1.7   tsutsui 				}
   2028       1.1   tsutsui 			}
   2029       1.1   tsutsui 		}
   2030       1.7   tsutsui 		goto finish;
   2031       1.7   tsutsui 
   2032       1.7   tsutsui 	case TRM_DISCONNECTED:
   2033       1.7   tsutsui 		sc->sc_actsrb = NULL;
   2034       1.7   tsutsui 		sc->sc_state = TRM_IDLE;
   2035       1.7   tsutsui 		goto sched;
   2036       1.7   tsutsui 
   2037       1.7   tsutsui 	case TRM_COMPLETED:
   2038       1.7   tsutsui 		goto finish;
   2039       1.1   tsutsui 	}
   2040       1.7   tsutsui 
   2041       1.7   tsutsui  out:
   2042       1.1   tsutsui 	splx(s);
   2043       1.7   tsutsui 	return;
   2044       1.7   tsutsui 
   2045       1.7   tsutsui  finish:
   2046       1.7   tsutsui 	sc->sc_state = TRM_IDLE;
   2047       1.7   tsutsui 	trm_done(sc, srb);
   2048       1.7   tsutsui 	goto out;
   2049       1.7   tsutsui 
   2050       1.7   tsutsui  sched:
   2051       1.7   tsutsui 	trm_sched(sc);
   2052       1.7   tsutsui 	goto out;
   2053       1.1   tsutsui }
   2054       1.1   tsutsui 
   2055       1.1   tsutsui static void
   2056      1.15   tsutsui trm_reselect(struct trm_softc *sc)
   2057       1.1   tsutsui {
   2058       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   2059       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   2060       1.7   tsutsui 	struct trm_tinfo *ti;
   2061       1.7   tsutsui 	struct trm_linfo *li;
   2062       1.7   tsutsui 	int target, lun;
   2063       1.7   tsutsui 
   2064       1.7   tsutsui 	DPRINTF(("trm_reselect.................\n"));
   2065       1.7   tsutsui 
   2066       1.7   tsutsui 	if (sc->sc_actsrb != NULL) {
   2067       1.7   tsutsui 		/* arbitration lost but reselection win */
   2068       1.7   tsutsui 		sc->sc_state = TRM_READY;
   2069       1.7   tsutsui 		target = sc->sc_actsrb->xs->xs_periph->periph_target;
   2070       1.7   tsutsui 		ti = &sc->sc_tinfo[target];
   2071       1.7   tsutsui 	} else {
   2072       1.7   tsutsui 		/* Read Reselected Target Id and LUN */
   2073       1.7   tsutsui 		target = bus_space_read_1(iot, ioh, TRM_SCSI_TARGETID);
   2074       1.7   tsutsui 		lun = bus_space_read_1(iot, ioh, TRM_SCSI_IDMSG) & 0x07;
   2075       1.7   tsutsui 		ti = &sc->sc_tinfo[target];
   2076       1.7   tsutsui 		li = ti->linfo[lun];
   2077       1.7   tsutsui 		DPRINTF(("target = %d, lun = %d\n", target, lun));
   2078       1.7   tsutsui 
   2079       1.7   tsutsui 		/*
   2080       1.7   tsutsui 		 * Check to see if we are running an un-tagged command.
   2081       1.7   tsutsui 		 * Otherwise ack the IDENTIFY and wait for a tag message.
   2082       1.7   tsutsui 		 */
   2083       1.7   tsutsui 		if (li != NULL) {
   2084       1.7   tsutsui 			if (li->untagged != NULL && li->busy) {
   2085       1.7   tsutsui 				sc->sc_actsrb = li->untagged;
   2086       1.7   tsutsui 				sc->sc_state = TRM_DATA_XFER;
   2087       1.7   tsutsui 			} else {
   2088       1.7   tsutsui 				sc->resel_target = target;
   2089       1.7   tsutsui 				sc->resel_lun = lun;
   2090       1.7   tsutsui 				/* XXX XXX XXX */
   2091       1.7   tsutsui 				sc->sc_flag |= WAIT_TAGMSG;
   2092       1.7   tsutsui 			}
   2093       1.7   tsutsui 		}
   2094       1.1   tsutsui 
   2095       1.7   tsutsui 		if ((ti->flag & USE_TAG_QUEUING) == 0 &&
   2096       1.7   tsutsui 		    sc->sc_actsrb == NULL) {
   2097       1.7   tsutsui 			printf("%s: reselect from target %d lun %d "
   2098       1.7   tsutsui 			    "without nexus; sending abort\n",
   2099       1.7   tsutsui 			    sc->sc_dev.dv_xname, target, lun);
   2100       1.7   tsutsui 			sc->sc_state = TRM_UNEXPECT_RESEL;
   2101       1.7   tsutsui 			sc->sc_msgbuf[0] = MSG_ABORT_TAG;
   2102       1.7   tsutsui 			sc->sc_msgcnt = 1;
   2103       1.7   tsutsui 			bus_space_write_2(iot, ioh,
   2104       1.7   tsutsui 			    TRM_SCSI_CONTROL, DO_SETATN);
   2105       1.1   tsutsui 		}
   2106       1.1   tsutsui 	}
   2107       1.7   tsutsui 	sc->sc_phase = PH_BUS_FREE;	/* SCSI bus free Phase */
   2108       1.1   tsutsui 	/*
   2109       1.1   tsutsui 	 * Program HA ID, target ID, period and offset
   2110       1.1   tsutsui 	 */
   2111       1.1   tsutsui 	/* target ID */
   2112       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_TARGETID, target);
   2113       1.1   tsutsui 
   2114       1.1   tsutsui 	/* host ID */
   2115       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_HOSTID, sc->sc_id);
   2116       1.1   tsutsui 
   2117       1.1   tsutsui 	/* period */
   2118       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_SYNC, ti->synctl);
   2119       1.1   tsutsui 
   2120       1.1   tsutsui 	/* offset */
   2121       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_OFFSET, ti->offset);
   2122       1.1   tsutsui 
   2123       1.1   tsutsui 	/* it's important for atn stop */
   2124       1.1   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_DATALATCH);
   2125       1.1   tsutsui 	/*
   2126       1.8       wiz 	 * SCSI command
   2127       1.1   tsutsui 	 */
   2128       1.1   tsutsui 	/* to rls the /ACK signal */
   2129       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_SCSI_COMMAND, SCMD_MSGACCEPT);
   2130       1.1   tsutsui }
   2131       1.1   tsutsui 
   2132       1.1   tsutsui /*
   2133       1.1   tsutsui  * Complete execution of a SCSI command
   2134       1.1   tsutsui  * Signal completion to the generic SCSI driver
   2135       1.1   tsutsui  */
   2136       1.1   tsutsui static void
   2137      1.15   tsutsui trm_done(struct trm_softc *sc, struct trm_srb *srb)
   2138       1.1   tsutsui {
   2139       1.1   tsutsui 	struct scsipi_xfer *xs = srb->xs;
   2140       1.1   tsutsui 
   2141       1.7   tsutsui 	DPRINTF(("trm_done..................\n"));
   2142       1.1   tsutsui 
   2143       1.1   tsutsui 	if (xs == NULL)
   2144       1.1   tsutsui 		return;
   2145       1.1   tsutsui 
   2146       1.5   tsutsui 	if ((xs->xs_control & XS_CTL_POLL) == 0)
   2147       1.5   tsutsui 		callout_stop(&xs->xs_callout);
   2148       1.1   tsutsui 
   2149       1.5   tsutsui 	if (xs->xs_control & (XS_CTL_DATA_IN | XS_CTL_DATA_OUT) ||
   2150       1.5   tsutsui 	    srb->flag & AUTO_REQSENSE) {
   2151       1.5   tsutsui 		bus_dmamap_sync(sc->sc_dmat, srb->dmap, 0,
   2152       1.5   tsutsui 		    srb->dmap->dm_mapsize,
   2153       1.5   tsutsui 		    ((xs->xs_control & XS_CTL_DATA_IN) ||
   2154       1.5   tsutsui 		    (srb->flag & AUTO_REQSENSE)) ?
   2155       1.5   tsutsui 		    BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
   2156       1.5   tsutsui 		bus_dmamap_unload(sc->sc_dmat, srb->dmap);
   2157       1.5   tsutsui 	}
   2158       1.1   tsutsui 
   2159       1.1   tsutsui 	/*
   2160       1.1   tsutsui 	 * target status
   2161       1.1   tsutsui 	 */
   2162       1.5   tsutsui 	xs->status = srb->tastat;
   2163       1.5   tsutsui 
   2164       1.7   tsutsui 	DPRINTF(("xs->status = 0x%02x\n", xs->status));
   2165       1.7   tsutsui 
   2166       1.5   tsutsui 	switch (xs->status) {
   2167       1.5   tsutsui 	case SCSI_OK:
   2168       1.1   tsutsui 		/*
   2169       1.1   tsutsui 		 * process initiator status......
   2170       1.1   tsutsui 		 * Adapter (initiator) status
   2171       1.1   tsutsui 		 */
   2172       1.7   tsutsui 		if ((srb->hastat & H_OVER_UNDER_RUN) != 0) {
   2173       1.7   tsutsui 			printf("%s: over/under run error\n",
   2174       1.7   tsutsui 			    sc->sc_dev.dv_xname);
   2175       1.1   tsutsui 			srb->tastat = 0;
   2176       1.1   tsutsui 			/* Illegal length (over/under run) */
   2177       1.1   tsutsui 			xs->error = XS_DRIVER_STUFFUP;
   2178       1.7   tsutsui 		} else if ((srb->flag & PARITY_ERROR) != 0) {
   2179       1.7   tsutsui 			printf("%s: parity error\n",
   2180       1.7   tsutsui 			    sc->sc_dev.dv_xname);
   2181       1.1   tsutsui 			/* Driver failed to perform operation */
   2182       1.7   tsutsui 			xs->error = XS_DRIVER_STUFFUP; /* XXX */
   2183       1.7   tsutsui 		} else if ((srb->flag & SRB_TIMEOUT) != 0) {
   2184       1.7   tsutsui 			xs->resid = srb->buflen;
   2185       1.7   tsutsui 			xs->error = XS_TIMEOUT;
   2186       1.5   tsutsui 		} else {
   2187       1.5   tsutsui 			/* No error */
   2188       1.7   tsutsui 			xs->resid = srb->buflen;
   2189       1.1   tsutsui 			srb->hastat = 0;
   2190       1.5   tsutsui 			if (srb->flag & AUTO_REQSENSE) {
   2191       1.5   tsutsui 				/* there is no error, (sense is invalid) */
   2192       1.5   tsutsui 				xs->error = XS_SENSE;
   2193       1.5   tsutsui 			} else {
   2194       1.5   tsutsui 				srb->tastat = 0;
   2195       1.5   tsutsui 				xs->error = XS_NOERROR;
   2196       1.5   tsutsui 			}
   2197       1.5   tsutsui 		}
   2198       1.5   tsutsui 		break;
   2199       1.7   tsutsui 
   2200       1.5   tsutsui 	case SCSI_CHECK:
   2201       1.5   tsutsui 		if ((srb->flag & AUTO_REQSENSE) != 0 ||
   2202       1.7   tsutsui 		    trm_request_sense(sc, srb) != 0) {
   2203       1.5   tsutsui 			printf("%s: request sense failed\n",
   2204       1.5   tsutsui 			    sc->sc_dev.dv_xname);
   2205       1.5   tsutsui 			xs->error = XS_DRIVER_STUFFUP;
   2206       1.5   tsutsui 			break;
   2207       1.1   tsutsui 		}
   2208       1.5   tsutsui 		xs->error = XS_SENSE;
   2209       1.5   tsutsui 		return;
   2210       1.7   tsutsui 
   2211       1.5   tsutsui 	case SCSI_SEL_TIMEOUT:
   2212       1.5   tsutsui 		srb->hastat = H_SEL_TIMEOUT;
   2213       1.5   tsutsui 		srb->tastat = 0;
   2214       1.7   tsutsui 		xs->error = XS_SELTIMEOUT;
   2215       1.5   tsutsui 		break;
   2216       1.7   tsutsui 
   2217       1.7   tsutsui 	case SCSI_QUEUE_FULL:
   2218       1.5   tsutsui 	case SCSI_BUSY:
   2219       1.5   tsutsui 		xs->error = XS_BUSY;
   2220       1.5   tsutsui 		break;
   2221       1.7   tsutsui 
   2222       1.5   tsutsui 	case SCSI_RESV_CONFLICT:
   2223       1.7   tsutsui 		DPRINTF(("%s: target reserved at ", sc->sc_dev.dv_xname));
   2224       1.7   tsutsui 		DPRINTF(("%s %d\n", __FILE__, __LINE__));
   2225       1.5   tsutsui 		xs->error = XS_BUSY;
   2226       1.5   tsutsui 		break;
   2227       1.7   tsutsui 
   2228       1.5   tsutsui 	default:
   2229       1.5   tsutsui 		srb->hastat = 0;
   2230       1.7   tsutsui 		printf("%s: trm_done(): unknown status = %02x\n",
   2231       1.7   tsutsui 		    sc->sc_dev.dv_xname, xs->status);
   2232       1.5   tsutsui 		xs->error = XS_DRIVER_STUFFUP;
   2233       1.5   tsutsui 		break;
   2234       1.1   tsutsui 	}
   2235       1.5   tsutsui 
   2236       1.7   tsutsui 	trm_dequeue(sc, srb);
   2237       1.7   tsutsui 	if (srb == sc->sc_actsrb) {
   2238       1.7   tsutsui 		sc->sc_actsrb = NULL;
   2239       1.7   tsutsui 		trm_sched(sc);
   2240       1.7   tsutsui 	}
   2241       1.1   tsutsui 
   2242       1.7   tsutsui 	TAILQ_INSERT_TAIL(&sc->sc_freesrb, srb, next);
   2243       1.5   tsutsui 
   2244       1.1   tsutsui 	/* Notify cmd done */
   2245       1.1   tsutsui 	scsipi_done(xs);
   2246       1.1   tsutsui }
   2247       1.1   tsutsui 
   2248       1.7   tsutsui static int
   2249      1.15   tsutsui trm_request_sense(struct trm_softc *sc, struct trm_srb *srb)
   2250       1.1   tsutsui {
   2251       1.1   tsutsui 	struct scsipi_xfer *xs;
   2252       1.7   tsutsui 	struct scsipi_periph *periph;
   2253       1.7   tsutsui 	struct trm_tinfo *ti;
   2254       1.7   tsutsui 	struct trm_linfo *li;
   2255      1.17   thorpej 	struct scsi_request_sense *ss = (struct scsi_request_sense *)srb->cmd;
   2256       1.7   tsutsui 	int error;
   2257       1.1   tsutsui 
   2258       1.7   tsutsui 	DPRINTF(("trm_request_sense...\n"));
   2259       1.1   tsutsui 
   2260       1.7   tsutsui 	xs = srb->xs;
   2261       1.7   tsutsui 	periph = xs->xs_periph;
   2262       1.1   tsutsui 
   2263       1.1   tsutsui 	srb->flag |= AUTO_REQSENSE;
   2264       1.1   tsutsui 
   2265       1.1   tsutsui 	/* Status of initiator/target */
   2266       1.1   tsutsui 	srb->hastat = 0;
   2267       1.1   tsutsui 	srb->tastat = 0;
   2268       1.1   tsutsui 
   2269      1.17   thorpej 	memset(ss, 0, sizeof(*ss));
   2270      1.17   thorpej 	ss->opcode = SCSI_REQUEST_SENSE;
   2271       1.7   tsutsui 	ss->byte2 = periph->periph_lun << SCSI_CMD_LUN_SHIFT;
   2272      1.17   thorpej 	ss->length = sizeof(struct scsi_sense_data);
   2273       1.1   tsutsui 
   2274      1.17   thorpej 	srb->buflen = sizeof(struct scsi_sense_data);
   2275       1.1   tsutsui 	srb->sgcnt = 1;
   2276       1.1   tsutsui 	srb->sgindex = 0;
   2277      1.17   thorpej 	srb->cmdlen = sizeof(struct scsi_request_sense);
   2278       1.1   tsutsui 
   2279       1.1   tsutsui 	if ((error = bus_dmamap_load(sc->sc_dmat, srb->dmap,
   2280       1.1   tsutsui 	    &xs->sense.scsi_sense, srb->buflen, NULL,
   2281       1.1   tsutsui 	    BUS_DMA_READ|BUS_DMA_NOWAIT)) != 0) {
   2282       1.5   tsutsui 		return error;
   2283       1.1   tsutsui 	}
   2284       1.1   tsutsui 	bus_dmamap_sync(sc->sc_dmat, srb->dmap, 0,
   2285       1.1   tsutsui 	    srb->buflen, BUS_DMASYNC_PREREAD);
   2286       1.1   tsutsui 
   2287       1.1   tsutsui 	srb->sgentry[0].address = htole32(srb->dmap->dm_segs[0].ds_addr);
   2288      1.17   thorpej 	srb->sgentry[0].length = htole32(sizeof(struct scsi_sense_data));
   2289       1.1   tsutsui 	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap, srb->sgoffset,
   2290       1.1   tsutsui 	    TRM_SG_SIZE, BUS_DMASYNC_PREWRITE);
   2291       1.1   tsutsui 
   2292       1.7   tsutsui 	ti = &sc->sc_tinfo[periph->periph_target];
   2293       1.7   tsutsui 	li = ti->linfo[periph->periph_lun];
   2294       1.7   tsutsui 	if (li->busy > 0)
   2295       1.7   tsutsui 		li->busy = 0;
   2296       1.7   tsutsui 	trm_dequeue(sc, srb);
   2297       1.7   tsutsui 	li->untagged = srb;	/* must be executed first to fix C/A */
   2298       1.7   tsutsui 	li->busy = 2;
   2299       1.7   tsutsui 
   2300       1.7   tsutsui 	if (srb == sc->sc_actsrb)
   2301       1.7   tsutsui 		trm_select(sc, srb);
   2302       1.7   tsutsui 	else {
   2303       1.7   tsutsui 		TAILQ_INSERT_HEAD(&sc->sc_readysrb, srb, next);
   2304       1.7   tsutsui 		if (sc->sc_actsrb == NULL)
   2305       1.7   tsutsui 			trm_sched(sc);
   2306       1.7   tsutsui 	}
   2307       1.5   tsutsui 	return 0;
   2308       1.1   tsutsui }
   2309       1.1   tsutsui 
   2310       1.1   tsutsui static void
   2311      1.15   tsutsui trm_dequeue(struct trm_softc *sc, struct trm_srb *srb)
   2312       1.1   tsutsui {
   2313       1.7   tsutsui 	struct scsipi_periph *periph;
   2314       1.7   tsutsui 	struct trm_tinfo *ti;
   2315       1.7   tsutsui 	struct trm_linfo *li;
   2316       1.7   tsutsui 
   2317       1.7   tsutsui 	periph = srb->xs->xs_periph;
   2318       1.7   tsutsui 	ti = &sc->sc_tinfo[periph->periph_target];
   2319       1.7   tsutsui 	li = ti->linfo[periph->periph_lun];
   2320       1.1   tsutsui 
   2321       1.7   tsutsui 	if (li->untagged == srb) {
   2322       1.7   tsutsui 		li->busy = 0;
   2323       1.7   tsutsui 		li->untagged = NULL;
   2324       1.7   tsutsui 	}
   2325       1.7   tsutsui 	if (srb->tag[0] != 0 && li->queued[srb->tag[1]] != NULL) {
   2326       1.7   tsutsui 		li->queued[srb->tag[1]] = NULL;
   2327       1.7   tsutsui 		li->used--;
   2328       1.7   tsutsui 	}
   2329       1.1   tsutsui }
   2330       1.1   tsutsui 
   2331       1.1   tsutsui static void
   2332      1.15   tsutsui trm_reset_scsi_bus(struct trm_softc *sc)
   2333       1.1   tsutsui {
   2334       1.7   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   2335       1.7   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   2336       1.7   tsutsui 	int timeout, s;
   2337       1.1   tsutsui 
   2338       1.7   tsutsui 	DPRINTF(("trm_reset_scsi_bus.........\n"));
   2339       1.1   tsutsui 
   2340       1.1   tsutsui 	s = splbio();
   2341       1.7   tsutsui 
   2342       1.7   tsutsui 	sc->sc_flag |= RESET_DEV;
   2343       1.7   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_RSTSCSI);
   2344       1.7   tsutsui 	for (timeout = 20000; timeout >= 0; timeout--) {
   2345       1.7   tsutsui 		DELAY(1);
   2346       1.7   tsutsui 		if ((bus_space_read_2(iot, ioh, TRM_SCSI_INTSTATUS) &
   2347       1.7   tsutsui 		    INT_SCSIRESET) == 0)
   2348       1.7   tsutsui 			break;
   2349       1.1   tsutsui 	}
   2350       1.7   tsutsui 	if (timeout == 0)
   2351       1.7   tsutsui 		printf(": scsibus reset timeout\n");
   2352      1.18     perry 
   2353       1.1   tsutsui 	splx(s);
   2354       1.1   tsutsui }
   2355       1.1   tsutsui 
   2356       1.1   tsutsui static void
   2357      1.15   tsutsui trm_scsi_reset_detect(struct trm_softc *sc)
   2358       1.1   tsutsui {
   2359       1.7   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   2360       1.7   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   2361       1.7   tsutsui 	int s;
   2362       1.7   tsutsui 
   2363       1.7   tsutsui 	DPRINTF(("trm_scsi_reset_detect...............\n"));
   2364       1.7   tsutsui 	DELAY(1000000);		/* delay 1 sec */
   2365       1.7   tsutsui 
   2366       1.7   tsutsui 	s = splbio();
   2367       1.1   tsutsui 
   2368       1.7   tsutsui 	bus_space_write_1(iot, ioh, TRM_DMA_CONTROL, STOPDMAXFER);
   2369       1.7   tsutsui 	bus_space_write_2(iot, ioh, TRM_SCSI_CONTROL, DO_CLRFIFO);
   2370       1.1   tsutsui 
   2371       1.7   tsutsui 	if (sc->sc_flag & RESET_DEV) {
   2372       1.7   tsutsui 		sc->sc_flag |= RESET_DONE;
   2373       1.7   tsutsui 	} else {
   2374       1.7   tsutsui 		sc->sc_flag |= RESET_DETECT;
   2375       1.7   tsutsui 		sc->sc_actsrb = NULL;
   2376       1.7   tsutsui 		sc->sc_flag = 0;
   2377       1.7   tsutsui 		trm_sched(sc);
   2378       1.1   tsutsui 	}
   2379       1.7   tsutsui 	splx(s);
   2380       1.1   tsutsui }
   2381       1.1   tsutsui 
   2382       1.1   tsutsui /*
   2383       1.7   tsutsui  * read seeprom 128 bytes to struct eeprom and check checksum.
   2384       1.8       wiz  * If it is wrong, update with default value.
   2385       1.1   tsutsui  */
   2386       1.1   tsutsui static void
   2387      1.15   tsutsui trm_check_eeprom(struct trm_softc *sc, struct trm_nvram *eeprom)
   2388       1.1   tsutsui {
   2389       1.7   tsutsui 	struct nvram_target *target;
   2390      1.16   tsutsui 	uint16_t *ep;
   2391      1.16   tsutsui 	uint16_t chksum;
   2392       1.7   tsutsui 	int i;
   2393       1.7   tsutsui 
   2394       1.7   tsutsui 	DPRINTF(("trm_check_eeprom......\n"));
   2395       1.7   tsutsui 	trm_eeprom_read_all(sc, eeprom);
   2396      1.16   tsutsui 	ep = (uint16_t *)eeprom;
   2397       1.7   tsutsui 	chksum = 0;
   2398       1.7   tsutsui 	for (i = 0; i < 64; i++)
   2399       1.7   tsutsui 		chksum += le16toh(*ep++);
   2400       1.7   tsutsui 
   2401       1.7   tsutsui 	if (chksum != TRM_NVRAM_CKSUM) {
   2402       1.7   tsutsui 		DPRINTF(("TRM_S1040 EEPROM Check Sum ERROR (load default).\n"));
   2403       1.7   tsutsui 		/*
   2404       1.7   tsutsui 		 * Checksum error, load default
   2405       1.7   tsutsui 		 */
   2406       1.7   tsutsui 		eeprom->subvendor_id[0] = PCI_VENDOR_TEKRAM2 & 0xFF;
   2407       1.7   tsutsui 		eeprom->subvendor_id[1] = PCI_VENDOR_TEKRAM2 >> 8;
   2408       1.7   tsutsui 		eeprom->subsys_id[0] = PCI_PRODUCT_TEKRAM2_DC315 & 0xFF;
   2409       1.7   tsutsui 		eeprom->subsys_id[1] = PCI_PRODUCT_TEKRAM2_DC315 >> 8;
   2410       1.7   tsutsui 		eeprom->subclass = 0x00;
   2411       1.7   tsutsui 		eeprom->vendor_id[0] = PCI_VENDOR_TEKRAM2 & 0xFF;
   2412       1.7   tsutsui 		eeprom->vendor_id[1] = PCI_VENDOR_TEKRAM2 >> 8;
   2413       1.7   tsutsui 		eeprom->device_id[0] = PCI_PRODUCT_TEKRAM2_DC315 & 0xFF;
   2414       1.7   tsutsui 		eeprom->device_id[1] = PCI_PRODUCT_TEKRAM2_DC315 >> 8;
   2415       1.7   tsutsui 		eeprom->reserved0 = 0x00;
   2416       1.7   tsutsui 
   2417       1.7   tsutsui 		for (i = 0, target = eeprom->target;
   2418       1.7   tsutsui 		     i < TRM_MAX_TARGETS;
   2419       1.7   tsutsui 		     i++, target++) {
   2420       1.7   tsutsui 			target->config0 = 0x77;
   2421       1.7   tsutsui 			target->period = 0x00;
   2422       1.7   tsutsui 			target->config2 = 0x00;
   2423       1.7   tsutsui 			target->config3 = 0x00;
   2424       1.7   tsutsui 		}
   2425       1.1   tsutsui 
   2426       1.7   tsutsui 		eeprom->scsi_id = 7;
   2427       1.7   tsutsui 		eeprom->channel_cfg = 0x0F;
   2428       1.7   tsutsui 		eeprom->delay_time = 0;
   2429       1.7   tsutsui 		eeprom->max_tag = 4;
   2430       1.7   tsutsui 		eeprom->reserved1 = 0x15;
   2431       1.7   tsutsui 		eeprom->boot_target = 0;
   2432       1.7   tsutsui 		eeprom->boot_lun = 0;
   2433       1.7   tsutsui 		eeprom->reserved2 = 0;
   2434       1.7   tsutsui 		memset(eeprom->reserved3, 0, sizeof(eeprom->reserved3));
   2435       1.1   tsutsui 
   2436       1.7   tsutsui 		chksum = 0;
   2437      1.16   tsutsui 		ep = (uint16_t *)eeprom;
   2438       1.7   tsutsui 		for (i = 0; i < 63; i++)
   2439       1.7   tsutsui 			chksum += le16toh(*ep++);
   2440       1.1   tsutsui 
   2441       1.7   tsutsui 		chksum = TRM_NVRAM_CKSUM - chksum;
   2442       1.7   tsutsui 		eeprom->checksum0 = chksum & 0xFF;
   2443       1.7   tsutsui 		eeprom->checksum1 = chksum >> 8;
   2444       1.1   tsutsui 
   2445       1.7   tsutsui 		trm_eeprom_write_all(sc, eeprom);
   2446       1.7   tsutsui 	}
   2447       1.1   tsutsui }
   2448       1.1   tsutsui 
   2449       1.1   tsutsui /*
   2450       1.7   tsutsui  * write struct eeprom 128 bytes to seeprom
   2451       1.1   tsutsui  */
   2452       1.1   tsutsui static void
   2453      1.15   tsutsui trm_eeprom_write_all(struct trm_softc *sc, struct trm_nvram *eeprom)
   2454       1.1   tsutsui {
   2455       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   2456       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   2457      1.20  christos 	uint8_t *sbuf = (uint8_t *)eeprom;
   2458      1.16   tsutsui 	uint8_t addr;
   2459       1.1   tsutsui 
   2460       1.1   tsutsui 	/* Enable SEEPROM */
   2461       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_CONTROL,
   2462       1.1   tsutsui 	    bus_space_read_1(iot, ioh, TRM_GEN_CONTROL) | EN_EEPROM);
   2463       1.1   tsutsui 
   2464       1.1   tsutsui 	/*
   2465       1.1   tsutsui 	 * Write enable
   2466       1.1   tsutsui 	 */
   2467       1.1   tsutsui 	trm_eeprom_write_cmd(sc, 0x04, 0xFF);
   2468       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, 0);
   2469       1.7   tsutsui 	trm_eeprom_wait();
   2470       1.1   tsutsui 
   2471      1.20  christos 	for (addr = 0; addr < 128; addr++, sbuf++)
   2472      1.20  christos 		trm_eeprom_set_data(sc, addr, *sbuf);
   2473       1.1   tsutsui 
   2474       1.1   tsutsui 	/*
   2475       1.1   tsutsui 	 * Write disable
   2476       1.1   tsutsui 	 */
   2477       1.1   tsutsui 	trm_eeprom_write_cmd(sc, 0x04, 0x00);
   2478       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, 0);
   2479       1.7   tsutsui 	trm_eeprom_wait();
   2480       1.1   tsutsui 
   2481       1.1   tsutsui 	/* Disable SEEPROM */
   2482       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_CONTROL,
   2483       1.1   tsutsui 	    bus_space_read_1(iot, ioh, TRM_GEN_CONTROL) & ~EN_EEPROM);
   2484       1.1   tsutsui }
   2485       1.1   tsutsui 
   2486       1.1   tsutsui /*
   2487       1.1   tsutsui  * write one byte to seeprom
   2488       1.1   tsutsui  */
   2489       1.1   tsutsui static void
   2490      1.16   tsutsui trm_eeprom_set_data(struct trm_softc *sc, uint8_t addr, uint8_t data)
   2491       1.1   tsutsui {
   2492       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   2493       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   2494       1.1   tsutsui 	int i;
   2495      1.16   tsutsui 	uint8_t send;
   2496       1.1   tsutsui 
   2497       1.1   tsutsui 	/*
   2498       1.1   tsutsui 	 * Send write command & address
   2499       1.1   tsutsui 	 */
   2500       1.1   tsutsui 	trm_eeprom_write_cmd(sc, 0x05, addr);
   2501       1.1   tsutsui 	/*
   2502       1.1   tsutsui 	 * Write data
   2503       1.1   tsutsui 	 */
   2504       1.1   tsutsui 	for (i = 0; i < 8; i++, data <<= 1) {
   2505       1.1   tsutsui 		send = NVR_SELECT;
   2506       1.1   tsutsui 		if (data & 0x80)	/* Start from bit 7 */
   2507       1.1   tsutsui 			send |= NVR_BITOUT;
   2508       1.1   tsutsui 
   2509       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, send);
   2510       1.7   tsutsui 		trm_eeprom_wait();
   2511       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, send | NVR_CLOCK);
   2512       1.7   tsutsui 		trm_eeprom_wait();
   2513       1.1   tsutsui 	}
   2514       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, NVR_SELECT);
   2515       1.7   tsutsui 	trm_eeprom_wait();
   2516       1.1   tsutsui 	/*
   2517       1.1   tsutsui 	 * Disable chip select
   2518       1.1   tsutsui 	 */
   2519       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, 0);
   2520       1.7   tsutsui 	trm_eeprom_wait();
   2521       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, NVR_SELECT);
   2522       1.7   tsutsui 	trm_eeprom_wait();
   2523       1.1   tsutsui 	/*
   2524       1.1   tsutsui 	 * Wait for write ready
   2525       1.1   tsutsui 	 */
   2526       1.1   tsutsui 	for (;;) {
   2527       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM,
   2528       1.1   tsutsui 		    NVR_SELECT | NVR_CLOCK);
   2529       1.7   tsutsui 		trm_eeprom_wait();
   2530       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, NVR_SELECT);
   2531       1.7   tsutsui 		trm_eeprom_wait();
   2532       1.1   tsutsui 		if (bus_space_read_1(iot, ioh, TRM_GEN_NVRAM) & NVR_BITIN)
   2533       1.1   tsutsui 			break;
   2534       1.1   tsutsui 	}
   2535       1.1   tsutsui 	/*
   2536       1.1   tsutsui 	 * Disable chip select
   2537       1.1   tsutsui 	 */
   2538       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, 0);
   2539       1.1   tsutsui }
   2540       1.1   tsutsui 
   2541       1.1   tsutsui /*
   2542       1.7   tsutsui  * read seeprom 128 bytes to struct eeprom
   2543       1.1   tsutsui  */
   2544       1.1   tsutsui static void
   2545      1.15   tsutsui trm_eeprom_read_all(struct trm_softc *sc, struct trm_nvram *eeprom)
   2546       1.1   tsutsui {
   2547       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   2548       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   2549      1.20  christos 	uint8_t *sbuf = (uint8_t *)eeprom;
   2550      1.16   tsutsui 	uint8_t addr;
   2551       1.1   tsutsui 
   2552       1.1   tsutsui 	/*
   2553       1.1   tsutsui 	 * Enable SEEPROM
   2554       1.1   tsutsui 	 */
   2555       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_CONTROL,
   2556       1.1   tsutsui 	    bus_space_read_1(iot, ioh, TRM_GEN_CONTROL) | EN_EEPROM);
   2557       1.1   tsutsui 
   2558       1.7   tsutsui 	for (addr = 0; addr < 128; addr++)
   2559      1.20  christos 		*sbuf++ = trm_eeprom_get_data(sc, addr);
   2560       1.1   tsutsui 
   2561       1.1   tsutsui 	/*
   2562       1.1   tsutsui 	 * Disable SEEPROM
   2563       1.1   tsutsui 	 */
   2564       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_CONTROL,
   2565       1.1   tsutsui 	    bus_space_read_1(iot, ioh, TRM_GEN_CONTROL) & ~EN_EEPROM);
   2566       1.1   tsutsui }
   2567       1.1   tsutsui 
   2568       1.1   tsutsui /*
   2569       1.1   tsutsui  * read one byte from seeprom
   2570       1.1   tsutsui  */
   2571      1.16   tsutsui static uint8_t
   2572      1.16   tsutsui trm_eeprom_get_data(struct trm_softc *sc, uint8_t addr)
   2573       1.1   tsutsui {
   2574       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   2575       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   2576       1.1   tsutsui 	int i;
   2577      1.16   tsutsui 	uint8_t read, data = 0;
   2578       1.1   tsutsui 
   2579       1.1   tsutsui 	/*
   2580       1.1   tsutsui 	 * Send read command & address
   2581       1.1   tsutsui 	 */
   2582       1.1   tsutsui 	trm_eeprom_write_cmd(sc, 0x06, addr);
   2583       1.1   tsutsui 
   2584       1.1   tsutsui 	for (i = 0; i < 8; i++) { /* Read data */
   2585       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM,
   2586       1.1   tsutsui 		    NVR_SELECT | NVR_CLOCK);
   2587       1.7   tsutsui 		trm_eeprom_wait();
   2588       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, NVR_SELECT);
   2589       1.1   tsutsui 		/*
   2590       1.1   tsutsui 		 * Get data bit while falling edge
   2591       1.1   tsutsui 		 */
   2592       1.1   tsutsui 		read = bus_space_read_1(iot, ioh, TRM_GEN_NVRAM);
   2593       1.1   tsutsui 		data <<= 1;
   2594       1.1   tsutsui 		if (read & NVR_BITIN)
   2595       1.1   tsutsui 			data |= 1;
   2596       1.1   tsutsui 
   2597       1.7   tsutsui 		trm_eeprom_wait();
   2598       1.1   tsutsui 	}
   2599       1.1   tsutsui 	/*
   2600       1.1   tsutsui 	 * Disable chip select
   2601       1.1   tsutsui 	 */
   2602       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, 0);
   2603       1.1   tsutsui 	return (data);
   2604       1.1   tsutsui }
   2605       1.1   tsutsui 
   2606       1.1   tsutsui /*
   2607       1.1   tsutsui  * write SB and Op Code into seeprom
   2608       1.1   tsutsui  */
   2609       1.1   tsutsui static void
   2610      1.16   tsutsui trm_eeprom_write_cmd(struct trm_softc *sc, uint8_t cmd, uint8_t addr)
   2611       1.1   tsutsui {
   2612       1.1   tsutsui 	bus_space_tag_t iot = sc->sc_iot;
   2613       1.1   tsutsui 	bus_space_handle_t ioh = sc->sc_ioh;
   2614       1.1   tsutsui 	int i;
   2615      1.16   tsutsui 	uint8_t send;
   2616       1.1   tsutsui 
   2617       1.1   tsutsui 	/* Program SB+OP code */
   2618       1.1   tsutsui 	for (i = 0; i < 3; i++, cmd <<= 1) {
   2619       1.1   tsutsui 		send = NVR_SELECT;
   2620       1.1   tsutsui 		if (cmd & 0x04)	/* Start from bit 2 */
   2621       1.1   tsutsui 			send |= NVR_BITOUT;
   2622       1.1   tsutsui 
   2623       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, send);
   2624       1.7   tsutsui 		trm_eeprom_wait();
   2625       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, send | NVR_CLOCK);
   2626       1.7   tsutsui 		trm_eeprom_wait();
   2627       1.1   tsutsui 	}
   2628       1.1   tsutsui 
   2629       1.1   tsutsui 	/* Program address */
   2630       1.1   tsutsui 	for (i = 0; i < 7; i++, addr <<= 1) {
   2631       1.1   tsutsui 		send = NVR_SELECT;
   2632       1.1   tsutsui 		if (addr & 0x40)	/* Start from bit 6 */
   2633       1.1   tsutsui 			send |= NVR_BITOUT;
   2634       1.1   tsutsui 
   2635       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, send);
   2636       1.7   tsutsui 		trm_eeprom_wait();
   2637       1.1   tsutsui 		bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, send | NVR_CLOCK);
   2638       1.7   tsutsui 		trm_eeprom_wait();
   2639       1.1   tsutsui 	}
   2640       1.1   tsutsui 	bus_space_write_1(iot, ioh, TRM_GEN_NVRAM, NVR_SELECT);
   2641       1.7   tsutsui 	trm_eeprom_wait();
   2642       1.1   tsutsui }
   2643