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