1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/atomic.h>
18#include <linux/blkdev.h>
19#include <linux/buffer_head.h>
20#include <linux/dax.h>
21#include <linux/fs.h>
22#include <linux/genhd.h>
23#include <linux/highmem.h>
24#include <linux/memcontrol.h>
25#include <linux/mm.h>
26#include <linux/mutex.h>
27#include <linux/pagevec.h>
28#include <linux/pmem.h>
29#include <linux/sched.h>
30#include <linux/uio.h>
31#include <linux/vmstat.h>
32#include <linux/pfn_t.h>
33#include <linux/sizes.h>
34
35static long dax_map_atomic(struct block_device *bdev, struct blk_dax_ctl *dax)
36{
37 struct request_queue *q = bdev->bd_queue;
38 long rc = -EIO;
39
40 dax->addr = (void __pmem *) ERR_PTR(-EIO);
41 if (blk_queue_enter(q, true) != 0)
42 return rc;
43
44 rc = bdev_direct_access(bdev, dax);
45 if (rc < 0) {
46 dax->addr = (void __pmem *) ERR_PTR(rc);
47 blk_queue_exit(q);
48 return rc;
49 }
50 return rc;
51}
52
53static void dax_unmap_atomic(struct block_device *bdev,
54 const struct blk_dax_ctl *dax)
55{
56 if (IS_ERR(dax->addr))
57 return;
58 blk_queue_exit(bdev->bd_queue);
59}
60
61struct page *read_dax_sector(struct block_device *bdev, sector_t n)
62{
63 struct page *page = alloc_pages(GFP_KERNEL, 0);
64 struct blk_dax_ctl dax = {
65 .size = PAGE_SIZE,
66 .sector = n & ~((((int) PAGE_SIZE) / 512) - 1),
67 };
68 long rc;
69
70 if (!page)
71 return ERR_PTR(-ENOMEM);
72
73 rc = dax_map_atomic(bdev, &dax);
74 if (rc < 0)
75 return ERR_PTR(rc);
76 memcpy_from_pmem(page_address(page), dax.addr, PAGE_SIZE);
77 dax_unmap_atomic(bdev, &dax);
78 return page;
79}
80
81
82
83
84
85
86int dax_clear_sectors(struct block_device *bdev, sector_t _sector, long _size)
87{
88 struct blk_dax_ctl dax = {
89 .sector = _sector,
90 .size = _size,
91 };
92
93 might_sleep();
94 do {
95 long count, sz;
96
97 count = dax_map_atomic(bdev, &dax);
98 if (count < 0)
99 return count;
100 sz = min_t(long, count, SZ_128K);
101 clear_pmem(dax.addr, sz);
102 dax.size -= sz;
103 dax.sector += sz / 512;
104 dax_unmap_atomic(bdev, &dax);
105 cond_resched();
106 } while (dax.size);
107
108 wmb_pmem();
109 return 0;
110}
111EXPORT_SYMBOL_GPL(dax_clear_sectors);
112
113
114static void dax_new_buf(void __pmem *addr, unsigned size, unsigned first,
115 loff_t pos, loff_t end)
116{
117 loff_t final = end - pos + first;
118
119 if (first > 0)
120 clear_pmem(addr, first);
121 if (final < size)
122 clear_pmem(addr + final, size - final);
123}
124
125static bool buffer_written(struct buffer_head *bh)
126{
127 return buffer_mapped(bh) && !buffer_unwritten(bh);
128}
129
130
131
132
133
134
135
136
137static bool buffer_size_valid(struct buffer_head *bh)
138{
139 return bh->b_state != 0;
140}
141
142
143static sector_t to_sector(const struct buffer_head *bh,
144 const struct inode *inode)
145{
146 sector_t sector = bh->b_blocknr << (inode->i_blkbits - 9);
147
148 return sector;
149}
150
151static ssize_t dax_io(struct inode *inode, struct iov_iter *iter,
152 loff_t start, loff_t end, get_block_t get_block,
153 struct buffer_head *bh)
154{
155 loff_t pos = start, max = start, bh_max = start;
156 bool hole = false, need_wmb = false;
157 struct block_device *bdev = NULL;
158 int rw = iov_iter_rw(iter), rc;
159 long map_len = 0;
160 struct blk_dax_ctl dax = {
161 .addr = (void __pmem *) ERR_PTR(-EIO),
162 };
163
164 if (rw == READ)
165 end = min(end, i_size_read(inode));
166
167 while (pos < end) {
168 size_t len;
169 if (pos == max) {
170 unsigned blkbits = inode->i_blkbits;
171 long page = pos >> PAGE_SHIFT;
172 sector_t block = page << (PAGE_SHIFT - blkbits);
173 unsigned first = pos - (block << blkbits);
174 long size;
175
176 if (pos == bh_max) {
177 bh->b_size = PAGE_ALIGN(end - pos);
178 bh->b_state = 0;
179 rc = get_block(inode, block, bh, rw == WRITE);
180 if (rc)
181 break;
182 if (!buffer_size_valid(bh))
183 bh->b_size = 1 << blkbits;
184 bh_max = pos - first + bh->b_size;
185 bdev = bh->b_bdev;
186 } else {
187 unsigned done = bh->b_size -
188 (bh_max - (pos - first));
189 bh->b_blocknr += done >> blkbits;
190 bh->b_size -= done;
191 }
192
193 hole = rw == READ && !buffer_written(bh);
194 if (hole) {
195 size = bh->b_size - first;
196 } else {
197 dax_unmap_atomic(bdev, &dax);
198 dax.sector = to_sector(bh, inode);
199 dax.size = bh->b_size;
200 map_len = dax_map_atomic(bdev, &dax);
201 if (map_len < 0) {
202 rc = map_len;
203 break;
204 }
205 if (buffer_unwritten(bh) || buffer_new(bh)) {
206 dax_new_buf(dax.addr, map_len, first,
207 pos, end);
208 need_wmb = true;
209 }
210 dax.addr += first;
211 size = map_len - first;
212 }
213 max = min(pos + size, end);
214 }
215
216 if (iov_iter_rw(iter) == WRITE) {
217 len = copy_from_iter_pmem(dax.addr, max - pos, iter);
218 need_wmb = true;
219 } else if (!hole)
220 len = copy_to_iter((void __force *) dax.addr, max - pos,
221 iter);
222 else
223 len = iov_iter_zero(max - pos, iter);
224
225 if (!len) {
226 rc = -EFAULT;
227 break;
228 }
229
230 pos += len;
231 if (!IS_ERR(dax.addr))
232 dax.addr += len;
233 }
234
235 if (need_wmb)
236 wmb_pmem();
237 dax_unmap_atomic(bdev, &dax);
238
239 return (pos == start) ? rc : pos - start;
240}
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259ssize_t dax_do_io(struct kiocb *iocb, struct inode *inode,
260 struct iov_iter *iter, loff_t pos, get_block_t get_block,
261 dio_iodone_t end_io, int flags)
262{
263 struct buffer_head bh;
264 ssize_t retval = -EINVAL;
265 loff_t end = pos + iov_iter_count(iter);
266
267 memset(&bh, 0, sizeof(bh));
268 bh.b_bdev = inode->i_sb->s_bdev;
269
270 if ((flags & DIO_LOCKING) && iov_iter_rw(iter) == READ) {
271 struct address_space *mapping = inode->i_mapping;
272 inode_lock(inode);
273 retval = filemap_write_and_wait_range(mapping, pos, end - 1);
274 if (retval) {
275 inode_unlock(inode);
276 goto out;
277 }
278 }
279
280
281 if (!(flags & DIO_SKIP_DIO_COUNT))
282 inode_dio_begin(inode);
283
284 retval = dax_io(inode, iter, pos, end, get_block, &bh);
285
286 if ((flags & DIO_LOCKING) && iov_iter_rw(iter) == READ)
287 inode_unlock(inode);
288
289 if (end_io) {
290 int err;
291
292 err = end_io(iocb, pos, retval, bh.b_private);
293 if (err)
294 retval = err;
295 }
296
297 if (!(flags & DIO_SKIP_DIO_COUNT))
298 inode_dio_end(inode);
299 out:
300 return retval;
301}
302EXPORT_SYMBOL_GPL(dax_do_io);
303
304
305
306
307
308
309
310
311
312static int dax_load_hole(struct address_space *mapping, struct page *page,
313 struct vm_fault *vmf)
314{
315 unsigned long size;
316 struct inode *inode = mapping->host;
317 if (!page)
318 page = find_or_create_page(mapping, vmf->pgoff,
319 GFP_KERNEL | __GFP_ZERO);
320 if (!page)
321 return VM_FAULT_OOM;
322
323 size = (i_size_read(inode) + PAGE_SIZE - 1) >> PAGE_SHIFT;
324 if (vmf->pgoff >= size) {
325 unlock_page(page);
326 put_page(page);
327 return VM_FAULT_SIGBUS;
328 }
329
330 vmf->page = page;
331 return VM_FAULT_LOCKED;
332}
333
334static int copy_user_bh(struct page *to, struct inode *inode,
335 struct buffer_head *bh, unsigned long vaddr)
336{
337 struct blk_dax_ctl dax = {
338 .sector = to_sector(bh, inode),
339 .size = bh->b_size,
340 };
341 struct block_device *bdev = bh->b_bdev;
342 void *vto;
343
344 if (dax_map_atomic(bdev, &dax) < 0)
345 return PTR_ERR(dax.addr);
346 vto = kmap_atomic(to);
347 copy_user_page(vto, (void __force *)dax.addr, vaddr, to);
348 kunmap_atomic(vto);
349 dax_unmap_atomic(bdev, &dax);
350 return 0;
351}
352
353#define NO_SECTOR -1
354#define DAX_PMD_INDEX(page_index) (page_index & (PMD_MASK >> PAGE_SHIFT))
355
356static int dax_radix_entry(struct address_space *mapping, pgoff_t index,
357 sector_t sector, bool pmd_entry, bool dirty)
358{
359 struct radix_tree_root *page_tree = &mapping->page_tree;
360 pgoff_t pmd_index = DAX_PMD_INDEX(index);
361 int type, error = 0;
362 void *entry;
363
364 WARN_ON_ONCE(pmd_entry && !dirty);
365 if (dirty)
366 __mark_inode_dirty(mapping->host, I_DIRTY_PAGES);
367
368 spin_lock_irq(&mapping->tree_lock);
369
370 entry = radix_tree_lookup(page_tree, pmd_index);
371 if (entry && RADIX_DAX_TYPE(entry) == RADIX_DAX_PMD) {
372 index = pmd_index;
373 goto dirty;
374 }
375
376 entry = radix_tree_lookup(page_tree, index);
377 if (entry) {
378 type = RADIX_DAX_TYPE(entry);
379 if (WARN_ON_ONCE(type != RADIX_DAX_PTE &&
380 type != RADIX_DAX_PMD)) {
381 error = -EIO;
382 goto unlock;
383 }
384
385 if (!pmd_entry || type == RADIX_DAX_PMD)
386 goto dirty;
387
388
389
390
391
392
393
394 radix_tree_delete(&mapping->page_tree, index);
395 mapping->nrexceptional--;
396 }
397
398 if (sector == NO_SECTOR) {
399
400
401
402
403
404
405
406
407
408
409 goto unlock;
410 }
411
412 error = radix_tree_insert(page_tree, index,
413 RADIX_DAX_ENTRY(sector, pmd_entry));
414 if (error)
415 goto unlock;
416
417 mapping->nrexceptional++;
418 dirty:
419 if (dirty)
420 radix_tree_tag_set(page_tree, index, PAGECACHE_TAG_DIRTY);
421 unlock:
422 spin_unlock_irq(&mapping->tree_lock);
423 return error;
424}
425
426static int dax_writeback_one(struct block_device *bdev,
427 struct address_space *mapping, pgoff_t index, void *entry)
428{
429 struct radix_tree_root *page_tree = &mapping->page_tree;
430 int type = RADIX_DAX_TYPE(entry);
431 struct radix_tree_node *node;
432 struct blk_dax_ctl dax;
433 void **slot;
434 int ret = 0;
435
436 spin_lock_irq(&mapping->tree_lock);
437
438
439
440
441
442 if (!__radix_tree_lookup(page_tree, index, &node, &slot))
443 goto unlock;
444 if (*slot != entry)
445 goto unlock;
446
447
448 if (!radix_tree_tag_get(page_tree, index, PAGECACHE_TAG_TOWRITE))
449 goto unlock;
450
451 if (WARN_ON_ONCE(type != RADIX_DAX_PTE && type != RADIX_DAX_PMD)) {
452 ret = -EIO;
453 goto unlock;
454 }
455
456 dax.sector = RADIX_DAX_SECTOR(entry);
457 dax.size = (type == RADIX_DAX_PMD ? PMD_SIZE : PAGE_SIZE);
458 spin_unlock_irq(&mapping->tree_lock);
459
460
461
462
463
464 ret = dax_map_atomic(bdev, &dax);
465 if (ret < 0)
466 return ret;
467
468 if (WARN_ON_ONCE(ret < dax.size)) {
469 ret = -EIO;
470 goto unmap;
471 }
472
473 wb_cache_pmem(dax.addr, dax.size);
474
475 spin_lock_irq(&mapping->tree_lock);
476 radix_tree_tag_clear(page_tree, index, PAGECACHE_TAG_TOWRITE);
477 spin_unlock_irq(&mapping->tree_lock);
478 unmap:
479 dax_unmap_atomic(bdev, &dax);
480 return ret;
481
482 unlock:
483 spin_unlock_irq(&mapping->tree_lock);
484 return ret;
485}
486
487
488
489
490
491
492int dax_writeback_mapping_range(struct address_space *mapping,
493 struct block_device *bdev, struct writeback_control *wbc)
494{
495 struct inode *inode = mapping->host;
496 pgoff_t start_index, end_index, pmd_index;
497 pgoff_t indices[PAGEVEC_SIZE];
498 struct pagevec pvec;
499 bool done = false;
500 int i, ret = 0;
501 void *entry;
502
503 if (WARN_ON_ONCE(inode->i_blkbits != PAGE_SHIFT))
504 return -EIO;
505
506 if (!mapping->nrexceptional || wbc->sync_mode != WB_SYNC_ALL)
507 return 0;
508
509 start_index = wbc->range_start >> PAGE_SHIFT;
510 end_index = wbc->range_end >> PAGE_SHIFT;
511 pmd_index = DAX_PMD_INDEX(start_index);
512
513 rcu_read_lock();
514 entry = radix_tree_lookup(&mapping->page_tree, pmd_index);
515 rcu_read_unlock();
516
517
518 if (entry && RADIX_DAX_TYPE(entry) == RADIX_DAX_PMD)
519 start_index = pmd_index;
520
521 tag_pages_for_writeback(mapping, start_index, end_index);
522
523 pagevec_init(&pvec, 0);
524 while (!done) {
525 pvec.nr = find_get_entries_tag(mapping, start_index,
526 PAGECACHE_TAG_TOWRITE, PAGEVEC_SIZE,
527 pvec.pages, indices);
528
529 if (pvec.nr == 0)
530 break;
531
532 for (i = 0; i < pvec.nr; i++) {
533 if (indices[i] > end_index) {
534 done = true;
535 break;
536 }
537
538 ret = dax_writeback_one(bdev, mapping, indices[i],
539 pvec.pages[i]);
540 if (ret < 0)
541 return ret;
542 }
543 }
544 wmb_pmem();
545 return 0;
546}
547EXPORT_SYMBOL_GPL(dax_writeback_mapping_range);
548
549static int dax_insert_mapping(struct inode *inode, struct buffer_head *bh,
550 struct vm_area_struct *vma, struct vm_fault *vmf)
551{
552 unsigned long vaddr = (unsigned long)vmf->virtual_address;
553 struct address_space *mapping = inode->i_mapping;
554 struct block_device *bdev = bh->b_bdev;
555 struct blk_dax_ctl dax = {
556 .sector = to_sector(bh, inode),
557 .size = bh->b_size,
558 };
559 pgoff_t size;
560 int error;
561
562 i_mmap_lock_read(mapping);
563
564
565
566
567
568
569
570
571 size = (i_size_read(inode) + PAGE_SIZE - 1) >> PAGE_SHIFT;
572 if (unlikely(vmf->pgoff >= size)) {
573 error = -EIO;
574 goto out;
575 }
576
577 if (dax_map_atomic(bdev, &dax) < 0) {
578 error = PTR_ERR(dax.addr);
579 goto out;
580 }
581
582 if (buffer_unwritten(bh) || buffer_new(bh)) {
583 clear_pmem(dax.addr, PAGE_SIZE);
584 wmb_pmem();
585 }
586 dax_unmap_atomic(bdev, &dax);
587
588 error = dax_radix_entry(mapping, vmf->pgoff, dax.sector, false,
589 vmf->flags & FAULT_FLAG_WRITE);
590 if (error)
591 goto out;
592
593 error = vm_insert_mixed(vma, vaddr, dax.pfn);
594
595 out:
596 i_mmap_unlock_read(mapping);
597
598 return error;
599}
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617int __dax_fault(struct vm_area_struct *vma, struct vm_fault *vmf,
618 get_block_t get_block, dax_iodone_t complete_unwritten)
619{
620 struct file *file = vma->vm_file;
621 struct address_space *mapping = file->f_mapping;
622 struct inode *inode = mapping->host;
623 struct page *page;
624 struct buffer_head bh;
625 unsigned long vaddr = (unsigned long)vmf->virtual_address;
626 unsigned blkbits = inode->i_blkbits;
627 sector_t block;
628 pgoff_t size;
629 int error;
630 int major = 0;
631
632 size = (i_size_read(inode) + PAGE_SIZE - 1) >> PAGE_SHIFT;
633 if (vmf->pgoff >= size)
634 return VM_FAULT_SIGBUS;
635
636 memset(&bh, 0, sizeof(bh));
637 block = (sector_t)vmf->pgoff << (PAGE_SHIFT - blkbits);
638 bh.b_bdev = inode->i_sb->s_bdev;
639 bh.b_size = PAGE_SIZE;
640
641 repeat:
642 page = find_get_page(mapping, vmf->pgoff);
643 if (page) {
644 if (!lock_page_or_retry(page, vma->vm_mm, vmf->flags)) {
645 put_page(page);
646 return VM_FAULT_RETRY;
647 }
648 if (unlikely(page->mapping != mapping)) {
649 unlock_page(page);
650 put_page(page);
651 goto repeat;
652 }
653 size = (i_size_read(inode) + PAGE_SIZE - 1) >> PAGE_SHIFT;
654 if (unlikely(vmf->pgoff >= size)) {
655
656
657
658
659 error = -EIO;
660 goto unlock_page;
661 }
662 }
663
664 error = get_block(inode, block, &bh, 0);
665 if (!error && (bh.b_size < PAGE_SIZE))
666 error = -EIO;
667 if (error)
668 goto unlock_page;
669
670 if (!buffer_mapped(&bh) && !buffer_unwritten(&bh) && !vmf->cow_page) {
671 if (vmf->flags & FAULT_FLAG_WRITE) {
672 error = get_block(inode, block, &bh, 1);
673 count_vm_event(PGMAJFAULT);
674 mem_cgroup_count_vm_event(vma->vm_mm, PGMAJFAULT);
675 major = VM_FAULT_MAJOR;
676 if (!error && (bh.b_size < PAGE_SIZE))
677 error = -EIO;
678 if (error)
679 goto unlock_page;
680 } else {
681 return dax_load_hole(mapping, page, vmf);
682 }
683 }
684
685 if (vmf->cow_page) {
686 struct page *new_page = vmf->cow_page;
687 if (buffer_written(&bh))
688 error = copy_user_bh(new_page, inode, &bh, vaddr);
689 else
690 clear_user_highpage(new_page, vaddr);
691 if (error)
692 goto unlock_page;
693 vmf->page = page;
694 if (!page) {
695 i_mmap_lock_read(mapping);
696
697 size = (i_size_read(inode) + PAGE_SIZE - 1) >>
698 PAGE_SHIFT;
699 if (vmf->pgoff >= size) {
700 i_mmap_unlock_read(mapping);
701 error = -EIO;
702 goto out;
703 }
704 }
705 return VM_FAULT_LOCKED;
706 }
707
708
709 if (!page && major)
710 page = find_lock_page(mapping, vmf->pgoff);
711
712 if (page) {
713 unmap_mapping_range(mapping, vmf->pgoff << PAGE_SHIFT,
714 PAGE_SIZE, 0);
715 delete_from_page_cache(page);
716 unlock_page(page);
717 put_page(page);
718 page = NULL;
719 }
720
721
722
723
724
725
726
727
728
729
730
731 error = dax_insert_mapping(inode, &bh, vma, vmf);
732 if (buffer_unwritten(&bh)) {
733 if (complete_unwritten)
734 complete_unwritten(&bh, !error);
735 else
736 WARN_ON_ONCE(!(vmf->flags & FAULT_FLAG_WRITE));
737 }
738
739 out:
740 if (error == -ENOMEM)
741 return VM_FAULT_OOM | major;
742
743 if ((error < 0) && (error != -EBUSY))
744 return VM_FAULT_SIGBUS | major;
745 return VM_FAULT_NOPAGE | major;
746
747 unlock_page:
748 if (page) {
749 unlock_page(page);
750 put_page(page);
751 }
752 goto out;
753}
754EXPORT_SYMBOL(__dax_fault);
755
756
757
758
759
760
761
762
763
764
765int dax_fault(struct vm_area_struct *vma, struct vm_fault *vmf,
766 get_block_t get_block, dax_iodone_t complete_unwritten)
767{
768 int result;
769 struct super_block *sb = file_inode(vma->vm_file)->i_sb;
770
771 if (vmf->flags & FAULT_FLAG_WRITE) {
772 sb_start_pagefault(sb);
773 file_update_time(vma->vm_file);
774 }
775 result = __dax_fault(vma, vmf, get_block, complete_unwritten);
776 if (vmf->flags & FAULT_FLAG_WRITE)
777 sb_end_pagefault(sb);
778
779 return result;
780}
781EXPORT_SYMBOL_GPL(dax_fault);
782
783#ifdef CONFIG_TRANSPARENT_HUGEPAGE
784
785
786
787
788#define PG_PMD_COLOUR ((PMD_SIZE >> PAGE_SHIFT) - 1)
789
790static void __dax_dbg(struct buffer_head *bh, unsigned long address,
791 const char *reason, const char *fn)
792{
793 if (bh) {
794 char bname[BDEVNAME_SIZE];
795 bdevname(bh->b_bdev, bname);
796 pr_debug("%s: %s addr: %lx dev %s state %lx start %lld "
797 "length %zd fallback: %s\n", fn, current->comm,
798 address, bname, bh->b_state, (u64)bh->b_blocknr,
799 bh->b_size, reason);
800 } else {
801 pr_debug("%s: %s addr: %lx fallback: %s\n", fn,
802 current->comm, address, reason);
803 }
804}
805
806#define dax_pmd_dbg(bh, address, reason) __dax_dbg(bh, address, reason, "dax_pmd")
807
808int __dax_pmd_fault(struct vm_area_struct *vma, unsigned long address,
809 pmd_t *pmd, unsigned int flags, get_block_t get_block,
810 dax_iodone_t complete_unwritten)
811{
812 struct file *file = vma->vm_file;
813 struct address_space *mapping = file->f_mapping;
814 struct inode *inode = mapping->host;
815 struct buffer_head bh;
816 unsigned blkbits = inode->i_blkbits;
817 unsigned long pmd_addr = address & PMD_MASK;
818 bool write = flags & FAULT_FLAG_WRITE;
819 struct block_device *bdev;
820 pgoff_t size, pgoff;
821 sector_t block;
822 int error, result = 0;
823 bool alloc = false;
824
825
826 if (!IS_ENABLED(CONFIG_FS_DAX_PMD))
827 return VM_FAULT_FALLBACK;
828
829
830 if (write && !(vma->vm_flags & VM_SHARED)) {
831 split_huge_pmd(vma, pmd, address);
832 dax_pmd_dbg(NULL, address, "cow write");
833 return VM_FAULT_FALLBACK;
834 }
835
836 if (pmd_addr < vma->vm_start) {
837 dax_pmd_dbg(NULL, address, "vma start unaligned");
838 return VM_FAULT_FALLBACK;
839 }
840 if ((pmd_addr + PMD_SIZE) > vma->vm_end) {
841 dax_pmd_dbg(NULL, address, "vma end unaligned");
842 return VM_FAULT_FALLBACK;
843 }
844
845 pgoff = linear_page_index(vma, pmd_addr);
846 size = (i_size_read(inode) + PAGE_SIZE - 1) >> PAGE_SHIFT;
847 if (pgoff >= size)
848 return VM_FAULT_SIGBUS;
849
850 if ((pgoff | PG_PMD_COLOUR) >= size) {
851 dax_pmd_dbg(NULL, address,
852 "offset + huge page size > file size");
853 return VM_FAULT_FALLBACK;
854 }
855
856 memset(&bh, 0, sizeof(bh));
857 bh.b_bdev = inode->i_sb->s_bdev;
858 block = (sector_t)pgoff << (PAGE_SHIFT - blkbits);
859
860 bh.b_size = PMD_SIZE;
861
862 if (get_block(inode, block, &bh, 0) != 0)
863 return VM_FAULT_SIGBUS;
864
865 if (!buffer_mapped(&bh) && write) {
866 if (get_block(inode, block, &bh, 1) != 0)
867 return VM_FAULT_SIGBUS;
868 alloc = true;
869 }
870
871 bdev = bh.b_bdev;
872
873
874
875
876
877
878 if (!buffer_size_valid(&bh) || bh.b_size < PMD_SIZE) {
879 dax_pmd_dbg(&bh, address, "allocated block too small");
880 return VM_FAULT_FALLBACK;
881 }
882
883
884
885
886
887 if (alloc) {
888 loff_t lstart = pgoff << PAGE_SHIFT;
889 loff_t lend = lstart + PMD_SIZE - 1;
890
891 truncate_pagecache_range(inode, lstart, lend);
892 }
893
894 i_mmap_lock_read(mapping);
895
896
897
898
899
900
901
902 size = (i_size_read(inode) + PAGE_SIZE - 1) >> PAGE_SHIFT;
903 if (pgoff >= size) {
904 result = VM_FAULT_SIGBUS;
905 goto out;
906 }
907 if ((pgoff | PG_PMD_COLOUR) >= size) {
908 dax_pmd_dbg(&bh, address,
909 "offset + huge page size > file size");
910 goto fallback;
911 }
912
913 if (!write && !buffer_mapped(&bh) && buffer_uptodate(&bh)) {
914 spinlock_t *ptl;
915 pmd_t entry;
916 struct page *zero_page = get_huge_zero_page();
917
918 if (unlikely(!zero_page)) {
919 dax_pmd_dbg(&bh, address, "no zero page");
920 goto fallback;
921 }
922
923 ptl = pmd_lock(vma->vm_mm, pmd);
924 if (!pmd_none(*pmd)) {
925 spin_unlock(ptl);
926 dax_pmd_dbg(&bh, address, "pmd already present");
927 goto fallback;
928 }
929
930 dev_dbg(part_to_dev(bdev->bd_part),
931 "%s: %s addr: %lx pfn: <zero> sect: %llx\n",
932 __func__, current->comm, address,
933 (unsigned long long) to_sector(&bh, inode));
934
935 entry = mk_pmd(zero_page, vma->vm_page_prot);
936 entry = pmd_mkhuge(entry);
937 set_pmd_at(vma->vm_mm, pmd_addr, pmd, entry);
938 result = VM_FAULT_NOPAGE;
939 spin_unlock(ptl);
940 } else {
941 struct blk_dax_ctl dax = {
942 .sector = to_sector(&bh, inode),
943 .size = PMD_SIZE,
944 };
945 long length = dax_map_atomic(bdev, &dax);
946
947 if (length < 0) {
948 result = VM_FAULT_SIGBUS;
949 goto out;
950 }
951 if (length < PMD_SIZE) {
952 dax_pmd_dbg(&bh, address, "dax-length too small");
953 dax_unmap_atomic(bdev, &dax);
954 goto fallback;
955 }
956 if (pfn_t_to_pfn(dax.pfn) & PG_PMD_COLOUR) {
957 dax_pmd_dbg(&bh, address, "pfn unaligned");
958 dax_unmap_atomic(bdev, &dax);
959 goto fallback;
960 }
961
962 if (!pfn_t_devmap(dax.pfn)) {
963 dax_unmap_atomic(bdev, &dax);
964 dax_pmd_dbg(&bh, address, "pfn not in memmap");
965 goto fallback;
966 }
967
968 if (buffer_unwritten(&bh) || buffer_new(&bh)) {
969 clear_pmem(dax.addr, PMD_SIZE);
970 wmb_pmem();
971 count_vm_event(PGMAJFAULT);
972 mem_cgroup_count_vm_event(vma->vm_mm, PGMAJFAULT);
973 result |= VM_FAULT_MAJOR;
974 }
975 dax_unmap_atomic(bdev, &dax);
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991
992 if (write) {
993 error = dax_radix_entry(mapping, pgoff, dax.sector,
994 true, true);
995 if (error) {
996 dax_pmd_dbg(&bh, address,
997 "PMD radix insertion failed");
998 goto fallback;
999 }
1000 }
1001
1002 dev_dbg(part_to_dev(bdev->bd_part),
1003 "%s: %s addr: %lx pfn: %lx sect: %llx\n",
1004 __func__, current->comm, address,
1005 pfn_t_to_pfn(dax.pfn),
1006 (unsigned long long) dax.sector);
1007 result |= vmf_insert_pfn_pmd(vma, address, pmd,
1008 dax.pfn, write);
1009 }
1010
1011 out:
1012 i_mmap_unlock_read(mapping);
1013
1014 if (buffer_unwritten(&bh))
1015 complete_unwritten(&bh, !(result & VM_FAULT_ERROR));
1016
1017 return result;
1018
1019 fallback:
1020 count_vm_event(THP_FAULT_FALLBACK);
1021 result = VM_FAULT_FALLBACK;
1022 goto out;
1023}
1024EXPORT_SYMBOL_GPL(__dax_pmd_fault);
1025
1026
1027
1028
1029
1030
1031
1032
1033
1034
1035int dax_pmd_fault(struct vm_area_struct *vma, unsigned long address,
1036 pmd_t *pmd, unsigned int flags, get_block_t get_block,
1037 dax_iodone_t complete_unwritten)
1038{
1039 int result;
1040 struct super_block *sb = file_inode(vma->vm_file)->i_sb;
1041
1042 if (flags & FAULT_FLAG_WRITE) {
1043 sb_start_pagefault(sb);
1044 file_update_time(vma->vm_file);
1045 }
1046 result = __dax_pmd_fault(vma, address, pmd, flags, get_block,
1047 complete_unwritten);
1048 if (flags & FAULT_FLAG_WRITE)
1049 sb_end_pagefault(sb);
1050
1051 return result;
1052}
1053EXPORT_SYMBOL_GPL(dax_pmd_fault);
1054#endif
1055
1056
1057
1058
1059
1060
1061int dax_pfn_mkwrite(struct vm_area_struct *vma, struct vm_fault *vmf)
1062{
1063 struct file *file = vma->vm_file;
1064 int error;
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074 error = dax_radix_entry(file->f_mapping, vmf->pgoff, NO_SECTOR, false,
1075 true);
1076
1077 if (error == -ENOMEM)
1078 return VM_FAULT_OOM;
1079 if (error)
1080 return VM_FAULT_SIGBUS;
1081 return VM_FAULT_NOPAGE;
1082}
1083EXPORT_SYMBOL_GPL(dax_pfn_mkwrite);
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103int dax_zero_page_range(struct inode *inode, loff_t from, unsigned length,
1104 get_block_t get_block)
1105{
1106 struct buffer_head bh;
1107 pgoff_t index = from >> PAGE_SHIFT;
1108 unsigned offset = from & (PAGE_SIZE-1);
1109 int err;
1110
1111
1112 if (!length)
1113 return 0;
1114 BUG_ON((offset + length) > PAGE_SIZE);
1115
1116 memset(&bh, 0, sizeof(bh));
1117 bh.b_bdev = inode->i_sb->s_bdev;
1118 bh.b_size = PAGE_SIZE;
1119 err = get_block(inode, index, &bh, 0);
1120 if (err < 0)
1121 return err;
1122 if (buffer_written(&bh)) {
1123 struct block_device *bdev = bh.b_bdev;
1124 struct blk_dax_ctl dax = {
1125 .sector = to_sector(&bh, inode),
1126 .size = PAGE_SIZE,
1127 };
1128
1129 if (dax_map_atomic(bdev, &dax) < 0)
1130 return PTR_ERR(dax.addr);
1131 clear_pmem(dax.addr + offset, length);
1132 wmb_pmem();
1133 dax_unmap_atomic(bdev, &dax);
1134 }
1135
1136 return 0;
1137}
1138EXPORT_SYMBOL_GPL(dax_zero_page_range);
1139
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150
1151
1152
1153
1154
1155int dax_truncate_page(struct inode *inode, loff_t from, get_block_t get_block)
1156{
1157 unsigned length = PAGE_ALIGN(from) - from;
1158 return dax_zero_page_range(inode, from, length, get_block);
1159}
1160EXPORT_SYMBOL_GPL(dax_truncate_page);
1161