Home | History | Annotate | Line # | Download | only in apbus
spifi.c revision 1.10
      1  1.10      wiz /*	$NetBSD: spifi.c,v 1.10 2003/05/03 18:10:54 wiz 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.9  thorpej CFATTACH_DECL(spifi, sizeof(struct spifi_softc),
    134   1.9  thorpej     spifi_match, spifi_attach, NULL, NULL);
    135   1.1   tsubai 
    136   1.1   tsubai int
    137   1.1   tsubai spifi_match(parent, cf, aux)
    138   1.1   tsubai 	struct device *parent;
    139   1.1   tsubai 	struct cfdata *cf;
    140   1.1   tsubai 	void *aux;
    141   1.1   tsubai {
    142   1.1   tsubai 	struct apbus_attach_args *apa = aux;
    143   1.1   tsubai 
    144   1.1   tsubai 	if (strcmp(apa->apa_name, "spifi") == 0)
    145   1.1   tsubai 		return 1;
    146   1.1   tsubai 
    147   1.1   tsubai 	return 0;
    148   1.1   tsubai }
    149   1.1   tsubai 
    150   1.1   tsubai void
    151   1.1   tsubai spifi_attach(parent, self, aux)
    152   1.1   tsubai 	struct device *parent, *self;
    153   1.1   tsubai 	void *aux;
    154   1.1   tsubai {
    155   1.1   tsubai 	struct spifi_softc *sc = (void *)self;
    156   1.1   tsubai 	struct apbus_attach_args *apa = aux;
    157   1.1   tsubai 	struct device *dma;
    158   1.1   tsubai 	int intr, i;
    159   1.1   tsubai 
    160   1.1   tsubai 	/* Initialize scbs. */
    161   1.1   tsubai 	TAILQ_INIT(&sc->free_scb);
    162   1.1   tsubai 	TAILQ_INIT(&sc->ready_scb);
    163   1.1   tsubai 	for (i = 0; i < sizeof(sc->sc_scb)/sizeof(sc->sc_scb[0]); i++)
    164   1.1   tsubai 		TAILQ_INSERT_TAIL(&sc->free_scb, &sc->sc_scb[i], chain);
    165   1.1   tsubai 
    166   1.1   tsubai 	sc->sc_reg = (struct spifi_reg *)apa->apa_hwbase;
    167   1.1   tsubai 	sc->sc_id = 7;					/* XXX */
    168   1.1   tsubai 
    169   1.1   tsubai 	/* Find my dmac3. */
    170   1.1   tsubai 	dma = dmac3_link(apa->apa_ctlnum);
    171   1.1   tsubai 	if (dma == NULL) {
    172   1.1   tsubai 		printf(": cannot find slave dmac\n");
    173   1.1   tsubai 		return;
    174   1.1   tsubai 	}
    175   1.1   tsubai 	sc->sc_dma = dma;
    176   1.1   tsubai 
    177   1.1   tsubai 	printf(" slot%d addr 0x%lx", apa->apa_slotno, apa->apa_hwbase);
    178   1.1   tsubai 	printf(": SCSI ID = %d, using %s\n", sc->sc_id, dma->dv_xname);
    179   1.1   tsubai 
    180   1.1   tsubai 	dmac3_reset(sc->sc_dma);
    181   1.1   tsubai 
    182   1.1   tsubai 	DMAC3_SLOWACCESS(sc);
    183   1.1   tsubai 	spifi_reset(sc);
    184   1.1   tsubai 	DMAC3_FASTACCESS(sc);
    185   1.1   tsubai 
    186   1.2   bouyer 	sc->sc_adapter.adapt_dev = &sc->sc_dev;
    187   1.2   bouyer 	sc->sc_adapter.adapt_nchannels = 1;
    188   1.2   bouyer 	sc->sc_adapter.adapt_openings = 7;
    189   1.2   bouyer 	sc->sc_adapter.adapt_max_periph = 1;
    190   1.2   bouyer 	sc->sc_adapter.adapt_ioctl = NULL;
    191   1.2   bouyer 	sc->sc_adapter.adapt_minphys = minphys;
    192   1.2   bouyer 	sc->sc_adapter.adapt_request = spifi_scsipi_request;
    193   1.2   bouyer 
    194   1.2   bouyer 	memset(&sc->sc_channel, 0, sizeof(sc->sc_channel));
    195   1.2   bouyer 	sc->sc_channel.chan_adapter = &sc->sc_adapter;
    196   1.2   bouyer 	sc->sc_channel.chan_bustype = &scsi_bustype;
    197   1.2   bouyer 	sc->sc_channel.chan_channel = 0;
    198   1.2   bouyer 	sc->sc_channel.chan_ntargets = 8;
    199   1.2   bouyer 	sc->sc_channel.chan_nluns = 8;
    200   1.2   bouyer 	sc->sc_channel.chan_id = sc->sc_id;
    201   1.1   tsubai 
    202   1.1   tsubai 	if (apa->apa_slotno == 0)
    203   1.1   tsubai 		intr = NEWS5000_INT0_DMAC;
    204   1.1   tsubai 	else
    205   1.1   tsubai 		intr = SLOTTOMASK(apa->apa_slotno);
    206   1.1   tsubai 	apbus_intr_establish(0, intr, 0, spifi_intr, sc, apa->apa_name,
    207   1.1   tsubai 	    apa->apa_ctlnum);
    208   1.1   tsubai 
    209   1.2   bouyer 	config_found(&sc->sc_dev, &sc->sc_channel, scsiprint);
    210   1.1   tsubai }
    211   1.1   tsubai 
    212   1.2   bouyer void
    213   1.2   bouyer spifi_scsipi_request(chan, req, arg)
    214   1.2   bouyer 	struct scsipi_channel *chan;
    215   1.2   bouyer 	scsipi_adapter_req_t req;
    216   1.2   bouyer 	void *arg;
    217   1.2   bouyer {
    218   1.1   tsubai 	struct scsipi_xfer *xs;
    219   1.2   bouyer 	struct scsipi_periph *periph;
    220   1.2   bouyer 	struct spifi_softc *sc = (void *)chan->chan_adapter->adapt_dev;
    221   1.1   tsubai 	struct spifi_scb *scb;
    222   1.1   tsubai 	u_int flags;
    223   1.1   tsubai 	int s;
    224   1.1   tsubai 
    225   1.2   bouyer 	switch (req) {
    226   1.2   bouyer 	case ADAPTER_REQ_RUN_XFER:
    227   1.2   bouyer 		xs = arg;
    228   1.2   bouyer 		periph = xs->xs_periph;
    229   1.2   bouyer 
    230   1.2   bouyer 		DPRINTF("spifi_scsi_cmd\n");
    231   1.2   bouyer 
    232   1.2   bouyer 		flags = xs->xs_control;
    233   1.2   bouyer 
    234   1.2   bouyer 		scb = spifi_get_scb(sc);
    235   1.2   bouyer 		if (scb == NULL) {
    236   1.7   provos 			panic("spifi_scsipi_request: no scb");
    237   1.2   bouyer 		}
    238   1.1   tsubai 
    239   1.2   bouyer 		scb->xs = xs;
    240   1.2   bouyer 		scb->flags = 0;
    241   1.2   bouyer 		scb->status = 0;
    242   1.2   bouyer 		scb->daddr = (vaddr_t)xs->data;
    243   1.2   bouyer 		scb->resid = xs->datalen;
    244   1.2   bouyer 		bcopy(xs->cmd, &scb->cmd, xs->cmdlen);
    245   1.2   bouyer 		scb->cmdlen = xs->cmdlen;
    246   1.2   bouyer 
    247   1.2   bouyer 		scb->target = periph->periph_target;
    248   1.2   bouyer 		scb->lun = periph->periph_lun;
    249   1.2   bouyer 		scb->lun_targ = scb->target | (scb->lun << 3);
    250   1.2   bouyer 
    251   1.2   bouyer 		if (flags & XS_CTL_DATA_IN)
    252   1.2   bouyer 			scb->flags |= SPIFI_READ;
    253   1.2   bouyer 
    254   1.2   bouyer 		s = splbio();
    255   1.2   bouyer 
    256   1.2   bouyer 		TAILQ_INSERT_TAIL(&sc->ready_scb, scb, chain);
    257   1.2   bouyer 
    258   1.2   bouyer 		if (sc->sc_nexus == NULL)	/* IDLE */
    259   1.2   bouyer 			spifi_sched(sc);
    260   1.2   bouyer 
    261   1.2   bouyer 		splx(s);
    262   1.2   bouyer 
    263   1.2   bouyer 		if (flags & XS_CTL_POLL) {
    264   1.2   bouyer 			if (spifi_poll(sc)) {
    265   1.2   bouyer 				printf("spifi: timeout\n");
    266   1.2   bouyer 				if (spifi_poll(sc))
    267   1.2   bouyer 					printf("spifi: timeout again\n");
    268   1.2   bouyer 			}
    269   1.2   bouyer 		}
    270   1.2   bouyer 		return;
    271   1.2   bouyer 	case ADAPTER_REQ_GROW_RESOURCES:
    272   1.2   bouyer 		/* XXX Not supported. */
    273   1.2   bouyer 		return;
    274   1.2   bouyer 	case ADAPTER_REQ_SET_XFER_MODE:
    275   1.2   bouyer 		/* XXX Not supported. */
    276   1.2   bouyer 		return;
    277   1.1   tsubai 	}
    278   1.1   tsubai }
    279   1.1   tsubai 
    280   1.1   tsubai struct spifi_scb *
    281   1.1   tsubai spifi_get_scb(sc)
    282   1.1   tsubai 	struct spifi_softc *sc;
    283   1.1   tsubai {
    284   1.1   tsubai 	struct spifi_scb *scb;
    285   1.1   tsubai 	int s;
    286   1.1   tsubai 
    287   1.1   tsubai 	s = splbio();
    288   1.1   tsubai 	scb = sc->free_scb.tqh_first;
    289   1.1   tsubai 	if (scb)
    290   1.1   tsubai 		TAILQ_REMOVE(&sc->free_scb, scb, chain);
    291   1.1   tsubai 	splx(s);
    292   1.1   tsubai 
    293   1.1   tsubai 	return scb;
    294   1.1   tsubai }
    295   1.1   tsubai 
    296   1.1   tsubai void
    297   1.1   tsubai spifi_free_scb(sc, scb)
    298   1.1   tsubai 	struct spifi_softc *sc;
    299   1.1   tsubai 	struct spifi_scb *scb;
    300   1.1   tsubai {
    301   1.1   tsubai 	int s;
    302   1.1   tsubai 
    303   1.1   tsubai 	s = splbio();
    304   1.1   tsubai 	TAILQ_INSERT_HEAD(&sc->free_scb, scb, chain);
    305   1.1   tsubai 	splx(s);
    306   1.1   tsubai }
    307   1.1   tsubai 
    308   1.1   tsubai int
    309   1.1   tsubai spifi_poll(sc)
    310   1.1   tsubai 	struct spifi_softc *sc;
    311   1.1   tsubai {
    312   1.1   tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    313   1.1   tsubai 	struct scsipi_xfer *xs;
    314   1.1   tsubai 	int count;
    315   1.1   tsubai 
    316   1.1   tsubai 	printf("spifi_poll: not implemented yet\n");
    317   1.1   tsubai 	delay(10000);
    318   1.4   tsubai 	scb->status = SCSI_OK;
    319   1.4   tsubai 	scb->resid = 0;
    320   1.4   tsubai 	spifi_done(sc);
    321   1.1   tsubai 	return 0;
    322   1.1   tsubai 
    323   1.1   tsubai 	if (xs == NULL)
    324   1.1   tsubai 		return 0;
    325   1.1   tsubai 
    326   1.1   tsubai 	xs = scb->xs;
    327   1.1   tsubai 	count = xs->timeout;
    328   1.1   tsubai 
    329   1.1   tsubai 	while (count > 0) {
    330   1.1   tsubai 		if (dmac3_intr(sc->sc_dma) != 0)
    331   1.1   tsubai 			spifi_intr(sc);
    332   1.1   tsubai 
    333   1.1   tsubai 		if (xs->xs_status & XS_STS_DONE)
    334   1.1   tsubai 			return 0;
    335   1.1   tsubai 		DELAY(1000);
    336   1.1   tsubai 		count--;
    337   1.1   tsubai 	};
    338   1.1   tsubai 	return 1;
    339   1.1   tsubai }
    340   1.1   tsubai 
    341   1.1   tsubai void
    342   1.1   tsubai spifi_minphys(bp)
    343   1.1   tsubai 	struct buf *bp;
    344   1.1   tsubai {
    345   1.1   tsubai 	if (bp->b_bcount > 64*1024)
    346   1.1   tsubai 		bp->b_bcount = 64*1024;
    347   1.1   tsubai 
    348   1.1   tsubai 	minphys(bp);
    349   1.1   tsubai }
    350   1.1   tsubai 
    351   1.1   tsubai void
    352   1.1   tsubai spifi_sched(sc)
    353   1.1   tsubai 	struct spifi_softc *sc;
    354   1.1   tsubai {
    355   1.1   tsubai 	struct spifi_scb *scb;
    356   1.1   tsubai 
    357   1.1   tsubai 	scb = sc->ready_scb.tqh_first;
    358   1.1   tsubai start:
    359   1.1   tsubai 	if (scb == NULL || sc->sc_nexus != NULL)
    360   1.1   tsubai 		return;
    361   1.1   tsubai /*
    362   1.1   tsubai 	if (sc->sc_targets[scb->target] & (1 << scb->lun))
    363   1.1   tsubai 		goto next;
    364   1.1   tsubai */
    365   1.1   tsubai 	TAILQ_REMOVE(&sc->ready_scb, scb, chain);
    366   1.1   tsubai 
    367   1.1   tsubai #ifdef SPIFI_DEBUG
    368   1.1   tsubai {
    369   1.1   tsubai 	int i;
    370   1.1   tsubai 
    371   1.1   tsubai 	printf("spifi_sched: ID:LUN = %d:%d, ", scb->target, scb->lun);
    372   1.1   tsubai 	printf("cmd = 0x%x", scb->cmd.opcode);
    373   1.1   tsubai 	for (i = 0; i < 5; i++)
    374   1.1   tsubai 		printf(" 0x%x", scb->cmd.bytes[i]);
    375   1.1   tsubai 	printf("\n");
    376   1.1   tsubai }
    377   1.1   tsubai #endif
    378   1.1   tsubai 
    379   1.1   tsubai 	DMAC3_SLOWACCESS(sc);
    380   1.1   tsubai 	sc->sc_nexus = scb;
    381   1.1   tsubai 	spifi_select(sc);
    382   1.1   tsubai 	DMAC3_FASTACCESS(sc);
    383   1.1   tsubai 
    384   1.1   tsubai 	scb = scb->chain.tqe_next;
    385   1.1   tsubai 	goto start;
    386   1.1   tsubai }
    387   1.1   tsubai 
    388   1.1   tsubai static inline int
    389   1.1   tsubai spifi_read_count(reg)
    390   1.1   tsubai 	struct spifi_reg *reg;
    391   1.1   tsubai {
    392   1.1   tsubai 	int count;
    393   1.1   tsubai 
    394   1.6  tsutsui 	count = (reg->count_hi  & 0xff) << 16 |
    395   1.6  tsutsui 		(reg->count_mid & 0xff) <<  8 |
    396   1.1   tsubai 		(reg->count_low & 0xff);
    397   1.1   tsubai 	return count;
    398   1.1   tsubai }
    399   1.1   tsubai 
    400   1.1   tsubai static inline void
    401   1.1   tsubai spifi_write_count(reg, count)
    402   1.1   tsubai 	struct spifi_reg *reg;
    403   1.1   tsubai 	int count;
    404   1.1   tsubai {
    405   1.1   tsubai 	reg->count_hi  = count >> 16;
    406   1.1   tsubai 	reg->count_mid = count >> 8;
    407   1.1   tsubai 	reg->count_low = count;
    408   1.1   tsubai }
    409   1.1   tsubai 
    410   1.1   tsubai 
    411   1.1   tsubai #ifdef SPIFI_DEBUG
    412   1.1   tsubai static char scsi_phase_name[][8] = {
    413   1.1   tsubai 	"DATAOUT", "DATAIN", "COMMAND", "STATUS",
    414   1.1   tsubai 	"", "", "MSGOUT", "MSGIN"
    415   1.1   tsubai };
    416   1.1   tsubai #endif
    417   1.1   tsubai 
    418   1.1   tsubai int
    419   1.1   tsubai spifi_intr(v)
    420   1.1   tsubai 	void *v;
    421   1.1   tsubai {
    422   1.1   tsubai 	struct spifi_softc *sc = v;
    423   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    424   1.1   tsubai 	int intr, state, icond;
    425   1.1   tsubai 	struct spifi_scb *scb;
    426   1.1   tsubai 	struct scsipi_xfer *xs;
    427   1.1   tsubai #ifdef SPIFI_DEBUG
    428   1.1   tsubai 	char bitmask[64];
    429   1.1   tsubai #endif
    430   1.1   tsubai 
    431   1.1   tsubai 	switch (dmac3_intr(sc->sc_dma)) {
    432   1.1   tsubai 	case 0:
    433  1.10      wiz 		DPRINTF("spurious DMA intr\n");
    434   1.1   tsubai 		return 0;
    435   1.1   tsubai 	case -1:
    436   1.1   tsubai 		printf("DMAC parity error, data PAD\n");
    437   1.1   tsubai 
    438   1.1   tsubai 		DMAC3_SLOWACCESS(sc);
    439   1.1   tsubai 		reg->prcmd = PRC_TRPAD;
    440   1.1   tsubai 		DMAC3_FASTACCESS(sc);
    441   1.1   tsubai 		return 1;
    442   1.1   tsubai 
    443   1.1   tsubai 	default:
    444   1.1   tsubai 		break;
    445   1.1   tsubai 	}
    446   1.1   tsubai 	DMAC3_SLOWACCESS(sc);
    447   1.1   tsubai 
    448   1.1   tsubai 	intr = reg->intr & 0xff;
    449   1.1   tsubai 	if (intr == 0) {
    450   1.1   tsubai 		DMAC3_FASTACCESS(sc);
    451   1.5      wiz 		DPRINTF("spurious intr (not me)\n");
    452   1.1   tsubai 		return 0;
    453   1.1   tsubai 	}
    454   1.1   tsubai 
    455   1.1   tsubai 	scb = sc->sc_nexus;
    456   1.1   tsubai 	xs = scb->xs;
    457   1.1   tsubai 	state = reg->spstat;
    458   1.1   tsubai 	icond = reg->icond;
    459   1.1   tsubai 
    460   1.1   tsubai 	/* clear interrupt */
    461   1.1   tsubai 	reg->intr = ~intr;
    462   1.1   tsubai 
    463   1.1   tsubai #ifdef SPIFI_DEBUG
    464   1.1   tsubai 	bitmask_snprintf(intr, INTR_BITMASK, bitmask, sizeof bitmask);
    465   1.1   tsubai 	printf("spifi_intr intr = 0x%s (%s), ", bitmask,
    466   1.1   tsubai 		scsi_phase_name[(reg->prstat >> 3) & 7]);
    467   1.1   tsubai 	printf("state = 0x%x, icond = 0x%x\n", state, icond);
    468   1.1   tsubai #endif
    469   1.1   tsubai 
    470   1.1   tsubai 	if (intr & INTR_FCOMP) {
    471   1.1   tsubai 		spifi_fifo_drain(sc);
    472   1.1   tsubai 		scb->status = reg->cmbuf[scb->target].status;
    473   1.1   tsubai 		scb->resid = spifi_read_count(reg);
    474   1.1   tsubai 
    475   1.1   tsubai 		DPRINTF("datalen = %d, resid = %d, status = 0x%x\n",
    476   1.1   tsubai 			xs->datalen, scb->resid, scb->status);
    477   1.1   tsubai 		DPRINTF("msg = 0x%x\n", reg->cmbuf[sc->sc_id].cdb[0]);
    478   1.1   tsubai 
    479   1.1   tsubai 		DMAC3_FASTACCESS(sc);
    480   1.1   tsubai 		spifi_done(sc);
    481   1.1   tsubai 		return 1;
    482   1.1   tsubai 	}
    483   1.1   tsubai 	if (intr & INTR_DISCON)
    484   1.1   tsubai 		panic("disconnect");
    485   1.1   tsubai 
    486   1.1   tsubai 	if (intr & INTR_TIMEO) {
    487   1.1   tsubai 		xs->error = XS_SELTIMEOUT;
    488   1.1   tsubai 		DMAC3_FASTACCESS(sc);
    489   1.1   tsubai 		spifi_done(sc);
    490   1.1   tsubai 		return 1;
    491   1.1   tsubai 	}
    492   1.1   tsubai 	if (intr & INTR_BSRQ) {
    493   1.1   tsubai 		if (scb == NULL)
    494   1.1   tsubai 			panic("reconnect?");
    495   1.1   tsubai 
    496   1.1   tsubai 		if (intr & INTR_PERR) {
    497   1.1   tsubai 			printf("%s: %d:%d parity error\n", sc->sc_dev.dv_xname,
    498   1.1   tsubai 			       scb->target, scb->lun);
    499   1.1   tsubai 
    500   1.1   tsubai 			/* XXX reset */
    501   1.1   tsubai 			xs->error = XS_DRIVER_STUFFUP;
    502   1.1   tsubai 			spifi_done(sc);
    503   1.1   tsubai 			return 1;
    504   1.1   tsubai 		}
    505   1.1   tsubai 
    506   1.1   tsubai 		if (state >> 4 == SPS_MSGIN && icond == ICOND_NXTREQ)
    507   1.1   tsubai 			panic("spifi_intr: NXTREQ");
    508   1.1   tsubai 		if (reg->fifoctrl & FIFOC_RQOVRN)
    509   1.1   tsubai 			panic("spifi_intr RQOVRN");
    510   1.1   tsubai 		if (icond == ICOND_UXPHASEZ)
    511   1.1   tsubai 			panic("ICOND_UXPHASEZ");
    512   1.1   tsubai 
    513   1.1   tsubai 		if ((icond & 0x0f) == ICOND_ADATAOFF) {
    514   1.1   tsubai 			spifi_data_io(sc);
    515   1.1   tsubai 			goto done;
    516   1.1   tsubai 		}
    517   1.1   tsubai 		if ((icond & 0xf0) == ICOND_UBF) {
    518   1.1   tsubai 			reg->exstat = reg->exstat & ~EXS_UBF;
    519   1.1   tsubai 			spifi_pmatch(sc);
    520   1.1   tsubai 			goto done;
    521   1.1   tsubai 		}
    522   1.1   tsubai 
    523   1.1   tsubai 		/*
    524   1.1   tsubai 		 * XXX Work around the SPIFI bug that interrupts during
    525   1.1   tsubai 		 * XXX dataout phase.
    526   1.1   tsubai 		 */
    527   1.1   tsubai 		if (state == ((SPS_DATAOUT << 4) | SPS_INTR) &&
    528   1.1   tsubai 		    (reg->prstat & PRS_PHASE) == SPIFI_DATAOUT) {
    529   1.1   tsubai 			reg->prcmd = PRC_DATAOUT;
    530   1.1   tsubai 			goto done;
    531   1.1   tsubai 		}
    532   1.1   tsubai 		if ((reg->prstat & PRS_Z) == 0) {
    533   1.1   tsubai 			spifi_pmatch(sc);
    534   1.1   tsubai 			goto done;
    535   1.1   tsubai 		}
    536   1.1   tsubai 
    537   1.1   tsubai 		panic("spifi_intr: unknown intr state");
    538   1.1   tsubai 	}
    539   1.1   tsubai 
    540   1.1   tsubai done:
    541   1.1   tsubai 	DMAC3_FASTACCESS(sc);
    542   1.1   tsubai 	return 1;
    543   1.1   tsubai }
    544   1.1   tsubai 
    545   1.1   tsubai void
    546   1.1   tsubai spifi_pmatch(sc)
    547   1.1   tsubai 	struct spifi_softc *sc;
    548   1.1   tsubai {
    549   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    550   1.1   tsubai 	int phase;
    551   1.1   tsubai 
    552   1.1   tsubai 	phase = (reg->prstat & PRS_PHASE);
    553   1.1   tsubai 
    554   1.1   tsubai #ifdef SPIFI_DEBUG
    555   1.1   tsubai 	printf("spifi_pmatch (%s)\n", scsi_phase_name[phase >> 3]);
    556   1.1   tsubai #endif
    557   1.1   tsubai 
    558   1.1   tsubai 	switch (phase) {
    559   1.1   tsubai 
    560   1.1   tsubai 	case SPIFI_COMMAND:
    561   1.1   tsubai 		spifi_command(sc);
    562   1.1   tsubai 		break;
    563   1.1   tsubai 	case SPIFI_DATAIN:
    564   1.1   tsubai 	case SPIFI_DATAOUT:
    565   1.1   tsubai 		spifi_data_io(sc);
    566   1.1   tsubai 		break;
    567   1.1   tsubai 	case SPIFI_STATUS:
    568   1.1   tsubai 		spifi_status(sc);
    569   1.1   tsubai 		break;
    570   1.1   tsubai 
    571   1.1   tsubai 	case SPIFI_MSGIN:	/* XXX */
    572   1.1   tsubai 	case SPIFI_MSGOUT:	/* XXX */
    573   1.1   tsubai 	default:
    574   1.1   tsubai 		printf("spifi: unknown phase %d\n", phase);
    575   1.1   tsubai 	}
    576   1.1   tsubai }
    577   1.1   tsubai 
    578   1.1   tsubai void
    579   1.1   tsubai spifi_select(sc)
    580   1.1   tsubai 	struct spifi_softc *sc;
    581   1.1   tsubai {
    582   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    583   1.1   tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    584   1.1   tsubai 	int sel;
    585   1.1   tsubai 
    586   1.1   tsubai #if 0
    587   1.1   tsubai 	if (reg->loopdata || reg->intr)
    588   1.1   tsubai 		return;
    589   1.1   tsubai #endif
    590   1.1   tsubai 
    591   1.1   tsubai 	if (scb == NULL) {
    592   1.1   tsubai 		printf("%s: spifi_select: NULL nexus\n", sc->sc_dev.dv_xname);
    593   1.1   tsubai 		return;
    594   1.1   tsubai 	}
    595   1.1   tsubai 
    596   1.1   tsubai 	reg->exctrl = EXC_IPLOCK;
    597   1.1   tsubai 
    598   1.1   tsubai 	dmac3_reset(sc->sc_dma);
    599   1.1   tsubai 	sel = scb->target << 4 | SEL_ISTART | SEL_IRESELEN | SEL_WATN;
    600   1.1   tsubai 	spifi_sendmsg(sc, SEND_IDENTIFY);
    601   1.1   tsubai 	reg->select = sel;
    602   1.1   tsubai }
    603   1.1   tsubai 
    604   1.1   tsubai void
    605   1.1   tsubai spifi_sendmsg(sc, msg)
    606   1.1   tsubai 	struct spifi_softc *sc;
    607   1.1   tsubai 	int msg;
    608   1.1   tsubai {
    609   1.1   tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    610   1.1   tsubai 	/* struct mesh_tinfo *ti; */
    611   1.1   tsubai 	int lun, len, i;
    612   1.1   tsubai 
    613   1.1   tsubai 	int id = sc->sc_id;
    614   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    615   1.1   tsubai 
    616   1.1   tsubai 	DPRINTF("spifi_sendmsg: sending");
    617   1.1   tsubai 	sc->sc_msgout = msg;
    618   1.1   tsubai 	len = 0;
    619   1.1   tsubai 
    620   1.1   tsubai 	if (msg & SEND_REJECT) {
    621   1.1   tsubai 		DPRINTF(" REJECT");
    622   1.1   tsubai 		sc->sc_omsg[len++] = MSG_MESSAGE_REJECT;
    623   1.1   tsubai 	}
    624   1.1   tsubai 	if (msg & SEND_IDENTIFY) {
    625   1.1   tsubai 		DPRINTF(" IDENTIFY");
    626   1.2   bouyer 		lun = scb->xs->xs_periph->periph_lun;
    627   1.1   tsubai 		sc->sc_omsg[len++] = MSG_IDENTIFY(lun, 0);
    628   1.1   tsubai 	}
    629   1.1   tsubai 	if (msg & SEND_SDTR) {
    630   1.1   tsubai 		DPRINTF(" SDTR");
    631   1.1   tsubai #if 0
    632   1.1   tsubai 		ti = &sc->sc_tinfo[scb->target];
    633   1.1   tsubai 		sc->sc_omsg[len++] = MSG_EXTENDED;
    634   1.1   tsubai 		sc->sc_omsg[len++] = 3;
    635   1.1   tsubai 		sc->sc_omsg[len++] = MSG_EXT_SDTR;
    636   1.1   tsubai 		sc->sc_omsg[len++] = ti->period;
    637   1.1   tsubai 		sc->sc_omsg[len++] = ti->offset;
    638   1.1   tsubai #endif
    639   1.1   tsubai 	}
    640   1.1   tsubai 	DPRINTF("\n");
    641   1.1   tsubai 
    642   1.1   tsubai 	reg->cmlen = CML_AMSG_EN | len;
    643   1.1   tsubai 	for (i = 0; i < len; i++)
    644   1.1   tsubai 		reg->cmbuf[id].cdb[i] = sc->sc_omsg[i];
    645   1.1   tsubai }
    646   1.1   tsubai void
    647   1.1   tsubai spifi_command(struct spifi_softc *sc)
    648   1.1   tsubai {
    649   1.1   tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    650   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    651   1.1   tsubai 	int len = scb->cmdlen;
    652   1.1   tsubai 	u_char *cmdp = (char *)&scb->cmd;
    653   1.1   tsubai 	int i;
    654   1.1   tsubai 
    655   1.1   tsubai 	DPRINTF("spifi_command\n");
    656   1.1   tsubai 
    657   1.1   tsubai 	reg->cmdpage = scb->lun_targ;
    658   1.1   tsubai 
    659   1.1   tsubai 	if (reg->init_status & IST_ACK) {
    660   1.1   tsubai 		/* Negate ACK. */
    661   1.1   tsubai 		reg->prcmd = PRC_NJMP | PRC_CLRACK | PRC_COMMAND;
    662   1.1   tsubai 		reg->prcmd = PRC_NJMP | PRC_COMMAND;
    663   1.1   tsubai 	}
    664   1.1   tsubai 
    665   1.1   tsubai 	reg->cmlen = CML_AMSG_EN | len;
    666   1.1   tsubai 
    667   1.1   tsubai 	for (i = 0; i < len; i++)
    668   1.1   tsubai 		reg->cmbuf[sc->sc_id].cdb[i] = *cmdp++;
    669   1.1   tsubai 
    670   1.1   tsubai 	reg->prcmd = PRC_COMMAND;
    671   1.1   tsubai }
    672   1.1   tsubai 
    673   1.1   tsubai void
    674   1.1   tsubai spifi_data_io(struct spifi_softc *sc)
    675   1.1   tsubai {
    676   1.1   tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    677   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    678   1.1   tsubai 	int phase;
    679   1.1   tsubai 
    680   1.1   tsubai 	DPRINTF("spifi_data_io\n");
    681   1.1   tsubai 
    682   1.1   tsubai 	phase = reg->prstat & PRS_PHASE;
    683   1.1   tsubai 	dmac3_reset(sc->sc_dma);
    684   1.1   tsubai 
    685   1.1   tsubai 	spifi_write_count(reg, scb->resid);
    686   1.1   tsubai 	reg->cmlen = CML_AMSG_EN | 1;
    687   1.1   tsubai 	reg->data_xfer = 0;
    688   1.1   tsubai 
    689   1.1   tsubai 	scb->flags |= SPIFI_DMA;
    690   1.1   tsubai 	if (phase == SPIFI_DATAIN) {
    691   1.1   tsubai 		if (reg->fifoctrl & FIFOC_SSTKACT) {
    692   1.1   tsubai 			/*
    693   1.1   tsubai 			 * Clear FIFO and load the contents of synchronous
    694   1.1   tsubai 			 * stack into the FIFO.
    695   1.1   tsubai 			 */
    696   1.1   tsubai 			reg->fifoctrl = FIFOC_CLREVEN;
    697   1.1   tsubai 			reg->fifoctrl = FIFOC_LOAD;
    698   1.1   tsubai 		}
    699   1.1   tsubai 		reg->autodata = ADATA_IN | scb->lun_targ;
    700   1.1   tsubai 		dmac3_start(sc->sc_dma, scb->daddr, scb->resid, DMAC3_CSR_RECV);
    701   1.1   tsubai 		reg->prcmd = PRC_DATAIN;
    702   1.1   tsubai 	} else {
    703   1.1   tsubai 		reg->fifoctrl = FIFOC_CLREVEN;
    704   1.1   tsubai 		reg->autodata = scb->lun_targ;
    705   1.1   tsubai 		dmac3_start(sc->sc_dma, scb->daddr, scb->resid, DMAC3_CSR_SEND);
    706   1.1   tsubai 		reg->prcmd = PRC_DATAOUT;
    707   1.1   tsubai 	}
    708   1.1   tsubai }
    709   1.1   tsubai 
    710   1.1   tsubai void
    711   1.1   tsubai spifi_status(struct spifi_softc *sc)
    712   1.1   tsubai {
    713   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    714   1.1   tsubai 
    715   1.1   tsubai 	DPRINTF("spifi_status\n");
    716   1.1   tsubai 	spifi_fifo_drain(sc);
    717   1.1   tsubai 	reg->cmlen = CML_AMSG_EN | 1;
    718   1.1   tsubai 	reg->prcmd = PRC_STATUS;
    719   1.1   tsubai }
    720   1.1   tsubai 
    721   1.1   tsubai int
    722   1.1   tsubai spifi_done(sc)
    723   1.1   tsubai 	struct spifi_softc *sc;
    724   1.1   tsubai {
    725   1.1   tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    726   1.1   tsubai 	struct scsipi_xfer *xs = scb->xs;
    727   1.1   tsubai 
    728   1.1   tsubai 	DPRINTF("spifi_done\n");
    729   1.1   tsubai 
    730   1.2   bouyer 	xs->status = scb->status;
    731   1.2   bouyer 	if (xs->status == SCSI_CHECK) {
    732   1.1   tsubai 		DPRINTF("spifi_done: CHECK CONDITION\n");
    733   1.2   bouyer 		if (xs->error == XS_NOERROR)
    734   1.2   bouyer 			xs->error = XS_BUSY;
    735   1.2   bouyer 	}
    736   1.1   tsubai 
    737   1.1   tsubai 	xs->resid = scb->resid;
    738   1.1   tsubai 
    739   1.1   tsubai 	scsipi_done(xs);
    740   1.1   tsubai 	spifi_free_scb(sc, scb);
    741   1.1   tsubai 
    742   1.1   tsubai 	sc->sc_nexus = NULL;
    743   1.1   tsubai 	spifi_sched(sc);
    744   1.1   tsubai 
    745   1.1   tsubai 	return FALSE;
    746   1.1   tsubai }
    747   1.1   tsubai 
    748   1.1   tsubai void
    749   1.1   tsubai spifi_fifo_drain(sc)
    750   1.1   tsubai 	struct spifi_softc *sc;
    751   1.1   tsubai {
    752   1.1   tsubai 	struct spifi_scb *scb = sc->sc_nexus;
    753   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    754   1.1   tsubai 	int fifoctrl, fifo_count;
    755   1.1   tsubai 
    756   1.1   tsubai 	DPRINTF("spifi_fifo_drain\n");
    757   1.1   tsubai 
    758   1.1   tsubai 	if ((scb->flags & SPIFI_READ) == 0)
    759   1.1   tsubai 		return;
    760   1.1   tsubai 
    761   1.1   tsubai 	fifoctrl = reg->fifoctrl;
    762   1.1   tsubai 	if (fifoctrl & FIFOC_SSTKACT)
    763   1.1   tsubai 		return;
    764   1.1   tsubai 
    765   1.1   tsubai 	fifo_count = 8 - (fifoctrl & FIFOC_FSLOT);
    766   1.1   tsubai 	if (fifo_count > 0 && (scb->flags & SPIFI_DMA)) {
    767   1.1   tsubai 		/* Flush data still in FIFO. */
    768   1.1   tsubai 		reg->fifoctrl = FIFOC_FLUSH;
    769   1.1   tsubai 		return;
    770   1.1   tsubai 	}
    771   1.1   tsubai 
    772   1.1   tsubai 	reg->fifoctrl = FIFOC_CLREVEN;
    773   1.1   tsubai }
    774   1.1   tsubai 
    775   1.1   tsubai void
    776   1.1   tsubai spifi_reset(sc)
    777   1.1   tsubai 	struct spifi_softc *sc;
    778   1.1   tsubai {
    779   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    780   1.1   tsubai 	int id = sc->sc_id;
    781   1.1   tsubai 
    782   1.1   tsubai 	DPRINTF("spifi_reset\n");
    783   1.1   tsubai 
    784   1.1   tsubai 	reg->auxctrl = AUXCTRL_SRST;
    785   1.1   tsubai 	reg->auxctrl = AUXCTRL_CRST;
    786   1.1   tsubai 
    787   1.1   tsubai 	dmac3_reset(sc->sc_dma);
    788   1.1   tsubai 
    789   1.1   tsubai 	reg->auxctrl = AUXCTRL_SRST;
    790   1.1   tsubai 	reg->auxctrl = AUXCTRL_CRST;
    791   1.1   tsubai 	reg->auxctrl = AUXCTRL_DMAEDGE;
    792   1.1   tsubai 
    793   1.1   tsubai 	/* Mask (only) target mode interrupts. */
    794   1.1   tsubai 	reg->imask = INTR_TGSEL | INTR_COMRECV;
    795   1.1   tsubai 
    796   1.1   tsubai 	reg->config = CONFIG_DMABURST | CONFIG_PCHKEN | CONFIG_PGENEN | id;
    797   1.1   tsubai 	reg->fastwide = FAST_FASTEN;
    798   1.1   tsubai 	reg->prctrl = 0;
    799   1.1   tsubai 	reg->loopctrl = 0;
    800   1.1   tsubai 
    801   1.1   tsubai 	/* Enable automatic status input except the initiator. */
    802   1.1   tsubai 	reg->autostat = ~(1 << id);
    803   1.1   tsubai 
    804   1.1   tsubai 	reg->fifoctrl = FIFOC_CLREVEN;
    805   1.1   tsubai 	spifi_write_count(reg, 0);
    806   1.1   tsubai 
    807   1.1   tsubai 	/* Flush write buffer. */
    808   1.1   tsubai 	(void)reg->spstat;
    809   1.1   tsubai }
    810   1.1   tsubai 
    811   1.1   tsubai void
    812   1.1   tsubai spifi_bus_reset(sc)
    813   1.1   tsubai 	struct spifi_softc *sc;
    814   1.1   tsubai {
    815   1.1   tsubai 	struct spifi_reg *reg = sc->sc_reg;
    816   1.1   tsubai 
    817   1.1   tsubai 	printf("%s: bus reset\n", sc->sc_dev.dv_xname);
    818   1.1   tsubai 
    819   1.1   tsubai 	sc->sc_nexus = NULL;
    820   1.1   tsubai 
    821   1.1   tsubai 	reg->auxctrl = AUXCTRL_SETRST;
    822   1.1   tsubai 	delay(100);
    823   1.1   tsubai 	reg->auxctrl = 0;
    824   1.1   tsubai }
    825   1.1   tsubai 
    826   1.1   tsubai #if 0
    827   1.1   tsubai static u_char spifi_sync_period[] = {
    828   1.1   tsubai /* 0    1    2    3   4   5   6   7   8   9  10  11 */
    829   1.1   tsubai  137, 125, 112, 100, 87, 75, 62, 50, 43, 37, 31, 25
    830   1.1   tsubai };
    831   1.1   tsubai 
    832   1.1   tsubai void
    833   1.1   tsubai spifi_setsync(sc, ti)
    834   1.1   tsubai 	struct spifi_softc *sc;
    835   1.1   tsubai 	struct spifi_tinfo *ti;
    836   1.1   tsubai {
    837   1.1   tsubai 	if ((ti->flags & T_SYNCMODE) == 0)
    838   1.1   tsubai 		reg->data_xfer = 0;
    839   1.1   tsubai 	else {
    840   1.1   tsubai 		int period = ti->period;
    841   1.1   tsubai 		int offset = ti->offset;
    842   1.1   tsubai 		int v;
    843   1.1   tsubai 
    844   1.1   tsubai 		for (v = sizeof(spifi_sync_period) - 1; v >= 0; v--)
    845   1.1   tsubai 			if (spifi_sync_period[v] >= period)
    846   1.1   tsubai 				break;
    847   1.1   tsubai 		if (v == -1)
    848   1.1   tsubai 			reg->data_xfer = 0;			/* XXX */
    849   1.1   tsubai 		else
    850   1.1   tsubai 			reg->data_xfer = v << 4 | offset;
    851   1.1   tsubai 	}
    852   1.1   tsubai }
    853   1.1   tsubai #endif
    854