Home | History | Annotate | Line # | Download | only in apbus
spifi.c revision 1.2
      1  1.1  tsubai /*	$NetBSD: spifi.c,v 1.2 2001/04/25 17:53:18 bouyer Exp $	*/
      2  1.1  tsubai 
      3  1.1  tsubai /*-
      4  1.1  tsubai  * Copyright (c) 2000 Tsubai Masanari.  All rights reserved.
      5  1.1  tsubai  *
      6  1.1  tsubai  * Redistribution and use in source and binary forms, with or without
      7  1.1  tsubai  * modification, are permitted provided that the following conditions
      8  1.1  tsubai  * are met:
      9  1.1  tsubai  * 1. Redistributions of source code must retain the above copyright
     10  1.1  tsubai  *    notice, this list of conditions and the following disclaimer.
     11  1.1  tsubai  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1  tsubai  *    notice, this list of conditions and the following disclaimer in the
     13  1.1  tsubai  *    documentation and/or other materials provided with the distribution.
     14  1.1  tsubai  * 3. The name of the author may not be used to endorse or promote products
     15  1.1  tsubai  *    derived from this software without specific prior written permission.
     16  1.1  tsubai  *
     17  1.1  tsubai  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     18  1.1  tsubai  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     19  1.1  tsubai  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     20  1.1  tsubai  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     21  1.1  tsubai  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     22  1.1  tsubai  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     23  1.1  tsubai  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     24  1.1  tsubai  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     25  1.1  tsubai  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     26  1.1  tsubai  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     27  1.1  tsubai  */
     28  1.1  tsubai 
     29  1.1  tsubai #include <sys/param.h>
     30  1.1  tsubai #include <sys/buf.h>
     31  1.1  tsubai #include <sys/device.h>
     32  1.1  tsubai #include <sys/errno.h>
     33  1.1  tsubai #include <sys/kernel.h>
     34  1.1  tsubai #include <sys/queue.h>
     35  1.1  tsubai #include <sys/systm.h>
     36  1.1  tsubai 
     37  1.1  tsubai #include <uvm/uvm_extern.h>
     38  1.1  tsubai 
     39  1.1  tsubai #include <dev/scsipi/scsi_all.h>
     40  1.1  tsubai #include <dev/scsipi/scsi_message.h>
     41  1.1  tsubai #include <dev/scsipi/scsipi_all.h>
     42  1.1  tsubai #include <dev/scsipi/scsiconf.h>
     43  1.1  tsubai 
     44  1.1  tsubai #include <newsmips/apbus/apbusvar.h>
     45  1.1  tsubai #include <newsmips/apbus/spifireg.h>
     46  1.1  tsubai #include <newsmips/apbus/dmac3reg.h>
     47  1.1  tsubai 
     48  1.1  tsubai #include <machine/adrsmap.h>
     49  1.1  tsubai 
     50  1.1  tsubai /* #define SPIFI_DEBUG */
     51  1.1  tsubai 
     52  1.1  tsubai #ifdef SPIFI_DEBUG
     53  1.1  tsubai # define DPRINTF printf
     54  1.1  tsubai #else
     55  1.1  tsubai # define DPRINTF while (0) printf
     56  1.1  tsubai #endif
     57  1.1  tsubai 
     58  1.1  tsubai struct spifi_scb {
     59  1.1  tsubai 	TAILQ_ENTRY(spifi_scb) chain;
     60  1.1  tsubai 	int flags;
     61  1.1  tsubai 	struct scsipi_xfer *xs;
     62  1.1  tsubai 	struct scsi_generic cmd;
     63  1.1  tsubai 	int cmdlen;
     64  1.1  tsubai 	int resid;
     65  1.1  tsubai 	vaddr_t daddr;
     66  1.1  tsubai 	u_char target;
     67  1.1  tsubai 	u_char lun;
     68  1.1  tsubai 	u_char lun_targ;
     69  1.1  tsubai 	u_char status;
     70  1.1  tsubai };
     71  1.1  tsubai /* scb flags */
     72  1.1  tsubai #define SPIFI_READ	0x80
     73  1.1  tsubai #define SPIFI_DMA	0x01
     74  1.1  tsubai 
     75  1.1  tsubai struct spifi_softc {
     76  1.1  tsubai 	struct device sc_dev;
     77  1.2  bouyer 	struct scsipi_channel sc_channel;
     78  1.2  bouyer 	struct scsipi_adapter sc_adapter;
     79  1.1  tsubai 
     80  1.1  tsubai 	struct spifi_reg *sc_reg;
     81  1.1  tsubai 	struct spifi_scb *sc_nexus;
     82  1.1  tsubai 	void *sc_dma;			/* attached DMA softc */
     83  1.1  tsubai 	int sc_id;			/* my SCSI ID */
     84  1.1  tsubai 	int sc_msgout;
     85  1.1  tsubai 	u_char sc_omsg[16];
     86  1.1  tsubai 	struct spifi_scb sc_scb[16];
     87  1.1  tsubai 	TAILQ_HEAD(, spifi_scb) free_scb;
     88  1.1  tsubai 	TAILQ_HEAD(, spifi_scb) ready_scb;
     89  1.1  tsubai };
     90  1.1  tsubai 
     91  1.1  tsubai #define SPIFI_SYNC_OFFSET_MAX	7
     92  1.1  tsubai 
     93  1.1  tsubai #define SEND_REJECT	1
     94  1.1  tsubai #define SEND_IDENTIFY	2
     95  1.1  tsubai #define SEND_SDTR	4
     96  1.1  tsubai 
     97  1.1  tsubai #define SPIFI_DATAOUT	0
     98  1.1  tsubai #define SPIFI_DATAIN	PRS_IO
     99  1.1  tsubai #define SPIFI_COMMAND	PRS_CD
    100  1.1  tsubai #define SPIFI_STATUS	(PRS_CD | PRS_IO)
    101  1.1  tsubai #define SPIFI_MSGOUT	(PRS_MSG | PRS_CD)
    102  1.1  tsubai #define SPIFI_MSGIN	(PRS_MSG | PRS_CD | PRS_IO)
    103  1.1  tsubai 
    104  1.1  tsubai int spifi_match(struct device *, struct cfdata *, void *);
    105  1.1  tsubai void spifi_attach(struct device *, struct device *, void *);
    106  1.1  tsubai 
    107  1.2  bouyer void spifi_scsipi_request(struct scsipi_channel *, scsipi_adapter_req_t, void *);
    108  1.1  tsubai struct spifi_scb *spifi_get_scb(struct spifi_softc *);
    109  1.1  tsubai void spifi_free_scb(struct spifi_softc *, struct spifi_scb *);
    110  1.1  tsubai int spifi_poll(struct spifi_softc *);
    111  1.1  tsubai void spifi_minphys(struct buf *);
    112  1.1  tsubai 
    113  1.1  tsubai void spifi_sched(struct spifi_softc *);
    114  1.1  tsubai int spifi_intr(void *);
    115  1.1  tsubai void spifi_pmatch(struct spifi_softc *);
    116  1.1  tsubai 
    117  1.1  tsubai void spifi_select(struct spifi_softc *);
    118  1.1  tsubai void spifi_sendmsg(struct spifi_softc *, int);
    119  1.1  tsubai void spifi_command(struct spifi_softc *);
    120  1.1  tsubai void spifi_data_io(struct spifi_softc *);
    121  1.1  tsubai void spifi_status(struct spifi_softc *);
    122  1.1  tsubai int spifi_done(struct spifi_softc *);
    123  1.1  tsubai void spifi_fifo_drain(struct spifi_softc *);
    124  1.1  tsubai void spifi_reset(struct spifi_softc *);
    125  1.1  tsubai void spifi_bus_reset(struct spifi_softc *);
    126  1.1  tsubai 
    127  1.1  tsubai static int spifi_read_count(struct spifi_reg *);
    128  1.1  tsubai static void spifi_write_count(struct spifi_reg *, int);
    129  1.1  tsubai 
    130  1.1  tsubai #define DMAC3_FASTACCESS(sc)  dmac3_misc((sc)->sc_dma, DMAC3_CONF_FASTACCESS)
    131  1.1  tsubai #define DMAC3_SLOWACCESS(sc)  dmac3_misc((sc)->sc_dma, DMAC3_CONF_SLOWACCESS)
    132  1.1  tsubai 
    133  1.1  tsubai struct cfattach spifi_ca = {
    134  1.1  tsubai 	sizeof(struct spifi_softc), spifi_match, spifi_attach
    135  1.1  tsubai };
    136  1.1  tsubai 
    137  1.1  tsubai int
    138  1.1  tsubai spifi_match(parent, cf, aux)
    139  1.1  tsubai 	struct device *parent;
    140  1.1  tsubai 	struct cfdata *cf;
    141  1.1  tsubai 	void *aux;
    142  1.1  tsubai {
    143  1.1  tsubai 	struct apbus_attach_args *apa = aux;
    144  1.1  tsubai 
    145  1.1  tsubai 	if (strcmp(apa->apa_name, "spifi") == 0)
    146  1.1  tsubai 		return 1;
    147  1.1  tsubai 
    148  1.1  tsubai 	return 0;
    149  1.1  tsubai }
    150  1.1  tsubai 
    151  1.1  tsubai void
    152  1.1  tsubai spifi_attach(parent, self, aux)
    153  1.1  tsubai 	struct device *parent, *self;
    154  1.1  tsubai 	void *aux;
    155  1.1  tsubai {
    156  1.1  tsubai 	struct spifi_softc *sc = (void *)self;
    157  1.1  tsubai 	struct apbus_attach_args *apa = aux;
    158  1.1  tsubai 	struct device *dma;
    159  1.1  tsubai 	int intr, i;
    160  1.1  tsubai 
    161  1.1  tsubai 	/* Initialize scbs. */
    162  1.1  tsubai 	TAILQ_INIT(&sc->free_scb);
    163  1.1  tsubai 	TAILQ_INIT(&sc->ready_scb);
    164  1.1  tsubai 	for (i = 0; i < sizeof(sc->sc_scb)/sizeof(sc->sc_scb[0]); i++)
    165  1.1  tsubai 		TAILQ_INSERT_TAIL(&sc->free_scb, &sc->sc_scb[i], chain);
    166  1.1  tsubai 
    167  1.1  tsubai 	sc->sc_reg = (struct spifi_reg *)apa->apa_hwbase;
    168  1.1  tsubai 	sc->sc_id = 7;					/* XXX */
    169  1.1  tsubai 
    170  1.1  tsubai 	/* Find my dmac3. */
    171  1.1  tsubai 	dma = dmac3_link(apa->apa_ctlnum);
    172  1.1  tsubai 	if (dma == NULL) {
    173  1.1  tsubai 		printf(": cannot find slave dmac\n");
    174  1.1  tsubai 		return;
    175  1.1  tsubai 	}
    176  1.1  tsubai 	sc->sc_dma = dma;
    177  1.1  tsubai 
    178  1.1  tsubai 	printf(" slot%d addr 0x%lx", apa->apa_slotno, apa->apa_hwbase);
    179  1.1  tsubai 	printf(": SCSI ID = %d, using %s\n", sc->sc_id, dma->dv_xname);
    180  1.1  tsubai 
    181  1.1  tsubai 	dmac3_reset(sc->sc_dma);
    182  1.1  tsubai 
    183  1.1  tsubai 	DMAC3_SLOWACCESS(sc);
    184  1.1  tsubai 	spifi_reset(sc);
    185  1.1  tsubai 	DMAC3_FASTACCESS(sc);
    186  1.1  tsubai 
    187  1.2  bouyer 	sc->sc_adapter.adapt_dev = &sc->sc_dev;
    188  1.2  bouyer 	sc->sc_adapter.adapt_nchannels = 1;
    189  1.2  bouyer 	sc->sc_adapter.adapt_openings = 7;
    190  1.2  bouyer 	sc->sc_adapter.adapt_max_periph = 1;
    191  1.2  bouyer 	sc->sc_adapter.adapt_ioctl = NULL;
    192  1.2  bouyer 	sc->sc_adapter.adapt_minphys = minphys;
    193  1.2  bouyer 	sc->sc_adapter.adapt_request = spifi_scsipi_request;
    194  1.2  bouyer 
    195  1.2  bouyer 	memset(&sc->sc_channel, 0, sizeof(sc->sc_channel));
    196  1.2  bouyer 	sc->sc_channel.chan_adapter = &sc->sc_adapter;
    197  1.2  bouyer 	sc->sc_channel.chan_bustype = &scsi_bustype;
    198  1.2  bouyer 	sc->sc_channel.chan_channel = 0;
    199  1.2  bouyer 	sc->sc_channel.chan_ntargets = 8;
    200  1.2  bouyer 	sc->sc_channel.chan_nluns = 8;
    201  1.2  bouyer 	sc->sc_channel.chan_id = sc->sc_id;
    202  1.1  tsubai 
    203  1.1  tsubai 	if (apa->apa_slotno == 0)
    204  1.1  tsubai 		intr = NEWS5000_INT0_DMAC;
    205  1.1  tsubai 	else
    206  1.1  tsubai 		intr = SLOTTOMASK(apa->apa_slotno);
    207  1.1  tsubai 	apbus_intr_establish(0, intr, 0, spifi_intr, sc, apa->apa_name,
    208  1.1  tsubai 	    apa->apa_ctlnum);
    209  1.1  tsubai 
    210  1.2  bouyer 	config_found(&sc->sc_dev, &sc->sc_channel, scsiprint);
    211  1.1  tsubai }
    212  1.1  tsubai 
    213  1.2  bouyer void
    214  1.2  bouyer spifi_scsipi_request(chan, req, arg)
    215  1.2  bouyer 	struct scsipi_channel *chan;
    216  1.2  bouyer 	scsipi_adapter_req_t req;
    217  1.2  bouyer 	void *arg;
    218  1.2  bouyer 
    219  1.2  bouyer {
    220  1.1  tsubai 	struct scsipi_xfer *xs;
    221  1.2  bouyer 	struct scsipi_periph *periph;
    222  1.2  bouyer 	struct spifi_softc *sc = (void *)chan->chan_adapter->adapt_dev;
    223  1.1  tsubai 	struct spifi_scb *scb;
    224  1.1  tsubai 	u_int flags;
    225  1.1  tsubai 	int s;
    226  1.1  tsubai 
    227  1.2  bouyer 	switch (req) {
    228  1.2  bouyer 	case ADAPTER_REQ_RUN_XFER:
    229  1.2  bouyer 		xs = arg;
    230  1.2  bouyer 		periph = xs->xs_periph;
    231  1.2  bouyer 
    232  1.2  bouyer 		DPRINTF("spifi_scsi_cmd\n");
    233  1.2  bouyer 
    234  1.2  bouyer 		flags = xs->xs_control;
    235  1.2  bouyer 
    236  1.2  bouyer 		scb = spifi_get_scb(sc);
    237  1.2  bouyer 		if (scb == NULL) {
    238  1.2  bouyer 			panic("spifi_scsipi_request: no scb\n");
    239  1.2  bouyer 		}
    240  1.1  tsubai 
    241  1.2  bouyer 		scb->xs = xs;
    242  1.2  bouyer 		scb->flags = 0;
    243  1.2  bouyer 		scb->status = 0;
    244  1.2  bouyer 		scb->daddr = (vaddr_t)xs->data;
    245  1.2  bouyer 		scb->resid = xs->datalen;
    246  1.2  bouyer 		bcopy(xs->cmd, &scb->cmd, xs->cmdlen);
    247  1.2  bouyer 		scb->cmdlen = xs->cmdlen;
    248  1.2  bouyer 
    249  1.2  bouyer 		scb->target = periph->periph_target;
    250  1.2  bouyer 		scb->lun = periph->periph_lun;
    251  1.2  bouyer 		scb->lun_targ = scb->target | (scb->lun << 3);
    252  1.2  bouyer 
    253  1.2  bouyer 		if (flags & XS_CTL_DATA_IN)
    254  1.2  bouyer 			scb->flags |= SPIFI_READ;
    255  1.2  bouyer 
    256  1.2  bouyer 		s = splbio();
    257  1.2  bouyer 
    258  1.2  bouyer 		TAILQ_INSERT_TAIL(&sc->ready_scb, scb, chain);
    259  1.2  bouyer 
    260  1.2  bouyer 		if (sc->sc_nexus == NULL)	/* IDLE */
    261  1.2  bouyer 			spifi_sched(sc);
    262  1.2  bouyer 
    263  1.2  bouyer 		splx(s);
    264  1.2  bouyer 
    265  1.2  bouyer 		if (flags & XS_CTL_POLL) {
    266  1.2  bouyer 			if (spifi_poll(sc)) {
    267  1.2  bouyer 				printf("spifi: timeout\n");
    268  1.2  bouyer 				if (spifi_poll(sc))
    269  1.2  bouyer 					printf("spifi: timeout again\n");
    270  1.2  bouyer 			}
    271  1.2  bouyer 		}
    272  1.2  bouyer 		return;
    273  1.2  bouyer 	case ADAPTER_REQ_GROW_RESOURCES:
    274  1.2  bouyer 		/* XXX Not supported. */
    275  1.2  bouyer 		return;
    276  1.2  bouyer 	case ADAPTER_REQ_SET_XFER_MODE:
    277  1.2  bouyer 		/* XXX Not supported. */
    278  1.2  bouyer 		return;
    279  1.1  tsubai 	}
    280  1.1  tsubai }
    281  1.1  tsubai 
    282  1.1  tsubai struct spifi_scb *
    283  1.1  tsubai spifi_get_scb(sc)
    284  1.1  tsubai 	struct spifi_softc *sc;
    285  1.1  tsubai {
    286  1.1  tsubai 	struct spifi_scb *scb;
    287  1.1  tsubai 	int s;
    288  1.1  tsubai 
    289  1.1  tsubai 	s = splbio();
    290  1.1  tsubai 	scb = sc->free_scb.tqh_first;
    291  1.1  tsubai 	if (scb)
    292  1.1  tsubai 		TAILQ_REMOVE(&sc->free_scb, scb, chain);
    293  1.1  tsubai 	splx(s);
    294  1.1  tsubai 
    295  1.1  tsubai 	return scb;
    296  1.1  tsubai }
    297  1.1  tsubai 
    298  1.1  tsubai void
    299  1.1  tsubai spifi_free_scb(sc, scb)
    300  1.1  tsubai 	struct spifi_softc *sc;
    301  1.1  tsubai 	struct spifi_scb *scb;
    302  1.1  tsubai {
    303  1.1  tsubai 	int s;
    304  1.1  tsubai 
    305  1.1  tsubai 	s = splbio();
    306  1.1  tsubai 	TAILQ_INSERT_HEAD(&sc->free_scb, scb, chain);
    307  1.1  tsubai 	splx(s);
    308  1.1  tsubai }
    309  1.1  tsubai 
    310  1.1  tsubai int
    311  1.1  tsubai spifi_poll(sc)
    312  1.1  tsubai 	struct spifi_softc *sc;
    313  1.1  tsubai {
    314  1.1  tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    315  1.1  tsubai 	struct scsipi_xfer *xs;
    316  1.1  tsubai 	int count;
    317  1.1  tsubai 
    318  1.1  tsubai 	printf("spifi_poll: not implemented yet\n");
    319  1.1  tsubai 	delay(10000);
    320  1.1  tsubai 	return 0;
    321  1.1  tsubai 
    322  1.1  tsubai 	if (xs == NULL)
    323  1.1  tsubai 		return 0;
    324  1.1  tsubai 
    325  1.1  tsubai 	xs = scb->xs;
    326  1.1  tsubai 	count = xs->timeout;
    327  1.1  tsubai 
    328  1.1  tsubai 	while (count > 0) {
    329  1.1  tsubai 		if (dmac3_intr(sc->sc_dma) != 0)
    330  1.1  tsubai 			spifi_intr(sc);
    331  1.1  tsubai 
    332  1.1  tsubai 		if (xs->xs_status & XS_STS_DONE)
    333  1.1  tsubai 			return 0;
    334  1.1  tsubai 		DELAY(1000);
    335  1.1  tsubai 		count--;
    336  1.1  tsubai 	};
    337  1.1  tsubai 	return 1;
    338  1.1  tsubai }
    339  1.1  tsubai 
    340  1.1  tsubai void
    341  1.1  tsubai spifi_minphys(bp)
    342  1.1  tsubai 	struct buf *bp;
    343  1.1  tsubai {
    344  1.1  tsubai 	if (bp->b_bcount > 64*1024)
    345  1.1  tsubai 		bp->b_bcount = 64*1024;
    346  1.1  tsubai 
    347  1.1  tsubai 	minphys(bp);
    348  1.1  tsubai }
    349  1.1  tsubai 
    350  1.1  tsubai void
    351  1.1  tsubai spifi_sched(sc)
    352  1.1  tsubai 	struct spifi_softc *sc;
    353  1.1  tsubai {
    354  1.1  tsubai 	struct spifi_scb *scb;
    355  1.1  tsubai 
    356  1.1  tsubai 	scb = sc->ready_scb.tqh_first;
    357  1.1  tsubai start:
    358  1.1  tsubai 	if (scb == NULL || sc->sc_nexus != NULL)
    359  1.1  tsubai 		return;
    360  1.1  tsubai /*
    361  1.1  tsubai 	if (sc->sc_targets[scb->target] & (1 << scb->lun))
    362  1.1  tsubai 		goto next;
    363  1.1  tsubai */
    364  1.1  tsubai 	TAILQ_REMOVE(&sc->ready_scb, scb, chain);
    365  1.1  tsubai 
    366  1.1  tsubai #ifdef SPIFI_DEBUG
    367  1.1  tsubai {
    368  1.1  tsubai 	int i;
    369  1.1  tsubai 
    370  1.1  tsubai 	printf("spifi_sched: ID:LUN = %d:%d, ", scb->target, scb->lun);
    371  1.1  tsubai 	printf("cmd = 0x%x", scb->cmd.opcode);
    372  1.1  tsubai 	for (i = 0; i < 5; i++)
    373  1.1  tsubai 		printf(" 0x%x", scb->cmd.bytes[i]);
    374  1.1  tsubai 	printf("\n");
    375  1.1  tsubai }
    376  1.1  tsubai #endif
    377  1.1  tsubai 
    378  1.1  tsubai 	DMAC3_SLOWACCESS(sc);
    379  1.1  tsubai 	sc->sc_nexus = scb;
    380  1.1  tsubai 	spifi_select(sc);
    381  1.1  tsubai 	DMAC3_FASTACCESS(sc);
    382  1.1  tsubai 
    383  1.1  tsubai 	scb = scb->chain.tqe_next;
    384  1.1  tsubai 	goto start;
    385  1.1  tsubai }
    386  1.1  tsubai 
    387  1.1  tsubai static inline int
    388  1.1  tsubai spifi_read_count(reg)
    389  1.1  tsubai 	struct spifi_reg *reg;
    390  1.1  tsubai {
    391  1.1  tsubai 	int count;
    392  1.1  tsubai 
    393  1.1  tsubai 	count = (reg->count_hi  & 0xff) |
    394  1.1  tsubai 		(reg->count_mid & 0xff) |
    395  1.1  tsubai 		(reg->count_low & 0xff);
    396  1.1  tsubai 	return count;
    397  1.1  tsubai }
    398  1.1  tsubai 
    399  1.1  tsubai static inline void
    400  1.1  tsubai spifi_write_count(reg, count)
    401  1.1  tsubai 	struct spifi_reg *reg;
    402  1.1  tsubai 	int count;
    403  1.1  tsubai {
    404  1.1  tsubai 	reg->count_hi  = count >> 16;
    405  1.1  tsubai 	reg->count_mid = count >> 8;
    406  1.1  tsubai 	reg->count_low = count;
    407  1.1  tsubai }
    408  1.1  tsubai 
    409  1.1  tsubai 
    410  1.1  tsubai #ifdef SPIFI_DEBUG
    411  1.1  tsubai static char scsi_phase_name[][8] = {
    412  1.1  tsubai 	"DATAOUT", "DATAIN", "COMMAND", "STATUS",
    413  1.1  tsubai 	"", "", "MSGOUT", "MSGIN"
    414  1.1  tsubai };
    415  1.1  tsubai #endif
    416  1.1  tsubai 
    417  1.1  tsubai int
    418  1.1  tsubai spifi_intr(v)
    419  1.1  tsubai 	void *v;
    420  1.1  tsubai {
    421  1.1  tsubai 	struct spifi_softc *sc = v;
    422  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    423  1.1  tsubai 	int intr, state, icond;
    424  1.1  tsubai 	struct spifi_scb *scb;
    425  1.1  tsubai 	struct scsipi_xfer *xs;
    426  1.1  tsubai #ifdef SPIFI_DEBUG
    427  1.1  tsubai 	char bitmask[64];
    428  1.1  tsubai #endif
    429  1.1  tsubai 
    430  1.1  tsubai 	switch (dmac3_intr(sc->sc_dma)) {
    431  1.1  tsubai 	case 0:
    432  1.1  tsubai 		DPRINTF("sprious dma intr\n");
    433  1.1  tsubai 		return 0;
    434  1.1  tsubai 	case -1:
    435  1.1  tsubai 		printf("DMAC parity error, data PAD\n");
    436  1.1  tsubai 
    437  1.1  tsubai 		DMAC3_SLOWACCESS(sc);
    438  1.1  tsubai 		reg->prcmd = PRC_TRPAD;
    439  1.1  tsubai 		DMAC3_FASTACCESS(sc);
    440  1.1  tsubai 		return 1;
    441  1.1  tsubai 
    442  1.1  tsubai 	default:
    443  1.1  tsubai 		break;
    444  1.1  tsubai 	}
    445  1.1  tsubai 	DMAC3_SLOWACCESS(sc);
    446  1.1  tsubai 
    447  1.1  tsubai 	intr = reg->intr & 0xff;
    448  1.1  tsubai 	if (intr == 0) {
    449  1.1  tsubai 		DMAC3_FASTACCESS(sc);
    450  1.1  tsubai 		DPRINTF("sprious intr (not me)\n");
    451  1.1  tsubai 		return 0;
    452  1.1  tsubai 	}
    453  1.1  tsubai 
    454  1.1  tsubai 	scb = sc->sc_nexus;
    455  1.1  tsubai 	xs = scb->xs;
    456  1.1  tsubai 	state = reg->spstat;
    457  1.1  tsubai 	icond = reg->icond;
    458  1.1  tsubai 
    459  1.1  tsubai 	/* clear interrupt */
    460  1.1  tsubai 	reg->intr = ~intr;
    461  1.1  tsubai 
    462  1.1  tsubai #ifdef SPIFI_DEBUG
    463  1.1  tsubai 	bitmask_snprintf(intr, INTR_BITMASK, bitmask, sizeof bitmask);
    464  1.1  tsubai 	printf("spifi_intr intr = 0x%s (%s), ", bitmask,
    465  1.1  tsubai 		scsi_phase_name[(reg->prstat >> 3) & 7]);
    466  1.1  tsubai 	printf("state = 0x%x, icond = 0x%x\n", state, icond);
    467  1.1  tsubai #endif
    468  1.1  tsubai 
    469  1.1  tsubai 	if (intr & INTR_FCOMP) {
    470  1.1  tsubai 		spifi_fifo_drain(sc);
    471  1.1  tsubai 		scb->status = reg->cmbuf[scb->target].status;
    472  1.1  tsubai 		scb->resid = spifi_read_count(reg);
    473  1.1  tsubai 
    474  1.1  tsubai 		DPRINTF("datalen = %d, resid = %d, status = 0x%x\n",
    475  1.1  tsubai 			xs->datalen, scb->resid, scb->status);
    476  1.1  tsubai 		DPRINTF("msg = 0x%x\n", reg->cmbuf[sc->sc_id].cdb[0]);
    477  1.1  tsubai 
    478  1.1  tsubai 		DMAC3_FASTACCESS(sc);
    479  1.1  tsubai 		spifi_done(sc);
    480  1.1  tsubai 		return 1;
    481  1.1  tsubai 	}
    482  1.1  tsubai 	if (intr & INTR_DISCON)
    483  1.1  tsubai 		panic("disconnect");
    484  1.1  tsubai 
    485  1.1  tsubai 	if (intr & INTR_TIMEO) {
    486  1.1  tsubai 		xs->error = XS_SELTIMEOUT;
    487  1.1  tsubai 		DMAC3_FASTACCESS(sc);
    488  1.1  tsubai 		spifi_done(sc);
    489  1.1  tsubai 		return 1;
    490  1.1  tsubai 	}
    491  1.1  tsubai 	if (intr & INTR_BSRQ) {
    492  1.1  tsubai 		if (scb == NULL)
    493  1.1  tsubai 			panic("reconnect?");
    494  1.1  tsubai 
    495  1.1  tsubai 		if (intr & INTR_PERR) {
    496  1.1  tsubai 			printf("%s: %d:%d parity error\n", sc->sc_dev.dv_xname,
    497  1.1  tsubai 			       scb->target, scb->lun);
    498  1.1  tsubai 
    499  1.1  tsubai 			/* XXX reset */
    500  1.1  tsubai 			xs->error = XS_DRIVER_STUFFUP;
    501  1.1  tsubai 			spifi_done(sc);
    502  1.1  tsubai 			return 1;
    503  1.1  tsubai 		}
    504  1.1  tsubai 
    505  1.1  tsubai 		if (state >> 4 == SPS_MSGIN && icond == ICOND_NXTREQ)
    506  1.1  tsubai 			panic("spifi_intr: NXTREQ");
    507  1.1  tsubai 		if (reg->fifoctrl & FIFOC_RQOVRN)
    508  1.1  tsubai 			panic("spifi_intr RQOVRN");
    509  1.1  tsubai 		if (icond == ICOND_UXPHASEZ)
    510  1.1  tsubai 			panic("ICOND_UXPHASEZ");
    511  1.1  tsubai 
    512  1.1  tsubai 		if ((icond & 0x0f) == ICOND_ADATAOFF) {
    513  1.1  tsubai 			spifi_data_io(sc);
    514  1.1  tsubai 			goto done;
    515  1.1  tsubai 		}
    516  1.1  tsubai 		if ((icond & 0xf0) == ICOND_UBF) {
    517  1.1  tsubai 			reg->exstat = reg->exstat & ~EXS_UBF;
    518  1.1  tsubai 			spifi_pmatch(sc);
    519  1.1  tsubai 			goto done;
    520  1.1  tsubai 		}
    521  1.1  tsubai 
    522  1.1  tsubai 		/*
    523  1.1  tsubai 		 * XXX Work around the SPIFI bug that interrupts during
    524  1.1  tsubai 		 * XXX dataout phase.
    525  1.1  tsubai 		 */
    526  1.1  tsubai 		if (state == ((SPS_DATAOUT << 4) | SPS_INTR) &&
    527  1.1  tsubai 		    (reg->prstat & PRS_PHASE) == SPIFI_DATAOUT) {
    528  1.1  tsubai 			reg->prcmd = PRC_DATAOUT;
    529  1.1  tsubai 			goto done;
    530  1.1  tsubai 		}
    531  1.1  tsubai 		if ((reg->prstat & PRS_Z) == 0) {
    532  1.1  tsubai 			spifi_pmatch(sc);
    533  1.1  tsubai 			goto done;
    534  1.1  tsubai 		}
    535  1.1  tsubai 
    536  1.1  tsubai 		panic("spifi_intr: unknown intr state");
    537  1.1  tsubai 	}
    538  1.1  tsubai 
    539  1.1  tsubai done:
    540  1.1  tsubai 	DMAC3_FASTACCESS(sc);
    541  1.1  tsubai 	return 1;
    542  1.1  tsubai }
    543  1.1  tsubai 
    544  1.1  tsubai void
    545  1.1  tsubai spifi_pmatch(sc)
    546  1.1  tsubai 	struct spifi_softc *sc;
    547  1.1  tsubai {
    548  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    549  1.1  tsubai 	int phase;
    550  1.1  tsubai 
    551  1.1  tsubai 	phase = (reg->prstat & PRS_PHASE);
    552  1.1  tsubai 
    553  1.1  tsubai #ifdef SPIFI_DEBUG
    554  1.1  tsubai 	printf("spifi_pmatch (%s)\n", scsi_phase_name[phase >> 3]);
    555  1.1  tsubai #endif
    556  1.1  tsubai 
    557  1.1  tsubai 	switch (phase) {
    558  1.1  tsubai 
    559  1.1  tsubai 	case SPIFI_COMMAND:
    560  1.1  tsubai 		spifi_command(sc);
    561  1.1  tsubai 		break;
    562  1.1  tsubai 	case SPIFI_DATAIN:
    563  1.1  tsubai 	case SPIFI_DATAOUT:
    564  1.1  tsubai 		spifi_data_io(sc);
    565  1.1  tsubai 		break;
    566  1.1  tsubai 	case SPIFI_STATUS:
    567  1.1  tsubai 		spifi_status(sc);
    568  1.1  tsubai 		break;
    569  1.1  tsubai 
    570  1.1  tsubai 	case SPIFI_MSGIN:	/* XXX */
    571  1.1  tsubai 	case SPIFI_MSGOUT:	/* XXX */
    572  1.1  tsubai 	default:
    573  1.1  tsubai 		printf("spifi: unknown phase %d\n", phase);
    574  1.1  tsubai 	}
    575  1.1  tsubai }
    576  1.1  tsubai 
    577  1.1  tsubai void
    578  1.1  tsubai spifi_select(sc)
    579  1.1  tsubai 	struct spifi_softc *sc;
    580  1.1  tsubai {
    581  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    582  1.1  tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    583  1.1  tsubai 	int sel;
    584  1.1  tsubai 
    585  1.1  tsubai #if 0
    586  1.1  tsubai 	if (reg->loopdata || reg->intr)
    587  1.1  tsubai 		return;
    588  1.1  tsubai #endif
    589  1.1  tsubai 
    590  1.1  tsubai 	if (scb == NULL) {
    591  1.1  tsubai 		printf("%s: spifi_select: NULL nexus\n", sc->sc_dev.dv_xname);
    592  1.1  tsubai 		return;
    593  1.1  tsubai 	}
    594  1.1  tsubai 
    595  1.1  tsubai 	reg->exctrl = EXC_IPLOCK;
    596  1.1  tsubai 
    597  1.1  tsubai 	dmac3_reset(sc->sc_dma);
    598  1.1  tsubai 	sel = scb->target << 4 | SEL_ISTART | SEL_IRESELEN | SEL_WATN;
    599  1.1  tsubai 	spifi_sendmsg(sc, SEND_IDENTIFY);
    600  1.1  tsubai 	reg->select = sel;
    601  1.1  tsubai }
    602  1.1  tsubai 
    603  1.1  tsubai void
    604  1.1  tsubai spifi_sendmsg(sc, msg)
    605  1.1  tsubai 	struct spifi_softc *sc;
    606  1.1  tsubai 	int msg;
    607  1.1  tsubai {
    608  1.1  tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    609  1.1  tsubai 	/* struct mesh_tinfo *ti; */
    610  1.1  tsubai 	int lun, len, i;
    611  1.1  tsubai 
    612  1.1  tsubai 	int id = sc->sc_id;
    613  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    614  1.1  tsubai 
    615  1.1  tsubai 	DPRINTF("spifi_sendmsg: sending");
    616  1.1  tsubai 	sc->sc_msgout = msg;
    617  1.1  tsubai 	len = 0;
    618  1.1  tsubai 
    619  1.1  tsubai 	if (msg & SEND_REJECT) {
    620  1.1  tsubai 		DPRINTF(" REJECT");
    621  1.1  tsubai 		sc->sc_omsg[len++] = MSG_MESSAGE_REJECT;
    622  1.1  tsubai 	}
    623  1.1  tsubai 	if (msg & SEND_IDENTIFY) {
    624  1.1  tsubai 		DPRINTF(" IDENTIFY");
    625  1.2  bouyer 		lun = scb->xs->xs_periph->periph_lun;
    626  1.1  tsubai 		sc->sc_omsg[len++] = MSG_IDENTIFY(lun, 0);
    627  1.1  tsubai 	}
    628  1.1  tsubai 	if (msg & SEND_SDTR) {
    629  1.1  tsubai 		DPRINTF(" SDTR");
    630  1.1  tsubai #if 0
    631  1.1  tsubai 		ti = &sc->sc_tinfo[scb->target];
    632  1.1  tsubai 		sc->sc_omsg[len++] = MSG_EXTENDED;
    633  1.1  tsubai 		sc->sc_omsg[len++] = 3;
    634  1.1  tsubai 		sc->sc_omsg[len++] = MSG_EXT_SDTR;
    635  1.1  tsubai 		sc->sc_omsg[len++] = ti->period;
    636  1.1  tsubai 		sc->sc_omsg[len++] = ti->offset;
    637  1.1  tsubai #endif
    638  1.1  tsubai 	}
    639  1.1  tsubai 	DPRINTF("\n");
    640  1.1  tsubai 
    641  1.1  tsubai 	reg->cmlen = CML_AMSG_EN | len;
    642  1.1  tsubai 	for (i = 0; i < len; i++)
    643  1.1  tsubai 		reg->cmbuf[id].cdb[i] = sc->sc_omsg[i];
    644  1.1  tsubai }
    645  1.1  tsubai void
    646  1.1  tsubai spifi_command(struct spifi_softc *sc)
    647  1.1  tsubai {
    648  1.1  tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    649  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    650  1.1  tsubai 	int len = scb->cmdlen;
    651  1.1  tsubai 	u_char *cmdp = (char *)&scb->cmd;
    652  1.1  tsubai 	int i;
    653  1.1  tsubai 
    654  1.1  tsubai 	DPRINTF("spifi_command\n");
    655  1.1  tsubai 
    656  1.1  tsubai 	reg->cmdpage = scb->lun_targ;
    657  1.1  tsubai 
    658  1.1  tsubai 	if (reg->init_status & IST_ACK) {
    659  1.1  tsubai 		/* Negate ACK. */
    660  1.1  tsubai 		reg->prcmd = PRC_NJMP | PRC_CLRACK | PRC_COMMAND;
    661  1.1  tsubai 		reg->prcmd = PRC_NJMP | PRC_COMMAND;
    662  1.1  tsubai 	}
    663  1.1  tsubai 
    664  1.1  tsubai 	reg->cmlen = CML_AMSG_EN | len;
    665  1.1  tsubai 
    666  1.1  tsubai 	for (i = 0; i < len; i++)
    667  1.1  tsubai 		reg->cmbuf[sc->sc_id].cdb[i] = *cmdp++;
    668  1.1  tsubai 
    669  1.1  tsubai 	reg->prcmd = PRC_COMMAND;
    670  1.1  tsubai }
    671  1.1  tsubai 
    672  1.1  tsubai void
    673  1.1  tsubai spifi_data_io(struct spifi_softc *sc)
    674  1.1  tsubai {
    675  1.1  tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    676  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    677  1.1  tsubai 	int phase;
    678  1.1  tsubai 
    679  1.1  tsubai 	DPRINTF("spifi_data_io\n");
    680  1.1  tsubai 
    681  1.1  tsubai 	phase = reg->prstat & PRS_PHASE;
    682  1.1  tsubai 	dmac3_reset(sc->sc_dma);
    683  1.1  tsubai 
    684  1.1  tsubai 	spifi_write_count(reg, scb->resid);
    685  1.1  tsubai 	reg->cmlen = CML_AMSG_EN | 1;
    686  1.1  tsubai 	reg->data_xfer = 0;
    687  1.1  tsubai 
    688  1.1  tsubai 	scb->flags |= SPIFI_DMA;
    689  1.1  tsubai 	if (phase == SPIFI_DATAIN) {
    690  1.1  tsubai 		if (reg->fifoctrl & FIFOC_SSTKACT) {
    691  1.1  tsubai 			/*
    692  1.1  tsubai 			 * Clear FIFO and load the contents of synchronous
    693  1.1  tsubai 			 * stack into the FIFO.
    694  1.1  tsubai 			 */
    695  1.1  tsubai 			reg->fifoctrl = FIFOC_CLREVEN;
    696  1.1  tsubai 			reg->fifoctrl = FIFOC_LOAD;
    697  1.1  tsubai 		}
    698  1.1  tsubai 		reg->autodata = ADATA_IN | scb->lun_targ;
    699  1.1  tsubai 		dmac3_start(sc->sc_dma, scb->daddr, scb->resid, DMAC3_CSR_RECV);
    700  1.1  tsubai 		reg->prcmd = PRC_DATAIN;
    701  1.1  tsubai 	} else {
    702  1.1  tsubai 		reg->fifoctrl = FIFOC_CLREVEN;
    703  1.1  tsubai 		reg->autodata = scb->lun_targ;
    704  1.1  tsubai 		dmac3_start(sc->sc_dma, scb->daddr, scb->resid, DMAC3_CSR_SEND);
    705  1.1  tsubai 		reg->prcmd = PRC_DATAOUT;
    706  1.1  tsubai 	}
    707  1.1  tsubai }
    708  1.1  tsubai 
    709  1.1  tsubai void
    710  1.1  tsubai spifi_status(struct spifi_softc *sc)
    711  1.1  tsubai {
    712  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    713  1.1  tsubai 
    714  1.1  tsubai 	DPRINTF("spifi_status\n");
    715  1.1  tsubai 	spifi_fifo_drain(sc);
    716  1.1  tsubai 	reg->cmlen = CML_AMSG_EN | 1;
    717  1.1  tsubai 	reg->prcmd = PRC_STATUS;
    718  1.1  tsubai }
    719  1.1  tsubai 
    720  1.1  tsubai int
    721  1.1  tsubai spifi_done(sc)
    722  1.1  tsubai 	struct spifi_softc *sc;
    723  1.1  tsubai {
    724  1.1  tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    725  1.1  tsubai 	struct scsipi_xfer *xs = scb->xs;
    726  1.1  tsubai 
    727  1.1  tsubai 	DPRINTF("spifi_done\n");
    728  1.1  tsubai 
    729  1.2  bouyer 	xs->status = scb->status;
    730  1.2  bouyer 	if (xs->status == SCSI_CHECK) {
    731  1.1  tsubai 		DPRINTF("spifi_done: CHECK CONDITION\n");
    732  1.2  bouyer 		if (xs->error == XS_NOERROR)
    733  1.2  bouyer 			xs->error = XS_BUSY;
    734  1.2  bouyer 	}
    735  1.1  tsubai 
    736  1.1  tsubai 	xs->resid = scb->resid;
    737  1.1  tsubai 
    738  1.1  tsubai 	scsipi_done(xs);
    739  1.1  tsubai 	spifi_free_scb(sc, scb);
    740  1.1  tsubai 
    741  1.1  tsubai 	sc->sc_nexus = NULL;
    742  1.1  tsubai 	spifi_sched(sc);
    743  1.1  tsubai 
    744  1.1  tsubai 	return FALSE;
    745  1.1  tsubai }
    746  1.1  tsubai 
    747  1.1  tsubai void
    748  1.1  tsubai spifi_fifo_drain(sc)
    749  1.1  tsubai 	struct spifi_softc *sc;
    750  1.1  tsubai {
    751  1.1  tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    752  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    753  1.1  tsubai 	int fifoctrl, fifo_count;
    754  1.1  tsubai 
    755  1.1  tsubai 	DPRINTF("spifi_fifo_drain\n");
    756  1.1  tsubai 
    757  1.1  tsubai 	if ((scb->flags & SPIFI_READ) == 0)
    758  1.1  tsubai 		return;
    759  1.1  tsubai 
    760  1.1  tsubai 	fifoctrl = reg->fifoctrl;
    761  1.1  tsubai 	if (fifoctrl & FIFOC_SSTKACT)
    762  1.1  tsubai 		return;
    763  1.1  tsubai 
    764  1.1  tsubai 	fifo_count = 8 - (fifoctrl & FIFOC_FSLOT);
    765  1.1  tsubai 	if (fifo_count > 0 && (scb->flags & SPIFI_DMA)) {
    766  1.1  tsubai 		/* Flush data still in FIFO. */
    767  1.1  tsubai 		reg->fifoctrl = FIFOC_FLUSH;
    768  1.1  tsubai 		return;
    769  1.1  tsubai 	}
    770  1.1  tsubai 
    771  1.1  tsubai 	reg->fifoctrl = FIFOC_CLREVEN;
    772  1.1  tsubai }
    773  1.1  tsubai 
    774  1.1  tsubai void
    775  1.1  tsubai spifi_reset(sc)
    776  1.1  tsubai 	struct spifi_softc *sc;
    777  1.1  tsubai {
    778  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    779  1.1  tsubai 	int id = sc->sc_id;
    780  1.1  tsubai 
    781  1.1  tsubai 	DPRINTF("spifi_reset\n");
    782  1.1  tsubai 
    783  1.1  tsubai 	reg->auxctrl = AUXCTRL_SRST;
    784  1.1  tsubai 	reg->auxctrl = AUXCTRL_CRST;
    785  1.1  tsubai 
    786  1.1  tsubai 	dmac3_reset(sc->sc_dma);
    787  1.1  tsubai 
    788  1.1  tsubai 	reg->auxctrl = AUXCTRL_SRST;
    789  1.1  tsubai 	reg->auxctrl = AUXCTRL_CRST;
    790  1.1  tsubai 	reg->auxctrl = AUXCTRL_DMAEDGE;
    791  1.1  tsubai 
    792  1.1  tsubai 	/* Mask (only) target mode interrupts. */
    793  1.1  tsubai 	reg->imask = INTR_TGSEL | INTR_COMRECV;
    794  1.1  tsubai 
    795  1.1  tsubai 	reg->config = CONFIG_DMABURST | CONFIG_PCHKEN | CONFIG_PGENEN | id;
    796  1.1  tsubai 	reg->fastwide = FAST_FASTEN;
    797  1.1  tsubai 	reg->prctrl = 0;
    798  1.1  tsubai 	reg->loopctrl = 0;
    799  1.1  tsubai 
    800  1.1  tsubai 	/* Enable automatic status input except the initiator. */
    801  1.1  tsubai 	reg->autostat = ~(1 << id);
    802  1.1  tsubai 
    803  1.1  tsubai 	reg->fifoctrl = FIFOC_CLREVEN;
    804  1.1  tsubai 	spifi_write_count(reg, 0);
    805  1.1  tsubai 
    806  1.1  tsubai 	/* Flush write buffer. */
    807  1.1  tsubai 	(void)reg->spstat;
    808  1.1  tsubai }
    809  1.1  tsubai 
    810  1.1  tsubai void
    811  1.1  tsubai spifi_bus_reset(sc)
    812  1.1  tsubai 	struct spifi_softc *sc;
    813  1.1  tsubai {
    814  1.1  tsubai 	struct spifi_reg *reg = sc->sc_reg;
    815  1.1  tsubai 
    816  1.1  tsubai 	printf("%s: bus reset\n", sc->sc_dev.dv_xname);
    817  1.1  tsubai 
    818  1.1  tsubai 	sc->sc_nexus = NULL;
    819  1.1  tsubai 
    820  1.1  tsubai 	reg->auxctrl = AUXCTRL_SETRST;
    821  1.1  tsubai 	delay(100);
    822  1.1  tsubai 	reg->auxctrl = 0;
    823  1.1  tsubai }
    824  1.1  tsubai 
    825  1.1  tsubai #if 0
    826  1.1  tsubai static u_char spifi_sync_period[] = {
    827  1.1  tsubai /* 0    1    2    3   4   5   6   7   8   9  10  11 */
    828  1.1  tsubai  137, 125, 112, 100, 87, 75, 62, 50, 43, 37, 31, 25
    829  1.1  tsubai };
    830  1.1  tsubai 
    831  1.1  tsubai void
    832  1.1  tsubai spifi_setsync(sc, ti)
    833  1.1  tsubai 	struct spifi_softc *sc;
    834  1.1  tsubai 	struct spifi_tinfo *ti;
    835  1.1  tsubai {
    836  1.1  tsubai 	if ((ti->flags & T_SYNCMODE) == 0)
    837  1.1  tsubai 		reg->data_xfer = 0;
    838  1.1  tsubai 	else {
    839  1.1  tsubai 		int period = ti->period;
    840  1.1  tsubai 		int offset = ti->offset;
    841  1.1  tsubai 		int v;
    842  1.1  tsubai 
    843  1.1  tsubai 		for (v = sizeof(spifi_sync_period) - 1; v >= 0; v--)
    844  1.1  tsubai 			if (spifi_sync_period[v] >= period)
    845  1.1  tsubai 				break;
    846  1.1  tsubai 		if (v == -1)
    847  1.1  tsubai 			reg->data_xfer = 0;			/* XXX */
    848  1.1  tsubai 		else
    849  1.1  tsubai 			reg->data_xfer = v << 4 | offset;
    850  1.1  tsubai 	}
    851  1.1  tsubai }
    852  1.1  tsubai #endif
    853