bus_dma.c revision 1.132 1 1.132 skrll /* $NetBSD: bus_dma.c,v 1.132 2021/02/07 10:47:40 skrll Exp $ */
2 1.1 chris
3 1.1 chris /*-
4 1.121 ad * Copyright (c) 1996, 1997, 1998, 2020 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 *
20 1.1 chris * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
21 1.1 chris * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 1.1 chris * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 1.1 chris * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
24 1.1 chris * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25 1.1 chris * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26 1.1 chris * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27 1.1 chris * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28 1.1 chris * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 1.1 chris * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 1.1 chris * POSSIBILITY OF SUCH DAMAGE.
31 1.1 chris */
32 1.33 lukem
33 1.35 rearnsha #define _ARM32_BUS_DMA_PRIVATE
34 1.35 rearnsha
35 1.81 matt #include "opt_arm_bus_space.h"
36 1.107 ryo #include "opt_cputypes.h"
37 1.81 matt
38 1.33 lukem #include <sys/cdefs.h>
39 1.132 skrll __KERNEL_RCSID(0, "$NetBSD: bus_dma.c,v 1.132 2021/02/07 10:47:40 skrll Exp $");
40 1.1 chris
41 1.1 chris #include <sys/param.h>
42 1.122 skrll
43 1.84 matt #include <sys/bus.h>
44 1.84 matt #include <sys/cpu.h>
45 1.81 matt #include <sys/kmem.h>
46 1.1 chris #include <sys/mbuf.h>
47 1.1 chris
48 1.53 uebayasi #include <uvm/uvm.h>
49 1.1 chris
50 1.107 ryo #include <arm/cpuconf.h>
51 1.84 matt #include <arm/cpufunc.h>
52 1.4 thorpej
53 1.84 matt #ifdef __HAVE_MM_MD_DIRECT_MAPPED_PHYS
54 1.84 matt #include <dev/mm.h>
55 1.84 matt #endif
56 1.1 chris
57 1.76 matt #ifdef BUSDMA_COUNTERS
58 1.58 matt static struct evcnt bus_dma_creates =
59 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "creates");
60 1.58 matt static struct evcnt bus_dma_bounced_creates =
61 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "bounced creates");
62 1.58 matt static struct evcnt bus_dma_loads =
63 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "loads");
64 1.58 matt static struct evcnt bus_dma_bounced_loads =
65 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "bounced loads");
66 1.81 matt static struct evcnt bus_dma_coherent_loads =
67 1.81 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "coherent loads");
68 1.58 matt static struct evcnt bus_dma_read_bounces =
69 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "read bounces");
70 1.58 matt static struct evcnt bus_dma_write_bounces =
71 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "write bounces");
72 1.58 matt static struct evcnt bus_dma_bounced_unloads =
73 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "bounced unloads");
74 1.58 matt static struct evcnt bus_dma_unloads =
75 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "unloads");
76 1.58 matt static struct evcnt bus_dma_bounced_destroys =
77 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "bounced destroys");
78 1.58 matt static struct evcnt bus_dma_destroys =
79 1.58 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "destroys");
80 1.95 skrll static struct evcnt bus_dma_sync_prereadwrite =
81 1.76 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync prereadwrite");
82 1.76 matt static struct evcnt bus_dma_sync_preread_begin =
83 1.76 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync preread begin");
84 1.76 matt static struct evcnt bus_dma_sync_preread =
85 1.76 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync preread");
86 1.76 matt static struct evcnt bus_dma_sync_preread_tail =
87 1.76 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync preread tail");
88 1.95 skrll static struct evcnt bus_dma_sync_prewrite =
89 1.76 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync prewrite");
90 1.95 skrll static struct evcnt bus_dma_sync_postread =
91 1.76 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync postread");
92 1.95 skrll static struct evcnt bus_dma_sync_postreadwrite =
93 1.76 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync postreadwrite");
94 1.95 skrll static struct evcnt bus_dma_sync_postwrite =
95 1.76 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync postwrite");
96 1.58 matt
97 1.129 skrll static struct evcnt bus_dma_sync_coherent_prereadwrite =
98 1.129 skrll EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync coherent prereadwrite");
99 1.129 skrll static struct evcnt bus_dma_sync_coherent_preread =
100 1.129 skrll EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync coherent preread");
101 1.129 skrll static struct evcnt bus_dma_sync_coherent_prewrite =
102 1.129 skrll EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync coherent prewrite");
103 1.129 skrll static struct evcnt bus_dma_sync_coherent_postread =
104 1.129 skrll EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync coherent postread");
105 1.129 skrll static struct evcnt bus_dma_sync_coherent_postreadwrite =
106 1.129 skrll EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync coherent postreadwrite");
107 1.129 skrll static struct evcnt bus_dma_sync_coherent_postwrite =
108 1.129 skrll EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "busdma", "sync coherent postwrite");
109 1.129 skrll
110 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_creates);
111 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_bounced_creates);
112 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_loads);
113 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_bounced_loads);
114 1.81 matt EVCNT_ATTACH_STATIC(bus_dma_coherent_loads);
115 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_read_bounces);
116 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_write_bounces);
117 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_unloads);
118 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_bounced_unloads);
119 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_destroys);
120 1.58 matt EVCNT_ATTACH_STATIC(bus_dma_bounced_destroys);
121 1.76 matt EVCNT_ATTACH_STATIC(bus_dma_sync_prereadwrite);
122 1.76 matt EVCNT_ATTACH_STATIC(bus_dma_sync_preread_begin);
123 1.76 matt EVCNT_ATTACH_STATIC(bus_dma_sync_preread);
124 1.76 matt EVCNT_ATTACH_STATIC(bus_dma_sync_preread_tail);
125 1.76 matt EVCNT_ATTACH_STATIC(bus_dma_sync_prewrite);
126 1.76 matt EVCNT_ATTACH_STATIC(bus_dma_sync_postread);
127 1.76 matt EVCNT_ATTACH_STATIC(bus_dma_sync_postreadwrite);
128 1.76 matt EVCNT_ATTACH_STATIC(bus_dma_sync_postwrite);
129 1.58 matt
130 1.129 skrll EVCNT_ATTACH_STATIC(bus_dma_sync_coherent_prereadwrite);
131 1.129 skrll EVCNT_ATTACH_STATIC(bus_dma_sync_coherent_preread);
132 1.129 skrll EVCNT_ATTACH_STATIC(bus_dma_sync_coherent_prewrite);
133 1.129 skrll EVCNT_ATTACH_STATIC(bus_dma_sync_coherent_postread);
134 1.129 skrll EVCNT_ATTACH_STATIC(bus_dma_sync_coherent_postreadwrite);
135 1.129 skrll EVCNT_ATTACH_STATIC(bus_dma_sync_coherent_postwrite);
136 1.129 skrll
137 1.58 matt #define STAT_INCR(x) (bus_dma_ ## x.ev_count++)
138 1.76 matt #else
139 1.107 ryo #define STAT_INCR(x) __nothing
140 1.76 matt #endif
141 1.58 matt
142 1.7 thorpej int _bus_dmamap_load_buffer(bus_dma_tag_t, bus_dmamap_t, void *,
143 1.48 yamt bus_size_t, struct vmspace *, int);
144 1.1 chris
145 1.1 chris /*
146 1.19 briggs * Check to see if the specified page is in an allowed DMA range.
147 1.19 briggs */
148 1.105 skrll static inline struct arm32_dma_range *
149 1.59 matt _bus_dma_paddr_inrange(struct arm32_dma_range *ranges, int nranges,
150 1.19 briggs bus_addr_t curaddr)
151 1.19 briggs {
152 1.19 briggs struct arm32_dma_range *dr;
153 1.19 briggs int i;
154 1.19 briggs
155 1.19 briggs for (i = 0, dr = ranges; i < nranges; i++, dr++) {
156 1.19 briggs if (curaddr >= dr->dr_sysbase &&
157 1.82 skrll curaddr < (dr->dr_sysbase + dr->dr_len))
158 1.100 skrll return dr;
159 1.19 briggs }
160 1.19 briggs
161 1.100 skrll return NULL;
162 1.19 briggs }
163 1.19 briggs
164 1.19 briggs /*
165 1.59 matt * Check to see if the specified busaddr is in an allowed DMA range.
166 1.59 matt */
167 1.59 matt static inline paddr_t
168 1.59 matt _bus_dma_busaddr_to_paddr(bus_dma_tag_t t, bus_addr_t curaddr)
169 1.59 matt {
170 1.59 matt struct arm32_dma_range *dr;
171 1.59 matt u_int i;
172 1.59 matt
173 1.59 matt if (t->_nranges == 0)
174 1.59 matt return curaddr;
175 1.59 matt
176 1.59 matt for (i = 0, dr = t->_ranges; i < t->_nranges; i++, dr++) {
177 1.59 matt if (dr->dr_busbase <= curaddr
178 1.82 skrll && curaddr < dr->dr_busbase + dr->dr_len)
179 1.59 matt return curaddr - dr->dr_busbase + dr->dr_sysbase;
180 1.59 matt }
181 1.59 matt panic("%s: curaddr %#lx not in range", __func__, curaddr);
182 1.59 matt }
183 1.59 matt
184 1.59 matt /*
185 1.41 thorpej * Common function to load the specified physical address into the
186 1.41 thorpej * DMA map, coalescing segments and boundary checking as necessary.
187 1.41 thorpej */
188 1.41 thorpej static int
189 1.41 thorpej _bus_dmamap_load_paddr(bus_dma_tag_t t, bus_dmamap_t map,
190 1.61 matt bus_addr_t paddr, bus_size_t size, bool coherent)
191 1.41 thorpej {
192 1.41 thorpej bus_dma_segment_t * const segs = map->dm_segs;
193 1.41 thorpej int nseg = map->dm_nsegs;
194 1.58 matt bus_addr_t lastaddr;
195 1.41 thorpej bus_addr_t bmask = ~(map->_dm_boundary - 1);
196 1.41 thorpej bus_addr_t curaddr;
197 1.41 thorpej bus_size_t sgsize;
198 1.61 matt uint32_t _ds_flags = coherent ? _BUS_DMAMAP_COHERENT : 0;
199 1.41 thorpej
200 1.41 thorpej if (nseg > 0)
201 1.101 skrll lastaddr = segs[nseg - 1].ds_addr + segs[nseg - 1].ds_len;
202 1.58 matt else
203 1.58 matt lastaddr = 0xdead;
204 1.95 skrll
205 1.41 thorpej again:
206 1.41 thorpej sgsize = size;
207 1.41 thorpej
208 1.41 thorpej /* Make sure we're in an allowed DMA range. */
209 1.41 thorpej if (t->_ranges != NULL) {
210 1.41 thorpej /* XXX cache last result? */
211 1.41 thorpej const struct arm32_dma_range * const dr =
212 1.59 matt _bus_dma_paddr_inrange(t->_ranges, t->_nranges, paddr);
213 1.41 thorpej if (dr == NULL)
214 1.100 skrll return EINVAL;
215 1.61 matt
216 1.61 matt /*
217 1.61 matt * If this region is coherent, mark the segment as coherent.
218 1.61 matt */
219 1.61 matt _ds_flags |= dr->dr_flags & _BUS_DMAMAP_COHERENT;
220 1.72 skrll
221 1.41 thorpej /*
222 1.41 thorpej * In a valid DMA range. Translate the physical
223 1.41 thorpej * memory address to an address in the DMA window.
224 1.41 thorpej */
225 1.41 thorpej curaddr = (paddr - dr->dr_sysbase) + dr->dr_busbase;
226 1.72 skrll #if 0
227 1.72 skrll printf("%p: %#lx: range %#lx/%#lx/%#lx/%#x: %#x <-- %#lx\n",
228 1.72 skrll t, paddr, dr->dr_sysbase, dr->dr_busbase,
229 1.72 skrll dr->dr_len, dr->dr_flags, _ds_flags, curaddr);
230 1.72 skrll #endif
231 1.41 thorpej } else
232 1.41 thorpej curaddr = paddr;
233 1.41 thorpej
234 1.41 thorpej /*
235 1.41 thorpej * Make sure we don't cross any boundaries.
236 1.41 thorpej */
237 1.41 thorpej if (map->_dm_boundary > 0) {
238 1.41 thorpej bus_addr_t baddr; /* next boundary address */
239 1.41 thorpej
240 1.41 thorpej baddr = (curaddr + map->_dm_boundary) & bmask;
241 1.41 thorpej if (sgsize > (baddr - curaddr))
242 1.41 thorpej sgsize = (baddr - curaddr);
243 1.41 thorpej }
244 1.41 thorpej
245 1.41 thorpej /*
246 1.41 thorpej * Insert chunk into a segment, coalescing with the
247 1.41 thorpej * previous segment if possible.
248 1.41 thorpej */
249 1.41 thorpej if (nseg > 0 && curaddr == lastaddr &&
250 1.101 skrll segs[nseg - 1].ds_len + sgsize <= map->dm_maxsegsz &&
251 1.101 skrll ((segs[nseg - 1]._ds_flags ^ _ds_flags) & _BUS_DMAMAP_COHERENT) == 0 &&
252 1.41 thorpej (map->_dm_boundary == 0 ||
253 1.101 skrll (segs[nseg - 1].ds_addr & bmask) == (curaddr & bmask))) {
254 1.41 thorpej /* coalesce */
255 1.101 skrll segs[nseg - 1].ds_len += sgsize;
256 1.41 thorpej } else if (nseg >= map->_dm_segcnt) {
257 1.100 skrll return EFBIG;
258 1.41 thorpej } else {
259 1.41 thorpej /* new segment */
260 1.41 thorpej segs[nseg].ds_addr = curaddr;
261 1.41 thorpej segs[nseg].ds_len = sgsize;
262 1.61 matt segs[nseg]._ds_flags = _ds_flags;
263 1.41 thorpej nseg++;
264 1.41 thorpej }
265 1.41 thorpej
266 1.41 thorpej lastaddr = curaddr + sgsize;
267 1.41 thorpej
268 1.41 thorpej paddr += sgsize;
269 1.41 thorpej size -= sgsize;
270 1.41 thorpej if (size > 0)
271 1.41 thorpej goto again;
272 1.61 matt
273 1.61 matt map->_dm_flags &= (_ds_flags & _BUS_DMAMAP_COHERENT);
274 1.41 thorpej map->dm_nsegs = nseg;
275 1.100 skrll return 0;
276 1.41 thorpej }
277 1.41 thorpej
278 1.115 skrll static int _bus_dma_uiomove(void *buf, struct uio *uio, size_t n,
279 1.115 skrll int direction);
280 1.115 skrll
281 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
282 1.58 matt static int _bus_dma_alloc_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map,
283 1.58 matt bus_size_t size, int flags);
284 1.58 matt static void _bus_dma_free_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map);
285 1.58 matt
286 1.58 matt static int
287 1.58 matt _bus_dma_load_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map, void *buf,
288 1.58 matt size_t buflen, int buftype, int flags)
289 1.58 matt {
290 1.58 matt struct arm32_bus_dma_cookie * const cookie = map->_dm_cookie;
291 1.58 matt struct vmspace * const vm = vmspace_kernel();
292 1.58 matt int error;
293 1.58 matt
294 1.58 matt KASSERT(cookie != NULL);
295 1.58 matt KASSERT(cookie->id_flags & _BUS_DMA_MIGHT_NEED_BOUNCE);
296 1.58 matt
297 1.58 matt /*
298 1.58 matt * Allocate bounce pages, if necessary.
299 1.58 matt */
300 1.58 matt if ((cookie->id_flags & _BUS_DMA_HAS_BOUNCE) == 0) {
301 1.58 matt error = _bus_dma_alloc_bouncebuf(t, map, buflen, flags);
302 1.58 matt if (error)
303 1.100 skrll return error;
304 1.58 matt }
305 1.58 matt
306 1.58 matt /*
307 1.58 matt * Cache a pointer to the caller's buffer and load the DMA map
308 1.58 matt * with the bounce buffer.
309 1.58 matt */
310 1.58 matt cookie->id_origbuf = buf;
311 1.58 matt cookie->id_origbuflen = buflen;
312 1.58 matt error = _bus_dmamap_load_buffer(t, map, cookie->id_bouncebuf,
313 1.58 matt buflen, vm, flags);
314 1.58 matt if (error)
315 1.100 skrll return error;
316 1.58 matt
317 1.58 matt STAT_INCR(bounced_loads);
318 1.58 matt map->dm_mapsize = buflen;
319 1.58 matt map->_dm_vmspace = vm;
320 1.58 matt map->_dm_buftype = buftype;
321 1.58 matt
322 1.58 matt /* ...so _bus_dmamap_sync() knows we're bouncing */
323 1.63 matt map->_dm_flags |= _BUS_DMAMAP_IS_BOUNCING;
324 1.58 matt cookie->id_flags |= _BUS_DMA_IS_BOUNCING;
325 1.58 matt return 0;
326 1.58 matt }
327 1.58 matt #endif /* _ARM32_NEED_BUS_DMA_BOUNCE */
328 1.58 matt
329 1.41 thorpej /*
330 1.1 chris * Common function for DMA map creation. May be called by bus-specific
331 1.1 chris * DMA map creation functions.
332 1.1 chris */
333 1.1 chris int
334 1.7 thorpej _bus_dmamap_create(bus_dma_tag_t t, bus_size_t size, int nsegments,
335 1.7 thorpej bus_size_t maxsegsz, bus_size_t boundary, int flags, bus_dmamap_t *dmamp)
336 1.1 chris {
337 1.1 chris struct arm32_bus_dmamap *map;
338 1.1 chris void *mapstore;
339 1.120 skrll int error = 0;
340 1.1 chris
341 1.1 chris #ifdef DEBUG_DMA
342 1.130 skrll printf("dmamap_create: t=%p size=%#lx nseg=%#x msegsz=%#lx boundary=%#lx"
343 1.130 skrll " flags=%#x\n", t, size, nsegments, maxsegsz, boundary, flags);
344 1.1 chris #endif /* DEBUG_DMA */
345 1.1 chris
346 1.1 chris /*
347 1.1 chris * Allocate and initialize the DMA map. The end of the map
348 1.1 chris * is a variable-sized array of segments, so we allocate enough
349 1.1 chris * room for them in one shot.
350 1.1 chris *
351 1.1 chris * Note we don't preserve the WAITOK or NOWAIT flags. Preservation
352 1.1 chris * of ALLOCNOW notifies others that we've reserved these resources,
353 1.1 chris * and they are not to be freed.
354 1.1 chris *
355 1.1 chris * The bus_dmamap_t includes one bus_dma_segment_t, hence
356 1.1 chris * the (nsegments - 1).
357 1.1 chris */
358 1.81 matt const size_t mapsize = sizeof(struct arm32_bus_dmamap) +
359 1.1 chris (sizeof(bus_dma_segment_t) * (nsegments - 1));
360 1.81 matt const int zallocflags = (flags & BUS_DMA_NOWAIT) ? KM_NOSLEEP : KM_SLEEP;
361 1.81 matt if ((mapstore = kmem_intr_zalloc(mapsize, zallocflags)) == NULL)
362 1.100 skrll return ENOMEM;
363 1.1 chris
364 1.1 chris map = (struct arm32_bus_dmamap *)mapstore;
365 1.1 chris map->_dm_size = size;
366 1.1 chris map->_dm_segcnt = nsegments;
367 1.43 matt map->_dm_maxmaxsegsz = maxsegsz;
368 1.1 chris map->_dm_boundary = boundary;
369 1.1 chris map->_dm_flags = flags & ~(BUS_DMA_WAITOK|BUS_DMA_NOWAIT);
370 1.14 thorpej map->_dm_origbuf = NULL;
371 1.58 matt map->_dm_buftype = _BUS_DMA_BUFTYPE_INVALID;
372 1.48 yamt map->_dm_vmspace = vmspace_kernel();
373 1.58 matt map->_dm_cookie = NULL;
374 1.43 matt map->dm_maxsegsz = maxsegsz;
375 1.1 chris map->dm_mapsize = 0; /* no valid mappings */
376 1.1 chris map->dm_nsegs = 0;
377 1.1 chris
378 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
379 1.58 matt struct arm32_bus_dma_cookie *cookie;
380 1.58 matt int cookieflags;
381 1.58 matt void *cookiestore;
382 1.58 matt
383 1.58 matt cookieflags = 0;
384 1.58 matt
385 1.58 matt if (t->_may_bounce != NULL) {
386 1.58 matt error = (*t->_may_bounce)(t, map, flags, &cookieflags);
387 1.58 matt if (error != 0)
388 1.58 matt goto out;
389 1.58 matt }
390 1.58 matt
391 1.127 jmcneill if (t->_ranges != NULL) {
392 1.127 jmcneill /*
393 1.127 jmcneill * If ranges are defined, we may have to bounce. The only
394 1.127 jmcneill * exception is if there is exactly one range that covers
395 1.127 jmcneill * all of physical memory.
396 1.127 jmcneill */
397 1.127 jmcneill switch (t->_nranges) {
398 1.127 jmcneill case 1:
399 1.127 jmcneill if (t->_ranges[0].dr_sysbase == 0 &&
400 1.127 jmcneill t->_ranges[0].dr_len == UINTPTR_MAX) {
401 1.127 jmcneill break;
402 1.127 jmcneill }
403 1.127 jmcneill /* FALLTHROUGH */
404 1.127 jmcneill default:
405 1.127 jmcneill cookieflags |= _BUS_DMA_MIGHT_NEED_BOUNCE;
406 1.127 jmcneill }
407 1.127 jmcneill }
408 1.58 matt
409 1.58 matt if ((cookieflags & _BUS_DMA_MIGHT_NEED_BOUNCE) == 0) {
410 1.58 matt STAT_INCR(creates);
411 1.98 msaitoh *dmamp = map;
412 1.58 matt return 0;
413 1.58 matt }
414 1.58 matt
415 1.81 matt const size_t cookiesize = sizeof(struct arm32_bus_dma_cookie) +
416 1.58 matt (sizeof(bus_dma_segment_t) * map->_dm_segcnt);
417 1.58 matt
418 1.58 matt /*
419 1.58 matt * Allocate our cookie.
420 1.58 matt */
421 1.81 matt if ((cookiestore = kmem_intr_zalloc(cookiesize, zallocflags)) == NULL) {
422 1.58 matt error = ENOMEM;
423 1.58 matt goto out;
424 1.58 matt }
425 1.58 matt cookie = (struct arm32_bus_dma_cookie *)cookiestore;
426 1.58 matt cookie->id_flags = cookieflags;
427 1.58 matt map->_dm_cookie = cookie;
428 1.58 matt STAT_INCR(bounced_creates);
429 1.58 matt
430 1.58 matt error = _bus_dma_alloc_bouncebuf(t, map, size, flags);
431 1.58 matt out:
432 1.58 matt if (error)
433 1.58 matt _bus_dmamap_destroy(t, map);
434 1.98 msaitoh else
435 1.98 msaitoh *dmamp = map;
436 1.58 matt #else
437 1.98 msaitoh *dmamp = map;
438 1.58 matt STAT_INCR(creates);
439 1.58 matt #endif /* _ARM32_NEED_BUS_DMA_BOUNCE */
440 1.1 chris #ifdef DEBUG_DMA
441 1.1 chris printf("dmamap_create:map=%p\n", map);
442 1.1 chris #endif /* DEBUG_DMA */
443 1.119 maya return error;
444 1.1 chris }
445 1.1 chris
446 1.1 chris /*
447 1.1 chris * Common function for DMA map destruction. May be called by bus-specific
448 1.1 chris * DMA map destruction functions.
449 1.1 chris */
450 1.1 chris void
451 1.7 thorpej _bus_dmamap_destroy(bus_dma_tag_t t, bus_dmamap_t map)
452 1.1 chris {
453 1.1 chris
454 1.1 chris #ifdef DEBUG_DMA
455 1.1 chris printf("dmamap_destroy: t=%p map=%p\n", t, map);
456 1.1 chris #endif /* DEBUG_DMA */
457 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
458 1.58 matt struct arm32_bus_dma_cookie *cookie = map->_dm_cookie;
459 1.13 briggs
460 1.13 briggs /*
461 1.58 matt * Free any bounce pages this map might hold.
462 1.13 briggs */
463 1.58 matt if (cookie != NULL) {
464 1.81 matt const size_t cookiesize = sizeof(struct arm32_bus_dma_cookie) +
465 1.81 matt (sizeof(bus_dma_segment_t) * map->_dm_segcnt);
466 1.81 matt
467 1.58 matt if (cookie->id_flags & _BUS_DMA_IS_BOUNCING)
468 1.58 matt STAT_INCR(bounced_unloads);
469 1.58 matt map->dm_nsegs = 0;
470 1.58 matt if (cookie->id_flags & _BUS_DMA_HAS_BOUNCE)
471 1.58 matt _bus_dma_free_bouncebuf(t, map);
472 1.58 matt STAT_INCR(bounced_destroys);
473 1.81 matt kmem_intr_free(cookie, cookiesize);
474 1.58 matt } else
475 1.58 matt #endif
476 1.58 matt STAT_INCR(destroys);
477 1.58 matt
478 1.58 matt if (map->dm_nsegs > 0)
479 1.58 matt STAT_INCR(unloads);
480 1.13 briggs
481 1.81 matt const size_t mapsize = sizeof(struct arm32_bus_dmamap) +
482 1.81 matt (sizeof(bus_dma_segment_t) * (map->_dm_segcnt - 1));
483 1.81 matt kmem_intr_free(map, mapsize);
484 1.1 chris }
485 1.1 chris
486 1.1 chris /*
487 1.1 chris * Common function for loading a DMA map with a linear buffer. May
488 1.1 chris * be called by bus-specific DMA map load functions.
489 1.1 chris */
490 1.1 chris int
491 1.7 thorpej _bus_dmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf,
492 1.7 thorpej bus_size_t buflen, struct proc *p, int flags)
493 1.1 chris {
494 1.58 matt struct vmspace *vm;
495 1.41 thorpej int error;
496 1.1 chris
497 1.1 chris #ifdef DEBUG_DMA
498 1.130 skrll printf("dmamap_load: t=%p map=%p buf=%p len=%#lx p=%p f=%#x\n",
499 1.1 chris t, map, buf, buflen, p, flags);
500 1.1 chris #endif /* DEBUG_DMA */
501 1.1 chris
502 1.58 matt if (map->dm_nsegs > 0) {
503 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
504 1.58 matt struct arm32_bus_dma_cookie *cookie = map->_dm_cookie;
505 1.58 matt if (cookie != NULL) {
506 1.58 matt if (cookie->id_flags & _BUS_DMA_IS_BOUNCING) {
507 1.58 matt STAT_INCR(bounced_unloads);
508 1.58 matt cookie->id_flags &= ~_BUS_DMA_IS_BOUNCING;
509 1.63 matt map->_dm_flags &= ~_BUS_DMAMAP_IS_BOUNCING;
510 1.58 matt }
511 1.58 matt } else
512 1.58 matt #endif
513 1.58 matt STAT_INCR(unloads);
514 1.58 matt }
515 1.58 matt
516 1.1 chris /*
517 1.1 chris * Make sure that on error condition we return "no valid mappings".
518 1.1 chris */
519 1.1 chris map->dm_mapsize = 0;
520 1.1 chris map->dm_nsegs = 0;
521 1.58 matt map->_dm_buftype = _BUS_DMA_BUFTYPE_INVALID;
522 1.74 matt KASSERTMSG(map->dm_maxsegsz <= map->_dm_maxmaxsegsz,
523 1.74 matt "dm_maxsegsz %lu _dm_maxmaxsegsz %lu",
524 1.74 matt map->dm_maxsegsz, map->_dm_maxmaxsegsz);
525 1.1 chris
526 1.1 chris if (buflen > map->_dm_size)
527 1.100 skrll return EINVAL;
528 1.1 chris
529 1.48 yamt if (p != NULL) {
530 1.48 yamt vm = p->p_vmspace;
531 1.48 yamt } else {
532 1.48 yamt vm = vmspace_kernel();
533 1.48 yamt }
534 1.48 yamt
535 1.17 thorpej /* _bus_dmamap_load_buffer() clears this if we're not... */
536 1.58 matt map->_dm_flags |= _BUS_DMAMAP_COHERENT;
537 1.17 thorpej
538 1.48 yamt error = _bus_dmamap_load_buffer(t, map, buf, buflen, vm, flags);
539 1.1 chris if (error == 0) {
540 1.1 chris map->dm_mapsize = buflen;
541 1.58 matt map->_dm_vmspace = vm;
542 1.14 thorpej map->_dm_origbuf = buf;
543 1.58 matt map->_dm_buftype = _BUS_DMA_BUFTYPE_LINEAR;
544 1.81 matt if (map->_dm_flags & _BUS_DMAMAP_COHERENT) {
545 1.81 matt STAT_INCR(coherent_loads);
546 1.81 matt } else {
547 1.81 matt STAT_INCR(loads);
548 1.81 matt }
549 1.58 matt return 0;
550 1.1 chris }
551 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
552 1.58 matt struct arm32_bus_dma_cookie * const cookie = map->_dm_cookie;
553 1.58 matt if (cookie != NULL && (cookie->id_flags & _BUS_DMA_MIGHT_NEED_BOUNCE)) {
554 1.58 matt error = _bus_dma_load_bouncebuf(t, map, buf, buflen,
555 1.58 matt _BUS_DMA_BUFTYPE_LINEAR, flags);
556 1.95 skrll }
557 1.95 skrll #endif
558 1.100 skrll return error;
559 1.1 chris }
560 1.1 chris
561 1.1 chris /*
562 1.1 chris * Like _bus_dmamap_load(), but for mbufs.
563 1.1 chris */
564 1.1 chris int
565 1.7 thorpej _bus_dmamap_load_mbuf(bus_dma_tag_t t, bus_dmamap_t map, struct mbuf *m0,
566 1.7 thorpej int flags)
567 1.1 chris {
568 1.105 skrll struct mbuf *m;
569 1.41 thorpej int error;
570 1.1 chris
571 1.1 chris #ifdef DEBUG_DMA
572 1.130 skrll printf("dmamap_load_mbuf: t=%p map=%p m0=%p f=%#x\n",
573 1.1 chris t, map, m0, flags);
574 1.1 chris #endif /* DEBUG_DMA */
575 1.1 chris
576 1.58 matt if (map->dm_nsegs > 0) {
577 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
578 1.58 matt struct arm32_bus_dma_cookie *cookie = map->_dm_cookie;
579 1.58 matt if (cookie != NULL) {
580 1.58 matt if (cookie->id_flags & _BUS_DMA_IS_BOUNCING) {
581 1.58 matt STAT_INCR(bounced_unloads);
582 1.58 matt cookie->id_flags &= ~_BUS_DMA_IS_BOUNCING;
583 1.63 matt map->_dm_flags &= ~_BUS_DMAMAP_IS_BOUNCING;
584 1.58 matt }
585 1.58 matt } else
586 1.58 matt #endif
587 1.58 matt STAT_INCR(unloads);
588 1.58 matt }
589 1.58 matt
590 1.1 chris /*
591 1.1 chris * Make sure that on error condition we return "no valid mappings."
592 1.1 chris */
593 1.1 chris map->dm_mapsize = 0;
594 1.1 chris map->dm_nsegs = 0;
595 1.58 matt map->_dm_buftype = _BUS_DMA_BUFTYPE_INVALID;
596 1.74 matt KASSERTMSG(map->dm_maxsegsz <= map->_dm_maxmaxsegsz,
597 1.74 matt "dm_maxsegsz %lu _dm_maxmaxsegsz %lu",
598 1.74 matt map->dm_maxsegsz, map->_dm_maxmaxsegsz);
599 1.1 chris
600 1.79 matt KASSERT(m0->m_flags & M_PKTHDR);
601 1.1 chris
602 1.1 chris if (m0->m_pkthdr.len > map->_dm_size)
603 1.100 skrll return EINVAL;
604 1.1 chris
605 1.61 matt /* _bus_dmamap_load_paddr() clears this if we're not... */
606 1.61 matt map->_dm_flags |= _BUS_DMAMAP_COHERENT;
607 1.17 thorpej
608 1.1 chris error = 0;
609 1.1 chris for (m = m0; m != NULL && error == 0; m = m->m_next) {
610 1.41 thorpej int offset;
611 1.41 thorpej int remainbytes;
612 1.41 thorpej const struct vm_page * const *pgs;
613 1.41 thorpej paddr_t paddr;
614 1.41 thorpej int size;
615 1.41 thorpej
616 1.28 thorpej if (m->m_len == 0)
617 1.28 thorpej continue;
618 1.57 matt /*
619 1.57 matt * Don't allow reads in read-only mbufs.
620 1.57 matt */
621 1.57 matt if (M_ROMAP(m) && (flags & BUS_DMA_READ)) {
622 1.57 matt error = EFAULT;
623 1.57 matt break;
624 1.57 matt }
625 1.108 maxv switch (m->m_flags & (M_EXT|M_EXT_CLUSTER|M_EXT_PAGES)) {
626 1.108 maxv case M_EXT|M_EXT_CLUSTER:
627 1.28 thorpej /* XXX KDASSERT */
628 1.28 thorpej KASSERT(m->m_ext.ext_paddr != M_PADDR_INVALID);
629 1.41 thorpej paddr = m->m_ext.ext_paddr +
630 1.28 thorpej (m->m_data - m->m_ext.ext_buf);
631 1.41 thorpej size = m->m_len;
632 1.61 matt error = _bus_dmamap_load_paddr(t, map, paddr, size,
633 1.61 matt false);
634 1.41 thorpej break;
635 1.95 skrll
636 1.41 thorpej case M_EXT|M_EXT_PAGES:
637 1.41 thorpej KASSERT(m->m_ext.ext_buf <= m->m_data);
638 1.41 thorpej KASSERT(m->m_data <=
639 1.41 thorpej m->m_ext.ext_buf + m->m_ext.ext_size);
640 1.95 skrll
641 1.41 thorpej offset = (vaddr_t)m->m_data -
642 1.41 thorpej trunc_page((vaddr_t)m->m_ext.ext_buf);
643 1.41 thorpej remainbytes = m->m_len;
644 1.41 thorpej
645 1.41 thorpej /* skip uninteresting pages */
646 1.41 thorpej pgs = (const struct vm_page * const *)
647 1.41 thorpej m->m_ext.ext_pgs + (offset >> PAGE_SHIFT);
648 1.95 skrll
649 1.41 thorpej offset &= PAGE_MASK; /* offset in the first page */
650 1.41 thorpej
651 1.41 thorpej /* load each page */
652 1.41 thorpej while (remainbytes > 0) {
653 1.41 thorpej const struct vm_page *pg;
654 1.41 thorpej
655 1.41 thorpej size = MIN(remainbytes, PAGE_SIZE - offset);
656 1.41 thorpej
657 1.41 thorpej pg = *pgs++;
658 1.41 thorpej KASSERT(pg);
659 1.41 thorpej paddr = VM_PAGE_TO_PHYS(pg) + offset;
660 1.41 thorpej
661 1.41 thorpej error = _bus_dmamap_load_paddr(t, map,
662 1.61 matt paddr, size, false);
663 1.41 thorpej if (error)
664 1.28 thorpej break;
665 1.41 thorpej offset = 0;
666 1.41 thorpej remainbytes -= size;
667 1.28 thorpej }
668 1.28 thorpej break;
669 1.28 thorpej
670 1.28 thorpej case 0:
671 1.41 thorpej paddr = m->m_paddr + M_BUFOFFSET(m) +
672 1.28 thorpej (m->m_data - M_BUFADDR(m));
673 1.41 thorpej size = m->m_len;
674 1.61 matt error = _bus_dmamap_load_paddr(t, map, paddr, size,
675 1.61 matt false);
676 1.41 thorpej break;
677 1.28 thorpej
678 1.28 thorpej default:
679 1.28 thorpej error = _bus_dmamap_load_buffer(t, map, m->m_data,
680 1.48 yamt m->m_len, vmspace_kernel(), flags);
681 1.28 thorpej }
682 1.1 chris }
683 1.1 chris if (error == 0) {
684 1.1 chris map->dm_mapsize = m0->m_pkthdr.len;
685 1.14 thorpej map->_dm_origbuf = m0;
686 1.58 matt map->_dm_buftype = _BUS_DMA_BUFTYPE_MBUF;
687 1.48 yamt map->_dm_vmspace = vmspace_kernel(); /* always kernel */
688 1.81 matt if (map->_dm_flags & _BUS_DMAMAP_COHERENT) {
689 1.81 matt STAT_INCR(coherent_loads);
690 1.81 matt } else {
691 1.81 matt STAT_INCR(loads);
692 1.81 matt }
693 1.58 matt return 0;
694 1.1 chris }
695 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
696 1.58 matt struct arm32_bus_dma_cookie * const cookie = map->_dm_cookie;
697 1.58 matt if (cookie != NULL && (cookie->id_flags & _BUS_DMA_MIGHT_NEED_BOUNCE)) {
698 1.58 matt error = _bus_dma_load_bouncebuf(t, map, m0, m0->m_pkthdr.len,
699 1.58 matt _BUS_DMA_BUFTYPE_MBUF, flags);
700 1.95 skrll }
701 1.95 skrll #endif
702 1.100 skrll return error;
703 1.1 chris }
704 1.1 chris
705 1.1 chris /*
706 1.1 chris * Like _bus_dmamap_load(), but for uios.
707 1.1 chris */
708 1.1 chris int
709 1.7 thorpej _bus_dmamap_load_uio(bus_dma_tag_t t, bus_dmamap_t map, struct uio *uio,
710 1.7 thorpej int flags)
711 1.1 chris {
712 1.1 chris bus_size_t minlen, resid;
713 1.1 chris struct iovec *iov;
714 1.50 christos void *addr;
715 1.105 skrll int i, error;
716 1.1 chris
717 1.1 chris /*
718 1.1 chris * Make sure that on error condition we return "no valid mappings."
719 1.1 chris */
720 1.1 chris map->dm_mapsize = 0;
721 1.1 chris map->dm_nsegs = 0;
722 1.74 matt KASSERTMSG(map->dm_maxsegsz <= map->_dm_maxmaxsegsz,
723 1.74 matt "dm_maxsegsz %lu _dm_maxmaxsegsz %lu",
724 1.74 matt map->dm_maxsegsz, map->_dm_maxmaxsegsz);
725 1.1 chris
726 1.1 chris resid = uio->uio_resid;
727 1.1 chris iov = uio->uio_iov;
728 1.1 chris
729 1.17 thorpej /* _bus_dmamap_load_buffer() clears this if we're not... */
730 1.58 matt map->_dm_flags |= _BUS_DMAMAP_COHERENT;
731 1.17 thorpej
732 1.1 chris error = 0;
733 1.1 chris for (i = 0; i < uio->uio_iovcnt && resid != 0 && error == 0; i++) {
734 1.1 chris /*
735 1.1 chris * Now at the first iovec to load. Load each iovec
736 1.1 chris * until we have exhausted the residual count.
737 1.1 chris */
738 1.1 chris minlen = resid < iov[i].iov_len ? resid : iov[i].iov_len;
739 1.50 christos addr = (void *)iov[i].iov_base;
740 1.1 chris
741 1.1 chris error = _bus_dmamap_load_buffer(t, map, addr, minlen,
742 1.48 yamt uio->uio_vmspace, flags);
743 1.1 chris
744 1.1 chris resid -= minlen;
745 1.1 chris }
746 1.1 chris if (error == 0) {
747 1.1 chris map->dm_mapsize = uio->uio_resid;
748 1.14 thorpej map->_dm_origbuf = uio;
749 1.58 matt map->_dm_buftype = _BUS_DMA_BUFTYPE_UIO;
750 1.48 yamt map->_dm_vmspace = uio->uio_vmspace;
751 1.81 matt if (map->_dm_flags & _BUS_DMAMAP_COHERENT) {
752 1.81 matt STAT_INCR(coherent_loads);
753 1.81 matt } else {
754 1.81 matt STAT_INCR(loads);
755 1.81 matt }
756 1.1 chris }
757 1.100 skrll return error;
758 1.1 chris }
759 1.1 chris
760 1.1 chris /*
761 1.1 chris * Like _bus_dmamap_load(), but for raw memory allocated with
762 1.1 chris * bus_dmamem_alloc().
763 1.1 chris */
764 1.1 chris int
765 1.7 thorpej _bus_dmamap_load_raw(bus_dma_tag_t t, bus_dmamap_t map,
766 1.94 jmcneill bus_dma_segment_t *segs, int nsegs, bus_size_t size0, int flags)
767 1.1 chris {
768 1.1 chris
769 1.94 jmcneill bus_size_t size;
770 1.94 jmcneill int i, error = 0;
771 1.94 jmcneill
772 1.94 jmcneill /*
773 1.94 jmcneill * Make sure that on error conditions we return "no valid mappings."
774 1.94 jmcneill */
775 1.94 jmcneill map->dm_mapsize = 0;
776 1.94 jmcneill map->dm_nsegs = 0;
777 1.94 jmcneill KASSERT(map->dm_maxsegsz <= map->_dm_maxmaxsegsz);
778 1.94 jmcneill
779 1.94 jmcneill if (size0 > map->_dm_size)
780 1.94 jmcneill return EINVAL;
781 1.94 jmcneill
782 1.94 jmcneill for (i = 0, size = size0; i < nsegs && size > 0; i++) {
783 1.94 jmcneill bus_dma_segment_t *ds = &segs[i];
784 1.94 jmcneill bus_size_t sgsize;
785 1.94 jmcneill
786 1.94 jmcneill sgsize = MIN(ds->ds_len, size);
787 1.94 jmcneill if (sgsize == 0)
788 1.94 jmcneill continue;
789 1.116 jmcneill const bool coherent =
790 1.116 jmcneill (ds->_ds_flags & _BUS_DMAMAP_COHERENT) != 0;
791 1.94 jmcneill error = _bus_dmamap_load_paddr(t, map, ds->ds_addr,
792 1.116 jmcneill sgsize, coherent);
793 1.94 jmcneill if (error != 0)
794 1.94 jmcneill break;
795 1.94 jmcneill size -= sgsize;
796 1.94 jmcneill }
797 1.94 jmcneill
798 1.94 jmcneill if (error != 0) {
799 1.94 jmcneill map->dm_mapsize = 0;
800 1.94 jmcneill map->dm_nsegs = 0;
801 1.94 jmcneill return error;
802 1.94 jmcneill }
803 1.94 jmcneill
804 1.94 jmcneill /* XXX TBD bounce */
805 1.94 jmcneill
806 1.94 jmcneill map->dm_mapsize = size0;
807 1.116 jmcneill map->_dm_origbuf = NULL;
808 1.116 jmcneill map->_dm_buftype = _BUS_DMA_BUFTYPE_RAW;
809 1.116 jmcneill map->_dm_vmspace = NULL;
810 1.94 jmcneill return 0;
811 1.1 chris }
812 1.1 chris
813 1.1 chris /*
814 1.1 chris * Common function for unloading a DMA map. May be called by
815 1.1 chris * bus-specific DMA map unload functions.
816 1.1 chris */
817 1.1 chris void
818 1.7 thorpej _bus_dmamap_unload(bus_dma_tag_t t, bus_dmamap_t map)
819 1.1 chris {
820 1.1 chris
821 1.1 chris #ifdef DEBUG_DMA
822 1.1 chris printf("dmamap_unload: t=%p map=%p\n", t, map);
823 1.1 chris #endif /* DEBUG_DMA */
824 1.1 chris
825 1.1 chris /*
826 1.1 chris * No resources to free; just mark the mappings as
827 1.1 chris * invalid.
828 1.1 chris */
829 1.1 chris map->dm_mapsize = 0;
830 1.1 chris map->dm_nsegs = 0;
831 1.14 thorpej map->_dm_origbuf = NULL;
832 1.58 matt map->_dm_buftype = _BUS_DMA_BUFTYPE_INVALID;
833 1.48 yamt map->_dm_vmspace = NULL;
834 1.1 chris }
835 1.1 chris
836 1.57 matt static void
837 1.103 skrll _bus_dmamap_sync_segment(vaddr_t va, paddr_t pa, vsize_t len, int ops,
838 1.103 skrll bool readonly_p)
839 1.14 thorpej {
840 1.106 skrll
841 1.115 skrll #if defined(ARM_MMU_EXTENDED)
842 1.106 skrll /*
843 1.106 skrll * No optimisations are available for readonly mbufs on armv6+, so
844 1.106 skrll * assume it's not readonly from here on.
845 1.106 skrll *
846 1.106 skrll * See the comment in _bus_dmamap_sync_mbuf
847 1.106 skrll */
848 1.106 skrll readonly_p = false;
849 1.106 skrll #endif
850 1.106 skrll
851 1.86 matt KASSERTMSG((va & PAGE_MASK) == (pa & PAGE_MASK),
852 1.86 matt "va %#lx pa %#lx", va, pa);
853 1.62 matt #if 0
854 1.62 matt printf("sync_segment: va=%#lx pa=%#lx len=%#lx ops=%#x ro=%d\n",
855 1.62 matt va, pa, len, ops, readonly_p);
856 1.62 matt #endif
857 1.14 thorpej
858 1.14 thorpej switch (ops) {
859 1.14 thorpej case BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE:
860 1.57 matt if (!readonly_p) {
861 1.76 matt STAT_INCR(sync_prereadwrite);
862 1.57 matt cpu_dcache_wbinv_range(va, len);
863 1.57 matt cpu_sdcache_wbinv_range(va, pa, len);
864 1.57 matt break;
865 1.57 matt }
866 1.57 matt /* FALLTHROUGH */
867 1.14 thorpej
868 1.57 matt case BUS_DMASYNC_PREREAD: {
869 1.59 matt const size_t line_size = arm_dcache_align;
870 1.59 matt const size_t line_mask = arm_dcache_align_mask;
871 1.59 matt vsize_t misalignment = va & line_mask;
872 1.57 matt if (misalignment) {
873 1.59 matt va -= misalignment;
874 1.59 matt pa -= misalignment;
875 1.59 matt len += misalignment;
876 1.77 matt STAT_INCR(sync_preread_begin);
877 1.59 matt cpu_dcache_wbinv_range(va, line_size);
878 1.59 matt cpu_sdcache_wbinv_range(va, pa, line_size);
879 1.59 matt if (len <= line_size)
880 1.57 matt break;
881 1.59 matt va += line_size;
882 1.59 matt pa += line_size;
883 1.59 matt len -= line_size;
884 1.57 matt }
885 1.59 matt misalignment = len & line_mask;
886 1.57 matt len -= misalignment;
887 1.65 matt if (len > 0) {
888 1.77 matt STAT_INCR(sync_preread);
889 1.65 matt cpu_dcache_inv_range(va, len);
890 1.65 matt cpu_sdcache_inv_range(va, pa, len);
891 1.65 matt }
892 1.57 matt if (misalignment) {
893 1.57 matt va += len;
894 1.57 matt pa += len;
895 1.77 matt STAT_INCR(sync_preread_tail);
896 1.59 matt cpu_dcache_wbinv_range(va, line_size);
897 1.59 matt cpu_sdcache_wbinv_range(va, pa, line_size);
898 1.57 matt }
899 1.14 thorpej break;
900 1.57 matt }
901 1.14 thorpej
902 1.14 thorpej case BUS_DMASYNC_PREWRITE:
903 1.76 matt STAT_INCR(sync_prewrite);
904 1.57 matt cpu_dcache_wb_range(va, len);
905 1.57 matt cpu_sdcache_wb_range(va, pa, len);
906 1.14 thorpej break;
907 1.67 matt
908 1.115 skrll #if defined(CPU_CORTEX) || defined(CPU_ARMV8)
909 1.115 skrll
910 1.67 matt /*
911 1.67 matt * Cortex CPUs can do speculative loads so we need to clean the cache
912 1.67 matt * after a DMA read to deal with any speculatively loaded cache lines.
913 1.67 matt * Since these can't be dirty, we can just invalidate them and don't
914 1.67 matt * have to worry about having to write back their contents.
915 1.67 matt */
916 1.67 matt case BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE:
917 1.76 matt STAT_INCR(sync_postreadwrite);
918 1.76 matt cpu_dcache_inv_range(va, len);
919 1.76 matt cpu_sdcache_inv_range(va, pa, len);
920 1.76 matt break;
921 1.126 skrll
922 1.67 matt case BUS_DMASYNC_POSTREAD:
923 1.76 matt STAT_INCR(sync_postread);
924 1.67 matt cpu_dcache_inv_range(va, len);
925 1.67 matt cpu_sdcache_inv_range(va, pa, len);
926 1.67 matt break;
927 1.67 matt #endif
928 1.14 thorpej }
929 1.14 thorpej }
930 1.14 thorpej
931 1.47 perry static inline void
932 1.57 matt _bus_dmamap_sync_linear(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
933 1.14 thorpej bus_size_t len, int ops)
934 1.14 thorpej {
935 1.57 matt bus_dma_segment_t *ds = map->dm_segs;
936 1.57 matt vaddr_t va = (vaddr_t) map->_dm_origbuf;
937 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
938 1.63 matt if (map->_dm_flags & _BUS_DMAMAP_IS_BOUNCING) {
939 1.63 matt struct arm32_bus_dma_cookie * const cookie = map->_dm_cookie;
940 1.58 matt va = (vaddr_t) cookie->id_bouncebuf;
941 1.58 matt }
942 1.58 matt #endif
943 1.57 matt
944 1.57 matt while (len > 0) {
945 1.57 matt while (offset >= ds->ds_len) {
946 1.57 matt offset -= ds->ds_len;
947 1.57 matt va += ds->ds_len;
948 1.57 matt ds++;
949 1.57 matt }
950 1.57 matt
951 1.59 matt paddr_t pa = _bus_dma_busaddr_to_paddr(t, ds->ds_addr + offset);
952 1.112 riastrad size_t seglen = uimin(len, ds->ds_len - offset);
953 1.57 matt
954 1.61 matt if ((ds->_ds_flags & _BUS_DMAMAP_COHERENT) == 0)
955 1.61 matt _bus_dmamap_sync_segment(va + offset, pa, seglen, ops,
956 1.67 matt false);
957 1.57 matt
958 1.57 matt offset += seglen;
959 1.57 matt len -= seglen;
960 1.57 matt }
961 1.57 matt }
962 1.57 matt
963 1.57 matt static inline void
964 1.57 matt _bus_dmamap_sync_mbuf(bus_dma_tag_t t, bus_dmamap_t map, bus_size_t offset,
965 1.57 matt bus_size_t len, int ops)
966 1.57 matt {
967 1.57 matt bus_dma_segment_t *ds = map->dm_segs;
968 1.57 matt struct mbuf *m = map->_dm_origbuf;
969 1.57 matt bus_size_t voff = offset;
970 1.57 matt bus_size_t ds_off = offset;
971 1.57 matt
972 1.57 matt while (len > 0) {
973 1.57 matt /* Find the current dma segment */
974 1.57 matt while (ds_off >= ds->ds_len) {
975 1.57 matt ds_off -= ds->ds_len;
976 1.57 matt ds++;
977 1.57 matt }
978 1.57 matt /* Find the current mbuf. */
979 1.57 matt while (voff >= m->m_len) {
980 1.57 matt voff -= m->m_len;
981 1.57 matt m = m->m_next;
982 1.14 thorpej }
983 1.14 thorpej
984 1.14 thorpej /*
985 1.14 thorpej * Now at the first mbuf to sync; nail each one until
986 1.14 thorpej * we have exhausted the length.
987 1.14 thorpej */
988 1.112 riastrad vsize_t seglen = uimin(len, uimin(m->m_len - voff, ds->ds_len - ds_off));
989 1.57 matt vaddr_t va = mtod(m, vaddr_t) + voff;
990 1.59 matt paddr_t pa = _bus_dma_busaddr_to_paddr(t, ds->ds_addr + ds_off);
991 1.14 thorpej
992 1.28 thorpej /*
993 1.28 thorpej * We can save a lot of work here if we know the mapping
994 1.93 matt * is read-only at the MMU and we aren't using the armv6+
995 1.93 matt * MMU:
996 1.28 thorpej *
997 1.28 thorpej * If a mapping is read-only, no dirty cache blocks will
998 1.28 thorpej * exist for it. If a writable mapping was made read-only,
999 1.28 thorpej * we know any dirty cache lines for the range will have
1000 1.28 thorpej * been cleaned for us already. Therefore, if the upper
1001 1.28 thorpej * layer can tell us we have a read-only mapping, we can
1002 1.28 thorpej * skip all cache cleaning.
1003 1.28 thorpej *
1004 1.28 thorpej * NOTE: This only works if we know the pmap cleans pages
1005 1.28 thorpej * before making a read-write -> read-only transition. If
1006 1.28 thorpej * this ever becomes non-true (e.g. Physically Indexed
1007 1.28 thorpej * cache), this will have to be revisited.
1008 1.28 thorpej */
1009 1.14 thorpej
1010 1.92 matt if ((ds->_ds_flags & _BUS_DMAMAP_COHERENT) == 0) {
1011 1.92 matt /*
1012 1.92 matt * If we are doing preread (DMAing into the mbuf),
1013 1.95 skrll * this mbuf better not be readonly,
1014 1.92 matt */
1015 1.92 matt KASSERT(!(ops & BUS_DMASYNC_PREREAD) || !M_ROMAP(m));
1016 1.61 matt _bus_dmamap_sync_segment(va, pa, seglen, ops,
1017 1.61 matt M_ROMAP(m));
1018 1.92 matt }
1019 1.57 matt voff += seglen;
1020 1.57 matt ds_off += seglen;
1021 1.57 matt len -= seglen;
1022 1.14 thorpej }
1023 1.14 thorpej }
1024 1.14 thorpej
1025 1.47 perry static inline void
1026 1.14 thorpej _bus_dmamap_sync_uio(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
1027 1.14 thorpej bus_size_t len, int ops)
1028 1.14 thorpej {
1029 1.57 matt bus_dma_segment_t *ds = map->dm_segs;
1030 1.14 thorpej struct uio *uio = map->_dm_origbuf;
1031 1.57 matt struct iovec *iov = uio->uio_iov;
1032 1.57 matt bus_size_t voff = offset;
1033 1.57 matt bus_size_t ds_off = offset;
1034 1.57 matt
1035 1.57 matt while (len > 0) {
1036 1.57 matt /* Find the current dma segment */
1037 1.57 matt while (ds_off >= ds->ds_len) {
1038 1.57 matt ds_off -= ds->ds_len;
1039 1.57 matt ds++;
1040 1.57 matt }
1041 1.14 thorpej
1042 1.57 matt /* Find the current iovec. */
1043 1.57 matt while (voff >= iov->iov_len) {
1044 1.57 matt voff -= iov->iov_len;
1045 1.57 matt iov++;
1046 1.14 thorpej }
1047 1.14 thorpej
1048 1.14 thorpej /*
1049 1.14 thorpej * Now at the first iovec to sync; nail each one until
1050 1.14 thorpej * we have exhausted the length.
1051 1.14 thorpej */
1052 1.112 riastrad vsize_t seglen = uimin(len, uimin(iov->iov_len - voff, ds->ds_len - ds_off));
1053 1.57 matt vaddr_t va = (vaddr_t) iov->iov_base + voff;
1054 1.59 matt paddr_t pa = _bus_dma_busaddr_to_paddr(t, ds->ds_addr + ds_off);
1055 1.57 matt
1056 1.61 matt if ((ds->_ds_flags & _BUS_DMAMAP_COHERENT) == 0)
1057 1.61 matt _bus_dmamap_sync_segment(va, pa, seglen, ops, false);
1058 1.57 matt
1059 1.57 matt voff += seglen;
1060 1.57 matt ds_off += seglen;
1061 1.57 matt len -= seglen;
1062 1.14 thorpej }
1063 1.14 thorpej }
1064 1.14 thorpej
1065 1.1 chris /*
1066 1.1 chris * Common function for DMA map synchronization. May be called
1067 1.1 chris * by bus-specific DMA map synchronization functions.
1068 1.8 thorpej *
1069 1.8 thorpej * XXX Should have separate versions for write-through vs.
1070 1.8 thorpej * XXX write-back caches. We currently assume write-back
1071 1.8 thorpej * XXX here, which is not as efficient as it could be for
1072 1.8 thorpej * XXX the write-through case.
1073 1.1 chris */
1074 1.1 chris void
1075 1.7 thorpej _bus_dmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
1076 1.7 thorpej bus_size_t len, int ops)
1077 1.1 chris {
1078 1.1 chris #ifdef DEBUG_DMA
1079 1.130 skrll printf("dmamap_sync: t=%p map=%p offset=%#lx len=%#lx ops=%#x\n",
1080 1.1 chris t, map, offset, len, ops);
1081 1.1 chris #endif /* DEBUG_DMA */
1082 1.1 chris
1083 1.8 thorpej /*
1084 1.8 thorpej * Mixing of PRE and POST operations is not allowed.
1085 1.8 thorpej */
1086 1.8 thorpej if ((ops & (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE)) != 0 &&
1087 1.8 thorpej (ops & (BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE)) != 0)
1088 1.126 skrll panic("%s: mix PRE and POST", __func__);
1089 1.8 thorpej
1090 1.79 matt KASSERTMSG(offset < map->dm_mapsize,
1091 1.79 matt "offset %lu mapsize %lu",
1092 1.79 matt offset, map->dm_mapsize);
1093 1.79 matt KASSERTMSG(len > 0 && offset + len <= map->dm_mapsize,
1094 1.79 matt "len %lu offset %lu mapsize %lu",
1095 1.79 matt len, offset, map->dm_mapsize);
1096 1.8 thorpej
1097 1.8 thorpej /*
1098 1.8 thorpej * For a virtually-indexed write-back cache, we need
1099 1.8 thorpej * to do the following things:
1100 1.8 thorpej *
1101 1.8 thorpej * PREREAD -- Invalidate the D-cache. We do this
1102 1.8 thorpej * here in case a write-back is required by the back-end.
1103 1.8 thorpej *
1104 1.8 thorpej * PREWRITE -- Write-back the D-cache. Note that if
1105 1.8 thorpej * we are doing a PREREAD|PREWRITE, we can collapse
1106 1.8 thorpej * the whole thing into a single Wb-Inv.
1107 1.8 thorpej *
1108 1.67 matt * POSTREAD -- Re-invalidate the D-cache in case speculative
1109 1.67 matt * memory accesses caused cachelines to become valid with now
1110 1.67 matt * invalid data.
1111 1.8 thorpej *
1112 1.8 thorpej * POSTWRITE -- Nothing.
1113 1.8 thorpej */
1114 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
1115 1.74 matt const bool bouncing = (map->_dm_flags & _BUS_DMAMAP_IS_BOUNCING);
1116 1.63 matt #else
1117 1.63 matt const bool bouncing = false;
1118 1.58 matt #endif
1119 1.8 thorpej
1120 1.58 matt const int pre_ops = ops & (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
1121 1.115 skrll #if defined(CPU_CORTEX) || defined(CPU_ARMV8)
1122 1.67 matt const int post_ops = ops & (BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
1123 1.67 matt #else
1124 1.67 matt const int post_ops = 0;
1125 1.67 matt #endif
1126 1.115 skrll if (pre_ops == 0 && post_ops == 0)
1127 1.115 skrll return;
1128 1.115 skrll
1129 1.115 skrll if (post_ops == BUS_DMASYNC_POSTWRITE) {
1130 1.115 skrll KASSERT(pre_ops == 0);
1131 1.129 skrll if ((map->_dm_flags & _BUS_DMAMAP_COHERENT)) {
1132 1.129 skrll STAT_INCR(sync_coherent_postwrite);
1133 1.129 skrll } else {
1134 1.129 skrll STAT_INCR(sync_postwrite);
1135 1.129 skrll }
1136 1.115 skrll return;
1137 1.61 matt }
1138 1.115 skrll
1139 1.74 matt KASSERTMSG(bouncing || pre_ops != 0 || (post_ops & BUS_DMASYNC_POSTREAD),
1140 1.74 matt "pre_ops %#x post_ops %#x", pre_ops, post_ops);
1141 1.115 skrll
1142 1.58 matt if (bouncing && (ops & BUS_DMASYNC_PREWRITE)) {
1143 1.63 matt struct arm32_bus_dma_cookie * const cookie = map->_dm_cookie;
1144 1.58 matt STAT_INCR(write_bounces);
1145 1.58 matt char * const dataptr = (char *)cookie->id_bouncebuf + offset;
1146 1.58 matt /*
1147 1.58 matt * Copy the caller's buffer to the bounce buffer.
1148 1.58 matt */
1149 1.58 matt switch (map->_dm_buftype) {
1150 1.58 matt case _BUS_DMA_BUFTYPE_LINEAR:
1151 1.58 matt memcpy(dataptr, cookie->id_origlinearbuf + offset, len);
1152 1.58 matt break;
1153 1.126 skrll
1154 1.58 matt case _BUS_DMA_BUFTYPE_MBUF:
1155 1.58 matt m_copydata(cookie->id_origmbuf, offset, len, dataptr);
1156 1.58 matt break;
1157 1.126 skrll
1158 1.58 matt case _BUS_DMA_BUFTYPE_UIO:
1159 1.126 skrll _bus_dma_uiomove(dataptr, cookie->id_origuio, len,
1160 1.126 skrll UIO_WRITE);
1161 1.58 matt break;
1162 1.126 skrll
1163 1.58 matt #ifdef DIAGNOSTIC
1164 1.58 matt case _BUS_DMA_BUFTYPE_RAW:
1165 1.126 skrll panic("%s:(pre): _BUS_DMA_BUFTYPE_RAW", __func__);
1166 1.58 matt break;
1167 1.58 matt
1168 1.58 matt case _BUS_DMA_BUFTYPE_INVALID:
1169 1.126 skrll panic("%s(pre): _BUS_DMA_BUFTYPE_INVALID", __func__);
1170 1.58 matt break;
1171 1.58 matt
1172 1.58 matt default:
1173 1.126 skrll panic("%s(pre): map %p: unknown buffer type %d\n",
1174 1.126 skrll __func__, map, map->_dm_buftype);
1175 1.58 matt break;
1176 1.58 matt #endif /* DIAGNOSTIC */
1177 1.58 matt }
1178 1.58 matt }
1179 1.58 matt
1180 1.115 skrll /* Skip cache frobbing if mapping was COHERENT */
1181 1.115 skrll if ((map->_dm_flags & _BUS_DMAMAP_COHERENT)) {
1182 1.125 skrll switch (ops) {
1183 1.125 skrll case BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE:
1184 1.129 skrll STAT_INCR(sync_coherent_prereadwrite);
1185 1.125 skrll break;
1186 1.125 skrll
1187 1.125 skrll case BUS_DMASYNC_PREREAD:
1188 1.129 skrll STAT_INCR(sync_coherent_preread);
1189 1.125 skrll break;
1190 1.125 skrll
1191 1.125 skrll case BUS_DMASYNC_PREWRITE:
1192 1.129 skrll STAT_INCR(sync_coherent_prewrite);
1193 1.125 skrll break;
1194 1.125 skrll
1195 1.125 skrll case BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE:
1196 1.129 skrll STAT_INCR(sync_coherent_postreadwrite);
1197 1.125 skrll break;
1198 1.125 skrll
1199 1.125 skrll case BUS_DMASYNC_POSTREAD:
1200 1.129 skrll STAT_INCR(sync_coherent_postread);
1201 1.125 skrll break;
1202 1.125 skrll
1203 1.125 skrll /* BUS_DMASYNC_POSTWRITE was aleady handled as a fastpath */
1204 1.125 skrll }
1205 1.115 skrll /*
1206 1.115 skrll * Drain the write buffer of DMA operators.
1207 1.115 skrll * 1) when cpu->device (prewrite)
1208 1.115 skrll * 2) when device->cpu (postread)
1209 1.115 skrll */
1210 1.115 skrll if ((pre_ops & BUS_DMASYNC_PREWRITE) || (post_ops & BUS_DMASYNC_POSTREAD))
1211 1.75 matt cpu_drain_writebuf();
1212 1.115 skrll
1213 1.115 skrll /*
1214 1.115 skrll * Only thing left to do for COHERENT mapping is copy from bounce
1215 1.115 skrll * in the POSTREAD case.
1216 1.115 skrll */
1217 1.115 skrll if (bouncing && (post_ops & BUS_DMASYNC_POSTREAD))
1218 1.115 skrll goto bounce_it;
1219 1.115 skrll
1220 1.17 thorpej return;
1221 1.17 thorpej }
1222 1.8 thorpej
1223 1.128 jmcneill #if !defined(ARM_MMU_EXTENDED)
1224 1.8 thorpej /*
1225 1.38 scw * If the mapping belongs to a non-kernel vmspace, and the
1226 1.38 scw * vmspace has not been active since the last time a full
1227 1.38 scw * cache flush was performed, we don't need to do anything.
1228 1.8 thorpej */
1229 1.48 yamt if (__predict_false(!VMSPACE_IS_KERNEL_P(map->_dm_vmspace) &&
1230 1.48 yamt vm_map_pmap(&map->_dm_vmspace->vm_map)->pm_cstate.cs_cache_d == 0))
1231 1.8 thorpej return;
1232 1.80 matt #endif
1233 1.8 thorpej
1234 1.58 matt int buftype = map->_dm_buftype;
1235 1.58 matt if (bouncing) {
1236 1.58 matt buftype = _BUS_DMA_BUFTYPE_LINEAR;
1237 1.58 matt }
1238 1.58 matt
1239 1.58 matt switch (buftype) {
1240 1.58 matt case _BUS_DMA_BUFTYPE_LINEAR:
1241 1.116 jmcneill case _BUS_DMA_BUFTYPE_RAW:
1242 1.14 thorpej _bus_dmamap_sync_linear(t, map, offset, len, ops);
1243 1.14 thorpej break;
1244 1.14 thorpej
1245 1.58 matt case _BUS_DMA_BUFTYPE_MBUF:
1246 1.14 thorpej _bus_dmamap_sync_mbuf(t, map, offset, len, ops);
1247 1.14 thorpej break;
1248 1.14 thorpej
1249 1.58 matt case _BUS_DMA_BUFTYPE_UIO:
1250 1.14 thorpej _bus_dmamap_sync_uio(t, map, offset, len, ops);
1251 1.14 thorpej break;
1252 1.14 thorpej
1253 1.58 matt case _BUS_DMA_BUFTYPE_INVALID:
1254 1.126 skrll panic("%s: _BUS_DMA_BUFTYPE_INVALID", __func__);
1255 1.14 thorpej break;
1256 1.14 thorpej
1257 1.14 thorpej default:
1258 1.126 skrll panic("%s: map %p: unknown buffer type %d\n", __func__, map,
1259 1.126 skrll map->_dm_buftype);
1260 1.8 thorpej }
1261 1.1 chris
1262 1.8 thorpej /* Drain the write buffer. */
1263 1.8 thorpej cpu_drain_writebuf();
1264 1.58 matt
1265 1.76 matt if (!bouncing || (ops & BUS_DMASYNC_POSTREAD) == 0)
1266 1.58 matt return;
1267 1.58 matt
1268 1.115 skrll bounce_it:
1269 1.115 skrll STAT_INCR(read_bounces);
1270 1.115 skrll
1271 1.63 matt struct arm32_bus_dma_cookie * const cookie = map->_dm_cookie;
1272 1.58 matt char * const dataptr = (char *)cookie->id_bouncebuf + offset;
1273 1.58 matt /*
1274 1.58 matt * Copy the bounce buffer to the caller's buffer.
1275 1.58 matt */
1276 1.58 matt switch (map->_dm_buftype) {
1277 1.58 matt case _BUS_DMA_BUFTYPE_LINEAR:
1278 1.58 matt memcpy(cookie->id_origlinearbuf + offset, dataptr, len);
1279 1.58 matt break;
1280 1.58 matt
1281 1.58 matt case _BUS_DMA_BUFTYPE_MBUF:
1282 1.58 matt m_copyback(cookie->id_origmbuf, offset, len, dataptr);
1283 1.58 matt break;
1284 1.58 matt
1285 1.58 matt case _BUS_DMA_BUFTYPE_UIO:
1286 1.58 matt _bus_dma_uiomove(dataptr, cookie->id_origuio, len, UIO_READ);
1287 1.58 matt break;
1288 1.126 skrll
1289 1.58 matt #ifdef DIAGNOSTIC
1290 1.58 matt case _BUS_DMA_BUFTYPE_RAW:
1291 1.126 skrll panic("%s(post): _BUS_DMA_BUFTYPE_RAW", __func__);
1292 1.58 matt break;
1293 1.58 matt
1294 1.58 matt case _BUS_DMA_BUFTYPE_INVALID:
1295 1.126 skrll panic("%s(post): _BUS_DMA_BUFTYPE_INVALID", __func__);
1296 1.58 matt break;
1297 1.58 matt
1298 1.58 matt default:
1299 1.126 skrll panic("%s(post): map %p: unknown buffer type %d\n", __func__,
1300 1.58 matt map, map->_dm_buftype);
1301 1.58 matt break;
1302 1.58 matt #endif
1303 1.58 matt }
1304 1.1 chris }
1305 1.1 chris
1306 1.1 chris /*
1307 1.1 chris * Common function for DMA-safe memory allocation. May be called
1308 1.1 chris * by bus-specific DMA memory allocation functions.
1309 1.1 chris */
1310 1.1 chris
1311 1.11 thorpej extern paddr_t physical_start;
1312 1.11 thorpej extern paddr_t physical_end;
1313 1.1 chris
1314 1.1 chris int
1315 1.7 thorpej _bus_dmamem_alloc(bus_dma_tag_t t, bus_size_t size, bus_size_t alignment,
1316 1.7 thorpej bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs,
1317 1.7 thorpej int flags)
1318 1.1 chris {
1319 1.15 thorpej struct arm32_dma_range *dr;
1320 1.37 mycroft int error, i;
1321 1.15 thorpej
1322 1.1 chris #ifdef DEBUG_DMA
1323 1.130 skrll printf("dmamem_alloc t=%p size=%#lx align=%#lx boundary=%#lx "
1324 1.130 skrll "segs=%p nsegs=%#x rsegs=%p flags=%#x\n", t, size, alignment,
1325 1.15 thorpej boundary, segs, nsegs, rsegs, flags);
1326 1.15 thorpej #endif
1327 1.15 thorpej
1328 1.15 thorpej if ((dr = t->_ranges) != NULL) {
1329 1.37 mycroft error = ENOMEM;
1330 1.15 thorpej for (i = 0; i < t->_nranges; i++, dr++) {
1331 1.70 matt if (dr->dr_len == 0
1332 1.70 matt || (dr->dr_flags & _BUS_DMAMAP_NOALLOC))
1333 1.15 thorpej continue;
1334 1.15 thorpej error = _bus_dmamem_alloc_range(t, size, alignment,
1335 1.15 thorpej boundary, segs, nsegs, rsegs, flags,
1336 1.15 thorpej trunc_page(dr->dr_sysbase),
1337 1.15 thorpej trunc_page(dr->dr_sysbase + dr->dr_len));
1338 1.15 thorpej if (error == 0)
1339 1.15 thorpej break;
1340 1.15 thorpej }
1341 1.15 thorpej } else {
1342 1.15 thorpej error = _bus_dmamem_alloc_range(t, size, alignment, boundary,
1343 1.15 thorpej segs, nsegs, rsegs, flags, trunc_page(physical_start),
1344 1.15 thorpej trunc_page(physical_end));
1345 1.15 thorpej }
1346 1.15 thorpej
1347 1.1 chris #ifdef DEBUG_DMA
1348 1.1 chris printf("dmamem_alloc: =%d\n", error);
1349 1.15 thorpej #endif
1350 1.15 thorpej
1351 1.100 skrll return error;
1352 1.1 chris }
1353 1.1 chris
1354 1.1 chris /*
1355 1.1 chris * Common function for freeing DMA-safe memory. May be called by
1356 1.1 chris * bus-specific DMA memory free functions.
1357 1.1 chris */
1358 1.1 chris void
1359 1.7 thorpej _bus_dmamem_free(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs)
1360 1.1 chris {
1361 1.1 chris struct vm_page *m;
1362 1.1 chris bus_addr_t addr;
1363 1.1 chris struct pglist mlist;
1364 1.1 chris int curseg;
1365 1.1 chris
1366 1.1 chris #ifdef DEBUG_DMA
1367 1.130 skrll printf("dmamem_free: t=%p segs=%p nsegs=%#x\n", t, segs, nsegs);
1368 1.1 chris #endif /* DEBUG_DMA */
1369 1.1 chris
1370 1.1 chris /*
1371 1.1 chris * Build a list of pages to free back to the VM system.
1372 1.1 chris */
1373 1.1 chris TAILQ_INIT(&mlist);
1374 1.1 chris for (curseg = 0; curseg < nsegs; curseg++) {
1375 1.1 chris for (addr = segs[curseg].ds_addr;
1376 1.1 chris addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
1377 1.1 chris addr += PAGE_SIZE) {
1378 1.1 chris m = PHYS_TO_VM_PAGE(addr);
1379 1.52 ad TAILQ_INSERT_TAIL(&mlist, m, pageq.queue);
1380 1.1 chris }
1381 1.1 chris }
1382 1.1 chris uvm_pglistfree(&mlist);
1383 1.1 chris }
1384 1.1 chris
1385 1.1 chris /*
1386 1.1 chris * Common function for mapping DMA-safe memory. May be called by
1387 1.1 chris * bus-specific DMA memory map functions.
1388 1.1 chris */
1389 1.1 chris int
1390 1.7 thorpej _bus_dmamem_map(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs,
1391 1.50 christos size_t size, void **kvap, int flags)
1392 1.1 chris {
1393 1.11 thorpej vaddr_t va;
1394 1.57 matt paddr_t pa;
1395 1.1 chris int curseg;
1396 1.65 matt const uvm_flag_t kmflags = UVM_KMF_VAONLY
1397 1.65 matt | ((flags & BUS_DMA_NOWAIT) != 0 ? UVM_KMF_NOWAIT : 0);
1398 1.65 matt vsize_t align = 0;
1399 1.1 chris
1400 1.1 chris #ifdef DEBUG_DMA
1401 1.130 skrll printf("dmamem_map: t=%p segs=%p nsegs=%#x size=%#lx flags=%#x\n", t,
1402 1.3 rearnsha segs, nsegs, (unsigned long)size, flags);
1403 1.1 chris #endif /* DEBUG_DMA */
1404 1.1 chris
1405 1.62 matt #ifdef PMAP_MAP_POOLPAGE
1406 1.62 matt /*
1407 1.62 matt * If all of memory is mapped, and we are mapping a single physically
1408 1.62 matt * contiguous area then this area is already mapped. Let's see if we
1409 1.62 matt * avoid having a separate mapping for it.
1410 1.62 matt */
1411 1.118 jmcneill if (nsegs == 1 && (flags & BUS_DMA_PREFETCHABLE) == 0) {
1412 1.62 matt /*
1413 1.62 matt * If this is a non-COHERENT mapping, then the existing kernel
1414 1.62 matt * mapping is already compatible with it.
1415 1.62 matt */
1416 1.68 matt bool direct_mapable = (flags & BUS_DMA_COHERENT) == 0;
1417 1.68 matt pa = segs[0].ds_addr;
1418 1.68 matt
1419 1.62 matt /*
1420 1.68 matt * This is a COHERENT mapping which, unless this address is in
1421 1.62 matt * a COHERENT dma range, will not be compatible.
1422 1.62 matt */
1423 1.62 matt if (t->_ranges != NULL) {
1424 1.62 matt const struct arm32_dma_range * const dr =
1425 1.68 matt _bus_dma_paddr_inrange(t->_ranges, t->_nranges, pa);
1426 1.71 matt if (dr != NULL
1427 1.71 matt && (dr->dr_flags & _BUS_DMAMAP_COHERENT)) {
1428 1.71 matt direct_mapable = true;
1429 1.68 matt }
1430 1.68 matt }
1431 1.68 matt
1432 1.87 matt #ifdef PMAP_NEED_ALLOC_POOLPAGE
1433 1.87 matt /*
1434 1.87 matt * The page can only be direct mapped if was allocated out
1435 1.95 skrll * of the arm poolpage vm freelist.
1436 1.87 matt */
1437 1.97 cherry uvm_physseg_t upm = uvm_physseg_find(atop(pa), NULL);
1438 1.97 cherry KASSERT(uvm_physseg_valid_p(upm));
1439 1.87 matt if (direct_mapable) {
1440 1.87 matt direct_mapable =
1441 1.97 cherry (arm_poolpage_vmfreelist == uvm_physseg_get_free_list(upm));
1442 1.87 matt }
1443 1.87 matt #endif
1444 1.87 matt
1445 1.68 matt if (direct_mapable) {
1446 1.68 matt *kvap = (void *)PMAP_MAP_POOLPAGE(pa);
1447 1.64 matt #ifdef DEBUG_DMA
1448 1.68 matt printf("dmamem_map: =%p\n", *kvap);
1449 1.64 matt #endif /* DEBUG_DMA */
1450 1.68 matt return 0;
1451 1.62 matt }
1452 1.62 matt }
1453 1.62 matt #endif
1454 1.62 matt
1455 1.1 chris size = round_page(size);
1456 1.107 ryo
1457 1.107 ryo #ifdef PMAP_MAPSIZE1
1458 1.107 ryo if (size >= PMAP_MAPSIZE1)
1459 1.107 ryo align = PMAP_MAPSIZE1;
1460 1.107 ryo
1461 1.107 ryo #ifdef PMAP_MAPSIZE2
1462 1.107 ryo
1463 1.107 ryo #if PMAP_MAPSIZE1 > PMAP_MAPSIZE2
1464 1.107 ryo #error PMAP_MAPSIZE1 must be smaller than PMAP_MAPSIZE2
1465 1.107 ryo #endif
1466 1.107 ryo
1467 1.107 ryo if (size >= PMAP_MAPSIZE2)
1468 1.107 ryo align = PMAP_MAPSIZE2;
1469 1.107 ryo
1470 1.107 ryo #ifdef PMAP_MAPSIZE3
1471 1.107 ryo
1472 1.107 ryo #if PMAP_MAPSIZE2 > PMAP_MAPSIZE3
1473 1.107 ryo #error PMAP_MAPSIZE2 must be smaller than PMAP_MAPSIZE3
1474 1.107 ryo #endif
1475 1.107 ryo
1476 1.107 ryo if (size >= PMAP_MAPSIZE3)
1477 1.107 ryo align = PMAP_MAPSIZE3;
1478 1.107 ryo #endif
1479 1.107 ryo #endif
1480 1.107 ryo #endif
1481 1.65 matt
1482 1.65 matt va = uvm_km_alloc(kernel_map, size, align, kmflags);
1483 1.65 matt if (__predict_false(va == 0 && align > 0)) {
1484 1.65 matt align = 0;
1485 1.65 matt va = uvm_km_alloc(kernel_map, size, 0, kmflags);
1486 1.65 matt }
1487 1.1 chris
1488 1.1 chris if (va == 0)
1489 1.100 skrll return ENOMEM;
1490 1.1 chris
1491 1.50 christos *kvap = (void *)va;
1492 1.1 chris
1493 1.1 chris for (curseg = 0; curseg < nsegs; curseg++) {
1494 1.57 matt for (pa = segs[curseg].ds_addr;
1495 1.57 matt pa < (segs[curseg].ds_addr + segs[curseg].ds_len);
1496 1.57 matt pa += PAGE_SIZE, va += PAGE_SIZE, size -= PAGE_SIZE) {
1497 1.68 matt bool uncached = (flags & BUS_DMA_COHERENT);
1498 1.117 jmcneill bool prefetchable = (flags & BUS_DMA_PREFETCHABLE);
1499 1.1 chris #ifdef DEBUG_DMA
1500 1.131 skrll printf("wiring P%#lx to V%#lx\n", pa, va);
1501 1.1 chris #endif /* DEBUG_DMA */
1502 1.1 chris if (size == 0)
1503 1.1 chris panic("_bus_dmamem_map: size botch");
1504 1.68 matt
1505 1.68 matt const struct arm32_dma_range * const dr =
1506 1.68 matt _bus_dma_paddr_inrange(t->_ranges, t->_nranges, pa);
1507 1.68 matt /*
1508 1.68 matt * If this dma region is coherent then there is
1509 1.68 matt * no need for an uncached mapping.
1510 1.68 matt */
1511 1.71 matt if (dr != NULL
1512 1.71 matt && (dr->dr_flags & _BUS_DMAMAP_COHERENT)) {
1513 1.71 matt uncached = false;
1514 1.68 matt }
1515 1.71 matt
1516 1.117 jmcneill u_int pmap_flags = PMAP_WIRED;
1517 1.117 jmcneill if (prefetchable)
1518 1.117 jmcneill pmap_flags |= PMAP_WRITE_COMBINE;
1519 1.117 jmcneill else if (uncached)
1520 1.117 jmcneill pmap_flags |= PMAP_NOCACHE;
1521 1.117 jmcneill
1522 1.81 matt pmap_kenter_pa(va, pa, VM_PROT_READ | VM_PROT_WRITE,
1523 1.117 jmcneill pmap_flags);
1524 1.1 chris }
1525 1.1 chris }
1526 1.2 chris pmap_update(pmap_kernel());
1527 1.1 chris #ifdef DEBUG_DMA
1528 1.1 chris printf("dmamem_map: =%p\n", *kvap);
1529 1.1 chris #endif /* DEBUG_DMA */
1530 1.100 skrll return 0;
1531 1.1 chris }
1532 1.1 chris
1533 1.1 chris /*
1534 1.1 chris * Common function for unmapping DMA-safe memory. May be called by
1535 1.1 chris * bus-specific DMA memory unmapping functions.
1536 1.1 chris */
1537 1.1 chris void
1538 1.50 christos _bus_dmamem_unmap(bus_dma_tag_t t, void *kva, size_t size)
1539 1.1 chris {
1540 1.1 chris
1541 1.1 chris #ifdef DEBUG_DMA
1542 1.130 skrll printf("dmamem_unmap: t=%p kva=%p size=%#zx\n", t, kva, size);
1543 1.1 chris #endif /* DEBUG_DMA */
1544 1.79 matt KASSERTMSG(((uintptr_t)kva & PAGE_MASK) == 0,
1545 1.83 christos "kva %p (%#"PRIxPTR")", kva, ((uintptr_t)kva & PAGE_MASK));
1546 1.1 chris
1547 1.84 matt #ifdef __HAVE_MM_MD_DIRECT_MAPPED_PHYS
1548 1.84 matt /*
1549 1.88 snj * Check to see if this used direct mapped memory. Get its physical
1550 1.84 matt * address and try to map it. If the resultant matches the kva, then
1551 1.99 skrll * it was and so we can just return since we have nothing to free up.
1552 1.84 matt */
1553 1.84 matt paddr_t pa;
1554 1.84 matt vaddr_t va;
1555 1.84 matt (void)pmap_extract(pmap_kernel(), (vaddr_t)kva, &pa);
1556 1.84 matt if (mm_md_direct_mapped_phys(pa, &va) && va == (vaddr_t)kva)
1557 1.84 matt return;
1558 1.84 matt #endif
1559 1.84 matt
1560 1.1 chris size = round_page(size);
1561 1.65 matt pmap_kremove((vaddr_t)kva, size);
1562 1.44 yamt pmap_update(pmap_kernel());
1563 1.44 yamt uvm_km_free(kernel_map, (vaddr_t)kva, size, UVM_KMF_VAONLY);
1564 1.1 chris }
1565 1.1 chris
1566 1.1 chris /*
1567 1.1 chris * Common functin for mmap(2)'ing DMA-safe memory. May be called by
1568 1.1 chris * bus-specific DMA mmap(2)'ing functions.
1569 1.1 chris */
1570 1.1 chris paddr_t
1571 1.7 thorpej _bus_dmamem_mmap(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs,
1572 1.7 thorpej off_t off, int prot, int flags)
1573 1.1 chris {
1574 1.73 macallan paddr_t map_flags;
1575 1.1 chris int i;
1576 1.1 chris
1577 1.1 chris for (i = 0; i < nsegs; i++) {
1578 1.79 matt KASSERTMSG((off & PAGE_MASK) == 0,
1579 1.111 christos "off %#jx (%#x)", (uintmax_t)off, (int)off & PAGE_MASK);
1580 1.79 matt KASSERTMSG((segs[i].ds_addr & PAGE_MASK) == 0,
1581 1.79 matt "ds_addr %#lx (%#x)", segs[i].ds_addr,
1582 1.79 matt (int)segs[i].ds_addr & PAGE_MASK);
1583 1.79 matt KASSERTMSG((segs[i].ds_len & PAGE_MASK) == 0,
1584 1.79 matt "ds_len %#lx (%#x)", segs[i].ds_addr,
1585 1.79 matt (int)segs[i].ds_addr & PAGE_MASK);
1586 1.1 chris if (off >= segs[i].ds_len) {
1587 1.1 chris off -= segs[i].ds_len;
1588 1.1 chris continue;
1589 1.1 chris }
1590 1.1 chris
1591 1.73 macallan map_flags = 0;
1592 1.73 macallan if (flags & BUS_DMA_PREFETCHABLE)
1593 1.107 ryo map_flags |= ARM_MMAP_WRITECOMBINE;
1594 1.73 macallan
1595 1.100 skrll return arm_btop((u_long)segs[i].ds_addr + off) | map_flags;
1596 1.95 skrll
1597 1.1 chris }
1598 1.1 chris
1599 1.1 chris /* Page not found. */
1600 1.100 skrll return -1;
1601 1.1 chris }
1602 1.1 chris
1603 1.1 chris /**********************************************************************
1604 1.1 chris * DMA utility functions
1605 1.1 chris **********************************************************************/
1606 1.1 chris
1607 1.1 chris /*
1608 1.1 chris * Utility function to load a linear buffer. lastaddrp holds state
1609 1.1 chris * between invocations (for multiple-buffer loads). segp contains
1610 1.1 chris * the starting segment on entrace, and the ending segment on exit.
1611 1.1 chris * first indicates if this is the first invocation of this function.
1612 1.1 chris */
1613 1.1 chris int
1614 1.7 thorpej _bus_dmamap_load_buffer(bus_dma_tag_t t, bus_dmamap_t map, void *buf,
1615 1.48 yamt bus_size_t buflen, struct vmspace *vm, int flags)
1616 1.1 chris {
1617 1.1 chris bus_size_t sgsize;
1618 1.41 thorpej bus_addr_t curaddr;
1619 1.11 thorpej vaddr_t vaddr = (vaddr_t)buf;
1620 1.41 thorpej int error;
1621 1.1 chris pmap_t pmap;
1622 1.1 chris
1623 1.1 chris #ifdef DEBUG_DMA
1624 1.130 skrll printf("_bus_dmamem_load_buffer(buf=%p, len=%#lx, flags=%#x)\n",
1625 1.40 scw buf, buflen, flags);
1626 1.1 chris #endif /* DEBUG_DMA */
1627 1.1 chris
1628 1.48 yamt pmap = vm_map_pmap(&vm->vm_map);
1629 1.1 chris
1630 1.41 thorpej while (buflen > 0) {
1631 1.1 chris /*
1632 1.1 chris * Get the physical address for this segment.
1633 1.17 thorpej *
1634 1.1 chris */
1635 1.61 matt bool coherent;
1636 1.132 skrll bool ok __diagused;
1637 1.132 skrll ok = pmap_extract_coherency(pmap, vaddr, &curaddr, &coherent);
1638 1.132 skrll
1639 1.132 skrll /*
1640 1.132 skrll * trying to bus_dmamap_load an unmapped buffer is a
1641 1.132 skrll * programming error.
1642 1.132 skrll */
1643 1.132 skrll KASSERT(ok);
1644 1.107 ryo
1645 1.86 matt KASSERTMSG((vaddr & PAGE_MASK) == (curaddr & PAGE_MASK),
1646 1.86 matt "va %#lx curaddr %#lx", vaddr, curaddr);
1647 1.1 chris
1648 1.1 chris /*
1649 1.1 chris * Compute the segment size, and adjust counts.
1650 1.1 chris */
1651 1.27 thorpej sgsize = PAGE_SIZE - ((u_long)vaddr & PGOFSET);
1652 1.1 chris if (buflen < sgsize)
1653 1.1 chris sgsize = buflen;
1654 1.1 chris
1655 1.61 matt error = _bus_dmamap_load_paddr(t, map, curaddr, sgsize,
1656 1.61 matt coherent);
1657 1.41 thorpej if (error)
1658 1.100 skrll return error;
1659 1.1 chris
1660 1.1 chris vaddr += sgsize;
1661 1.1 chris buflen -= sgsize;
1662 1.1 chris }
1663 1.1 chris
1664 1.100 skrll return 0;
1665 1.1 chris }
1666 1.1 chris
1667 1.1 chris /*
1668 1.1 chris * Allocate physical memory from the given physical address range.
1669 1.1 chris * Called by DMA-safe memory allocation methods.
1670 1.1 chris */
1671 1.1 chris int
1672 1.7 thorpej _bus_dmamem_alloc_range(bus_dma_tag_t t, bus_size_t size, bus_size_t alignment,
1673 1.7 thorpej bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs,
1674 1.11 thorpej int flags, paddr_t low, paddr_t high)
1675 1.1 chris {
1676 1.11 thorpej paddr_t curaddr, lastaddr;
1677 1.1 chris struct vm_page *m;
1678 1.1 chris struct pglist mlist;
1679 1.1 chris int curseg, error;
1680 1.1 chris
1681 1.101 skrll KASSERTMSG(boundary == 0 || (boundary & (boundary - 1)) == 0,
1682 1.76 matt "invalid boundary %#lx", boundary);
1683 1.76 matt
1684 1.1 chris #ifdef DEBUG_DMA
1685 1.130 skrll printf("alloc_range: t=%p size=%#lx align=%#lx boundary=%#lx segs=%p nsegs=%#x rsegs=%p flags=%#x lo=%#lx hi=%#lx\n",
1686 1.1 chris t, size, alignment, boundary, segs, nsegs, rsegs, flags, low, high);
1687 1.1 chris #endif /* DEBUG_DMA */
1688 1.1 chris
1689 1.1 chris /* Always round the size. */
1690 1.1 chris size = round_page(size);
1691 1.1 chris
1692 1.1 chris /*
1693 1.76 matt * We accept boundaries < size, splitting in multiple segments
1694 1.76 matt * if needed. uvm_pglistalloc does not, so compute an appropriate
1695 1.76 matt * boundary: next power of 2 >= size
1696 1.76 matt */
1697 1.76 matt bus_size_t uboundary = boundary;
1698 1.76 matt if (uboundary <= PAGE_SIZE) {
1699 1.76 matt uboundary = 0;
1700 1.76 matt } else {
1701 1.76 matt while (uboundary < size) {
1702 1.76 matt uboundary <<= 1;
1703 1.76 matt }
1704 1.76 matt }
1705 1.76 matt
1706 1.76 matt /*
1707 1.1 chris * Allocate pages from the VM system.
1708 1.1 chris */
1709 1.78 matt error = uvm_pglistalloc(size, low, high, alignment, uboundary,
1710 1.1 chris &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0);
1711 1.1 chris if (error)
1712 1.100 skrll return error;
1713 1.1 chris
1714 1.1 chris /*
1715 1.1 chris * Compute the location, size, and number of segments actually
1716 1.1 chris * returned by the VM code.
1717 1.1 chris */
1718 1.42 chris m = TAILQ_FIRST(&mlist);
1719 1.1 chris curseg = 0;
1720 1.1 chris lastaddr = segs[curseg].ds_addr = VM_PAGE_TO_PHYS(m);
1721 1.1 chris segs[curseg].ds_len = PAGE_SIZE;
1722 1.1 chris #ifdef DEBUG_DMA
1723 1.130 skrll printf("alloc: page %#lx\n", lastaddr);
1724 1.1 chris #endif /* DEBUG_DMA */
1725 1.52 ad m = TAILQ_NEXT(m, pageq.queue);
1726 1.1 chris
1727 1.52 ad for (; m != NULL; m = TAILQ_NEXT(m, pageq.queue)) {
1728 1.1 chris curaddr = VM_PAGE_TO_PHYS(m);
1729 1.76 matt KASSERTMSG(low <= curaddr && curaddr < high,
1730 1.76 matt "uvm_pglistalloc returned non-sensicaladdress %#lx "
1731 1.76 matt "(low=%#lx, high=%#lx\n", curaddr, low, high);
1732 1.1 chris #ifdef DEBUG_DMA
1733 1.130 skrll printf("alloc: page %#lx\n", curaddr);
1734 1.1 chris #endif /* DEBUG_DMA */
1735 1.76 matt if (curaddr == lastaddr + PAGE_SIZE
1736 1.76 matt && (lastaddr & boundary) == (curaddr & boundary))
1737 1.1 chris segs[curseg].ds_len += PAGE_SIZE;
1738 1.1 chris else {
1739 1.1 chris curseg++;
1740 1.76 matt if (curseg >= nsegs) {
1741 1.76 matt uvm_pglistfree(&mlist);
1742 1.76 matt return EFBIG;
1743 1.76 matt }
1744 1.1 chris segs[curseg].ds_addr = curaddr;
1745 1.1 chris segs[curseg].ds_len = PAGE_SIZE;
1746 1.1 chris }
1747 1.1 chris lastaddr = curaddr;
1748 1.1 chris }
1749 1.1 chris
1750 1.1 chris *rsegs = curseg + 1;
1751 1.1 chris
1752 1.100 skrll return 0;
1753 1.15 thorpej }
1754 1.15 thorpej
1755 1.15 thorpej /*
1756 1.15 thorpej * Check if a memory region intersects with a DMA range, and return the
1757 1.15 thorpej * page-rounded intersection if it does.
1758 1.15 thorpej */
1759 1.15 thorpej int
1760 1.15 thorpej arm32_dma_range_intersect(struct arm32_dma_range *ranges, int nranges,
1761 1.15 thorpej paddr_t pa, psize_t size, paddr_t *pap, psize_t *sizep)
1762 1.15 thorpej {
1763 1.15 thorpej struct arm32_dma_range *dr;
1764 1.15 thorpej int i;
1765 1.15 thorpej
1766 1.15 thorpej if (ranges == NULL)
1767 1.100 skrll return 0;
1768 1.15 thorpej
1769 1.15 thorpej for (i = 0, dr = ranges; i < nranges; i++, dr++) {
1770 1.15 thorpej if (dr->dr_sysbase <= pa &&
1771 1.15 thorpej pa < (dr->dr_sysbase + dr->dr_len)) {
1772 1.15 thorpej /*
1773 1.15 thorpej * Beginning of region intersects with this range.
1774 1.15 thorpej */
1775 1.15 thorpej *pap = trunc_page(pa);
1776 1.112 riastrad *sizep = round_page(uimin(pa + size,
1777 1.15 thorpej dr->dr_sysbase + dr->dr_len) - pa);
1778 1.100 skrll return 1;
1779 1.15 thorpej }
1780 1.15 thorpej if (pa < dr->dr_sysbase && dr->dr_sysbase < (pa + size)) {
1781 1.15 thorpej /*
1782 1.15 thorpej * End of region intersects with this range.
1783 1.15 thorpej */
1784 1.15 thorpej *pap = trunc_page(dr->dr_sysbase);
1785 1.112 riastrad *sizep = round_page(uimin((pa + size) - dr->dr_sysbase,
1786 1.15 thorpej dr->dr_len));
1787 1.100 skrll return 1;
1788 1.15 thorpej }
1789 1.15 thorpej }
1790 1.15 thorpej
1791 1.15 thorpej /* No intersection found. */
1792 1.100 skrll return 0;
1793 1.1 chris }
1794 1.58 matt
1795 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
1796 1.58 matt static int
1797 1.58 matt _bus_dma_alloc_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map,
1798 1.58 matt bus_size_t size, int flags)
1799 1.58 matt {
1800 1.58 matt struct arm32_bus_dma_cookie *cookie = map->_dm_cookie;
1801 1.58 matt int error = 0;
1802 1.58 matt
1803 1.79 matt KASSERT(cookie != NULL);
1804 1.58 matt
1805 1.58 matt cookie->id_bouncebuflen = round_page(size);
1806 1.58 matt error = _bus_dmamem_alloc(t, cookie->id_bouncebuflen,
1807 1.58 matt PAGE_SIZE, map->_dm_boundary, cookie->id_bouncesegs,
1808 1.58 matt map->_dm_segcnt, &cookie->id_nbouncesegs, flags);
1809 1.76 matt if (error == 0) {
1810 1.76 matt error = _bus_dmamem_map(t, cookie->id_bouncesegs,
1811 1.76 matt cookie->id_nbouncesegs, cookie->id_bouncebuflen,
1812 1.76 matt (void **)&cookie->id_bouncebuf, flags);
1813 1.76 matt if (error) {
1814 1.76 matt _bus_dmamem_free(t, cookie->id_bouncesegs,
1815 1.76 matt cookie->id_nbouncesegs);
1816 1.76 matt cookie->id_bouncebuflen = 0;
1817 1.76 matt cookie->id_nbouncesegs = 0;
1818 1.76 matt } else {
1819 1.76 matt cookie->id_flags |= _BUS_DMA_HAS_BOUNCE;
1820 1.76 matt }
1821 1.76 matt } else {
1822 1.58 matt cookie->id_bouncebuflen = 0;
1823 1.58 matt cookie->id_nbouncesegs = 0;
1824 1.58 matt }
1825 1.58 matt
1826 1.100 skrll return error;
1827 1.58 matt }
1828 1.58 matt
1829 1.58 matt static void
1830 1.58 matt _bus_dma_free_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map)
1831 1.58 matt {
1832 1.58 matt struct arm32_bus_dma_cookie *cookie = map->_dm_cookie;
1833 1.58 matt
1834 1.79 matt KASSERT(cookie != NULL);
1835 1.58 matt
1836 1.58 matt _bus_dmamem_unmap(t, cookie->id_bouncebuf, cookie->id_bouncebuflen);
1837 1.79 matt _bus_dmamem_free(t, cookie->id_bouncesegs, cookie->id_nbouncesegs);
1838 1.58 matt cookie->id_bouncebuflen = 0;
1839 1.58 matt cookie->id_nbouncesegs = 0;
1840 1.58 matt cookie->id_flags &= ~_BUS_DMA_HAS_BOUNCE;
1841 1.58 matt }
1842 1.115 skrll #endif /* _ARM32_NEED_BUS_DMA_BOUNCE */
1843 1.58 matt
1844 1.58 matt /*
1845 1.58 matt * This function does the same as uiomove, but takes an explicit
1846 1.58 matt * direction, and does not update the uio structure.
1847 1.58 matt */
1848 1.58 matt static int
1849 1.58 matt _bus_dma_uiomove(void *buf, struct uio *uio, size_t n, int direction)
1850 1.58 matt {
1851 1.58 matt struct iovec *iov;
1852 1.58 matt int error;
1853 1.58 matt struct vmspace *vm;
1854 1.58 matt char *cp;
1855 1.58 matt size_t resid, cnt;
1856 1.58 matt int i;
1857 1.58 matt
1858 1.58 matt iov = uio->uio_iov;
1859 1.58 matt vm = uio->uio_vmspace;
1860 1.58 matt cp = buf;
1861 1.58 matt resid = n;
1862 1.58 matt
1863 1.58 matt for (i = 0; i < uio->uio_iovcnt && resid > 0; i++) {
1864 1.58 matt iov = &uio->uio_iov[i];
1865 1.58 matt if (iov->iov_len == 0)
1866 1.58 matt continue;
1867 1.58 matt cnt = MIN(resid, iov->iov_len);
1868 1.58 matt
1869 1.121 ad if (!VMSPACE_IS_KERNEL_P(vm)) {
1870 1.121 ad preempt_point();
1871 1.58 matt }
1872 1.58 matt if (direction == UIO_READ) {
1873 1.58 matt error = copyout_vmspace(vm, cp, iov->iov_base, cnt);
1874 1.58 matt } else {
1875 1.58 matt error = copyin_vmspace(vm, iov->iov_base, cp, cnt);
1876 1.58 matt }
1877 1.58 matt if (error)
1878 1.100 skrll return error;
1879 1.58 matt cp += cnt;
1880 1.58 matt resid -= cnt;
1881 1.58 matt }
1882 1.100 skrll return 0;
1883 1.58 matt }
1884 1.58 matt
1885 1.58 matt int
1886 1.58 matt _bus_dmatag_subregion(bus_dma_tag_t tag, bus_addr_t min_addr,
1887 1.58 matt bus_addr_t max_addr, bus_dma_tag_t *newtag, int flags)
1888 1.58 matt {
1889 1.123 skrll if (min_addr >= max_addr)
1890 1.123 skrll return EOPNOTSUPP;
1891 1.58 matt
1892 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
1893 1.58 matt struct arm32_dma_range *dr;
1894 1.124 skrll bool psubset = true;
1895 1.58 matt size_t nranges = 0;
1896 1.58 matt size_t i;
1897 1.58 matt for (i = 0, dr = tag->_ranges; i < tag->_nranges; i++, dr++) {
1898 1.123 skrll /*
1899 1.124 skrll * If the new {min,max}_addr are narrower than any of the
1900 1.124 skrll * ranges in the parent tag then we need a new tag;
1901 1.124 skrll * otherwise the parent tag is a subset of the new
1902 1.124 skrll * range and can continue to be used.
1903 1.123 skrll */
1904 1.124 skrll if (min_addr > dr->dr_sysbase
1905 1.124 skrll || max_addr < dr->dr_sysbase + dr->dr_len - 1) {
1906 1.124 skrll psubset = false;
1907 1.58 matt }
1908 1.58 matt if (min_addr <= dr->dr_sysbase + dr->dr_len
1909 1.58 matt && max_addr >= dr->dr_sysbase) {
1910 1.58 matt nranges++;
1911 1.58 matt }
1912 1.58 matt }
1913 1.124 skrll if (nranges == 0) {
1914 1.124 skrll nranges = 1;
1915 1.124 skrll psubset = false;
1916 1.124 skrll }
1917 1.124 skrll if (psubset) {
1918 1.58 matt *newtag = tag;
1919 1.58 matt /* if the tag must be freed, add a reference */
1920 1.58 matt if (tag->_tag_needs_free)
1921 1.58 matt (tag->_tag_needs_free)++;
1922 1.58 matt return 0;
1923 1.58 matt }
1924 1.58 matt
1925 1.81 matt const size_t tagsize = sizeof(*tag) + nranges * sizeof(*dr);
1926 1.81 matt if ((*newtag = kmem_intr_zalloc(tagsize,
1927 1.81 matt (flags & BUS_DMA_NOWAIT) ? KM_NOSLEEP : KM_SLEEP)) == NULL)
1928 1.58 matt return ENOMEM;
1929 1.58 matt
1930 1.58 matt dr = (void *)(*newtag + 1);
1931 1.58 matt **newtag = *tag;
1932 1.58 matt (*newtag)->_tag_needs_free = 1;
1933 1.58 matt (*newtag)->_ranges = dr;
1934 1.58 matt (*newtag)->_nranges = nranges;
1935 1.58 matt
1936 1.58 matt if (tag->_ranges == NULL) {
1937 1.58 matt dr->dr_sysbase = min_addr;
1938 1.58 matt dr->dr_busbase = min_addr;
1939 1.58 matt dr->dr_len = max_addr + 1 - min_addr;
1940 1.58 matt } else {
1941 1.123 skrll struct arm32_dma_range *pdr;
1942 1.123 skrll
1943 1.123 skrll for (i = 0, pdr = tag->_ranges; i < tag->_nranges; i++, pdr++) {
1944 1.123 skrll KASSERT(nranges != 0);
1945 1.123 skrll
1946 1.123 skrll if (min_addr > pdr->dr_sysbase + pdr->dr_len
1947 1.123 skrll || max_addr < pdr->dr_sysbase) {
1948 1.123 skrll /*
1949 1.123 skrll * this range doesn't overlap with new limits,
1950 1.123 skrll * so skip.
1951 1.123 skrll */
1952 1.58 matt continue;
1953 1.123 skrll }
1954 1.123 skrll /*
1955 1.123 skrll * Copy the range and adjust to fit within the new
1956 1.123 skrll * limits
1957 1.123 skrll */
1958 1.123 skrll dr[0] = pdr[0];
1959 1.58 matt if (dr->dr_sysbase < min_addr) {
1960 1.58 matt psize_t diff = min_addr - dr->dr_sysbase;
1961 1.58 matt dr->dr_busbase += diff;
1962 1.58 matt dr->dr_len -= diff;
1963 1.58 matt dr->dr_sysbase += diff;
1964 1.58 matt }
1965 1.123 skrll if (max_addr <= dr->dr_sysbase + dr->dr_len - 1) {
1966 1.58 matt dr->dr_len = max_addr + 1 - dr->dr_sysbase;
1967 1.58 matt }
1968 1.58 matt dr++;
1969 1.123 skrll nranges--;
1970 1.58 matt }
1971 1.58 matt }
1972 1.58 matt
1973 1.58 matt return 0;
1974 1.58 matt #else
1975 1.58 matt return EOPNOTSUPP;
1976 1.58 matt #endif /* _ARM32_NEED_BUS_DMA_BOUNCE */
1977 1.58 matt }
1978 1.58 matt
1979 1.58 matt void
1980 1.58 matt _bus_dmatag_destroy(bus_dma_tag_t tag)
1981 1.58 matt {
1982 1.58 matt #ifdef _ARM32_NEED_BUS_DMA_BOUNCE
1983 1.58 matt switch (tag->_tag_needs_free) {
1984 1.58 matt case 0:
1985 1.81 matt break; /* not allocated with kmem */
1986 1.81 matt case 1: {
1987 1.81 matt const size_t tagsize = sizeof(*tag)
1988 1.81 matt + tag->_nranges * sizeof(*tag->_ranges);
1989 1.81 matt kmem_intr_free(tag, tagsize); /* last reference to tag */
1990 1.58 matt break;
1991 1.81 matt }
1992 1.58 matt default:
1993 1.58 matt (tag->_tag_needs_free)--; /* one less reference */
1994 1.58 matt }
1995 1.58 matt #endif
1996 1.58 matt }
1997