bus_dma.c revision 1.43 1 1.43 matt /* $NetBSD: bus_dma.c,v 1.43 2005/03/09 19:04:43 matt Exp $ */
2 1.1 chris
3 1.1 chris /*-
4 1.1 chris * Copyright (c) 1996, 1997, 1998 The NetBSD Foundation, Inc.
5 1.1 chris * All rights reserved.
6 1.1 chris *
7 1.1 chris * This code is derived from software contributed to The NetBSD Foundation
8 1.1 chris * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
9 1.1 chris * NASA Ames Research Center.
10 1.1 chris *
11 1.1 chris * Redistribution and use in source and binary forms, with or without
12 1.1 chris * modification, are permitted provided that the following conditions
13 1.1 chris * are met:
14 1.1 chris * 1. Redistributions of source code must retain the above copyright
15 1.1 chris * notice, this list of conditions and the following disclaimer.
16 1.1 chris * 2. Redistributions in binary form must reproduce the above copyright
17 1.1 chris * notice, this list of conditions and the following disclaimer in the
18 1.1 chris * documentation and/or other materials provided with the distribution.
19 1.1 chris * 3. All advertising materials mentioning features or use of this software
20 1.1 chris * must display the following acknowledgement:
21 1.1 chris * This product includes software developed by the NetBSD
22 1.1 chris * Foundation, Inc. and its contributors.
23 1.1 chris * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.1 chris * contributors may be used to endorse or promote products derived
25 1.1 chris * from this software without specific prior written permission.
26 1.1 chris *
27 1.1 chris * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.1 chris * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.1 chris * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.1 chris * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.1 chris * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.1 chris * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.1 chris * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.1 chris * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.1 chris * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.1 chris * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.1 chris * POSSIBILITY OF SUCH DAMAGE.
38 1.1 chris */
39 1.33 lukem
40 1.35 rearnsha #define _ARM32_BUS_DMA_PRIVATE
41 1.35 rearnsha
42 1.33 lukem #include <sys/cdefs.h>
43 1.43 matt __KERNEL_RCSID(0, "$NetBSD: bus_dma.c,v 1.43 2005/03/09 19:04:43 matt Exp $");
44 1.1 chris
45 1.1 chris #include <sys/param.h>
46 1.1 chris #include <sys/systm.h>
47 1.1 chris #include <sys/kernel.h>
48 1.1 chris #include <sys/proc.h>
49 1.1 chris #include <sys/buf.h>
50 1.1 chris #include <sys/reboot.h>
51 1.1 chris #include <sys/conf.h>
52 1.1 chris #include <sys/file.h>
53 1.1 chris #include <sys/malloc.h>
54 1.1 chris #include <sys/mbuf.h>
55 1.1 chris #include <sys/vnode.h>
56 1.1 chris #include <sys/device.h>
57 1.1 chris
58 1.1 chris #include <uvm/uvm_extern.h>
59 1.1 chris
60 1.1 chris #include <machine/bus.h>
61 1.1 chris #include <machine/cpu.h>
62 1.4 thorpej
63 1.4 thorpej #include <arm/cpufunc.h>
64 1.1 chris
65 1.7 thorpej int _bus_dmamap_load_buffer(bus_dma_tag_t, bus_dmamap_t, void *,
66 1.41 thorpej bus_size_t, struct proc *, int);
67 1.15 thorpej struct arm32_dma_range *_bus_dma_inrange(struct arm32_dma_range *,
68 1.15 thorpej int, bus_addr_t);
69 1.1 chris
70 1.1 chris /*
71 1.19 briggs * Check to see if the specified page is in an allowed DMA range.
72 1.19 briggs */
73 1.19 briggs __inline struct arm32_dma_range *
74 1.19 briggs _bus_dma_inrange(struct arm32_dma_range *ranges, int nranges,
75 1.19 briggs bus_addr_t curaddr)
76 1.19 briggs {
77 1.19 briggs struct arm32_dma_range *dr;
78 1.19 briggs int i;
79 1.19 briggs
80 1.19 briggs for (i = 0, dr = ranges; i < nranges; i++, dr++) {
81 1.19 briggs if (curaddr >= dr->dr_sysbase &&
82 1.19 briggs round_page(curaddr) <= (dr->dr_sysbase + dr->dr_len))
83 1.19 briggs return (dr);
84 1.19 briggs }
85 1.19 briggs
86 1.19 briggs return (NULL);
87 1.19 briggs }
88 1.19 briggs
89 1.19 briggs /*
90 1.41 thorpej * Common function to load the specified physical address into the
91 1.41 thorpej * DMA map, coalescing segments and boundary checking as necessary.
92 1.41 thorpej */
93 1.41 thorpej static int
94 1.41 thorpej _bus_dmamap_load_paddr(bus_dma_tag_t t, bus_dmamap_t map,
95 1.41 thorpej bus_addr_t paddr, bus_size_t size)
96 1.41 thorpej {
97 1.41 thorpej bus_dma_segment_t * const segs = map->dm_segs;
98 1.41 thorpej int nseg = map->dm_nsegs;
99 1.41 thorpej bus_addr_t lastaddr = 0xdead; /* XXX gcc */
100 1.41 thorpej bus_addr_t bmask = ~(map->_dm_boundary - 1);
101 1.41 thorpej bus_addr_t curaddr;
102 1.41 thorpej bus_size_t sgsize;
103 1.41 thorpej
104 1.41 thorpej if (nseg > 0)
105 1.41 thorpej lastaddr = segs[nseg-1].ds_addr + segs[nseg-1].ds_len;
106 1.41 thorpej again:
107 1.41 thorpej sgsize = size;
108 1.41 thorpej
109 1.41 thorpej /* Make sure we're in an allowed DMA range. */
110 1.41 thorpej if (t->_ranges != NULL) {
111 1.41 thorpej /* XXX cache last result? */
112 1.41 thorpej const struct arm32_dma_range * const dr =
113 1.41 thorpej _bus_dma_inrange(t->_ranges, t->_nranges, paddr);
114 1.41 thorpej if (dr == NULL)
115 1.41 thorpej return (EINVAL);
116 1.41 thorpej
117 1.41 thorpej /*
118 1.41 thorpej * In a valid DMA range. Translate the physical
119 1.41 thorpej * memory address to an address in the DMA window.
120 1.41 thorpej */
121 1.41 thorpej curaddr = (paddr - dr->dr_sysbase) + dr->dr_busbase;
122 1.41 thorpej } else
123 1.41 thorpej curaddr = paddr;
124 1.41 thorpej
125 1.41 thorpej /*
126 1.41 thorpej * Make sure we don't cross any boundaries.
127 1.41 thorpej */
128 1.41 thorpej if (map->_dm_boundary > 0) {
129 1.41 thorpej bus_addr_t baddr; /* next boundary address */
130 1.41 thorpej
131 1.41 thorpej baddr = (curaddr + map->_dm_boundary) & bmask;
132 1.41 thorpej if (sgsize > (baddr - curaddr))
133 1.41 thorpej sgsize = (baddr - curaddr);
134 1.41 thorpej }
135 1.41 thorpej
136 1.41 thorpej /*
137 1.41 thorpej * Insert chunk into a segment, coalescing with the
138 1.41 thorpej * previous segment if possible.
139 1.41 thorpej */
140 1.41 thorpej if (nseg > 0 && curaddr == lastaddr &&
141 1.43 matt segs[nseg-1].ds_len + sgsize <= map->dm_maxsegsz &&
142 1.41 thorpej (map->_dm_boundary == 0 ||
143 1.41 thorpej (segs[nseg-1].ds_addr & bmask) == (curaddr & bmask))) {
144 1.41 thorpej /* coalesce */
145 1.41 thorpej segs[nseg-1].ds_len += sgsize;
146 1.41 thorpej } else if (nseg >= map->_dm_segcnt) {
147 1.41 thorpej return (EFBIG);
148 1.41 thorpej } else {
149 1.41 thorpej /* new segment */
150 1.41 thorpej segs[nseg].ds_addr = curaddr;
151 1.41 thorpej segs[nseg].ds_len = sgsize;
152 1.41 thorpej nseg++;
153 1.41 thorpej }
154 1.41 thorpej
155 1.41 thorpej lastaddr = curaddr + sgsize;
156 1.41 thorpej
157 1.41 thorpej paddr += sgsize;
158 1.41 thorpej size -= sgsize;
159 1.41 thorpej if (size > 0)
160 1.41 thorpej goto again;
161 1.41 thorpej
162 1.41 thorpej map->dm_nsegs = nseg;
163 1.41 thorpej return (0);
164 1.41 thorpej }
165 1.41 thorpej
166 1.41 thorpej /*
167 1.1 chris * Common function for DMA map creation. May be called by bus-specific
168 1.1 chris * DMA map creation functions.
169 1.1 chris */
170 1.1 chris int
171 1.7 thorpej _bus_dmamap_create(bus_dma_tag_t t, bus_size_t size, int nsegments,
172 1.7 thorpej bus_size_t maxsegsz, bus_size_t boundary, int flags, bus_dmamap_t *dmamp)
173 1.1 chris {
174 1.1 chris struct arm32_bus_dmamap *map;
175 1.1 chris void *mapstore;
176 1.1 chris size_t mapsize;
177 1.1 chris
178 1.1 chris #ifdef DEBUG_DMA
179 1.1 chris printf("dmamap_create: t=%p size=%lx nseg=%x msegsz=%lx boundary=%lx flags=%x\n",
180 1.1 chris t, size, nsegments, maxsegsz, boundary, flags);
181 1.1 chris #endif /* DEBUG_DMA */
182 1.1 chris
183 1.1 chris /*
184 1.1 chris * Allocate and initialize the DMA map. The end of the map
185 1.1 chris * is a variable-sized array of segments, so we allocate enough
186 1.1 chris * room for them in one shot.
187 1.1 chris *
188 1.1 chris * Note we don't preserve the WAITOK or NOWAIT flags. Preservation
189 1.1 chris * of ALLOCNOW notifies others that we've reserved these resources,
190 1.1 chris * and they are not to be freed.
191 1.1 chris *
192 1.1 chris * The bus_dmamap_t includes one bus_dma_segment_t, hence
193 1.1 chris * the (nsegments - 1).
194 1.1 chris */
195 1.1 chris mapsize = sizeof(struct arm32_bus_dmamap) +
196 1.1 chris (sizeof(bus_dma_segment_t) * (nsegments - 1));
197 1.1 chris if ((mapstore = malloc(mapsize, M_DMAMAP,
198 1.1 chris (flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK)) == NULL)
199 1.1 chris return (ENOMEM);
200 1.1 chris
201 1.1 chris memset(mapstore, 0, mapsize);
202 1.1 chris map = (struct arm32_bus_dmamap *)mapstore;
203 1.1 chris map->_dm_size = size;
204 1.1 chris map->_dm_segcnt = nsegments;
205 1.43 matt map->_dm_maxmaxsegsz = maxsegsz;
206 1.1 chris map->_dm_boundary = boundary;
207 1.1 chris map->_dm_flags = flags & ~(BUS_DMA_WAITOK|BUS_DMA_NOWAIT);
208 1.14 thorpej map->_dm_origbuf = NULL;
209 1.14 thorpej map->_dm_buftype = ARM32_BUFTYPE_INVALID;
210 1.8 thorpej map->_dm_proc = NULL;
211 1.43 matt map->dm_maxsegsz = maxsegsz;
212 1.1 chris map->dm_mapsize = 0; /* no valid mappings */
213 1.1 chris map->dm_nsegs = 0;
214 1.1 chris
215 1.1 chris *dmamp = map;
216 1.1 chris #ifdef DEBUG_DMA
217 1.1 chris printf("dmamap_create:map=%p\n", map);
218 1.1 chris #endif /* DEBUG_DMA */
219 1.1 chris return (0);
220 1.1 chris }
221 1.1 chris
222 1.1 chris /*
223 1.1 chris * Common function for DMA map destruction. May be called by bus-specific
224 1.1 chris * DMA map destruction functions.
225 1.1 chris */
226 1.1 chris void
227 1.7 thorpej _bus_dmamap_destroy(bus_dma_tag_t t, bus_dmamap_t map)
228 1.1 chris {
229 1.1 chris
230 1.1 chris #ifdef DEBUG_DMA
231 1.1 chris printf("dmamap_destroy: t=%p map=%p\n", t, map);
232 1.1 chris #endif /* DEBUG_DMA */
233 1.13 briggs
234 1.13 briggs /*
235 1.13 briggs * Explicit unload.
236 1.13 briggs */
237 1.43 matt map->dm_maxsegsz = map->_dm_maxmaxsegsz;
238 1.13 briggs map->dm_mapsize = 0;
239 1.13 briggs map->dm_nsegs = 0;
240 1.14 thorpej map->_dm_origbuf = NULL;
241 1.14 thorpej map->_dm_buftype = ARM32_BUFTYPE_INVALID;
242 1.13 briggs map->_dm_proc = NULL;
243 1.13 briggs
244 1.25 chris free(map, M_DMAMAP);
245 1.1 chris }
246 1.1 chris
247 1.1 chris /*
248 1.1 chris * Common function for loading a DMA map with a linear buffer. May
249 1.1 chris * be called by bus-specific DMA map load functions.
250 1.1 chris */
251 1.1 chris int
252 1.7 thorpej _bus_dmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf,
253 1.7 thorpej bus_size_t buflen, struct proc *p, int flags)
254 1.1 chris {
255 1.41 thorpej int error;
256 1.1 chris
257 1.1 chris #ifdef DEBUG_DMA
258 1.1 chris printf("dmamap_load: t=%p map=%p buf=%p len=%lx p=%p f=%d\n",
259 1.1 chris t, map, buf, buflen, p, flags);
260 1.1 chris #endif /* DEBUG_DMA */
261 1.1 chris
262 1.1 chris /*
263 1.1 chris * Make sure that on error condition we return "no valid mappings".
264 1.1 chris */
265 1.1 chris map->dm_mapsize = 0;
266 1.1 chris map->dm_nsegs = 0;
267 1.43 matt KASSERT(map->dm_maxsegsz <= map->_dm_maxmaxsegsz);
268 1.1 chris
269 1.1 chris if (buflen > map->_dm_size)
270 1.1 chris return (EINVAL);
271 1.1 chris
272 1.17 thorpej /* _bus_dmamap_load_buffer() clears this if we're not... */
273 1.17 thorpej map->_dm_flags |= ARM32_DMAMAP_COHERENT;
274 1.17 thorpej
275 1.41 thorpej error = _bus_dmamap_load_buffer(t, map, buf, buflen, p, flags);
276 1.1 chris if (error == 0) {
277 1.1 chris map->dm_mapsize = buflen;
278 1.14 thorpej map->_dm_origbuf = buf;
279 1.14 thorpej map->_dm_buftype = ARM32_BUFTYPE_LINEAR;
280 1.8 thorpej map->_dm_proc = p;
281 1.1 chris }
282 1.1 chris #ifdef DEBUG_DMA
283 1.1 chris printf("dmamap_load: error=%d\n", error);
284 1.1 chris #endif /* DEBUG_DMA */
285 1.1 chris return (error);
286 1.1 chris }
287 1.1 chris
288 1.1 chris /*
289 1.1 chris * Like _bus_dmamap_load(), but for mbufs.
290 1.1 chris */
291 1.1 chris int
292 1.7 thorpej _bus_dmamap_load_mbuf(bus_dma_tag_t t, bus_dmamap_t map, struct mbuf *m0,
293 1.7 thorpej int flags)
294 1.1 chris {
295 1.41 thorpej int error;
296 1.1 chris struct mbuf *m;
297 1.1 chris
298 1.1 chris #ifdef DEBUG_DMA
299 1.1 chris printf("dmamap_load_mbuf: t=%p map=%p m0=%p f=%d\n",
300 1.1 chris t, map, m0, flags);
301 1.1 chris #endif /* DEBUG_DMA */
302 1.1 chris
303 1.1 chris /*
304 1.1 chris * Make sure that on error condition we return "no valid mappings."
305 1.1 chris */
306 1.1 chris map->dm_mapsize = 0;
307 1.1 chris map->dm_nsegs = 0;
308 1.43 matt KASSERT(map->dm_maxsegsz <= map->_dm_maxmaxsegsz);
309 1.1 chris
310 1.1 chris #ifdef DIAGNOSTIC
311 1.1 chris if ((m0->m_flags & M_PKTHDR) == 0)
312 1.1 chris panic("_bus_dmamap_load_mbuf: no packet header");
313 1.1 chris #endif /* DIAGNOSTIC */
314 1.1 chris
315 1.1 chris if (m0->m_pkthdr.len > map->_dm_size)
316 1.1 chris return (EINVAL);
317 1.1 chris
318 1.28 thorpej /*
319 1.28 thorpej * Mbuf chains should almost never have coherent (i.e.
320 1.28 thorpej * un-cached) mappings, so clear that flag now.
321 1.28 thorpej */
322 1.28 thorpej map->_dm_flags &= ~ARM32_DMAMAP_COHERENT;
323 1.17 thorpej
324 1.1 chris error = 0;
325 1.1 chris for (m = m0; m != NULL && error == 0; m = m->m_next) {
326 1.41 thorpej int offset;
327 1.41 thorpej int remainbytes;
328 1.41 thorpej const struct vm_page * const *pgs;
329 1.41 thorpej paddr_t paddr;
330 1.41 thorpej int size;
331 1.41 thorpej
332 1.28 thorpej if (m->m_len == 0)
333 1.28 thorpej continue;
334 1.41 thorpej switch (m->m_flags & (M_EXT|M_CLUSTER|M_EXT_PAGES)) {
335 1.28 thorpej case M_EXT|M_CLUSTER:
336 1.28 thorpej /* XXX KDASSERT */
337 1.28 thorpej KASSERT(m->m_ext.ext_paddr != M_PADDR_INVALID);
338 1.41 thorpej paddr = m->m_ext.ext_paddr +
339 1.28 thorpej (m->m_data - m->m_ext.ext_buf);
340 1.41 thorpej size = m->m_len;
341 1.41 thorpej error = _bus_dmamap_load_paddr(t, map, paddr, size);
342 1.41 thorpej break;
343 1.41 thorpej
344 1.41 thorpej case M_EXT|M_EXT_PAGES:
345 1.41 thorpej KASSERT(m->m_ext.ext_buf <= m->m_data);
346 1.41 thorpej KASSERT(m->m_data <=
347 1.41 thorpej m->m_ext.ext_buf + m->m_ext.ext_size);
348 1.41 thorpej
349 1.41 thorpej offset = (vaddr_t)m->m_data -
350 1.41 thorpej trunc_page((vaddr_t)m->m_ext.ext_buf);
351 1.41 thorpej remainbytes = m->m_len;
352 1.41 thorpej
353 1.41 thorpej /* skip uninteresting pages */
354 1.41 thorpej pgs = (const struct vm_page * const *)
355 1.41 thorpej m->m_ext.ext_pgs + (offset >> PAGE_SHIFT);
356 1.41 thorpej
357 1.41 thorpej offset &= PAGE_MASK; /* offset in the first page */
358 1.41 thorpej
359 1.41 thorpej /* load each page */
360 1.41 thorpej while (remainbytes > 0) {
361 1.41 thorpej const struct vm_page *pg;
362 1.41 thorpej
363 1.41 thorpej size = MIN(remainbytes, PAGE_SIZE - offset);
364 1.41 thorpej
365 1.41 thorpej pg = *pgs++;
366 1.41 thorpej KASSERT(pg);
367 1.41 thorpej paddr = VM_PAGE_TO_PHYS(pg) + offset;
368 1.41 thorpej
369 1.41 thorpej error = _bus_dmamap_load_paddr(t, map,
370 1.41 thorpej paddr, size);
371 1.41 thorpej if (error)
372 1.28 thorpej break;
373 1.41 thorpej offset = 0;
374 1.41 thorpej remainbytes -= size;
375 1.28 thorpej }
376 1.28 thorpej break;
377 1.28 thorpej
378 1.28 thorpej case 0:
379 1.41 thorpej paddr = m->m_paddr + M_BUFOFFSET(m) +
380 1.28 thorpej (m->m_data - M_BUFADDR(m));
381 1.41 thorpej size = m->m_len;
382 1.41 thorpej error = _bus_dmamap_load_paddr(t, map, paddr, size);
383 1.41 thorpej break;
384 1.28 thorpej
385 1.28 thorpej default:
386 1.28 thorpej error = _bus_dmamap_load_buffer(t, map, m->m_data,
387 1.41 thorpej m->m_len, NULL, flags);
388 1.28 thorpej }
389 1.1 chris }
390 1.1 chris if (error == 0) {
391 1.1 chris map->dm_mapsize = m0->m_pkthdr.len;
392 1.14 thorpej map->_dm_origbuf = m0;
393 1.14 thorpej map->_dm_buftype = ARM32_BUFTYPE_MBUF;
394 1.8 thorpej map->_dm_proc = NULL; /* always kernel */
395 1.1 chris }
396 1.1 chris #ifdef DEBUG_DMA
397 1.1 chris printf("dmamap_load_mbuf: error=%d\n", error);
398 1.1 chris #endif /* DEBUG_DMA */
399 1.1 chris return (error);
400 1.1 chris }
401 1.1 chris
402 1.1 chris /*
403 1.1 chris * Like _bus_dmamap_load(), but for uios.
404 1.1 chris */
405 1.1 chris int
406 1.7 thorpej _bus_dmamap_load_uio(bus_dma_tag_t t, bus_dmamap_t map, struct uio *uio,
407 1.7 thorpej int flags)
408 1.1 chris {
409 1.41 thorpej int i, error;
410 1.1 chris bus_size_t minlen, resid;
411 1.1 chris struct proc *p = NULL;
412 1.1 chris struct iovec *iov;
413 1.1 chris caddr_t addr;
414 1.1 chris
415 1.1 chris /*
416 1.1 chris * Make sure that on error condition we return "no valid mappings."
417 1.1 chris */
418 1.1 chris map->dm_mapsize = 0;
419 1.1 chris map->dm_nsegs = 0;
420 1.43 matt KASSERT(map->dm_maxsegsz <= map->_dm_maxmaxsegsz);
421 1.1 chris
422 1.1 chris resid = uio->uio_resid;
423 1.1 chris iov = uio->uio_iov;
424 1.1 chris
425 1.1 chris if (uio->uio_segflg == UIO_USERSPACE) {
426 1.32 fvdl p = uio->uio_procp;
427 1.1 chris #ifdef DIAGNOSTIC
428 1.1 chris if (p == NULL)
429 1.1 chris panic("_bus_dmamap_load_uio: USERSPACE but no proc");
430 1.1 chris #endif
431 1.1 chris }
432 1.1 chris
433 1.17 thorpej /* _bus_dmamap_load_buffer() clears this if we're not... */
434 1.17 thorpej map->_dm_flags |= ARM32_DMAMAP_COHERENT;
435 1.17 thorpej
436 1.1 chris error = 0;
437 1.1 chris for (i = 0; i < uio->uio_iovcnt && resid != 0 && error == 0; i++) {
438 1.1 chris /*
439 1.1 chris * Now at the first iovec to load. Load each iovec
440 1.1 chris * until we have exhausted the residual count.
441 1.1 chris */
442 1.1 chris minlen = resid < iov[i].iov_len ? resid : iov[i].iov_len;
443 1.1 chris addr = (caddr_t)iov[i].iov_base;
444 1.1 chris
445 1.1 chris error = _bus_dmamap_load_buffer(t, map, addr, minlen,
446 1.41 thorpej p, flags);
447 1.1 chris
448 1.1 chris resid -= minlen;
449 1.1 chris }
450 1.1 chris if (error == 0) {
451 1.1 chris map->dm_mapsize = uio->uio_resid;
452 1.14 thorpej map->_dm_origbuf = uio;
453 1.14 thorpej map->_dm_buftype = ARM32_BUFTYPE_UIO;
454 1.8 thorpej map->_dm_proc = p;
455 1.1 chris }
456 1.1 chris return (error);
457 1.1 chris }
458 1.1 chris
459 1.1 chris /*
460 1.1 chris * Like _bus_dmamap_load(), but for raw memory allocated with
461 1.1 chris * bus_dmamem_alloc().
462 1.1 chris */
463 1.1 chris int
464 1.7 thorpej _bus_dmamap_load_raw(bus_dma_tag_t t, bus_dmamap_t map,
465 1.7 thorpej bus_dma_segment_t *segs, int nsegs, bus_size_t size, int flags)
466 1.1 chris {
467 1.1 chris
468 1.1 chris panic("_bus_dmamap_load_raw: not implemented");
469 1.1 chris }
470 1.1 chris
471 1.1 chris /*
472 1.1 chris * Common function for unloading a DMA map. May be called by
473 1.1 chris * bus-specific DMA map unload functions.
474 1.1 chris */
475 1.1 chris void
476 1.7 thorpej _bus_dmamap_unload(bus_dma_tag_t t, bus_dmamap_t map)
477 1.1 chris {
478 1.1 chris
479 1.1 chris #ifdef DEBUG_DMA
480 1.1 chris printf("dmamap_unload: t=%p map=%p\n", t, map);
481 1.1 chris #endif /* DEBUG_DMA */
482 1.1 chris
483 1.1 chris /*
484 1.1 chris * No resources to free; just mark the mappings as
485 1.1 chris * invalid.
486 1.1 chris */
487 1.1 chris map->dm_mapsize = 0;
488 1.1 chris map->dm_nsegs = 0;
489 1.14 thorpej map->_dm_origbuf = NULL;
490 1.14 thorpej map->_dm_buftype = ARM32_BUFTYPE_INVALID;
491 1.8 thorpej map->_dm_proc = NULL;
492 1.1 chris }
493 1.1 chris
494 1.19 briggs static __inline void
495 1.14 thorpej _bus_dmamap_sync_linear(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
496 1.14 thorpej bus_size_t len, int ops)
497 1.14 thorpej {
498 1.14 thorpej vaddr_t addr = (vaddr_t) map->_dm_origbuf;
499 1.14 thorpej
500 1.14 thorpej addr += offset;
501 1.14 thorpej
502 1.14 thorpej switch (ops) {
503 1.14 thorpej case BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE:
504 1.14 thorpej cpu_dcache_wbinv_range(addr, len);
505 1.14 thorpej break;
506 1.14 thorpej
507 1.14 thorpej case BUS_DMASYNC_PREREAD:
508 1.18 thorpej if (((addr | len) & arm_dcache_align_mask) == 0)
509 1.18 thorpej cpu_dcache_inv_range(addr, len);
510 1.18 thorpej else
511 1.18 thorpej cpu_dcache_wbinv_range(addr, len);
512 1.14 thorpej break;
513 1.14 thorpej
514 1.14 thorpej case BUS_DMASYNC_PREWRITE:
515 1.14 thorpej cpu_dcache_wb_range(addr, len);
516 1.14 thorpej break;
517 1.14 thorpej }
518 1.14 thorpej }
519 1.14 thorpej
520 1.19 briggs static __inline void
521 1.14 thorpej _bus_dmamap_sync_mbuf(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
522 1.14 thorpej bus_size_t len, int ops)
523 1.14 thorpej {
524 1.14 thorpej struct mbuf *m, *m0 = map->_dm_origbuf;
525 1.14 thorpej bus_size_t minlen, moff;
526 1.14 thorpej vaddr_t maddr;
527 1.14 thorpej
528 1.14 thorpej for (moff = offset, m = m0; m != NULL && len != 0;
529 1.14 thorpej m = m->m_next) {
530 1.14 thorpej /* Find the beginning mbuf. */
531 1.14 thorpej if (moff >= m->m_len) {
532 1.14 thorpej moff -= m->m_len;
533 1.14 thorpej continue;
534 1.14 thorpej }
535 1.14 thorpej
536 1.14 thorpej /*
537 1.14 thorpej * Now at the first mbuf to sync; nail each one until
538 1.14 thorpej * we have exhausted the length.
539 1.14 thorpej */
540 1.14 thorpej minlen = m->m_len - moff;
541 1.14 thorpej if (len < minlen)
542 1.14 thorpej minlen = len;
543 1.14 thorpej
544 1.14 thorpej maddr = mtod(m, vaddr_t);
545 1.14 thorpej maddr += moff;
546 1.14 thorpej
547 1.28 thorpej /*
548 1.28 thorpej * We can save a lot of work here if we know the mapping
549 1.28 thorpej * is read-only at the MMU:
550 1.28 thorpej *
551 1.28 thorpej * If a mapping is read-only, no dirty cache blocks will
552 1.28 thorpej * exist for it. If a writable mapping was made read-only,
553 1.28 thorpej * we know any dirty cache lines for the range will have
554 1.28 thorpej * been cleaned for us already. Therefore, if the upper
555 1.28 thorpej * layer can tell us we have a read-only mapping, we can
556 1.28 thorpej * skip all cache cleaning.
557 1.28 thorpej *
558 1.28 thorpej * NOTE: This only works if we know the pmap cleans pages
559 1.28 thorpej * before making a read-write -> read-only transition. If
560 1.28 thorpej * this ever becomes non-true (e.g. Physically Indexed
561 1.28 thorpej * cache), this will have to be revisited.
562 1.28 thorpej */
563 1.14 thorpej switch (ops) {
564 1.14 thorpej case BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE:
565 1.28 thorpej if (! M_ROMAP(m)) {
566 1.28 thorpej cpu_dcache_wbinv_range(maddr, minlen);
567 1.28 thorpej break;
568 1.28 thorpej }
569 1.28 thorpej /* else FALLTHROUGH */
570 1.14 thorpej
571 1.14 thorpej case BUS_DMASYNC_PREREAD:
572 1.18 thorpej if (((maddr | minlen) & arm_dcache_align_mask) == 0)
573 1.18 thorpej cpu_dcache_inv_range(maddr, minlen);
574 1.18 thorpej else
575 1.18 thorpej cpu_dcache_wbinv_range(maddr, minlen);
576 1.14 thorpej break;
577 1.14 thorpej
578 1.14 thorpej case BUS_DMASYNC_PREWRITE:
579 1.28 thorpej if (! M_ROMAP(m))
580 1.28 thorpej cpu_dcache_wb_range(maddr, minlen);
581 1.14 thorpej break;
582 1.14 thorpej }
583 1.14 thorpej moff = 0;
584 1.14 thorpej len -= minlen;
585 1.14 thorpej }
586 1.14 thorpej }
587 1.14 thorpej
588 1.19 briggs static __inline void
589 1.14 thorpej _bus_dmamap_sync_uio(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
590 1.14 thorpej bus_size_t len, int ops)
591 1.14 thorpej {
592 1.14 thorpej struct uio *uio = map->_dm_origbuf;
593 1.14 thorpej struct iovec *iov;
594 1.14 thorpej bus_size_t minlen, ioff;
595 1.14 thorpej vaddr_t addr;
596 1.14 thorpej
597 1.14 thorpej for (iov = uio->uio_iov, ioff = offset; len != 0; iov++) {
598 1.14 thorpej /* Find the beginning iovec. */
599 1.14 thorpej if (ioff >= iov->iov_len) {
600 1.14 thorpej ioff -= iov->iov_len;
601 1.14 thorpej continue;
602 1.14 thorpej }
603 1.14 thorpej
604 1.14 thorpej /*
605 1.14 thorpej * Now at the first iovec to sync; nail each one until
606 1.14 thorpej * we have exhausted the length.
607 1.14 thorpej */
608 1.14 thorpej minlen = iov->iov_len - ioff;
609 1.14 thorpej if (len < minlen)
610 1.14 thorpej minlen = len;
611 1.14 thorpej
612 1.14 thorpej addr = (vaddr_t) iov->iov_base;
613 1.14 thorpej addr += ioff;
614 1.14 thorpej
615 1.14 thorpej switch (ops) {
616 1.14 thorpej case BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE:
617 1.14 thorpej cpu_dcache_wbinv_range(addr, minlen);
618 1.14 thorpej break;
619 1.14 thorpej
620 1.14 thorpej case BUS_DMASYNC_PREREAD:
621 1.18 thorpej if (((addr | minlen) & arm_dcache_align_mask) == 0)
622 1.18 thorpej cpu_dcache_inv_range(addr, minlen);
623 1.18 thorpej else
624 1.18 thorpej cpu_dcache_wbinv_range(addr, minlen);
625 1.14 thorpej break;
626 1.14 thorpej
627 1.14 thorpej case BUS_DMASYNC_PREWRITE:
628 1.14 thorpej cpu_dcache_wb_range(addr, minlen);
629 1.14 thorpej break;
630 1.14 thorpej }
631 1.14 thorpej ioff = 0;
632 1.14 thorpej len -= minlen;
633 1.14 thorpej }
634 1.14 thorpej }
635 1.14 thorpej
636 1.1 chris /*
637 1.1 chris * Common function for DMA map synchronization. May be called
638 1.1 chris * by bus-specific DMA map synchronization functions.
639 1.8 thorpej *
640 1.8 thorpej * This version works for the Virtually Indexed Virtually Tagged
641 1.8 thorpej * cache found on 32-bit ARM processors.
642 1.8 thorpej *
643 1.8 thorpej * XXX Should have separate versions for write-through vs.
644 1.8 thorpej * XXX write-back caches. We currently assume write-back
645 1.8 thorpej * XXX here, which is not as efficient as it could be for
646 1.8 thorpej * XXX the write-through case.
647 1.1 chris */
648 1.1 chris void
649 1.7 thorpej _bus_dmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
650 1.7 thorpej bus_size_t len, int ops)
651 1.1 chris {
652 1.1 chris
653 1.1 chris #ifdef DEBUG_DMA
654 1.1 chris printf("dmamap_sync: t=%p map=%p offset=%lx len=%lx ops=%x\n",
655 1.1 chris t, map, offset, len, ops);
656 1.1 chris #endif /* DEBUG_DMA */
657 1.1 chris
658 1.8 thorpej /*
659 1.8 thorpej * Mixing of PRE and POST operations is not allowed.
660 1.8 thorpej */
661 1.8 thorpej if ((ops & (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE)) != 0 &&
662 1.8 thorpej (ops & (BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE)) != 0)
663 1.8 thorpej panic("_bus_dmamap_sync: mix PRE and POST");
664 1.8 thorpej
665 1.8 thorpej #ifdef DIAGNOSTIC
666 1.8 thorpej if (offset >= map->dm_mapsize)
667 1.8 thorpej panic("_bus_dmamap_sync: bad offset %lu (map size is %lu)",
668 1.8 thorpej offset, map->dm_mapsize);
669 1.8 thorpej if (len == 0 || (offset + len) > map->dm_mapsize)
670 1.8 thorpej panic("_bus_dmamap_sync: bad length");
671 1.8 thorpej #endif
672 1.8 thorpej
673 1.8 thorpej /*
674 1.8 thorpej * For a virtually-indexed write-back cache, we need
675 1.8 thorpej * to do the following things:
676 1.8 thorpej *
677 1.8 thorpej * PREREAD -- Invalidate the D-cache. We do this
678 1.8 thorpej * here in case a write-back is required by the back-end.
679 1.8 thorpej *
680 1.8 thorpej * PREWRITE -- Write-back the D-cache. Note that if
681 1.8 thorpej * we are doing a PREREAD|PREWRITE, we can collapse
682 1.8 thorpej * the whole thing into a single Wb-Inv.
683 1.8 thorpej *
684 1.8 thorpej * POSTREAD -- Nothing.
685 1.8 thorpej *
686 1.8 thorpej * POSTWRITE -- Nothing.
687 1.8 thorpej */
688 1.8 thorpej
689 1.8 thorpej ops &= (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
690 1.8 thorpej if (ops == 0)
691 1.8 thorpej return;
692 1.8 thorpej
693 1.17 thorpej /* Skip cache frobbing if mapping was COHERENT. */
694 1.17 thorpej if (map->_dm_flags & ARM32_DMAMAP_COHERENT) {
695 1.17 thorpej /* Drain the write buffer. */
696 1.17 thorpej cpu_drain_writebuf();
697 1.17 thorpej return;
698 1.17 thorpej }
699 1.8 thorpej
700 1.8 thorpej /*
701 1.38 scw * If the mapping belongs to a non-kernel vmspace, and the
702 1.38 scw * vmspace has not been active since the last time a full
703 1.38 scw * cache flush was performed, we don't need to do anything.
704 1.8 thorpej */
705 1.23 thorpej if (__predict_false(map->_dm_proc != NULL &&
706 1.38 scw map->_dm_proc->p_vmspace->vm_map.pmap->pm_cstate.cs_cache_d == 0))
707 1.8 thorpej return;
708 1.8 thorpej
709 1.14 thorpej switch (map->_dm_buftype) {
710 1.14 thorpej case ARM32_BUFTYPE_LINEAR:
711 1.14 thorpej _bus_dmamap_sync_linear(t, map, offset, len, ops);
712 1.14 thorpej break;
713 1.14 thorpej
714 1.14 thorpej case ARM32_BUFTYPE_MBUF:
715 1.14 thorpej _bus_dmamap_sync_mbuf(t, map, offset, len, ops);
716 1.14 thorpej break;
717 1.14 thorpej
718 1.14 thorpej case ARM32_BUFTYPE_UIO:
719 1.14 thorpej _bus_dmamap_sync_uio(t, map, offset, len, ops);
720 1.14 thorpej break;
721 1.14 thorpej
722 1.14 thorpej case ARM32_BUFTYPE_RAW:
723 1.14 thorpej panic("_bus_dmamap_sync: ARM32_BUFTYPE_RAW");
724 1.14 thorpej break;
725 1.14 thorpej
726 1.14 thorpej case ARM32_BUFTYPE_INVALID:
727 1.14 thorpej panic("_bus_dmamap_sync: ARM32_BUFTYPE_INVALID");
728 1.14 thorpej break;
729 1.14 thorpej
730 1.14 thorpej default:
731 1.14 thorpej printf("unknown buffer type %d\n", map->_dm_buftype);
732 1.14 thorpej panic("_bus_dmamap_sync");
733 1.8 thorpej }
734 1.1 chris
735 1.8 thorpej /* Drain the write buffer. */
736 1.8 thorpej cpu_drain_writebuf();
737 1.1 chris }
738 1.1 chris
739 1.1 chris /*
740 1.1 chris * Common function for DMA-safe memory allocation. May be called
741 1.1 chris * by bus-specific DMA memory allocation functions.
742 1.1 chris */
743 1.1 chris
744 1.11 thorpej extern paddr_t physical_start;
745 1.11 thorpej extern paddr_t physical_end;
746 1.1 chris
747 1.1 chris int
748 1.7 thorpej _bus_dmamem_alloc(bus_dma_tag_t t, bus_size_t size, bus_size_t alignment,
749 1.7 thorpej bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs,
750 1.7 thorpej int flags)
751 1.1 chris {
752 1.15 thorpej struct arm32_dma_range *dr;
753 1.37 mycroft int error, i;
754 1.15 thorpej
755 1.1 chris #ifdef DEBUG_DMA
756 1.15 thorpej printf("dmamem_alloc t=%p size=%lx align=%lx boundary=%lx "
757 1.15 thorpej "segs=%p nsegs=%x rsegs=%p flags=%x\n", t, size, alignment,
758 1.15 thorpej boundary, segs, nsegs, rsegs, flags);
759 1.15 thorpej #endif
760 1.15 thorpej
761 1.15 thorpej if ((dr = t->_ranges) != NULL) {
762 1.37 mycroft error = ENOMEM;
763 1.15 thorpej for (i = 0; i < t->_nranges; i++, dr++) {
764 1.37 mycroft if (dr->dr_len == 0)
765 1.15 thorpej continue;
766 1.15 thorpej error = _bus_dmamem_alloc_range(t, size, alignment,
767 1.15 thorpej boundary, segs, nsegs, rsegs, flags,
768 1.15 thorpej trunc_page(dr->dr_sysbase),
769 1.15 thorpej trunc_page(dr->dr_sysbase + dr->dr_len));
770 1.15 thorpej if (error == 0)
771 1.15 thorpej break;
772 1.15 thorpej }
773 1.15 thorpej } else {
774 1.15 thorpej error = _bus_dmamem_alloc_range(t, size, alignment, boundary,
775 1.15 thorpej segs, nsegs, rsegs, flags, trunc_page(physical_start),
776 1.15 thorpej trunc_page(physical_end));
777 1.15 thorpej }
778 1.15 thorpej
779 1.1 chris #ifdef DEBUG_DMA
780 1.1 chris printf("dmamem_alloc: =%d\n", error);
781 1.15 thorpej #endif
782 1.15 thorpej
783 1.1 chris return(error);
784 1.1 chris }
785 1.1 chris
786 1.1 chris /*
787 1.1 chris * Common function for freeing DMA-safe memory. May be called by
788 1.1 chris * bus-specific DMA memory free functions.
789 1.1 chris */
790 1.1 chris void
791 1.7 thorpej _bus_dmamem_free(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs)
792 1.1 chris {
793 1.1 chris struct vm_page *m;
794 1.1 chris bus_addr_t addr;
795 1.1 chris struct pglist mlist;
796 1.1 chris int curseg;
797 1.1 chris
798 1.1 chris #ifdef DEBUG_DMA
799 1.1 chris printf("dmamem_free: t=%p segs=%p nsegs=%x\n", t, segs, nsegs);
800 1.1 chris #endif /* DEBUG_DMA */
801 1.1 chris
802 1.1 chris /*
803 1.1 chris * Build a list of pages to free back to the VM system.
804 1.1 chris */
805 1.1 chris TAILQ_INIT(&mlist);
806 1.1 chris for (curseg = 0; curseg < nsegs; curseg++) {
807 1.1 chris for (addr = segs[curseg].ds_addr;
808 1.1 chris addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
809 1.1 chris addr += PAGE_SIZE) {
810 1.1 chris m = PHYS_TO_VM_PAGE(addr);
811 1.1 chris TAILQ_INSERT_TAIL(&mlist, m, pageq);
812 1.1 chris }
813 1.1 chris }
814 1.1 chris uvm_pglistfree(&mlist);
815 1.1 chris }
816 1.1 chris
817 1.1 chris /*
818 1.1 chris * Common function for mapping DMA-safe memory. May be called by
819 1.1 chris * bus-specific DMA memory map functions.
820 1.1 chris */
821 1.1 chris int
822 1.7 thorpej _bus_dmamem_map(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs,
823 1.7 thorpej size_t size, caddr_t *kvap, int flags)
824 1.1 chris {
825 1.11 thorpej vaddr_t va;
826 1.1 chris bus_addr_t addr;
827 1.1 chris int curseg;
828 1.1 chris pt_entry_t *ptep/*, pte*/;
829 1.1 chris
830 1.1 chris #ifdef DEBUG_DMA
831 1.3 rearnsha printf("dmamem_map: t=%p segs=%p nsegs=%x size=%lx flags=%x\n", t,
832 1.3 rearnsha segs, nsegs, (unsigned long)size, flags);
833 1.1 chris #endif /* DEBUG_DMA */
834 1.1 chris
835 1.1 chris size = round_page(size);
836 1.1 chris va = uvm_km_valloc(kernel_map, size);
837 1.1 chris
838 1.1 chris if (va == 0)
839 1.1 chris return (ENOMEM);
840 1.1 chris
841 1.1 chris *kvap = (caddr_t)va;
842 1.1 chris
843 1.1 chris for (curseg = 0; curseg < nsegs; curseg++) {
844 1.1 chris for (addr = segs[curseg].ds_addr;
845 1.1 chris addr < (segs[curseg].ds_addr + segs[curseg].ds_len);
846 1.27 thorpej addr += PAGE_SIZE, va += PAGE_SIZE, size -= PAGE_SIZE) {
847 1.1 chris #ifdef DEBUG_DMA
848 1.1 chris printf("wiring p%lx to v%lx", addr, va);
849 1.1 chris #endif /* DEBUG_DMA */
850 1.1 chris if (size == 0)
851 1.1 chris panic("_bus_dmamem_map: size botch");
852 1.1 chris pmap_enter(pmap_kernel(), va, addr,
853 1.1 chris VM_PROT_READ | VM_PROT_WRITE,
854 1.1 chris VM_PROT_READ | VM_PROT_WRITE | PMAP_WIRED);
855 1.1 chris /*
856 1.1 chris * If the memory must remain coherent with the
857 1.1 chris * cache then we must make the memory uncacheable
858 1.1 chris * in order to maintain virtual cache coherency.
859 1.24 wiz * We must also guarantee the cache does not already
860 1.1 chris * contain the virtal addresses we are making
861 1.1 chris * uncacheable.
862 1.1 chris */
863 1.1 chris if (flags & BUS_DMA_COHERENT) {
864 1.27 thorpej cpu_dcache_wbinv_range(va, PAGE_SIZE);
865 1.1 chris cpu_drain_writebuf();
866 1.1 chris ptep = vtopte(va);
867 1.17 thorpej *ptep &= ~L2_S_CACHE_MASK;
868 1.21 thorpej PTE_SYNC(ptep);
869 1.1 chris tlb_flush();
870 1.1 chris }
871 1.1 chris #ifdef DEBUG_DMA
872 1.1 chris ptep = vtopte(va);
873 1.1 chris printf(" pte=v%p *pte=%x\n", ptep, *ptep);
874 1.1 chris #endif /* DEBUG_DMA */
875 1.1 chris }
876 1.1 chris }
877 1.2 chris pmap_update(pmap_kernel());
878 1.1 chris #ifdef DEBUG_DMA
879 1.1 chris printf("dmamem_map: =%p\n", *kvap);
880 1.1 chris #endif /* DEBUG_DMA */
881 1.1 chris return (0);
882 1.1 chris }
883 1.1 chris
884 1.1 chris /*
885 1.1 chris * Common function for unmapping DMA-safe memory. May be called by
886 1.1 chris * bus-specific DMA memory unmapping functions.
887 1.1 chris */
888 1.1 chris void
889 1.7 thorpej _bus_dmamem_unmap(bus_dma_tag_t t, caddr_t kva, size_t size)
890 1.1 chris {
891 1.1 chris
892 1.1 chris #ifdef DEBUG_DMA
893 1.3 rearnsha printf("dmamem_unmap: t=%p kva=%p size=%lx\n", t, kva,
894 1.3 rearnsha (unsigned long)size);
895 1.1 chris #endif /* DEBUG_DMA */
896 1.1 chris #ifdef DIAGNOSTIC
897 1.1 chris if ((u_long)kva & PGOFSET)
898 1.1 chris panic("_bus_dmamem_unmap");
899 1.1 chris #endif /* DIAGNOSTIC */
900 1.1 chris
901 1.1 chris size = round_page(size);
902 1.11 thorpej uvm_km_free(kernel_map, (vaddr_t)kva, size);
903 1.1 chris }
904 1.1 chris
905 1.1 chris /*
906 1.1 chris * Common functin for mmap(2)'ing DMA-safe memory. May be called by
907 1.1 chris * bus-specific DMA mmap(2)'ing functions.
908 1.1 chris */
909 1.1 chris paddr_t
910 1.7 thorpej _bus_dmamem_mmap(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs,
911 1.7 thorpej off_t off, int prot, int flags)
912 1.1 chris {
913 1.1 chris int i;
914 1.1 chris
915 1.1 chris for (i = 0; i < nsegs; i++) {
916 1.1 chris #ifdef DIAGNOSTIC
917 1.1 chris if (off & PGOFSET)
918 1.1 chris panic("_bus_dmamem_mmap: offset unaligned");
919 1.1 chris if (segs[i].ds_addr & PGOFSET)
920 1.1 chris panic("_bus_dmamem_mmap: segment unaligned");
921 1.1 chris if (segs[i].ds_len & PGOFSET)
922 1.1 chris panic("_bus_dmamem_mmap: segment size not multiple"
923 1.1 chris " of page size");
924 1.1 chris #endif /* DIAGNOSTIC */
925 1.1 chris if (off >= segs[i].ds_len) {
926 1.1 chris off -= segs[i].ds_len;
927 1.1 chris continue;
928 1.1 chris }
929 1.1 chris
930 1.9 thorpej return (arm_btop((u_long)segs[i].ds_addr + off));
931 1.1 chris }
932 1.1 chris
933 1.1 chris /* Page not found. */
934 1.1 chris return (-1);
935 1.1 chris }
936 1.1 chris
937 1.1 chris /**********************************************************************
938 1.1 chris * DMA utility functions
939 1.1 chris **********************************************************************/
940 1.1 chris
941 1.1 chris /*
942 1.1 chris * Utility function to load a linear buffer. lastaddrp holds state
943 1.1 chris * between invocations (for multiple-buffer loads). segp contains
944 1.1 chris * the starting segment on entrace, and the ending segment on exit.
945 1.1 chris * first indicates if this is the first invocation of this function.
946 1.1 chris */
947 1.1 chris int
948 1.7 thorpej _bus_dmamap_load_buffer(bus_dma_tag_t t, bus_dmamap_t map, void *buf,
949 1.41 thorpej bus_size_t buflen, struct proc *p, int flags)
950 1.1 chris {
951 1.1 chris bus_size_t sgsize;
952 1.41 thorpej bus_addr_t curaddr;
953 1.11 thorpej vaddr_t vaddr = (vaddr_t)buf;
954 1.17 thorpej pd_entry_t *pde;
955 1.17 thorpej pt_entry_t pte;
956 1.41 thorpej int error;
957 1.1 chris pmap_t pmap;
958 1.29 scw pt_entry_t *ptep;
959 1.1 chris
960 1.1 chris #ifdef DEBUG_DMA
961 1.40 scw printf("_bus_dmamem_load_buffer(buf=%p, len=%lx, flags=%d)\n",
962 1.40 scw buf, buflen, flags);
963 1.1 chris #endif /* DEBUG_DMA */
964 1.1 chris
965 1.1 chris if (p != NULL)
966 1.1 chris pmap = p->p_vmspace->vm_map.pmap;
967 1.1 chris else
968 1.1 chris pmap = pmap_kernel();
969 1.1 chris
970 1.41 thorpej while (buflen > 0) {
971 1.1 chris /*
972 1.1 chris * Get the physical address for this segment.
973 1.17 thorpej *
974 1.17 thorpej * XXX Don't support checking for coherent mappings
975 1.17 thorpej * XXX in user address space.
976 1.1 chris */
977 1.17 thorpej if (__predict_true(pmap == pmap_kernel())) {
978 1.29 scw (void) pmap_get_pde_pte(pmap, vaddr, &pde, &ptep);
979 1.17 thorpej if (__predict_false(pmap_pde_section(pde))) {
980 1.17 thorpej curaddr = (*pde & L1_S_FRAME) |
981 1.17 thorpej (vaddr & L1_S_OFFSET);
982 1.17 thorpej if (*pde & L1_S_CACHE_MASK) {
983 1.17 thorpej map->_dm_flags &=
984 1.17 thorpej ~ARM32_DMAMAP_COHERENT;
985 1.17 thorpej }
986 1.17 thorpej } else {
987 1.29 scw pte = *ptep;
988 1.17 thorpej KDASSERT((pte & L2_TYPE_MASK) != L2_TYPE_INV);
989 1.17 thorpej if (__predict_false((pte & L2_TYPE_MASK)
990 1.17 thorpej == L2_TYPE_L)) {
991 1.17 thorpej curaddr = (pte & L2_L_FRAME) |
992 1.17 thorpej (vaddr & L2_L_OFFSET);
993 1.17 thorpej if (pte & L2_L_CACHE_MASK) {
994 1.17 thorpej map->_dm_flags &=
995 1.17 thorpej ~ARM32_DMAMAP_COHERENT;
996 1.17 thorpej }
997 1.17 thorpej } else {
998 1.17 thorpej curaddr = (pte & L2_S_FRAME) |
999 1.17 thorpej (vaddr & L2_S_OFFSET);
1000 1.17 thorpej if (pte & L2_S_CACHE_MASK) {
1001 1.17 thorpej map->_dm_flags &=
1002 1.17 thorpej ~ARM32_DMAMAP_COHERENT;
1003 1.17 thorpej }
1004 1.17 thorpej }
1005 1.17 thorpej }
1006 1.34 briggs } else {
1007 1.17 thorpej (void) pmap_extract(pmap, vaddr, &curaddr);
1008 1.34 briggs map->_dm_flags &= ~ARM32_DMAMAP_COHERENT;
1009 1.34 briggs }
1010 1.1 chris
1011 1.1 chris /*
1012 1.1 chris * Compute the segment size, and adjust counts.
1013 1.1 chris */
1014 1.27 thorpej sgsize = PAGE_SIZE - ((u_long)vaddr & PGOFSET);
1015 1.1 chris if (buflen < sgsize)
1016 1.1 chris sgsize = buflen;
1017 1.1 chris
1018 1.41 thorpej error = _bus_dmamap_load_paddr(t, map, curaddr, sgsize);
1019 1.41 thorpej if (error)
1020 1.41 thorpej return (error);
1021 1.1 chris
1022 1.1 chris vaddr += sgsize;
1023 1.1 chris buflen -= sgsize;
1024 1.1 chris }
1025 1.1 chris
1026 1.1 chris return (0);
1027 1.1 chris }
1028 1.1 chris
1029 1.1 chris /*
1030 1.1 chris * Allocate physical memory from the given physical address range.
1031 1.1 chris * Called by DMA-safe memory allocation methods.
1032 1.1 chris */
1033 1.1 chris int
1034 1.7 thorpej _bus_dmamem_alloc_range(bus_dma_tag_t t, bus_size_t size, bus_size_t alignment,
1035 1.7 thorpej bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs,
1036 1.11 thorpej int flags, paddr_t low, paddr_t high)
1037 1.1 chris {
1038 1.11 thorpej paddr_t curaddr, lastaddr;
1039 1.1 chris struct vm_page *m;
1040 1.1 chris struct pglist mlist;
1041 1.1 chris int curseg, error;
1042 1.1 chris
1043 1.1 chris #ifdef DEBUG_DMA
1044 1.1 chris printf("alloc_range: t=%p size=%lx align=%lx boundary=%lx segs=%p nsegs=%x rsegs=%p flags=%x lo=%lx hi=%lx\n",
1045 1.1 chris t, size, alignment, boundary, segs, nsegs, rsegs, flags, low, high);
1046 1.1 chris #endif /* DEBUG_DMA */
1047 1.1 chris
1048 1.1 chris /* Always round the size. */
1049 1.1 chris size = round_page(size);
1050 1.1 chris
1051 1.1 chris /*
1052 1.1 chris * Allocate pages from the VM system.
1053 1.1 chris */
1054 1.1 chris error = uvm_pglistalloc(size, low, high, alignment, boundary,
1055 1.1 chris &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0);
1056 1.1 chris if (error)
1057 1.1 chris return (error);
1058 1.1 chris
1059 1.1 chris /*
1060 1.1 chris * Compute the location, size, and number of segments actually
1061 1.1 chris * returned by the VM code.
1062 1.1 chris */
1063 1.42 chris m = TAILQ_FIRST(&mlist);
1064 1.1 chris curseg = 0;
1065 1.1 chris lastaddr = segs[curseg].ds_addr = VM_PAGE_TO_PHYS(m);
1066 1.1 chris segs[curseg].ds_len = PAGE_SIZE;
1067 1.1 chris #ifdef DEBUG_DMA
1068 1.1 chris printf("alloc: page %lx\n", lastaddr);
1069 1.1 chris #endif /* DEBUG_DMA */
1070 1.42 chris m = TAILQ_NEXT(m, pageq);
1071 1.1 chris
1072 1.42 chris for (; m != NULL; m = TAILQ_NEXT(m, pageq)) {
1073 1.1 chris curaddr = VM_PAGE_TO_PHYS(m);
1074 1.1 chris #ifdef DIAGNOSTIC
1075 1.1 chris if (curaddr < low || curaddr >= high) {
1076 1.1 chris printf("uvm_pglistalloc returned non-sensical"
1077 1.1 chris " address 0x%lx\n", curaddr);
1078 1.1 chris panic("_bus_dmamem_alloc_range");
1079 1.1 chris }
1080 1.1 chris #endif /* DIAGNOSTIC */
1081 1.1 chris #ifdef DEBUG_DMA
1082 1.1 chris printf("alloc: page %lx\n", curaddr);
1083 1.1 chris #endif /* DEBUG_DMA */
1084 1.1 chris if (curaddr == (lastaddr + PAGE_SIZE))
1085 1.1 chris segs[curseg].ds_len += PAGE_SIZE;
1086 1.1 chris else {
1087 1.1 chris curseg++;
1088 1.1 chris segs[curseg].ds_addr = curaddr;
1089 1.1 chris segs[curseg].ds_len = PAGE_SIZE;
1090 1.1 chris }
1091 1.1 chris lastaddr = curaddr;
1092 1.1 chris }
1093 1.1 chris
1094 1.1 chris *rsegs = curseg + 1;
1095 1.1 chris
1096 1.15 thorpej return (0);
1097 1.15 thorpej }
1098 1.15 thorpej
1099 1.15 thorpej /*
1100 1.15 thorpej * Check if a memory region intersects with a DMA range, and return the
1101 1.15 thorpej * page-rounded intersection if it does.
1102 1.15 thorpej */
1103 1.15 thorpej int
1104 1.15 thorpej arm32_dma_range_intersect(struct arm32_dma_range *ranges, int nranges,
1105 1.15 thorpej paddr_t pa, psize_t size, paddr_t *pap, psize_t *sizep)
1106 1.15 thorpej {
1107 1.15 thorpej struct arm32_dma_range *dr;
1108 1.15 thorpej int i;
1109 1.15 thorpej
1110 1.15 thorpej if (ranges == NULL)
1111 1.15 thorpej return (0);
1112 1.15 thorpej
1113 1.15 thorpej for (i = 0, dr = ranges; i < nranges; i++, dr++) {
1114 1.15 thorpej if (dr->dr_sysbase <= pa &&
1115 1.15 thorpej pa < (dr->dr_sysbase + dr->dr_len)) {
1116 1.15 thorpej /*
1117 1.15 thorpej * Beginning of region intersects with this range.
1118 1.15 thorpej */
1119 1.15 thorpej *pap = trunc_page(pa);
1120 1.15 thorpej *sizep = round_page(min(pa + size,
1121 1.15 thorpej dr->dr_sysbase + dr->dr_len) - pa);
1122 1.15 thorpej return (1);
1123 1.15 thorpej }
1124 1.15 thorpej if (pa < dr->dr_sysbase && dr->dr_sysbase < (pa + size)) {
1125 1.15 thorpej /*
1126 1.15 thorpej * End of region intersects with this range.
1127 1.15 thorpej */
1128 1.15 thorpej *pap = trunc_page(dr->dr_sysbase);
1129 1.15 thorpej *sizep = round_page(min((pa + size) - dr->dr_sysbase,
1130 1.15 thorpej dr->dr_len));
1131 1.15 thorpej return (1);
1132 1.15 thorpej }
1133 1.15 thorpej }
1134 1.15 thorpej
1135 1.15 thorpej /* No intersection found. */
1136 1.1 chris return (0);
1137 1.1 chris }
1138