Home | History | Annotate | Line # | Download | only in common
bus_dma.c revision 1.11
      1  1.11  thorpej /* $NetBSD: bus_dma.c,v 1.11 1998/02/04 01:57:27 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.11  thorpej __KERNEL_RCSID(0, "$NetBSD: bus_dma.c,v 1.11 1998/02/04 01:57:27 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.10  thorpej 	map->dm_mapsize = 0;		/* no valid mappings */
    107  1.10  thorpej 	map->dm_nsegs = 0;
    108   1.2  thorpej 
    109   1.2  thorpej 	*dmamp = map;
    110   1.2  thorpej 	return (0);
    111   1.2  thorpej }
    112   1.2  thorpej 
    113   1.2  thorpej /*
    114   1.2  thorpej  * Common function for DMA map destruction.  May be called by bus-specific
    115   1.2  thorpej  * DMA map destruction functions.
    116   1.2  thorpej  */
    117   1.2  thorpej void
    118   1.2  thorpej _bus_dmamap_destroy(t, map)
    119   1.2  thorpej 	bus_dma_tag_t t;
    120   1.2  thorpej 	bus_dmamap_t map;
    121   1.2  thorpej {
    122   1.2  thorpej 
    123   1.2  thorpej 	free(map, M_DEVBUF);
    124   1.2  thorpej }
    125   1.2  thorpej 
    126   1.2  thorpej /*
    127   1.9  thorpej  * Utility function to load a linear buffer.  lastaddrp holds state
    128   1.9  thorpej  * between invocations (for multiple-buffer loads).  segp contains
    129   1.9  thorpej  * the starting segment on entrance, and the ending segment on exit.
    130   1.9  thorpej  * first indicates if this is the first invocation of this function.
    131   1.2  thorpej  */
    132   1.2  thorpej int
    133   1.9  thorpej _bus_dmamap_load_buffer_direct_common(map, buf, buflen, p, flags, wbase,
    134   1.9  thorpej     lastaddrp, segp, first)
    135   1.2  thorpej 	bus_dmamap_t map;
    136   1.2  thorpej 	void *buf;
    137   1.2  thorpej 	bus_size_t buflen;
    138   1.2  thorpej 	struct proc *p;
    139   1.2  thorpej 	int flags;
    140   1.2  thorpej 	bus_addr_t wbase;
    141   1.9  thorpej 	vm_offset_t *lastaddrp;
    142   1.9  thorpej 	int *segp;
    143   1.9  thorpej 	int first;
    144   1.2  thorpej {
    145   1.2  thorpej 	bus_size_t sgsize;
    146   1.2  thorpej 	vm_offset_t curaddr, lastaddr;
    147   1.2  thorpej 	vm_offset_t vaddr = (vm_offset_t)buf;
    148   1.9  thorpej 	int seg;
    149   1.2  thorpej 
    150   1.9  thorpej 	lastaddr = *lastaddrp;
    151   1.2  thorpej 
    152   1.9  thorpej 	for (seg = *segp; buflen > 0 && seg < map->_dm_segcnt; ) {
    153   1.2  thorpej 		/*
    154   1.2  thorpej 		 * Get the physical address for this segment.
    155   1.2  thorpej 		 */
    156   1.2  thorpej 		if (p != NULL)
    157   1.5  thorpej 			curaddr = pmap_extract(p->p_vmspace->vm_map.pmap,
    158   1.5  thorpej 			    vaddr);
    159   1.2  thorpej 		else
    160   1.2  thorpej 			curaddr = vtophys(vaddr);
    161   1.2  thorpej 
    162   1.2  thorpej 		curaddr |= wbase;
    163   1.2  thorpej 
    164   1.2  thorpej 		/*
    165   1.2  thorpej 		 * Compute the segment size, and adjust counts.
    166   1.2  thorpej 		 */
    167   1.2  thorpej 		sgsize = NBPG - ((u_long)vaddr & PGOFSET);
    168   1.2  thorpej 		if (buflen < sgsize)
    169   1.2  thorpej 			sgsize = buflen;
    170   1.2  thorpej 
    171   1.2  thorpej 		/*
    172   1.2  thorpej 		 * Insert chunk into a segment, coalescing with
    173   1.2  thorpej 		 * the previous segment if possible.
    174   1.2  thorpej 		 */
    175   1.2  thorpej 		if (first) {
    176   1.2  thorpej 			map->dm_segs[seg].ds_addr = curaddr;
    177   1.2  thorpej 			map->dm_segs[seg].ds_len = sgsize;
    178   1.2  thorpej 			first = 0;
    179   1.2  thorpej 		} else {
    180   1.2  thorpej 			if (curaddr == lastaddr &&
    181   1.2  thorpej 			    (map->dm_segs[seg].ds_len + sgsize) <=
    182   1.2  thorpej 			    map->_dm_maxsegsz)
    183   1.2  thorpej 				map->dm_segs[seg].ds_len += sgsize;
    184   1.2  thorpej 			else {
    185   1.2  thorpej 				seg++;
    186   1.2  thorpej 				map->dm_segs[seg].ds_addr = curaddr;
    187   1.2  thorpej 				map->dm_segs[seg].ds_len = sgsize;
    188   1.2  thorpej 			}
    189   1.2  thorpej 		}
    190   1.2  thorpej 
    191   1.2  thorpej 		lastaddr = curaddr + sgsize;
    192   1.2  thorpej 		vaddr += sgsize;
    193   1.2  thorpej 		buflen -= sgsize;
    194   1.2  thorpej 	}
    195   1.2  thorpej 
    196   1.9  thorpej 	*segp = seg;
    197   1.9  thorpej 	*lastaddrp = lastaddr;
    198   1.9  thorpej 
    199   1.2  thorpej 	/*
    200   1.2  thorpej 	 * Did we fit?
    201   1.2  thorpej 	 */
    202   1.2  thorpej 	if (buflen != 0) {
    203   1.2  thorpej 		/*
    204   1.2  thorpej 		 * XXX Should fall back on SGMAPs.
    205   1.2  thorpej 		 */
    206   1.2  thorpej 		return (EFBIG);		/* XXX better return value here? */
    207   1.2  thorpej 	}
    208   1.9  thorpej 	return (0);
    209   1.9  thorpej }
    210   1.9  thorpej 
    211   1.9  thorpej /*
    212   1.9  thorpej  * Common function for loading a direct-mapped DMA map with a linear
    213   1.9  thorpej  * buffer.  Called by bus-specific DMA map load functions with the
    214   1.9  thorpej  * OR value appropriate for indicating "direct-mapped" for that
    215   1.9  thorpej  * chipset.
    216   1.9  thorpej  */
    217   1.9  thorpej int
    218   1.9  thorpej _bus_dmamap_load_direct_common(t, map, buf, buflen, p, flags, wbase)
    219   1.9  thorpej 	bus_dma_tag_t t;
    220   1.9  thorpej 	bus_dmamap_t map;
    221   1.9  thorpej 	void *buf;
    222   1.9  thorpej 	bus_size_t buflen;
    223   1.9  thorpej 	struct proc *p;
    224   1.9  thorpej 	int flags;
    225   1.9  thorpej 	bus_addr_t wbase;
    226   1.9  thorpej {
    227   1.9  thorpej 	vm_offset_t lastaddr;
    228   1.9  thorpej 	int seg, error;
    229   1.9  thorpej 
    230   1.9  thorpej 	/*
    231   1.9  thorpej 	 * Make sure that on error condition we return "no valid mappings".
    232   1.9  thorpej 	 */
    233  1.10  thorpej 	map->dm_mapsize = 0;
    234   1.9  thorpej 	map->dm_nsegs = 0;
    235   1.2  thorpej 
    236   1.9  thorpej 	if (buflen > map->_dm_size)
    237   1.9  thorpej 		return (EINVAL);
    238   1.9  thorpej 
    239   1.9  thorpej 	seg = 0;
    240   1.9  thorpej 	error = _bus_dmamap_load_buffer_direct_common(map, buf, buflen,
    241   1.9  thorpej 	    p, flags, wbase, &lastaddr, &seg, 1);
    242  1.10  thorpej 	if (error == 0) {
    243  1.10  thorpej 		map->dm_mapsize = buflen;
    244   1.9  thorpej 		map->dm_nsegs = seg + 1;
    245  1.10  thorpej 	}
    246   1.9  thorpej 	return (error);
    247   1.2  thorpej }
    248   1.2  thorpej 
    249   1.2  thorpej /*
    250   1.2  thorpej  * Like _bus_dmamap_load_direct_common(), but for mbufs.
    251   1.2  thorpej  */
    252   1.2  thorpej int
    253   1.9  thorpej _bus_dmamap_load_mbuf_direct_common(t, map, m0, flags, wbase)
    254   1.2  thorpej 	bus_dma_tag_t t;
    255   1.2  thorpej 	bus_dmamap_t map;
    256   1.9  thorpej 	struct mbuf *m0;
    257   1.2  thorpej 	int flags;
    258   1.2  thorpej 	bus_addr_t wbase;
    259   1.2  thorpej {
    260   1.9  thorpej 	vm_offset_t lastaddr;
    261   1.9  thorpej 	int seg, error, first;
    262   1.9  thorpej 	struct mbuf *m;
    263   1.9  thorpej 
    264   1.9  thorpej 	/*
    265   1.9  thorpej 	 * Make sure that on error condition we return "no valid mappings."
    266   1.9  thorpej 	 */
    267  1.10  thorpej 	map->dm_mapsize = 0;
    268   1.9  thorpej 	map->dm_nsegs = 0;
    269   1.9  thorpej 
    270   1.9  thorpej #ifdef DIAGNOSTIC
    271   1.9  thorpej 	if ((m0->m_flags & M_PKTHDR) == 0)
    272   1.9  thorpej 		panic("_bus_dmamap_load_mbuf_direct_common: no packet header");
    273   1.9  thorpej #endif
    274   1.2  thorpej 
    275   1.9  thorpej 	if (m0->m_pkthdr.len > map->_dm_size)
    276   1.9  thorpej 		return (EINVAL);
    277   1.9  thorpej 
    278   1.9  thorpej 	first = 1;
    279   1.9  thorpej 	seg = 0;
    280   1.9  thorpej 	error = 0;
    281   1.9  thorpej 	for (m = m0; m != NULL && error == 0; m = m->m_next) {
    282   1.9  thorpej 		error = _bus_dmamap_load_buffer_direct_common(map,
    283   1.9  thorpej 		    m->m_data, m->m_len, NULL, flags, wbase, &lastaddr,
    284   1.9  thorpej 		    &seg, first);
    285   1.9  thorpej 		first = 0;
    286   1.9  thorpej 	}
    287  1.10  thorpej 	if (error == 0) {
    288  1.10  thorpej 		map->dm_mapsize = m0->m_pkthdr.len;
    289   1.9  thorpej 		map->dm_nsegs = seg + 1;
    290  1.10  thorpej 	}
    291   1.9  thorpej 	return (error);
    292   1.2  thorpej }
    293   1.2  thorpej 
    294   1.2  thorpej /*
    295   1.2  thorpej  * Like _bus_dmamap_load_direct_common(), but for uios.
    296   1.2  thorpej  */
    297   1.2  thorpej int
    298   1.2  thorpej _bus_dmamap_load_uio_direct_common(t, map, uio, flags, wbase)
    299   1.2  thorpej 	bus_dma_tag_t t;
    300   1.2  thorpej 	bus_dmamap_t map;
    301   1.2  thorpej 	struct uio *uio;
    302   1.2  thorpej 	int flags;
    303   1.2  thorpej 	bus_addr_t wbase;
    304   1.2  thorpej {
    305   1.2  thorpej 
    306   1.2  thorpej 	panic("_bus_dmamap_load_uio_direct_common: not implemented");
    307   1.2  thorpej }
    308   1.2  thorpej 
    309   1.2  thorpej /*
    310   1.2  thorpej  * Like _bus_dmamap_load_direct_common(), but for raw memory.
    311   1.2  thorpej  */
    312   1.2  thorpej int
    313   1.2  thorpej _bus_dmamap_load_raw_direct_common(t, map, segs, nsegs, size, flags, wbase)
    314   1.2  thorpej 	bus_dma_tag_t t;
    315   1.2  thorpej 	bus_dmamap_t map;
    316   1.2  thorpej 	bus_dma_segment_t *segs;
    317   1.2  thorpej 	int nsegs;
    318   1.2  thorpej 	bus_size_t size;
    319   1.2  thorpej 	int flags;
    320   1.2  thorpej 	bus_addr_t wbase;
    321   1.2  thorpej {
    322   1.2  thorpej 
    323   1.2  thorpej 	panic("_bus_dmamap_load_raw_direct_common: not implemented");
    324   1.2  thorpej }
    325   1.2  thorpej 
    326   1.2  thorpej /*
    327   1.2  thorpej  * Common function for unloading a DMA map.  May be called by
    328   1.2  thorpej  * chipset-specific DMA map unload functions.
    329   1.2  thorpej  */
    330   1.2  thorpej void
    331   1.2  thorpej _bus_dmamap_unload(t, map)
    332   1.2  thorpej 	bus_dma_tag_t t;
    333   1.2  thorpej 	bus_dmamap_t map;
    334   1.2  thorpej {
    335   1.2  thorpej 
    336   1.2  thorpej 	/*
    337   1.2  thorpej 	 * No resources to free; just mark the mappings as
    338   1.2  thorpej 	 * invalid.
    339   1.2  thorpej 	 */
    340  1.10  thorpej 	map->dm_mapsize = 0;
    341   1.2  thorpej 	map->dm_nsegs = 0;
    342   1.2  thorpej }
    343   1.2  thorpej 
    344   1.2  thorpej /*
    345   1.2  thorpej  * Common function for DMA map synchronization.  May be called
    346   1.2  thorpej  * by chipset-specific DMA map synchronization functions.
    347   1.2  thorpej  */
    348   1.2  thorpej void
    349  1.11  thorpej _bus_dmamap_sync(t, map, ops)
    350   1.2  thorpej 	bus_dma_tag_t t;
    351   1.2  thorpej 	bus_dmamap_t map;
    352  1.11  thorpej 	int ops;
    353   1.2  thorpej {
    354   1.2  thorpej 
    355   1.2  thorpej 	/* Nothing to do. */
    356   1.2  thorpej }
    357   1.2  thorpej 
    358   1.2  thorpej /*
    359   1.2  thorpej  * Common function for DMA-safe memory allocation.  May be called
    360   1.2  thorpej  * by bus-specific DMA memory allocation functions.
    361   1.2  thorpej  */
    362   1.2  thorpej int
    363   1.2  thorpej _bus_dmamem_alloc(t, size, alignment, boundary, segs, nsegs, rsegs, flags)
    364   1.2  thorpej 	bus_dma_tag_t t;
    365   1.2  thorpej 	bus_size_t size, alignment, boundary;
    366   1.2  thorpej 	bus_dma_segment_t *segs;
    367   1.2  thorpej 	int nsegs;
    368   1.2  thorpej 	int *rsegs;
    369   1.2  thorpej 	int flags;
    370   1.2  thorpej {
    371   1.7  thorpej 	extern vm_offset_t avail_start, avail_end;
    372   1.2  thorpej 	vm_offset_t curaddr, lastaddr, high;
    373   1.2  thorpej 	vm_page_t m;
    374   1.2  thorpej 	struct pglist mlist;
    375   1.2  thorpej 	int curseg, error;
    376   1.2  thorpej 
    377   1.2  thorpej 	/* Always round the size. */
    378   1.2  thorpej 	size = round_page(size);
    379   1.2  thorpej 
    380   1.7  thorpej 	high = avail_end - PAGE_SIZE;
    381   1.2  thorpej 
    382   1.2  thorpej 	/*
    383   1.2  thorpej 	 * Allocate pages from the VM system.
    384   1.2  thorpej 	 */
    385   1.2  thorpej 	TAILQ_INIT(&mlist);
    386   1.7  thorpej 	error = vm_page_alloc_memory(size, avail_start, high,
    387   1.2  thorpej 	    alignment, boundary, &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0);
    388   1.2  thorpej 	if (error)
    389   1.2  thorpej 		return (error);
    390   1.2  thorpej 
    391   1.2  thorpej 	/*
    392   1.2  thorpej 	 * Compute the location, size, and number of segments actually
    393   1.2  thorpej 	 * returned by the VM code.
    394   1.2  thorpej 	 */
    395   1.2  thorpej 	m = mlist.tqh_first;
    396   1.2  thorpej 	curseg = 0;
    397   1.2  thorpej 	lastaddr = segs[curseg].ds_addr = VM_PAGE_TO_PHYS(m);
    398   1.2  thorpej 	segs[curseg].ds_len = PAGE_SIZE;
    399   1.2  thorpej 	m = m->pageq.tqe_next;
    400   1.2  thorpej 
    401   1.2  thorpej 	for (; m != NULL; m = m->pageq.tqe_next) {
    402   1.2  thorpej 		curaddr = VM_PAGE_TO_PHYS(m);
    403   1.2  thorpej #ifdef DIAGNOSTIC
    404   1.7  thorpej 		if (curaddr < avail_start || curaddr >= high) {
    405   1.2  thorpej 			printf("vm_page_alloc_memory returned non-sensical"
    406   1.2  thorpej 			    " address 0x%lx\n", curaddr);
    407   1.2  thorpej 			panic("_bus_dmamem_alloc");
    408   1.2  thorpej 		}
    409   1.2  thorpej #endif
    410   1.2  thorpej 		if (curaddr == (lastaddr + PAGE_SIZE))
    411   1.2  thorpej 			segs[curseg].ds_len += PAGE_SIZE;
    412   1.2  thorpej 		else {
    413   1.2  thorpej 			curseg++;
    414   1.2  thorpej 			segs[curseg].ds_addr = curaddr;
    415   1.2  thorpej 			segs[curseg].ds_len = PAGE_SIZE;
    416   1.2  thorpej 		}
    417   1.2  thorpej 		lastaddr = curaddr;
    418   1.2  thorpej 	}
    419   1.2  thorpej 
    420   1.2  thorpej 	*rsegs = curseg + 1;
    421   1.2  thorpej 
    422   1.2  thorpej 	return (0);
    423   1.2  thorpej }
    424   1.2  thorpej 
    425   1.2  thorpej /*
    426   1.2  thorpej  * Common function for freeing DMA-safe memory.  May be called by
    427   1.2  thorpej  * bus-specific DMA memory free functions.
    428   1.2  thorpej  */
    429   1.2  thorpej void
    430   1.2  thorpej _bus_dmamem_free(t, segs, nsegs)
    431   1.2  thorpej 	bus_dma_tag_t t;
    432   1.2  thorpej 	bus_dma_segment_t *segs;
    433   1.2  thorpej 	int nsegs;
    434   1.2  thorpej {
    435   1.2  thorpej 	vm_page_t m;
    436   1.2  thorpej 	bus_addr_t addr;
    437   1.2  thorpej 	struct pglist mlist;
    438   1.2  thorpej 	int curseg;
    439   1.2  thorpej 
    440   1.2  thorpej 	/*
    441   1.2  thorpej 	 * Build a list of pages to free back to the VM system.
    442   1.2  thorpej 	 */
    443   1.2  thorpej 	TAILQ_INIT(&mlist);
    444   1.2  thorpej 	for (curseg = 0; curseg < nsegs; curseg++) {
    445   1.2  thorpej 		for (addr = segs[curseg].ds_addr;
    446   1.2  thorpej 		    addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
    447   1.2  thorpej 		    addr += PAGE_SIZE) {
    448   1.2  thorpej 			m = PHYS_TO_VM_PAGE(addr);
    449   1.2  thorpej 			TAILQ_INSERT_TAIL(&mlist, m, pageq);
    450   1.2  thorpej 		}
    451   1.2  thorpej 	}
    452   1.2  thorpej 
    453   1.2  thorpej 	vm_page_free_memory(&mlist);
    454   1.2  thorpej }
    455   1.2  thorpej 
    456   1.2  thorpej /*
    457   1.2  thorpej  * Common function for mapping DMA-safe memory.  May be called by
    458   1.2  thorpej  * bus-specific DMA memory map functions.
    459   1.2  thorpej  */
    460   1.2  thorpej int
    461   1.2  thorpej _bus_dmamem_map(t, segs, nsegs, size, kvap, flags)
    462   1.2  thorpej 	bus_dma_tag_t t;
    463   1.2  thorpej 	bus_dma_segment_t *segs;
    464   1.2  thorpej 	int nsegs;
    465   1.2  thorpej 	size_t size;
    466   1.2  thorpej 	caddr_t *kvap;
    467   1.2  thorpej 	int flags;
    468   1.2  thorpej {
    469   1.2  thorpej 	vm_offset_t va;
    470   1.2  thorpej 	bus_addr_t addr;
    471   1.3  thorpej 	int curseg, s;
    472   1.2  thorpej 
    473   1.8  thorpej 	/*
    474   1.8  thorpej 	 * If we're only mapping 1 segment, use K0SEG, to avoid
    475   1.8  thorpej 	 * TLB thrashing.
    476   1.8  thorpej 	 */
    477   1.8  thorpej 	if (nsegs == 1) {
    478   1.8  thorpej 		*kvap = (caddr_t)ALPHA_PHYS_TO_K0SEG(segs[0].ds_addr);
    479   1.8  thorpej 		return (0);
    480   1.8  thorpej 	}
    481   1.8  thorpej 
    482   1.2  thorpej 	size = round_page(size);
    483   1.3  thorpej 
    484   1.3  thorpej 	s = splimp();
    485   1.2  thorpej 	va = kmem_alloc_pageable(kmem_map, size);
    486   1.3  thorpej 	splx(s);
    487   1.3  thorpej 
    488   1.2  thorpej 	if (va == 0)
    489   1.2  thorpej 		return (ENOMEM);
    490   1.2  thorpej 
    491   1.2  thorpej 	*kvap = (caddr_t)va;
    492   1.2  thorpej 
    493   1.2  thorpej 	for (curseg = 0; curseg < nsegs; curseg++) {
    494   1.2  thorpej 		for (addr = segs[curseg].ds_addr;
    495   1.2  thorpej 		    addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
    496   1.2  thorpej 		    addr += NBPG, va += NBPG, size -= NBPG) {
    497   1.2  thorpej 			if (size == 0)
    498   1.2  thorpej 				panic("_bus_dmamem_map: size botch");
    499   1.2  thorpej 			pmap_enter(pmap_kernel(), va, addr,
    500   1.2  thorpej 			    VM_PROT_READ | VM_PROT_WRITE, TRUE);
    501   1.2  thorpej 		}
    502   1.2  thorpej 	}
    503   1.2  thorpej 
    504   1.2  thorpej 	return (0);
    505   1.2  thorpej }
    506   1.2  thorpej 
    507   1.2  thorpej /*
    508   1.2  thorpej  * Common function for unmapping DMA-safe memory.  May be called by
    509   1.2  thorpej  * bus-specific DMA memory unmapping functions.
    510   1.2  thorpej  */
    511   1.2  thorpej void
    512   1.2  thorpej _bus_dmamem_unmap(t, kva, size)
    513   1.2  thorpej 	bus_dma_tag_t t;
    514   1.2  thorpej 	caddr_t kva;
    515   1.2  thorpej 	size_t size;
    516   1.2  thorpej {
    517   1.3  thorpej 	int s;
    518   1.2  thorpej 
    519   1.2  thorpej #ifdef DIAGNOSTIC
    520   1.2  thorpej 	if ((u_long)kva & PGOFSET)
    521   1.2  thorpej 		panic("_bus_dmamem_unmap");
    522   1.2  thorpej #endif
    523   1.8  thorpej 
    524   1.8  thorpej 	/*
    525   1.8  thorpej 	 * Nothing to do if we mapped it with K0SEG.
    526   1.8  thorpej 	 */
    527   1.8  thorpej 	if (kva >= (caddr_t)ALPHA_K0SEG_BASE &&
    528   1.8  thorpej 	    kva <= (caddr_t)ALPHA_K0SEG_END)
    529   1.8  thorpej 		return;
    530   1.2  thorpej 
    531   1.2  thorpej 	size = round_page(size);
    532   1.3  thorpej 	s = splimp();
    533   1.2  thorpej 	kmem_free(kmem_map, (vm_offset_t)kva, size);
    534   1.3  thorpej 	splx(s);
    535   1.2  thorpej }
    536   1.2  thorpej 
    537   1.2  thorpej /*
    538   1.2  thorpej  * Common functin for mmap(2)'ing DMA-safe memory.  May be called by
    539   1.2  thorpej  * bus-specific DMA mmap(2)'ing functions.
    540   1.2  thorpej  */
    541   1.2  thorpej int
    542   1.2  thorpej _bus_dmamem_mmap(t, segs, nsegs, off, prot, flags)
    543   1.2  thorpej 	bus_dma_tag_t t;
    544   1.2  thorpej 	bus_dma_segment_t *segs;
    545   1.2  thorpej 	int nsegs, off, prot, flags;
    546   1.2  thorpej {
    547   1.6  thorpej 	int i;
    548   1.2  thorpej 
    549   1.6  thorpej 	for (i = 0; i < nsegs; i++) {
    550   1.6  thorpej #ifdef DIAGNOSTIC
    551   1.6  thorpej 		if (off & PGOFSET)
    552   1.6  thorpej 			panic("_bus_dmamem_mmap: offset unaligned");
    553   1.6  thorpej 		if (segs[i].ds_addr & PGOFSET)
    554   1.6  thorpej 			panic("_bus_dmamem_mmap: segment unaligned");
    555   1.6  thorpej 		if (segs[i].ds_len & PGOFSET)
    556   1.6  thorpej 			panic("_bus_dmamem_mmap: segment size not multiple"
    557   1.6  thorpej 			    " of page size");
    558   1.6  thorpej #endif
    559   1.6  thorpej 		if (off >= segs[i].ds_len) {
    560   1.6  thorpej 			off -= segs[i].ds_len;
    561   1.6  thorpej 			continue;
    562   1.6  thorpej 		}
    563   1.6  thorpej 
    564   1.6  thorpej 		return (alpha_btop((caddr_t)segs[i].ds_addr + off));
    565   1.6  thorpej 	}
    566   1.6  thorpej 
    567   1.6  thorpej 	/* Page not found. */
    568   1.6  thorpej 	return (-1);
    569   1.2  thorpej }
    570