1 /*- 2 * Copyright (c) 2010 Isilon Systems, Inc. 3 * Copyright (c) 2016 Matthew Macy (mmacy@mattmacy.io) 4 * Copyright (c) 2017 Mellanox Technologies, Ltd. 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 unmodified, this list of conditions, and the following 12 * disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 */ 28 29 #include <sys/param.h> 30 #include <sys/systm.h> 31 #include <sys/malloc.h> 32 #include <sys/kernel.h> 33 #include <sys/sysctl.h> 34 #include <sys/lock.h> 35 #include <sys/mutex.h> 36 #include <sys/rwlock.h> 37 #include <sys/proc.h> 38 #include <sys/sched.h> 39 #include <sys/memrange.h> 40 41 #include <machine/bus.h> 42 43 #include <vm/vm.h> 44 #include <vm/pmap.h> 45 #include <vm/vm_param.h> 46 #include <vm/vm_kern.h> 47 #include <vm/vm_object.h> 48 #include <vm/vm_map.h> 49 #include <vm/vm_page.h> 50 #include <vm/vm_pageout.h> 51 #include <vm/vm_pager.h> 52 #include <vm/vm_radix.h> 53 #include <vm/vm_reserv.h> 54 #include <vm/vm_extern.h> 55 56 #include <vm/uma.h> 57 #include <vm/uma_int.h> 58 59 #include <linux/gfp.h> 60 #include <linux/mm.h> 61 #include <linux/preempt.h> 62 #include <linux/fs.h> 63 #include <linux/shmem_fs.h> 64 #include <linux/kernel.h> 65 #include <linux/idr.h> 66 #include <linux/io.h> 67 #include <linux/io-mapping.h> 68 69 #ifdef __i386__ 70 DEFINE_IDR(mtrr_idr); 71 static MALLOC_DEFINE(M_LKMTRR, "idr", "Linux MTRR compat"); 72 extern int pat_works; 73 #endif 74 75 void 76 si_meminfo(struct sysinfo *si) 77 { 78 si->totalram = physmem; 79 si->freeram = vm_free_count(); 80 si->totalhigh = 0; 81 si->freehigh = 0; 82 si->mem_unit = PAGE_SIZE; 83 } 84 85 void * 86 linux_page_address(const struct page *page) 87 { 88 89 if (page->object != kernel_object) { 90 return (PMAP_HAS_DMAP ? PHYS_TO_DMAP(page_to_phys(page)) : 91 NULL); 92 } 93 return ((void *)(uintptr_t)(VM_MIN_KERNEL_ADDRESS + 94 IDX_TO_OFF(page->pindex))); 95 } 96 97 struct page * 98 linux_alloc_pages(gfp_t flags, unsigned int order) 99 { 100 struct page *page; 101 102 if (PMAP_HAS_DMAP) { 103 unsigned long npages = 1UL << order; 104 int req = VM_ALLOC_WIRED; 105 106 if ((flags & M_ZERO) != 0) 107 req |= VM_ALLOC_ZERO; 108 109 if (order == 0 && (flags & GFP_DMA32) == 0) { 110 page = vm_page_alloc_noobj(req); 111 if (page == NULL) 112 return (NULL); 113 } else { 114 vm_paddr_t pmax = (flags & GFP_DMA32) ? 115 BUS_SPACE_MAXADDR_32BIT : BUS_SPACE_MAXADDR; 116 117 if ((flags & __GFP_NORETRY) != 0) 118 req |= VM_ALLOC_NORECLAIM; 119 120 retry: 121 if ((flags & __GFP_THISNODE) != 0) { 122 int curdomain = PCPU_GET(domain); 123 page = vm_page_alloc_noobj_contig_domain( 124 curdomain, req, npages, 0, pmax, 125 PAGE_SIZE, 0, VM_MEMATTR_DEFAULT); 126 } else { 127 page = vm_page_alloc_noobj_contig( 128 req, npages, 0, pmax, 129 PAGE_SIZE, 0, VM_MEMATTR_DEFAULT); 130 } 131 132 if (page == NULL) { 133 if ((flags & (M_WAITOK | __GFP_NORETRY | __GFP_THISNODE)) == 134 M_WAITOK) { 135 int err = vm_page_reclaim_contig(req, 136 npages, 0, pmax, PAGE_SIZE, 0); 137 if (err == ENOMEM) 138 vm_wait(NULL); 139 else if (err != 0) 140 return (NULL); 141 flags &= ~M_WAITOK; 142 goto retry; 143 } 144 return (NULL); 145 } 146 } 147 } else { 148 vm_offset_t vaddr; 149 150 vaddr = linux_alloc_kmem(flags, order); 151 if (vaddr == 0) 152 return (NULL); 153 154 page = virt_to_page((void *)vaddr); 155 156 KASSERT(vaddr == (vm_offset_t)page_address(page), 157 ("Page address mismatch")); 158 } 159 160 return (page); 161 } 162 163 static void 164 _linux_free_kmem(vm_offset_t addr, unsigned int order) 165 { 166 size_t size = ((size_t)PAGE_SIZE) << order; 167 168 kmem_free((void *)addr, size); 169 } 170 171 void 172 linux_free_pages(struct page *page, unsigned int order) 173 { 174 if (PMAP_HAS_DMAP) { 175 unsigned long npages = 1UL << order; 176 unsigned long x; 177 178 for (x = 0; x != npages; x++) { 179 vm_page_t pgo = page + x; 180 181 /* 182 * The "free page" function is used in several 183 * contexts. 184 * 185 * Some pages are allocated by `linux_alloc_pages()` 186 * above, but not all of them are. For instance in the 187 * DRM drivers, some pages come from 188 * `shmem_read_mapping_page_gfp()`. 189 * 190 * That's why we need to check if the page is managed 191 * or not here. 192 */ 193 if ((pgo->oflags & VPO_UNMANAGED) == 0) { 194 vm_page_unwire(pgo, PQ_ACTIVE); 195 } else { 196 if (vm_page_unwire_noq(pgo)) 197 vm_page_free(pgo); 198 } 199 } 200 } else { 201 vm_offset_t vaddr; 202 203 vaddr = (vm_offset_t)page_address(page); 204 205 _linux_free_kmem(vaddr, order); 206 } 207 } 208 209 void 210 linux_release_pages(release_pages_arg arg, int nr) 211 { 212 int i; 213 214 CTASSERT(offsetof(struct folio, page) == 0); 215 216 for (i = 0; i < nr; i++) 217 __free_page(arg.pages[i]); 218 } 219 220 vm_offset_t 221 linux_alloc_kmem(gfp_t flags, unsigned int order) 222 { 223 size_t size = ((size_t)PAGE_SIZE) << order; 224 void *addr; 225 226 addr = kmem_alloc_contig(size, flags & GFP_NATIVE_MASK, 0, 227 ((flags & GFP_DMA32) == 0) ? -1UL : BUS_SPACE_MAXADDR_32BIT, 228 PAGE_SIZE, 0, VM_MEMATTR_DEFAULT); 229 230 return ((vm_offset_t)addr); 231 } 232 233 void 234 linux_free_kmem(vm_offset_t addr, unsigned int order) 235 { 236 KASSERT((addr & ~PAGE_MASK) == 0, 237 ("%s: addr %p is not page aligned", __func__, (void *)addr)); 238 239 if (addr >= VM_MIN_KERNEL_ADDRESS && addr < VM_MAX_KERNEL_ADDRESS) { 240 _linux_free_kmem(addr, order); 241 } else { 242 vm_page_t page; 243 244 page = DMAP_TO_VM_PAGE(addr); 245 linux_free_pages(page, order); 246 } 247 } 248 249 static int 250 linux_get_user_pages_internal(vm_map_t map, unsigned long start, int nr_pages, 251 int write, struct page **pages) 252 { 253 vm_prot_t prot; 254 size_t len; 255 int count; 256 257 prot = write ? (VM_PROT_READ | VM_PROT_WRITE) : VM_PROT_READ; 258 len = ptoa((vm_offset_t)nr_pages); 259 count = vm_fault_quick_hold_pages(map, start, len, prot, pages, nr_pages); 260 return (count == -1 ? -EFAULT : nr_pages); 261 } 262 263 int 264 __get_user_pages_fast(unsigned long start, int nr_pages, int write, 265 struct page **pages) 266 { 267 vm_map_t map; 268 vm_page_t *mp; 269 vm_offset_t va; 270 vm_offset_t end; 271 vm_prot_t prot; 272 int count; 273 274 if (nr_pages == 0 || in_interrupt()) 275 return (0); 276 277 MPASS(pages != NULL); 278 map = &curthread->td_proc->p_vmspace->vm_map; 279 end = start + ptoa((vm_offset_t)nr_pages); 280 if (!vm_map_range_valid(map, start, end)) 281 return (-EINVAL); 282 prot = write ? (VM_PROT_READ | VM_PROT_WRITE) : VM_PROT_READ; 283 for (count = 0, mp = pages, va = start; va < end; 284 mp++, va += PAGE_SIZE, count++) { 285 *mp = pmap_extract_and_hold(map->pmap, va, prot); 286 if (*mp == NULL) 287 break; 288 289 if ((prot & VM_PROT_WRITE) != 0 && 290 (*mp)->dirty != VM_PAGE_BITS_ALL) { 291 /* 292 * Explicitly dirty the physical page. Otherwise, the 293 * caller's changes may go unnoticed because they are 294 * performed through an unmanaged mapping or by a DMA 295 * operation. 296 * 297 * The object lock is not held here. 298 * See vm_page_clear_dirty_mask(). 299 */ 300 vm_page_dirty(*mp); 301 } 302 } 303 return (count); 304 } 305 306 long 307 get_user_pages_remote(struct task_struct *task, struct mm_struct *mm, 308 unsigned long start, unsigned long nr_pages, unsigned int gup_flags, 309 struct page **pages, struct vm_area_struct **vmas) 310 { 311 vm_map_t map; 312 313 map = &task->task_thread->td_proc->p_vmspace->vm_map; 314 return (linux_get_user_pages_internal(map, start, nr_pages, 315 !!(gup_flags & FOLL_WRITE), pages)); 316 } 317 318 long 319 lkpi_get_user_pages(unsigned long start, unsigned long nr_pages, 320 unsigned int gup_flags, struct page **pages) 321 { 322 vm_map_t map; 323 324 map = &curthread->td_proc->p_vmspace->vm_map; 325 return (linux_get_user_pages_internal(map, start, nr_pages, 326 !!(gup_flags & FOLL_WRITE), pages)); 327 } 328 329 /* 330 * Hash of vmmap addresses. This is infrequently accessed and does not 331 * need to be particularly large. This is done because we must store the 332 * caller's idea of the map size to properly unmap. 333 */ 334 struct vmmap { 335 LIST_ENTRY(vmmap) vm_next; 336 void *vm_addr; 337 unsigned long vm_size; 338 }; 339 340 struct vmmaphd { 341 struct vmmap *lh_first; 342 }; 343 #define VMMAP_HASH_SIZE 64 344 #define VMMAP_HASH_MASK (VMMAP_HASH_SIZE - 1) 345 #define VM_HASH(addr) ((uintptr_t)(addr) >> PAGE_SHIFT) & VMMAP_HASH_MASK 346 static struct vmmaphd vmmaphead[VMMAP_HASH_SIZE]; 347 static struct mtx vmmaplock; 348 349 int 350 is_vmalloc_addr(const void *addr) 351 { 352 struct vmmap *vmmap; 353 354 mtx_lock(&vmmaplock); 355 LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next) 356 if (addr == vmmap->vm_addr) 357 break; 358 mtx_unlock(&vmmaplock); 359 if (vmmap != NULL) 360 return (1); 361 362 return (vtoslab((vm_offset_t)addr & ~UMA_SLAB_MASK) != NULL); 363 } 364 365 static void 366 vmmap_add(void *addr, unsigned long size) 367 { 368 struct vmmap *vmmap; 369 370 vmmap = kmalloc(sizeof(*vmmap), GFP_KERNEL); 371 mtx_lock(&vmmaplock); 372 vmmap->vm_size = size; 373 vmmap->vm_addr = addr; 374 LIST_INSERT_HEAD(&vmmaphead[VM_HASH(addr)], vmmap, vm_next); 375 mtx_unlock(&vmmaplock); 376 } 377 378 static struct vmmap * 379 vmmap_remove(void *addr) 380 { 381 struct vmmap *vmmap; 382 383 mtx_lock(&vmmaplock); 384 LIST_FOREACH(vmmap, &vmmaphead[VM_HASH(addr)], vm_next) 385 if (vmmap->vm_addr == addr) 386 break; 387 if (vmmap) 388 LIST_REMOVE(vmmap, vm_next); 389 mtx_unlock(&vmmaplock); 390 391 return (vmmap); 392 } 393 394 #if defined(__i386__) || defined(__amd64__) || defined(__powerpc__) || defined(__aarch64__) || defined(__riscv) 395 void * 396 _ioremap_attr(vm_paddr_t phys_addr, unsigned long size, int attr) 397 { 398 void *addr; 399 400 addr = pmap_mapdev_attr(phys_addr, size, attr); 401 if (addr == NULL) 402 return (NULL); 403 vmmap_add(addr, size); 404 405 return (addr); 406 } 407 #endif 408 409 void 410 iounmap(void *addr) 411 { 412 struct vmmap *vmmap; 413 414 vmmap = vmmap_remove(addr); 415 if (vmmap == NULL) 416 return; 417 #if defined(__i386__) || defined(__amd64__) || defined(__powerpc__) || defined(__aarch64__) || defined(__riscv) 418 pmap_unmapdev(addr, vmmap->vm_size); 419 #endif 420 kfree(vmmap); 421 } 422 423 void * 424 vmap(struct page **pages, unsigned int count, unsigned long flags, int prot) 425 { 426 void *off; 427 size_t size; 428 429 size = count * PAGE_SIZE; 430 off = kva_alloc(size); 431 if (off == NULL) 432 return (NULL); 433 vmmap_add(off, size); 434 pmap_qenter(off, pages, count); 435 436 return (off); 437 } 438 439 #define VMAP_MAX_CHUNK_SIZE (65536U / sizeof(struct vm_page)) /* KMEM_ZMAX */ 440 441 void * 442 linuxkpi_vmap_pfn(unsigned long *pfns, unsigned int count, int prot) 443 { 444 vm_page_t m, *ma, fma; 445 void *off; 446 char *coff; 447 vm_paddr_t pa; 448 vm_memattr_t attr; 449 size_t size; 450 unsigned int i, c, chunk; 451 452 size = ptoa(count); 453 off = kva_alloc(size); 454 if (off == NULL) 455 return (NULL); 456 vmmap_add(off, size); 457 458 chunk = MIN(count, VMAP_MAX_CHUNK_SIZE); 459 attr = pgprot2cachemode(prot); 460 ma = malloc(chunk * sizeof(vm_page_t), M_TEMP, M_WAITOK | M_ZERO); 461 fma = NULL; 462 c = 0; 463 coff = off; 464 for (i = 0; i < count; i++) { 465 pa = IDX_TO_OFF(pfns[i]); 466 m = PHYS_TO_VM_PAGE(pa); 467 if (m == NULL) { 468 if (fma == NULL) 469 fma = malloc(chunk * sizeof(struct vm_page), 470 M_TEMP, M_WAITOK | M_ZERO); 471 m = fma + c; 472 vm_page_initfake(m, pa, attr); 473 } else { 474 pmap_page_set_memattr(m, attr); 475 } 476 ma[c] = m; 477 c++; 478 if (c == chunk || i == count - 1) { 479 pmap_qenter(coff, ma, c); 480 if (i == count - 1) 481 break; 482 coff += ptoa(c); 483 c = 0; 484 memset(ma, 0, chunk * sizeof(vm_page_t)); 485 if (fma != NULL) 486 memset(fma, 0, chunk * sizeof(struct vm_page)); 487 } 488 } 489 free(fma, M_TEMP); 490 free(ma, M_TEMP); 491 492 return (off); 493 } 494 495 void 496 vunmap(void *addr) 497 { 498 struct vmmap *vmmap; 499 500 vmmap = vmmap_remove(addr); 501 if (vmmap == NULL) 502 return; 503 pmap_qremove(addr, vmmap->vm_size / PAGE_SIZE); 504 kva_free(addr, vmmap->vm_size); 505 kfree(vmmap); 506 } 507 508 vm_fault_t 509 lkpi_vmf_insert_pfn_prot_locked(struct vm_area_struct *vma, unsigned long addr, 510 unsigned long pfn, pgprot_t prot) 511 { 512 struct pctrie_iter pages; 513 vm_object_t vm_obj = vma->vm_obj; 514 vm_object_t tmp_obj; 515 vm_page_t page; 516 vm_pindex_t pindex; 517 518 if (addr < vma->vm_start || addr >= vma->vm_end) 519 return (VM_FAULT_SIGBUS); 520 521 VM_OBJECT_ASSERT_WLOCKED(vm_obj); 522 vm_page_iter_init(&pages, vm_obj); 523 pindex = OFF_TO_IDX(addr - vma->vm_start); 524 if (vma->vm_pfn_count == 0) 525 vma->vm_pfn_first = pindex; 526 MPASS(pindex < OFF_TO_IDX(vma->vm_end)); 527 528 retry: 529 page = vm_page_grab_iter(vm_obj, pindex, VM_ALLOC_NOCREAT, &pages); 530 if (page == NULL) { 531 page = PHYS_TO_VM_PAGE(IDX_TO_OFF(pfn)); 532 if (page == NULL) 533 return (VM_FAULT_SIGBUS); 534 if (!vm_page_busy_acquire(page, VM_ALLOC_WAITFAIL)) { 535 pctrie_iter_reset(&pages); 536 goto retry; 537 } 538 if (page->object != NULL) { 539 tmp_obj = page->object; 540 vm_page_xunbusy(page); 541 VM_OBJECT_WUNLOCK(vm_obj); 542 VM_OBJECT_WLOCK(tmp_obj); 543 if (page->object == tmp_obj && 544 vm_page_busy_acquire(page, VM_ALLOC_WAITFAIL)) { 545 KASSERT(page->object == tmp_obj, 546 ("page has changed identity")); 547 KASSERT((page->oflags & VPO_UNMANAGED) == 0, 548 ("page does not belong to shmem")); 549 vm_pager_page_unswapped(page); 550 if (pmap_page_is_mapped(page)) { 551 vm_page_xunbusy(page); 552 VM_OBJECT_WUNLOCK(tmp_obj); 553 printf("%s: page rename failed: page " 554 "is mapped\n", __func__); 555 VM_OBJECT_WLOCK(vm_obj); 556 return (VM_FAULT_NOPAGE); 557 } 558 vm_page_remove(page); 559 } 560 VM_OBJECT_WUNLOCK(tmp_obj); 561 pctrie_iter_reset(&pages); 562 VM_OBJECT_WLOCK(vm_obj); 563 goto retry; 564 } 565 if (vm_page_iter_insert(page, vm_obj, pindex, &pages) != 0) { 566 vm_page_xunbusy(page); 567 return (VM_FAULT_OOM); 568 } 569 vm_page_valid(page); 570 } 571 pmap_page_set_memattr(page, pgprot2cachemode(prot)); 572 vma->vm_pfn_count++; 573 574 return (VM_FAULT_NOPAGE); 575 } 576 577 int 578 lkpi_remap_pfn_range(struct vm_area_struct *vma, unsigned long start_addr, 579 unsigned long start_pfn, unsigned long size, pgprot_t prot) 580 { 581 vm_object_t vm_obj; 582 unsigned long addr, pfn; 583 int err = 0; 584 585 vm_obj = vma->vm_obj; 586 587 VM_OBJECT_WLOCK(vm_obj); 588 for (addr = start_addr, pfn = start_pfn; 589 addr < start_addr + size; 590 addr += PAGE_SIZE) { 591 vm_fault_t ret; 592 retry: 593 ret = lkpi_vmf_insert_pfn_prot_locked(vma, addr, pfn, prot); 594 595 if ((ret & VM_FAULT_OOM) != 0) { 596 VM_OBJECT_WUNLOCK(vm_obj); 597 vm_wait(NULL); 598 VM_OBJECT_WLOCK(vm_obj); 599 goto retry; 600 } 601 602 if ((ret & VM_FAULT_ERROR) != 0) { 603 err = -EFAULT; 604 break; 605 } 606 607 pfn++; 608 } 609 VM_OBJECT_WUNLOCK(vm_obj); 610 611 if (unlikely(err)) { 612 zap_vma_ptes(vma, start_addr, 613 (pfn - start_pfn) << PAGE_SHIFT); 614 return (err); 615 } 616 617 return (0); 618 } 619 620 int 621 lkpi_io_mapping_map_user(struct io_mapping *iomap, 622 struct vm_area_struct *vma, unsigned long addr, 623 unsigned long pfn, unsigned long size) 624 { 625 pgprot_t prot; 626 int ret; 627 628 prot = cachemode2protval(iomap->attr); 629 ret = lkpi_remap_pfn_range(vma, addr, pfn, size, prot); 630 631 return (ret); 632 } 633 634 /* 635 * Although FreeBSD version of unmap_mapping_range has semantics and types of 636 * parameters compatible with Linux version, the values passed in are different 637 * @obj should match to vm_private_data field of vm_area_struct returned by 638 * mmap file operation handler, see linux_file_mmap_single() sources 639 * @holelen should match to size of area to be munmapped. 640 */ 641 void 642 lkpi_unmap_mapping_range(void *obj, loff_t const holebegin __unused, 643 loff_t const holelen __unused, int even_cows __unused) 644 { 645 vm_object_t devobj; 646 647 devobj = cdev_pager_lookup(obj); 648 if (devobj != NULL) { 649 cdev_mgtdev_pager_free_pages(devobj); 650 vm_object_deallocate(devobj); 651 } 652 } 653 654 int 655 lkpi_arch_phys_wc_add(unsigned long base, unsigned long size) 656 { 657 #ifdef __i386__ 658 struct mem_range_desc *mrdesc; 659 int error, id, act; 660 661 /* If PAT is available, do nothing */ 662 if (pat_works) 663 return (0); 664 665 mrdesc = malloc(sizeof(*mrdesc), M_LKMTRR, M_WAITOK); 666 mrdesc->mr_base = base; 667 mrdesc->mr_len = size; 668 mrdesc->mr_flags = MDF_WRITECOMBINE; 669 strlcpy(mrdesc->mr_owner, "drm", sizeof(mrdesc->mr_owner)); 670 act = MEMRANGE_SET_UPDATE; 671 error = mem_range_attr_set(mrdesc, &act); 672 if (error == 0) { 673 error = idr_get_new(&mtrr_idr, mrdesc, &id); 674 MPASS(idr_find(&mtrr_idr, id) == mrdesc); 675 if (error != 0) { 676 act = MEMRANGE_SET_REMOVE; 677 mem_range_attr_set(mrdesc, &act); 678 } 679 } 680 if (error != 0) { 681 free(mrdesc, M_LKMTRR); 682 pr_warn( 683 "Failed to add WC MTRR for [%p-%p]: %d; " 684 "performance may suffer\n", 685 (void *)base, (void *)(base + size - 1), error); 686 } else 687 pr_warn("Successfully added WC MTRR for [%p-%p]\n", 688 (void *)base, (void *)(base + size - 1)); 689 690 return (error != 0 ? -error : id + __MTRR_ID_BASE); 691 #else 692 return (0); 693 #endif 694 } 695 696 void 697 lkpi_arch_phys_wc_del(int reg) 698 { 699 #ifdef __i386__ 700 struct mem_range_desc *mrdesc; 701 int act; 702 703 /* Check if arch_phys_wc_add() failed. */ 704 if (reg < __MTRR_ID_BASE) 705 return; 706 707 mrdesc = idr_find(&mtrr_idr, reg - __MTRR_ID_BASE); 708 MPASS(mrdesc != NULL); 709 idr_remove(&mtrr_idr, reg - __MTRR_ID_BASE); 710 act = MEMRANGE_SET_REMOVE; 711 mem_range_attr_set(mrdesc, &act); 712 free(mrdesc, M_LKMTRR); 713 #endif 714 } 715 716 int 717 lkpi_set_pages_attr(struct page *page, int numpages, vm_memattr_t ma) 718 { 719 while (numpages-- > 0) { 720 /* 721 * pmap_page_set_memattr() would only update the DMAP mapping 722 * if it's a normal page, leaving the kernel map untouched. 723 */ 724 MPASS(page->object != kernel_object); 725 726 /* 727 * pmap_page_set_memattr() sets page->md.pat_mode, which is 728 * crucial for future userspace mappings. 729 */ 730 pmap_page_set_memattr(page, ma); 731 page++; 732 } 733 734 return (0); 735 } 736 737 /* 738 * This is a highly simplified version of the Linux page_frag_cache. 739 * We only support up-to 1 single page as fragment size and we will 740 * always return a full page. This may be wasteful on small objects 741 * but the only known consumer (mt76) is either asking for a half-page 742 * or a full page. If this was to become a problem we can implement 743 * a more elaborate version. 744 */ 745 void * 746 linuxkpi_page_frag_alloc(struct page_frag_cache *pfc, 747 size_t fragsz, gfp_t gfp) 748 { 749 struct page *pages; 750 751 if (fragsz == 0) 752 return (NULL); 753 754 KASSERT(fragsz <= PAGE_SIZE, ("%s: fragsz %zu > PAGE_SIZE not yet " 755 "supported", __func__, fragsz)); 756 757 pages = alloc_pages(gfp, flsl(howmany(fragsz, PAGE_SIZE) - 1)); 758 if (pages == NULL) 759 return (NULL); 760 pfc->va = linux_page_address(pages); 761 762 /* Passed in as "count" to __page_frag_cache_drain(). Unused by us. */ 763 pfc->pagecnt_bias = 0; 764 765 return (pfc->va); 766 } 767 768 void 769 linuxkpi_page_frag_free(void *addr) 770 { 771 struct page *page; 772 773 page = virt_to_page(addr); 774 linux_free_pages(page, 0); 775 } 776 777 void 778 linuxkpi__page_frag_cache_drain(struct page *page, size_t count __unused) 779 { 780 781 linux_free_pages(page, 0); 782 } 783 784 static void 785 lkpi_page_init(void *arg) 786 { 787 int i; 788 789 mtx_init(&vmmaplock, "IO Map lock", NULL, MTX_DEF); 790 for (i = 0; i < VMMAP_HASH_SIZE; i++) 791 LIST_INIT(&vmmaphead[i]); 792 } 793 SYSINIT(lkpi_page, SI_SUB_DRIVERS, SI_ORDER_SECOND, lkpi_page_init, NULL); 794 795 static void 796 lkpi_page_uninit(void *arg) 797 { 798 mtx_destroy(&vmmaplock); 799 } 800 SYSUNINIT(lkpi_page, SI_SUB_DRIVERS, SI_ORDER_SECOND, lkpi_page_uninit, NULL); 801