Home | History | Annotate | Line # | Download | only in common
bus_dma.c revision 1.9
      1  1.9  thorpej /* $NetBSD: bus_dma.c,v 1.9 1998/01/27 02:35:58 thorpej Exp $ */
      2  1.2  thorpej 
      3  1.2  thorpej /*-
      4  1.8  thorpej  * Copyright (c) 1997, 1998 The NetBSD Foundation, Inc.
      5  1.2  thorpej  * All rights reserved.
      6  1.2  thorpej  *
      7  1.2  thorpej  * This code is derived from software contributed to The NetBSD Foundation
      8  1.2  thorpej  * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
      9  1.2  thorpej  * NASA Ames Research Center.
     10  1.2  thorpej  *
     11  1.2  thorpej  * Redistribution and use in source and binary forms, with or without
     12  1.2  thorpej  * modification, are permitted provided that the following conditions
     13  1.2  thorpej  * are met:
     14  1.2  thorpej  * 1. Redistributions of source code must retain the above copyright
     15  1.2  thorpej  *    notice, this list of conditions and the following disclaimer.
     16  1.2  thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     17  1.2  thorpej  *    notice, this list of conditions and the following disclaimer in the
     18  1.2  thorpej  *    documentation and/or other materials provided with the distribution.
     19  1.2  thorpej  * 3. All advertising materials mentioning features or use of this software
     20  1.2  thorpej  *    must display the following acknowledgement:
     21  1.2  thorpej  *	This product includes software developed by the NetBSD
     22  1.2  thorpej  *	Foundation, Inc. and its contributors.
     23  1.2  thorpej  * 4. Neither the name of The NetBSD Foundation nor the names of its
     24  1.2  thorpej  *    contributors may be used to endorse or promote products derived
     25  1.2  thorpej  *    from this software without specific prior written permission.
     26  1.2  thorpej  *
     27  1.2  thorpej  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     28  1.2  thorpej  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     29  1.2  thorpej  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     30  1.2  thorpej  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     31  1.2  thorpej  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32  1.2  thorpej  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33  1.2  thorpej  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34  1.2  thorpej  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35  1.2  thorpej  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36  1.2  thorpej  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37  1.2  thorpej  * POSSIBILITY OF SUCH DAMAGE.
     38  1.2  thorpej  */
     39  1.2  thorpej 
     40  1.2  thorpej #include <sys/cdefs.h>			/* RCS ID & Copyright macro defns */
     41  1.2  thorpej 
     42  1.9  thorpej __KERNEL_RCSID(0, "$NetBSD: bus_dma.c,v 1.9 1998/01/27 02:35:58 thorpej Exp $");
     43  1.2  thorpej 
     44  1.2  thorpej #include <sys/param.h>
     45  1.2  thorpej #include <sys/systm.h>
     46  1.2  thorpej #include <sys/kernel.h>
     47  1.2  thorpej #include <sys/device.h>
     48  1.2  thorpej #include <sys/malloc.h>
     49  1.2  thorpej #include <sys/proc.h>
     50  1.9  thorpej #include <sys/mbuf.h>
     51  1.2  thorpej 
     52  1.2  thorpej #include <vm/vm.h>
     53  1.2  thorpej #include <vm/vm_kern.h>
     54  1.2  thorpej 
     55  1.2  thorpej #define _ALPHA_BUS_DMA_PRIVATE
     56  1.2  thorpej #include <machine/bus.h>
     57  1.3  thorpej #include <machine/intr.h>
     58  1.2  thorpej 
     59  1.9  thorpej int	_bus_dmamap_load_buffer_direct_common __P((bus_dmamap_t,
     60  1.9  thorpej 	    void *, bus_size_t, struct proc *, int, bus_addr_t,
     61  1.9  thorpej 	    vm_offset_t *, int *, int));
     62  1.9  thorpej 
     63  1.2  thorpej /*
     64  1.2  thorpej  * Common function for DMA map creation.  May be called by bus-specific
     65  1.2  thorpej  * DMA map creation functions.
     66  1.2  thorpej  */
     67  1.2  thorpej int
     68  1.2  thorpej _bus_dmamap_create(t, size, nsegments, maxsegsz, boundary, flags, dmamp)
     69  1.2  thorpej 	bus_dma_tag_t t;
     70  1.2  thorpej 	bus_size_t size;
     71  1.2  thorpej 	int nsegments;
     72  1.2  thorpej 	bus_size_t maxsegsz;
     73  1.2  thorpej 	bus_size_t boundary;
     74  1.2  thorpej 	int flags;
     75  1.2  thorpej 	bus_dmamap_t *dmamp;
     76  1.2  thorpej {
     77  1.2  thorpej 	struct alpha_bus_dmamap *map;
     78  1.2  thorpej 	void *mapstore;
     79  1.2  thorpej 	size_t mapsize;
     80  1.2  thorpej 
     81  1.2  thorpej 	/*
     82  1.2  thorpej 	 * Allcoate and initialize the DMA map.  The end of the map
     83  1.2  thorpej 	 * is a variable-sized array of segments, so we allocate enough
     84  1.2  thorpej 	 * room for them in one shot.
     85  1.2  thorpej 	 *
     86  1.2  thorpej 	 * Note we don't preserve the WAITOK or NOWAIT flags.  Preservation
     87  1.2  thorpej 	 * of ALLOCNOW notifes others that we've reserved these resources,
     88  1.2  thorpej 	 * and they are not to be freed.
     89  1.2  thorpej 	 *
     90  1.2  thorpej 	 * The bus_dmamap_t includes one bus_dma_segment_t, hence
     91  1.2  thorpej 	 * the (nsegments - 1).
     92  1.2  thorpej 	 */
     93  1.2  thorpej 	mapsize = sizeof(struct alpha_bus_dmamap) +
     94  1.2  thorpej 	    (sizeof(bus_dma_segment_t) * (nsegments - 1));
     95  1.2  thorpej 	if ((mapstore = malloc(mapsize, M_DEVBUF,
     96  1.2  thorpej 	    (flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK)) == NULL)
     97  1.2  thorpej 		return (ENOMEM);
     98  1.2  thorpej 
     99  1.2  thorpej 	bzero(mapstore, mapsize);
    100  1.2  thorpej 	map = (struct alpha_bus_dmamap *)mapstore;
    101  1.2  thorpej 	map->_dm_size = size;
    102  1.2  thorpej 	map->_dm_segcnt = nsegments;
    103  1.2  thorpej 	map->_dm_maxsegsz = maxsegsz;
    104  1.2  thorpej 	map->_dm_boundary = boundary;
    105  1.2  thorpej 	map->_dm_flags = flags & ~(BUS_DMA_WAITOK|BUS_DMA_NOWAIT);
    106  1.2  thorpej 	map->dm_nsegs = 0;		/* no valid mappings */
    107  1.2  thorpej 
    108  1.2  thorpej 	*dmamp = map;
    109  1.2  thorpej 	return (0);
    110  1.2  thorpej }
    111  1.2  thorpej 
    112  1.2  thorpej /*
    113  1.2  thorpej  * Common function for DMA map destruction.  May be called by bus-specific
    114  1.2  thorpej  * DMA map destruction functions.
    115  1.2  thorpej  */
    116  1.2  thorpej void
    117  1.2  thorpej _bus_dmamap_destroy(t, map)
    118  1.2  thorpej 	bus_dma_tag_t t;
    119  1.2  thorpej 	bus_dmamap_t map;
    120  1.2  thorpej {
    121  1.2  thorpej 
    122  1.2  thorpej 	free(map, M_DEVBUF);
    123  1.2  thorpej }
    124  1.2  thorpej 
    125  1.2  thorpej /*
    126  1.9  thorpej  * Utility function to load a linear buffer.  lastaddrp holds state
    127  1.9  thorpej  * between invocations (for multiple-buffer loads).  segp contains
    128  1.9  thorpej  * the starting segment on entrance, and the ending segment on exit.
    129  1.9  thorpej  * first indicates if this is the first invocation of this function.
    130  1.2  thorpej  */
    131  1.2  thorpej int
    132  1.9  thorpej _bus_dmamap_load_buffer_direct_common(map, buf, buflen, p, flags, wbase,
    133  1.9  thorpej     lastaddrp, segp, first)
    134  1.2  thorpej 	bus_dmamap_t map;
    135  1.2  thorpej 	void *buf;
    136  1.2  thorpej 	bus_size_t buflen;
    137  1.2  thorpej 	struct proc *p;
    138  1.2  thorpej 	int flags;
    139  1.2  thorpej 	bus_addr_t wbase;
    140  1.9  thorpej 	vm_offset_t *lastaddrp;
    141  1.9  thorpej 	int *segp;
    142  1.9  thorpej 	int first;
    143  1.2  thorpej {
    144  1.2  thorpej 	bus_size_t sgsize;
    145  1.2  thorpej 	vm_offset_t curaddr, lastaddr;
    146  1.2  thorpej 	vm_offset_t vaddr = (vm_offset_t)buf;
    147  1.9  thorpej 	int seg;
    148  1.2  thorpej 
    149  1.9  thorpej 	lastaddr = *lastaddrp;
    150  1.2  thorpej 
    151  1.9  thorpej 	for (seg = *segp; buflen > 0 && seg < map->_dm_segcnt; ) {
    152  1.2  thorpej 		/*
    153  1.2  thorpej 		 * Get the physical address for this segment.
    154  1.2  thorpej 		 */
    155  1.2  thorpej 		if (p != NULL)
    156  1.5  thorpej 			curaddr = pmap_extract(p->p_vmspace->vm_map.pmap,
    157  1.5  thorpej 			    vaddr);
    158  1.2  thorpej 		else
    159  1.2  thorpej 			curaddr = vtophys(vaddr);
    160  1.2  thorpej 
    161  1.2  thorpej 		curaddr |= wbase;
    162  1.2  thorpej 
    163  1.2  thorpej 		/*
    164  1.2  thorpej 		 * Compute the segment size, and adjust counts.
    165  1.2  thorpej 		 */
    166  1.2  thorpej 		sgsize = NBPG - ((u_long)vaddr & PGOFSET);
    167  1.2  thorpej 		if (buflen < sgsize)
    168  1.2  thorpej 			sgsize = buflen;
    169  1.2  thorpej 
    170  1.2  thorpej 		/*
    171  1.2  thorpej 		 * Insert chunk into a segment, coalescing with
    172  1.2  thorpej 		 * the previous segment if possible.
    173  1.2  thorpej 		 */
    174  1.2  thorpej 		if (first) {
    175  1.2  thorpej 			map->dm_segs[seg].ds_addr = curaddr;
    176  1.2  thorpej 			map->dm_segs[seg].ds_len = sgsize;
    177  1.2  thorpej 			first = 0;
    178  1.2  thorpej 		} else {
    179  1.2  thorpej 			if (curaddr == lastaddr &&
    180  1.2  thorpej 			    (map->dm_segs[seg].ds_len + sgsize) <=
    181  1.2  thorpej 			    map->_dm_maxsegsz)
    182  1.2  thorpej 				map->dm_segs[seg].ds_len += sgsize;
    183  1.2  thorpej 			else {
    184  1.2  thorpej 				seg++;
    185  1.2  thorpej 				map->dm_segs[seg].ds_addr = curaddr;
    186  1.2  thorpej 				map->dm_segs[seg].ds_len = sgsize;
    187  1.2  thorpej 			}
    188  1.2  thorpej 		}
    189  1.2  thorpej 
    190  1.2  thorpej 		lastaddr = curaddr + sgsize;
    191  1.2  thorpej 		vaddr += sgsize;
    192  1.2  thorpej 		buflen -= sgsize;
    193  1.2  thorpej 	}
    194  1.2  thorpej 
    195  1.9  thorpej 	*segp = seg;
    196  1.9  thorpej 	*lastaddrp = lastaddr;
    197  1.9  thorpej 
    198  1.2  thorpej 	/*
    199  1.2  thorpej 	 * Did we fit?
    200  1.2  thorpej 	 */
    201  1.2  thorpej 	if (buflen != 0) {
    202  1.2  thorpej 		/*
    203  1.2  thorpej 		 * XXX Should fall back on SGMAPs.
    204  1.2  thorpej 		 */
    205  1.2  thorpej 		return (EFBIG);		/* XXX better return value here? */
    206  1.2  thorpej 	}
    207  1.9  thorpej 	return (0);
    208  1.9  thorpej }
    209  1.9  thorpej 
    210  1.9  thorpej /*
    211  1.9  thorpej  * Common function for loading a direct-mapped DMA map with a linear
    212  1.9  thorpej  * buffer.  Called by bus-specific DMA map load functions with the
    213  1.9  thorpej  * OR value appropriate for indicating "direct-mapped" for that
    214  1.9  thorpej  * chipset.
    215  1.9  thorpej  */
    216  1.9  thorpej int
    217  1.9  thorpej _bus_dmamap_load_direct_common(t, map, buf, buflen, p, flags, wbase)
    218  1.9  thorpej 	bus_dma_tag_t t;
    219  1.9  thorpej 	bus_dmamap_t map;
    220  1.9  thorpej 	void *buf;
    221  1.9  thorpej 	bus_size_t buflen;
    222  1.9  thorpej 	struct proc *p;
    223  1.9  thorpej 	int flags;
    224  1.9  thorpej 	bus_addr_t wbase;
    225  1.9  thorpej {
    226  1.9  thorpej 	vm_offset_t lastaddr;
    227  1.9  thorpej 	int seg, error;
    228  1.9  thorpej 
    229  1.9  thorpej 	/*
    230  1.9  thorpej 	 * Make sure that on error condition we return "no valid mappings".
    231  1.9  thorpej 	 */
    232  1.9  thorpej 	map->dm_nsegs = 0;
    233  1.2  thorpej 
    234  1.9  thorpej 	if (buflen > map->_dm_size)
    235  1.9  thorpej 		return (EINVAL);
    236  1.9  thorpej 
    237  1.9  thorpej 	seg = 0;
    238  1.9  thorpej 	error = _bus_dmamap_load_buffer_direct_common(map, buf, buflen,
    239  1.9  thorpej 	    p, flags, wbase, &lastaddr, &seg, 1);
    240  1.9  thorpej 	if (error == 0)
    241  1.9  thorpej 		map->dm_nsegs = seg + 1;
    242  1.9  thorpej 	return (error);
    243  1.2  thorpej }
    244  1.2  thorpej 
    245  1.2  thorpej /*
    246  1.2  thorpej  * Like _bus_dmamap_load_direct_common(), but for mbufs.
    247  1.2  thorpej  */
    248  1.2  thorpej int
    249  1.9  thorpej _bus_dmamap_load_mbuf_direct_common(t, map, m0, flags, wbase)
    250  1.2  thorpej 	bus_dma_tag_t t;
    251  1.2  thorpej 	bus_dmamap_t map;
    252  1.9  thorpej 	struct mbuf *m0;
    253  1.2  thorpej 	int flags;
    254  1.2  thorpej 	bus_addr_t wbase;
    255  1.2  thorpej {
    256  1.9  thorpej 	vm_offset_t lastaddr;
    257  1.9  thorpej 	int seg, error, first;
    258  1.9  thorpej 	struct mbuf *m;
    259  1.9  thorpej 
    260  1.9  thorpej 	/*
    261  1.9  thorpej 	 * Make sure that on error condition we return "no valid mappings."
    262  1.9  thorpej 	 */
    263  1.9  thorpej 	map->dm_nsegs = 0;
    264  1.9  thorpej 
    265  1.9  thorpej #ifdef DIAGNOSTIC
    266  1.9  thorpej 	if ((m0->m_flags & M_PKTHDR) == 0)
    267  1.9  thorpej 		panic("_bus_dmamap_load_mbuf_direct_common: no packet header");
    268  1.9  thorpej #endif
    269  1.2  thorpej 
    270  1.9  thorpej 	if (m0->m_pkthdr.len > map->_dm_size)
    271  1.9  thorpej 		return (EINVAL);
    272  1.9  thorpej 
    273  1.9  thorpej 	first = 1;
    274  1.9  thorpej 	seg = 0;
    275  1.9  thorpej 	error = 0;
    276  1.9  thorpej 	for (m = m0; m != NULL && error == 0; m = m->m_next) {
    277  1.9  thorpej 		error = _bus_dmamap_load_buffer_direct_common(map,
    278  1.9  thorpej 		    m->m_data, m->m_len, NULL, flags, wbase, &lastaddr,
    279  1.9  thorpej 		    &seg, first);
    280  1.9  thorpej 		first = 0;
    281  1.9  thorpej 	}
    282  1.9  thorpej 	if (error == 0)
    283  1.9  thorpej 		map->dm_nsegs = seg + 1;
    284  1.9  thorpej 	return (error);
    285  1.2  thorpej }
    286  1.2  thorpej 
    287  1.2  thorpej /*
    288  1.2  thorpej  * Like _bus_dmamap_load_direct_common(), but for uios.
    289  1.2  thorpej  */
    290  1.2  thorpej int
    291  1.2  thorpej _bus_dmamap_load_uio_direct_common(t, map, uio, flags, wbase)
    292  1.2  thorpej 	bus_dma_tag_t t;
    293  1.2  thorpej 	bus_dmamap_t map;
    294  1.2  thorpej 	struct uio *uio;
    295  1.2  thorpej 	int flags;
    296  1.2  thorpej 	bus_addr_t wbase;
    297  1.2  thorpej {
    298  1.2  thorpej 
    299  1.2  thorpej 	panic("_bus_dmamap_load_uio_direct_common: not implemented");
    300  1.2  thorpej }
    301  1.2  thorpej 
    302  1.2  thorpej /*
    303  1.2  thorpej  * Like _bus_dmamap_load_direct_common(), but for raw memory.
    304  1.2  thorpej  */
    305  1.2  thorpej int
    306  1.2  thorpej _bus_dmamap_load_raw_direct_common(t, map, segs, nsegs, size, flags, wbase)
    307  1.2  thorpej 	bus_dma_tag_t t;
    308  1.2  thorpej 	bus_dmamap_t map;
    309  1.2  thorpej 	bus_dma_segment_t *segs;
    310  1.2  thorpej 	int nsegs;
    311  1.2  thorpej 	bus_size_t size;
    312  1.2  thorpej 	int flags;
    313  1.2  thorpej 	bus_addr_t wbase;
    314  1.2  thorpej {
    315  1.2  thorpej 
    316  1.2  thorpej 	panic("_bus_dmamap_load_raw_direct_common: not implemented");
    317  1.2  thorpej }
    318  1.2  thorpej 
    319  1.2  thorpej /*
    320  1.2  thorpej  * Common function for unloading a DMA map.  May be called by
    321  1.2  thorpej  * chipset-specific DMA map unload functions.
    322  1.2  thorpej  */
    323  1.2  thorpej void
    324  1.2  thorpej _bus_dmamap_unload(t, map)
    325  1.2  thorpej 	bus_dma_tag_t t;
    326  1.2  thorpej 	bus_dmamap_t map;
    327  1.2  thorpej {
    328  1.2  thorpej 
    329  1.2  thorpej 	/*
    330  1.2  thorpej 	 * No resources to free; just mark the mappings as
    331  1.2  thorpej 	 * invalid.
    332  1.2  thorpej 	 */
    333  1.2  thorpej 	map->dm_nsegs = 0;
    334  1.2  thorpej }
    335  1.2  thorpej 
    336  1.2  thorpej /*
    337  1.2  thorpej  * Common function for DMA map synchronization.  May be called
    338  1.2  thorpej  * by chipset-specific DMA map synchronization functions.
    339  1.2  thorpej  */
    340  1.2  thorpej void
    341  1.2  thorpej _bus_dmamap_sync(t, map, op)
    342  1.2  thorpej 	bus_dma_tag_t t;
    343  1.2  thorpej 	bus_dmamap_t map;
    344  1.2  thorpej 	bus_dmasync_op_t op;
    345  1.2  thorpej {
    346  1.2  thorpej 
    347  1.2  thorpej 	/* Nothing to do. */
    348  1.2  thorpej }
    349  1.2  thorpej 
    350  1.2  thorpej /*
    351  1.2  thorpej  * Common function for DMA-safe memory allocation.  May be called
    352  1.2  thorpej  * by bus-specific DMA memory allocation functions.
    353  1.2  thorpej  */
    354  1.2  thorpej int
    355  1.2  thorpej _bus_dmamem_alloc(t, size, alignment, boundary, segs, nsegs, rsegs, flags)
    356  1.2  thorpej 	bus_dma_tag_t t;
    357  1.2  thorpej 	bus_size_t size, alignment, boundary;
    358  1.2  thorpej 	bus_dma_segment_t *segs;
    359  1.2  thorpej 	int nsegs;
    360  1.2  thorpej 	int *rsegs;
    361  1.2  thorpej 	int flags;
    362  1.2  thorpej {
    363  1.7  thorpej 	extern vm_offset_t avail_start, avail_end;
    364  1.2  thorpej 	vm_offset_t curaddr, lastaddr, high;
    365  1.2  thorpej 	vm_page_t m;
    366  1.2  thorpej 	struct pglist mlist;
    367  1.2  thorpej 	int curseg, error;
    368  1.2  thorpej 
    369  1.2  thorpej 	/* Always round the size. */
    370  1.2  thorpej 	size = round_page(size);
    371  1.2  thorpej 
    372  1.7  thorpej 	high = avail_end - PAGE_SIZE;
    373  1.2  thorpej 
    374  1.2  thorpej 	/*
    375  1.2  thorpej 	 * Allocate pages from the VM system.
    376  1.2  thorpej 	 */
    377  1.2  thorpej 	TAILQ_INIT(&mlist);
    378  1.7  thorpej 	error = vm_page_alloc_memory(size, avail_start, high,
    379  1.2  thorpej 	    alignment, boundary, &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0);
    380  1.2  thorpej 	if (error)
    381  1.2  thorpej 		return (error);
    382  1.2  thorpej 
    383  1.2  thorpej 	/*
    384  1.2  thorpej 	 * Compute the location, size, and number of segments actually
    385  1.2  thorpej 	 * returned by the VM code.
    386  1.2  thorpej 	 */
    387  1.2  thorpej 	m = mlist.tqh_first;
    388  1.2  thorpej 	curseg = 0;
    389  1.2  thorpej 	lastaddr = segs[curseg].ds_addr = VM_PAGE_TO_PHYS(m);
    390  1.2  thorpej 	segs[curseg].ds_len = PAGE_SIZE;
    391  1.2  thorpej 	m = m->pageq.tqe_next;
    392  1.2  thorpej 
    393  1.2  thorpej 	for (; m != NULL; m = m->pageq.tqe_next) {
    394  1.2  thorpej 		curaddr = VM_PAGE_TO_PHYS(m);
    395  1.2  thorpej #ifdef DIAGNOSTIC
    396  1.7  thorpej 		if (curaddr < avail_start || curaddr >= high) {
    397  1.2  thorpej 			printf("vm_page_alloc_memory returned non-sensical"
    398  1.2  thorpej 			    " address 0x%lx\n", curaddr);
    399  1.2  thorpej 			panic("_bus_dmamem_alloc");
    400  1.2  thorpej 		}
    401  1.2  thorpej #endif
    402  1.2  thorpej 		if (curaddr == (lastaddr + PAGE_SIZE))
    403  1.2  thorpej 			segs[curseg].ds_len += PAGE_SIZE;
    404  1.2  thorpej 		else {
    405  1.2  thorpej 			curseg++;
    406  1.2  thorpej 			segs[curseg].ds_addr = curaddr;
    407  1.2  thorpej 			segs[curseg].ds_len = PAGE_SIZE;
    408  1.2  thorpej 		}
    409  1.2  thorpej 		lastaddr = curaddr;
    410  1.2  thorpej 	}
    411  1.2  thorpej 
    412  1.2  thorpej 	*rsegs = curseg + 1;
    413  1.2  thorpej 
    414  1.2  thorpej 	return (0);
    415  1.2  thorpej }
    416  1.2  thorpej 
    417  1.2  thorpej /*
    418  1.2  thorpej  * Common function for freeing DMA-safe memory.  May be called by
    419  1.2  thorpej  * bus-specific DMA memory free functions.
    420  1.2  thorpej  */
    421  1.2  thorpej void
    422  1.2  thorpej _bus_dmamem_free(t, segs, nsegs)
    423  1.2  thorpej 	bus_dma_tag_t t;
    424  1.2  thorpej 	bus_dma_segment_t *segs;
    425  1.2  thorpej 	int nsegs;
    426  1.2  thorpej {
    427  1.2  thorpej 	vm_page_t m;
    428  1.2  thorpej 	bus_addr_t addr;
    429  1.2  thorpej 	struct pglist mlist;
    430  1.2  thorpej 	int curseg;
    431  1.2  thorpej 
    432  1.2  thorpej 	/*
    433  1.2  thorpej 	 * Build a list of pages to free back to the VM system.
    434  1.2  thorpej 	 */
    435  1.2  thorpej 	TAILQ_INIT(&mlist);
    436  1.2  thorpej 	for (curseg = 0; curseg < nsegs; curseg++) {
    437  1.2  thorpej 		for (addr = segs[curseg].ds_addr;
    438  1.2  thorpej 		    addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
    439  1.2  thorpej 		    addr += PAGE_SIZE) {
    440  1.2  thorpej 			m = PHYS_TO_VM_PAGE(addr);
    441  1.2  thorpej 			TAILQ_INSERT_TAIL(&mlist, m, pageq);
    442  1.2  thorpej 		}
    443  1.2  thorpej 	}
    444  1.2  thorpej 
    445  1.2  thorpej 	vm_page_free_memory(&mlist);
    446  1.2  thorpej }
    447  1.2  thorpej 
    448  1.2  thorpej /*
    449  1.2  thorpej  * Common function for mapping DMA-safe memory.  May be called by
    450  1.2  thorpej  * bus-specific DMA memory map functions.
    451  1.2  thorpej  */
    452  1.2  thorpej int
    453  1.2  thorpej _bus_dmamem_map(t, segs, nsegs, size, kvap, flags)
    454  1.2  thorpej 	bus_dma_tag_t t;
    455  1.2  thorpej 	bus_dma_segment_t *segs;
    456  1.2  thorpej 	int nsegs;
    457  1.2  thorpej 	size_t size;
    458  1.2  thorpej 	caddr_t *kvap;
    459  1.2  thorpej 	int flags;
    460  1.2  thorpej {
    461  1.2  thorpej 	vm_offset_t va;
    462  1.2  thorpej 	bus_addr_t addr;
    463  1.3  thorpej 	int curseg, s;
    464  1.2  thorpej 
    465  1.8  thorpej 	/*
    466  1.8  thorpej 	 * If we're only mapping 1 segment, use K0SEG, to avoid
    467  1.8  thorpej 	 * TLB thrashing.
    468  1.8  thorpej 	 */
    469  1.8  thorpej 	if (nsegs == 1) {
    470  1.8  thorpej 		*kvap = (caddr_t)ALPHA_PHYS_TO_K0SEG(segs[0].ds_addr);
    471  1.8  thorpej 		return (0);
    472  1.8  thorpej 	}
    473  1.8  thorpej 
    474  1.2  thorpej 	size = round_page(size);
    475  1.3  thorpej 
    476  1.3  thorpej 	s = splimp();
    477  1.2  thorpej 	va = kmem_alloc_pageable(kmem_map, size);
    478  1.3  thorpej 	splx(s);
    479  1.3  thorpej 
    480  1.2  thorpej 	if (va == 0)
    481  1.2  thorpej 		return (ENOMEM);
    482  1.2  thorpej 
    483  1.2  thorpej 	*kvap = (caddr_t)va;
    484  1.2  thorpej 
    485  1.2  thorpej 	for (curseg = 0; curseg < nsegs; curseg++) {
    486  1.2  thorpej 		for (addr = segs[curseg].ds_addr;
    487  1.2  thorpej 		    addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
    488  1.2  thorpej 		    addr += NBPG, va += NBPG, size -= NBPG) {
    489  1.2  thorpej 			if (size == 0)
    490  1.2  thorpej 				panic("_bus_dmamem_map: size botch");
    491  1.2  thorpej 			pmap_enter(pmap_kernel(), va, addr,
    492  1.2  thorpej 			    VM_PROT_READ | VM_PROT_WRITE, TRUE);
    493  1.2  thorpej #if 0
    494  1.2  thorpej 			if (flags & BUS_DMAMEM_NOSYNC)
    495  1.2  thorpej 				/* XXX make non-cacheable? */ ;
    496  1.2  thorpej #endif
    497  1.2  thorpej 		}
    498  1.2  thorpej 	}
    499  1.2  thorpej 
    500  1.2  thorpej 	return (0);
    501  1.2  thorpej }
    502  1.2  thorpej 
    503  1.2  thorpej /*
    504  1.2  thorpej  * Common function for unmapping DMA-safe memory.  May be called by
    505  1.2  thorpej  * bus-specific DMA memory unmapping functions.
    506  1.2  thorpej  */
    507  1.2  thorpej void
    508  1.2  thorpej _bus_dmamem_unmap(t, kva, size)
    509  1.2  thorpej 	bus_dma_tag_t t;
    510  1.2  thorpej 	caddr_t kva;
    511  1.2  thorpej 	size_t size;
    512  1.2  thorpej {
    513  1.3  thorpej 	int s;
    514  1.2  thorpej 
    515  1.2  thorpej #ifdef DIAGNOSTIC
    516  1.2  thorpej 	if ((u_long)kva & PGOFSET)
    517  1.2  thorpej 		panic("_bus_dmamem_unmap");
    518  1.2  thorpej #endif
    519  1.8  thorpej 
    520  1.8  thorpej 	/*
    521  1.8  thorpej 	 * Nothing to do if we mapped it with K0SEG.
    522  1.8  thorpej 	 */
    523  1.8  thorpej 	if (kva >= (caddr_t)ALPHA_K0SEG_BASE &&
    524  1.8  thorpej 	    kva <= (caddr_t)ALPHA_K0SEG_END)
    525  1.8  thorpej 		return;
    526  1.2  thorpej 
    527  1.2  thorpej 	size = round_page(size);
    528  1.3  thorpej 	s = splimp();
    529  1.2  thorpej 	kmem_free(kmem_map, (vm_offset_t)kva, size);
    530  1.3  thorpej 	splx(s);
    531  1.2  thorpej }
    532  1.2  thorpej 
    533  1.2  thorpej /*
    534  1.2  thorpej  * Common functin for mmap(2)'ing DMA-safe memory.  May be called by
    535  1.2  thorpej  * bus-specific DMA mmap(2)'ing functions.
    536  1.2  thorpej  */
    537  1.2  thorpej int
    538  1.2  thorpej _bus_dmamem_mmap(t, segs, nsegs, off, prot, flags)
    539  1.2  thorpej 	bus_dma_tag_t t;
    540  1.2  thorpej 	bus_dma_segment_t *segs;
    541  1.2  thorpej 	int nsegs, off, prot, flags;
    542  1.2  thorpej {
    543  1.6  thorpej 	int i;
    544  1.2  thorpej 
    545  1.6  thorpej 	for (i = 0; i < nsegs; i++) {
    546  1.6  thorpej #ifdef DIAGNOSTIC
    547  1.6  thorpej 		if (off & PGOFSET)
    548  1.6  thorpej 			panic("_bus_dmamem_mmap: offset unaligned");
    549  1.6  thorpej 		if (segs[i].ds_addr & PGOFSET)
    550  1.6  thorpej 			panic("_bus_dmamem_mmap: segment unaligned");
    551  1.6  thorpej 		if (segs[i].ds_len & PGOFSET)
    552  1.6  thorpej 			panic("_bus_dmamem_mmap: segment size not multiple"
    553  1.6  thorpej 			    " of page size");
    554  1.6  thorpej #endif
    555  1.6  thorpej 		if (off >= segs[i].ds_len) {
    556  1.6  thorpej 			off -= segs[i].ds_len;
    557  1.6  thorpej 			continue;
    558  1.6  thorpej 		}
    559  1.6  thorpej 
    560  1.6  thorpej 		return (alpha_btop((caddr_t)segs[i].ds_addr + off));
    561  1.6  thorpej 	}
    562  1.6  thorpej 
    563  1.6  thorpej 	/* Page not found. */
    564  1.6  thorpej 	return (-1);
    565  1.2  thorpej }
    566