Home | History | Annotate | Line # | Download | only in dev
flsc.c revision 1.5
      1  1.5    veego /*	$NetBSD: flsc.c,v 1.5 1996/04/21 21:11:03 veego Exp $	*/
      2  1.5    veego 
      3  1.1   chopps /*
      4  1.1   chopps  * Copyright (c) 1995 Daniel Widenfalk
      5  1.1   chopps  * Copyright (c) 1994 Christian E. Hopps
      6  1.1   chopps  * Copyright (c) 1982, 1990 The Regents of the University of California.
      7  1.1   chopps  * All rights reserved.
      8  1.1   chopps  *
      9  1.1   chopps  * Redistribution and use in source and binary forms, with or without
     10  1.1   chopps  * modification, are permitted provided that the following conditions
     11  1.1   chopps  * are met:
     12  1.1   chopps  * 1. Redistributions of source code must retain the above copyright
     13  1.1   chopps  *    notice, this list of conditions and the following disclaimer.
     14  1.1   chopps  * 2. Redistributions in binary form must reproduce the above copyright
     15  1.1   chopps  *    notice, this list of conditions and the following disclaimer in the
     16  1.1   chopps  *    documentation and/or other materials provided with the distribution.
     17  1.1   chopps  * 3. All advertising materials mentioning features or use of this software
     18  1.1   chopps  *    must display the following acknowledgement:
     19  1.1   chopps  *	This product includes software developed by the University of
     20  1.1   chopps  *	California, Berkeley and its contributors.
     21  1.1   chopps  * 4. Neither the name of the University nor the names of its contributors
     22  1.1   chopps  *    may be used to endorse or promote products derived from this software
     23  1.1   chopps  *    without specific prior written permission.
     24  1.1   chopps  *
     25  1.1   chopps  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     26  1.1   chopps  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     27  1.1   chopps  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     28  1.1   chopps  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     29  1.1   chopps  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     30  1.1   chopps  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     31  1.1   chopps  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     32  1.1   chopps  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     33  1.1   chopps  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     34  1.1   chopps  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     35  1.1   chopps  * SUCH DAMAGE.
     36  1.1   chopps  *
     37  1.1   chopps  *	@(#)dma.c
     38  1.1   chopps  */
     39  1.1   chopps 
     40  1.1   chopps #include <sys/param.h>
     41  1.1   chopps #include <sys/systm.h>
     42  1.1   chopps #include <sys/kernel.h>
     43  1.1   chopps #include <sys/device.h>
     44  1.1   chopps #include <scsi/scsi_all.h>
     45  1.1   chopps #include <scsi/scsiconf.h>
     46  1.1   chopps #include <vm/vm.h>
     47  1.1   chopps #include <vm/vm_kern.h>
     48  1.1   chopps #include <vm/vm_page.h>
     49  1.1   chopps #include <machine/pmap.h>
     50  1.1   chopps #include <amiga/amiga/custom.h>
     51  1.1   chopps #include <amiga/amiga/cc.h>
     52  1.1   chopps #include <amiga/amiga/device.h>
     53  1.1   chopps #include <amiga/amiga/isr.h>
     54  1.1   chopps #include <amiga/dev/sfasreg.h>
     55  1.1   chopps #include <amiga/dev/sfasvar.h>
     56  1.1   chopps #include <amiga/dev/zbusvar.h>
     57  1.1   chopps #include <amiga/dev/flscreg.h>
     58  1.1   chopps #include <amiga/dev/flscvar.h>
     59  1.1   chopps 
     60  1.1   chopps int  flscprint  __P((void *auxp, char *));
     61  1.1   chopps void flscattach __P((struct device *, struct device *, void *));
     62  1.3  thorpej int  flscmatch  __P((struct device *, void *, void *));
     63  1.1   chopps 
     64  1.1   chopps struct scsi_adapter flsc_scsiswitch = {
     65  1.1   chopps 	sfas_scsicmd,
     66  1.1   chopps 	sfas_minphys,
     67  1.1   chopps 	0,			/* no lun support */
     68  1.1   chopps 	0,			/* no lun support */
     69  1.1   chopps };
     70  1.1   chopps 
     71  1.1   chopps struct scsi_device flsc_scsidev = {
     72  1.1   chopps 	NULL,		/* use default error handler */
     73  1.1   chopps 	NULL,		/* do not have a start functio */
     74  1.1   chopps 	NULL,		/* have no async handler */
     75  1.1   chopps 	NULL,		/* Use default done routine */
     76  1.1   chopps };
     77  1.1   chopps 
     78  1.3  thorpej struct cfattach flsc_ca = {
     79  1.3  thorpej 	sizeof(struct flsc_softc), flscmatch, flscattach
     80  1.3  thorpej };
     81  1.1   chopps 
     82  1.3  thorpej struct cfdriver flsc_cd = {
     83  1.3  thorpej 	NULL, "flsc", DV_DULL, NULL, 0
     84  1.3  thorpej };
     85  1.1   chopps 
     86  1.5    veego int flsc_intr		 __P((void *));
     87  1.5    veego void flsc_set_dma_adr	 __P((struct sfas_softc *sc, vm_offset_t ptr));
     88  1.5    veego void flsc_set_dma_tc	 __P((struct sfas_softc *sc, unsigned int len));
     89  1.5    veego void flsc_set_dma_mode	 __P((struct sfas_softc *sc, int mode));
     90  1.5    veego int flsc_setup_dma	 __P((struct sfas_softc *sc, vm_offset_t ptr, int len,
     91  1.1   chopps 			      int mode));
     92  1.1   chopps int flsc_build_dma_chain __P((struct sfas_softc *sc,
     93  1.1   chopps 			      struct sfas_dma_chain *chain, void *p, int l));
     94  1.5    veego int flsc_need_bump	 __P((struct sfas_softc *sc, vm_offset_t ptr, int len));
     95  1.1   chopps void flsc_led		 __P((struct sfas_softc *sc, int mode));
     96  1.1   chopps 
     97  1.1   chopps /*
     98  1.1   chopps  * if we are an Advanced Systems & Software FastlaneZ3
     99  1.1   chopps  */
    100  1.1   chopps int
    101  1.4   mhitch flscmatch(pdp, match, auxp)
    102  1.1   chopps 	struct device	*pdp;
    103  1.3  thorpej 	void		*match, *auxp;
    104  1.1   chopps {
    105  1.1   chopps 	struct zbus_args *zap;
    106  1.1   chopps 
    107  1.1   chopps 	if (!is_a4000() && !is_a3000())
    108  1.1   chopps 		return(0);
    109  1.1   chopps 
    110  1.1   chopps 	zap = auxp;
    111  1.1   chopps 	if (zap->manid == 0x2140 && zap->prodid == 11)
    112  1.1   chopps 		return(1);
    113  1.1   chopps 
    114  1.1   chopps 	return(0);
    115  1.1   chopps }
    116  1.1   chopps 
    117  1.1   chopps void
    118  1.1   chopps flscattach(pdp, dp, auxp)
    119  1.1   chopps 	struct device	*pdp;
    120  1.1   chopps 	struct device	*dp;
    121  1.1   chopps 	void		*auxp;
    122  1.1   chopps {
    123  1.1   chopps 	struct flsc_softc *sc;
    124  1.1   chopps 	struct zbus_args  *zap;
    125  1.1   chopps 	flsc_regmap_p	   rp;
    126  1.1   chopps 	vu_char		  *fas;
    127  1.1   chopps 
    128  1.1   chopps 	zap = auxp;
    129  1.1   chopps 	fas = &((vu_char *)zap->va)[0x1000001];
    130  1.1   chopps 
    131  1.1   chopps 	sc = (struct flsc_softc *)dp;
    132  1.1   chopps 	rp = &sc->sc_regmap;
    133  1.1   chopps 
    134  1.1   chopps 	rp->FAS216.sfas_tc_low	= &fas[0x00];
    135  1.1   chopps 	rp->FAS216.sfas_tc_mid	= &fas[0x04];
    136  1.1   chopps 	rp->FAS216.sfas_fifo	= &fas[0x08];
    137  1.1   chopps 	rp->FAS216.sfas_command	= &fas[0x0C];
    138  1.1   chopps 	rp->FAS216.sfas_dest_id	= &fas[0x10];
    139  1.1   chopps 	rp->FAS216.sfas_timeout	= &fas[0x14];
    140  1.1   chopps 	rp->FAS216.sfas_syncper	= &fas[0x18];
    141  1.1   chopps 	rp->FAS216.sfas_syncoff	= &fas[0x1C];
    142  1.1   chopps 	rp->FAS216.sfas_config1	= &fas[0x20];
    143  1.1   chopps 	rp->FAS216.sfas_clkconv	= &fas[0x24];
    144  1.1   chopps 	rp->FAS216.sfas_test	= &fas[0x28];
    145  1.1   chopps 	rp->FAS216.sfas_config2	= &fas[0x2C];
    146  1.1   chopps 	rp->FAS216.sfas_config3	= &fas[0x30];
    147  1.1   chopps 	rp->FAS216.sfas_tc_high	= &fas[0x38];
    148  1.1   chopps 	rp->FAS216.sfas_fifo_bot = &fas[0x3C];
    149  1.1   chopps 	rp->hardbits		= &fas[0x40];
    150  1.1   chopps 	rp->clear		= &fas[0x80];
    151  1.1   chopps 	rp->dmabase		= zap->va;
    152  1.1   chopps 
    153  1.1   chopps 	sc->sc_softc.sc_fas	= (sfas_regmap_p)rp;
    154  1.1   chopps 	sc->sc_softc.sc_spec	= &sc->sc_specific;
    155  1.1   chopps 
    156  1.1   chopps 	sc->sc_softc.sc_led	= flsc_led;
    157  1.1   chopps 
    158  1.1   chopps 	sc->sc_softc.sc_setup_dma	= flsc_setup_dma;
    159  1.1   chopps 	sc->sc_softc.sc_build_dma_chain = flsc_build_dma_chain;
    160  1.1   chopps 	sc->sc_softc.sc_need_bump	= flsc_need_bump;
    161  1.1   chopps 
    162  1.1   chopps 	sc->sc_softc.sc_clock_freq   = 40;   /* FastlaneZ3 runs at 40MHz */
    163  1.1   chopps 	sc->sc_softc.sc_timeout      = 250;  /* Set default timeout to 250ms */
    164  1.1   chopps 	sc->sc_softc.sc_config_flags = 0;    /* No config flags yet */
    165  1.1   chopps 	sc->sc_softc.sc_host_id      = 7;    /* Should check the jumpers */
    166  1.1   chopps 
    167  1.1   chopps 	sc->sc_specific.portbits = 0xA0 | FLSC_PB_EDI | FLSC_PB_ESI;
    168  1.1   chopps 	sc->sc_specific.hardbits = *rp->hardbits;
    169  1.1   chopps 
    170  1.1   chopps 	sc->sc_softc.sc_bump_sz = NBPG;
    171  1.1   chopps 	sc->sc_softc.sc_bump_pa = 0x0;
    172  1.1   chopps 
    173  1.1   chopps 	sfasinitialize((struct sfas_softc *)sc);
    174  1.1   chopps 
    175  1.1   chopps 	sc->sc_softc.sc_link.adapter_softc  = sc;
    176  1.1   chopps 	sc->sc_softc.sc_link.adapter_target = sc->sc_softc.sc_host_id;
    177  1.1   chopps 	sc->sc_softc.sc_link.adapter	    = &flsc_scsiswitch;
    178  1.1   chopps 	sc->sc_softc.sc_link.device	    = &flsc_scsidev;
    179  1.1   chopps 	sc->sc_softc.sc_link.openings	    = 1;
    180  1.1   chopps 
    181  1.1   chopps 	sc->sc_softc.sc_isr.isr_intr = flsc_intr;
    182  1.1   chopps 	sc->sc_softc.sc_isr.isr_arg  = &sc->sc_softc;
    183  1.1   chopps 	sc->sc_softc.sc_isr.isr_ipl  = 2;
    184  1.1   chopps 	add_isr(&sc->sc_softc.sc_isr);
    185  1.1   chopps 
    186  1.1   chopps /* We don't want interrupt until we're initialized! */
    187  1.1   chopps 	*rp->hardbits = sc->sc_specific.portbits;
    188  1.1   chopps 
    189  1.1   chopps 	printf("\n");
    190  1.1   chopps 
    191  1.1   chopps /* attach all scsi units on us */
    192  1.1   chopps 	config_found(dp, &sc->sc_softc.sc_link, flscprint);
    193  1.1   chopps }
    194  1.1   chopps 
    195  1.1   chopps /* print diag if pnp is NULL else just extra */
    196  1.1   chopps int
    197  1.1   chopps flscprint(auxp, pnp)
    198  1.1   chopps 	void *auxp;
    199  1.1   chopps 	char *pnp;
    200  1.1   chopps {
    201  1.1   chopps 	if (pnp == NULL)
    202  1.1   chopps 		return(UNCONF);
    203  1.1   chopps 
    204  1.1   chopps 	return(QUIET);
    205  1.1   chopps }
    206  1.1   chopps 
    207  1.1   chopps int
    208  1.5    veego flsc_intr(arg)
    209  1.5    veego 	void *arg;
    210  1.1   chopps {
    211  1.5    veego 	struct sfas_softc *dev = arg;
    212  1.1   chopps 	flsc_regmap_p	      rp;
    213  1.1   chopps 	struct flsc_specific *flspec;
    214  1.1   chopps 	int		      quickints;
    215  1.1   chopps 	u_char		      hb;
    216  1.1   chopps 
    217  1.1   chopps 	flspec = dev->sc_spec;
    218  1.1   chopps 	rp = (flsc_regmap_p)dev->sc_fas;
    219  1.1   chopps 	hb = *rp->hardbits;
    220  1.1   chopps 
    221  1.1   chopps 	if (hb & FLSC_HB_IACT)
    222  1.1   chopps 		return(0);
    223  1.1   chopps 
    224  1.1   chopps 	flspec->hardbits = hb;
    225  1.1   chopps 	if ((hb & FLSC_HB_CREQ) &&
    226  1.1   chopps 	    !(hb & FLSC_HB_MINT) &&
    227  1.1   chopps 	    (*rp->FAS216.sfas_status & SFAS_STAT_INTERRUPT_PENDING)) {
    228  1.1   chopps 		quickints = 16;
    229  1.1   chopps 		do {
    230  1.1   chopps 			dev->sc_status = *rp->FAS216.sfas_status;
    231  1.1   chopps 			dev->sc_interrupt = *rp->FAS216.sfas_interrupt;
    232  1.1   chopps 
    233  1.1   chopps 			if (dev->sc_interrupt & SFAS_INT_RESELECTED) {
    234  1.1   chopps 				dev->sc_resel[0] = *rp->FAS216.sfas_fifo;
    235  1.1   chopps 				dev->sc_resel[1] = *rp->FAS216.sfas_fifo;
    236  1.1   chopps 			}
    237  1.1   chopps 			sfasintr(dev);
    238  1.1   chopps 
    239  1.1   chopps 		} while((*rp->FAS216.sfas_status & SFAS_STAT_INTERRUPT_PENDING)
    240  1.1   chopps 			&& --quickints);
    241  1.1   chopps 	}
    242  1.1   chopps 
    243  1.1   chopps 	/* Reset fastlane interrupt bits */
    244  1.1   chopps 	*rp->hardbits = flspec->portbits & ~FLSC_PB_INT_BITS;
    245  1.1   chopps 	*rp->hardbits = flspec->portbits;
    246  1.1   chopps 
    247  1.1   chopps 	return(1);
    248  1.1   chopps }
    249  1.1   chopps 
    250  1.1   chopps /* Load transfer adress into dma register */
    251  1.1   chopps void
    252  1.1   chopps flsc_set_dma_adr(sc, ptr)
    253  1.1   chopps 	struct sfas_softc *sc;
    254  1.5    veego 	vm_offset_t	  ptr;
    255  1.1   chopps {
    256  1.1   chopps 	flsc_regmap_p	rp;
    257  1.1   chopps 	unsigned int   *p;
    258  1.1   chopps 	unsigned int	d;
    259  1.1   chopps 
    260  1.1   chopps 	rp = (flsc_regmap_p)sc->sc_fas;
    261  1.1   chopps 
    262  1.1   chopps 	d = (unsigned int)ptr;
    263  1.1   chopps 	p = (unsigned int *)((d & 0xFFFFFF) + (int)rp->dmabase);
    264  1.1   chopps 
    265  1.1   chopps 	*rp->clear=0;
    266  1.1   chopps 	*p = d;
    267  1.1   chopps }
    268  1.1   chopps 
    269  1.1   chopps /* Set DMA transfer counter */
    270  1.1   chopps void
    271  1.1   chopps flsc_set_dma_tc(sc, len)
    272  1.1   chopps 	struct sfas_softc *sc;
    273  1.1   chopps 	unsigned int	  len;
    274  1.1   chopps {
    275  1.1   chopps 	*sc->sc_fas->sfas_tc_low  = len; len >>= 8;
    276  1.1   chopps 	*sc->sc_fas->sfas_tc_mid  = len; len >>= 8;
    277  1.1   chopps 	*sc->sc_fas->sfas_tc_high = len;
    278  1.1   chopps }
    279  1.1   chopps 
    280  1.1   chopps /* Set DMA mode */
    281  1.1   chopps void
    282  1.1   chopps flsc_set_dma_mode(sc, mode)
    283  1.1   chopps 	struct sfas_softc *sc;
    284  1.1   chopps 	int		  mode;
    285  1.1   chopps {
    286  1.1   chopps 	struct flsc_specific *spec;
    287  1.1   chopps 
    288  1.1   chopps 	spec = sc->sc_spec;
    289  1.1   chopps 
    290  1.1   chopps 	spec->portbits = (spec->portbits & ~FLSC_PB_DMA_BITS) | mode;
    291  1.1   chopps 	*((flsc_regmap_p)sc->sc_fas)->hardbits = spec->portbits;
    292  1.1   chopps }
    293  1.1   chopps 
    294  1.1   chopps /* Initialize DMA for transfer */
    295  1.1   chopps int
    296  1.1   chopps flsc_setup_dma(sc, ptr, len, mode)
    297  1.1   chopps 	struct sfas_softc *sc;
    298  1.5    veego 	vm_offset_t	  ptr;
    299  1.1   chopps 	int		  len;
    300  1.1   chopps 	int		  mode;
    301  1.1   chopps {
    302  1.1   chopps 	int	retval;
    303  1.1   chopps 
    304  1.1   chopps 	retval = 0;
    305  1.1   chopps 
    306  1.1   chopps 	switch(mode) {
    307  1.1   chopps 	case SFAS_DMA_READ:
    308  1.1   chopps 	case SFAS_DMA_WRITE:
    309  1.1   chopps 		flsc_set_dma_adr(sc, ptr);
    310  1.1   chopps 		if (mode == SFAS_DMA_READ)
    311  1.1   chopps 		  flsc_set_dma_mode(sc,FLSC_PB_ENABLE_DMA | FLSC_PB_DMA_READ);
    312  1.1   chopps 		else
    313  1.1   chopps 		  flsc_set_dma_mode(sc,FLSC_PB_ENABLE_DMA | FLSC_PB_DMA_WRITE);
    314  1.1   chopps 
    315  1.1   chopps 		flsc_set_dma_tc(sc, len);
    316  1.1   chopps 		break;
    317  1.1   chopps 
    318  1.1   chopps 	case SFAS_DMA_CLEAR:
    319  1.1   chopps 	default:
    320  1.1   chopps 		flsc_set_dma_mode(sc, FLSC_PB_DISABLE_DMA);
    321  1.1   chopps 		flsc_set_dma_adr(sc, 0);
    322  1.1   chopps 
    323  1.1   chopps 		retval = (*sc->sc_fas->sfas_tc_high << 16) |
    324  1.1   chopps 			 (*sc->sc_fas->sfas_tc_mid  <<  8) |
    325  1.1   chopps 			  *sc->sc_fas->sfas_tc_low;
    326  1.1   chopps 
    327  1.1   chopps 		flsc_set_dma_tc(sc, 0);
    328  1.1   chopps 		break;
    329  1.1   chopps 	}
    330  1.1   chopps 
    331  1.1   chopps 	return(retval);
    332  1.1   chopps }
    333  1.1   chopps 
    334  1.1   chopps /* Check if address and len is ok for DMA transfer */
    335  1.1   chopps int
    336  1.1   chopps flsc_need_bump(sc, ptr, len)
    337  1.1   chopps 	struct sfas_softc *sc;
    338  1.5    veego 	vm_offset_t	  ptr;
    339  1.1   chopps 	int		  len;
    340  1.1   chopps {
    341  1.1   chopps 	int	p;
    342  1.1   chopps 
    343  1.1   chopps 	p = (int)ptr & 0x03;
    344  1.1   chopps 
    345  1.1   chopps 	if (p) {
    346  1.1   chopps 		p = 4-p;
    347  1.1   chopps 
    348  1.1   chopps 		if (len < 256)
    349  1.1   chopps 			p = len;
    350  1.1   chopps 	}
    351  1.1   chopps 
    352  1.1   chopps 	return(p);
    353  1.1   chopps }
    354  1.1   chopps 
    355  1.1   chopps /* Interrupt driven routines */
    356  1.1   chopps int
    357  1.1   chopps flsc_build_dma_chain(sc, chain, p, l)
    358  1.1   chopps 	struct sfas_softc	*sc;
    359  1.1   chopps 	struct sfas_dma_chain	*chain;
    360  1.1   chopps 	void			*p;
    361  1.1   chopps 	int			 l;
    362  1.1   chopps {
    363  1.1   chopps 	vm_offset_t  pa, lastpa;
    364  1.1   chopps 	char	    *ptr;
    365  1.5    veego 	int	     len, prelen, max_t, n;
    366  1.1   chopps 
    367  1.1   chopps 	if (l == 0)
    368  1.1   chopps 		return(0);
    369  1.1   chopps 
    370  1.1   chopps #define set_link(n, p, l, f)\
    371  1.1   chopps do { chain[n].ptr = (p); chain[n].len = (l); chain[n++].flg = (f); } while(0)
    372  1.1   chopps 
    373  1.1   chopps 	n = 0;
    374  1.1   chopps 
    375  1.1   chopps 	if (l < 512)
    376  1.1   chopps 		set_link(n, (vm_offset_t)p, l, SFAS_CHAIN_BUMP);
    377  1.1   chopps 	else if ((p >= (void *)0xFF000000)
    378  1.1   chopps #if M68040
    379  1.2   chopps 		 && ((mmutype == MMU_68040) && (p >= (void *)0xFFFC0000))
    380  1.1   chopps #endif
    381  1.1   chopps 		 ) {
    382  1.1   chopps 		while(l != 0) {
    383  1.1   chopps 			len = ((l > sc->sc_bump_sz) ? sc->sc_bump_sz : l);
    384  1.1   chopps 
    385  1.1   chopps 			set_link(n, (vm_offset_t)p, len, SFAS_CHAIN_BUMP);
    386  1.1   chopps 
    387  1.1   chopps 			p += len;
    388  1.1   chopps 			l -= len;
    389  1.1   chopps 		}
    390  1.1   chopps 	} else {
    391  1.1   chopps 		ptr = p;
    392  1.1   chopps 		len = l;
    393  1.1   chopps 
    394  1.1   chopps 		pa = kvtop(ptr);
    395  1.1   chopps 		prelen = ((int)ptr & 0x03);
    396  1.1   chopps 
    397  1.1   chopps 		if (prelen) {
    398  1.1   chopps 			prelen = 4-prelen;
    399  1.1   chopps 			set_link(n, (vm_offset_t)ptr, prelen, SFAS_CHAIN_BUMP);
    400  1.1   chopps 			ptr += prelen;
    401  1.1   chopps 			len -= prelen;
    402  1.1   chopps 		}
    403  1.1   chopps 
    404  1.1   chopps 		lastpa = 0;
    405  1.1   chopps 		while(len > 3) {
    406  1.1   chopps 			pa = kvtop(ptr);
    407  1.1   chopps 			max_t = NBPG - (pa & PGOFSET);
    408  1.1   chopps 			if (max_t > len)
    409  1.1   chopps 			  max_t = len;
    410  1.1   chopps 
    411  1.1   chopps 			max_t &= ~3;
    412  1.1   chopps 
    413  1.1   chopps 			if (lastpa == pa)
    414  1.1   chopps 				sc->sc_chain[n-1].len += max_t;
    415  1.1   chopps 			else
    416  1.1   chopps 				set_link(n, pa, max_t, SFAS_CHAIN_DMA);
    417  1.1   chopps 
    418  1.1   chopps 			lastpa = pa+max_t;
    419  1.1   chopps 
    420  1.1   chopps 			ptr += max_t;
    421  1.1   chopps 			len -= max_t;
    422  1.1   chopps 		}
    423  1.1   chopps 
    424  1.1   chopps 		if (len)
    425  1.1   chopps 			set_link(n, (vm_offset_t)ptr, len, SFAS_CHAIN_BUMP);
    426  1.1   chopps 	}
    427  1.1   chopps 
    428  1.1   chopps 	return(n);
    429  1.1   chopps }
    430  1.1   chopps 
    431  1.1   chopps /* Turn on/off led */
    432  1.1   chopps void
    433  1.1   chopps flsc_led(sc, mode)
    434  1.1   chopps 	struct sfas_softc *sc;
    435  1.1   chopps 	int		  mode;
    436  1.1   chopps {
    437  1.1   chopps 	struct flsc_specific   *spec;
    438  1.1   chopps 	flsc_regmap_p		rp;
    439  1.1   chopps 
    440  1.1   chopps 	spec = sc->sc_spec;
    441  1.1   chopps 	rp = (flsc_regmap_p)sc->sc_fas;
    442  1.1   chopps 
    443  1.1   chopps 	if (mode) {
    444  1.1   chopps 		sc->sc_led_status++;
    445  1.1   chopps 
    446  1.1   chopps 		spec->portbits |= FLSC_PB_LED;
    447  1.1   chopps 		*rp->hardbits = spec->portbits;
    448  1.1   chopps 	} else {
    449  1.1   chopps 		if (sc->sc_led_status)
    450  1.1   chopps 			sc->sc_led_status--;
    451  1.1   chopps 
    452  1.1   chopps 		if (!sc->sc_led_status) {
    453  1.1   chopps 			spec->portbits &= ~FLSC_PB_LED;
    454  1.1   chopps 			*rp->hardbits = spec->portbits;
    455  1.1   chopps 		}
    456  1.1   chopps 	}
    457  1.1   chopps }
    458