Refactor map_page_at_addr
[akaros.git] / kern / src / mm.c
1 /* Copyright (c) 2009, 2010 The Regents of the University of California
2  * Barret Rhoden <brho@cs.berkeley.edu>
3  * See LICENSE for details.
4  *
5  * Virtual memory management functions.  Creation, modification, etc, of virtual
6  * memory regions (VMRs) as well as mmap(), mprotect(), and munmap().
7  *
8  * In general, error checking / bounds checks are done in the main function
9  * (e.g. mmap()), and the work is done in a do_ function (e.g. do_mmap()).
10  * Versions of those functions that are called when the vmr lock is already held
11  * begin with __ (e.g. __do_munmap()).
12  *
13  * Note that if we were called from kern/src/syscall.c, we probably don't have
14  * an edible reference to p. */
15
16 #include <frontend.h>
17 #include <ros/common.h>
18 #include <pmap.h>
19 #include <mm.h>
20 #include <process.h>
21 #include <stdio.h>
22 #include <syscall.h>
23 #include <slab.h>
24 #include <kmalloc.h>
25 #include <vfs.h>
26 #include <smp.h>
27 #include <profiler.h>
28 #include <umem.h>
29
30 struct kmem_cache *vmr_kcache;
31
32 static int __vmr_free_pgs(struct proc *p, pte_t pte, void *va, void *arg);
33 static int populate_pm_va(struct proc *p, uintptr_t va, unsigned long nr_pgs,
34                           int pte_prot, struct page_map *pm, size_t offset,
35                           int flags, bool exec);
36
37 /* minor helper, will ease the file->chan transition */
38 static struct page_map *file2pm(struct file *file)
39 {
40         return file->f_mapping;
41 }
42
43 void vmr_init(void)
44 {
45         vmr_kcache = kmem_cache_create("vm_regions", sizeof(struct vm_region),
46                                        __alignof__(struct dentry), 0, 0, 0);
47 }
48
49 /* For now, the caller will set the prot, flags, file, and offset.  In the
50  * future, we may put those in here, to do clever things with merging vm_regions
51  * that are the same.
52  *
53  * TODO: take a look at solari's vmem alloc.  And consider keeping these in a
54  * tree of some sort for easier lookups. */
55 struct vm_region *create_vmr(struct proc *p, uintptr_t va, size_t len)
56 {
57         struct vm_region *vmr = 0, *vm_i, *vm_next;
58         uintptr_t gap_end;
59
60         assert(!PGOFF(va));
61         assert(!PGOFF(len));
62         assert(__is_user_addr((void*)va, len, UMAPTOP));
63         /* Is there room before the first one: */
64         vm_i = TAILQ_FIRST(&p->vm_regions);
65         /* This works for now, but if all we have is BRK_END ones, we'll start
66          * growing backwards (TODO) */
67         if (!vm_i || (va + len <= vm_i->vm_base)) {
68                 vmr = kmem_cache_alloc(vmr_kcache, 0);
69                 if (!vmr)
70                         panic("EOM!");
71                 memset(vmr, 0, sizeof(struct vm_region));
72                 vmr->vm_base = va;
73                 TAILQ_INSERT_HEAD(&p->vm_regions, vmr, vm_link);
74         } else {
75                 TAILQ_FOREACH(vm_i, &p->vm_regions, vm_link) {
76                         vm_next = TAILQ_NEXT(vm_i, vm_link);
77                         gap_end = vm_next ? vm_next->vm_base : UMAPTOP;
78                         /* skip til we get past the 'hint' va */
79                         if (va >= gap_end)
80                                 continue;
81                         /* Find a gap that is big enough */
82                         if (gap_end - vm_i->vm_end >= len) {
83                                 vmr = kmem_cache_alloc(vmr_kcache, 0);
84                                 if (!vmr)
85                                         panic("EOM!");
86                                 memset(vmr, 0, sizeof(struct vm_region));
87                                 /* if we can put it at va, let's do that.  o/w, put it so it
88                                  * fits */
89                                 if ((gap_end >= va + len) && (va >= vm_i->vm_end))
90                                         vmr->vm_base = va;
91                                 else
92                                         vmr->vm_base = vm_i->vm_end;
93                                 TAILQ_INSERT_AFTER(&p->vm_regions, vm_i, vmr, vm_link);
94                                 break;
95                         }
96                 }
97         }
98         /* Finalize the creation, if we got one */
99         if (vmr) {
100                 vmr->vm_proc = p;
101                 vmr->vm_end = vmr->vm_base + len;
102         }
103         if (!vmr)
104                 warn("Not making a VMR, wanted %p, + %p = %p", va, len, va + len);
105         return vmr;
106 }
107
108 /* Split a VMR at va, returning the new VMR.  It is set up the same way, with
109  * file offsets fixed accordingly.  'va' is the beginning of the new one, and
110  * must be page aligned. */
111 struct vm_region *split_vmr(struct vm_region *old_vmr, uintptr_t va)
112 {
113         struct vm_region *new_vmr;
114
115         assert(!PGOFF(va));
116         if ((old_vmr->vm_base >= va) || (old_vmr->vm_end <= va))
117                 return 0;
118         new_vmr = kmem_cache_alloc(vmr_kcache, 0);
119         TAILQ_INSERT_AFTER(&old_vmr->vm_proc->vm_regions, old_vmr, new_vmr,
120                            vm_link);
121         new_vmr->vm_proc = old_vmr->vm_proc;
122         new_vmr->vm_base = va;
123         new_vmr->vm_end = old_vmr->vm_end;
124         old_vmr->vm_end = va;
125         new_vmr->vm_prot = old_vmr->vm_prot;
126         new_vmr->vm_flags = old_vmr->vm_flags;
127         if (old_vmr->vm_file) {
128                 kref_get(&old_vmr->vm_file->f_kref, 1);
129                 new_vmr->vm_file = old_vmr->vm_file;
130                 new_vmr->vm_foff = old_vmr->vm_foff +
131                                       old_vmr->vm_end - old_vmr->vm_base;
132                 pm_add_vmr(file2pm(old_vmr->vm_file), new_vmr);
133         } else {
134                 new_vmr->vm_file = 0;
135                 new_vmr->vm_foff = 0;
136         }
137         return new_vmr;
138 }
139
140 /* Merges two vm regions.  For now, it will check to make sure they are the
141  * same.  The second one will be destroyed. */
142 int merge_vmr(struct vm_region *first, struct vm_region *second)
143 {
144         assert(first->vm_proc == second->vm_proc);
145         if ((first->vm_end != second->vm_base) ||
146             (first->vm_prot != second->vm_prot) ||
147             (first->vm_flags != second->vm_flags) ||
148             (first->vm_file != second->vm_file))
149                 return -1;
150         if ((first->vm_file) && (second->vm_foff != first->vm_foff +
151                                  first->vm_end - first->vm_base))
152                 return -1;
153         first->vm_end = second->vm_end;
154         destroy_vmr(second);
155         return 0;
156 }
157
158 /* Attempts to merge vmr with adjacent VMRs, returning a ptr to be used for vmr.
159  * It could be the same struct vmr, or possibly another one (usually lower in
160  * the address space. */
161 struct vm_region *merge_me(struct vm_region *vmr)
162 {
163         struct vm_region *vmr_temp;
164         /* Merge will fail if it cannot do it.  If it succeeds, the second VMR is
165          * destroyed, so we need to be a bit careful. */
166         vmr_temp = TAILQ_PREV(vmr, vmr_tailq, vm_link);
167         if (vmr_temp)
168                 if (!merge_vmr(vmr_temp, vmr))
169                         vmr = vmr_temp;
170         vmr_temp = TAILQ_NEXT(vmr, vm_link);
171         if (vmr_temp)
172                 merge_vmr(vmr, vmr_temp);
173         return vmr;
174 }
175
176 /* Grows the vm region up to (and not including) va.  Fails if another is in the
177  * way, etc. */
178 int grow_vmr(struct vm_region *vmr, uintptr_t va)
179 {
180         assert(!PGOFF(va));
181         struct vm_region *next = TAILQ_NEXT(vmr, vm_link);
182         if (next && next->vm_base < va)
183                 return -1;
184         if (va <= vmr->vm_end)
185                 return -1;
186         vmr->vm_end = va;
187         return 0;
188 }
189
190 /* Shrinks the vm region down to (and not including) va.  Whoever calls this
191  * will need to sort out the page table entries. */
192 int shrink_vmr(struct vm_region *vmr, uintptr_t va)
193 {
194         assert(!PGOFF(va));
195         if ((va < vmr->vm_base) || (va > vmr->vm_end))
196                 return -1;
197         vmr->vm_end = va;
198         return 0;
199 }
200
201 /* Called by the unmapper, just cleans up.  Whoever calls this will need to sort
202  * out the page table entries. */
203 void destroy_vmr(struct vm_region *vmr)
204 {
205         if (vmr->vm_file) {
206                 pm_remove_vmr(file2pm(vmr->vm_file), vmr);
207                 kref_put(&vmr->vm_file->f_kref);
208         }
209         TAILQ_REMOVE(&vmr->vm_proc->vm_regions, vmr, vm_link);
210         kmem_cache_free(vmr_kcache, vmr);
211 }
212
213 /* Given a va and a proc (later an mm, possibly), returns the owning vmr, or 0
214  * if there is none. */
215 struct vm_region *find_vmr(struct proc *p, uintptr_t va)
216 {
217         struct vm_region *vmr;
218         /* ugly linear seach */
219         TAILQ_FOREACH(vmr, &p->vm_regions, vm_link) {
220                 if ((vmr->vm_base <= va) && (vmr->vm_end > va))
221                         return vmr;
222         }
223         return 0;
224 }
225
226 /* Finds the first vmr after va (including the one holding va), or 0 if there is
227  * none. */
228 struct vm_region *find_first_vmr(struct proc *p, uintptr_t va)
229 {
230         struct vm_region *vmr;
231         /* ugly linear seach */
232         TAILQ_FOREACH(vmr, &p->vm_regions, vm_link) {
233                 if ((vmr->vm_base <= va) && (vmr->vm_end > va))
234                         return vmr;
235                 if (vmr->vm_base > va)
236                         return vmr;
237         }
238         return 0;
239 }
240
241 /* Makes sure that no VMRs cross either the start or end of the given region
242  * [va, va + len), splitting any VMRs that are on the endpoints. */
243 void isolate_vmrs(struct proc *p, uintptr_t va, size_t len)
244 {
245         struct vm_region *vmr;
246         if ((vmr = find_vmr(p, va)))
247                 split_vmr(vmr, va);
248         /* TODO: don't want to do another find (linear search) */
249         if ((vmr = find_vmr(p, va + len)))
250                 split_vmr(vmr, va + len);
251 }
252
253 void unmap_and_destroy_vmrs(struct proc *p)
254 {
255         struct vm_region *vmr_i, *vmr_temp;
256         /* this only gets called from __proc_free, so there should be no sync
257          * concerns.  still, better safe than sorry. */
258         spin_lock(&p->vmr_lock);
259         p->vmr_history++;
260         spin_lock(&p->pte_lock);
261         TAILQ_FOREACH(vmr_i, &p->vm_regions, vm_link) {
262                 /* note this CB sets the PTE = 0, regardless of if it was P or not */
263                 env_user_mem_walk(p, (void*)vmr_i->vm_base,
264                                   vmr_i->vm_end - vmr_i->vm_base, __vmr_free_pgs, 0);
265         }
266         spin_unlock(&p->pte_lock);
267         /* need the safe style, since destroy_vmr modifies the list.  also, we want
268          * to do this outside the pte lock, since it grabs the pm lock. */
269         TAILQ_FOREACH_SAFE(vmr_i, &p->vm_regions, vm_link, vmr_temp)
270                 destroy_vmr(vmr_i);
271         spin_unlock(&p->vmr_lock);
272 }
273
274 /* Helper: copies the contents of pages from p to new p.  For pages that aren't
275  * present, once we support swapping or CoW, we can do something more
276  * intelligent.  0 on success, -ERROR on failure.  Can't handle jumbos. */
277 static int copy_pages(struct proc *p, struct proc *new_p, uintptr_t va_start,
278                       uintptr_t va_end)
279 {
280         /* Sanity checks.  If these fail, we had a screwed up VMR.
281          * Check for: alignment, wraparound, or userspace addresses */
282         if ((PGOFF(va_start)) ||
283             (PGOFF(va_end)) ||
284             (va_end < va_start) ||      /* now, start > UMAPTOP -> end > UMAPTOP */
285             (va_end > UMAPTOP)) {
286                 warn("VMR mapping is probably screwed up (%p - %p)", va_start,
287                      va_end);
288                 return -EINVAL;
289         }
290         int copy_page(struct proc *p, pte_t pte, void *va, void *arg) {
291                 struct proc *new_p = (struct proc*)arg;
292                 struct page *pp;
293                 if (pte_is_unmapped(pte))
294                         return 0;
295                 /* pages could be !P, but right now that's only for file backed VMRs
296                  * undergoing page removal, which isn't the caller of copy_pages. */
297                 if (pte_is_mapped(pte)) {
298                         /* TODO: check for jumbos */
299                         if (upage_alloc(new_p, &pp, 0))
300                                 return -ENOMEM;
301                         memcpy(page2kva(pp), KADDR(pte_get_paddr(pte)), PGSIZE);
302                         if (page_insert(new_p->env_pgdir, pp, va, pte_get_settings(pte))) {
303                                 page_decref(pp);
304                                 return -ENOMEM;
305                         }
306                 } else if (pte_is_paged_out(pte)) {
307                         /* TODO: (SWAP) will need to either make a copy or CoW/refcnt the
308                          * backend store.  For now, this PTE will be the same as the
309                          * original PTE */
310                         panic("Swapping not supported!");
311                 } else {
312                         panic("Weird PTE %p in %s!", pte_print(pte), __FUNCTION__);
313                 }
314                 return 0;
315         }
316         return env_user_mem_walk(p, (void*)va_start, va_end - va_start, &copy_page,
317                                  new_p);
318 }
319
320 static int fill_vmr(struct proc *p, struct proc *new_p, struct vm_region *vmr)
321 {
322         int ret = 0;
323
324         if ((!vmr->vm_file) || (vmr->vm_flags & MAP_PRIVATE)) {
325                 assert(!(vmr->vm_flags & MAP_SHARED));
326                 ret = copy_pages(p, new_p, vmr->vm_base, vmr->vm_end);
327         } else {
328                 /* non-private file, i.e. page cacheable.  we have to honor MAP_LOCKED,
329                  * (but we might be able to ignore MAP_POPULATE). */
330                 if (vmr->vm_flags & MAP_LOCKED) {
331                         /* need to keep the file alive in case we unlock/block */
332                         kref_get(&vmr->vm_file->f_kref, 1);
333                         /* math is a bit nasty if vm_base isn't page aligned */
334                         assert(!PGOFF(vmr->vm_base));
335                         ret = populate_pm_va(new_p, vmr->vm_base,
336                                              (vmr->vm_end - vmr->vm_base) >> PGSHIFT,
337                                              vmr->vm_prot, vmr->vm_file->f_mapping,
338                                              vmr->vm_foff, vmr->vm_flags,
339                                              vmr->vm_prot & PROT_EXEC);
340                         kref_put(&vmr->vm_file->f_kref);
341                 }
342         }
343         return ret;
344 }
345
346 /* This will make new_p have the same VMRs as p, and it will make sure all
347  * physical pages are copied over, with the exception of MAP_SHARED files.
348  * MAP_SHARED files that are also MAP_LOCKED will be attached to the process -
349  * presumably they are in the page cache since the parent locked them.  This is
350  * all pretty nasty.
351  *
352  * This is used by fork().
353  *
354  * Note that if you are working on a VMR that is a file, you'll want to be
355  * careful about how it is mapped (SHARED, PRIVATE, etc). */
356 int duplicate_vmrs(struct proc *p, struct proc *new_p)
357 {
358         int ret = 0;
359         struct vm_region *vmr, *vm_i;
360
361         TAILQ_FOREACH(vm_i, &p->vm_regions, vm_link) {
362                 vmr = kmem_cache_alloc(vmr_kcache, 0);
363                 if (!vmr)
364                         return -ENOMEM;
365                 vmr->vm_proc = new_p;
366                 vmr->vm_base = vm_i->vm_base;
367                 vmr->vm_end = vm_i->vm_end;
368                 vmr->vm_prot = vm_i->vm_prot;
369                 vmr->vm_flags = vm_i->vm_flags;
370                 vmr->vm_file = vm_i->vm_file;
371                 vmr->vm_foff = vm_i->vm_foff;
372                 if (vm_i->vm_file) {
373                         kref_get(&vm_i->vm_file->f_kref, 1);
374                         pm_add_vmr(file2pm(vm_i->vm_file), vmr);
375                 }
376                 ret = fill_vmr(p, new_p, vmr);
377                 if (ret) {
378                         if (vm_i->vm_file) {
379                                 pm_remove_vmr(file2pm(vm_i->vm_file), vmr);
380                                 kref_put(&vm_i->vm_file->f_kref);
381                         }
382                         kmem_cache_free(vmr_kcache, vm_i);
383                         return ret;
384                 }
385                 TAILQ_INSERT_TAIL(&new_p->vm_regions, vmr, vm_link);
386         }
387         return 0;
388 }
389
390 void print_vmrs(struct proc *p)
391 {
392         int count = 0;
393         struct vm_region *vmr;
394         printk("VM Regions for proc %d\n", p->pid);
395         printk("NR:"
396                "                                     Range:"
397                "       Prot,"
398                "      Flags,"
399                "               File,"
400                "                Off\n");
401         TAILQ_FOREACH(vmr, &p->vm_regions, vm_link)
402                 printk("%02d: (%p - %p): 0x%08x, 0x%08x, %p, %p\n", count++,
403                        vmr->vm_base, vmr->vm_end, vmr->vm_prot, vmr->vm_flags,
404                        vmr->vm_file, vmr->vm_foff);
405 }
406
407 void enumerate_vmrs(struct proc *p,
408                                         void (*func)(struct vm_region *vmr, void *opaque),
409                                         void *opaque)
410 {
411         struct vm_region *vmr;
412
413         spin_lock(&p->vmr_lock);
414         TAILQ_FOREACH(vmr, &p->vm_regions, vm_link)
415                 func(vmr, opaque);
416         spin_unlock(&p->vmr_lock);
417 }
418
419 /* Error values aren't quite comprehensive - check man mmap() once we do better
420  * with the FS.
421  *
422  * The mmap call's offset is in units of PGSIZE (like Linux's mmap2()), but
423  * internally, the offset is tracked in bytes.  The reason for the PGSIZE is for
424  * 32bit apps to enumerate large files, but a full 64bit system won't need that.
425  * We track things internally in bytes since that is how file pointers work, vmr
426  * bases and ends, and similar math.  While it's not a hard change, there's no
427  * need for it, and ideally we'll be a fully 64bit system before we deal with
428  * files that large. */
429 void *mmap(struct proc *p, uintptr_t addr, size_t len, int prot, int flags,
430            int fd, size_t offset)
431 {
432         struct file *file = NULL;
433         offset <<= PGSHIFT;
434         printd("mmap(addr %x, len %x, prot %x, flags %x, fd %x, off %x)\n", addr,
435                len, prot, flags, fd, offset);
436         if (fd >= 0 && (flags & MAP_ANON)) {
437                 set_errno(EBADF);
438                 return MAP_FAILED;
439         }
440         if (!len) {
441                 set_errno(EINVAL);
442                 return MAP_FAILED;
443         }
444         if (fd != -1) {
445                 file = get_file_from_fd(&p->open_files, fd);
446                 if (!file) {
447                         set_errno(EBADF);
448                         return MAP_FAILED;
449                 }
450         }
451         /* Check for overflow.  This helps do_mmap and populate_va, among others. */
452         if (offset + len < offset) {
453                 set_errno(EINVAL);
454                 return MAP_FAILED;
455         }
456         /* If they don't care where to put it, we'll start looking after the break.
457          * We could just have userspace handle this (in glibc's mmap), so we don't
458          * need to know about BRK_END, but this will work for now (and may avoid
459          * bugs).  Note that this limits mmap(0) a bit.  Keep this in sync with
460          * __do_mmap()'s check.  (Both are necessary).  */
461         if (addr == 0)
462                 addr = BRK_END;
463         /* Still need to enforce this: */
464         addr = MAX(addr, MMAP_LOWEST_VA);
465         /* Need to check addr + len, after we do our addr adjustments */
466         if (!__is_user_addr((void*)addr, len, UMAPTOP)) {
467                 set_errno(EINVAL);
468                 return MAP_FAILED;
469         }
470         if (PGOFF(addr)) {
471                 set_errno(EINVAL);
472                 return MAP_FAILED;
473         }
474         void *result = do_mmap(p, addr, len, prot, flags, file, offset);
475         if (file)
476                 kref_put(&file->f_kref);
477         return result;
478 }
479
480 /* Helper: returns TRUE if the VMR is allowed to access the file with prot.
481  * This is a bit ghetto still: messes with the file mode and assumes it can walk
482  * the dentry/inode paths without locking.  It also ignores the CoW stuff we'll
483  * need to do eventually. */
484 static bool check_file_perms(struct vm_region *vmr, struct file *file, int prot)
485 {
486         assert(file);
487         if (prot & PROT_READ) {
488                 if (check_perms(file->f_dentry->d_inode, S_IRUSR))
489                         goto out_error;
490         }
491         if (prot & PROT_WRITE) {
492                 /* if vmr maps a file as MAP_SHARED, then we need to make sure the
493                  * protection change is in compliance with the open mode of the
494                  * file. */
495                 if (vmr->vm_flags & MAP_SHARED) {
496                         if (!(file->f_mode & S_IWUSR)) {
497                                 /* at this point, we have a file opened in the wrong mode,
498                                  * but we may be allowed to access it still. */
499                                 if (check_perms(file->f_dentry->d_inode, S_IWUSR)) {
500                                         goto out_error;
501                                 } else {
502                                         /* it is okay, though we need to change the file mode. (note
503                                          * the lack of a lock/protection (TODO) */
504                                         file->f_mode |= S_IWUSR;
505                                 }
506                         }
507                 } else {        /* PRIVATE mapping */
508                         /* TODO: we want a CoW mapping (like we want in handle_page_fault()),
509                          * since there is a concern of a process having the page already
510                          * mapped in to a file it does not have permissions to, and then
511                          * mprotecting it so it can access it.  So we can't just change
512                          * the prot, and we don't know yet if a page is mapped in.  To
513                          * handle this, we ought to sort out the CoW bit, and then this
514                          * will be easy.  Til then, just do a permissions check.  If we
515                          * start having weird issues with libc overwriting itself (since
516                          * procs mprotect that W), then change this. */
517                         if (check_perms(file->f_dentry->d_inode, S_IWUSR))
518                                 goto out_error;
519                 }
520         }
521         return TRUE;
522 out_error:      /* for debugging */
523         printk("[kernel] mmap perm check failed for %s for access %d\n",
524                file_name(file), prot);
525         return FALSE;
526 }
527
528 /* Helper, maps in page at addr, but only if nothing is mapped there.  Returns
529  * 0 on success.  Will take ownership of the page if @xfer is set (used by pmap
530  * code), including on error cases.  This just means we free it on error, and
531  * notionally store it in the PTE on success, which will get freed later.
532  *
533  * It's possible that a page has already been mapped here, in which case we'll
534  * treat as success.  So when we return 0, *a* page is mapped here, but not
535  * necessarily the one you passed in. */
536 static int map_page_at_addr(struct proc *p, struct page *page, uintptr_t addr,
537                             int prot, bool xfer)
538 {
539         pte_t pte;
540         spin_lock(&p->pte_lock);        /* walking and changing PTEs */
541         /* find offending PTE (prob don't read this in).  This might alloc an
542          * intermediate page table page. */
543         pte = pgdir_walk(p->env_pgdir, (void*)addr, TRUE);
544         if (!pte_walk_okay(pte)) {
545                 spin_unlock(&p->pte_lock);
546                 if (xfer)
547                         page_decref(page);
548                 return -ENOMEM;
549         }
550         /* a spurious, valid PF is possible due to a legit race: the page might have
551          * been faulted in by another core already (and raced on the memory lock),
552          * in which case we should just return. */
553         if (pte_is_present(pte)) {
554                 spin_unlock(&p->pte_lock);
555                 if (xfer)
556                         page_decref(page);
557                 return 0;
558         }
559         /* I used to allow clobbering an old entry (contrary to the documentation),
560          * but it's probably a sign of another bug. */
561         assert(!pte_is_mapped(pte));
562         /* preserve the dirty bit - pm removal could be looking concurrently */
563         prot |= (pte_is_dirty(pte) ? PTE_D : 0);
564         /* We have a ref to page, which we are storing in the PTE */
565         pte_write(pte, page2pa(page), prot);
566         spin_unlock(&p->pte_lock);
567         return 0;
568 }
569
570 /* Helper: copies *pp's contents to a new page, replacing your page pointer.  If
571  * this succeeds, you'll have a non-PM page, which matters for how you put it.*/
572 static int __copy_and_swap_pmpg(struct proc *p, struct page **pp)
573 {
574         struct page *new_page, *old_page = *pp;
575         if (upage_alloc(p, &new_page, FALSE))
576                 return -ENOMEM;
577         memcpy(page2kva(new_page), page2kva(old_page), PGSIZE);
578         pm_put_page(old_page);
579         *pp = new_page;
580         return 0;
581 }
582
583 /* Hold the VMR lock when you call this - it'll assume the entire VA range is
584  * mappable, which isn't true if there are concurrent changes to the VMRs. */
585 static int populate_anon_va(struct proc *p, uintptr_t va, unsigned long nr_pgs,
586                             int pte_prot)
587 {
588         struct page *page;
589         int ret;
590         for (long i = 0; i < nr_pgs; i++) {
591                 if (upage_alloc(p, &page, TRUE))
592                         return -ENOMEM;
593                 /* could imagine doing a memwalk instead of a for loop */
594                 ret = map_page_at_addr(p, page, va + i * PGSIZE, pte_prot, TRUE);
595                 if (ret)
596                         return ret;
597         }
598         return 0;
599 }
600
601 /* This will periodically unlock the vmr lock. */
602 static int populate_pm_va(struct proc *p, uintptr_t va, unsigned long nr_pgs,
603                           int pte_prot, struct page_map *pm, size_t offset,
604                           int flags, bool exec)
605 {
606         int ret = 0;
607         unsigned long pm_idx0 = offset >> PGSHIFT;
608         int vmr_history = ACCESS_ONCE(p->vmr_history);
609         struct page *page;
610
611         /* locking rules: start the loop holding the vmr lock, enter and exit the
612          * entire func holding the lock. */
613         for (long i = 0; i < nr_pgs; i++) {
614                 ret = pm_load_page_nowait(pm, pm_idx0 + i, &page);
615                 if (ret) {
616                         if (ret != -EAGAIN)
617                                 break;
618                         spin_unlock(&p->vmr_lock);
619                         /* might block here, can't hold the spinlock */
620                         ret = pm_load_page(pm, pm_idx0 + i, &page);
621                         spin_lock(&p->vmr_lock);
622                         if (ret)
623                                 break;
624                         /* while we were sleeping, the VMRs could have changed on us. */
625                         if (vmr_history != ACCESS_ONCE(p->vmr_history)) {
626                                 pm_put_page(page);
627                                 printk("[kernel] FYI: VMR changed during populate\n");
628                                 break;
629                         }
630                 }
631                 if (flags & MAP_PRIVATE) {
632                         ret = __copy_and_swap_pmpg(p, &page);
633                         if (ret) {
634                                 pm_put_page(page);
635                                 break;
636                         }
637                 }
638                 /* if this is an executable page, we might have to flush the
639                  * instruction cache if our HW requires it.
640                  * TODO: is this still needed?  andrew put this in a while ago*/
641                 if (exec)
642                         icache_flush_page(0, page2kva(page));
643                 /* The page could be either in the PM, or a private, now-anon page. */
644                 ret = map_page_at_addr(p, page, va + i * PGSIZE, pte_prot,
645                                        page_is_pagemap(page));
646                 if (page_is_pagemap(page))
647                         pm_put_page(page);
648                 if (ret)
649                         break;
650         }
651         return ret;
652 }
653
654 void *do_mmap(struct proc *p, uintptr_t addr, size_t len, int prot, int flags,
655               struct file *file, size_t offset)
656 {
657         len = ROUNDUP(len, PGSIZE);
658         struct vm_region *vmr, *vmr_temp;
659
660         /* read/write vmr lock (will change the tree) */
661         spin_lock(&p->vmr_lock);
662         p->vmr_history++;
663         /* Sanity check, for callers that bypass mmap().  We want addr for anon
664          * memory to start above the break limit (BRK_END), but not 0.  Keep this in
665          * sync with BRK_END in mmap(). */
666         if (addr == 0)
667                 addr = BRK_END;
668         assert(!PGOFF(offset));
669
670         /* MCPs will need their code and data pinned.  This check will start to fail
671          * after uthread_slim_init(), at which point userspace should have enough
672          * control over its mmaps (i.e. no longer done by LD or load_elf) that it
673          * can ask for pinned and populated pages.  Except for dl_opens(). */
674         struct preempt_data *vcpd = &p->procdata->vcore_preempt_data[0];
675         if (file && (atomic_read(&vcpd->flags) & VC_SCP_NOVCCTX))
676                 flags |= MAP_POPULATE | MAP_LOCKED;
677         /* Need to make sure nothing is in our way when we want a FIXED location.
678          * We just need to split on the end points (if they exist), and then remove
679          * everything in between.  __do_munmap() will do this.  Careful, this means
680          * an mmap can be an implied munmap() (not my call...). */
681         if (flags & MAP_FIXED)
682                 __do_munmap(p, addr, len);
683         vmr = create_vmr(p, addr, len);
684         if (!vmr) {
685                 printk("[kernel] do_mmap() aborted for %p + %p!\n", addr, len);
686                 set_errno(ENOMEM);
687                 spin_unlock(&p->vmr_lock);
688                 return MAP_FAILED;
689         }
690         addr = vmr->vm_base;
691         vmr->vm_prot = prot;
692         vmr->vm_flags = flags;
693         vmr->vm_foff = offset;
694         if (file) {
695                 if (!check_file_perms(vmr, file, prot)) {
696                         assert(!vmr->vm_file);
697                         destroy_vmr(vmr);
698                         set_errno(EACCES);
699                         spin_unlock(&p->vmr_lock);
700                         return MAP_FAILED;
701                 }
702                 /* TODO: consider locking the file while checking (not as manadatory as
703                  * in handle_page_fault() */
704                 if (nr_pages(offset + len) > nr_pages(file->f_dentry->d_inode->i_size)) {
705                         /* We're allowing them to set up the VMR, though if they attempt to
706                          * fault in any pages beyond the file's limit, they'll fail.  Since
707                          * they might not access the region, we need to make sure POPULATE
708                          * is off.  FYI, 64 bit glibc shared libs map in an extra 2MB of
709                          * unaligned space between their RO and RW sections, but then
710                          * immediately mprotect it to PROT_NONE. */
711                         flags &= ~MAP_POPULATE;
712                 }
713                 /* Prep the FS to make sure it can mmap the file.  Slightly weird
714                  * semantics: if we fail and had munmapped the space, they will have a
715                  * hole in their VM now. */
716                 if (file->f_op->mmap(file, vmr)) {
717                         assert(!vmr->vm_file);
718                         destroy_vmr(vmr);
719                         set_errno(EACCES);      /* not quite */
720                         spin_unlock(&p->vmr_lock);
721                         return MAP_FAILED;
722                 }
723                 kref_get(&file->f_kref, 1);
724                 pm_add_vmr(file2pm(file), vmr);
725         }
726         vmr->vm_file = file;
727         vmr = merge_me(vmr);            /* attempts to merge with neighbors */
728
729         if (flags & MAP_POPULATE && prot != PROT_NONE) {
730                 int pte_prot = (prot & PROT_WRITE) ? PTE_USER_RW :
731                            (prot & (PROT_READ|PROT_EXEC)) ? PTE_USER_RO : 0;
732                 unsigned long nr_pgs = len >> PGSHIFT;
733                 int ret = 0;
734                 if (!file) {
735                         ret = populate_anon_va(p, addr, nr_pgs, pte_prot);
736                 } else {
737                         /* Note: this will unlock if it blocks.  our refcnt on the file
738                          * keeps the pm alive when we unlock */
739                         ret = populate_pm_va(p, addr, nr_pgs, pte_prot, file->f_mapping,
740                                              offset, flags, prot & PROT_EXEC);
741                 }
742                 if (ret == -ENOMEM) {
743                         spin_unlock(&p->vmr_lock);
744                         printk("[kernel] ENOMEM, killing %d\n", p->pid);
745                         proc_destroy(p);
746                         return MAP_FAILED;      /* will never make it back to userspace */
747                 }
748         }
749         spin_unlock(&p->vmr_lock);
750
751         profiler_notify_mmap(p, addr, len, prot, flags, file, offset);
752
753         return (void*)addr;
754 }
755
756 int mprotect(struct proc *p, uintptr_t addr, size_t len, int prot)
757 {
758         int ret;
759
760         printd("mprotect: (addr %p, len %p, prot 0x%x)\n", addr, len, prot);
761         if (!len)
762                 return 0;
763         len = ROUNDUP(len, PGSIZE);
764         if (PGOFF(addr)) {
765                 set_errno(EINVAL);
766                 return -1;
767         }
768         if (!__is_user_addr((void*)addr, len, UMAPTOP)) {
769                 set_errno(ENOMEM);
770                 return -1;
771         }
772         /* read/write lock, will probably change the tree and settings */
773         spin_lock(&p->vmr_lock);
774         p->vmr_history++;
775         ret = __do_mprotect(p, addr, len, prot);
776         spin_unlock(&p->vmr_lock);
777         return ret;
778 }
779
780 /* This does not care if the region is not mapped.  POSIX says you should return
781  * ENOMEM if any part of it is unmapped.  Can do this later if we care, based on
782  * the VMRs, not the actual page residency. */
783 int __do_mprotect(struct proc *p, uintptr_t addr, size_t len, int prot)
784 {
785         struct vm_region *vmr, *next_vmr;
786         pte_t pte;
787         bool shootdown_needed = FALSE;
788         int pte_prot = (prot & PROT_WRITE) ? PTE_USER_RW :
789                        (prot & (PROT_READ|PROT_EXEC)) ? PTE_USER_RO : PTE_NONE;
790         /* TODO: this is aggressively splitting, when we might not need to if the
791          * prots are the same as the previous.  Plus, there are three excessive
792          * scans.  Finally, we might be able to merge when we are done. */
793         isolate_vmrs(p, addr, len);
794         vmr = find_first_vmr(p, addr);
795         while (vmr && vmr->vm_base < addr + len) {
796                 if (vmr->vm_prot == prot)
797                         continue;
798                 if (vmr->vm_file && !check_file_perms(vmr, vmr->vm_file, prot)) {
799                         set_errno(EACCES);
800                         return -1;
801                 }
802                 vmr->vm_prot = prot;
803                 spin_lock(&p->pte_lock);        /* walking and changing PTEs */
804                 /* TODO: use a memwalk.  At a minimum, we need to change every existing
805                  * PTE that won't trigger a PF (meaning, present PTEs) to have the new
806                  * prot.  The others will fault on access, and we'll change the PTE
807                  * then.  In the off chance we have a mapped but not present PTE, we
808                  * might as well change it too, since we're already here. */
809                 for (uintptr_t va = vmr->vm_base; va < vmr->vm_end; va += PGSIZE) {
810                         pte = pgdir_walk(p->env_pgdir, (void*)va, 0);
811                         if (pte_walk_okay(pte) && pte_is_mapped(pte)) {
812                                 pte_replace_perm(pte, pte_prot);
813                                 shootdown_needed = TRUE;
814                         }
815                 }
816                 spin_unlock(&p->pte_lock);
817                 vmr = merge_me(vmr);
818                 next_vmr = TAILQ_NEXT(vmr, vm_link);
819                 vmr = next_vmr;
820         }
821         if (shootdown_needed)
822                 proc_tlbshootdown(p, addr, addr + len);
823         return 0;
824 }
825
826 int munmap(struct proc *p, uintptr_t addr, size_t len)
827 {
828         int ret;
829
830         printd("munmap(addr %x, len %x)\n", addr, len);
831         if (!len)
832                 return 0;
833         len = ROUNDUP(len, PGSIZE);
834         if (PGOFF(addr)) {
835                 set_errno(EINVAL);
836                 return -1;
837         }
838         if (!__is_user_addr((void*)addr, len, UMAPTOP)) {
839                 set_errno(EINVAL);
840                 return -1;
841         }
842         /* read/write: changing the vmrs (trees, properties, and whatnot) */
843         spin_lock(&p->vmr_lock);
844         p->vmr_history++;
845         ret = __do_munmap(p, addr, len);
846         spin_unlock(&p->vmr_lock);
847         return ret;
848 }
849
850 static int __munmap_mark_not_present(struct proc *p, pte_t pte, void *va,
851                                      void *arg)
852 {
853         bool *shootdown_needed = (bool*)arg;
854         /* could put in some checks here for !P and also !0 */
855         if (!pte_is_present(pte))       /* unmapped (== 0) *ptes are also not PTE_P */
856                 return 0;
857         pte_clear_present(pte);
858         *shootdown_needed = TRUE;
859         return 0;
860 }
861
862 /* If our page is actually in the PM, we don't do anything.  All a page map
863  * really needs is for our VMR to no longer track it (vmr being in the pm's
864  * list) and to not point at its pages (mark it 0, dude).
865  *
866  * But private mappings mess with that a bit.  Luckily, we can tell by looking
867  * at a page whether the specific page is in the PM or not.  If it isn't, we
868  * still need to free our "VMR local" copy.
869  *
870  * For pages in a PM, we're racing with PM removers.  Both of us sync with the
871  * mm lock, so once we hold the lock, it's a matter of whether or not the PTE is
872  * 0 or not.  If it isn't, then we're still okay to look at the page.  Consider
873  * the PTE a weak ref on the page.  So long as you hold the mm lock, you can
874  * look at the PTE and know the page isn't being freed. */
875 static int __vmr_free_pgs(struct proc *p, pte_t pte, void *va, void *arg)
876 {
877         struct page *page;
878         if (pte_is_unmapped(pte))
879                 return 0;
880         page = pa2page(pte_get_paddr(pte));
881         pte_clear(pte);
882         if (!page_is_pagemap(page))
883                 page_decref(page);
884         return 0;
885 }
886
887 int __do_munmap(struct proc *p, uintptr_t addr, size_t len)
888 {
889         struct vm_region *vmr, *next_vmr, *first_vmr;
890         bool shootdown_needed = FALSE;
891
892         /* TODO: this will be a bit slow, since we end up doing three linear
893          * searches (two in isolate, one in find_first). */
894         isolate_vmrs(p, addr, len);
895         first_vmr = find_first_vmr(p, addr);
896         vmr = first_vmr;
897         spin_lock(&p->pte_lock);        /* changing PTEs */
898         while (vmr && vmr->vm_base < addr + len) {
899                 env_user_mem_walk(p, (void*)vmr->vm_base, vmr->vm_end - vmr->vm_base,
900                                   __munmap_mark_not_present, &shootdown_needed);
901                 vmr = TAILQ_NEXT(vmr, vm_link);
902         }
903         spin_unlock(&p->pte_lock);
904         /* we haven't freed the pages yet; still using the PTEs to store the them.
905          * There should be no races with inserts/faults, since we still hold the mm
906          * lock since the previous CB. */
907         if (shootdown_needed)
908                 proc_tlbshootdown(p, addr, addr + len);
909         vmr = first_vmr;
910         while (vmr && vmr->vm_base < addr + len) {
911                 /* there is rarely more than one VMR in this loop.  o/w, we'll need to
912                  * gather up the vmrs and destroy outside the pte_lock. */
913                 spin_lock(&p->pte_lock);        /* changing PTEs */
914                 env_user_mem_walk(p, (void*)vmr->vm_base, vmr->vm_end - vmr->vm_base,
915                                       __vmr_free_pgs, 0);
916                 spin_unlock(&p->pte_lock);
917                 next_vmr = TAILQ_NEXT(vmr, vm_link);
918                 destroy_vmr(vmr);
919                 vmr = next_vmr;
920         }
921         return 0;
922 }
923
924 /* Helper - drop the page differently based on where it is from */
925 static void __put_page(struct page *page)
926 {
927         if (page_is_pagemap(page))
928                 pm_put_page(page);
929         else
930                 page_decref(page);
931 }
932
933 static int __hpf_load_page(struct proc *p, struct page_map *pm,
934                            unsigned long idx, struct page **page, bool first)
935 {
936         int ret = 0;
937         int coreid = core_id();
938         struct per_cpu_info *pcpui = &per_cpu_info[coreid];
939         bool wake_scp = FALSE;
940         spin_lock(&p->proc_lock);
941         switch (p->state) {
942                 case (PROC_RUNNING_S):
943                         wake_scp = TRUE;
944                         __proc_set_state(p, PROC_WAITING);
945                         /* it's possible for HPF to loop a few times; we can only save the
946                          * first time, o/w we could clobber. */
947                         if (first) {
948                                 __proc_save_context_s(p);
949                                 __proc_save_fpu_s(p);
950                                 /* We clear the owner, since userspace doesn't run here
951                                  * anymore, but we won't abandon since the fault handler
952                                  * still runs in our process. */
953                                 clear_owning_proc(coreid);
954                         }
955                         /* other notes: we don't currently need to tell the ksched
956                          * we switched from running to waiting, though we probably
957                          * will later for more generic scheds. */
958                         break;
959                 case (PROC_RUNNABLE_M):
960                 case (PROC_RUNNING_M):
961                         spin_unlock(&p->proc_lock);
962                         return -EAGAIN; /* will get reflected back to userspace */
963                 case (PROC_DYING):
964                 case (PROC_DYING_ABORT):
965                         spin_unlock(&p->proc_lock);
966                         return -EINVAL;
967                 default:
968                         /* shouldn't have any waitings, under the current yield style.  if
969                          * this becomes an issue, we can branch on is_mcp(). */
970                         printk("HPF unexpectecd state(%s)", procstate2str(p->state));
971                         spin_unlock(&p->proc_lock);
972                         return -EINVAL;
973         }
974         spin_unlock(&p->proc_lock);
975         ret = pm_load_page(pm, idx, page);
976         if (wake_scp)
977                 proc_wakeup(p);
978         if (ret) {
979                 printk("load failed with ret %d\n", ret);
980                 return ret;
981         }
982         /* need to put our old ref, next time around HPF will get another. */
983         pm_put_page(*page);
984         return 0;
985 }
986
987 /* Returns 0 on success, or an appropriate -error code.
988  *
989  * Notes: if your TLB caches negative results, you'll need to flush the
990  * appropriate tlb entry.  Also, you could have a weird race where a present PTE
991  * faulted for a different reason (was mprotected on another core), and the
992  * shootdown is on its way.  Userspace should have waited for the mprotect to
993  * return before trying to write (or whatever), so we don't care and will fault
994  * them. */
995 static int __hpf(struct proc *p, uintptr_t va, int prot, bool file_ok)
996 {
997         struct vm_region *vmr;
998         struct page *a_page;
999         unsigned int f_idx;     /* index of the missing page in the file */
1000         int ret = 0;
1001         bool first = TRUE;
1002         va = ROUNDDOWN(va,PGSIZE);
1003
1004 refault:
1005         /* read access to the VMRs TODO: RCU */
1006         spin_lock(&p->vmr_lock);
1007         /* Check the vmr's protection */
1008         vmr = find_vmr(p, va);
1009         if (!vmr) {                                                     /* not mapped at all */
1010                 printd("fault: %p not mapped\n", va);
1011                 ret = -EFAULT;
1012                 goto out;
1013         }
1014         if (!(vmr->vm_prot & prot)) {           /* wrong prots for this vmr */
1015                 ret = -EPERM;
1016                 goto out;
1017         }
1018         if (!vmr->vm_file) {
1019                 /* No file - just want anonymous memory */
1020                 if (upage_alloc(p, &a_page, TRUE)) {
1021                         ret = -ENOMEM;
1022                         goto out;
1023                 }
1024         } else {
1025                 if (!file_ok)
1026                         return -EACCES;
1027                 /* If this fails, either something got screwed up with the VMR, or the
1028                  * permissions changed after mmap/mprotect.  Either way, I want to know
1029                  * (though it's not critical). */
1030                 if (!check_file_perms(vmr, vmr->vm_file, prot))
1031                         printk("[kernel] possible issue with VMR prots on file %s!\n",
1032                                file_name(vmr->vm_file));
1033                 /* Load the file's page in the page cache.
1034                  * TODO: (BLK) Note, we are holding the mem lock!  We need to rewrite
1035                  * this stuff so we aren't hold the lock as excessively as we are, and
1036                  * such that we can block and resume later. */
1037                 assert(!PGOFF(va - vmr->vm_base + vmr->vm_foff));
1038                 f_idx = (va - vmr->vm_base + vmr->vm_foff) >> PGSHIFT;
1039                 /* TODO: need some sort of lock on the file to deal with someone
1040                  * concurrently shrinking it.  Adding 1 to f_idx, since it is
1041                  * zero-indexed */
1042                 if (f_idx + 1 > nr_pages(vmr->vm_file->f_dentry->d_inode->i_size)) {
1043                         /* We're asking for pages that don't exist in the file */
1044                         /* TODO: unlock the file */
1045                         ret = -ESPIPE; /* linux sends a SIGBUS at access time */
1046                         goto out;
1047                 }
1048                 ret = pm_load_page_nowait(vmr->vm_file->f_mapping, f_idx, &a_page);
1049                 if (ret) {
1050                         if (ret != -EAGAIN)
1051                                 goto out;
1052                         /* keep the file alive after we unlock */
1053                         kref_get(&vmr->vm_file->f_kref, 1);
1054                         spin_unlock(&p->vmr_lock);
1055                         ret = __hpf_load_page(p, vmr->vm_file->f_mapping, f_idx, &a_page,
1056                                               first);
1057                         first = FALSE;
1058                         kref_put(&vmr->vm_file->f_kref);
1059                         if (ret)
1060                                 return ret;
1061                         goto refault;
1062                 }
1063                 /* If we want a private map, we'll preemptively give you a new page.  We
1064                  * used to just care if it was private and writable, but were running
1065                  * into issues with libc changing its mapping (map private, then
1066                  * mprotect to writable...)  In the future, we want to CoW this anyway,
1067                  * so it's not a big deal. */
1068                 if ((vmr->vm_flags & MAP_PRIVATE)) {
1069                         ret = __copy_and_swap_pmpg(p, &a_page);
1070                         if (ret)
1071                                 goto out_put_pg;
1072                 }
1073                 /* if this is an executable page, we might have to flush the instruction
1074                  * cache if our HW requires it. */
1075                 if (vmr->vm_prot & PROT_EXEC)
1076                         icache_flush_page((void*)va, page2kva(a_page));
1077         }
1078         /* update the page table TODO: careful with MAP_PRIVATE etc.  might do this
1079          * separately (file, no file) */
1080         int pte_prot = (vmr->vm_prot & PROT_WRITE) ? PTE_USER_RW :
1081                        (vmr->vm_prot & (PROT_READ|PROT_EXEC)) ? PTE_USER_RO : 0;
1082         ret = map_page_at_addr(p, a_page, va, pte_prot, page_is_pagemap(a_page));
1083         /* fall through, even for errors */
1084 out_put_pg:
1085         /* the VMR's existence in the PM (via the mmap) allows us to have PTE point
1086          * to a_page without it magically being reallocated.  For non-PM memory
1087          * (anon memory or private pages) we transferred the ref to the PTE. */
1088         if (page_is_pagemap(a_page))
1089                 pm_put_page(a_page);
1090 out:
1091         spin_unlock(&p->vmr_lock);
1092         return ret;
1093 }
1094
1095 int handle_page_fault(struct proc *p, uintptr_t va, int prot)
1096 {
1097         return __hpf(p, va, prot, TRUE);
1098 }
1099
1100 int handle_page_fault_nofile(struct proc *p, uintptr_t va, int prot)
1101 {
1102         return __hpf(p, va, prot, FALSE);
1103 }
1104
1105 /* Attempts to populate the pages, as if there was a page faults.  Bails on
1106  * errors, and returns the number of pages populated.  */
1107 unsigned long populate_va(struct proc *p, uintptr_t va, unsigned long nr_pgs)
1108 {
1109         struct vm_region *vmr, vmr_copy;
1110         unsigned long nr_pgs_this_vmr;
1111         unsigned long nr_filled = 0;
1112         struct page *page;
1113         int pte_prot;
1114         int ret;
1115
1116         /* we can screw around with ways to limit the find_vmr calls (can do the
1117          * next in line if we didn't unlock, etc., but i don't expect us to do this
1118          * for more than a single VMR in most cases. */
1119         spin_lock(&p->vmr_lock);
1120         while (nr_pgs) {
1121                 vmr = find_vmr(p, va);
1122                 if (!vmr)
1123                         break;
1124                 if (vmr->vm_prot == PROT_NONE)
1125                         break;
1126                 pte_prot = (vmr->vm_prot & PROT_WRITE) ? PTE_USER_RW :
1127                            (vmr->vm_prot & (PROT_READ|PROT_EXEC)) ? PTE_USER_RO : 0;
1128                 nr_pgs_this_vmr = MIN(nr_pgs, (vmr->vm_end - va) >> PGSHIFT);
1129                 if (!vmr->vm_file) {
1130                         if (populate_anon_va(p, va, nr_pgs_this_vmr, pte_prot)) {
1131                                 /* on any error, we can just bail.  we might be underestimating
1132                                  * nr_filled. */
1133                                 break;
1134                         }
1135                 } else {
1136                         /* need to keep the file alive in case we unlock/block */
1137                         kref_get(&vmr->vm_file->f_kref, 1);
1138                         /* Regarding foff + (va - base): va - base < len, and foff + len
1139                          * does not over flow */
1140                         ret = populate_pm_va(p, va, nr_pgs_this_vmr, pte_prot,
1141                                              vmr->vm_file->f_mapping,
1142                                              vmr->vm_foff + (va - vmr->vm_base),
1143                                              vmr->vm_flags, vmr->vm_prot & PROT_EXEC);
1144                         kref_put(&vmr->vm_file->f_kref);
1145                         if (ret) {
1146                                 /* we might have failed if the underlying file doesn't cover the
1147                                  * mmap window, depending on how we'll deal with truncation. */
1148                                 break;
1149                         }
1150                 }
1151                 nr_filled += nr_pgs_this_vmr;
1152                 va += nr_pgs_this_vmr << PGSHIFT;
1153                 nr_pgs -= nr_pgs_this_vmr;
1154         }
1155         spin_unlock(&p->vmr_lock);
1156         return nr_filled;
1157 }
1158
1159 /* Kernel Dynamic Memory Mappings */
1160 uintptr_t dyn_vmap_llim = KERN_DYN_TOP;
1161 spinlock_t dyn_vmap_lock = SPINLOCK_INITIALIZER;
1162
1163 /* Reserve space in the kernel dynamic memory map area */
1164 uintptr_t get_vmap_segment(unsigned long num_pages)
1165 {
1166         uintptr_t retval;
1167         spin_lock(&dyn_vmap_lock);
1168         retval = dyn_vmap_llim - num_pages * PGSIZE;
1169         if ((retval > ULIM) && (retval < KERN_DYN_TOP)) {
1170                 dyn_vmap_llim = retval;
1171         } else {
1172                 warn("[kernel] dynamic mapping failed!");
1173                 retval = 0;
1174         }
1175         spin_unlock(&dyn_vmap_lock);
1176         return retval;
1177 }
1178
1179 /* Give up your space.  Note this isn't supported yet */
1180 uintptr_t put_vmap_segment(uintptr_t vaddr, unsigned long num_pages)
1181 {
1182         /* TODO: use vmem regions for adjustable vmap segments */
1183         warn("Not implemented, leaking vmem space.\n");
1184         return 0;
1185 }
1186
1187 /* Map a virtual address chunk to physical addresses.  Make sure you got a vmap
1188  * segment before actually trying to do the mapping.
1189  *
1190  * Careful with more than one 'page', since it will assume your physical pages
1191  * are also contiguous.  Most callers will only use one page.
1192  *
1193  * Finally, note that this does not care whether or not there are real pages
1194  * being mapped, and will not attempt to incref your page (if there is such a
1195  * thing).  Handle your own refcnting for pages. */
1196 int map_vmap_segment(uintptr_t vaddr, uintptr_t paddr, unsigned long num_pages,
1197                      int perm)
1198 {
1199         /* For now, we only handle the root pgdir, and not any of the other ones
1200          * (like for processes).  To do so, we'll need to insert into every pgdir,
1201          * and send tlb shootdowns to those that are active (which we don't track
1202          * yet). */
1203         extern int booting;
1204         assert(booting);
1205
1206         /* TODO: (MM) you should lock on boot pgdir modifications.  A vm region lock
1207          * isn't enough, since there might be a race on outer levels of page tables.
1208          * For now, we'll just use the dyn_vmap_lock (which technically works). */
1209         spin_lock(&dyn_vmap_lock);
1210         pte_t pte;
1211 #ifdef CONFIG_X86
1212         perm |= PTE_G;
1213 #endif
1214         for (int i = 0; i < num_pages; i++) {
1215                 pte = pgdir_walk(boot_pgdir, (void*)(vaddr + i * PGSIZE), 1);
1216                 if (!pte_walk_okay(pte)) {
1217                         spin_unlock(&dyn_vmap_lock);
1218                         return -ENOMEM;
1219                 }
1220                 /* You probably should have unmapped first */
1221                 if (pte_is_mapped(pte))
1222                         warn("Existing PTE value %p\n", pte_print(pte));
1223                 pte_write(pte, paddr + i * PGSIZE, perm);
1224         }
1225         spin_unlock(&dyn_vmap_lock);
1226         return 0;
1227 }
1228
1229 /* Unmaps / 0's the PTEs of a chunk of vaddr space */
1230 int unmap_vmap_segment(uintptr_t vaddr, unsigned long num_pages)
1231 {
1232         /* Not a big deal - won't need this til we do something with kthreads */
1233         warn("Incomplete, don't call this yet.");
1234         spin_lock(&dyn_vmap_lock);
1235         /* TODO: For all pgdirs */
1236         pte_t pte;
1237         for (int i = 0; i < num_pages; i++) {
1238                 pte = pgdir_walk(boot_pgdir, (void*)(vaddr + i * PGSIZE), 1);
1239                 if (pte_walk_okay(pte))
1240                         pte_clear(pte);
1241         }
1242         /* TODO: TLB shootdown.  Also note that the global flag is set on the PTE
1243          * (for x86 for now), which requires a global shootdown.  bigger issue is
1244          * the TLB shootdowns for multiple pgdirs.  We'll need to remove from every
1245          * pgdir, and send tlb shootdowns to those that are active (which we don't
1246          * track yet). */
1247         spin_unlock(&dyn_vmap_lock);
1248         return 0;
1249 }
1250
1251 /* This can handle unaligned paddrs */
1252 static uintptr_t vmap_pmem_flags(uintptr_t paddr, size_t nr_bytes, int flags)
1253 {
1254         uintptr_t vaddr;
1255         unsigned long nr_pages;
1256         assert(nr_bytes && paddr);
1257         nr_bytes += PGOFF(paddr);
1258         nr_pages = ROUNDUP(nr_bytes, PGSIZE) >> PGSHIFT;
1259         vaddr = get_vmap_segment(nr_pages);
1260         if (!vaddr) {
1261                 warn("Unable to get a vmap segment");   /* probably a bug */
1262                 return 0;
1263         }
1264         /* it's not strictly necessary to drop paddr's pgoff, but it might save some
1265          * vmap heartache in the future. */
1266         if (map_vmap_segment(vaddr, PG_ADDR(paddr), nr_pages,
1267                              PTE_KERN_RW | flags)) {
1268                 warn("Unable to map a vmap segment");   /* probably a bug */
1269                 return 0;
1270         }
1271         return vaddr + PGOFF(paddr);
1272 }
1273
1274 uintptr_t vmap_pmem(uintptr_t paddr, size_t nr_bytes)
1275 {
1276         return vmap_pmem_flags(paddr, nr_bytes, 0);
1277 }
1278
1279 uintptr_t vmap_pmem_nocache(uintptr_t paddr, size_t nr_bytes)
1280 {
1281         return vmap_pmem_flags(paddr, nr_bytes, PTE_NOCACHE);
1282 }
1283
1284 uintptr_t vmap_pmem_writecomb(uintptr_t paddr, size_t nr_bytes)
1285 {
1286         return vmap_pmem_flags(paddr, nr_bytes, PTE_WRITECOMB);
1287 }
1288
1289 int vunmap_vmem(uintptr_t vaddr, size_t nr_bytes)
1290 {
1291         unsigned long nr_pages = ROUNDUP(nr_bytes, PGSIZE) >> PGSHIFT;
1292         unmap_vmap_segment(vaddr, nr_pages);
1293         put_vmap_segment(vaddr, nr_pages);
1294         return 0;
1295 }