Home | History | Annotate | Line # | Download | only in podulebus
ptsc.c revision 1.6
      1  1.6  thorpej /*	$NetBSD: ptsc.c,v 1.6 2002/10/02 02:23:52 thorpej Exp $	*/
      2  1.1  reinoud 
      3  1.1  reinoud /*
      4  1.1  reinoud  * Copyright (c) 1995 Scott Stevens
      5  1.1  reinoud  * Copyright (c) 1995 Daniel Widenfalk
      6  1.1  reinoud  * Copyright (c) 1994 Christian E. Hopps
      7  1.1  reinoud  * Copyright (c) 1982, 1990 The Regents of the University of California.
      8  1.1  reinoud  * All rights reserved.
      9  1.1  reinoud  *
     10  1.1  reinoud  * Redistribution and use in source and binary forms, with or without
     11  1.1  reinoud  * modification, are permitted provided that the following conditions
     12  1.1  reinoud  * are met:
     13  1.1  reinoud  * 1. Redistributions of source code must retain the above copyright
     14  1.1  reinoud  *    notice, this list of conditions and the following disclaimer.
     15  1.1  reinoud  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1  reinoud  *    notice, this list of conditions and the following disclaimer in the
     17  1.1  reinoud  *    documentation and/or other materials provided with the distribution.
     18  1.1  reinoud  * 3. All advertising materials mentioning features or use of this software
     19  1.1  reinoud  *    must display the following acknowledgement:
     20  1.1  reinoud  *	This product includes software developed by the University of
     21  1.1  reinoud  *	California, Berkeley and its contributors.
     22  1.1  reinoud  * 4. Neither the name of the University nor the names of its contributors
     23  1.1  reinoud  *    may be used to endorse or promote products derived from this software
     24  1.1  reinoud  *    without specific prior written permission.
     25  1.1  reinoud  *
     26  1.1  reinoud  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     27  1.1  reinoud  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     28  1.1  reinoud  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     29  1.1  reinoud  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     30  1.1  reinoud  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     31  1.1  reinoud  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     32  1.1  reinoud  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     33  1.1  reinoud  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     34  1.1  reinoud  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     35  1.1  reinoud  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     36  1.1  reinoud  * SUCH DAMAGE.
     37  1.1  reinoud  *
     38  1.1  reinoud  *	@(#)ptsc.c
     39  1.1  reinoud  */
     40  1.1  reinoud 
     41  1.1  reinoud /*
     42  1.1  reinoud  * Power-tec SCSI-2 driver uses SFAS216 generic driver
     43  1.1  reinoud  *
     44  1.1  reinoud  * Thanks to Alsystems for loaning a development card and providing
     45  1.1  reinoud  * programming information.
     46  1.1  reinoud  */
     47  1.1  reinoud 
     48  1.1  reinoud #include <sys/param.h>
     49  1.1  reinoud #include <sys/systm.h>
     50  1.1  reinoud #include <sys/kernel.h>
     51  1.1  reinoud #include <sys/device.h>
     52  1.1  reinoud #include <dev/scsipi/scsi_all.h>
     53  1.1  reinoud #include <dev/scsipi/scsipi_all.h>
     54  1.1  reinoud #include <dev/scsipi/scsiconf.h>
     55  1.1  reinoud #include <uvm/uvm_extern.h>
     56  1.1  reinoud #include <machine/pmap.h>
     57  1.1  reinoud #include <machine/io.h>
     58  1.2  thorpej #include <machine/intr.h>
     59  1.1  reinoud #include <machine/bootconfig.h>
     60  1.1  reinoud #include <acorn32/podulebus/podulebus.h>
     61  1.1  reinoud #include <acorn32/podulebus/sfasreg.h>
     62  1.1  reinoud #include <acorn32/podulebus/sfasvar.h>
     63  1.1  reinoud #include <acorn32/podulebus/ptscreg.h>
     64  1.1  reinoud #include <acorn32/podulebus/ptscvar.h>
     65  1.1  reinoud #include <dev/podulebus/podules.h>
     66  1.1  reinoud #include <dev/podulebus/powerromreg.h>
     67  1.1  reinoud 
     68  1.1  reinoud void ptscattach __P((struct device *, struct device *, void *));
     69  1.1  reinoud int  ptscmatch  __P((struct device *, struct cfdata *, void *));
     70  1.1  reinoud 
     71  1.6  thorpej CFATTACH_DECL(ptsc, sizeof(struct ptsc_softc),
     72  1.6  thorpej 	ptscmatch, ptscattach, NULL, NULL);
     73  1.1  reinoud 
     74  1.1  reinoud int ptsc_intr		 __P((void *arg));
     75  1.1  reinoud int ptsc_setup_dma	 __P((struct sfas_softc *sc, void *ptr, int len,
     76  1.1  reinoud 			      int mode));
     77  1.1  reinoud int ptsc_build_dma_chain __P((struct sfas_softc *sc,
     78  1.1  reinoud 			      struct sfas_dma_chain *chain, void *p, int l));
     79  1.1  reinoud int ptsc_need_bump	 __P((struct sfas_softc *sc, void *ptr, int len));
     80  1.1  reinoud void ptsc_led		 __P((struct sfas_softc *sc, int mode));
     81  1.1  reinoud 
     82  1.1  reinoud /*
     83  1.1  reinoud  * if we are a Power-tec SCSI-2 card
     84  1.1  reinoud  */
     85  1.1  reinoud int
     86  1.1  reinoud ptscmatch(pdp, cf, auxp)
     87  1.1  reinoud 	struct device	*pdp;
     88  1.1  reinoud 	struct cfdata	*cf;
     89  1.1  reinoud 	void		*auxp;
     90  1.1  reinoud {
     91  1.1  reinoud 	struct podule_attach_args *pa = (struct podule_attach_args *)auxp;
     92  1.1  reinoud 
     93  1.1  reinoud 	/* Look for the card */
     94  1.1  reinoud 
     95  1.1  reinoud 	/*
     96  1.1  reinoud 	 * All Power-tec cards effectively have PowerROMS.  Note,
     97  1.1  reinoud 	 * though, that here, if we fail to initialise the loader, we
     98  1.1  reinoud 	 * assume this _is_ the right kind of card.
     99  1.1  reinoud 	 */
    100  1.1  reinoud         if (pa->pa_product == PODULE_ALSYSTEMS_SCSI &&
    101  1.1  reinoud             (podulebus_initloader(pa) != 0 ||
    102  1.1  reinoud 	     podloader_callloader(pa, 0, 0) == PRID_POWERTEC))
    103  1.1  reinoud                 return 1;
    104  1.1  reinoud 
    105  1.1  reinoud 	return 0;
    106  1.1  reinoud }
    107  1.1  reinoud 
    108  1.1  reinoud void
    109  1.1  reinoud ptscattach(pdp, dp, auxp)
    110  1.1  reinoud 	struct device	*pdp;
    111  1.1  reinoud 	struct device	*dp;
    112  1.1  reinoud 	void		*auxp;
    113  1.1  reinoud {
    114  1.1  reinoud 	struct ptsc_softc *sc = (struct ptsc_softc *)dp;
    115  1.1  reinoud 	struct podule_attach_args  *pa;
    116  1.1  reinoud 	ptsc_regmap_p	   rp = &sc->sc_regmap;
    117  1.1  reinoud 	vu_char		  *fas;
    118  1.1  reinoud 
    119  1.1  reinoud 	pa = (struct podule_attach_args *)auxp;
    120  1.1  reinoud 
    121  1.1  reinoud 	if (pa->pa_podule_number == -1)
    122  1.1  reinoud 		panic("Podule has disappeared !");
    123  1.1  reinoud 
    124  1.1  reinoud 	sc->sc_specific.sc_podule_number = pa->pa_podule_number;
    125  1.1  reinoud 	sc->sc_specific.sc_podule = pa->pa_podule;
    126  1.1  reinoud 	sc->sc_specific.sc_iobase =
    127  1.1  reinoud 	  (vu_char *)sc->sc_specific.sc_podule->fast_base;
    128  1.1  reinoud 
    129  1.1  reinoud 	rp->chipreset = &sc->sc_specific.sc_iobase[PTSC_CONTROL_CHIPRESET];
    130  1.1  reinoud 	rp->inten = &sc->sc_specific.sc_iobase[PTSC_CONTROL_INTEN];
    131  1.1  reinoud 	rp->status = &sc->sc_specific.sc_iobase[PTSC_STATUS];
    132  1.1  reinoud 	rp->term = &sc->sc_specific.sc_iobase[PTSC_CONTROL_TERM];
    133  1.1  reinoud 	rp->led = &sc->sc_specific.sc_iobase[PTSC_CONTROL_LED];
    134  1.1  reinoud 	fas = &sc->sc_specific.sc_iobase[PTSC_FASOFFSET_BASE];
    135  1.1  reinoud 
    136  1.1  reinoud 	rp->FAS216.sfas_tc_low	= &fas[PTSC_FASOFFSET_TCL];
    137  1.1  reinoud 	rp->FAS216.sfas_tc_mid	= &fas[PTSC_FASOFFSET_TCM];
    138  1.1  reinoud 	rp->FAS216.sfas_fifo	= &fas[PTSC_FASOFFSET_FIFO];
    139  1.1  reinoud 	rp->FAS216.sfas_command	= &fas[PTSC_FASOFFSET_COMMAND];
    140  1.1  reinoud 	rp->FAS216.sfas_dest_id	= &fas[PTSC_FASOFFSET_DESTID];
    141  1.1  reinoud 	rp->FAS216.sfas_timeout	= &fas[PTSC_FASOFFSET_TIMEOUT];
    142  1.1  reinoud 	rp->FAS216.sfas_syncper	= &fas[PTSC_FASOFFSET_PERIOD];
    143  1.1  reinoud 	rp->FAS216.sfas_syncoff	= &fas[PTSC_FASOFFSET_OFFSET];
    144  1.1  reinoud 	rp->FAS216.sfas_config1	= &fas[PTSC_FASOFFSET_CONFIG1];
    145  1.1  reinoud 	rp->FAS216.sfas_clkconv	= &fas[PTSC_FASOFFSET_CLOCKCONV];
    146  1.1  reinoud 	rp->FAS216.sfas_test	= &fas[PTSC_FASOFFSET_TEST];
    147  1.1  reinoud 	rp->FAS216.sfas_config2	= &fas[PTSC_FASOFFSET_CONFIG2];
    148  1.1  reinoud 	rp->FAS216.sfas_config3	= &fas[PTSC_FASOFFSET_CONFIG3];
    149  1.1  reinoud 	rp->FAS216.sfas_tc_high	= &fas[PTSC_FASOFFSET_TCH];
    150  1.1  reinoud 	rp->FAS216.sfas_fifo_bot = &fas[PTSC_FASOFFSET_FIFOBOTTOM];
    151  1.1  reinoud 
    152  1.1  reinoud 	sc->sc_softc.sc_fas	= (sfas_regmap_p)rp;
    153  1.1  reinoud 	sc->sc_softc.sc_spec	= &sc->sc_specific;
    154  1.1  reinoud 
    155  1.1  reinoud 	sc->sc_softc.sc_led	= ptsc_led;
    156  1.1  reinoud 
    157  1.1  reinoud 	sc->sc_softc.sc_setup_dma	= ptsc_setup_dma;
    158  1.1  reinoud 	sc->sc_softc.sc_build_dma_chain = ptsc_build_dma_chain;
    159  1.1  reinoud 	sc->sc_softc.sc_need_bump	= ptsc_need_bump;
    160  1.1  reinoud 
    161  1.1  reinoud 	sc->sc_softc.sc_clock_freq   = 40;   /* Power-Tec runs at 8MHz */
    162  1.1  reinoud 	sc->sc_softc.sc_timeout      = 250;  /* Set default timeout to 250ms */
    163  1.1  reinoud 	sc->sc_softc.sc_config_flags = SFAS_NO_DMA /*| SFAS_NF_DEBUG*/;
    164  1.1  reinoud 	sc->sc_softc.sc_host_id      = 7;    /* Should check the jumpers */
    165  1.1  reinoud 
    166  1.1  reinoud 	sc->sc_softc.sc_bump_sz = NBPG;
    167  1.1  reinoud 	sc->sc_softc.sc_bump_pa = 0x0;
    168  1.1  reinoud 
    169  1.1  reinoud 	sfasinitialize((struct sfas_softc *)sc);
    170  1.1  reinoud 
    171  1.1  reinoud 	sc->sc_softc.sc_adapter.adapt_dev = &sc->sc_softc.sc_dev;
    172  1.1  reinoud 	sc->sc_softc.sc_adapter.adapt_nchannels = 1;
    173  1.1  reinoud 	sc->sc_softc.sc_adapter.adapt_openings = 7;
    174  1.1  reinoud 	sc->sc_softc.sc_adapter.adapt_max_periph = 1;
    175  1.1  reinoud 	sc->sc_softc.sc_adapter.adapt_ioctl = NULL;
    176  1.1  reinoud 	sc->sc_softc.sc_adapter.adapt_minphys = sfas_minphys;
    177  1.3    bjh21 	sc->sc_softc.sc_adapter.adapt_request = sfas_scsi_request;
    178  1.1  reinoud 
    179  1.1  reinoud 	sc->sc_softc.sc_channel.chan_adapter = &sc->sc_softc.sc_adapter;
    180  1.1  reinoud 	sc->sc_softc.sc_channel.chan_bustype = &scsi_bustype;
    181  1.1  reinoud 	sc->sc_softc.sc_channel.chan_channel = 0;
    182  1.1  reinoud 	sc->sc_softc.sc_channel.chan_ntargets = 8;
    183  1.1  reinoud 	sc->sc_softc.sc_channel.chan_nluns = 8;
    184  1.1  reinoud 	sc->sc_softc.sc_channel.chan_id = sc->sc_softc.sc_host_id;
    185  1.1  reinoud 
    186  1.1  reinoud 	/* Provide an override for the host id */
    187  1.1  reinoud 	(void)get_bootconf_option(boot_args, "ptsc.hostid",
    188  1.1  reinoud 	    BOOTOPT_TYPE_INT, &sc->sc_softc.sc_channel.chan_id);
    189  1.1  reinoud 
    190  1.1  reinoud 	printf(": host=%d", sc->sc_softc.sc_channel.chan_id);
    191  1.1  reinoud 
    192  1.1  reinoud 	/* initialise the card */
    193  1.1  reinoud /*	*rp->term = 0;*/
    194  1.1  reinoud 	*rp->inten = (PTSC_POLL?0:1);
    195  1.1  reinoud 	*rp->led = 0;
    196  1.1  reinoud 
    197  1.1  reinoud #if PTSC_POLL == 0
    198  1.1  reinoud 	evcnt_attach_dynamic(&sc->sc_softc.sc_intrcnt, EVCNT_TYPE_INTR, NULL,
    199  1.1  reinoud 	    dp->dv_xname, "intr");
    200  1.1  reinoud 	sc->sc_softc.sc_ih = podulebus_irq_establish(pa->pa_ih, IPL_BIO,
    201  1.1  reinoud 	    ptsc_intr, &sc->sc_softc, &sc->sc_softc.sc_intrcnt);
    202  1.1  reinoud 	if (sc->sc_softc.sc_ih == NULL)
    203  1.4   provos 	    panic("%s: Cannot install IRQ handler", dp->dv_xname);
    204  1.1  reinoud #else
    205  1.1  reinoud 	printf(" polling");
    206  1.3    bjh21 	sc->sc_softc.sc_adapter.adapt_flags = SCSIPI_ADAPT_POLL_ONLY;
    207  1.1  reinoud #endif
    208  1.1  reinoud 
    209  1.1  reinoud 	printf("\n");
    210  1.1  reinoud 
    211  1.1  reinoud 	/* attach all scsi units on us */
    212  1.1  reinoud 	config_found(dp, &sc->sc_softc.sc_channel, scsiprint);
    213  1.1  reinoud }
    214  1.1  reinoud 
    215  1.1  reinoud 
    216  1.1  reinoud int
    217  1.1  reinoud ptsc_intr(arg)
    218  1.1  reinoud 	void *arg;
    219  1.1  reinoud {
    220  1.1  reinoud 	struct sfas_softc *dev = arg;
    221  1.1  reinoud 	ptsc_regmap_p	      rp;
    222  1.1  reinoud 	int		      quickints;
    223  1.1  reinoud 
    224  1.1  reinoud 	rp = (ptsc_regmap_p)dev->sc_fas;
    225  1.1  reinoud 
    226  1.1  reinoud 	if (*rp->FAS216.sfas_status & SFAS_STAT_INTERRUPT_PENDING) {
    227  1.1  reinoud 		quickints = 16;
    228  1.1  reinoud 		do {
    229  1.1  reinoud 			dev->sc_status = *rp->FAS216.sfas_status;
    230  1.1  reinoud 			dev->sc_interrupt = *rp->FAS216.sfas_interrupt;
    231  1.1  reinoud 
    232  1.1  reinoud 			if (dev->sc_interrupt & SFAS_INT_RESELECTED) {
    233  1.1  reinoud 				dev->sc_resel[0] = *rp->FAS216.sfas_fifo;
    234  1.1  reinoud 				dev->sc_resel[1] = *rp->FAS216.sfas_fifo;
    235  1.1  reinoud 			}
    236  1.1  reinoud 
    237  1.1  reinoud 			sfasintr(dev);
    238  1.1  reinoud 
    239  1.1  reinoud 		} while((*rp->FAS216.sfas_status & SFAS_STAT_INTERRUPT_PENDING)
    240  1.1  reinoud 			&& --quickints);
    241  1.1  reinoud 	}
    242  1.1  reinoud 
    243  1.1  reinoud 	return(0);	/* Pass interrupt on down the chain */
    244  1.1  reinoud }
    245  1.1  reinoud 
    246  1.1  reinoud /* Load transfer address into dma register */
    247  1.1  reinoud void
    248  1.1  reinoud ptsc_set_dma_adr(sc, ptr)
    249  1.1  reinoud 	struct sfas_softc *sc;
    250  1.1  reinoud 	void		 *ptr;
    251  1.1  reinoud {
    252  1.1  reinoud #if 0
    253  1.1  reinoud 	ptsc_regmap_p	rp;
    254  1.1  reinoud 	unsigned int   *p;
    255  1.1  reinoud 	unsigned int	d;
    256  1.1  reinoud #endif
    257  1.1  reinoud #if 0
    258  1.1  reinoud 	printf("ptsc_set_dma_adr(sc = 0x%08x, ptr = 0x%08x)\n", (u_int)sc, (u_int)ptr);
    259  1.1  reinoud #endif
    260  1.1  reinoud 	return;
    261  1.1  reinoud #if 0
    262  1.1  reinoud 	rp = (ptsc_regmap_p)sc->sc_fas;
    263  1.1  reinoud 
    264  1.1  reinoud 	d = (unsigned int)ptr;
    265  1.1  reinoud 	p = (unsigned int *)((d & 0xFFFFFF) + (int)rp->dmabase);
    266  1.1  reinoud 
    267  1.1  reinoud 	*rp->clear=0;
    268  1.1  reinoud 	*p = d;
    269  1.1  reinoud #endif
    270  1.1  reinoud }
    271  1.1  reinoud 
    272  1.1  reinoud /* Set DMA transfer counter */
    273  1.1  reinoud void
    274  1.1  reinoud ptsc_set_dma_tc(sc, len)
    275  1.1  reinoud 	struct sfas_softc *sc;
    276  1.1  reinoud 	unsigned int	  len;
    277  1.1  reinoud {
    278  1.1  reinoud 	printf("ptsc_set_dma_tc(sc, len = 0x%08x)", len);
    279  1.1  reinoud 
    280  1.1  reinoud 	*sc->sc_fas->sfas_tc_low  = len; len >>= 8;
    281  1.1  reinoud 	*sc->sc_fas->sfas_tc_mid  = len; len >>= 8;
    282  1.1  reinoud 	*sc->sc_fas->sfas_tc_high = len;
    283  1.1  reinoud }
    284  1.1  reinoud 
    285  1.1  reinoud /* Set DMA mode */
    286  1.1  reinoud void
    287  1.1  reinoud ptsc_set_dma_mode(sc, mode)
    288  1.1  reinoud 	struct sfas_softc *sc;
    289  1.1  reinoud 	int		  mode;
    290  1.1  reinoud {
    291  1.1  reinoud #if 0
    292  1.1  reinoud 	struct csc_specific *spec;
    293  1.1  reinoud 
    294  1.1  reinoud 	spec = sc->sc_spec;
    295  1.1  reinoud 
    296  1.1  reinoud 	spec->portbits = (spec->portbits & ~FLSC_PB_DMA_BITS) | mode;
    297  1.1  reinoud 	*((flsc_regmap_p)sc->sc_fas)->hardbits = spec->portbits;
    298  1.1  reinoud #endif
    299  1.1  reinoud }
    300  1.1  reinoud 
    301  1.1  reinoud /* Initialize DMA for transfer */
    302  1.1  reinoud int
    303  1.1  reinoud ptsc_setup_dma(sc, ptr, len, mode)
    304  1.1  reinoud 	struct sfas_softc *sc;
    305  1.1  reinoud 	void		 *ptr;
    306  1.1  reinoud 	int		  len;
    307  1.1  reinoud 	int		  mode;
    308  1.1  reinoud {
    309  1.1  reinoud 	int	retval;
    310  1.1  reinoud 
    311  1.1  reinoud 	retval = 0;
    312  1.1  reinoud 
    313  1.1  reinoud #if 0
    314  1.1  reinoud 	printf("ptsc_setup_dma(sc, ptr = 0x%08x, len = 0x%08x, mode = 0x%08x)\n", (u_int)ptr, len, mode);
    315  1.1  reinoud #endif
    316  1.1  reinoud 	return(0);
    317  1.1  reinoud 
    318  1.1  reinoud #if 0
    319  1.1  reinoud 	switch(mode) {
    320  1.1  reinoud 	case SFAS_DMA_READ:
    321  1.1  reinoud 	case SFAS_DMA_WRITE:
    322  1.1  reinoud 		flsc_set_dma_adr(sc, ptr);
    323  1.1  reinoud 		if (mode == SFAS_DMA_READ)
    324  1.1  reinoud 		  flsc_set_dma_mode(sc,FLSC_PB_ENABLE_DMA | FLSC_PB_DMA_READ);
    325  1.1  reinoud 		else
    326  1.1  reinoud 		  flsc_set_dma_mode(sc,FLSC_PB_ENABLE_DMA | FLSC_PB_DMA_WRITE);
    327  1.1  reinoud 
    328  1.1  reinoud 		flsc_set_dma_tc(sc, len);
    329  1.1  reinoud 		break;
    330  1.1  reinoud 
    331  1.1  reinoud 	case SFAS_DMA_CLEAR:
    332  1.1  reinoud 	default:
    333  1.1  reinoud 		flsc_set_dma_mode(sc, FLSC_PB_DISABLE_DMA);
    334  1.1  reinoud 		flsc_set_dma_adr(sc, 0);
    335  1.1  reinoud 
    336  1.1  reinoud 		retval = (*sc->sc_fas->sfas_tc_high << 16) |
    337  1.1  reinoud 			 (*sc->sc_fas->sfas_tc_mid  <<  8) |
    338  1.1  reinoud 			  *sc->sc_fas->sfas_tc_low;
    339  1.1  reinoud 
    340  1.1  reinoud 		flsc_set_dma_tc(sc, 0);
    341  1.1  reinoud 		break;
    342  1.1  reinoud 	}
    343  1.1  reinoud 
    344  1.1  reinoud 	return(retval);
    345  1.1  reinoud #endif
    346  1.1  reinoud }
    347  1.1  reinoud 
    348  1.1  reinoud /* Check if address and len is ok for DMA transfer */
    349  1.1  reinoud int
    350  1.1  reinoud ptsc_need_bump(sc, ptr, len)
    351  1.1  reinoud 	struct sfas_softc *sc;
    352  1.1  reinoud 	void		 *ptr;
    353  1.1  reinoud 	int		  len;
    354  1.1  reinoud {
    355  1.1  reinoud 	int	p;
    356  1.1  reinoud 
    357  1.1  reinoud 	p = (int)ptr & 0x03;
    358  1.1  reinoud 
    359  1.1  reinoud 	if (p) {
    360  1.1  reinoud 		p = 4-p;
    361  1.1  reinoud 
    362  1.1  reinoud 		if (len < 256)
    363  1.1  reinoud 			p = len;
    364  1.1  reinoud 	}
    365  1.1  reinoud 
    366  1.1  reinoud 	return(p);
    367  1.1  reinoud }
    368  1.1  reinoud 
    369  1.1  reinoud /* Interrupt driven routines */
    370  1.1  reinoud int
    371  1.1  reinoud ptsc_build_dma_chain(sc, chain, p, l)
    372  1.1  reinoud 	struct sfas_softc	*sc;
    373  1.1  reinoud 	struct sfas_dma_chain	*chain;
    374  1.1  reinoud 	void			*p;
    375  1.1  reinoud 	int			 l;
    376  1.1  reinoud {
    377  1.1  reinoud #if 0
    378  1.1  reinoud 	vm_offset_t  pa, lastpa;
    379  1.1  reinoud 	char	    *ptr;
    380  1.1  reinoud 	int	     len, prelen, postlen, max_t, n;
    381  1.1  reinoud #endif
    382  1.1  reinoud #if 0
    383  1.1  reinoud 	printf("ptsc_build_dma_chain()\n");
    384  1.1  reinoud #endif
    385  1.1  reinoud 	return(0);
    386  1.1  reinoud 
    387  1.1  reinoud #if 0
    388  1.1  reinoud 	if (l == 0)
    389  1.1  reinoud 		return(0);
    390  1.1  reinoud 
    391  1.1  reinoud #define set_link(n, p, l, f)\
    392  1.1  reinoud do { chain[n].ptr = (p); chain[n].len = (l); chain[n++].flg = (f); } while(0)
    393  1.1  reinoud 
    394  1.1  reinoud 	n = 0;
    395  1.1  reinoud 
    396  1.1  reinoud 	if (l < 512)
    397  1.1  reinoud 		set_link(n, (vm_offset_t)p, l, SFAS_CHAIN_BUMP);
    398  1.1  reinoud 	else if (p >= (void *)0xFF000000) {
    399  1.1  reinoud 		while(l != 0) {
    400  1.1  reinoud 			len = ((l > sc->sc_bump_sz) ? sc->sc_bump_sz : l);
    401  1.1  reinoud 
    402  1.1  reinoud 			set_link(n, (vm_offset_t)p, len, SFAS_CHAIN_BUMP);
    403  1.1  reinoud 
    404  1.1  reinoud 			p += len;
    405  1.1  reinoud 			l -= len;
    406  1.1  reinoud 		}
    407  1.1  reinoud 	} else {
    408  1.1  reinoud 		ptr = p;
    409  1.1  reinoud 		len = l;
    410  1.1  reinoud 
    411  1.1  reinoud 		pa = kvtop(ptr);
    412  1.1  reinoud 		prelen = ((int)ptr & 0x03);
    413  1.1  reinoud 
    414  1.1  reinoud 		if (prelen) {
    415  1.1  reinoud 			prelen = 4-prelen;
    416  1.1  reinoud 			set_link(n, (vm_offset_t)ptr, prelen, SFAS_CHAIN_BUMP);
    417  1.1  reinoud 			ptr += prelen;
    418  1.1  reinoud 			len -= prelen;
    419  1.1  reinoud 		}
    420  1.1  reinoud 
    421  1.1  reinoud 		lastpa = 0;
    422  1.1  reinoud 		while(len > 3) {
    423  1.1  reinoud 			pa = kvtop(ptr);
    424  1.1  reinoud 			max_t = NBPG - (pa & PGOFSET);
    425  1.1  reinoud 			if (max_t > len)
    426  1.1  reinoud 			  max_t = len;
    427  1.1  reinoud 
    428  1.1  reinoud 			max_t &= ~3;
    429  1.1  reinoud 
    430  1.1  reinoud 			if (lastpa == pa)
    431  1.1  reinoud 				sc->sc_chain[n-1].len += max_t;
    432  1.1  reinoud 			else
    433  1.1  reinoud 				set_link(n, pa, max_t, SFAS_CHAIN_DMA);
    434  1.1  reinoud 
    435  1.1  reinoud 			lastpa = pa+max_t;
    436  1.1  reinoud 
    437  1.1  reinoud 			ptr += max_t;
    438  1.1  reinoud 			len -= max_t;
    439  1.1  reinoud 		}
    440  1.1  reinoud 
    441  1.1  reinoud 		if (len)
    442  1.1  reinoud 			set_link(n, (vm_offset_t)ptr, len, SFAS_CHAIN_BUMP);
    443  1.1  reinoud 	}
    444  1.1  reinoud 
    445  1.1  reinoud 	return(n);
    446  1.1  reinoud #endif
    447  1.1  reinoud }
    448  1.1  reinoud 
    449  1.1  reinoud /* Turn on/off led */
    450  1.1  reinoud void
    451  1.1  reinoud ptsc_led(sc, mode)
    452  1.1  reinoud 	struct sfas_softc *sc;
    453  1.1  reinoud 	int		  mode;
    454  1.1  reinoud {
    455  1.1  reinoud 	ptsc_regmap_p		rp;
    456  1.1  reinoud 
    457  1.1  reinoud 	rp = (ptsc_regmap_p)sc->sc_fas;
    458  1.1  reinoud 
    459  1.1  reinoud 	if (mode) {
    460  1.1  reinoud 		sc->sc_led_status++;
    461  1.1  reinoud 	} else {
    462  1.1  reinoud 		if (sc->sc_led_status)
    463  1.1  reinoud 			sc->sc_led_status--;
    464  1.1  reinoud 	}
    465  1.1  reinoud 	*rp->led = (sc->sc_led_status?1:0);
    466  1.1  reinoud }
    467