Home | History | Annotate | Line # | Download | only in arm32
bus_dma.c revision 1.2
      1  1.2  chris /*	$NetBSD: bus_dma.c,v 1.2 2001/09/10 21:19:35 chris 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  chris 	printf("dmamem_map: t=%p segs=%p nsegs=%x size=%x flags=%x\n", t, segs, nsegs, size, flags);
    493  1.1  chris #endif	/* DEBUG_DMA */
    494  1.1  chris 
    495  1.1  chris 	size = round_page(size);
    496  1.1  chris 	va = uvm_km_valloc(kernel_map, size);
    497  1.1  chris 
    498  1.1  chris 	if (va == 0)
    499  1.1  chris 		return (ENOMEM);
    500  1.1  chris 
    501  1.1  chris 	*kvap = (caddr_t)va;
    502  1.1  chris 
    503  1.1  chris 	for (curseg = 0; curseg < nsegs; curseg++) {
    504  1.1  chris 		for (addr = segs[curseg].ds_addr;
    505  1.1  chris 		    addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
    506  1.1  chris 		    addr += NBPG, va += NBPG, size -= NBPG) {
    507  1.1  chris #ifdef DEBUG_DMA
    508  1.1  chris 			printf("wiring p%lx to v%lx", addr, va);
    509  1.1  chris #endif	/* DEBUG_DMA */
    510  1.1  chris 			if (size == 0)
    511  1.1  chris 				panic("_bus_dmamem_map: size botch");
    512  1.1  chris 			pmap_enter(pmap_kernel(), va, addr,
    513  1.1  chris 			    VM_PROT_READ | VM_PROT_WRITE,
    514  1.1  chris 			    VM_PROT_READ | VM_PROT_WRITE | PMAP_WIRED);
    515  1.1  chris 			/*
    516  1.1  chris 			 * If the memory must remain coherent with the
    517  1.1  chris 			 * cache then we must make the memory uncacheable
    518  1.1  chris 			 * in order to maintain virtual cache coherency.
    519  1.1  chris 			 * We must also guarentee the cache does not already
    520  1.1  chris 			 * contain the virtal addresses we are making
    521  1.1  chris 			 * uncacheable.
    522  1.1  chris 			 */
    523  1.1  chris 			if (flags & BUS_DMA_COHERENT) {
    524  1.1  chris 				cpu_cache_purgeD_rng(va, NBPG);
    525  1.1  chris 				cpu_drain_writebuf();
    526  1.1  chris 				ptep = vtopte(va);
    527  1.1  chris 				*ptep = ((*ptep) & (~PT_C | PT_B));
    528  1.1  chris 				tlb_flush();
    529  1.1  chris 			}
    530  1.1  chris #ifdef DEBUG_DMA
    531  1.1  chris 			ptep = vtopte(va);
    532  1.1  chris 			printf(" pte=v%p *pte=%x\n", ptep, *ptep);
    533  1.1  chris #endif	/* DEBUG_DMA */
    534  1.1  chris 		}
    535  1.1  chris 	}
    536  1.2  chris 	pmap_update(pmap_kernel());
    537  1.1  chris #ifdef DEBUG_DMA
    538  1.1  chris 	printf("dmamem_map: =%p\n", *kvap);
    539  1.1  chris #endif	/* DEBUG_DMA */
    540  1.1  chris 	return (0);
    541  1.1  chris }
    542  1.1  chris 
    543  1.1  chris /*
    544  1.1  chris  * Common function for unmapping DMA-safe memory.  May be called by
    545  1.1  chris  * bus-specific DMA memory unmapping functions.
    546  1.1  chris  */
    547  1.1  chris void
    548  1.1  chris _bus_dmamem_unmap(t, kva, size)
    549  1.1  chris 	bus_dma_tag_t t;
    550  1.1  chris 	caddr_t kva;
    551  1.1  chris 	size_t size;
    552  1.1  chris {
    553  1.1  chris 
    554  1.1  chris #ifdef DEBUG_DMA
    555  1.1  chris 	printf("dmamem_unmap: t=%p kva=%p size=%x\n", t, kva, size);
    556  1.1  chris #endif	/* DEBUG_DMA */
    557  1.1  chris #ifdef DIAGNOSTIC
    558  1.1  chris 	if ((u_long)kva & PGOFSET)
    559  1.1  chris 		panic("_bus_dmamem_unmap");
    560  1.1  chris #endif	/* DIAGNOSTIC */
    561  1.1  chris 
    562  1.1  chris 	size = round_page(size);
    563  1.1  chris 	uvm_km_free(kernel_map, (vm_offset_t)kva, size);
    564  1.1  chris }
    565  1.1  chris 
    566  1.1  chris /*
    567  1.1  chris  * Common functin for mmap(2)'ing DMA-safe memory.  May be called by
    568  1.1  chris  * bus-specific DMA mmap(2)'ing functions.
    569  1.1  chris  */
    570  1.1  chris paddr_t
    571  1.1  chris _bus_dmamem_mmap(t, segs, nsegs, off, prot, flags)
    572  1.1  chris 	bus_dma_tag_t t;
    573  1.1  chris 	bus_dma_segment_t *segs;
    574  1.1  chris 	int nsegs;
    575  1.1  chris 	off_t off;
    576  1.1  chris 	int prot, flags;
    577  1.1  chris {
    578  1.1  chris 	int i;
    579  1.1  chris 
    580  1.1  chris 	for (i = 0; i < nsegs; i++) {
    581  1.1  chris #ifdef DIAGNOSTIC
    582  1.1  chris 		if (off & PGOFSET)
    583  1.1  chris 			panic("_bus_dmamem_mmap: offset unaligned");
    584  1.1  chris 		if (segs[i].ds_addr & PGOFSET)
    585  1.1  chris 			panic("_bus_dmamem_mmap: segment unaligned");
    586  1.1  chris 		if (segs[i].ds_len & PGOFSET)
    587  1.1  chris 			panic("_bus_dmamem_mmap: segment size not multiple"
    588  1.1  chris 			    " of page size");
    589  1.1  chris #endif	/* DIAGNOSTIC */
    590  1.1  chris 		if (off >= segs[i].ds_len) {
    591  1.1  chris 			off -= segs[i].ds_len;
    592  1.1  chris 			continue;
    593  1.1  chris 		}
    594  1.1  chris 
    595  1.1  chris 		return (arm_byte_to_page((u_long)segs[i].ds_addr + off));
    596  1.1  chris 	}
    597  1.1  chris 
    598  1.1  chris 	/* Page not found. */
    599  1.1  chris 	return (-1);
    600  1.1  chris }
    601  1.1  chris 
    602  1.1  chris /**********************************************************************
    603  1.1  chris  * DMA utility functions
    604  1.1  chris  **********************************************************************/
    605  1.1  chris 
    606  1.1  chris /*
    607  1.1  chris  * Utility function to load a linear buffer.  lastaddrp holds state
    608  1.1  chris  * between invocations (for multiple-buffer loads).  segp contains
    609  1.1  chris  * the starting segment on entrace, and the ending segment on exit.
    610  1.1  chris  * first indicates if this is the first invocation of this function.
    611  1.1  chris  */
    612  1.1  chris int
    613  1.1  chris _bus_dmamap_load_buffer(t, map, buf, buflen, p, flags, lastaddrp, segp, first)
    614  1.1  chris 	bus_dma_tag_t t;
    615  1.1  chris 	bus_dmamap_t map;
    616  1.1  chris 	void *buf;
    617  1.1  chris 	bus_size_t buflen;
    618  1.1  chris 	struct proc *p;
    619  1.1  chris 	int flags;
    620  1.1  chris 	vm_offset_t *lastaddrp;
    621  1.1  chris 	int *segp;
    622  1.1  chris 	int first;
    623  1.1  chris {
    624  1.1  chris 	bus_size_t sgsize;
    625  1.1  chris 	bus_addr_t curaddr, lastaddr, baddr, bmask;
    626  1.1  chris 	vm_offset_t vaddr = (vm_offset_t)buf;
    627  1.1  chris 	int seg;
    628  1.1  chris 	pmap_t pmap;
    629  1.1  chris 
    630  1.1  chris #ifdef DEBUG_DMA
    631  1.1  chris 	printf("_bus_dmamem_load_buffer(buf=%p, len=%lx, flags=%d, 1st=%d)\n",
    632  1.1  chris 	    buf, buflen, flags, first);
    633  1.1  chris #endif	/* DEBUG_DMA */
    634  1.1  chris 
    635  1.1  chris 	if (p != NULL)
    636  1.1  chris 		pmap = p->p_vmspace->vm_map.pmap;
    637  1.1  chris 	else
    638  1.1  chris 		pmap = pmap_kernel();
    639  1.1  chris 
    640  1.1  chris 	lastaddr = *lastaddrp;
    641  1.1  chris 	bmask  = ~(map->_dm_boundary - 1);
    642  1.1  chris 
    643  1.1  chris 	for (seg = *segp; buflen > 0; ) {
    644  1.1  chris 		/*
    645  1.1  chris 		 * Get the physical address for this segment.
    646  1.1  chris 		 */
    647  1.1  chris 		(void) pmap_extract(pmap, (vaddr_t)vaddr, &curaddr);
    648  1.1  chris 
    649  1.1  chris 		/*
    650  1.1  chris 		 * Make sure we're in an allowed DMA range.
    651  1.1  chris 		 */
    652  1.1  chris 		if (t->_ranges != NULL &&
    653  1.1  chris 		    _bus_dma_inrange(t->_ranges, t->_nranges, curaddr) == 0)
    654  1.1  chris 			return (EINVAL);
    655  1.1  chris 
    656  1.1  chris 		/*
    657  1.1  chris 		 * Compute the segment size, and adjust counts.
    658  1.1  chris 		 */
    659  1.1  chris 		sgsize = NBPG - ((u_long)vaddr & PGOFSET);
    660  1.1  chris 		if (buflen < sgsize)
    661  1.1  chris 			sgsize = buflen;
    662  1.1  chris 
    663  1.1  chris 		/*
    664  1.1  chris 		 * Make sure we don't cross any boundaries.
    665  1.1  chris 		 */
    666  1.1  chris 		if (map->_dm_boundary > 0) {
    667  1.1  chris 			baddr = (curaddr + map->_dm_boundary) & bmask;
    668  1.1  chris 			if (sgsize > (baddr - curaddr))
    669  1.1  chris 				sgsize = (baddr - curaddr);
    670  1.1  chris 		}
    671  1.1  chris 
    672  1.1  chris 		/*
    673  1.1  chris 		 * Insert chunk into a segment, coalescing with
    674  1.1  chris 		 * previous segment if possible.
    675  1.1  chris 		 */
    676  1.1  chris 		if (first) {
    677  1.1  chris 			map->dm_segs[seg].ds_addr = curaddr;
    678  1.1  chris 			map->dm_segs[seg].ds_len = sgsize;
    679  1.1  chris 			map->dm_segs[seg]._ds_vaddr = vaddr;
    680  1.1  chris 			first = 0;
    681  1.1  chris 		} else {
    682  1.1  chris 			if (curaddr == lastaddr &&
    683  1.1  chris 			    (map->dm_segs[seg].ds_len + sgsize) <=
    684  1.1  chris 			     map->_dm_maxsegsz &&
    685  1.1  chris 			    (map->_dm_boundary == 0 ||
    686  1.1  chris 			     (map->dm_segs[seg].ds_addr & bmask) ==
    687  1.1  chris 			     (curaddr & bmask)))
    688  1.1  chris 				map->dm_segs[seg].ds_len += sgsize;
    689  1.1  chris 			else {
    690  1.1  chris 				if (++seg >= map->_dm_segcnt)
    691  1.1  chris 					break;
    692  1.1  chris 				map->dm_segs[seg].ds_addr = curaddr;
    693  1.1  chris 				map->dm_segs[seg].ds_len = sgsize;
    694  1.1  chris 				map->dm_segs[seg]._ds_vaddr = vaddr;
    695  1.1  chris 			}
    696  1.1  chris 		}
    697  1.1  chris 
    698  1.1  chris 		lastaddr = curaddr + sgsize;
    699  1.1  chris 		vaddr += sgsize;
    700  1.1  chris 		buflen -= sgsize;
    701  1.1  chris 	}
    702  1.1  chris 
    703  1.1  chris 	*segp = seg;
    704  1.1  chris 	*lastaddrp = lastaddr;
    705  1.1  chris 
    706  1.1  chris 	/*
    707  1.1  chris 	 * Did we fit?
    708  1.1  chris 	 */
    709  1.1  chris 	if (buflen != 0)
    710  1.1  chris 		return (EFBIG);		/* XXX better return value here? */
    711  1.1  chris 	return (0);
    712  1.1  chris }
    713  1.1  chris 
    714  1.1  chris /*
    715  1.1  chris  * Check to see if the specified page is in an allowed DMA range.
    716  1.1  chris  */
    717  1.1  chris int
    718  1.1  chris _bus_dma_inrange(ranges, nranges, curaddr)
    719  1.1  chris 	bus_dma_segment_t *ranges;
    720  1.1  chris 	int nranges;
    721  1.1  chris 	bus_addr_t curaddr;
    722  1.1  chris {
    723  1.1  chris 	bus_dma_segment_t *ds;
    724  1.1  chris 	int i;
    725  1.1  chris 
    726  1.1  chris 	for (i = 0, ds = ranges; i < nranges; i++, ds++) {
    727  1.1  chris 		if (curaddr >= ds->ds_addr &&
    728  1.1  chris 		    round_page(curaddr) <= (ds->ds_addr + ds->ds_len))
    729  1.1  chris 			return (1);
    730  1.1  chris 	}
    731  1.1  chris 
    732  1.1  chris 	return (0);
    733  1.1  chris }
    734  1.1  chris 
    735  1.1  chris /*
    736  1.1  chris  * Allocate physical memory from the given physical address range.
    737  1.1  chris  * Called by DMA-safe memory allocation methods.
    738  1.1  chris  */
    739  1.1  chris int
    740  1.1  chris _bus_dmamem_alloc_range(t, size, alignment, boundary, segs, nsegs, rsegs,
    741  1.1  chris     flags, low, high)
    742  1.1  chris 	bus_dma_tag_t t;
    743  1.1  chris 	bus_size_t size, alignment, boundary;
    744  1.1  chris 	bus_dma_segment_t *segs;
    745  1.1  chris 	int nsegs;
    746  1.1  chris 	int *rsegs;
    747  1.1  chris 	int flags;
    748  1.1  chris 	vm_offset_t low;
    749  1.1  chris 	vm_offset_t high;
    750  1.1  chris {
    751  1.1  chris 	vm_offset_t curaddr, lastaddr;
    752  1.1  chris 	struct vm_page *m;
    753  1.1  chris 	struct pglist mlist;
    754  1.1  chris 	int curseg, error;
    755  1.1  chris 
    756  1.1  chris #ifdef DEBUG_DMA
    757  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",
    758  1.1  chris 	    t, size, alignment, boundary, segs, nsegs, rsegs, flags, low, high);
    759  1.1  chris #endif	/* DEBUG_DMA */
    760  1.1  chris 
    761  1.1  chris 	/* Always round the size. */
    762  1.1  chris 	size = round_page(size);
    763  1.1  chris 
    764  1.1  chris 	/*
    765  1.1  chris 	 * Allocate pages from the VM system.
    766  1.1  chris 	 */
    767  1.1  chris 	TAILQ_INIT(&mlist);
    768  1.1  chris 	error = uvm_pglistalloc(size, low, high, alignment, boundary,
    769  1.1  chris 	    &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0);
    770  1.1  chris 	if (error)
    771  1.1  chris 		return (error);
    772  1.1  chris 
    773  1.1  chris 	/*
    774  1.1  chris 	 * Compute the location, size, and number of segments actually
    775  1.1  chris 	 * returned by the VM code.
    776  1.1  chris 	 */
    777  1.1  chris 	m = mlist.tqh_first;
    778  1.1  chris 	curseg = 0;
    779  1.1  chris 	lastaddr = segs[curseg].ds_addr = VM_PAGE_TO_PHYS(m);
    780  1.1  chris 	segs[curseg].ds_len = PAGE_SIZE;
    781  1.1  chris #ifdef DEBUG_DMA
    782  1.1  chris 		printf("alloc: page %lx\n", lastaddr);
    783  1.1  chris #endif	/* DEBUG_DMA */
    784  1.1  chris 	m = m->pageq.tqe_next;
    785  1.1  chris 
    786  1.1  chris 	for (; m != NULL; m = m->pageq.tqe_next) {
    787  1.1  chris 		curaddr = VM_PAGE_TO_PHYS(m);
    788  1.1  chris #ifdef DIAGNOSTIC
    789  1.1  chris 		if (curaddr < low || curaddr >= high) {
    790  1.1  chris 			printf("uvm_pglistalloc returned non-sensical"
    791  1.1  chris 			    " address 0x%lx\n", curaddr);
    792  1.1  chris 			panic("_bus_dmamem_alloc_range");
    793  1.1  chris 		}
    794  1.1  chris #endif	/* DIAGNOSTIC */
    795  1.1  chris #ifdef DEBUG_DMA
    796  1.1  chris 		printf("alloc: page %lx\n", curaddr);
    797  1.1  chris #endif	/* DEBUG_DMA */
    798  1.1  chris 		if (curaddr == (lastaddr + PAGE_SIZE))
    799  1.1  chris 			segs[curseg].ds_len += PAGE_SIZE;
    800  1.1  chris 		else {
    801  1.1  chris 			curseg++;
    802  1.1  chris 			segs[curseg].ds_addr = curaddr;
    803  1.1  chris 			segs[curseg].ds_len = PAGE_SIZE;
    804  1.1  chris 		}
    805  1.1  chris 		lastaddr = curaddr;
    806  1.1  chris 	}
    807  1.1  chris 
    808  1.1  chris 	*rsegs = curseg + 1;
    809  1.1  chris 
    810  1.1  chris 	return (0);
    811  1.1  chris }
    812