1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/init.h>
20#include <linux/fs.h>
21#include <linux/mm.h>
22#include <linux/hugetlb.h>
23#include <linux/pagemap.h>
24#include <linux/slab.h>
25#include <linux/err.h>
26#include <linux/sysctl.h>
27#include <linux/mman.h>
28#include <asm/tlb.h>
29#include <asm/tlbflush.h>
30
31pte_t *huge_pte_alloc(struct mm_struct *mm,
32 unsigned long addr, unsigned long sz)
33{
34 pgd_t *pgd;
35 pud_t *pud;
36 pte_t *pte = NULL;
37
38
39 BUG_ON(sz != PMD_SIZE);
40
41 pgd = pgd_offset(mm, addr);
42 pud = pud_alloc(mm, pgd, addr);
43 if (pud)
44 pte = (pte_t *) pmd_alloc(mm, pud, addr);
45 BUG_ON(pte && !pte_none(*pte) && !pte_huge(*pte));
46
47 return pte;
48}
49
50pte_t *huge_pte_offset(struct mm_struct *mm, unsigned long addr)
51{
52 pgd_t *pgd;
53 pud_t *pud;
54 pmd_t *pmd = NULL;
55
56 pgd = pgd_offset(mm, addr);
57 if (pgd_present(*pgd)) {
58 pud = pud_offset(pgd, addr);
59 if (pud_present(*pud))
60 pmd = pmd_offset(pud, addr);
61 }
62 return (pte_t *) pmd;
63}
64
65#ifdef HUGETLB_TEST
66struct page *follow_huge_addr(struct mm_struct *mm, unsigned long address,
67 int write)
68{
69 unsigned long start = address;
70 int length = 1;
71 int nr;
72 struct page *page;
73 struct vm_area_struct *vma;
74
75 vma = find_vma(mm, addr);
76 if (!vma || !is_vm_hugetlb_page(vma))
77 return ERR_PTR(-EINVAL);
78
79 pte = huge_pte_offset(mm, address);
80
81
82 WARN_ON(!pte || pte_none(*pte));
83
84 page = &pte_page(*pte)[vpfn % (HPAGE_SIZE/PAGE_SIZE)];
85
86 WARN_ON(!PageHead(page));
87
88 return page;
89}
90
91int pmd_huge(pmd_t pmd)
92{
93 return 0;
94}
95
96int pud_huge(pud_t pud)
97{
98 return 0;
99}
100
101struct page *follow_huge_pmd(struct mm_struct *mm, unsigned long address,
102 pmd_t *pmd, int write)
103{
104 return NULL;
105}
106
107#else
108
109struct page *follow_huge_addr(struct mm_struct *mm, unsigned long address,
110 int write)
111{
112 return ERR_PTR(-EINVAL);
113}
114
115int pmd_huge(pmd_t pmd)
116{
117 return !!(pmd_val(pmd) & _PAGE_HUGE_PAGE);
118}
119
120int pud_huge(pud_t pud)
121{
122 return !!(pud_val(pud) & _PAGE_HUGE_PAGE);
123}
124
125struct page *follow_huge_pmd(struct mm_struct *mm, unsigned long address,
126 pmd_t *pmd, int write)
127{
128 struct page *page;
129
130 page = pte_page(*(pte_t *)pmd);
131 if (page)
132 page += ((address & ~PMD_MASK) >> PAGE_SHIFT);
133 return page;
134}
135
136struct page *follow_huge_pud(struct mm_struct *mm, unsigned long address,
137 pud_t *pud, int write)
138{
139 struct page *page;
140
141 page = pte_page(*(pte_t *)pud);
142 if (page)
143 page += ((address & ~PUD_MASK) >> PAGE_SHIFT);
144 return page;
145}
146
147int huge_pmd_unshare(struct mm_struct *mm, unsigned long *addr, pte_t *ptep)
148{
149 return 0;
150}
151
152#endif
153
154#ifdef HAVE_ARCH_HUGETLB_UNMAPPED_AREA
155static unsigned long hugetlb_get_unmapped_area_bottomup(struct file *file,
156 unsigned long addr, unsigned long len,
157 unsigned long pgoff, unsigned long flags)
158{
159 struct hstate *h = hstate_file(file);
160 struct mm_struct *mm = current->mm;
161 struct vm_area_struct *vma;
162 unsigned long start_addr;
163
164 if (len > mm->cached_hole_size) {
165 start_addr = mm->free_area_cache;
166 } else {
167 start_addr = TASK_UNMAPPED_BASE;
168 mm->cached_hole_size = 0;
169 }
170
171full_search:
172 addr = ALIGN(start_addr, huge_page_size(h));
173
174 for (vma = find_vma(mm, addr); ; vma = vma->vm_next) {
175
176 if (TASK_SIZE - len < addr) {
177
178
179
180
181 if (start_addr != TASK_UNMAPPED_BASE) {
182 start_addr = TASK_UNMAPPED_BASE;
183 mm->cached_hole_size = 0;
184 goto full_search;
185 }
186 return -ENOMEM;
187 }
188 if (!vma || addr + len <= vma->vm_start) {
189 mm->free_area_cache = addr + len;
190 return addr;
191 }
192 if (addr + mm->cached_hole_size < vma->vm_start)
193 mm->cached_hole_size = vma->vm_start - addr;
194 addr = ALIGN(vma->vm_end, huge_page_size(h));
195 }
196}
197
198static unsigned long hugetlb_get_unmapped_area_topdown(struct file *file,
199 unsigned long addr0, unsigned long len,
200 unsigned long pgoff, unsigned long flags)
201{
202 struct hstate *h = hstate_file(file);
203 struct mm_struct *mm = current->mm;
204 struct vm_area_struct *vma, *prev_vma;
205 unsigned long base = mm->mmap_base, addr = addr0;
206 unsigned long largest_hole = mm->cached_hole_size;
207 int first_time = 1;
208
209
210 if (mm->free_area_cache > base)
211 mm->free_area_cache = base;
212
213 if (len <= largest_hole) {
214 largest_hole = 0;
215 mm->free_area_cache = base;
216 }
217try_again:
218
219 if (mm->free_area_cache < len)
220 goto fail;
221
222
223 addr = (mm->free_area_cache - len) & huge_page_mask(h);
224 do {
225
226
227
228
229 vma = find_vma_prev(mm, addr, &prev_vma);
230 if (!vma) {
231 return addr;
232 break;
233 }
234
235
236
237
238
239 if (addr + len <= vma->vm_start &&
240 (!prev_vma || (addr >= prev_vma->vm_end))) {
241
242 mm->cached_hole_size = largest_hole;
243 mm->free_area_cache = addr;
244 return addr;
245 } else {
246
247 if (mm->free_area_cache == vma->vm_end) {
248 mm->free_area_cache = vma->vm_start;
249 mm->cached_hole_size = largest_hole;
250 }
251 }
252
253
254 if (addr + largest_hole < vma->vm_start)
255 largest_hole = vma->vm_start - addr;
256
257
258 addr = (vma->vm_start - len) & huge_page_mask(h);
259
260 } while (len <= vma->vm_start);
261
262fail:
263
264
265
266
267 if (first_time) {
268 mm->free_area_cache = base;
269 largest_hole = 0;
270 first_time = 0;
271 goto try_again;
272 }
273
274
275
276
277
278
279 mm->free_area_cache = TASK_UNMAPPED_BASE;
280 mm->cached_hole_size = ~0UL;
281 addr = hugetlb_get_unmapped_area_bottomup(file, addr0,
282 len, pgoff, flags);
283
284
285
286
287 mm->free_area_cache = base;
288 mm->cached_hole_size = ~0UL;
289
290 return addr;
291}
292
293unsigned long hugetlb_get_unmapped_area(struct file *file, unsigned long addr,
294 unsigned long len, unsigned long pgoff, unsigned long flags)
295{
296 struct hstate *h = hstate_file(file);
297 struct mm_struct *mm = current->mm;
298 struct vm_area_struct *vma;
299
300 if (len & ~huge_page_mask(h))
301 return -EINVAL;
302 if (len > TASK_SIZE)
303 return -ENOMEM;
304
305 if (flags & MAP_FIXED) {
306 if (prepare_hugepage_range(file, addr, len))
307 return -EINVAL;
308 return addr;
309 }
310
311 if (addr) {
312 addr = ALIGN(addr, huge_page_size(h));
313 vma = find_vma(mm, addr);
314 if (TASK_SIZE - len >= addr &&
315 (!vma || addr + len <= vma->vm_start))
316 return addr;
317 }
318 if (current->mm->get_unmapped_area == arch_get_unmapped_area)
319 return hugetlb_get_unmapped_area_bottomup(file, addr, len,
320 pgoff, flags);
321 else
322 return hugetlb_get_unmapped_area_topdown(file, addr, len,
323 pgoff, flags);
324}
325
326static __init int setup_hugepagesz(char *opt)
327{
328 unsigned long ps = memparse(opt, &opt);
329 if (ps == PMD_SIZE) {
330 hugetlb_add_hstate(PMD_SHIFT - PAGE_SHIFT);
331 } else if (ps == PUD_SIZE) {
332 hugetlb_add_hstate(PUD_SHIFT - PAGE_SHIFT);
333 } else {
334 pr_err("hugepagesz: Unsupported page size %lu M\n",
335 ps >> 20);
336 return 0;
337 }
338 return 1;
339}
340__setup("hugepagesz=", setup_hugepagesz);
341
342#endif
343