xref: /linux/mm/userfaultfd.c (revision 643aa36eadebdcdcaeecf538f0549a619ad78ea0)
120c8ccb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2c1a4de99SAndrea Arcangeli /*
3c1a4de99SAndrea Arcangeli  *  mm/userfaultfd.c
4c1a4de99SAndrea Arcangeli  *
5c1a4de99SAndrea Arcangeli  *  Copyright (C) 2015  Red Hat, Inc.
6c1a4de99SAndrea Arcangeli  */
7c1a4de99SAndrea Arcangeli 
8c1a4de99SAndrea Arcangeli #include <linux/mm.h>
9174cd4b1SIngo Molnar #include <linux/sched/signal.h>
10c1a4de99SAndrea Arcangeli #include <linux/pagemap.h>
11c1a4de99SAndrea Arcangeli #include <linux/rmap.h>
12c1a4de99SAndrea Arcangeli #include <linux/swap.h>
13c1a4de99SAndrea Arcangeli #include <linux/swapops.h>
14c1a4de99SAndrea Arcangeli #include <linux/userfaultfd_k.h>
15c1a4de99SAndrea Arcangeli #include <linux/mmu_notifier.h>
1660d4d2d2SMike Kravetz #include <linux/hugetlb.h>
1726071cedSMike Rapoport #include <linux/shmem_fs.h>
18c1a4de99SAndrea Arcangeli #include <asm/tlbflush.h>
19c1a4de99SAndrea Arcangeli #include "internal.h"
20c1a4de99SAndrea Arcangeli 
21*643aa36eSWei Yang static __always_inline
22*643aa36eSWei Yang struct vm_area_struct *find_dst_vma(struct mm_struct *dst_mm,
23*643aa36eSWei Yang 				    unsigned long dst_start,
24*643aa36eSWei Yang 				    unsigned long len)
25*643aa36eSWei Yang {
26*643aa36eSWei Yang 	/*
27*643aa36eSWei Yang 	 * Make sure that the dst range is both valid and fully within a
28*643aa36eSWei Yang 	 * single existing vma.
29*643aa36eSWei Yang 	 */
30*643aa36eSWei Yang 	struct vm_area_struct *dst_vma;
31*643aa36eSWei Yang 
32*643aa36eSWei Yang 	dst_vma = find_vma(dst_mm, dst_start);
33*643aa36eSWei Yang 	if (!dst_vma)
34*643aa36eSWei Yang 		return NULL;
35*643aa36eSWei Yang 
36*643aa36eSWei Yang 	if (dst_start < dst_vma->vm_start ||
37*643aa36eSWei Yang 	    dst_start + len > dst_vma->vm_end)
38*643aa36eSWei Yang 		return NULL;
39*643aa36eSWei Yang 
40*643aa36eSWei Yang 	/*
41*643aa36eSWei Yang 	 * Check the vma is registered in uffd, this is required to
42*643aa36eSWei Yang 	 * enforce the VM_MAYWRITE check done at uffd registration
43*643aa36eSWei Yang 	 * time.
44*643aa36eSWei Yang 	 */
45*643aa36eSWei Yang 	if (!dst_vma->vm_userfaultfd_ctx.ctx)
46*643aa36eSWei Yang 		return NULL;
47*643aa36eSWei Yang 
48*643aa36eSWei Yang 	return dst_vma;
49*643aa36eSWei Yang }
50*643aa36eSWei Yang 
51c1a4de99SAndrea Arcangeli static int mcopy_atomic_pte(struct mm_struct *dst_mm,
52c1a4de99SAndrea Arcangeli 			    pmd_t *dst_pmd,
53c1a4de99SAndrea Arcangeli 			    struct vm_area_struct *dst_vma,
54c1a4de99SAndrea Arcangeli 			    unsigned long dst_addr,
55b6ebaedbSAndrea Arcangeli 			    unsigned long src_addr,
56b6ebaedbSAndrea Arcangeli 			    struct page **pagep)
57c1a4de99SAndrea Arcangeli {
58c1a4de99SAndrea Arcangeli 	struct mem_cgroup *memcg;
59c1a4de99SAndrea Arcangeli 	pte_t _dst_pte, *dst_pte;
60c1a4de99SAndrea Arcangeli 	spinlock_t *ptl;
61c1a4de99SAndrea Arcangeli 	void *page_kaddr;
62c1a4de99SAndrea Arcangeli 	int ret;
63b6ebaedbSAndrea Arcangeli 	struct page *page;
64e2a50c1fSAndrea Arcangeli 	pgoff_t offset, max_off;
65e2a50c1fSAndrea Arcangeli 	struct inode *inode;
66c1a4de99SAndrea Arcangeli 
67b6ebaedbSAndrea Arcangeli 	if (!*pagep) {
68c1a4de99SAndrea Arcangeli 		ret = -ENOMEM;
69c1a4de99SAndrea Arcangeli 		page = alloc_page_vma(GFP_HIGHUSER_MOVABLE, dst_vma, dst_addr);
70c1a4de99SAndrea Arcangeli 		if (!page)
71c1a4de99SAndrea Arcangeli 			goto out;
72c1a4de99SAndrea Arcangeli 
73b6ebaedbSAndrea Arcangeli 		page_kaddr = kmap_atomic(page);
74b6ebaedbSAndrea Arcangeli 		ret = copy_from_user(page_kaddr,
75b6ebaedbSAndrea Arcangeli 				     (const void __user *) src_addr,
76b6ebaedbSAndrea Arcangeli 				     PAGE_SIZE);
77b6ebaedbSAndrea Arcangeli 		kunmap_atomic(page_kaddr);
78b6ebaedbSAndrea Arcangeli 
79b6ebaedbSAndrea Arcangeli 		/* fallback to copy_from_user outside mmap_sem */
80b6ebaedbSAndrea Arcangeli 		if (unlikely(ret)) {
819e368259SAndrea Arcangeli 			ret = -ENOENT;
82b6ebaedbSAndrea Arcangeli 			*pagep = page;
83b6ebaedbSAndrea Arcangeli 			/* don't free the page */
84b6ebaedbSAndrea Arcangeli 			goto out;
85b6ebaedbSAndrea Arcangeli 		}
86b6ebaedbSAndrea Arcangeli 	} else {
87b6ebaedbSAndrea Arcangeli 		page = *pagep;
88b6ebaedbSAndrea Arcangeli 		*pagep = NULL;
89b6ebaedbSAndrea Arcangeli 	}
90c1a4de99SAndrea Arcangeli 
91c1a4de99SAndrea Arcangeli 	/*
92c1a4de99SAndrea Arcangeli 	 * The memory barrier inside __SetPageUptodate makes sure that
93c1a4de99SAndrea Arcangeli 	 * preceeding stores to the page contents become visible before
94c1a4de99SAndrea Arcangeli 	 * the set_pte_at() write.
95c1a4de99SAndrea Arcangeli 	 */
96c1a4de99SAndrea Arcangeli 	__SetPageUptodate(page);
97c1a4de99SAndrea Arcangeli 
98c1a4de99SAndrea Arcangeli 	ret = -ENOMEM;
99f627c2f5SKirill A. Shutemov 	if (mem_cgroup_try_charge(page, dst_mm, GFP_KERNEL, &memcg, false))
100c1a4de99SAndrea Arcangeli 		goto out_release;
101c1a4de99SAndrea Arcangeli 
102c1a4de99SAndrea Arcangeli 	_dst_pte = mk_pte(page, dst_vma->vm_page_prot);
103c1a4de99SAndrea Arcangeli 	if (dst_vma->vm_flags & VM_WRITE)
104c1a4de99SAndrea Arcangeli 		_dst_pte = pte_mkwrite(pte_mkdirty(_dst_pte));
105c1a4de99SAndrea Arcangeli 
106c1a4de99SAndrea Arcangeli 	dst_pte = pte_offset_map_lock(dst_mm, dst_pmd, dst_addr, &ptl);
107e2a50c1fSAndrea Arcangeli 	if (dst_vma->vm_file) {
108e2a50c1fSAndrea Arcangeli 		/* the shmem MAP_PRIVATE case requires checking the i_size */
109e2a50c1fSAndrea Arcangeli 		inode = dst_vma->vm_file->f_inode;
110e2a50c1fSAndrea Arcangeli 		offset = linear_page_index(dst_vma, dst_addr);
111e2a50c1fSAndrea Arcangeli 		max_off = DIV_ROUND_UP(i_size_read(inode), PAGE_SIZE);
112e2a50c1fSAndrea Arcangeli 		ret = -EFAULT;
113e2a50c1fSAndrea Arcangeli 		if (unlikely(offset >= max_off))
114e2a50c1fSAndrea Arcangeli 			goto out_release_uncharge_unlock;
115e2a50c1fSAndrea Arcangeli 	}
116e2a50c1fSAndrea Arcangeli 	ret = -EEXIST;
117c1a4de99SAndrea Arcangeli 	if (!pte_none(*dst_pte))
118c1a4de99SAndrea Arcangeli 		goto out_release_uncharge_unlock;
119c1a4de99SAndrea Arcangeli 
120c1a4de99SAndrea Arcangeli 	inc_mm_counter(dst_mm, MM_ANONPAGES);
121d281ee61SKirill A. Shutemov 	page_add_new_anon_rmap(page, dst_vma, dst_addr, false);
122f627c2f5SKirill A. Shutemov 	mem_cgroup_commit_charge(page, memcg, false, false);
123c1a4de99SAndrea Arcangeli 	lru_cache_add_active_or_unevictable(page, dst_vma);
124c1a4de99SAndrea Arcangeli 
125c1a4de99SAndrea Arcangeli 	set_pte_at(dst_mm, dst_addr, dst_pte, _dst_pte);
126c1a4de99SAndrea Arcangeli 
127c1a4de99SAndrea Arcangeli 	/* No need to invalidate - it was non-present before */
128c1a4de99SAndrea Arcangeli 	update_mmu_cache(dst_vma, dst_addr, dst_pte);
129c1a4de99SAndrea Arcangeli 
130c1a4de99SAndrea Arcangeli 	pte_unmap_unlock(dst_pte, ptl);
131c1a4de99SAndrea Arcangeli 	ret = 0;
132c1a4de99SAndrea Arcangeli out:
133c1a4de99SAndrea Arcangeli 	return ret;
134c1a4de99SAndrea Arcangeli out_release_uncharge_unlock:
135c1a4de99SAndrea Arcangeli 	pte_unmap_unlock(dst_pte, ptl);
136f627c2f5SKirill A. Shutemov 	mem_cgroup_cancel_charge(page, memcg, false);
137c1a4de99SAndrea Arcangeli out_release:
13809cbfeafSKirill A. Shutemov 	put_page(page);
139c1a4de99SAndrea Arcangeli 	goto out;
140c1a4de99SAndrea Arcangeli }
141c1a4de99SAndrea Arcangeli 
142c1a4de99SAndrea Arcangeli static int mfill_zeropage_pte(struct mm_struct *dst_mm,
143c1a4de99SAndrea Arcangeli 			      pmd_t *dst_pmd,
144c1a4de99SAndrea Arcangeli 			      struct vm_area_struct *dst_vma,
145c1a4de99SAndrea Arcangeli 			      unsigned long dst_addr)
146c1a4de99SAndrea Arcangeli {
147c1a4de99SAndrea Arcangeli 	pte_t _dst_pte, *dst_pte;
148c1a4de99SAndrea Arcangeli 	spinlock_t *ptl;
149c1a4de99SAndrea Arcangeli 	int ret;
150e2a50c1fSAndrea Arcangeli 	pgoff_t offset, max_off;
151e2a50c1fSAndrea Arcangeli 	struct inode *inode;
152c1a4de99SAndrea Arcangeli 
153c1a4de99SAndrea Arcangeli 	_dst_pte = pte_mkspecial(pfn_pte(my_zero_pfn(dst_addr),
154c1a4de99SAndrea Arcangeli 					 dst_vma->vm_page_prot));
155c1a4de99SAndrea Arcangeli 	dst_pte = pte_offset_map_lock(dst_mm, dst_pmd, dst_addr, &ptl);
156e2a50c1fSAndrea Arcangeli 	if (dst_vma->vm_file) {
157e2a50c1fSAndrea Arcangeli 		/* the shmem MAP_PRIVATE case requires checking the i_size */
158e2a50c1fSAndrea Arcangeli 		inode = dst_vma->vm_file->f_inode;
159e2a50c1fSAndrea Arcangeli 		offset = linear_page_index(dst_vma, dst_addr);
160e2a50c1fSAndrea Arcangeli 		max_off = DIV_ROUND_UP(i_size_read(inode), PAGE_SIZE);
161e2a50c1fSAndrea Arcangeli 		ret = -EFAULT;
162e2a50c1fSAndrea Arcangeli 		if (unlikely(offset >= max_off))
163e2a50c1fSAndrea Arcangeli 			goto out_unlock;
164e2a50c1fSAndrea Arcangeli 	}
165e2a50c1fSAndrea Arcangeli 	ret = -EEXIST;
166c1a4de99SAndrea Arcangeli 	if (!pte_none(*dst_pte))
167c1a4de99SAndrea Arcangeli 		goto out_unlock;
168c1a4de99SAndrea Arcangeli 	set_pte_at(dst_mm, dst_addr, dst_pte, _dst_pte);
169c1a4de99SAndrea Arcangeli 	/* No need to invalidate - it was non-present before */
170c1a4de99SAndrea Arcangeli 	update_mmu_cache(dst_vma, dst_addr, dst_pte);
171c1a4de99SAndrea Arcangeli 	ret = 0;
172c1a4de99SAndrea Arcangeli out_unlock:
173c1a4de99SAndrea Arcangeli 	pte_unmap_unlock(dst_pte, ptl);
174c1a4de99SAndrea Arcangeli 	return ret;
175c1a4de99SAndrea Arcangeli }
176c1a4de99SAndrea Arcangeli 
177c1a4de99SAndrea Arcangeli static pmd_t *mm_alloc_pmd(struct mm_struct *mm, unsigned long address)
178c1a4de99SAndrea Arcangeli {
179c1a4de99SAndrea Arcangeli 	pgd_t *pgd;
180c2febafcSKirill A. Shutemov 	p4d_t *p4d;
181c1a4de99SAndrea Arcangeli 	pud_t *pud;
182c1a4de99SAndrea Arcangeli 
183c1a4de99SAndrea Arcangeli 	pgd = pgd_offset(mm, address);
184c2febafcSKirill A. Shutemov 	p4d = p4d_alloc(mm, pgd, address);
185c2febafcSKirill A. Shutemov 	if (!p4d)
186c2febafcSKirill A. Shutemov 		return NULL;
187c2febafcSKirill A. Shutemov 	pud = pud_alloc(mm, p4d, address);
188c2febafcSKirill A. Shutemov 	if (!pud)
189c2febafcSKirill A. Shutemov 		return NULL;
190c1a4de99SAndrea Arcangeli 	/*
191c1a4de99SAndrea Arcangeli 	 * Note that we didn't run this because the pmd was
192c1a4de99SAndrea Arcangeli 	 * missing, the *pmd may be already established and in
193c1a4de99SAndrea Arcangeli 	 * turn it may also be a trans_huge_pmd.
194c1a4de99SAndrea Arcangeli 	 */
195c2febafcSKirill A. Shutemov 	return pmd_alloc(mm, pud, address);
196c1a4de99SAndrea Arcangeli }
197c1a4de99SAndrea Arcangeli 
19860d4d2d2SMike Kravetz #ifdef CONFIG_HUGETLB_PAGE
19960d4d2d2SMike Kravetz /*
20060d4d2d2SMike Kravetz  * __mcopy_atomic processing for HUGETLB vmas.  Note that this routine is
20160d4d2d2SMike Kravetz  * called with mmap_sem held, it will release mmap_sem before returning.
20260d4d2d2SMike Kravetz  */
20360d4d2d2SMike Kravetz static __always_inline ssize_t __mcopy_atomic_hugetlb(struct mm_struct *dst_mm,
20460d4d2d2SMike Kravetz 					      struct vm_area_struct *dst_vma,
20560d4d2d2SMike Kravetz 					      unsigned long dst_start,
20660d4d2d2SMike Kravetz 					      unsigned long src_start,
20760d4d2d2SMike Kravetz 					      unsigned long len,
20860d4d2d2SMike Kravetz 					      bool zeropage)
20960d4d2d2SMike Kravetz {
2101c9e8defSMike Kravetz 	int vm_alloc_shared = dst_vma->vm_flags & VM_SHARED;
2111c9e8defSMike Kravetz 	int vm_shared = dst_vma->vm_flags & VM_SHARED;
21260d4d2d2SMike Kravetz 	ssize_t err;
21360d4d2d2SMike Kravetz 	pte_t *dst_pte;
21460d4d2d2SMike Kravetz 	unsigned long src_addr, dst_addr;
21560d4d2d2SMike Kravetz 	long copied;
21660d4d2d2SMike Kravetz 	struct page *page;
21760d4d2d2SMike Kravetz 	unsigned long vma_hpagesize;
21860d4d2d2SMike Kravetz 	pgoff_t idx;
21960d4d2d2SMike Kravetz 	u32 hash;
22060d4d2d2SMike Kravetz 	struct address_space *mapping;
22160d4d2d2SMike Kravetz 
22260d4d2d2SMike Kravetz 	/*
22360d4d2d2SMike Kravetz 	 * There is no default zero huge page for all huge page sizes as
22460d4d2d2SMike Kravetz 	 * supported by hugetlb.  A PMD_SIZE huge pages may exist as used
22560d4d2d2SMike Kravetz 	 * by THP.  Since we can not reliably insert a zero page, this
22660d4d2d2SMike Kravetz 	 * feature is not supported.
22760d4d2d2SMike Kravetz 	 */
22860d4d2d2SMike Kravetz 	if (zeropage) {
22960d4d2d2SMike Kravetz 		up_read(&dst_mm->mmap_sem);
23060d4d2d2SMike Kravetz 		return -EINVAL;
23160d4d2d2SMike Kravetz 	}
23260d4d2d2SMike Kravetz 
23360d4d2d2SMike Kravetz 	src_addr = src_start;
23460d4d2d2SMike Kravetz 	dst_addr = dst_start;
23560d4d2d2SMike Kravetz 	copied = 0;
23660d4d2d2SMike Kravetz 	page = NULL;
23760d4d2d2SMike Kravetz 	vma_hpagesize = vma_kernel_pagesize(dst_vma);
23860d4d2d2SMike Kravetz 
23960d4d2d2SMike Kravetz 	/*
24060d4d2d2SMike Kravetz 	 * Validate alignment based on huge page size
24160d4d2d2SMike Kravetz 	 */
24260d4d2d2SMike Kravetz 	err = -EINVAL;
24360d4d2d2SMike Kravetz 	if (dst_start & (vma_hpagesize - 1) || len & (vma_hpagesize - 1))
24460d4d2d2SMike Kravetz 		goto out_unlock;
24560d4d2d2SMike Kravetz 
24660d4d2d2SMike Kravetz retry:
24760d4d2d2SMike Kravetz 	/*
24860d4d2d2SMike Kravetz 	 * On routine entry dst_vma is set.  If we had to drop mmap_sem and
24960d4d2d2SMike Kravetz 	 * retry, dst_vma will be set to NULL and we must lookup again.
25060d4d2d2SMike Kravetz 	 */
25160d4d2d2SMike Kravetz 	if (!dst_vma) {
25227d02568SMike Rapoport 		err = -ENOENT;
253*643aa36eSWei Yang 		dst_vma = find_dst_vma(dst_mm, dst_start, len);
25460d4d2d2SMike Kravetz 		if (!dst_vma || !is_vm_hugetlb_page(dst_vma))
25560d4d2d2SMike Kravetz 			goto out_unlock;
2561c9e8defSMike Kravetz 
25727d02568SMike Rapoport 		err = -EINVAL;
25827d02568SMike Rapoport 		if (vma_hpagesize != vma_kernel_pagesize(dst_vma))
25927d02568SMike Rapoport 			goto out_unlock;
26027d02568SMike Rapoport 
2611c9e8defSMike Kravetz 		vm_shared = dst_vma->vm_flags & VM_SHARED;
26260d4d2d2SMike Kravetz 	}
26360d4d2d2SMike Kravetz 
26460d4d2d2SMike Kravetz 	/*
2651c9e8defSMike Kravetz 	 * If not shared, ensure the dst_vma has a anon_vma.
26660d4d2d2SMike Kravetz 	 */
26760d4d2d2SMike Kravetz 	err = -ENOMEM;
2681c9e8defSMike Kravetz 	if (!vm_shared) {
26960d4d2d2SMike Kravetz 		if (unlikely(anon_vma_prepare(dst_vma)))
27060d4d2d2SMike Kravetz 			goto out_unlock;
2711c9e8defSMike Kravetz 	}
27260d4d2d2SMike Kravetz 
27360d4d2d2SMike Kravetz 	while (src_addr < src_start + len) {
27460d4d2d2SMike Kravetz 		pte_t dst_pteval;
27560d4d2d2SMike Kravetz 
27660d4d2d2SMike Kravetz 		BUG_ON(dst_addr >= dst_start + len);
27760d4d2d2SMike Kravetz 
27860d4d2d2SMike Kravetz 		/*
279ddeaab32SMike Kravetz 		 * Serialize via hugetlb_fault_mutex
28060d4d2d2SMike Kravetz 		 */
281b43a9990SMike Kravetz 		idx = linear_page_index(dst_vma, dst_addr);
282ddeaab32SMike Kravetz 		mapping = dst_vma->vm_file->f_mapping;
283188b04a7SWei Yang 		hash = hugetlb_fault_mutex_hash(mapping, idx);
28460d4d2d2SMike Kravetz 		mutex_lock(&hugetlb_fault_mutex_table[hash]);
28560d4d2d2SMike Kravetz 
28660d4d2d2SMike Kravetz 		err = -ENOMEM;
2874fb07ee6SWei Yang 		dst_pte = huge_pte_alloc(dst_mm, dst_addr, vma_hpagesize);
28860d4d2d2SMike Kravetz 		if (!dst_pte) {
28960d4d2d2SMike Kravetz 			mutex_unlock(&hugetlb_fault_mutex_table[hash]);
29060d4d2d2SMike Kravetz 			goto out_unlock;
29160d4d2d2SMike Kravetz 		}
29260d4d2d2SMike Kravetz 
29360d4d2d2SMike Kravetz 		err = -EEXIST;
29460d4d2d2SMike Kravetz 		dst_pteval = huge_ptep_get(dst_pte);
29560d4d2d2SMike Kravetz 		if (!huge_pte_none(dst_pteval)) {
29660d4d2d2SMike Kravetz 			mutex_unlock(&hugetlb_fault_mutex_table[hash]);
29760d4d2d2SMike Kravetz 			goto out_unlock;
29860d4d2d2SMike Kravetz 		}
29960d4d2d2SMike Kravetz 
30060d4d2d2SMike Kravetz 		err = hugetlb_mcopy_atomic_pte(dst_mm, dst_pte, dst_vma,
30160d4d2d2SMike Kravetz 						dst_addr, src_addr, &page);
30260d4d2d2SMike Kravetz 
30360d4d2d2SMike Kravetz 		mutex_unlock(&hugetlb_fault_mutex_table[hash]);
3041c9e8defSMike Kravetz 		vm_alloc_shared = vm_shared;
30560d4d2d2SMike Kravetz 
30660d4d2d2SMike Kravetz 		cond_resched();
30760d4d2d2SMike Kravetz 
3089e368259SAndrea Arcangeli 		if (unlikely(err == -ENOENT)) {
30960d4d2d2SMike Kravetz 			up_read(&dst_mm->mmap_sem);
31060d4d2d2SMike Kravetz 			BUG_ON(!page);
31160d4d2d2SMike Kravetz 
31260d4d2d2SMike Kravetz 			err = copy_huge_page_from_user(page,
31360d4d2d2SMike Kravetz 						(const void __user *)src_addr,
3144fb07ee6SWei Yang 						vma_hpagesize / PAGE_SIZE,
3154fb07ee6SWei Yang 						true);
31660d4d2d2SMike Kravetz 			if (unlikely(err)) {
31760d4d2d2SMike Kravetz 				err = -EFAULT;
31860d4d2d2SMike Kravetz 				goto out;
31960d4d2d2SMike Kravetz 			}
32060d4d2d2SMike Kravetz 			down_read(&dst_mm->mmap_sem);
32160d4d2d2SMike Kravetz 
32260d4d2d2SMike Kravetz 			dst_vma = NULL;
32360d4d2d2SMike Kravetz 			goto retry;
32460d4d2d2SMike Kravetz 		} else
32560d4d2d2SMike Kravetz 			BUG_ON(page);
32660d4d2d2SMike Kravetz 
32760d4d2d2SMike Kravetz 		if (!err) {
32860d4d2d2SMike Kravetz 			dst_addr += vma_hpagesize;
32960d4d2d2SMike Kravetz 			src_addr += vma_hpagesize;
33060d4d2d2SMike Kravetz 			copied += vma_hpagesize;
33160d4d2d2SMike Kravetz 
33260d4d2d2SMike Kravetz 			if (fatal_signal_pending(current))
33360d4d2d2SMike Kravetz 				err = -EINTR;
33460d4d2d2SMike Kravetz 		}
33560d4d2d2SMike Kravetz 		if (err)
33660d4d2d2SMike Kravetz 			break;
33760d4d2d2SMike Kravetz 	}
33860d4d2d2SMike Kravetz 
33960d4d2d2SMike Kravetz out_unlock:
34060d4d2d2SMike Kravetz 	up_read(&dst_mm->mmap_sem);
34160d4d2d2SMike Kravetz out:
34221205bf8SMike Kravetz 	if (page) {
34321205bf8SMike Kravetz 		/*
34421205bf8SMike Kravetz 		 * We encountered an error and are about to free a newly
3451c9e8defSMike Kravetz 		 * allocated huge page.
3461c9e8defSMike Kravetz 		 *
3471c9e8defSMike Kravetz 		 * Reservation handling is very subtle, and is different for
3481c9e8defSMike Kravetz 		 * private and shared mappings.  See the routine
3491c9e8defSMike Kravetz 		 * restore_reserve_on_error for details.  Unfortunately, we
3501c9e8defSMike Kravetz 		 * can not call restore_reserve_on_error now as it would
3511c9e8defSMike Kravetz 		 * require holding mmap_sem.
3521c9e8defSMike Kravetz 		 *
3531c9e8defSMike Kravetz 		 * If a reservation for the page existed in the reservation
3541c9e8defSMike Kravetz 		 * map of a private mapping, the map was modified to indicate
3551c9e8defSMike Kravetz 		 * the reservation was consumed when the page was allocated.
3561c9e8defSMike Kravetz 		 * We clear the PagePrivate flag now so that the global
35721205bf8SMike Kravetz 		 * reserve count will not be incremented in free_huge_page.
35821205bf8SMike Kravetz 		 * The reservation map will still indicate the reservation
35921205bf8SMike Kravetz 		 * was consumed and possibly prevent later page allocation.
3601c9e8defSMike Kravetz 		 * This is better than leaking a global reservation.  If no
3611c9e8defSMike Kravetz 		 * reservation existed, it is still safe to clear PagePrivate
3621c9e8defSMike Kravetz 		 * as no adjustments to reservation counts were made during
3631c9e8defSMike Kravetz 		 * allocation.
3641c9e8defSMike Kravetz 		 *
3651c9e8defSMike Kravetz 		 * The reservation map for shared mappings indicates which
3661c9e8defSMike Kravetz 		 * pages have reservations.  When a huge page is allocated
3671c9e8defSMike Kravetz 		 * for an address with a reservation, no change is made to
3681c9e8defSMike Kravetz 		 * the reserve map.  In this case PagePrivate will be set
3691c9e8defSMike Kravetz 		 * to indicate that the global reservation count should be
3701c9e8defSMike Kravetz 		 * incremented when the page is freed.  This is the desired
3711c9e8defSMike Kravetz 		 * behavior.  However, when a huge page is allocated for an
3721c9e8defSMike Kravetz 		 * address without a reservation a reservation entry is added
3731c9e8defSMike Kravetz 		 * to the reservation map, and PagePrivate will not be set.
3741c9e8defSMike Kravetz 		 * When the page is freed, the global reserve count will NOT
3751c9e8defSMike Kravetz 		 * be incremented and it will appear as though we have leaked
3761c9e8defSMike Kravetz 		 * reserved page.  In this case, set PagePrivate so that the
3771c9e8defSMike Kravetz 		 * global reserve count will be incremented to match the
3781c9e8defSMike Kravetz 		 * reservation map entry which was created.
3791c9e8defSMike Kravetz 		 *
3801c9e8defSMike Kravetz 		 * Note that vm_alloc_shared is based on the flags of the vma
3811c9e8defSMike Kravetz 		 * for which the page was originally allocated.  dst_vma could
3821c9e8defSMike Kravetz 		 * be different or NULL on error.
38321205bf8SMike Kravetz 		 */
3841c9e8defSMike Kravetz 		if (vm_alloc_shared)
3851c9e8defSMike Kravetz 			SetPagePrivate(page);
3861c9e8defSMike Kravetz 		else
38721205bf8SMike Kravetz 			ClearPagePrivate(page);
38860d4d2d2SMike Kravetz 		put_page(page);
38921205bf8SMike Kravetz 	}
39060d4d2d2SMike Kravetz 	BUG_ON(copied < 0);
39160d4d2d2SMike Kravetz 	BUG_ON(err > 0);
39260d4d2d2SMike Kravetz 	BUG_ON(!copied && !err);
39360d4d2d2SMike Kravetz 	return copied ? copied : err;
39460d4d2d2SMike Kravetz }
39560d4d2d2SMike Kravetz #else /* !CONFIG_HUGETLB_PAGE */
39660d4d2d2SMike Kravetz /* fail at build time if gcc attempts to use this */
39760d4d2d2SMike Kravetz extern ssize_t __mcopy_atomic_hugetlb(struct mm_struct *dst_mm,
39860d4d2d2SMike Kravetz 				      struct vm_area_struct *dst_vma,
39960d4d2d2SMike Kravetz 				      unsigned long dst_start,
40060d4d2d2SMike Kravetz 				      unsigned long src_start,
40160d4d2d2SMike Kravetz 				      unsigned long len,
40260d4d2d2SMike Kravetz 				      bool zeropage);
40360d4d2d2SMike Kravetz #endif /* CONFIG_HUGETLB_PAGE */
40460d4d2d2SMike Kravetz 
4053217d3c7SMike Rapoport static __always_inline ssize_t mfill_atomic_pte(struct mm_struct *dst_mm,
4063217d3c7SMike Rapoport 						pmd_t *dst_pmd,
4073217d3c7SMike Rapoport 						struct vm_area_struct *dst_vma,
4083217d3c7SMike Rapoport 						unsigned long dst_addr,
4093217d3c7SMike Rapoport 						unsigned long src_addr,
4103217d3c7SMike Rapoport 						struct page **page,
4113217d3c7SMike Rapoport 						bool zeropage)
4123217d3c7SMike Rapoport {
4133217d3c7SMike Rapoport 	ssize_t err;
4143217d3c7SMike Rapoport 
4155b51072eSAndrea Arcangeli 	/*
4165b51072eSAndrea Arcangeli 	 * The normal page fault path for a shmem will invoke the
4175b51072eSAndrea Arcangeli 	 * fault, fill the hole in the file and COW it right away. The
4185b51072eSAndrea Arcangeli 	 * result generates plain anonymous memory. So when we are
4195b51072eSAndrea Arcangeli 	 * asked to fill an hole in a MAP_PRIVATE shmem mapping, we'll
4205b51072eSAndrea Arcangeli 	 * generate anonymous memory directly without actually filling
4215b51072eSAndrea Arcangeli 	 * the hole. For the MAP_PRIVATE case the robustness check
4225b51072eSAndrea Arcangeli 	 * only happens in the pagetable (to verify it's still none)
4235b51072eSAndrea Arcangeli 	 * and not in the radix tree.
4245b51072eSAndrea Arcangeli 	 */
4255b51072eSAndrea Arcangeli 	if (!(dst_vma->vm_flags & VM_SHARED)) {
4263217d3c7SMike Rapoport 		if (!zeropage)
4273217d3c7SMike Rapoport 			err = mcopy_atomic_pte(dst_mm, dst_pmd, dst_vma,
4283217d3c7SMike Rapoport 					       dst_addr, src_addr, page);
4293217d3c7SMike Rapoport 		else
4303217d3c7SMike Rapoport 			err = mfill_zeropage_pte(dst_mm, dst_pmd,
4313217d3c7SMike Rapoport 						 dst_vma, dst_addr);
4323217d3c7SMike Rapoport 	} else {
4338fb44e54SMike Rapoport 		if (!zeropage)
4343217d3c7SMike Rapoport 			err = shmem_mcopy_atomic_pte(dst_mm, dst_pmd,
4353217d3c7SMike Rapoport 						     dst_vma, dst_addr,
4363217d3c7SMike Rapoport 						     src_addr, page);
4378fb44e54SMike Rapoport 		else
4388fb44e54SMike Rapoport 			err = shmem_mfill_zeropage_pte(dst_mm, dst_pmd,
4398fb44e54SMike Rapoport 						       dst_vma, dst_addr);
4403217d3c7SMike Rapoport 	}
4413217d3c7SMike Rapoport 
4423217d3c7SMike Rapoport 	return err;
4433217d3c7SMike Rapoport }
4443217d3c7SMike Rapoport 
445c1a4de99SAndrea Arcangeli static __always_inline ssize_t __mcopy_atomic(struct mm_struct *dst_mm,
446c1a4de99SAndrea Arcangeli 					      unsigned long dst_start,
447c1a4de99SAndrea Arcangeli 					      unsigned long src_start,
448c1a4de99SAndrea Arcangeli 					      unsigned long len,
449df2cc96eSMike Rapoport 					      bool zeropage,
450df2cc96eSMike Rapoport 					      bool *mmap_changing)
451c1a4de99SAndrea Arcangeli {
452c1a4de99SAndrea Arcangeli 	struct vm_area_struct *dst_vma;
453c1a4de99SAndrea Arcangeli 	ssize_t err;
454c1a4de99SAndrea Arcangeli 	pmd_t *dst_pmd;
455c1a4de99SAndrea Arcangeli 	unsigned long src_addr, dst_addr;
456b6ebaedbSAndrea Arcangeli 	long copied;
457b6ebaedbSAndrea Arcangeli 	struct page *page;
458c1a4de99SAndrea Arcangeli 
459c1a4de99SAndrea Arcangeli 	/*
460c1a4de99SAndrea Arcangeli 	 * Sanitize the command parameters:
461c1a4de99SAndrea Arcangeli 	 */
462c1a4de99SAndrea Arcangeli 	BUG_ON(dst_start & ~PAGE_MASK);
463c1a4de99SAndrea Arcangeli 	BUG_ON(len & ~PAGE_MASK);
464c1a4de99SAndrea Arcangeli 
465c1a4de99SAndrea Arcangeli 	/* Does the address range wrap, or is the span zero-sized? */
466c1a4de99SAndrea Arcangeli 	BUG_ON(src_start + len <= src_start);
467c1a4de99SAndrea Arcangeli 	BUG_ON(dst_start + len <= dst_start);
468c1a4de99SAndrea Arcangeli 
469b6ebaedbSAndrea Arcangeli 	src_addr = src_start;
470b6ebaedbSAndrea Arcangeli 	dst_addr = dst_start;
471b6ebaedbSAndrea Arcangeli 	copied = 0;
472b6ebaedbSAndrea Arcangeli 	page = NULL;
473b6ebaedbSAndrea Arcangeli retry:
474c1a4de99SAndrea Arcangeli 	down_read(&dst_mm->mmap_sem);
475c1a4de99SAndrea Arcangeli 
476c1a4de99SAndrea Arcangeli 	/*
477df2cc96eSMike Rapoport 	 * If memory mappings are changing because of non-cooperative
478df2cc96eSMike Rapoport 	 * operation (e.g. mremap) running in parallel, bail out and
479df2cc96eSMike Rapoport 	 * request the user to retry later
480df2cc96eSMike Rapoport 	 */
481df2cc96eSMike Rapoport 	err = -EAGAIN;
482df2cc96eSMike Rapoport 	if (mmap_changing && READ_ONCE(*mmap_changing))
483df2cc96eSMike Rapoport 		goto out_unlock;
484df2cc96eSMike Rapoport 
485df2cc96eSMike Rapoport 	/*
486c1a4de99SAndrea Arcangeli 	 * Make sure the vma is not shared, that the dst range is
487c1a4de99SAndrea Arcangeli 	 * both valid and fully within a single existing vma.
488c1a4de99SAndrea Arcangeli 	 */
48927d02568SMike Rapoport 	err = -ENOENT;
490*643aa36eSWei Yang 	dst_vma = find_dst_vma(dst_mm, dst_start, len);
49126071cedSMike Rapoport 	if (!dst_vma)
49226071cedSMike Rapoport 		goto out_unlock;
49327d02568SMike Rapoport 
49427d02568SMike Rapoport 	err = -EINVAL;
49527d02568SMike Rapoport 	/*
49627d02568SMike Rapoport 	 * shmem_zero_setup is invoked in mmap for MAP_ANONYMOUS|MAP_SHARED but
49727d02568SMike Rapoport 	 * it will overwrite vm_ops, so vma_is_anonymous must return false.
49827d02568SMike Rapoport 	 */
49927d02568SMike Rapoport 	if (WARN_ON_ONCE(vma_is_anonymous(dst_vma) &&
50027d02568SMike Rapoport 	    dst_vma->vm_flags & VM_SHARED))
50127d02568SMike Rapoport 		goto out_unlock;
50227d02568SMike Rapoport 
50327d02568SMike Rapoport 	/*
50427d02568SMike Rapoport 	 * If this is a HUGETLB vma, pass off to appropriate routine
50527d02568SMike Rapoport 	 */
50627d02568SMike Rapoport 	if (is_vm_hugetlb_page(dst_vma))
50727d02568SMike Rapoport 		return  __mcopy_atomic_hugetlb(dst_mm, dst_vma, dst_start,
50827d02568SMike Rapoport 						src_start, len, zeropage);
50927d02568SMike Rapoport 
51026071cedSMike Rapoport 	if (!vma_is_anonymous(dst_vma) && !vma_is_shmem(dst_vma))
511b6ebaedbSAndrea Arcangeli 		goto out_unlock;
512c1a4de99SAndrea Arcangeli 
513c1a4de99SAndrea Arcangeli 	/*
514c1a4de99SAndrea Arcangeli 	 * Ensure the dst_vma has a anon_vma or this page
515c1a4de99SAndrea Arcangeli 	 * would get a NULL anon_vma when moved in the
516c1a4de99SAndrea Arcangeli 	 * dst_vma.
517c1a4de99SAndrea Arcangeli 	 */
518c1a4de99SAndrea Arcangeli 	err = -ENOMEM;
5195b51072eSAndrea Arcangeli 	if (!(dst_vma->vm_flags & VM_SHARED) &&
5205b51072eSAndrea Arcangeli 	    unlikely(anon_vma_prepare(dst_vma)))
521b6ebaedbSAndrea Arcangeli 		goto out_unlock;
522c1a4de99SAndrea Arcangeli 
523b6ebaedbSAndrea Arcangeli 	while (src_addr < src_start + len) {
524c1a4de99SAndrea Arcangeli 		pmd_t dst_pmdval;
525b6ebaedbSAndrea Arcangeli 
526c1a4de99SAndrea Arcangeli 		BUG_ON(dst_addr >= dst_start + len);
527b6ebaedbSAndrea Arcangeli 
528c1a4de99SAndrea Arcangeli 		dst_pmd = mm_alloc_pmd(dst_mm, dst_addr);
529c1a4de99SAndrea Arcangeli 		if (unlikely(!dst_pmd)) {
530c1a4de99SAndrea Arcangeli 			err = -ENOMEM;
531c1a4de99SAndrea Arcangeli 			break;
532c1a4de99SAndrea Arcangeli 		}
533c1a4de99SAndrea Arcangeli 
534c1a4de99SAndrea Arcangeli 		dst_pmdval = pmd_read_atomic(dst_pmd);
535c1a4de99SAndrea Arcangeli 		/*
536c1a4de99SAndrea Arcangeli 		 * If the dst_pmd is mapped as THP don't
537c1a4de99SAndrea Arcangeli 		 * override it and just be strict.
538c1a4de99SAndrea Arcangeli 		 */
539c1a4de99SAndrea Arcangeli 		if (unlikely(pmd_trans_huge(dst_pmdval))) {
540c1a4de99SAndrea Arcangeli 			err = -EEXIST;
541c1a4de99SAndrea Arcangeli 			break;
542c1a4de99SAndrea Arcangeli 		}
543c1a4de99SAndrea Arcangeli 		if (unlikely(pmd_none(dst_pmdval)) &&
5444cf58924SJoel Fernandes (Google) 		    unlikely(__pte_alloc(dst_mm, dst_pmd))) {
545c1a4de99SAndrea Arcangeli 			err = -ENOMEM;
546c1a4de99SAndrea Arcangeli 			break;
547c1a4de99SAndrea Arcangeli 		}
548c1a4de99SAndrea Arcangeli 		/* If an huge pmd materialized from under us fail */
549c1a4de99SAndrea Arcangeli 		if (unlikely(pmd_trans_huge(*dst_pmd))) {
550c1a4de99SAndrea Arcangeli 			err = -EFAULT;
551c1a4de99SAndrea Arcangeli 			break;
552c1a4de99SAndrea Arcangeli 		}
553c1a4de99SAndrea Arcangeli 
554c1a4de99SAndrea Arcangeli 		BUG_ON(pmd_none(*dst_pmd));
555c1a4de99SAndrea Arcangeli 		BUG_ON(pmd_trans_huge(*dst_pmd));
556c1a4de99SAndrea Arcangeli 
5573217d3c7SMike Rapoport 		err = mfill_atomic_pte(dst_mm, dst_pmd, dst_vma, dst_addr,
5583217d3c7SMike Rapoport 				       src_addr, &page, zeropage);
559c1a4de99SAndrea Arcangeli 		cond_resched();
560c1a4de99SAndrea Arcangeli 
5619e368259SAndrea Arcangeli 		if (unlikely(err == -ENOENT)) {
562b6ebaedbSAndrea Arcangeli 			void *page_kaddr;
563b6ebaedbSAndrea Arcangeli 
564b6ebaedbSAndrea Arcangeli 			up_read(&dst_mm->mmap_sem);
565b6ebaedbSAndrea Arcangeli 			BUG_ON(!page);
566b6ebaedbSAndrea Arcangeli 
567b6ebaedbSAndrea Arcangeli 			page_kaddr = kmap(page);
568b6ebaedbSAndrea Arcangeli 			err = copy_from_user(page_kaddr,
569b6ebaedbSAndrea Arcangeli 					     (const void __user *) src_addr,
570b6ebaedbSAndrea Arcangeli 					     PAGE_SIZE);
571b6ebaedbSAndrea Arcangeli 			kunmap(page);
572b6ebaedbSAndrea Arcangeli 			if (unlikely(err)) {
573b6ebaedbSAndrea Arcangeli 				err = -EFAULT;
574b6ebaedbSAndrea Arcangeli 				goto out;
575b6ebaedbSAndrea Arcangeli 			}
576b6ebaedbSAndrea Arcangeli 			goto retry;
577b6ebaedbSAndrea Arcangeli 		} else
578b6ebaedbSAndrea Arcangeli 			BUG_ON(page);
579b6ebaedbSAndrea Arcangeli 
580c1a4de99SAndrea Arcangeli 		if (!err) {
581c1a4de99SAndrea Arcangeli 			dst_addr += PAGE_SIZE;
582c1a4de99SAndrea Arcangeli 			src_addr += PAGE_SIZE;
583c1a4de99SAndrea Arcangeli 			copied += PAGE_SIZE;
584c1a4de99SAndrea Arcangeli 
585c1a4de99SAndrea Arcangeli 			if (fatal_signal_pending(current))
586c1a4de99SAndrea Arcangeli 				err = -EINTR;
587c1a4de99SAndrea Arcangeli 		}
588c1a4de99SAndrea Arcangeli 		if (err)
589c1a4de99SAndrea Arcangeli 			break;
590c1a4de99SAndrea Arcangeli 	}
591c1a4de99SAndrea Arcangeli 
592b6ebaedbSAndrea Arcangeli out_unlock:
593c1a4de99SAndrea Arcangeli 	up_read(&dst_mm->mmap_sem);
594b6ebaedbSAndrea Arcangeli out:
595b6ebaedbSAndrea Arcangeli 	if (page)
59609cbfeafSKirill A. Shutemov 		put_page(page);
597c1a4de99SAndrea Arcangeli 	BUG_ON(copied < 0);
598c1a4de99SAndrea Arcangeli 	BUG_ON(err > 0);
599c1a4de99SAndrea Arcangeli 	BUG_ON(!copied && !err);
600c1a4de99SAndrea Arcangeli 	return copied ? copied : err;
601c1a4de99SAndrea Arcangeli }
602c1a4de99SAndrea Arcangeli 
603c1a4de99SAndrea Arcangeli ssize_t mcopy_atomic(struct mm_struct *dst_mm, unsigned long dst_start,
604df2cc96eSMike Rapoport 		     unsigned long src_start, unsigned long len,
605df2cc96eSMike Rapoport 		     bool *mmap_changing)
606c1a4de99SAndrea Arcangeli {
607df2cc96eSMike Rapoport 	return __mcopy_atomic(dst_mm, dst_start, src_start, len, false,
608df2cc96eSMike Rapoport 			      mmap_changing);
609c1a4de99SAndrea Arcangeli }
610c1a4de99SAndrea Arcangeli 
611c1a4de99SAndrea Arcangeli ssize_t mfill_zeropage(struct mm_struct *dst_mm, unsigned long start,
612df2cc96eSMike Rapoport 		       unsigned long len, bool *mmap_changing)
613c1a4de99SAndrea Arcangeli {
614df2cc96eSMike Rapoport 	return __mcopy_atomic(dst_mm, start, 0, len, true, mmap_changing);
615c1a4de99SAndrea Arcangeli }
616