Home | History | Annotate | Line # | Download | only in arm32
bus_dma.c revision 1.1.4.1
      1  1.1.4.1   fvdl /*	$NetBSD: bus_dma.c,v 1.1.4.1 2001/10/01 12:37:31 fvdl Exp $	*/
      2      1.1  chris 
      3      1.1  chris /*-
      4      1.1  chris  * Copyright (c) 1996, 1997, 1998 The NetBSD Foundation, Inc.
      5      1.1  chris  * All rights reserved.
      6      1.1  chris  *
      7      1.1  chris  * This code is derived from software contributed to The NetBSD Foundation
      8      1.1  chris  * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
      9      1.1  chris  * NASA Ames Research Center.
     10      1.1  chris  *
     11      1.1  chris  * Redistribution and use in source and binary forms, with or without
     12      1.1  chris  * modification, are permitted provided that the following conditions
     13      1.1  chris  * are met:
     14      1.1  chris  * 1. Redistributions of source code must retain the above copyright
     15      1.1  chris  *    notice, this list of conditions and the following disclaimer.
     16      1.1  chris  * 2. Redistributions in binary form must reproduce the above copyright
     17      1.1  chris  *    notice, this list of conditions and the following disclaimer in the
     18      1.1  chris  *    documentation and/or other materials provided with the distribution.
     19      1.1  chris  * 3. All advertising materials mentioning features or use of this software
     20      1.1  chris  *    must display the following acknowledgement:
     21      1.1  chris  *	This product includes software developed by the NetBSD
     22      1.1  chris  *	Foundation, Inc. and its contributors.
     23      1.1  chris  * 4. Neither the name of The NetBSD Foundation nor the names of its
     24      1.1  chris  *    contributors may be used to endorse or promote products derived
     25      1.1  chris  *    from this software without specific prior written permission.
     26      1.1  chris  *
     27      1.1  chris  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     28      1.1  chris  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     29      1.1  chris  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     30      1.1  chris  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     31      1.1  chris  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32      1.1  chris  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33      1.1  chris  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34      1.1  chris  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35      1.1  chris  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36      1.1  chris  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37      1.1  chris  * POSSIBILITY OF SUCH DAMAGE.
     38      1.1  chris  */
     39      1.1  chris 
     40      1.1  chris #include <sys/param.h>
     41      1.1  chris #include <sys/systm.h>
     42      1.1  chris #include <sys/kernel.h>
     43      1.1  chris #include <sys/map.h>
     44      1.1  chris #include <sys/proc.h>
     45      1.1  chris #include <sys/buf.h>
     46      1.1  chris #include <sys/reboot.h>
     47      1.1  chris #include <sys/conf.h>
     48      1.1  chris #include <sys/file.h>
     49      1.1  chris #include <sys/malloc.h>
     50      1.1  chris #include <sys/mbuf.h>
     51      1.1  chris #include <sys/vnode.h>
     52      1.1  chris #include <sys/device.h>
     53      1.1  chris 
     54      1.1  chris #include <uvm/uvm_extern.h>
     55      1.1  chris 
     56      1.1  chris #define _ARM32_BUS_DMA_PRIVATE
     57      1.1  chris #include <machine/bus.h>
     58      1.1  chris 
     59      1.1  chris #include <machine/cpu.h>
     60      1.1  chris #include <machine/cpufunc.h>
     61      1.1  chris #include <machine/psl.h>
     62      1.1  chris 
     63      1.1  chris int	_bus_dmamap_load_buffer __P((bus_dma_tag_t, bus_dmamap_t, void *,
     64      1.1  chris 	    bus_size_t, struct proc *, int, vm_offset_t *, int *, int));
     65      1.1  chris int	_bus_dma_inrange __P((bus_dma_segment_t *, int, bus_addr_t));
     66      1.1  chris 
     67      1.1  chris /*
     68      1.1  chris  * Common function for DMA map creation.  May be called by bus-specific
     69      1.1  chris  * DMA map creation functions.
     70      1.1  chris  */
     71      1.1  chris int
     72      1.1  chris _bus_dmamap_create(t, size, nsegments, maxsegsz, boundary, flags, dmamp)
     73      1.1  chris 	bus_dma_tag_t t;
     74      1.1  chris 	bus_size_t size;
     75      1.1  chris 	int nsegments;
     76      1.1  chris 	bus_size_t maxsegsz;
     77      1.1  chris 	bus_size_t boundary;
     78      1.1  chris 	int flags;
     79      1.1  chris 	bus_dmamap_t *dmamp;
     80      1.1  chris {
     81      1.1  chris 	struct arm32_bus_dmamap *map;
     82      1.1  chris 	void *mapstore;
     83      1.1  chris 	size_t mapsize;
     84      1.1  chris 
     85      1.1  chris #ifdef DEBUG_DMA
     86      1.1  chris 	printf("dmamap_create: t=%p size=%lx nseg=%x msegsz=%lx boundary=%lx flags=%x\n",
     87      1.1  chris 	    t, size, nsegments, maxsegsz, boundary, flags);
     88      1.1  chris #endif	/* DEBUG_DMA */
     89      1.1  chris 
     90      1.1  chris 	/*
     91      1.1  chris 	 * Allocate and initialize the DMA map.  The end of the map
     92      1.1  chris 	 * is a variable-sized array of segments, so we allocate enough
     93      1.1  chris 	 * room for them in one shot.
     94      1.1  chris 	 *
     95      1.1  chris 	 * Note we don't preserve the WAITOK or NOWAIT flags.  Preservation
     96      1.1  chris 	 * of ALLOCNOW notifies others that we've reserved these resources,
     97      1.1  chris 	 * and they are not to be freed.
     98      1.1  chris 	 *
     99      1.1  chris 	 * The bus_dmamap_t includes one bus_dma_segment_t, hence
    100      1.1  chris 	 * the (nsegments - 1).
    101      1.1  chris 	 */
    102      1.1  chris 	mapsize = sizeof(struct arm32_bus_dmamap) +
    103      1.1  chris 	    (sizeof(bus_dma_segment_t) * (nsegments - 1));
    104      1.1  chris 	if ((mapstore = malloc(mapsize, M_DMAMAP,
    105      1.1  chris 	    (flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK)) == NULL)
    106      1.1  chris 		return (ENOMEM);
    107      1.1  chris 
    108      1.1  chris 	memset(mapstore, 0, mapsize);
    109      1.1  chris 	map = (struct arm32_bus_dmamap *)mapstore;
    110      1.1  chris 	map->_dm_size = size;
    111      1.1  chris 	map->_dm_segcnt = nsegments;
    112      1.1  chris 	map->_dm_maxsegsz = maxsegsz;
    113      1.1  chris 	map->_dm_boundary = boundary;
    114      1.1  chris 	map->_dm_flags = flags & ~(BUS_DMA_WAITOK|BUS_DMA_NOWAIT);
    115      1.1  chris 	map->dm_mapsize = 0;		/* no valid mappings */
    116      1.1  chris 	map->dm_nsegs = 0;
    117      1.1  chris 
    118      1.1  chris 	*dmamp = map;
    119      1.1  chris #ifdef DEBUG_DMA
    120      1.1  chris 	printf("dmamap_create:map=%p\n", map);
    121      1.1  chris #endif	/* DEBUG_DMA */
    122      1.1  chris 	return (0);
    123      1.1  chris }
    124      1.1  chris 
    125      1.1  chris /*
    126      1.1  chris  * Common function for DMA map destruction.  May be called by bus-specific
    127      1.1  chris  * DMA map destruction functions.
    128      1.1  chris  */
    129      1.1  chris void
    130      1.1  chris _bus_dmamap_destroy(t, map)
    131      1.1  chris 	bus_dma_tag_t t;
    132      1.1  chris 	bus_dmamap_t map;
    133      1.1  chris {
    134      1.1  chris 
    135      1.1  chris #ifdef DEBUG_DMA
    136      1.1  chris 	printf("dmamap_destroy: t=%p map=%p\n", t, map);
    137      1.1  chris #endif	/* DEBUG_DMA */
    138      1.1  chris #ifdef DIAGNOSTIC
    139      1.1  chris 	if (map->dm_nsegs > 0)
    140      1.1  chris 		printf("bus_dmamap_destroy() called for map with valid mappings\n");
    141      1.1  chris #endif	/* DIAGNOSTIC */
    142      1.1  chris 	free(map, M_DEVBUF);
    143      1.1  chris }
    144      1.1  chris 
    145      1.1  chris /*
    146      1.1  chris  * Common function for loading a DMA map with a linear buffer.  May
    147      1.1  chris  * be called by bus-specific DMA map load functions.
    148      1.1  chris  */
    149      1.1  chris int
    150      1.1  chris _bus_dmamap_load(t, map, buf, buflen, p, flags)
    151      1.1  chris 	bus_dma_tag_t t;
    152      1.1  chris 	bus_dmamap_t map;
    153      1.1  chris 	void *buf;
    154      1.1  chris 	bus_size_t buflen;
    155      1.1  chris 	struct proc *p;
    156      1.1  chris 	int flags;
    157      1.1  chris {
    158      1.1  chris 	vm_offset_t lastaddr;
    159      1.1  chris 	int seg, error;
    160      1.1  chris 
    161      1.1  chris #ifdef DEBUG_DMA
    162      1.1  chris 	printf("dmamap_load: t=%p map=%p buf=%p len=%lx p=%p f=%d\n",
    163      1.1  chris 	    t, map, buf, buflen, p, flags);
    164      1.1  chris #endif	/* DEBUG_DMA */
    165      1.1  chris 
    166      1.1  chris 	/*
    167      1.1  chris 	 * Make sure that on error condition we return "no valid mappings".
    168      1.1  chris 	 */
    169      1.1  chris 	map->dm_mapsize = 0;
    170      1.1  chris 	map->dm_nsegs = 0;
    171      1.1  chris 
    172      1.1  chris 	if (buflen > map->_dm_size)
    173      1.1  chris 		return (EINVAL);
    174      1.1  chris 
    175      1.1  chris 	seg = 0;
    176      1.1  chris 	error = _bus_dmamap_load_buffer(t, map, buf, buflen, p, flags,
    177      1.1  chris 	    &lastaddr, &seg, 1);
    178      1.1  chris 	if (error == 0) {
    179      1.1  chris 		map->dm_mapsize = buflen;
    180      1.1  chris 		map->dm_nsegs = seg + 1;
    181      1.1  chris 	}
    182      1.1  chris #ifdef DEBUG_DMA
    183      1.1  chris 	printf("dmamap_load: error=%d\n", error);
    184      1.1  chris #endif	/* DEBUG_DMA */
    185      1.1  chris 	return (error);
    186      1.1  chris }
    187      1.1  chris 
    188      1.1  chris /*
    189      1.1  chris  * Like _bus_dmamap_load(), but for mbufs.
    190      1.1  chris  */
    191      1.1  chris int
    192      1.1  chris _bus_dmamap_load_mbuf(t, map, m0, flags)
    193      1.1  chris 	bus_dma_tag_t t;
    194      1.1  chris 	bus_dmamap_t map;
    195      1.1  chris 	struct mbuf *m0;
    196      1.1  chris 	int flags;
    197      1.1  chris {
    198      1.1  chris 	vm_offset_t lastaddr;
    199      1.1  chris 	int seg, error, first;
    200      1.1  chris 	struct mbuf *m;
    201      1.1  chris 
    202      1.1  chris #ifdef DEBUG_DMA
    203      1.1  chris 	printf("dmamap_load_mbuf: t=%p map=%p m0=%p f=%d\n",
    204      1.1  chris 	    t, map, m0, flags);
    205      1.1  chris #endif	/* DEBUG_DMA */
    206      1.1  chris 
    207      1.1  chris 	/*
    208      1.1  chris 	 * Make sure that on error condition we return "no valid mappings."
    209      1.1  chris 	 */
    210      1.1  chris 	map->dm_mapsize = 0;
    211      1.1  chris 	map->dm_nsegs = 0;
    212      1.1  chris 
    213      1.1  chris #ifdef DIAGNOSTIC
    214      1.1  chris 	if ((m0->m_flags & M_PKTHDR) == 0)
    215      1.1  chris 		panic("_bus_dmamap_load_mbuf: no packet header");
    216      1.1  chris #endif	/* DIAGNOSTIC */
    217      1.1  chris 
    218      1.1  chris 	if (m0->m_pkthdr.len > map->_dm_size)
    219      1.1  chris 		return (EINVAL);
    220      1.1  chris 
    221      1.1  chris 	first = 1;
    222      1.1  chris 	seg = 0;
    223      1.1  chris 	error = 0;
    224      1.1  chris 	for (m = m0; m != NULL && error == 0; m = m->m_next) {
    225      1.1  chris 		error = _bus_dmamap_load_buffer(t, map, m->m_data, m->m_len,
    226      1.1  chris 		    NULL, flags, &lastaddr, &seg, first);
    227      1.1  chris 		first = 0;
    228      1.1  chris 	}
    229      1.1  chris 	if (error == 0) {
    230      1.1  chris 		map->dm_mapsize = m0->m_pkthdr.len;
    231      1.1  chris 		map->dm_nsegs = seg + 1;
    232      1.1  chris 	}
    233      1.1  chris #ifdef DEBUG_DMA
    234      1.1  chris 	printf("dmamap_load_mbuf: error=%d\n", error);
    235      1.1  chris #endif	/* DEBUG_DMA */
    236      1.1  chris 	return (error);
    237      1.1  chris }
    238      1.1  chris 
    239      1.1  chris /*
    240      1.1  chris  * Like _bus_dmamap_load(), but for uios.
    241      1.1  chris  */
    242      1.1  chris int
    243      1.1  chris _bus_dmamap_load_uio(t, map, uio, flags)
    244      1.1  chris 	bus_dma_tag_t t;
    245      1.1  chris 	bus_dmamap_t map;
    246      1.1  chris 	struct uio *uio;
    247      1.1  chris 	int flags;
    248      1.1  chris {
    249      1.1  chris 	vm_offset_t lastaddr;
    250      1.1  chris 	int seg, i, error, first;
    251      1.1  chris 	bus_size_t minlen, resid;
    252      1.1  chris 	struct proc *p = NULL;
    253      1.1  chris 	struct iovec *iov;
    254      1.1  chris 	caddr_t addr;
    255      1.1  chris 
    256      1.1  chris 	/*
    257      1.1  chris 	 * Make sure that on error condition we return "no valid mappings."
    258      1.1  chris 	 */
    259      1.1  chris 	map->dm_mapsize = 0;
    260      1.1  chris 	map->dm_nsegs = 0;
    261      1.1  chris 
    262      1.1  chris 	resid = uio->uio_resid;
    263      1.1  chris 	iov = uio->uio_iov;
    264      1.1  chris 
    265      1.1  chris 	if (uio->uio_segflg == UIO_USERSPACE) {
    266      1.1  chris 		p = uio->uio_procp;
    267      1.1  chris #ifdef DIAGNOSTIC
    268      1.1  chris 		if (p == NULL)
    269      1.1  chris 			panic("_bus_dmamap_load_uio: USERSPACE but no proc");
    270      1.1  chris #endif
    271      1.1  chris 	}
    272      1.1  chris 
    273      1.1  chris 	first = 1;
    274      1.1  chris 	seg = 0;
    275      1.1  chris 	error = 0;
    276      1.1  chris 	for (i = 0; i < uio->uio_iovcnt && resid != 0 && error == 0; i++) {
    277      1.1  chris 		/*
    278      1.1  chris 		 * Now at the first iovec to load.  Load each iovec
    279      1.1  chris 		 * until we have exhausted the residual count.
    280      1.1  chris 		 */
    281      1.1  chris 		minlen = resid < iov[i].iov_len ? resid : iov[i].iov_len;
    282      1.1  chris 		addr = (caddr_t)iov[i].iov_base;
    283      1.1  chris 
    284      1.1  chris 		error = _bus_dmamap_load_buffer(t, map, addr, minlen,
    285      1.1  chris 		    p, flags, &lastaddr, &seg, first);
    286      1.1  chris 		first = 0;
    287      1.1  chris 
    288      1.1  chris 		resid -= minlen;
    289      1.1  chris 	}
    290      1.1  chris 	if (error == 0) {
    291      1.1  chris 		map->dm_mapsize = uio->uio_resid;
    292      1.1  chris 		map->dm_nsegs = seg + 1;
    293      1.1  chris 	}
    294      1.1  chris 	return (error);
    295      1.1  chris }
    296      1.1  chris 
    297      1.1  chris /*
    298      1.1  chris  * Like _bus_dmamap_load(), but for raw memory allocated with
    299      1.1  chris  * bus_dmamem_alloc().
    300      1.1  chris  */
    301      1.1  chris int
    302      1.1  chris _bus_dmamap_load_raw(t, map, segs, nsegs, size, flags)
    303      1.1  chris 	bus_dma_tag_t t;
    304      1.1  chris 	bus_dmamap_t map;
    305      1.1  chris 	bus_dma_segment_t *segs;
    306      1.1  chris 	int nsegs;
    307      1.1  chris 	bus_size_t size;
    308      1.1  chris 	int flags;
    309      1.1  chris {
    310      1.1  chris 
    311      1.1  chris 	panic("_bus_dmamap_load_raw: not implemented");
    312      1.1  chris }
    313      1.1  chris 
    314      1.1  chris /*
    315      1.1  chris  * Common function for unloading a DMA map.  May be called by
    316      1.1  chris  * bus-specific DMA map unload functions.
    317      1.1  chris  */
    318      1.1  chris void
    319      1.1  chris _bus_dmamap_unload(t, map)
    320      1.1  chris 	bus_dma_tag_t t;
    321      1.1  chris 	bus_dmamap_t map;
    322      1.1  chris {
    323      1.1  chris 
    324      1.1  chris #ifdef DEBUG_DMA
    325      1.1  chris 	printf("dmamap_unload: t=%p map=%p\n", t, map);
    326      1.1  chris #endif	/* DEBUG_DMA */
    327      1.1  chris 
    328      1.1  chris 	/*
    329      1.1  chris 	 * No resources to free; just mark the mappings as
    330      1.1  chris 	 * invalid.
    331      1.1  chris 	 */
    332      1.1  chris 	map->dm_mapsize = 0;
    333      1.1  chris 	map->dm_nsegs = 0;
    334      1.1  chris }
    335      1.1  chris 
    336      1.1  chris /*
    337      1.1  chris  * Common function for DMA map synchronization.  May be called
    338      1.1  chris  * by bus-specific DMA map synchronization functions.
    339      1.1  chris  */
    340      1.1  chris void
    341      1.1  chris _bus_dmamap_sync(t, map, offset, len, ops)
    342      1.1  chris 	bus_dma_tag_t t;
    343      1.1  chris 	bus_dmamap_t map;
    344      1.1  chris 	bus_addr_t offset;
    345      1.1  chris 	bus_size_t len;
    346      1.1  chris 	int ops;
    347      1.1  chris {
    348      1.1  chris 	int loop;
    349      1.1  chris 	bus_addr_t vaddr;
    350      1.1  chris 	bus_size_t length;
    351      1.1  chris 	bus_dma_segment_t *seg;
    352      1.1  chris 
    353      1.1  chris #ifdef DEBUG_DMA
    354      1.1  chris 	printf("dmamap_sync: t=%p map=%p offset=%lx len=%lx ops=%x\n",
    355      1.1  chris 	    t, map, offset, len, ops);
    356      1.1  chris #endif	/* DEBUG_DMA */
    357      1.1  chris 
    358      1.1  chris 	if (ops & (BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE)) {
    359      1.1  chris 		/* Quick exit if length is zero */
    360      1.1  chris 		if (len == 0)
    361      1.1  chris 			return;
    362      1.1  chris 
    363      1.1  chris 		/* Find the segment pointed to by offset */
    364      1.1  chris 		loop = map->dm_nsegs;
    365      1.1  chris 		seg = &map->dm_segs[0];
    366      1.1  chris 		while (offset >= seg->ds_len) {
    367      1.1  chris 			offset -= seg->ds_len;
    368      1.1  chris 			++seg;
    369      1.1  chris 			/* Got any more segments ? */
    370      1.1  chris 			--loop;
    371      1.1  chris 			if (loop == 0)
    372      1.1  chris 				return;
    373      1.1  chris 		}
    374      1.1  chris 
    375      1.1  chris 		/* Set the starting address and maximum length */
    376      1.1  chris 		vaddr = seg->_ds_vaddr + offset;
    377      1.1  chris 		length = seg->ds_len - offset;
    378      1.1  chris 		do {
    379      1.1  chris 			/* Limit the length if not the whole segment */
    380      1.1  chris 			if (len < length)
    381      1.1  chris 				length = len;
    382      1.1  chris #ifdef DEBUG_DMA
    383      1.1  chris 			printf("syncing: %lx,%lx\n", vaddr, length);
    384      1.1  chris #endif	/* DEBUG_DMA */
    385      1.1  chris 			/* Actually sync the cache */
    386      1.1  chris 			cpu_cache_purgeD_rng(vaddr, length);
    387      1.1  chris 
    388      1.1  chris 			/* Adjust the length */
    389      1.1  chris 			len -= length;
    390      1.1  chris 
    391      1.1  chris 			/* sync complete ? */
    392      1.1  chris 			if (len > 0) {
    393      1.1  chris 				/* Got any more segments ? */
    394      1.1  chris 				--loop;
    395      1.1  chris 				if (loop == 0)
    396      1.1  chris 					return;
    397      1.1  chris 				++seg;
    398      1.1  chris 				vaddr = seg->_ds_vaddr;
    399      1.1  chris 				length = seg->ds_len;
    400      1.1  chris 			}
    401      1.1  chris 		} while (len > 0);
    402      1.1  chris 
    403      1.1  chris 		cpu_drain_writebuf();
    404      1.1  chris 	}
    405      1.1  chris }
    406      1.1  chris 
    407      1.1  chris /*
    408      1.1  chris  * Common function for DMA-safe memory allocation.  May be called
    409      1.1  chris  * by bus-specific DMA memory allocation functions.
    410      1.1  chris  */
    411      1.1  chris 
    412      1.1  chris extern vm_offset_t physical_start;
    413      1.1  chris extern vm_offset_t physical_freestart;
    414      1.1  chris extern vm_offset_t physical_freeend;
    415      1.1  chris extern vm_offset_t physical_end;
    416      1.1  chris 
    417      1.1  chris int
    418      1.1  chris _bus_dmamem_alloc(t, size, alignment, boundary, segs, nsegs, rsegs, flags)
    419      1.1  chris 	bus_dma_tag_t t;
    420      1.1  chris 	bus_size_t size, alignment, boundary;
    421      1.1  chris 	bus_dma_segment_t *segs;
    422      1.1  chris 	int nsegs;
    423      1.1  chris 	int *rsegs;
    424      1.1  chris 	int flags;
    425      1.1  chris {
    426      1.1  chris 	int error;
    427      1.1  chris #ifdef DEBUG_DMA
    428      1.1  chris 	printf("dmamem_alloc t=%p size=%lx align=%lx boundary=%lx segs=%p nsegs=%x rsegs=%p flags=%x\n",
    429      1.1  chris 	    t, size, alignment, boundary, segs, nsegs, rsegs, flags);
    430      1.1  chris #endif	/* DEBUG_DMA */
    431      1.1  chris 	error =  (_bus_dmamem_alloc_range(t, size, alignment, boundary,
    432      1.1  chris 	    segs, nsegs, rsegs, flags, trunc_page(physical_start), trunc_page(physical_end)));
    433      1.1  chris #ifdef DEBUG_DMA
    434      1.1  chris 	printf("dmamem_alloc: =%d\n", error);
    435      1.1  chris #endif	/* DEBUG_DMA */
    436      1.1  chris 	return(error);
    437      1.1  chris }
    438      1.1  chris 
    439      1.1  chris /*
    440      1.1  chris  * Common function for freeing DMA-safe memory.  May be called by
    441      1.1  chris  * bus-specific DMA memory free functions.
    442      1.1  chris  */
    443      1.1  chris void
    444      1.1  chris _bus_dmamem_free(t, segs, nsegs)
    445      1.1  chris 	bus_dma_tag_t t;
    446      1.1  chris 	bus_dma_segment_t *segs;
    447      1.1  chris 	int nsegs;
    448      1.1  chris {
    449      1.1  chris 	struct vm_page *m;
    450      1.1  chris 	bus_addr_t addr;
    451      1.1  chris 	struct pglist mlist;
    452      1.1  chris 	int curseg;
    453      1.1  chris 
    454      1.1  chris #ifdef DEBUG_DMA
    455      1.1  chris 	printf("dmamem_free: t=%p segs=%p nsegs=%x\n", t, segs, nsegs);
    456      1.1  chris #endif	/* DEBUG_DMA */
    457      1.1  chris 
    458      1.1  chris 	/*
    459      1.1  chris 	 * Build a list of pages to free back to the VM system.
    460      1.1  chris 	 */
    461      1.1  chris 	TAILQ_INIT(&mlist);
    462      1.1  chris 	for (curseg = 0; curseg < nsegs; curseg++) {
    463      1.1  chris 		for (addr = segs[curseg].ds_addr;
    464      1.1  chris 		    addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
    465      1.1  chris 		    addr += PAGE_SIZE) {
    466      1.1  chris 			m = PHYS_TO_VM_PAGE(addr);
    467      1.1  chris 			TAILQ_INSERT_TAIL(&mlist, m, pageq);
    468      1.1  chris 		}
    469      1.1  chris 	}
    470      1.1  chris 	uvm_pglistfree(&mlist);
    471      1.1  chris }
    472      1.1  chris 
    473      1.1  chris /*
    474      1.1  chris  * Common function for mapping DMA-safe memory.  May be called by
    475      1.1  chris  * bus-specific DMA memory map functions.
    476      1.1  chris  */
    477      1.1  chris int
    478      1.1  chris _bus_dmamem_map(t, segs, nsegs, size, kvap, flags)
    479      1.1  chris 	bus_dma_tag_t t;
    480      1.1  chris 	bus_dma_segment_t *segs;
    481      1.1  chris 	int nsegs;
    482      1.1  chris 	size_t size;
    483      1.1  chris 	caddr_t *kvap;
    484      1.1  chris 	int flags;
    485      1.1  chris {
    486      1.1  chris 	vm_offset_t va;
    487      1.1  chris 	bus_addr_t addr;
    488      1.1  chris 	int curseg;
    489      1.1  chris 	pt_entry_t *ptep/*, pte*/;
    490      1.1  chris 
    491      1.1  chris #ifdef DEBUG_DMA
    492  1.1.4.1   fvdl 	printf("dmamem_map: t=%p segs=%p nsegs=%x size=%lx flags=%x\n", t,
    493  1.1.4.1   fvdl 	    segs, nsegs, (unsigned long)size, flags);
    494      1.1  chris #endif	/* DEBUG_DMA */
    495      1.1  chris 
    496      1.1  chris 	size = round_page(size);
    497      1.1  chris 	va = uvm_km_valloc(kernel_map, size);
    498      1.1  chris 
    499      1.1  chris 	if (va == 0)
    500      1.1  chris 		return (ENOMEM);
    501      1.1  chris 
    502      1.1  chris 	*kvap = (caddr_t)va;
    503      1.1  chris 
    504      1.1  chris 	for (curseg = 0; curseg < nsegs; curseg++) {
    505      1.1  chris 		for (addr = segs[curseg].ds_addr;
    506      1.1  chris 		    addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
    507      1.1  chris 		    addr += NBPG, va += NBPG, size -= NBPG) {
    508      1.1  chris #ifdef DEBUG_DMA
    509      1.1  chris 			printf("wiring p%lx to v%lx", addr, va);
    510      1.1  chris #endif	/* DEBUG_DMA */
    511      1.1  chris 			if (size == 0)
    512      1.1  chris 				panic("_bus_dmamem_map: size botch");
    513      1.1  chris 			pmap_enter(pmap_kernel(), va, addr,
    514      1.1  chris 			    VM_PROT_READ | VM_PROT_WRITE,
    515      1.1  chris 			    VM_PROT_READ | VM_PROT_WRITE | PMAP_WIRED);
    516      1.1  chris 			/*
    517      1.1  chris 			 * If the memory must remain coherent with the
    518      1.1  chris 			 * cache then we must make the memory uncacheable
    519      1.1  chris 			 * in order to maintain virtual cache coherency.
    520      1.1  chris 			 * We must also guarentee the cache does not already
    521      1.1  chris 			 * contain the virtal addresses we are making
    522      1.1  chris 			 * uncacheable.
    523      1.1  chris 			 */
    524      1.1  chris 			if (flags & BUS_DMA_COHERENT) {
    525      1.1  chris 				cpu_cache_purgeD_rng(va, NBPG);
    526      1.1  chris 				cpu_drain_writebuf();
    527      1.1  chris 				ptep = vtopte(va);
    528      1.1  chris 				*ptep = ((*ptep) & (~PT_C | PT_B));
    529      1.1  chris 				tlb_flush();
    530      1.1  chris 			}
    531      1.1  chris #ifdef DEBUG_DMA
    532      1.1  chris 			ptep = vtopte(va);
    533      1.1  chris 			printf(" pte=v%p *pte=%x\n", ptep, *ptep);
    534      1.1  chris #endif	/* DEBUG_DMA */
    535      1.1  chris 		}
    536      1.1  chris 	}
    537  1.1.4.1   fvdl 	pmap_update(pmap_kernel());
    538      1.1  chris #ifdef DEBUG_DMA
    539      1.1  chris 	printf("dmamem_map: =%p\n", *kvap);
    540      1.1  chris #endif	/* DEBUG_DMA */
    541      1.1  chris 	return (0);
    542      1.1  chris }
    543      1.1  chris 
    544      1.1  chris /*
    545      1.1  chris  * Common function for unmapping DMA-safe memory.  May be called by
    546      1.1  chris  * bus-specific DMA memory unmapping functions.
    547      1.1  chris  */
    548      1.1  chris void
    549      1.1  chris _bus_dmamem_unmap(t, kva, size)
    550      1.1  chris 	bus_dma_tag_t t;
    551      1.1  chris 	caddr_t kva;
    552      1.1  chris 	size_t size;
    553      1.1  chris {
    554      1.1  chris 
    555      1.1  chris #ifdef DEBUG_DMA
    556  1.1.4.1   fvdl 	printf("dmamem_unmap: t=%p kva=%p size=%lx\n", t, kva,
    557  1.1.4.1   fvdl 	    (unsigned long)size);
    558      1.1  chris #endif	/* DEBUG_DMA */
    559      1.1  chris #ifdef DIAGNOSTIC
    560      1.1  chris 	if ((u_long)kva & PGOFSET)
    561      1.1  chris 		panic("_bus_dmamem_unmap");
    562      1.1  chris #endif	/* DIAGNOSTIC */
    563      1.1  chris 
    564      1.1  chris 	size = round_page(size);
    565      1.1  chris 	uvm_km_free(kernel_map, (vm_offset_t)kva, size);
    566      1.1  chris }
    567      1.1  chris 
    568      1.1  chris /*
    569      1.1  chris  * Common functin for mmap(2)'ing DMA-safe memory.  May be called by
    570      1.1  chris  * bus-specific DMA mmap(2)'ing functions.
    571      1.1  chris  */
    572      1.1  chris paddr_t
    573      1.1  chris _bus_dmamem_mmap(t, segs, nsegs, off, prot, flags)
    574      1.1  chris 	bus_dma_tag_t t;
    575      1.1  chris 	bus_dma_segment_t *segs;
    576      1.1  chris 	int nsegs;
    577      1.1  chris 	off_t off;
    578      1.1  chris 	int prot, flags;
    579      1.1  chris {
    580      1.1  chris 	int i;
    581      1.1  chris 
    582      1.1  chris 	for (i = 0; i < nsegs; i++) {
    583      1.1  chris #ifdef DIAGNOSTIC
    584      1.1  chris 		if (off & PGOFSET)
    585      1.1  chris 			panic("_bus_dmamem_mmap: offset unaligned");
    586      1.1  chris 		if (segs[i].ds_addr & PGOFSET)
    587      1.1  chris 			panic("_bus_dmamem_mmap: segment unaligned");
    588      1.1  chris 		if (segs[i].ds_len & PGOFSET)
    589      1.1  chris 			panic("_bus_dmamem_mmap: segment size not multiple"
    590      1.1  chris 			    " of page size");
    591      1.1  chris #endif	/* DIAGNOSTIC */
    592      1.1  chris 		if (off >= segs[i].ds_len) {
    593      1.1  chris 			off -= segs[i].ds_len;
    594      1.1  chris 			continue;
    595      1.1  chris 		}
    596      1.1  chris 
    597      1.1  chris 		return (arm_byte_to_page((u_long)segs[i].ds_addr + off));
    598      1.1  chris 	}
    599      1.1  chris 
    600      1.1  chris 	/* Page not found. */
    601      1.1  chris 	return (-1);
    602      1.1  chris }
    603      1.1  chris 
    604      1.1  chris /**********************************************************************
    605      1.1  chris  * DMA utility functions
    606      1.1  chris  **********************************************************************/
    607      1.1  chris 
    608      1.1  chris /*
    609      1.1  chris  * Utility function to load a linear buffer.  lastaddrp holds state
    610      1.1  chris  * between invocations (for multiple-buffer loads).  segp contains
    611      1.1  chris  * the starting segment on entrace, and the ending segment on exit.
    612      1.1  chris  * first indicates if this is the first invocation of this function.
    613      1.1  chris  */
    614      1.1  chris int
    615      1.1  chris _bus_dmamap_load_buffer(t, map, buf, buflen, p, flags, lastaddrp, segp, first)
    616      1.1  chris 	bus_dma_tag_t t;
    617      1.1  chris 	bus_dmamap_t map;
    618      1.1  chris 	void *buf;
    619      1.1  chris 	bus_size_t buflen;
    620      1.1  chris 	struct proc *p;
    621      1.1  chris 	int flags;
    622      1.1  chris 	vm_offset_t *lastaddrp;
    623      1.1  chris 	int *segp;
    624      1.1  chris 	int first;
    625      1.1  chris {
    626      1.1  chris 	bus_size_t sgsize;
    627      1.1  chris 	bus_addr_t curaddr, lastaddr, baddr, bmask;
    628      1.1  chris 	vm_offset_t vaddr = (vm_offset_t)buf;
    629      1.1  chris 	int seg;
    630      1.1  chris 	pmap_t pmap;
    631      1.1  chris 
    632      1.1  chris #ifdef DEBUG_DMA
    633      1.1  chris 	printf("_bus_dmamem_load_buffer(buf=%p, len=%lx, flags=%d, 1st=%d)\n",
    634      1.1  chris 	    buf, buflen, flags, first);
    635      1.1  chris #endif	/* DEBUG_DMA */
    636      1.1  chris 
    637      1.1  chris 	if (p != NULL)
    638      1.1  chris 		pmap = p->p_vmspace->vm_map.pmap;
    639      1.1  chris 	else
    640      1.1  chris 		pmap = pmap_kernel();
    641      1.1  chris 
    642      1.1  chris 	lastaddr = *lastaddrp;
    643      1.1  chris 	bmask  = ~(map->_dm_boundary - 1);
    644      1.1  chris 
    645      1.1  chris 	for (seg = *segp; buflen > 0; ) {
    646      1.1  chris 		/*
    647      1.1  chris 		 * Get the physical address for this segment.
    648      1.1  chris 		 */
    649      1.1  chris 		(void) pmap_extract(pmap, (vaddr_t)vaddr, &curaddr);
    650      1.1  chris 
    651      1.1  chris 		/*
    652      1.1  chris 		 * Make sure we're in an allowed DMA range.
    653      1.1  chris 		 */
    654      1.1  chris 		if (t->_ranges != NULL &&
    655      1.1  chris 		    _bus_dma_inrange(t->_ranges, t->_nranges, curaddr) == 0)
    656      1.1  chris 			return (EINVAL);
    657      1.1  chris 
    658      1.1  chris 		/*
    659      1.1  chris 		 * Compute the segment size, and adjust counts.
    660      1.1  chris 		 */
    661      1.1  chris 		sgsize = NBPG - ((u_long)vaddr & PGOFSET);
    662      1.1  chris 		if (buflen < sgsize)
    663      1.1  chris 			sgsize = buflen;
    664      1.1  chris 
    665      1.1  chris 		/*
    666      1.1  chris 		 * Make sure we don't cross any boundaries.
    667      1.1  chris 		 */
    668      1.1  chris 		if (map->_dm_boundary > 0) {
    669      1.1  chris 			baddr = (curaddr + map->_dm_boundary) & bmask;
    670      1.1  chris 			if (sgsize > (baddr - curaddr))
    671      1.1  chris 				sgsize = (baddr - curaddr);
    672      1.1  chris 		}
    673      1.1  chris 
    674      1.1  chris 		/*
    675      1.1  chris 		 * Insert chunk into a segment, coalescing with
    676      1.1  chris 		 * previous segment if possible.
    677      1.1  chris 		 */
    678      1.1  chris 		if (first) {
    679      1.1  chris 			map->dm_segs[seg].ds_addr = curaddr;
    680      1.1  chris 			map->dm_segs[seg].ds_len = sgsize;
    681      1.1  chris 			map->dm_segs[seg]._ds_vaddr = vaddr;
    682      1.1  chris 			first = 0;
    683      1.1  chris 		} else {
    684      1.1  chris 			if (curaddr == lastaddr &&
    685      1.1  chris 			    (map->dm_segs[seg].ds_len + sgsize) <=
    686      1.1  chris 			     map->_dm_maxsegsz &&
    687      1.1  chris 			    (map->_dm_boundary == 0 ||
    688      1.1  chris 			     (map->dm_segs[seg].ds_addr & bmask) ==
    689      1.1  chris 			     (curaddr & bmask)))
    690      1.1  chris 				map->dm_segs[seg].ds_len += sgsize;
    691      1.1  chris 			else {
    692      1.1  chris 				if (++seg >= map->_dm_segcnt)
    693      1.1  chris 					break;
    694      1.1  chris 				map->dm_segs[seg].ds_addr = curaddr;
    695      1.1  chris 				map->dm_segs[seg].ds_len = sgsize;
    696      1.1  chris 				map->dm_segs[seg]._ds_vaddr = vaddr;
    697      1.1  chris 			}
    698      1.1  chris 		}
    699      1.1  chris 
    700      1.1  chris 		lastaddr = curaddr + sgsize;
    701      1.1  chris 		vaddr += sgsize;
    702      1.1  chris 		buflen -= sgsize;
    703      1.1  chris 	}
    704      1.1  chris 
    705      1.1  chris 	*segp = seg;
    706      1.1  chris 	*lastaddrp = lastaddr;
    707      1.1  chris 
    708      1.1  chris 	/*
    709      1.1  chris 	 * Did we fit?
    710      1.1  chris 	 */
    711      1.1  chris 	if (buflen != 0)
    712      1.1  chris 		return (EFBIG);		/* XXX better return value here? */
    713      1.1  chris 	return (0);
    714      1.1  chris }
    715      1.1  chris 
    716      1.1  chris /*
    717      1.1  chris  * Check to see if the specified page is in an allowed DMA range.
    718      1.1  chris  */
    719      1.1  chris int
    720      1.1  chris _bus_dma_inrange(ranges, nranges, curaddr)
    721      1.1  chris 	bus_dma_segment_t *ranges;
    722      1.1  chris 	int nranges;
    723      1.1  chris 	bus_addr_t curaddr;
    724      1.1  chris {
    725      1.1  chris 	bus_dma_segment_t *ds;
    726      1.1  chris 	int i;
    727      1.1  chris 
    728      1.1  chris 	for (i = 0, ds = ranges; i < nranges; i++, ds++) {
    729      1.1  chris 		if (curaddr >= ds->ds_addr &&
    730      1.1  chris 		    round_page(curaddr) <= (ds->ds_addr + ds->ds_len))
    731      1.1  chris 			return (1);
    732      1.1  chris 	}
    733      1.1  chris 
    734      1.1  chris 	return (0);
    735      1.1  chris }
    736      1.1  chris 
    737      1.1  chris /*
    738      1.1  chris  * Allocate physical memory from the given physical address range.
    739      1.1  chris  * Called by DMA-safe memory allocation methods.
    740      1.1  chris  */
    741      1.1  chris int
    742      1.1  chris _bus_dmamem_alloc_range(t, size, alignment, boundary, segs, nsegs, rsegs,
    743      1.1  chris     flags, low, high)
    744      1.1  chris 	bus_dma_tag_t t;
    745      1.1  chris 	bus_size_t size, alignment, boundary;
    746      1.1  chris 	bus_dma_segment_t *segs;
    747      1.1  chris 	int nsegs;
    748      1.1  chris 	int *rsegs;
    749      1.1  chris 	int flags;
    750      1.1  chris 	vm_offset_t low;
    751      1.1  chris 	vm_offset_t high;
    752      1.1  chris {
    753      1.1  chris 	vm_offset_t curaddr, lastaddr;
    754      1.1  chris 	struct vm_page *m;
    755      1.1  chris 	struct pglist mlist;
    756      1.1  chris 	int curseg, error;
    757      1.1  chris 
    758      1.1  chris #ifdef DEBUG_DMA
    759      1.1  chris 	printf("alloc_range: t=%p size=%lx align=%lx boundary=%lx segs=%p nsegs=%x rsegs=%p flags=%x lo=%lx hi=%lx\n",
    760      1.1  chris 	    t, size, alignment, boundary, segs, nsegs, rsegs, flags, low, high);
    761      1.1  chris #endif	/* DEBUG_DMA */
    762      1.1  chris 
    763      1.1  chris 	/* Always round the size. */
    764      1.1  chris 	size = round_page(size);
    765      1.1  chris 
    766      1.1  chris 	/*
    767      1.1  chris 	 * Allocate pages from the VM system.
    768      1.1  chris 	 */
    769      1.1  chris 	TAILQ_INIT(&mlist);
    770      1.1  chris 	error = uvm_pglistalloc(size, low, high, alignment, boundary,
    771      1.1  chris 	    &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0);
    772      1.1  chris 	if (error)
    773      1.1  chris 		return (error);
    774      1.1  chris 
    775      1.1  chris 	/*
    776      1.1  chris 	 * Compute the location, size, and number of segments actually
    777      1.1  chris 	 * returned by the VM code.
    778      1.1  chris 	 */
    779      1.1  chris 	m = mlist.tqh_first;
    780      1.1  chris 	curseg = 0;
    781      1.1  chris 	lastaddr = segs[curseg].ds_addr = VM_PAGE_TO_PHYS(m);
    782      1.1  chris 	segs[curseg].ds_len = PAGE_SIZE;
    783      1.1  chris #ifdef DEBUG_DMA
    784      1.1  chris 		printf("alloc: page %lx\n", lastaddr);
    785      1.1  chris #endif	/* DEBUG_DMA */
    786      1.1  chris 	m = m->pageq.tqe_next;
    787      1.1  chris 
    788      1.1  chris 	for (; m != NULL; m = m->pageq.tqe_next) {
    789      1.1  chris 		curaddr = VM_PAGE_TO_PHYS(m);
    790      1.1  chris #ifdef DIAGNOSTIC
    791      1.1  chris 		if (curaddr < low || curaddr >= high) {
    792      1.1  chris 			printf("uvm_pglistalloc returned non-sensical"
    793      1.1  chris 			    " address 0x%lx\n", curaddr);
    794      1.1  chris 			panic("_bus_dmamem_alloc_range");
    795      1.1  chris 		}
    796      1.1  chris #endif	/* DIAGNOSTIC */
    797      1.1  chris #ifdef DEBUG_DMA
    798      1.1  chris 		printf("alloc: page %lx\n", curaddr);
    799      1.1  chris #endif	/* DEBUG_DMA */
    800      1.1  chris 		if (curaddr == (lastaddr + PAGE_SIZE))
    801      1.1  chris 			segs[curseg].ds_len += PAGE_SIZE;
    802      1.1  chris 		else {
    803      1.1  chris 			curseg++;
    804      1.1  chris 			segs[curseg].ds_addr = curaddr;
    805      1.1  chris 			segs[curseg].ds_len = PAGE_SIZE;
    806      1.1  chris 		}
    807      1.1  chris 		lastaddr = curaddr;
    808      1.1  chris 	}
    809      1.1  chris 
    810      1.1  chris 	*rsegs = curseg + 1;
    811      1.1  chris 
    812      1.1  chris 	return (0);
    813      1.1  chris }
    814