busdma_machdep-v4.c revision 140682
1139735Simp/*-
2129198Scognet * Copyright (c) 2004 Olivier Houchard
3129198Scognet * Copyright (c) 2002 Peter Grehan
4129198Scognet * Copyright (c) 1997, 1998 Justin T. Gibbs.
5129198Scognet * All rights reserved.
6129198Scognet *
7129198Scognet * Redistribution and use in source and binary forms, with or without
8129198Scognet * modification, are permitted provided that the following conditions
9129198Scognet * are met:
10129198Scognet * 1. Redistributions of source code must retain the above copyright
11129198Scognet *    notice, this list of conditions, and the following disclaimer,
12129198Scognet *    without modification, immediately at the beginning of the file.
13129198Scognet * 2. The name of the author may not be used to endorse or promote products
14129198Scognet *    derived from this software without specific prior written permission.
15129198Scognet *
16129198Scognet * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17129198Scognet * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18129198Scognet * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19129198Scognet * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
20129198Scognet * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21129198Scognet * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22129198Scognet * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23129198Scognet * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24129198Scognet * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25129198Scognet * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26129198Scognet * SUCH DAMAGE.
27129198Scognet *
28129198Scognet *   From i386/busdma_machdep.c,v 1.26 2002/04/19 22:58:09 alfred
29129198Scognet */
30129198Scognet
31129198Scognet#include <sys/cdefs.h>
32129198Scognet__FBSDID("$FreeBSD: head/sys/arm/arm/busdma_machdep.c 140682 2005-01-23 22:07:33Z cognet $");
33129198Scognet
34129198Scognet/*
35129198Scognet * MacPPC bus dma support routines
36129198Scognet */
37129198Scognet
38129198Scognet#define _ARM32_BUS_DMA_PRIVATE
39129198Scognet#include <sys/param.h>
40129198Scognet#include <sys/systm.h>
41129198Scognet#include <sys/malloc.h>
42129198Scognet#include <sys/bus.h>
43129198Scognet#include <sys/interrupt.h>
44129198Scognet#include <sys/lock.h>
45129198Scognet#include <sys/proc.h>
46129198Scognet#include <sys/mutex.h>
47129198Scognet#include <sys/mbuf.h>
48129198Scognet#include <sys/uio.h>
49140310Scognet#include <sys/ktr.h>
50129198Scognet
51129198Scognet#include <vm/vm.h>
52129198Scognet#include <vm/vm_page.h>
53129198Scognet#include <vm/vm_map.h>
54129198Scognet
55129198Scognet#include <machine/atomic.h>
56129198Scognet#include <machine/bus.h>
57129198Scognet#include <machine/cpufunc.h>
58129198Scognet
59129198Scognetstruct bus_dma_tag {
60129198Scognet	bus_dma_tag_t		parent;
61129198Scognet	bus_size_t		alignment;
62129198Scognet	bus_size_t		boundary;
63129198Scognet	bus_addr_t		lowaddr;
64129198Scognet	bus_addr_t		highaddr;
65129198Scognet	bus_dma_filter_t	*filter;
66129198Scognet	void			*filterarg;
67129198Scognet	bus_size_t		maxsize;
68129198Scognet	u_int			nsegments;
69129198Scognet	bus_size_t		maxsegsz;
70129198Scognet	int			flags;
71129198Scognet	int			ref_count;
72129198Scognet	int			map_count;
73129198Scognet	bus_dma_lock_t		*lockfunc;
74129198Scognet	void			*lockfuncarg;
75129198Scognet	/*
76129198Scognet	 * DMA range for this tag.  If the page doesn't fall within
77129198Scognet	 * one of these ranges, an error is returned.  The caller
78129198Scognet	 * may then decide what to do with the transfer.  If the
79129198Scognet	 * range pointer is NULL, it is ignored.
80129198Scognet	 */
81129198Scognet	struct arm32_dma_range	*ranges;
82129198Scognet	int			_nranges;
83129198Scognet};
84129198Scognet
85135644Scognet#define DMAMAP_LINEAR		0x1
86135644Scognet#define DMAMAP_MBUF		0x2
87135644Scognet#define DMAMAP_UIO		0x4
88135644Scognet#define DMAMAP_TYPE_MASK	(DMAMAP_LINEAR|DMAMAP_MBUF|DMAMAP_UIO)
89135644Scognet#define DMAMAP_COHERENT		0x8
90129198Scognetstruct bus_dmamap {
91135644Scognet        bus_dma_tag_t	dmat;
92135644Scognet	int		flags;
93135644Scognet	void 		*buffer;
94135644Scognet	int		len;
95129198Scognet};
96129198Scognet
97129198Scognet/*
98129198Scognet * Check to see if the specified page is in an allowed DMA range.
99129198Scognet */
100129198Scognet
101137758Scognetstatic __inline int
102140349Scognetbus_dmamap_load_buffer(bus_dma_tag_t dmat, bus_dma_segment_t *segs,
103137758Scognet    bus_dmamap_t map, void *buf, bus_size_t buflen, struct pmap *pmap,
104137760Scognet    int flags, vm_offset_t *lastaddrp, int *segp);
105135644Scognet
106129198Scognetstatic __inline struct arm32_dma_range *
107129198Scognet_bus_dma_inrange(struct arm32_dma_range *ranges, int nranges,
108129198Scognet    bus_addr_t curaddr)
109129198Scognet{
110129198Scognet	struct arm32_dma_range *dr;
111129198Scognet	int i;
112129198Scognet
113129198Scognet	for (i = 0, dr = ranges; i < nranges; i++, dr++) {
114129198Scognet		if (curaddr >= dr->dr_sysbase &&
115129198Scognet		    round_page(curaddr) <= (dr->dr_sysbase + dr->dr_len))
116129198Scognet			return (dr);
117129198Scognet	}
118129198Scognet
119129198Scognet	return (NULL);
120129198Scognet}
121129198Scognet/*
122129198Scognet * Convenience function for manipulating driver locks from busdma (during
123129198Scognet * busdma_swi, for example).  Drivers that don't provide their own locks
124129198Scognet * should specify &Giant to dmat->lockfuncarg.  Drivers that use their own
125129198Scognet * non-mutex locking scheme don't have to use this at all.
126129198Scognet */
127129198Scognetvoid
128129198Scognetbusdma_lock_mutex(void *arg, bus_dma_lock_op_t op)
129129198Scognet{
130129198Scognet	struct mtx *dmtx;
131129198Scognet
132129198Scognet	dmtx = (struct mtx *)arg;
133129198Scognet	switch (op) {
134129198Scognet	case BUS_DMA_LOCK:
135129198Scognet		mtx_lock(dmtx);
136129198Scognet		break;
137129198Scognet	case BUS_DMA_UNLOCK:
138129198Scognet		mtx_unlock(dmtx);
139129198Scognet		break;
140129198Scognet	default:
141129198Scognet		panic("Unknown operation 0x%x for busdma_lock_mutex!", op);
142129198Scognet	}
143129198Scognet}
144129198Scognet
145129198Scognet/*
146129198Scognet * dflt_lock should never get called.  It gets put into the dma tag when
147129198Scognet * lockfunc == NULL, which is only valid if the maps that are associated
148129198Scognet * with the tag are meant to never be defered.
149129198Scognet * XXX Should have a way to identify which driver is responsible here.
150129198Scognet */
151129198Scognetstatic void
152129198Scognetdflt_lock(void *arg, bus_dma_lock_op_t op)
153129198Scognet{
154129198Scognet#ifdef INVARIANTS
155129198Scognet	panic("driver error: busdma dflt_lock called");
156129198Scognet#else
157129198Scognet	printf("DRIVER_ERROR: busdma dflt_lock called\n");
158129198Scognet#endif
159129198Scognet}
160129198Scognet
161129198Scognet/*
162129198Scognet * Allocate a device specific dma_tag.
163129198Scognet */
164135644Scognet#define SEG_NB 1024
165135644Scognet
166129198Scognetint
167129198Scognetbus_dma_tag_create(bus_dma_tag_t parent, bus_size_t alignment,
168129198Scognet		   bus_size_t boundary, bus_addr_t lowaddr,
169129198Scognet		   bus_addr_t highaddr, bus_dma_filter_t *filter,
170129198Scognet		   void *filterarg, bus_size_t maxsize, int nsegments,
171129198Scognet		   bus_size_t maxsegsz, int flags, bus_dma_lock_t *lockfunc,
172129198Scognet		   void *lockfuncarg, bus_dma_tag_t *dmat)
173129198Scognet{
174129198Scognet	bus_dma_tag_t newtag;
175129198Scognet	int error = 0;
176129198Scognet	/* Return a NULL tag on failure */
177129198Scognet	*dmat = NULL;
178129198Scognet
179129198Scognet	newtag = (bus_dma_tag_t)malloc(sizeof(*newtag), M_DEVBUF, M_NOWAIT);
180140313Scognet	if (newtag == NULL) {
181140313Scognet		CTR3(KTR_BUSDMA, "bus_dma_tag_create returned tag %p tag "
182140313Scognet		    "flags 0x%x error %d", newtag, 0, error);
183129198Scognet		return (ENOMEM);
184140313Scognet	}
185129198Scognet
186129198Scognet	newtag->parent = parent;
187129198Scognet	newtag->alignment = alignment;
188129198Scognet	newtag->boundary = boundary;
189129198Scognet	newtag->lowaddr = trunc_page((vm_offset_t)lowaddr) + (PAGE_SIZE - 1);
190129198Scognet	newtag->highaddr = trunc_page((vm_offset_t)highaddr) + (PAGE_SIZE - 1);
191129198Scognet	newtag->filter = filter;
192129198Scognet	newtag->filterarg = filterarg;
193129198Scognet        newtag->maxsize = maxsize;
194129198Scognet        newtag->nsegments = nsegments;
195129198Scognet	newtag->maxsegsz = maxsegsz;
196129198Scognet	newtag->flags = flags;
197129198Scognet	newtag->ref_count = 1; /* Count ourself */
198129198Scognet	newtag->map_count = 0;
199129198Scognet	newtag->ranges = bus_dma_get_range();
200135644Scognet	newtag->_nranges = bus_dma_get_range_nb();
201129198Scognet	if (lockfunc != NULL) {
202129198Scognet		newtag->lockfunc = lockfunc;
203129198Scognet		newtag->lockfuncarg = lockfuncarg;
204129198Scognet	} else {
205129198Scognet		newtag->lockfunc = dflt_lock;
206129198Scognet		newtag->lockfuncarg = NULL;
207129198Scognet	}
208129198Scognet        /*
209129198Scognet	 * Take into account any restrictions imposed by our parent tag
210129198Scognet	 */
211129198Scognet        if (parent != NULL) {
212129198Scognet                newtag->lowaddr = min(parent->lowaddr, newtag->lowaddr);
213129198Scognet                newtag->highaddr = max(parent->highaddr, newtag->highaddr);
214134934Sscottl		if (newtag->boundary == 0)
215134934Sscottl			newtag->boundary = parent->boundary;
216134934Sscottl		else if (parent->boundary != 0)
217134934Sscottl                	newtag->boundary = min(parent->boundary,
218134934Sscottl					       newtag->boundary);
219129198Scognet                if (newtag->filter == NULL) {
220129198Scognet                        /*
221129198Scognet                         * Short circuit looking at our parent directly
222129198Scognet                         * since we have encapsulated all of its information
223129198Scognet                         */
224129198Scognet                        newtag->filter = parent->filter;
225129198Scognet                        newtag->filterarg = parent->filterarg;
226129198Scognet                        newtag->parent = parent->parent;
227129198Scognet		}
228129198Scognet		if (newtag->parent != NULL)
229129198Scognet			atomic_add_int(&parent->ref_count, 1);
230129198Scognet	}
231129198Scognet
232129198Scognet	*dmat = newtag;
233140313Scognet	CTR3(KTR_BUSDMA, "bus_dma_tag_create returned tag %p tag flags 0x%x "
234140313Scognet	    "error %d", newtag, (newtag != NULL ? newtag->flags : 0), error);
235140313Scognet
236129198Scognet	return (error);
237129198Scognet}
238129198Scognet
239129198Scognetint
240129198Scognetbus_dma_tag_destroy(bus_dma_tag_t dmat)
241129198Scognet{
242140680Scognet#ifdef KTR
243140313Scognet	bus_dma_tag_t dmat_copy = dmat;
244140680Scognet#endif
245140313Scognet
246129198Scognet	if (dmat != NULL) {
247129198Scognet
248129198Scognet                if (dmat->map_count != 0)
249129198Scognet                        return (EBUSY);
250129198Scognet
251129198Scognet                while (dmat != NULL) {
252129198Scognet                        bus_dma_tag_t parent;
253129198Scognet
254129198Scognet                        parent = dmat->parent;
255129198Scognet                        atomic_subtract_int(&dmat->ref_count, 1);
256129198Scognet                        if (dmat->ref_count == 0) {
257129198Scognet                                free(dmat, M_DEVBUF);
258129198Scognet                                /*
259129198Scognet                                 * Last reference count, so
260129198Scognet                                 * release our reference
261129198Scognet                                 * count on our parent.
262129198Scognet                                 */
263129198Scognet                                dmat = parent;
264129198Scognet                        } else
265129198Scognet                                dmat = NULL;
266129198Scognet                }
267129198Scognet        }
268140313Scognet	CTR1(KTR_BUSDMA, "bus_dma_tag_destroy tag %p", dmat_copy);
269140313Scognet
270129198Scognet        return (0);
271129198Scognet}
272129198Scognet
273129198Scognet/*
274129198Scognet * Allocate a handle for mapping from kva/uva/physical
275129198Scognet * address space into bus device space.
276129198Scognet */
277129198Scognetint
278129198Scognetbus_dmamap_create(bus_dma_tag_t dmat, int flags, bus_dmamap_t *mapp)
279129198Scognet{
280129198Scognet	bus_dmamap_t newmap;
281140680Scognet#ifdef KTR
282140313Scognet	int error = 0;
283140680Scognet#endif
284129198Scognet
285129198Scognet	newmap = malloc(sizeof(*newmap), M_DEVBUF, M_NOWAIT | M_ZERO);
286140313Scognet	if (newmap == NULL) {
287140313Scognet		CTR2(KTR_BUSDMA, "bus_dmamap_create: tag %p error %d",
288140313Scognet		    dmat, ENOMEM);
289129198Scognet		return (ENOMEM);
290140313Scognet	}
291129198Scognet	*mapp = newmap;
292135644Scognet	newmap->dmat = dmat;
293135644Scognet	newmap->flags = 0;
294129198Scognet	dmat->map_count++;
295129198Scognet
296140313Scognet	CTR3(KTR_BUSDMA, "bus_dmamap_create: tag %p tag flags 0x%x error %d",
297140313Scognet	    dmat, dmat->flags, error);
298140313Scognet
299129198Scognet	return (0);
300129198Scognet}
301129198Scognet
302129198Scognet/*
303129198Scognet * Destroy a handle for mapping from kva/uva/physical
304129198Scognet * address space into bus device space.
305129198Scognet */
306129198Scognetint
307129198Scognetbus_dmamap_destroy(bus_dma_tag_t dmat, bus_dmamap_t map)
308129198Scognet{
309135644Scognet
310129198Scognet	free(map, M_DEVBUF);
311129198Scognet        dmat->map_count--;
312140313Scognet	CTR1(KTR_BUSDMA, "bus_dmamap_destroy: tag %p error 0", dmat);
313129198Scognet        return (0);
314129198Scognet}
315129198Scognet
316129198Scognet/*
317129198Scognet * Allocate a piece of memory that can be efficiently mapped into
318129198Scognet * bus device space based on the constraints lited in the dma tag.
319129198Scognet * A dmamap to for use with dmamap_load is also allocated.
320129198Scognet */
321129198Scognetint
322129198Scognetbus_dmamem_alloc(bus_dma_tag_t dmat, void** vaddr, int flags,
323129198Scognet                 bus_dmamap_t *mapp)
324129198Scognet{
325135644Scognet	bus_dmamap_t newmap = NULL;
326129198Scognet
327129198Scognet	int mflags;
328129198Scognet
329129198Scognet	if (flags & BUS_DMA_NOWAIT)
330129198Scognet		mflags = M_NOWAIT;
331129198Scognet	else
332129198Scognet		mflags = M_WAITOK;
333129198Scognet	if (flags & BUS_DMA_ZERO)
334129198Scognet		mflags |= M_ZERO;
335129198Scognet
336135644Scognet	if (!*mapp) {
337135644Scognet		newmap = malloc(sizeof(*newmap), M_DEVBUF, M_NOWAIT | M_ZERO);
338140313Scognet		if (newmap == NULL) {
339140313Scognet			CTR3(KTR_BUSDMA, "bus_dmamem_alloc: tag %p tag "
340140313Scognet			    "flags %0x%x error Md", dmat, dmat->flags, ENOMEM);
341135644Scognet			return (ENOMEM);
342140313Scognet		}
343135644Scognet		dmat->map_count++;
344135644Scognet		newmap->flags = 0;
345135644Scognet		*mapp = newmap;
346135644Scognet		newmap->dmat = dmat;
347135644Scognet	}
348135644Scognet
349129198Scognet        if (dmat->maxsize <= PAGE_SIZE) {
350129198Scognet                *vaddr = malloc(dmat->maxsize, M_DEVBUF, mflags);
351129198Scognet        } else {
352129198Scognet                /*
353129198Scognet                 * XXX Use Contigmalloc until it is merged into this facility
354129198Scognet                 *     and handles multi-seg allocations.  Nobody is doing
355129198Scognet                 *     multi-seg allocations yet though.
356129198Scognet                 */
357129198Scognet                *vaddr = contigmalloc(dmat->maxsize, M_DEVBUF, mflags,
358129198Scognet                    0ul, dmat->lowaddr, dmat->alignment? dmat->alignment : 1ul,
359129198Scognet                    dmat->boundary);
360129198Scognet        }
361140313Scognet        if (*vaddr == NULL) {
362140313Scognet		if (newmap != NULL) {
363140313Scognet			free(newmap, M_DEVBUF);
364140313Scognet			dmat->map_count--;
365140313Scognet		}
366129198Scognet		*mapp = NULL;
367129198Scognet                return (ENOMEM);
368129198Scognet	}
369129198Scognet        return (0);
370129198Scognet}
371129198Scognet
372129198Scognet/*
373129198Scognet * Free a piece of memory and it's allocated dmamap, that was allocated
374129198Scognet * via bus_dmamem_alloc.  Make the same choice for free/contigfree.
375129198Scognet */
376129198Scognetvoid
377129198Scognetbus_dmamem_free(bus_dma_tag_t dmat, void *vaddr, bus_dmamap_t map)
378129198Scognet{
379129198Scognet        if (dmat->maxsize <= PAGE_SIZE)
380129198Scognet		free(vaddr, M_DEVBUF);
381129198Scognet        else {
382129198Scognet		contigfree(vaddr, dmat->maxsize, M_DEVBUF);
383129198Scognet	}
384135644Scognet	dmat->map_count--;
385129198Scognet	free(map, M_DEVBUF);
386140313Scognet	CTR2(KTR_BUSDMA, "bus_dmamem_free: tag %p flags 0x%x", dmat,
387140313Scognet	    dmat->flags);
388129198Scognet}
389129198Scognet
390129198Scognet/*
391129198Scognet * Utility function to load a linear buffer.  lastaddrp holds state
392129198Scognet * between invocations (for multiple-buffer loads).  segp contains
393129198Scognet * the starting segment on entrance, and the ending segment on exit.
394129198Scognet * first indicates if this is the first invocation of this function.
395129198Scognet */
396137758Scognetstatic int __inline
397140349Scognetbus_dmamap_load_buffer(bus_dma_tag_t dmat, bus_dma_segment_t *segs,
398137758Scognet    bus_dmamap_t map, void *buf, bus_size_t buflen, struct pmap *pmap,
399137760Scognet    int flags, vm_offset_t *lastaddrp, int *segp)
400129198Scognet{
401129198Scognet	bus_size_t sgsize;
402129198Scognet	bus_addr_t curaddr, lastaddr, baddr, bmask;
403129198Scognet	vm_offset_t vaddr = (vm_offset_t)buf;
404129198Scognet	int seg;
405129198Scognet	int error = 0;
406129198Scognet	pd_entry_t *pde;
407129198Scognet	pt_entry_t pte;
408129198Scognet	pt_entry_t *ptep;
409129198Scognet
410129198Scognet	lastaddr = *lastaddrp;
411129198Scognet	bmask = ~(dmat->boundary - 1);
412129198Scognet
413140313Scognet	CTR3(KTR_BUSDMA, "lowaddr= %d boundary= %d, "
414140313Scognet	    "alignment= %d", dmat->lowaddr, dmat->boundary, dmat->alignment);
415140313Scognet
416129198Scognet	for (seg = *segp; buflen > 0 ; ) {
417129198Scognet		/*
418129198Scognet		 * Get the physical address for this segment.
419129198Scognet		 *
420129198Scognet		 * XXX Don't support checking for coherent mappings
421129198Scognet		 * XXX in user address space.
422129198Scognet		 */
423129198Scognet		if (__predict_true(pmap == pmap_kernel())) {
424129198Scognet			(void) pmap_get_pde_pte(pmap, vaddr, &pde, &ptep);
425129198Scognet			if (__predict_false(pmap_pde_section(pde))) {
426129198Scognet				curaddr = (*pde & L1_S_FRAME) |
427129198Scognet				    (vaddr & L1_S_OFFSET);
428129198Scognet				if (*pde & L1_S_CACHE_MASK) {
429129198Scognet					map->flags &=
430135644Scognet					    ~DMAMAP_COHERENT;
431129198Scognet				}
432129198Scognet			} else {
433129198Scognet				pte = *ptep;
434129198Scognet				KASSERT((pte & L2_TYPE_MASK) != L2_TYPE_INV,
435132514Scognet				    ("INV type"));
436129198Scognet				if (__predict_false((pte & L2_TYPE_MASK)
437129198Scognet						    == L2_TYPE_L)) {
438129198Scognet					curaddr = (pte & L2_L_FRAME) |
439129198Scognet					    (vaddr & L2_L_OFFSET);
440129198Scognet					if (pte & L2_L_CACHE_MASK) {
441129198Scognet						map->flags &=
442135644Scognet						    ~DMAMAP_COHERENT;
443135644Scognet
444129198Scognet					}
445129198Scognet				} else {
446129198Scognet					curaddr = (pte & L2_S_FRAME) |
447129198Scognet					    (vaddr & L2_S_OFFSET);
448129198Scognet					if (pte & L2_S_CACHE_MASK) {
449129198Scognet						map->flags &=
450135644Scognet						    ~DMAMAP_COHERENT;
451129198Scognet					}
452129198Scognet				}
453129198Scognet			}
454129198Scognet		} else {
455129198Scognet			curaddr = pmap_extract(pmap, vaddr);
456135644Scognet			map->flags &= ~DMAMAP_COHERENT;
457129198Scognet		}
458129198Scognet
459135644Scognet		if (dmat->ranges) {
460135644Scognet			struct arm32_dma_range *dr;
461135644Scognet
462135644Scognet			dr = _bus_dma_inrange(dmat->ranges, dmat->_nranges,
463135644Scognet			    curaddr);
464135644Scognet			if (dr == NULL)
465135644Scognet				return (EINVAL);
466135644Scognet			/*
467135644Scognet		     	 * In a valid DMA range.  Translate the physical
468135644Scognet			 * memory address to an address in the DMA window.
469135644Scognet			 */
470135644Scognet			curaddr = (curaddr - dr->dr_sysbase) + dr->dr_busbase;
471135644Scognet
472135644Scognet		}
473129198Scognet		/*
474129198Scognet		 * Compute the segment size, and adjust counts.
475129198Scognet		 */
476129198Scognet		sgsize = PAGE_SIZE - ((u_long)curaddr & PAGE_MASK);
477129198Scognet		if (buflen < sgsize)
478129198Scognet			sgsize = buflen;
479129198Scognet
480129198Scognet		/*
481129198Scognet		 * Make sure we don't cross any boundaries.
482129198Scognet		 */
483129198Scognet		if (dmat->boundary > 0) {
484129198Scognet			baddr = (curaddr + dmat->boundary) & bmask;
485129198Scognet			if (sgsize > (baddr - curaddr))
486129198Scognet				sgsize = (baddr - curaddr);
487129198Scognet		}
488129198Scognet
489129198Scognet		/*
490129198Scognet		 * Insert chunk into a segment, coalescing with
491129198Scognet		 * the previous segment if possible.
492129198Scognet		 */
493137760Scognet		if (seg >= 0 && curaddr == lastaddr &&
494137760Scognet		    (segs[seg].ds_len + sgsize) <= dmat->maxsegsz &&
495137760Scognet		    (dmat->boundary == 0 ||
496137760Scognet		     (segs[seg].ds_addr & bmask) ==
497137760Scognet		     (curaddr & bmask))) {
498137760Scognet			segs[seg].ds_len += sgsize;
499140349Scognet			goto segdone;
500137760Scognet		} else {
501137760Scognet			if (++seg >= dmat->nsegments)
502137760Scognet				break;
503129198Scognet			segs[seg].ds_addr = curaddr;
504129198Scognet			segs[seg].ds_len = sgsize;
505129198Scognet		}
506135644Scognet		if (error)
507135644Scognet			break;
508135644Scognetsegdone:
509129198Scognet		lastaddr = curaddr + sgsize;
510129198Scognet		vaddr += sgsize;
511129198Scognet		buflen -= sgsize;
512129198Scognet	}
513129198Scognet
514129198Scognet	*segp = seg;
515129198Scognet	*lastaddrp = lastaddr;
516129198Scognet
517129198Scognet	/*
518129198Scognet	 * Did we fit?
519129198Scognet	 */
520129198Scognet	if (buflen != 0)
521129198Scognet		error = EFBIG; /* XXX better return value here? */
522129198Scognet	return (error);
523129198Scognet}
524129198Scognet
525129198Scognet/*
526140682Scognet * Map the buffer buf into bus space using the dmamap map.
527140682Scognet */
528140682Scognetint
529140682Scognetbus_dmamap_load(bus_dma_tag_t dmat, bus_dmamap_t map, void *buf,
530140682Scognet                bus_size_t buflen, bus_dmamap_callback_t *callback,
531140682Scognet                void *callback_arg, int flags)
532140682Scognet{
533140682Scognet     	vm_offset_t	lastaddr = 0;
534140682Scognet	int		error, nsegs = -1;
535140682Scognet#ifdef __GNUC__
536140682Scognet	bus_dma_segment_t dm_segments[dmat->nsegments];
537140682Scognet#else
538140682Scognet	bus_dma_segment_t dm_segments[BUS_DMAMAP_NSEGS];
539140682Scognet#endif
540140682Scognet
541140682Scognet	map->flags &= ~DMAMAP_TYPE_MASK;
542140682Scognet	map->flags |= DMAMAP_LINEAR|DMAMAP_COHERENT;
543140682Scognet	map->buffer = buf;
544140682Scognet	map->len = buflen;
545140682Scognet	error = bus_dmamap_load_buffer(dmat,
546140682Scognet	    dm_segments, map, buf, buflen, kernel_pmap,
547140682Scognet	    flags, &lastaddr, &nsegs);
548140682Scognet	if (error)
549140682Scognet		(*callback)(callback_arg, NULL, 0, error);
550140682Scognet	else
551140682Scognet		(*callback)(callback_arg, dm_segments, nsegs + 1, error);
552140682Scognet
553140682Scognet	CTR4(KTR_BUSDMA, "bus_dmamap_load: tag %p tag flags 0x%x error %d "
554140682Scognet	    "nsegs %d", dmat, dmat->flags, nsegs + 1, error);
555140682Scognet
556140682Scognet	return (0);
557140682Scognet}
558140682Scognet
559140682Scognet/*
560129198Scognet * Like bus_dmamap_load(), but for mbufs.
561129198Scognet */
562129198Scognetint
563129198Scognetbus_dmamap_load_mbuf(bus_dma_tag_t dmat, bus_dmamap_t map, struct mbuf *m0,
564129198Scognet		     bus_dmamap_callback2_t *callback, void *callback_arg,
565129198Scognet		     int flags)
566129198Scognet{
567129198Scognet#ifdef __GNUC__
568129198Scognet	bus_dma_segment_t dm_segments[dmat->nsegments];
569129198Scognet#else
570129198Scognet	bus_dma_segment_t dm_segments[BUS_DMAMAP_NSEGS];
571129198Scognet#endif
572137760Scognet	int nsegs = -1, error = 0;
573129198Scognet
574129198Scognet	M_ASSERTPKTHDR(m0);
575129198Scognet
576135644Scognet	map->flags &= ~DMAMAP_TYPE_MASK;
577135644Scognet	map->flags |= DMAMAP_MBUF | DMAMAP_COHERENT;
578135644Scognet	map->buffer = m0;
579129198Scognet	if (m0->m_pkthdr.len <= dmat->maxsize) {
580129198Scognet		vm_offset_t lastaddr = 0;
581129198Scognet		struct mbuf *m;
582129198Scognet
583129198Scognet		for (m = m0; m != NULL && error == 0; m = m->m_next) {
584137760Scognet			if (m->m_len > 0)
585129198Scognet				error = bus_dmamap_load_buffer(dmat,
586137758Scognet				    dm_segments, map, m->m_data, m->m_len,
587137760Scognet				    pmap_kernel(), flags, &lastaddr, &nsegs);
588129198Scognet		}
589129198Scognet	} else {
590129198Scognet		error = EINVAL;
591129198Scognet	}
592129198Scognet
593129198Scognet	if (error) {
594129198Scognet		/*
595129198Scognet		 * force "no valid mappings" on error in callback.
596129198Scognet		 */
597129198Scognet		(*callback)(callback_arg, dm_segments, 0, 0, error);
598129198Scognet	} else {
599135644Scognet		(*callback)(callback_arg, dm_segments, nsegs + 1,
600129198Scognet		    m0->m_pkthdr.len, error);
601129198Scognet	}
602140313Scognet	CTR4(KTR_BUSDMA, "bus_dmamap_load_mbuf: tag %p tag flags 0x%x "
603140313Scognet	    "error %d nsegs %d", dmat, dmat->flags, error, nsegs + 1);
604140313Scognet
605129198Scognet	return (error);
606129198Scognet}
607129198Scognet
608140310Scognetint
609140310Scognetbus_dmamap_load_mbuf_sg(bus_dma_tag_t dmat, bus_dmamap_t map,
610140310Scognet			struct mbuf *m0, bus_dma_segment_t *segs, int *nsegs,
611140310Scognet			int flags)
612140310Scognet{
613140310Scognet	int error = 0;
614140310Scognet	M_ASSERTPKTHDR(m0);
615140310Scognet
616140310Scognet	flags |= BUS_DMA_NOWAIT;
617140310Scognet	*nsegs = -1;
618140349Scognet	map->flags &= ~DMAMAP_TYPE_MASK;
619140349Scognet	map->flags |= DMAMAP_MBUF | DMAMAP_COHERENT;
620140349Scognet	map->buffer = m0;
621140310Scognet	if (m0->m_pkthdr.len <= dmat->maxsize) {
622140310Scognet		vm_offset_t lastaddr = 0;
623140310Scognet		struct mbuf *m;
624140310Scognet
625140310Scognet		for (m = m0; m != NULL && error == 0; m = m->m_next) {
626140310Scognet			if (m->m_len > 0) {
627140310Scognet				error = bus_dmamap_load_buffer(dmat, segs, map,
628140310Scognet						m->m_data, m->m_len,
629140310Scognet						pmap_kernel(), flags, &lastaddr,
630140310Scognet						nsegs);
631140310Scognet			}
632140310Scognet		}
633140310Scognet	} else {
634140310Scognet		error = EINVAL;
635140310Scognet	}
636140310Scognet
637140310Scognet	/* XXX FIXME: Having to increment nsegs is really annoying */
638140310Scognet	++*nsegs;
639140310Scognet	CTR4(KTR_BUSDMA, "bus_dmamap_load_mbuf: tag %p tag flags 0x%x "
640140310Scognet	    "error %d nsegs %d", dmat, dmat->flags, error, *nsegs);
641140310Scognet	return (error);
642140310Scognet}
643140310Scognet
644129198Scognet/*
645129198Scognet * Like bus_dmamap_load(), but for uios.
646129198Scognet */
647129198Scognetint
648129198Scognetbus_dmamap_load_uio(bus_dma_tag_t dmat, bus_dmamap_t map, struct uio *uio,
649129198Scognet    bus_dmamap_callback2_t *callback, void *callback_arg,
650129198Scognet    int flags)
651129198Scognet{
652129198Scognet	vm_offset_t lastaddr;
653129198Scognet#ifdef __GNUC__
654129198Scognet	bus_dma_segment_t dm_segments[dmat->nsegments];
655129198Scognet#else
656129198Scognet	bus_dma_segment_t dm_segments[BUS_DMAMAP_NSEGS];
657129198Scognet#endif
658137760Scognet	int nsegs, i, error;
659129198Scognet	bus_size_t resid;
660129198Scognet	struct iovec *iov;
661137758Scognet	struct pmap *pmap;
662129198Scognet
663129198Scognet	resid = uio->uio_resid;
664129198Scognet	iov = uio->uio_iov;
665135644Scognet	map->flags &= ~DMAMAP_TYPE_MASK;
666135644Scognet	map->flags |= DMAMAP_UIO|DMAMAP_COHERENT;
667135644Scognet	map->buffer = uio;
668129198Scognet
669129198Scognet	if (uio->uio_segflg == UIO_USERSPACE) {
670138683Scognet		KASSERT(uio->uio_td != NULL,
671138683Scognet		    ("bus_dmamap_load_uio: USERSPACE but no proc"));
672137758Scognet		pmap = vmspace_pmap(uio->uio_td->td_proc->p_vmspace);
673137758Scognet	} else
674137758Scognet		pmap = kernel_pmap;
675129198Scognet
676137760Scognet	error = 0;
677137760Scognet	nsegs = -1;
678129198Scognet	for (i = 0; i < uio->uio_iovcnt && resid != 0 && !error; i++) {
679129198Scognet		/*
680129198Scognet		 * Now at the first iovec to load.  Load each iovec
681129198Scognet		 * until we have exhausted the residual count.
682129198Scognet		 */
683129198Scognet		bus_size_t minlen =
684129198Scognet		    resid < iov[i].iov_len ? resid : iov[i].iov_len;
685129198Scognet		caddr_t addr = (caddr_t) iov[i].iov_base;
686129198Scognet
687129198Scognet		if (minlen > 0) {
688129198Scognet			error = bus_dmamap_load_buffer(dmat, dm_segments, map,
689137760Scognet			    addr, minlen, pmap, flags, &lastaddr, &nsegs);
690129198Scognet
691129198Scognet			resid -= minlen;
692129198Scognet		}
693129198Scognet	}
694129198Scognet
695129198Scognet	if (error) {
696129198Scognet		/*
697129198Scognet		 * force "no valid mappings" on error in callback.
698129198Scognet		 */
699129198Scognet		(*callback)(callback_arg, dm_segments, 0, 0, error);
700129198Scognet	} else {
701129198Scognet		(*callback)(callback_arg, dm_segments, nsegs+1,
702129198Scognet		    uio->uio_resid, error);
703129198Scognet	}
704129198Scognet
705140313Scognet	CTR4(KTR_BUSDMA, "bus_dmamap_load_uio: tag %p tag flags 0x%x "
706140313Scognet	    "error %d nsegs %d", dmat, dmat->flags, error, nsegs + 1);
707129198Scognet	return (error);
708129198Scognet}
709129198Scognet
710129198Scognet/*
711135644Scognet * Release the mapping held by map.
712129198Scognet */
713129198Scognetvoid
714129198Scognetbus_dmamap_unload(bus_dma_tag_t dmat, bus_dmamap_t map)
715129198Scognet{
716135644Scognet	map->flags &= ~DMAMAP_TYPE_MASK;
717129198Scognet	return;
718129198Scognet}
719129198Scognet
720135644Scognetstatic void
721135644Scognetbus_dmamap_sync_buf(void *buf, int len, bus_dmasync_op_t op)
722135644Scognet{
723135644Scognet
724135644Scognet	if (op & BUS_DMASYNC_POSTREAD ||
725135644Scognet	    op == (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE)) {
726135644Scognet		cpu_dcache_wbinv_range((vm_offset_t)buf, len);
727135644Scognet		return;
728135644Scognet	}
729135644Scognet	if (op & BUS_DMASYNC_PREWRITE)
730135644Scognet		cpu_dcache_wb_range((vm_offset_t)buf, len);
731135644Scognet	if (op & BUS_DMASYNC_PREREAD) {
732135644Scognet		if ((((vm_offset_t)buf | len) & arm_dcache_align_mask) == 0)
733135644Scognet 			cpu_dcache_inv_range((vm_offset_t)buf, len);
734135644Scognet		else
735135644Scognet			cpu_dcache_wbinv_range((vm_offset_t)buf, len);
736135644Scognet	}
737135644Scognet}
738135644Scognet
739129198Scognetvoid
740129198Scognetbus_dmamap_sync(bus_dma_tag_t dmat, bus_dmamap_t map, bus_dmasync_op_t op)
741129198Scognet{
742135644Scognet	struct mbuf *m;
743135644Scognet	struct uio *uio;
744135644Scognet	int resid;
745135644Scognet	struct iovec *iov;
746135644Scognet
747136743Scognet	if (op == BUS_DMASYNC_POSTWRITE)
748129198Scognet		return;
749135644Scognet	if (map->flags & DMAMAP_COHERENT)
750129198Scognet		return;
751140313Scognet	CTR2(KTR_BUSDMA, "bus_dmamap_sync: op %x flags %x", op, map->flags);
752135644Scognet	switch(map->flags & DMAMAP_TYPE_MASK) {
753135644Scognet	case DMAMAP_LINEAR:
754135644Scognet		bus_dmamap_sync_buf(map->buffer, map->len, op);
755135644Scognet		break;
756135644Scognet	case DMAMAP_MBUF:
757135644Scognet		m = map->buffer;
758135644Scognet		while (m) {
759135644Scognet			bus_dmamap_sync_buf(m->m_data, m->m_len, op);
760135644Scognet			m = m->m_next;
761135644Scognet		}
762135644Scognet		break;
763135644Scognet	case DMAMAP_UIO:
764135644Scognet		uio = map->buffer;
765135644Scognet		iov = uio->uio_iov;
766135644Scognet		resid = uio->uio_resid;
767135644Scognet		for (int i = 0; i < uio->uio_iovcnt && resid != 0; i++) {
768135644Scognet			bus_size_t minlen = resid < iov[i].iov_len ? resid :
769135644Scognet			    iov[i].iov_len;
770135644Scognet			if (minlen > 0) {
771135644Scognet				bus_dmamap_sync_buf(iov[i].iov_base, minlen,
772135644Scognet				    op);
773135644Scognet				resid -= minlen;
774135644Scognet			}
775135644Scognet		}
776135644Scognet		break;
777135644Scognet	default:
778135644Scognet		break;
779129198Scognet	}
780135644Scognet	cpu_drain_writebuf();
781129198Scognet}
782