1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3 *
4 * Copyright (c) 1997, 1998 Justin T. Gibbs.
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions, and the following disclaimer,
12 * without modification, immediately at the beginning of the file.
13 * 2. The name of the author may not be used to endorse or promote products
14 * derived from this software without specific prior written permission.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
20 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
31
32 #include <sys/param.h>
33 #include <sys/systm.h>
34 #include <sys/domainset.h>
35 #include <sys/malloc.h>
36 #include <sys/bus.h>
37 #include <sys/interrupt.h>
38 #include <sys/kernel.h>
39 #include <sys/ktr.h>
40 #include <sys/lock.h>
41 #include <sys/proc.h>
42 #include <sys/memdesc.h>
43 #include <sys/mutex.h>
44 #include <sys/sysctl.h>
45 #include <sys/uio.h>
46
47 #include <vm/vm.h>
48 #include <vm/vm_extern.h>
49 #include <vm/vm_kern.h>
50 #include <vm/vm_page.h>
51 #include <vm/vm_map.h>
52
53 #include <machine/atomic.h>
54 #include <machine/bus.h>
55 #include <machine/md_var.h>
56 #include <machine/specialreg.h>
57 #include <x86/include/busdma_impl.h>
58
59 #ifdef __i386__
60 #define MAX_BPAGES (Maxmem > atop(0x100000000ULL) ? 8192 : 512)
61 #else
62 #define MAX_BPAGES 8192
63 #endif
64
65 enum {
66 BUS_DMA_COULD_BOUNCE = 0x01,
67 BUS_DMA_MIN_ALLOC_COMP = 0x02,
68 BUS_DMA_KMEM_ALLOC = 0x04,
69 };
70
71 struct bounce_zone;
72
73 struct bus_dma_tag {
74 struct bus_dma_tag_common common;
75 int map_count;
76 int bounce_flags;
77 bus_dma_segment_t *segments;
78 struct bounce_zone *bounce_zone;
79 };
80
81 struct bounce_page {
82 vm_offset_t vaddr; /* kva of bounce buffer */
83 bus_addr_t busaddr; /* Physical address */
84 vm_offset_t datavaddr; /* kva of client data */
85 vm_offset_t dataoffs; /* page offset of client data */
86 vm_page_t datapage[2]; /* physical page(s) of client data */
87 bus_size_t datacount; /* client data count */
88 STAILQ_ENTRY(bounce_page) links;
89 };
90
91 int busdma_swi_pending;
92
93 struct bounce_zone {
94 STAILQ_ENTRY(bounce_zone) links;
95 STAILQ_HEAD(bp_list, bounce_page) bounce_page_list;
96 int total_bpages;
97 int free_bpages;
98 int reserved_bpages;
99 int active_bpages;
100 int total_bounced;
101 int total_deferred;
102 int map_count;
103 int domain;
104 bus_size_t alignment;
105 bus_addr_t lowaddr;
106 char zoneid[8];
107 char lowaddrid[20];
108 struct sysctl_ctx_list sysctl_tree;
109 struct sysctl_oid *sysctl_tree_top;
110 };
111
112 static struct mtx bounce_lock;
113 static int total_bpages;
114 static int busdma_zonecount;
115 static STAILQ_HEAD(, bounce_zone) bounce_zone_list;
116
117 static SYSCTL_NODE(_hw, OID_AUTO, busdma, CTLFLAG_RD, 0, "Busdma parameters");
118 SYSCTL_INT(_hw_busdma, OID_AUTO, total_bpages, CTLFLAG_RD, &total_bpages, 0,
119 "Total bounce pages");
120
121 struct bus_dmamap {
122 struct bp_list bpages;
123 int pagesneeded;
124 int pagesreserved;
125 bus_dma_tag_t dmat;
126 struct memdesc mem;
127 bus_dmamap_callback_t *callback;
128 void *callback_arg;
129 STAILQ_ENTRY(bus_dmamap) links;
130 };
131
132 static STAILQ_HEAD(, bus_dmamap) bounce_map_waitinglist;
133 static STAILQ_HEAD(, bus_dmamap) bounce_map_callbacklist;
134 static struct bus_dmamap nobounce_dmamap;
135
136 static void init_bounce_pages(void *dummy);
137 static int alloc_bounce_zone(bus_dma_tag_t dmat);
138 static int alloc_bounce_pages(bus_dma_tag_t dmat, u_int numpages);
139 static int reserve_bounce_pages(bus_dma_tag_t dmat, bus_dmamap_t map,
140 int commit);
141 static bus_addr_t add_bounce_page(bus_dma_tag_t dmat, bus_dmamap_t map,
142 vm_offset_t vaddr, vm_paddr_t addr1, vm_paddr_t addr2, bus_size_t size);
143 static void free_bounce_page(bus_dma_tag_t dmat, struct bounce_page *bpage);
144 static void _bus_dmamap_count_pages(bus_dma_tag_t dmat, bus_dmamap_t map,
145 pmap_t pmap, void *buf, bus_size_t buflen, int flags);
146 static void _bus_dmamap_count_phys(bus_dma_tag_t dmat, bus_dmamap_t map,
147 vm_paddr_t buf, bus_size_t buflen, int flags);
148 static int _bus_dmamap_reserve_pages(bus_dma_tag_t dmat, bus_dmamap_t map,
149 int flags);
150
151 static int
bounce_bus_dma_zone_setup(bus_dma_tag_t dmat)152 bounce_bus_dma_zone_setup(bus_dma_tag_t dmat)
153 {
154 struct bounce_zone *bz;
155 int error;
156
157 /* Must bounce */
158 if ((error = alloc_bounce_zone(dmat)) != 0)
159 return (error);
160 bz = dmat->bounce_zone;
161
162 if (ptoa(bz->total_bpages) < dmat->common.maxsize) {
163 int pages;
164
165 pages = atop(dmat->common.maxsize) - bz->total_bpages;
166
167 /* Add pages to our bounce pool */
168 if (alloc_bounce_pages(dmat, pages) < pages)
169 return (ENOMEM);
170 }
171 /* Performed initial allocation */
172 dmat->bounce_flags |= BUS_DMA_MIN_ALLOC_COMP;
173
174 return (0);
175 }
176
177 /*
178 * Allocate a device specific dma_tag.
179 */
180 static int
bounce_bus_dma_tag_create(bus_dma_tag_t parent,bus_size_t alignment,bus_addr_t boundary,bus_addr_t lowaddr,bus_addr_t highaddr,bus_dma_filter_t * filter,void * filterarg,bus_size_t maxsize,int nsegments,bus_size_t maxsegsz,int flags,bus_dma_lock_t * lockfunc,void * lockfuncarg,bus_dma_tag_t * dmat)181 bounce_bus_dma_tag_create(bus_dma_tag_t parent, bus_size_t alignment,
182 bus_addr_t boundary, bus_addr_t lowaddr, bus_addr_t highaddr,
183 bus_dma_filter_t *filter, void *filterarg, bus_size_t maxsize,
184 int nsegments, bus_size_t maxsegsz, int flags, bus_dma_lock_t *lockfunc,
185 void *lockfuncarg, bus_dma_tag_t *dmat)
186 {
187 bus_dma_tag_t newtag;
188 int error;
189
190 *dmat = NULL;
191 error = common_bus_dma_tag_create(parent != NULL ? &parent->common :
192 NULL, alignment, boundary, lowaddr, highaddr, filter, filterarg,
193 maxsize, nsegments, maxsegsz, flags, lockfunc, lockfuncarg,
194 sizeof (struct bus_dma_tag), (void **)&newtag);
195 if (error != 0)
196 return (error);
197
198 newtag->common.impl = &bus_dma_bounce_impl;
199 newtag->map_count = 0;
200 newtag->segments = NULL;
201
202 if (parent != NULL && (newtag->common.filter != NULL ||
203 (parent->bounce_flags & BUS_DMA_COULD_BOUNCE) != 0))
204 newtag->bounce_flags |= BUS_DMA_COULD_BOUNCE;
205
206 if (newtag->common.lowaddr < ptoa((vm_paddr_t)Maxmem) ||
207 newtag->common.alignment > 1)
208 newtag->bounce_flags |= BUS_DMA_COULD_BOUNCE;
209
210 if ((newtag->bounce_flags & BUS_DMA_COULD_BOUNCE) != 0 &&
211 (flags & BUS_DMA_ALLOCNOW) != 0)
212 error = bounce_bus_dma_zone_setup(newtag);
213 else
214 error = 0;
215
216 if (error != 0)
217 free(newtag, M_DEVBUF);
218 else
219 *dmat = newtag;
220 CTR4(KTR_BUSDMA, "%s returned tag %p tag flags 0x%x error %d",
221 __func__, newtag, (newtag != NULL ? newtag->common.flags : 0),
222 error);
223 return (error);
224 }
225
226 /*
227 * Update the domain for the tag. We may need to reallocate the zone and
228 * bounce pages.
229 */
230 static int
bounce_bus_dma_tag_set_domain(bus_dma_tag_t dmat)231 bounce_bus_dma_tag_set_domain(bus_dma_tag_t dmat)
232 {
233
234 KASSERT(dmat->map_count == 0,
235 ("bounce_bus_dma_tag_set_domain: Domain set after use.\n"));
236 if ((dmat->bounce_flags & BUS_DMA_COULD_BOUNCE) == 0 ||
237 dmat->bounce_zone == NULL)
238 return (0);
239 dmat->bounce_flags &= ~BUS_DMA_MIN_ALLOC_COMP;
240 return (bounce_bus_dma_zone_setup(dmat));
241 }
242
243 static int
bounce_bus_dma_tag_destroy(bus_dma_tag_t dmat)244 bounce_bus_dma_tag_destroy(bus_dma_tag_t dmat)
245 {
246 bus_dma_tag_t dmat_copy, parent;
247 int error;
248
249 error = 0;
250 dmat_copy = dmat;
251
252 if (dmat != NULL) {
253 if (dmat->map_count != 0) {
254 error = EBUSY;
255 goto out;
256 }
257 while (dmat != NULL) {
258 parent = (bus_dma_tag_t)dmat->common.parent;
259 atomic_subtract_int(&dmat->common.ref_count, 1);
260 if (dmat->common.ref_count == 0) {
261 if (dmat->segments != NULL)
262 free_domain(dmat->segments, M_DEVBUF);
263 free(dmat, M_DEVBUF);
264 /*
265 * Last reference count, so
266 * release our reference
267 * count on our parent.
268 */
269 dmat = parent;
270 } else
271 dmat = NULL;
272 }
273 }
274 out:
275 CTR3(KTR_BUSDMA, "%s tag %p error %d", __func__, dmat_copy, error);
276 return (error);
277 }
278
279 /*
280 * Allocate a handle for mapping from kva/uva/physical
281 * address space into bus device space.
282 */
283 static int
bounce_bus_dmamap_create(bus_dma_tag_t dmat,int flags,bus_dmamap_t * mapp)284 bounce_bus_dmamap_create(bus_dma_tag_t dmat, int flags, bus_dmamap_t *mapp)
285 {
286 struct bounce_zone *bz;
287 int error, maxpages, pages;
288
289 error = 0;
290
291 if (dmat->segments == NULL) {
292 dmat->segments = (bus_dma_segment_t *)malloc_domainset(
293 sizeof(bus_dma_segment_t) * dmat->common.nsegments,
294 M_DEVBUF, DOMAINSET_PREF(dmat->common.domain), M_NOWAIT);
295 if (dmat->segments == NULL) {
296 CTR3(KTR_BUSDMA, "%s: tag %p error %d",
297 __func__, dmat, ENOMEM);
298 return (ENOMEM);
299 }
300 }
301
302 /*
303 * Bouncing might be required if the driver asks for an active
304 * exclusion region, a data alignment that is stricter than 1, and/or
305 * an active address boundary.
306 */
307 if ((dmat->bounce_flags & BUS_DMA_COULD_BOUNCE) != 0) {
308 /* Must bounce */
309 if (dmat->bounce_zone == NULL) {
310 if ((error = alloc_bounce_zone(dmat)) != 0)
311 return (error);
312 }
313 bz = dmat->bounce_zone;
314
315 *mapp = (bus_dmamap_t)malloc_domainset(sizeof(**mapp), M_DEVBUF,
316 DOMAINSET_PREF(dmat->common.domain), M_NOWAIT | M_ZERO);
317 if (*mapp == NULL) {
318 CTR3(KTR_BUSDMA, "%s: tag %p error %d",
319 __func__, dmat, ENOMEM);
320 return (ENOMEM);
321 }
322
323 /* Initialize the new map */
324 STAILQ_INIT(&((*mapp)->bpages));
325
326 /*
327 * Attempt to add pages to our pool on a per-instance
328 * basis up to a sane limit.
329 */
330 if (dmat->common.alignment > 1)
331 maxpages = MAX_BPAGES;
332 else
333 maxpages = MIN(MAX_BPAGES, Maxmem -
334 atop(dmat->common.lowaddr));
335 if ((dmat->bounce_flags & BUS_DMA_MIN_ALLOC_COMP) == 0 ||
336 (bz->map_count > 0 && bz->total_bpages < maxpages)) {
337 pages = MAX(atop(dmat->common.maxsize), 1);
338 pages = MIN(maxpages - bz->total_bpages, pages);
339 pages = MAX(pages, 1);
340 if (alloc_bounce_pages(dmat, pages) < pages)
341 error = ENOMEM;
342 if ((dmat->bounce_flags & BUS_DMA_MIN_ALLOC_COMP)
343 == 0) {
344 if (error == 0) {
345 dmat->bounce_flags |=
346 BUS_DMA_MIN_ALLOC_COMP;
347 }
348 } else
349 error = 0;
350 }
351 bz->map_count++;
352 } else {
353 *mapp = NULL;
354 }
355 if (error == 0)
356 dmat->map_count++;
357 CTR4(KTR_BUSDMA, "%s: tag %p tag flags 0x%x error %d",
358 __func__, dmat, dmat->common.flags, error);
359 return (error);
360 }
361
362 /*
363 * Destroy a handle for mapping from kva/uva/physical
364 * address space into bus device space.
365 */
366 static int
bounce_bus_dmamap_destroy(bus_dma_tag_t dmat,bus_dmamap_t map)367 bounce_bus_dmamap_destroy(bus_dma_tag_t dmat, bus_dmamap_t map)
368 {
369
370 if (map != NULL && map != &nobounce_dmamap) {
371 if (STAILQ_FIRST(&map->bpages) != NULL) {
372 CTR3(KTR_BUSDMA, "%s: tag %p error %d",
373 __func__, dmat, EBUSY);
374 return (EBUSY);
375 }
376 if (dmat->bounce_zone)
377 dmat->bounce_zone->map_count--;
378 free_domain(map, M_DEVBUF);
379 }
380 dmat->map_count--;
381 CTR2(KTR_BUSDMA, "%s: tag %p error 0", __func__, dmat);
382 return (0);
383 }
384
385
386 /*
387 * Allocate a piece of memory that can be efficiently mapped into
388 * bus device space based on the constraints lited in the dma tag.
389 * A dmamap to for use with dmamap_load is also allocated.
390 */
391 static int
bounce_bus_dmamem_alloc(bus_dma_tag_t dmat,void ** vaddr,int flags,bus_dmamap_t * mapp)392 bounce_bus_dmamem_alloc(bus_dma_tag_t dmat, void** vaddr, int flags,
393 bus_dmamap_t *mapp)
394 {
395 vm_memattr_t attr;
396 int mflags;
397
398 WITNESS_WARN(WARN_GIANTOK | WARN_SLEEPOK, NULL, "%s", __func__);
399
400 if (flags & BUS_DMA_NOWAIT)
401 mflags = M_NOWAIT;
402 else
403 mflags = M_WAITOK;
404
405 /* If we succeed, no mapping/bouncing will be required */
406 *mapp = NULL;
407
408 if (dmat->segments == NULL) {
409 dmat->segments = (bus_dma_segment_t *)malloc_domainset(
410 sizeof(bus_dma_segment_t) * dmat->common.nsegments,
411 M_DEVBUF, DOMAINSET_PREF(dmat->common.domain), mflags);
412 if (dmat->segments == NULL) {
413 CTR4(KTR_BUSDMA, "%s: tag %p tag flags 0x%x error %d",
414 __func__, dmat, dmat->common.flags, ENOMEM);
415 return (ENOMEM);
416 }
417 }
418 if (flags & BUS_DMA_ZERO)
419 mflags |= M_ZERO;
420 if (flags & BUS_DMA_NOCACHE)
421 attr = VM_MEMATTR_UNCACHEABLE;
422 else
423 attr = VM_MEMATTR_DEFAULT;
424
425 /*
426 * Allocate the buffer from the malloc(9) allocator if...
427 * - It's small enough to fit into a single power of two sized bucket.
428 * - The alignment is less than or equal to the maximum size
429 * - The low address requirement is fulfilled.
430 * else allocate non-contiguous pages if...
431 * - The page count that could get allocated doesn't exceed
432 * nsegments also when the maximum segment size is less
433 * than PAGE_SIZE.
434 * - The alignment constraint isn't larger than a page boundary.
435 * - There are no boundary-crossing constraints.
436 * else allocate a block of contiguous pages because one or more of the
437 * constraints is something that only the contig allocator can fulfill.
438 *
439 * NOTE: The (dmat->common.alignment <= dmat->maxsize) check
440 * below is just a quick hack. The exact alignment guarantees
441 * of malloc(9) need to be nailed down, and the code below
442 * should be rewritten to take that into account.
443 *
444 * In the meantime warn the user if malloc gets it wrong.
445 */
446 if (dmat->common.maxsize <= PAGE_SIZE &&
447 dmat->common.alignment <= dmat->common.maxsize &&
448 dmat->common.lowaddr >= ptoa((vm_paddr_t)Maxmem) &&
449 attr == VM_MEMATTR_DEFAULT) {
450 *vaddr = malloc_domainset(dmat->common.maxsize, M_DEVBUF,
451 DOMAINSET_PREF(dmat->common.domain), mflags);
452 } else if (dmat->common.nsegments >=
453 howmany(dmat->common.maxsize, MIN(dmat->common.maxsegsz,
454 PAGE_SIZE)) &&
455 dmat->common.alignment <= PAGE_SIZE &&
456 (dmat->common.boundary % PAGE_SIZE) == 0) {
457 /* Page-based multi-segment allocations allowed */
458 *vaddr = (void *)kmem_alloc_attr_domainset(
459 DOMAINSET_PREF(dmat->common.domain), dmat->common.maxsize,
460 mflags, 0ul, dmat->common.lowaddr, attr);
461 dmat->bounce_flags |= BUS_DMA_KMEM_ALLOC;
462 } else {
463 *vaddr = (void *)kmem_alloc_contig_domainset(
464 DOMAINSET_PREF(dmat->common.domain), dmat->common.maxsize,
465 mflags, 0ul, dmat->common.lowaddr,
466 dmat->common.alignment != 0 ? dmat->common.alignment : 1ul,
467 dmat->common.boundary, attr);
468 dmat->bounce_flags |= BUS_DMA_KMEM_ALLOC;
469 }
470 if (*vaddr == NULL) {
471 CTR4(KTR_BUSDMA, "%s: tag %p tag flags 0x%x error %d",
472 __func__, dmat, dmat->common.flags, ENOMEM);
473 return (ENOMEM);
474 } else if (vtophys(*vaddr) & (dmat->common.alignment - 1)) {
475 printf("bus_dmamem_alloc failed to align memory properly.\n");
476 }
477 CTR4(KTR_BUSDMA, "%s: tag %p tag flags 0x%x error %d",
478 __func__, dmat, dmat->common.flags, 0);
479 return (0);
480 }
481
482 /*
483 * Free a piece of memory and it's allociated dmamap, that was allocated
484 * via bus_dmamem_alloc. Make the same choice for free/contigfree.
485 */
486 static void
bounce_bus_dmamem_free(bus_dma_tag_t dmat,void * vaddr,bus_dmamap_t map)487 bounce_bus_dmamem_free(bus_dma_tag_t dmat, void *vaddr, bus_dmamap_t map)
488 {
489 /*
490 * dmamem does not need to be bounced, so the map should be
491 * NULL and the BUS_DMA_KMEM_ALLOC flag cleared if malloc()
492 * was used and set if kmem_alloc_contig() was used.
493 */
494 if (map != NULL)
495 panic("bus_dmamem_free: Invalid map freed\n");
496 if ((dmat->bounce_flags & BUS_DMA_KMEM_ALLOC) == 0)
497 free_domain(vaddr, M_DEVBUF);
498 else
499 kmem_free((vm_offset_t)vaddr, dmat->common.maxsize);
500 CTR3(KTR_BUSDMA, "%s: tag %p flags 0x%x", __func__, dmat,
501 dmat->bounce_flags);
502 }
503
504 static void
_bus_dmamap_count_phys(bus_dma_tag_t dmat,bus_dmamap_t map,vm_paddr_t buf,bus_size_t buflen,int flags)505 _bus_dmamap_count_phys(bus_dma_tag_t dmat, bus_dmamap_t map, vm_paddr_t buf,
506 bus_size_t buflen, int flags)
507 {
508 vm_paddr_t curaddr;
509 bus_size_t sgsize;
510
511 if (map != &nobounce_dmamap && map->pagesneeded == 0) {
512 /*
513 * Count the number of bounce pages
514 * needed in order to complete this transfer
515 */
516 curaddr = buf;
517 while (buflen != 0) {
518 sgsize = MIN(buflen, dmat->common.maxsegsz);
519 if (bus_dma_run_filter(&dmat->common, curaddr)) {
520 sgsize = MIN(sgsize,
521 PAGE_SIZE - (curaddr & PAGE_MASK));
522 map->pagesneeded++;
523 }
524 curaddr += sgsize;
525 buflen -= sgsize;
526 }
527 CTR1(KTR_BUSDMA, "pagesneeded= %d\n", map->pagesneeded);
528 }
529 }
530
531 static void
_bus_dmamap_count_pages(bus_dma_tag_t dmat,bus_dmamap_t map,pmap_t pmap,void * buf,bus_size_t buflen,int flags)532 _bus_dmamap_count_pages(bus_dma_tag_t dmat, bus_dmamap_t map, pmap_t pmap,
533 void *buf, bus_size_t buflen, int flags)
534 {
535 vm_offset_t vaddr;
536 vm_offset_t vendaddr;
537 vm_paddr_t paddr;
538 bus_size_t sg_len;
539
540 if (map != &nobounce_dmamap && map->pagesneeded == 0) {
541 CTR4(KTR_BUSDMA, "lowaddr= %d Maxmem= %d, boundary= %d, "
542 "alignment= %d", dmat->common.lowaddr,
543 ptoa((vm_paddr_t)Maxmem),
544 dmat->common.boundary, dmat->common.alignment);
545 CTR3(KTR_BUSDMA, "map= %p, nobouncemap= %p, pagesneeded= %d",
546 map, &nobounce_dmamap, map->pagesneeded);
547 /*
548 * Count the number of bounce pages
549 * needed in order to complete this transfer
550 */
551 vaddr = (vm_offset_t)buf;
552 vendaddr = (vm_offset_t)buf + buflen;
553
554 while (vaddr < vendaddr) {
555 sg_len = PAGE_SIZE - ((vm_offset_t)vaddr & PAGE_MASK);
556 if (pmap == kernel_pmap)
557 paddr = pmap_kextract(vaddr);
558 else
559 paddr = pmap_extract(pmap, vaddr);
560 if (bus_dma_run_filter(&dmat->common, paddr) != 0) {
561 sg_len = roundup2(sg_len,
562 dmat->common.alignment);
563 map->pagesneeded++;
564 }
565 vaddr += sg_len;
566 }
567 CTR1(KTR_BUSDMA, "pagesneeded= %d\n", map->pagesneeded);
568 }
569 }
570
571 static void
_bus_dmamap_count_ma(bus_dma_tag_t dmat,bus_dmamap_t map,struct vm_page ** ma,int ma_offs,bus_size_t buflen,int flags)572 _bus_dmamap_count_ma(bus_dma_tag_t dmat, bus_dmamap_t map, struct vm_page **ma,
573 int ma_offs, bus_size_t buflen, int flags)
574 {
575 bus_size_t sg_len, max_sgsize;
576 int page_index;
577 vm_paddr_t paddr;
578
579 if (map != &nobounce_dmamap && map->pagesneeded == 0) {
580 CTR4(KTR_BUSDMA, "lowaddr= %d Maxmem= %d, boundary= %d, "
581 "alignment= %d", dmat->common.lowaddr,
582 ptoa((vm_paddr_t)Maxmem),
583 dmat->common.boundary, dmat->common.alignment);
584 CTR3(KTR_BUSDMA, "map= %p, nobouncemap= %p, pagesneeded= %d",
585 map, &nobounce_dmamap, map->pagesneeded);
586
587 /*
588 * Count the number of bounce pages
589 * needed in order to complete this transfer
590 */
591 page_index = 0;
592 while (buflen > 0) {
593 paddr = VM_PAGE_TO_PHYS(ma[page_index]) + ma_offs;
594 sg_len = PAGE_SIZE - ma_offs;
595 max_sgsize = MIN(buflen, dmat->common.maxsegsz);
596 sg_len = MIN(sg_len, max_sgsize);
597 if (bus_dma_run_filter(&dmat->common, paddr) != 0) {
598 sg_len = roundup2(sg_len,
599 dmat->common.alignment);
600 sg_len = MIN(sg_len, max_sgsize);
601 KASSERT((sg_len & (dmat->common.alignment - 1))
602 == 0, ("Segment size is not aligned"));
603 map->pagesneeded++;
604 }
605 if (((ma_offs + sg_len) & ~PAGE_MASK) != 0)
606 page_index++;
607 ma_offs = (ma_offs + sg_len) & PAGE_MASK;
608 KASSERT(buflen >= sg_len,
609 ("Segment length overruns original buffer"));
610 buflen -= sg_len;
611 }
612 CTR1(KTR_BUSDMA, "pagesneeded= %d\n", map->pagesneeded);
613 }
614 }
615
616 static int
_bus_dmamap_reserve_pages(bus_dma_tag_t dmat,bus_dmamap_t map,int flags)617 _bus_dmamap_reserve_pages(bus_dma_tag_t dmat, bus_dmamap_t map, int flags)
618 {
619
620 /* Reserve Necessary Bounce Pages */
621 mtx_lock(&bounce_lock);
622 if (flags & BUS_DMA_NOWAIT) {
623 if (reserve_bounce_pages(dmat, map, 0) != 0) {
624 mtx_unlock(&bounce_lock);
625 return (ENOMEM);
626 }
627 } else {
628 if (reserve_bounce_pages(dmat, map, 1) != 0) {
629 /* Queue us for resources */
630 STAILQ_INSERT_TAIL(&bounce_map_waitinglist, map, links);
631 mtx_unlock(&bounce_lock);
632 return (EINPROGRESS);
633 }
634 }
635 mtx_unlock(&bounce_lock);
636
637 return (0);
638 }
639
640 /*
641 * Add a single contiguous physical range to the segment list.
642 */
643 static int
_bus_dmamap_addseg(bus_dma_tag_t dmat,bus_dmamap_t map,vm_paddr_t curaddr,bus_size_t sgsize,bus_dma_segment_t * segs,int * segp)644 _bus_dmamap_addseg(bus_dma_tag_t dmat, bus_dmamap_t map, vm_paddr_t curaddr,
645 bus_size_t sgsize, bus_dma_segment_t *segs, int *segp)
646 {
647 bus_addr_t baddr, bmask;
648 int seg;
649
650 KASSERT(curaddr <= BUS_SPACE_MAXADDR,
651 ("ds_addr %#jx > BUS_SPACE_MAXADDR %#jx; dmat %p fl %#x low %#jx "
652 "hi %#jx",
653 (uintmax_t)curaddr, (uintmax_t)BUS_SPACE_MAXADDR,
654 dmat, dmat->bounce_flags, (uintmax_t)dmat->common.lowaddr,
655 (uintmax_t)dmat->common.highaddr));
656
657 /*
658 * Make sure we don't cross any boundaries.
659 */
660 bmask = ~(dmat->common.boundary - 1);
661 if (dmat->common.boundary > 0) {
662 baddr = (curaddr + dmat->common.boundary) & bmask;
663 if (sgsize > (baddr - curaddr))
664 sgsize = (baddr - curaddr);
665 }
666
667 /*
668 * Insert chunk into a segment, coalescing with
669 * previous segment if possible.
670 */
671 seg = *segp;
672 if (seg == -1) {
673 seg = 0;
674 segs[seg].ds_addr = curaddr;
675 segs[seg].ds_len = sgsize;
676 } else {
677 if (curaddr == segs[seg].ds_addr + segs[seg].ds_len &&
678 (segs[seg].ds_len + sgsize) <= dmat->common.maxsegsz &&
679 (dmat->common.boundary == 0 ||
680 (segs[seg].ds_addr & bmask) == (curaddr & bmask)))
681 segs[seg].ds_len += sgsize;
682 else {
683 if (++seg >= dmat->common.nsegments)
684 return (0);
685 segs[seg].ds_addr = curaddr;
686 segs[seg].ds_len = sgsize;
687 }
688 }
689 *segp = seg;
690 return (sgsize);
691 }
692
693 /*
694 * Utility function to load a physical buffer. segp contains
695 * the starting segment on entrace, and the ending segment on exit.
696 */
697 static int
bounce_bus_dmamap_load_phys(bus_dma_tag_t dmat,bus_dmamap_t map,vm_paddr_t buf,bus_size_t buflen,int flags,bus_dma_segment_t * segs,int * segp)698 bounce_bus_dmamap_load_phys(bus_dma_tag_t dmat, bus_dmamap_t map,
699 vm_paddr_t buf, bus_size_t buflen, int flags, bus_dma_segment_t *segs,
700 int *segp)
701 {
702 bus_size_t sgsize;
703 vm_paddr_t curaddr;
704 int error;
705
706 if (map == NULL)
707 map = &nobounce_dmamap;
708
709 if (segs == NULL)
710 segs = dmat->segments;
711
712 if ((dmat->bounce_flags & BUS_DMA_COULD_BOUNCE) != 0) {
713 _bus_dmamap_count_phys(dmat, map, buf, buflen, flags);
714 if (map->pagesneeded != 0) {
715 error = _bus_dmamap_reserve_pages(dmat, map, flags);
716 if (error)
717 return (error);
718 }
719 }
720
721 while (buflen > 0) {
722 curaddr = buf;
723 sgsize = MIN(buflen, dmat->common.maxsegsz);
724 if ((dmat->bounce_flags & BUS_DMA_COULD_BOUNCE) != 0 &&
725 map->pagesneeded != 0 &&
726 bus_dma_run_filter(&dmat->common, curaddr)) {
727 sgsize = MIN(sgsize, PAGE_SIZE - (curaddr & PAGE_MASK));
728 curaddr = add_bounce_page(dmat, map, 0, curaddr, 0,
729 sgsize);
730 }
731 sgsize = _bus_dmamap_addseg(dmat, map, curaddr, sgsize, segs,
732 segp);
733 if (sgsize == 0)
734 break;
735 buf += sgsize;
736 buflen -= sgsize;
737 }
738
739 /*
740 * Did we fit?
741 */
742 return (buflen != 0 ? EFBIG : 0); /* XXX better return value here? */
743 }
744
745 /*
746 * Utility function to load a linear buffer. segp contains
747 * the starting segment on entrace, and the ending segment on exit.
748 */
749 static int
bounce_bus_dmamap_load_buffer(bus_dma_tag_t dmat,bus_dmamap_t map,void * buf,bus_size_t buflen,pmap_t pmap,int flags,bus_dma_segment_t * segs,int * segp)750 bounce_bus_dmamap_load_buffer(bus_dma_tag_t dmat, bus_dmamap_t map, void *buf,
751 bus_size_t buflen, pmap_t pmap, int flags, bus_dma_segment_t *segs,
752 int *segp)
753 {
754 bus_size_t sgsize, max_sgsize;
755 vm_paddr_t curaddr;
756 vm_offset_t kvaddr, vaddr;
757 int error;
758
759 if (map == NULL)
760 map = &nobounce_dmamap;
761
762 if (segs == NULL)
763 segs = dmat->segments;
764
765 if ((dmat->bounce_flags & BUS_DMA_COULD_BOUNCE) != 0) {
766 _bus_dmamap_count_pages(dmat, map, pmap, buf, buflen, flags);
767 if (map->pagesneeded != 0) {
768 error = _bus_dmamap_reserve_pages(dmat, map, flags);
769 if (error)
770 return (error);
771 }
772 }
773
774 vaddr = (vm_offset_t)buf;
775 while (buflen > 0) {
776 /*
777 * Get the physical address for this segment.
778 */
779 if (pmap == kernel_pmap) {
780 curaddr = pmap_kextract(vaddr);
781 kvaddr = vaddr;
782 } else {
783 curaddr = pmap_extract(pmap, vaddr);
784 kvaddr = 0;
785 }
786
787 /*
788 * Compute the segment size, and adjust counts.
789 */
790 max_sgsize = MIN(buflen, dmat->common.maxsegsz);
791 sgsize = PAGE_SIZE - (curaddr & PAGE_MASK);
792 if ((dmat->bounce_flags & BUS_DMA_COULD_BOUNCE) != 0 &&
793 map->pagesneeded != 0 &&
794 bus_dma_run_filter(&dmat->common, curaddr)) {
795 sgsize = roundup2(sgsize, dmat->common.alignment);
796 sgsize = MIN(sgsize, max_sgsize);
797 curaddr = add_bounce_page(dmat, map, kvaddr, curaddr, 0,
798 sgsize);
799 } else {
800 sgsize = MIN(sgsize, max_sgsize);
801 }
802 sgsize = _bus_dmamap_addseg(dmat, map, curaddr, sgsize, segs,
803 segp);
804 if (sgsize == 0)
805 break;
806 vaddr += sgsize;
807 buflen -= sgsize;
808 }
809
810 /*
811 * Did we fit?
812 */
813 return (buflen != 0 ? EFBIG : 0); /* XXX better return value here? */
814 }
815
816 static int
bounce_bus_dmamap_load_ma(bus_dma_tag_t dmat,bus_dmamap_t map,struct vm_page ** ma,bus_size_t buflen,int ma_offs,int flags,bus_dma_segment_t * segs,int * segp)817 bounce_bus_dmamap_load_ma(bus_dma_tag_t dmat, bus_dmamap_t map,
818 struct vm_page **ma, bus_size_t buflen, int ma_offs, int flags,
819 bus_dma_segment_t *segs, int *segp)
820 {
821 vm_paddr_t paddr, next_paddr;
822 int error, page_index;
823 bus_size_t sgsize, max_sgsize;
824
825 if (dmat->common.flags & BUS_DMA_KEEP_PG_OFFSET) {
826 /*
827 * If we have to keep the offset of each page this function
828 * is not suitable, switch back to bus_dmamap_load_ma_triv
829 * which is going to do the right thing in this case.
830 */
831 error = bus_dmamap_load_ma_triv(dmat, map, ma, buflen, ma_offs,
832 flags, segs, segp);
833 return (error);
834 }
835
836 if (map == NULL)
837 map = &nobounce_dmamap;
838
839 if (segs == NULL)
840 segs = dmat->segments;
841
842 if ((dmat->bounce_flags & BUS_DMA_COULD_BOUNCE) != 0) {
843 _bus_dmamap_count_ma(dmat, map, ma, ma_offs, buflen, flags);
844 if (map->pagesneeded != 0) {
845 error = _bus_dmamap_reserve_pages(dmat, map, flags);
846 if (error)
847 return (error);
848 }
849 }
850
851 page_index = 0;
852 while (buflen > 0) {
853 /*
854 * Compute the segment size, and adjust counts.
855 */
856 paddr = VM_PAGE_TO_PHYS(ma[page_index]) + ma_offs;
857 max_sgsize = MIN(buflen, dmat->common.maxsegsz);
858 sgsize = PAGE_SIZE - ma_offs;
859 if ((dmat->bounce_flags & BUS_DMA_COULD_BOUNCE) != 0 &&
860 map->pagesneeded != 0 &&
861 bus_dma_run_filter(&dmat->common, paddr)) {
862 sgsize = roundup2(sgsize, dmat->common.alignment);
863 sgsize = MIN(sgsize, max_sgsize);
864 KASSERT((sgsize & (dmat->common.alignment - 1)) == 0,
865 ("Segment size is not aligned"));
866 /*
867 * Check if two pages of the user provided buffer
868 * are used.
869 */
870 if ((ma_offs + sgsize) > PAGE_SIZE)
871 next_paddr =
872 VM_PAGE_TO_PHYS(ma[page_index + 1]);
873 else
874 next_paddr = 0;
875 paddr = add_bounce_page(dmat, map, 0, paddr,
876 next_paddr, sgsize);
877 } else {
878 sgsize = MIN(sgsize, max_sgsize);
879 }
880 sgsize = _bus_dmamap_addseg(dmat, map, paddr, sgsize, segs,
881 segp);
882 if (sgsize == 0)
883 break;
884 KASSERT(buflen >= sgsize,
885 ("Segment length overruns original buffer"));
886 buflen -= sgsize;
887 if (((ma_offs + sgsize) & ~PAGE_MASK) != 0)
888 page_index++;
889 ma_offs = (ma_offs + sgsize) & PAGE_MASK;
890 }
891
892 /*
893 * Did we fit?
894 */
895 return (buflen != 0 ? EFBIG : 0); /* XXX better return value here? */
896 }
897
898 static void
bounce_bus_dmamap_waitok(bus_dma_tag_t dmat,bus_dmamap_t map,struct memdesc * mem,bus_dmamap_callback_t * callback,void * callback_arg)899 bounce_bus_dmamap_waitok(bus_dma_tag_t dmat, bus_dmamap_t map,
900 struct memdesc *mem, bus_dmamap_callback_t *callback, void *callback_arg)
901 {
902
903 if (map == NULL)
904 return;
905 map->mem = *mem;
906 map->dmat = dmat;
907 map->callback = callback;
908 map->callback_arg = callback_arg;
909 }
910
911 static bus_dma_segment_t *
bounce_bus_dmamap_complete(bus_dma_tag_t dmat,bus_dmamap_t map,bus_dma_segment_t * segs,int nsegs,int error)912 bounce_bus_dmamap_complete(bus_dma_tag_t dmat, bus_dmamap_t map,
913 bus_dma_segment_t *segs, int nsegs, int error)
914 {
915
916 if (segs == NULL)
917 segs = dmat->segments;
918 return (segs);
919 }
920
921 /*
922 * Release the mapping held by map.
923 */
924 static void
bounce_bus_dmamap_unload(bus_dma_tag_t dmat,bus_dmamap_t map)925 bounce_bus_dmamap_unload(bus_dma_tag_t dmat, bus_dmamap_t map)
926 {
927 struct bounce_page *bpage;
928
929 if (map == NULL)
930 return;
931
932 while ((bpage = STAILQ_FIRST(&map->bpages)) != NULL) {
933 STAILQ_REMOVE_HEAD(&map->bpages, links);
934 free_bounce_page(dmat, bpage);
935 }
936 }
937
938 static void
bounce_bus_dmamap_sync(bus_dma_tag_t dmat,bus_dmamap_t map,bus_dmasync_op_t op)939 bounce_bus_dmamap_sync(bus_dma_tag_t dmat, bus_dmamap_t map,
940 bus_dmasync_op_t op)
941 {
942 struct bounce_page *bpage;
943 vm_offset_t datavaddr, tempvaddr;
944 bus_size_t datacount1, datacount2;
945
946 if (map == NULL || (bpage = STAILQ_FIRST(&map->bpages)) == NULL)
947 return;
948
949 /*
950 * Handle data bouncing. We might also want to add support for
951 * invalidating the caches on broken hardware.
952 */
953 CTR4(KTR_BUSDMA, "%s: tag %p tag flags 0x%x op 0x%x "
954 "performing bounce", __func__, dmat, dmat->common.flags, op);
955
956 if ((op & BUS_DMASYNC_PREWRITE) != 0) {
957 while (bpage != NULL) {
958 tempvaddr = 0;
959 datavaddr = bpage->datavaddr;
960 datacount1 = bpage->datacount;
961 if (datavaddr == 0) {
962 tempvaddr =
963 pmap_quick_enter_page(bpage->datapage[0]);
964 datavaddr = tempvaddr | bpage->dataoffs;
965 datacount1 = min(PAGE_SIZE - bpage->dataoffs,
966 datacount1);
967 }
968
969 bcopy((void *)datavaddr,
970 (void *)bpage->vaddr, datacount1);
971
972 if (tempvaddr != 0)
973 pmap_quick_remove_page(tempvaddr);
974
975 if (bpage->datapage[1] == 0) {
976 KASSERT(datacount1 == bpage->datacount,
977 ("Mismatch between data size and provided memory space"));
978 goto next_w;
979 }
980
981 /*
982 * We are dealing with an unmapped buffer that expands
983 * over two pages.
984 */
985 datavaddr = pmap_quick_enter_page(bpage->datapage[1]);
986 datacount2 = bpage->datacount - datacount1;
987 bcopy((void *)datavaddr,
988 (void *)(bpage->vaddr + datacount1), datacount2);
989 pmap_quick_remove_page(datavaddr);
990
991 next_w:
992 bpage = STAILQ_NEXT(bpage, links);
993 }
994 dmat->bounce_zone->total_bounced++;
995 }
996
997 if ((op & BUS_DMASYNC_POSTREAD) != 0) {
998 while (bpage != NULL) {
999 tempvaddr = 0;
1000 datavaddr = bpage->datavaddr;
1001 datacount1 = bpage->datacount;
1002 if (datavaddr == 0) {
1003 tempvaddr =
1004 pmap_quick_enter_page(bpage->datapage[0]);
1005 datavaddr = tempvaddr | bpage->dataoffs;
1006 datacount1 = min(PAGE_SIZE - bpage->dataoffs,
1007 datacount1);
1008 }
1009
1010 bcopy((void *)bpage->vaddr, (void *)datavaddr,
1011 datacount1);
1012
1013 if (tempvaddr != 0)
1014 pmap_quick_remove_page(tempvaddr);
1015
1016 if (bpage->datapage[1] == 0) {
1017 KASSERT(datacount1 == bpage->datacount,
1018 ("Mismatch between data size and provided memory space"));
1019 goto next_r;
1020 }
1021
1022 /*
1023 * We are dealing with an unmapped buffer that expands
1024 * over two pages.
1025 */
1026 datavaddr = pmap_quick_enter_page(bpage->datapage[1]);
1027 datacount2 = bpage->datacount - datacount1;
1028 bcopy((void *)(bpage->vaddr + datacount1),
1029 (void *)datavaddr, datacount2);
1030 pmap_quick_remove_page(datavaddr);
1031
1032 next_r:
1033 bpage = STAILQ_NEXT(bpage, links);
1034 }
1035 dmat->bounce_zone->total_bounced++;
1036 }
1037 }
1038
1039 static void
init_bounce_pages(void * dummy __unused)1040 init_bounce_pages(void *dummy __unused)
1041 {
1042
1043 total_bpages = 0;
1044 STAILQ_INIT(&bounce_zone_list);
1045 STAILQ_INIT(&bounce_map_waitinglist);
1046 STAILQ_INIT(&bounce_map_callbacklist);
1047 mtx_init(&bounce_lock, "bounce pages lock", NULL, MTX_DEF);
1048 }
1049 SYSINIT(bpages, SI_SUB_LOCK, SI_ORDER_ANY, init_bounce_pages, NULL);
1050
1051 static struct sysctl_ctx_list *
busdma_sysctl_tree(struct bounce_zone * bz)1052 busdma_sysctl_tree(struct bounce_zone *bz)
1053 {
1054
1055 return (&bz->sysctl_tree);
1056 }
1057
1058 static struct sysctl_oid *
busdma_sysctl_tree_top(struct bounce_zone * bz)1059 busdma_sysctl_tree_top(struct bounce_zone *bz)
1060 {
1061
1062 return (bz->sysctl_tree_top);
1063 }
1064
1065 static int
alloc_bounce_zone(bus_dma_tag_t dmat)1066 alloc_bounce_zone(bus_dma_tag_t dmat)
1067 {
1068 struct bounce_zone *bz;
1069
1070 /* Check to see if we already have a suitable zone */
1071 STAILQ_FOREACH(bz, &bounce_zone_list, links) {
1072 if (dmat->common.alignment <= bz->alignment &&
1073 dmat->common.lowaddr >= bz->lowaddr &&
1074 dmat->common.domain == bz->domain) {
1075 dmat->bounce_zone = bz;
1076 return (0);
1077 }
1078 }
1079
1080 if ((bz = (struct bounce_zone *)malloc(sizeof(*bz), M_DEVBUF,
1081 M_NOWAIT | M_ZERO)) == NULL)
1082 return (ENOMEM);
1083
1084 STAILQ_INIT(&bz->bounce_page_list);
1085 bz->free_bpages = 0;
1086 bz->reserved_bpages = 0;
1087 bz->active_bpages = 0;
1088 bz->lowaddr = dmat->common.lowaddr;
1089 bz->alignment = MAX(dmat->common.alignment, PAGE_SIZE);
1090 bz->map_count = 0;
1091 bz->domain = dmat->common.domain;
1092 snprintf(bz->zoneid, 8, "zone%d", busdma_zonecount);
1093 busdma_zonecount++;
1094 snprintf(bz->lowaddrid, 18, "%#jx", (uintmax_t)bz->lowaddr);
1095 STAILQ_INSERT_TAIL(&bounce_zone_list, bz, links);
1096 dmat->bounce_zone = bz;
1097
1098 sysctl_ctx_init(&bz->sysctl_tree);
1099 bz->sysctl_tree_top = SYSCTL_ADD_NODE(&bz->sysctl_tree,
1100 SYSCTL_STATIC_CHILDREN(_hw_busdma), OID_AUTO, bz->zoneid,
1101 CTLFLAG_RD, 0, "");
1102 if (bz->sysctl_tree_top == NULL) {
1103 sysctl_ctx_free(&bz->sysctl_tree);
1104 return (0); /* XXX error code? */
1105 }
1106
1107 SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1108 SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1109 "total_bpages", CTLFLAG_RD, &bz->total_bpages, 0,
1110 "Total bounce pages");
1111 SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1112 SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1113 "free_bpages", CTLFLAG_RD, &bz->free_bpages, 0,
1114 "Free bounce pages");
1115 SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1116 SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1117 "reserved_bpages", CTLFLAG_RD, &bz->reserved_bpages, 0,
1118 "Reserved bounce pages");
1119 SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1120 SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1121 "active_bpages", CTLFLAG_RD, &bz->active_bpages, 0,
1122 "Active bounce pages");
1123 SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1124 SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1125 "total_bounced", CTLFLAG_RD, &bz->total_bounced, 0,
1126 "Total bounce requests");
1127 SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1128 SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1129 "total_deferred", CTLFLAG_RD, &bz->total_deferred, 0,
1130 "Total bounce requests that were deferred");
1131 SYSCTL_ADD_STRING(busdma_sysctl_tree(bz),
1132 SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1133 "lowaddr", CTLFLAG_RD, bz->lowaddrid, 0, "");
1134 SYSCTL_ADD_UAUTO(busdma_sysctl_tree(bz),
1135 SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1136 "alignment", CTLFLAG_RD, &bz->alignment, "");
1137 SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1138 SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1139 "domain", CTLFLAG_RD, &bz->domain, 0,
1140 "memory domain");
1141
1142 return (0);
1143 }
1144
1145 static int
alloc_bounce_pages(bus_dma_tag_t dmat,u_int numpages)1146 alloc_bounce_pages(bus_dma_tag_t dmat, u_int numpages)
1147 {
1148 struct bounce_zone *bz;
1149 int count;
1150
1151 bz = dmat->bounce_zone;
1152 count = 0;
1153 while (numpages > 0) {
1154 struct bounce_page *bpage;
1155
1156 bpage = malloc_domainset(sizeof(*bpage), M_DEVBUF,
1157 DOMAINSET_PREF(dmat->common.domain), M_NOWAIT | M_ZERO);
1158
1159 if (bpage == NULL)
1160 break;
1161 bpage->vaddr = (vm_offset_t)contigmalloc_domainset(PAGE_SIZE,
1162 M_DEVBUF, DOMAINSET_PREF(dmat->common.domain), M_NOWAIT,
1163 0ul, bz->lowaddr, PAGE_SIZE, 0);
1164 if (bpage->vaddr == 0) {
1165 free_domain(bpage, M_DEVBUF);
1166 break;
1167 }
1168 bpage->busaddr = pmap_kextract(bpage->vaddr);
1169 mtx_lock(&bounce_lock);
1170 STAILQ_INSERT_TAIL(&bz->bounce_page_list, bpage, links);
1171 total_bpages++;
1172 bz->total_bpages++;
1173 bz->free_bpages++;
1174 mtx_unlock(&bounce_lock);
1175 count++;
1176 numpages--;
1177 }
1178 return (count);
1179 }
1180
1181 static int
reserve_bounce_pages(bus_dma_tag_t dmat,bus_dmamap_t map,int commit)1182 reserve_bounce_pages(bus_dma_tag_t dmat, bus_dmamap_t map, int commit)
1183 {
1184 struct bounce_zone *bz;
1185 int pages;
1186
1187 mtx_assert(&bounce_lock, MA_OWNED);
1188 bz = dmat->bounce_zone;
1189 pages = MIN(bz->free_bpages, map->pagesneeded - map->pagesreserved);
1190 if (commit == 0 && map->pagesneeded > (map->pagesreserved + pages))
1191 return (map->pagesneeded - (map->pagesreserved + pages));
1192 bz->free_bpages -= pages;
1193 bz->reserved_bpages += pages;
1194 map->pagesreserved += pages;
1195 pages = map->pagesneeded - map->pagesreserved;
1196
1197 return (pages);
1198 }
1199
1200 static bus_addr_t
add_bounce_page(bus_dma_tag_t dmat,bus_dmamap_t map,vm_offset_t vaddr,vm_paddr_t addr1,vm_paddr_t addr2,bus_size_t size)1201 add_bounce_page(bus_dma_tag_t dmat, bus_dmamap_t map, vm_offset_t vaddr,
1202 vm_paddr_t addr1, vm_paddr_t addr2, bus_size_t size)
1203 {
1204 struct bounce_zone *bz;
1205 struct bounce_page *bpage;
1206
1207 KASSERT(dmat->bounce_zone != NULL, ("no bounce zone in dma tag"));
1208 KASSERT(map != NULL && map != &nobounce_dmamap,
1209 ("add_bounce_page: bad map %p", map));
1210
1211 bz = dmat->bounce_zone;
1212 if (map->pagesneeded == 0)
1213 panic("add_bounce_page: map doesn't need any pages");
1214 map->pagesneeded--;
1215
1216 if (map->pagesreserved == 0)
1217 panic("add_bounce_page: map doesn't need any pages");
1218 map->pagesreserved--;
1219
1220 mtx_lock(&bounce_lock);
1221 bpage = STAILQ_FIRST(&bz->bounce_page_list);
1222 if (bpage == NULL)
1223 panic("add_bounce_page: free page list is empty");
1224
1225 STAILQ_REMOVE_HEAD(&bz->bounce_page_list, links);
1226 bz->reserved_bpages--;
1227 bz->active_bpages++;
1228 mtx_unlock(&bounce_lock);
1229
1230 if (dmat->common.flags & BUS_DMA_KEEP_PG_OFFSET) {
1231 /* Page offset needs to be preserved. */
1232 bpage->vaddr |= addr1 & PAGE_MASK;
1233 bpage->busaddr |= addr1 & PAGE_MASK;
1234 KASSERT(addr2 == 0,
1235 ("Trying to bounce multiple pages with BUS_DMA_KEEP_PG_OFFSET"));
1236 }
1237 bpage->datavaddr = vaddr;
1238 bpage->datapage[0] = PHYS_TO_VM_PAGE(addr1);
1239 KASSERT((addr2 & PAGE_MASK) == 0, ("Second page is not aligned"));
1240 bpage->datapage[1] = PHYS_TO_VM_PAGE(addr2);
1241 bpage->dataoffs = addr1 & PAGE_MASK;
1242 bpage->datacount = size;
1243 STAILQ_INSERT_TAIL(&(map->bpages), bpage, links);
1244 return (bpage->busaddr);
1245 }
1246
1247 static void
free_bounce_page(bus_dma_tag_t dmat,struct bounce_page * bpage)1248 free_bounce_page(bus_dma_tag_t dmat, struct bounce_page *bpage)
1249 {
1250 struct bus_dmamap *map;
1251 struct bounce_zone *bz;
1252
1253 bz = dmat->bounce_zone;
1254 bpage->datavaddr = 0;
1255 bpage->datacount = 0;
1256 if (dmat->common.flags & BUS_DMA_KEEP_PG_OFFSET) {
1257 /*
1258 * Reset the bounce page to start at offset 0. Other uses
1259 * of this bounce page may need to store a full page of
1260 * data and/or assume it starts on a page boundary.
1261 */
1262 bpage->vaddr &= ~PAGE_MASK;
1263 bpage->busaddr &= ~PAGE_MASK;
1264 }
1265
1266 mtx_lock(&bounce_lock);
1267 STAILQ_INSERT_HEAD(&bz->bounce_page_list, bpage, links);
1268 bz->free_bpages++;
1269 bz->active_bpages--;
1270 if ((map = STAILQ_FIRST(&bounce_map_waitinglist)) != NULL) {
1271 if (reserve_bounce_pages(map->dmat, map, 1) == 0) {
1272 STAILQ_REMOVE_HEAD(&bounce_map_waitinglist, links);
1273 STAILQ_INSERT_TAIL(&bounce_map_callbacklist,
1274 map, links);
1275 busdma_swi_pending = 1;
1276 bz->total_deferred++;
1277 swi_sched(vm_ih, 0);
1278 }
1279 }
1280 mtx_unlock(&bounce_lock);
1281 }
1282
1283 void
busdma_swi(void)1284 busdma_swi(void)
1285 {
1286 bus_dma_tag_t dmat;
1287 struct bus_dmamap *map;
1288
1289 mtx_lock(&bounce_lock);
1290 while ((map = STAILQ_FIRST(&bounce_map_callbacklist)) != NULL) {
1291 STAILQ_REMOVE_HEAD(&bounce_map_callbacklist, links);
1292 mtx_unlock(&bounce_lock);
1293 dmat = map->dmat;
1294 (dmat->common.lockfunc)(dmat->common.lockfuncarg, BUS_DMA_LOCK);
1295 bus_dmamap_load_mem(map->dmat, map, &map->mem,
1296 map->callback, map->callback_arg, BUS_DMA_WAITOK);
1297 (dmat->common.lockfunc)(dmat->common.lockfuncarg,
1298 BUS_DMA_UNLOCK);
1299 mtx_lock(&bounce_lock);
1300 }
1301 mtx_unlock(&bounce_lock);
1302 }
1303
1304 struct bus_dma_impl bus_dma_bounce_impl = {
1305 .tag_create = bounce_bus_dma_tag_create,
1306 .tag_destroy = bounce_bus_dma_tag_destroy,
1307 .tag_set_domain = bounce_bus_dma_tag_set_domain,
1308 .map_create = bounce_bus_dmamap_create,
1309 .map_destroy = bounce_bus_dmamap_destroy,
1310 .mem_alloc = bounce_bus_dmamem_alloc,
1311 .mem_free = bounce_bus_dmamem_free,
1312 .load_phys = bounce_bus_dmamap_load_phys,
1313 .load_buffer = bounce_bus_dmamap_load_buffer,
1314 .load_ma = bounce_bus_dmamap_load_ma,
1315 .map_waitok = bounce_bus_dmamap_waitok,
1316 .map_complete = bounce_bus_dmamap_complete,
1317 .map_unload = bounce_bus_dmamap_unload,
1318 .map_sync = bounce_bus_dmamap_sync,
1319 };
1320