mmap.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:31k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * linux/mm/mmap.c
  3.  *
  4.  * Written by obz.
  5.  */
  6. #include <linux/slab.h>
  7. #include <linux/shm.h>
  8. #include <linux/mman.h>
  9. #include <linux/pagemap.h>
  10. #include <linux/swap.h>
  11. #include <linux/swapctl.h>
  12. #include <linux/smp_lock.h>
  13. #include <linux/init.h>
  14. #include <linux/file.h>
  15. #include <linux/fs.h>
  16. #include <linux/personality.h>
  17. #include <asm/uaccess.h>
  18. #include <asm/pgalloc.h>
  19. #include <asm/tlb.h>
  20. extern void unmap_page_range(mmu_gather_t *tlb, struct mm_struct *mm, unsigned long start, unsigned long end);
  21. /*
  22.  * WARNING: the debugging will use recursive algorithms so never enable this
  23.  * unless you know what you are doing.
  24.  */
  25. #undef DEBUG_MM_RB
  26. /* description of effects of mapping type and prot in current implementation.
  27.  * this is due to the limited x86 page protection hardware.  The expected
  28.  * behavior is in parens:
  29.  *
  30.  * map_type prot
  31.  * PROT_NONE PROT_READ PROT_WRITE PROT_EXEC
  32.  * MAP_SHARED r: (no) no r: (yes) yes r: (no) yes r: (no) yes
  33.  * w: (no) no w: (no) no w: (yes) yes w: (no) no
  34.  * x: (no) no x: (no) yes x: (no) yes x: (yes) yes
  35.  *
  36.  * MAP_PRIVATE r: (no) no r: (yes) yes r: (no) yes r: (no) yes
  37.  * w: (no) no w: (no) no w: (copy) copy w: (no) no
  38.  * x: (no) no x: (no) yes x: (no) yes x: (yes) yes
  39.  *
  40.  */
  41. pgprot_t protection_map[16] = {
  42. __P000, __P001, __P010, __P011, __P100, __P101, __P110, __P111,
  43. __S000, __S001, __S010, __S011, __S100, __S101, __S110, __S111
  44. };
  45. int sysctl_overcommit_memory;
  46. /* Check that a process has enough memory to allocate a
  47.  * new virtual mapping.
  48.  */
  49. int vm_enough_memory(long pages)
  50. {
  51. /* Stupid algorithm to decide if we have enough memory: while
  52.  * simple, it hopefully works in most obvious cases.. Easy to
  53.  * fool it, but this should catch most mistakes.
  54.  */
  55. /* 23/11/98 NJC: Somewhat less stupid version of algorithm,
  56.  * which tries to do "TheRightThing".  Instead of using half of
  57.  * (buffers+cache), use the minimum values.  Allow an extra 2%
  58.  * of num_physpages for safety margin.
  59.  */
  60. unsigned long free;
  61.         /* Sometimes we want to use more memory than we have. */
  62. if (sysctl_overcommit_memory)
  63.     return 1;
  64. /* The page cache contains buffer pages these days.. */
  65. free = atomic_read(&page_cache_size);
  66. free += nr_free_pages();
  67. free += nr_swap_pages;
  68. /*
  69.  * This double-counts: the nrpages are both in the page-cache
  70.  * and in the swapper space. At the same time, this compensates
  71.  * for the swap-space over-allocation (ie "nr_swap_pages" being
  72.  * too small.
  73.  */
  74. free += swapper_space.nrpages;
  75. /*
  76.  * The code below doesn't account for free space in the inode
  77.  * and dentry slab cache, slab cache fragmentation, inodes and
  78.  * dentries which will become freeable under VM load, etc.
  79.  * Lets just hope all these (complex) factors balance out...
  80.  */
  81. free += (dentry_stat.nr_unused * sizeof(struct dentry)) >> PAGE_SHIFT;
  82. free += (inodes_stat.nr_unused * sizeof(struct inode)) >> PAGE_SHIFT;
  83. return free > pages;
  84. }
  85. /* Remove one vm structure from the inode's i_mapping address space. */
  86. static inline void __remove_shared_vm_struct(struct vm_area_struct *vma)
  87. {
  88. struct file * file = vma->vm_file;
  89. if (file) {
  90. struct inode *inode = file->f_dentry->d_inode;
  91. if (vma->vm_flags & VM_DENYWRITE)
  92. atomic_inc(&inode->i_writecount);
  93. if(vma->vm_next_share)
  94. vma->vm_next_share->vm_pprev_share = vma->vm_pprev_share;
  95. *vma->vm_pprev_share = vma->vm_next_share;
  96. }
  97. }
  98. static inline void remove_shared_vm_struct(struct vm_area_struct *vma)
  99. {
  100. lock_vma_mappings(vma);
  101. __remove_shared_vm_struct(vma);
  102. unlock_vma_mappings(vma);
  103. }
  104. void lock_vma_mappings(struct vm_area_struct *vma)
  105. {
  106. struct address_space *mapping;
  107. mapping = NULL;
  108. if (vma->vm_file)
  109. mapping = vma->vm_file->f_dentry->d_inode->i_mapping;
  110. if (mapping)
  111. spin_lock(&mapping->i_shared_lock);
  112. }
  113. void unlock_vma_mappings(struct vm_area_struct *vma)
  114. {
  115. struct address_space *mapping;
  116. mapping = NULL;
  117. if (vma->vm_file)
  118. mapping = vma->vm_file->f_dentry->d_inode->i_mapping;
  119. if (mapping)
  120. spin_unlock(&mapping->i_shared_lock);
  121. }
  122. /*
  123.  *  sys_brk() for the most part doesn't need the global kernel
  124.  *  lock, except when an application is doing something nasty
  125.  *  like trying to un-brk an area that has already been mapped
  126.  *  to a regular file.  in this case, the unmapping will need
  127.  *  to invoke file system routines that need the global lock.
  128.  */
  129. asmlinkage unsigned long sys_brk(unsigned long brk)
  130. {
  131. unsigned long rlim, retval;
  132. unsigned long newbrk, oldbrk;
  133. struct mm_struct *mm = current->mm;
  134. down_write(&mm->mmap_sem);
  135. if (brk < mm->end_code)
  136. goto out;
  137. newbrk = PAGE_ALIGN(brk);
  138. oldbrk = PAGE_ALIGN(mm->brk);
  139. if (oldbrk == newbrk)
  140. goto set_brk;
  141. /* Always allow shrinking brk. */
  142. if (brk <= mm->brk) {
  143. if (!do_munmap(mm, newbrk, oldbrk-newbrk))
  144. goto set_brk;
  145. goto out;
  146. }
  147. /* Check against rlimit.. */
  148. rlim = current->rlim[RLIMIT_DATA].rlim_cur;
  149. if (rlim < RLIM_INFINITY && brk - mm->start_data > rlim)
  150. goto out;
  151. /* Check against existing mmap mappings. */
  152. if (find_vma_intersection(mm, oldbrk, newbrk+PAGE_SIZE))
  153. goto out;
  154. /* Check if we have enough memory.. */
  155. if (!vm_enough_memory((newbrk-oldbrk) >> PAGE_SHIFT))
  156. goto out;
  157. /* Ok, looks good - let it rip. */
  158. if (do_brk(oldbrk, newbrk-oldbrk) != oldbrk)
  159. goto out;
  160. set_brk:
  161. mm->brk = brk;
  162. out:
  163. retval = mm->brk;
  164. up_write(&mm->mmap_sem);
  165. return retval;
  166. }
  167. /* Combine the mmap "prot" and "flags" argument into one "vm_flags" used
  168.  * internally. Essentially, translate the "PROT_xxx" and "MAP_xxx" bits
  169.  * into "VM_xxx".
  170.  */
  171. static inline unsigned long calc_vm_flags(unsigned long prot, unsigned long flags)
  172. {
  173. #define _trans(x,bit1,bit2) 
  174. ((bit1==bit2)?(x&bit1):(x&bit1)?bit2:0)
  175. unsigned long prot_bits, flag_bits;
  176. prot_bits =
  177. _trans(prot, PROT_READ, VM_READ) |
  178. _trans(prot, PROT_WRITE, VM_WRITE) |
  179. _trans(prot, PROT_EXEC, VM_EXEC);
  180. flag_bits =
  181. _trans(flags, MAP_GROWSDOWN, VM_GROWSDOWN) |
  182. _trans(flags, MAP_DENYWRITE, VM_DENYWRITE) |
  183. _trans(flags, MAP_EXECUTABLE, VM_EXECUTABLE);
  184. return prot_bits | flag_bits;
  185. #undef _trans
  186. }
  187. #ifdef DEBUG_MM_RB
  188. static int browse_rb(rb_node_t * rb_node) {
  189. int i = 0;
  190. if (rb_node) {
  191. i++;
  192. i += browse_rb(rb_node->rb_left);
  193. i += browse_rb(rb_node->rb_right);
  194. }
  195. return i;
  196. }
  197. static void validate_mm(struct mm_struct * mm) {
  198. int bug = 0;
  199. int i = 0;
  200. struct vm_area_struct * tmp = mm->mmap;
  201. while (tmp) {
  202. tmp = tmp->vm_next;
  203. i++;
  204. }
  205. if (i != mm->map_count)
  206. printk("map_count %d vm_next %dn", mm->map_count, i), bug = 1;
  207. i = browse_rb(mm->mm_rb.rb_node);
  208. if (i != mm->map_count)
  209. printk("map_count %d rb %dn", mm->map_count, i), bug = 1;
  210. if (bug)
  211. BUG();
  212. }
  213. #else
  214. #define validate_mm(mm) do { } while (0)
  215. #endif
  216. static struct vm_area_struct * find_vma_prepare(struct mm_struct * mm, unsigned long addr,
  217. struct vm_area_struct ** pprev,
  218. rb_node_t *** rb_link, rb_node_t ** rb_parent)
  219. {
  220. struct vm_area_struct * vma;
  221. rb_node_t ** __rb_link, * __rb_parent, * rb_prev;
  222. __rb_link = &mm->mm_rb.rb_node;
  223. rb_prev = __rb_parent = NULL;
  224. vma = NULL;
  225. while (*__rb_link) {
  226. struct vm_area_struct *vma_tmp;
  227. __rb_parent = *__rb_link;
  228. vma_tmp = rb_entry(__rb_parent, struct vm_area_struct, vm_rb);
  229. if (vma_tmp->vm_end > addr) {
  230. vma = vma_tmp;
  231. if (vma_tmp->vm_start <= addr)
  232. return vma;
  233. __rb_link = &__rb_parent->rb_left;
  234. } else {
  235. rb_prev = __rb_parent;
  236. __rb_link = &__rb_parent->rb_right;
  237. }
  238. }
  239. *pprev = NULL;
  240. if (rb_prev)
  241. *pprev = rb_entry(rb_prev, struct vm_area_struct, vm_rb);
  242. *rb_link = __rb_link;
  243. *rb_parent = __rb_parent;
  244. return vma;
  245. }
  246. static inline void __vma_link_list(struct mm_struct * mm, struct vm_area_struct * vma, struct vm_area_struct * prev,
  247.    rb_node_t * rb_parent)
  248. {
  249. if (prev) {
  250. vma->vm_next = prev->vm_next;
  251. prev->vm_next = vma;
  252. } else {
  253. mm->mmap = vma;
  254. if (rb_parent)
  255. vma->vm_next = rb_entry(rb_parent, struct vm_area_struct, vm_rb);
  256. else
  257. vma->vm_next = NULL;
  258. }
  259. }
  260. static inline void __vma_link_rb(struct mm_struct * mm, struct vm_area_struct * vma,
  261.  rb_node_t ** rb_link, rb_node_t * rb_parent)
  262. {
  263. rb_link_node(&vma->vm_rb, rb_parent, rb_link);
  264. rb_insert_color(&vma->vm_rb, &mm->mm_rb);
  265. }
  266. static inline void __vma_link_file(struct vm_area_struct * vma)
  267. {
  268. struct file * file;
  269. file = vma->vm_file;
  270. if (file) {
  271. struct inode * inode = file->f_dentry->d_inode;
  272. struct address_space *mapping = inode->i_mapping;
  273. struct vm_area_struct **head;
  274. if (vma->vm_flags & VM_DENYWRITE)
  275. atomic_dec(&inode->i_writecount);
  276. head = &mapping->i_mmap;
  277. if (vma->vm_flags & VM_SHARED)
  278. head = &mapping->i_mmap_shared;
  279.       
  280. /* insert vma into inode's share list */
  281. if((vma->vm_next_share = *head) != NULL)
  282. (*head)->vm_pprev_share = &vma->vm_next_share;
  283. *head = vma;
  284. vma->vm_pprev_share = head;
  285. }
  286. }
  287. static void __vma_link(struct mm_struct * mm, struct vm_area_struct * vma,  struct vm_area_struct * prev,
  288.        rb_node_t ** rb_link, rb_node_t * rb_parent)
  289. {
  290. __vma_link_list(mm, vma, prev, rb_parent);
  291. __vma_link_rb(mm, vma, rb_link, rb_parent);
  292. __vma_link_file(vma);
  293. }
  294. static inline void vma_link(struct mm_struct * mm, struct vm_area_struct * vma, struct vm_area_struct * prev,
  295.     rb_node_t ** rb_link, rb_node_t * rb_parent)
  296. {
  297. lock_vma_mappings(vma);
  298. spin_lock(&mm->page_table_lock);
  299. __vma_link(mm, vma, prev, rb_link, rb_parent);
  300. spin_unlock(&mm->page_table_lock);
  301. unlock_vma_mappings(vma);
  302. mm->map_count++;
  303. validate_mm(mm);
  304. }
  305. static int vma_merge(struct mm_struct * mm, struct vm_area_struct * prev,
  306.      rb_node_t * rb_parent, unsigned long addr, unsigned long end, unsigned long vm_flags)
  307. {
  308. spinlock_t * lock = &mm->page_table_lock;
  309. if (!prev) {
  310. prev = rb_entry(rb_parent, struct vm_area_struct, vm_rb);
  311. goto merge_next;
  312. }
  313. if (prev->vm_end == addr && can_vma_merge(prev, vm_flags)) {
  314. struct vm_area_struct * next;
  315. spin_lock(lock);
  316. prev->vm_end = end;
  317. next = prev->vm_next;
  318. if (next && prev->vm_end == next->vm_start && can_vma_merge(next, vm_flags)) {
  319. prev->vm_end = next->vm_end;
  320. __vma_unlink(mm, next, prev);
  321. spin_unlock(lock);
  322. mm->map_count--;
  323. kmem_cache_free(vm_area_cachep, next);
  324. return 1;
  325. }
  326. spin_unlock(lock);
  327. return 1;
  328. }
  329. prev = prev->vm_next;
  330. if (prev) {
  331.  merge_next:
  332. if (!can_vma_merge(prev, vm_flags))
  333. return 0;
  334. if (end == prev->vm_start) {
  335. spin_lock(lock);
  336. prev->vm_start = addr;
  337. spin_unlock(lock);
  338. return 1;
  339. }
  340. }
  341. return 0;
  342. }
  343. unsigned long do_mmap_pgoff(struct file * file, unsigned long addr, unsigned long len,
  344. unsigned long prot, unsigned long flags, unsigned long pgoff)
  345. {
  346. struct mm_struct * mm = current->mm;
  347. struct vm_area_struct * vma, * prev;
  348. unsigned int vm_flags;
  349. int correct_wcount = 0;
  350. int error;
  351. rb_node_t ** rb_link, * rb_parent;
  352. if (file && (!file->f_op || !file->f_op->mmap))
  353. return -ENODEV;
  354. if ((len = PAGE_ALIGN(len)) == 0)
  355. return addr;
  356. if (len > TASK_SIZE)
  357. return -EINVAL;
  358. /* offset overflow? */
  359. if ((pgoff + (len >> PAGE_SHIFT)) < pgoff)
  360. return -EINVAL;
  361. /* Too many mappings? */
  362. if (mm->map_count > MAX_MAP_COUNT)
  363. return -ENOMEM;
  364. /* Obtain the address to map to. we verify (or select) it and ensure
  365.  * that it represents a valid section of the address space.
  366.  */
  367. addr = get_unmapped_area(file, addr, len, pgoff, flags);
  368. if (addr & ~PAGE_MASK)
  369. return addr;
  370. /* Do simple checking here so the lower-level routines won't have
  371.  * to. we assume access permissions have been handled by the open
  372.  * of the memory object, so we don't do any here.
  373.  */
  374. vm_flags = calc_vm_flags(prot,flags) | mm->def_flags | VM_MAYREAD | VM_MAYWRITE | VM_MAYEXEC;
  375. /* mlock MCL_FUTURE? */
  376. if (vm_flags & VM_LOCKED) {
  377. unsigned long locked = mm->locked_vm << PAGE_SHIFT;
  378. locked += len;
  379. if (locked > current->rlim[RLIMIT_MEMLOCK].rlim_cur)
  380. return -EAGAIN;
  381. }
  382. if (file) {
  383. switch (flags & MAP_TYPE) {
  384. case MAP_SHARED:
  385. if ((prot & PROT_WRITE) && !(file->f_mode & FMODE_WRITE))
  386. return -EACCES;
  387. /* Make sure we don't allow writing to an append-only file.. */
  388. if (IS_APPEND(file->f_dentry->d_inode) && (file->f_mode & FMODE_WRITE))
  389. return -EACCES;
  390. /* make sure there are no mandatory locks on the file. */
  391. if (locks_verify_locked(file->f_dentry->d_inode))
  392. return -EAGAIN;
  393. vm_flags |= VM_SHARED | VM_MAYSHARE;
  394. if (!(file->f_mode & FMODE_WRITE))
  395. vm_flags &= ~(VM_MAYWRITE | VM_SHARED);
  396. /* fall through */
  397. case MAP_PRIVATE:
  398. if (!(file->f_mode & FMODE_READ))
  399. return -EACCES;
  400. break;
  401. default:
  402. return -EINVAL;
  403. }
  404. } else {
  405. vm_flags |= VM_SHARED | VM_MAYSHARE;
  406. switch (flags & MAP_TYPE) {
  407. default:
  408. return -EINVAL;
  409. case MAP_PRIVATE:
  410. vm_flags &= ~(VM_SHARED | VM_MAYSHARE);
  411. /* fall through */
  412. case MAP_SHARED:
  413. break;
  414. }
  415. }
  416. /* Clear old maps */
  417. error = -ENOMEM;
  418. munmap_back:
  419. vma = find_vma_prepare(mm, addr, &prev, &rb_link, &rb_parent);
  420. if (vma && vma->vm_start < addr + len) {
  421. if (do_munmap(mm, addr, len))
  422. return -ENOMEM;
  423. goto munmap_back;
  424. }
  425. /* Check against address space limit. */
  426. if ((mm->total_vm << PAGE_SHIFT) + len
  427.     > current->rlim[RLIMIT_AS].rlim_cur)
  428. return -ENOMEM;
  429. /* Private writable mapping? Check memory availability.. */
  430. if ((vm_flags & (VM_SHARED | VM_WRITE)) == VM_WRITE &&
  431.     !(flags & MAP_NORESERVE)  &&
  432.     !vm_enough_memory(len >> PAGE_SHIFT))
  433. return -ENOMEM;
  434. /* Can we just expand an old anonymous mapping? */
  435. if (!file && !(vm_flags & VM_SHARED) && rb_parent)
  436. if (vma_merge(mm, prev, rb_parent, addr, addr + len, vm_flags))
  437. goto out;
  438. /* Determine the object being mapped and call the appropriate
  439.  * specific mapper. the address has already been validated, but
  440.  * not unmapped, but the maps are removed from the list.
  441.  */
  442. vma = kmem_cache_alloc(vm_area_cachep, SLAB_KERNEL);
  443. if (!vma)
  444. return -ENOMEM;
  445. vma->vm_mm = mm;
  446. vma->vm_start = addr;
  447. vma->vm_end = addr + len;
  448. vma->vm_flags = vm_flags;
  449. vma->vm_page_prot = protection_map[vm_flags & 0x0f];
  450. vma->vm_ops = NULL;
  451. vma->vm_pgoff = pgoff;
  452. vma->vm_file = NULL;
  453. vma->vm_private_data = NULL;
  454. vma->vm_raend = 0;
  455. if (file) {
  456. error = -EINVAL;
  457. if (vm_flags & (VM_GROWSDOWN|VM_GROWSUP))
  458. goto free_vma;
  459. if (vm_flags & VM_DENYWRITE) {
  460. error = deny_write_access(file);
  461. if (error)
  462. goto free_vma;
  463. correct_wcount = 1;
  464. }
  465. vma->vm_file = file;
  466. get_file(file);
  467. error = file->f_op->mmap(file, vma);
  468. if (error)
  469. goto unmap_and_free_vma;
  470. } else if (flags & MAP_SHARED) {
  471. error = shmem_zero_setup(vma);
  472. if (error)
  473. goto free_vma;
  474. }
  475. /* Can addr have changed??
  476.  *
  477.  * Answer: Yes, several device drivers can do it in their
  478.  *         f_op->mmap method. -DaveM
  479.  */
  480. addr = vma->vm_start;
  481. vma_link(mm, vma, prev, rb_link, rb_parent);
  482. if (correct_wcount)
  483. atomic_inc(&file->f_dentry->d_inode->i_writecount);
  484. out:
  485. mm->total_vm += len >> PAGE_SHIFT;
  486. if (vm_flags & VM_LOCKED) {
  487. mm->locked_vm += len >> PAGE_SHIFT;
  488. make_pages_present(addr, addr + len);
  489. }
  490. return addr;
  491. unmap_and_free_vma:
  492. if (correct_wcount)
  493. atomic_inc(&file->f_dentry->d_inode->i_writecount);
  494. vma->vm_file = NULL;
  495. fput(file);
  496. /* Undo any partial mapping done by a device driver. */
  497. zap_page_range(mm, vma->vm_start, vma->vm_end - vma->vm_start);
  498. free_vma:
  499. kmem_cache_free(vm_area_cachep, vma);
  500. return error;
  501. }
  502. /* Get an address range which is currently unmapped.
  503.  * For shmat() with addr=0.
  504.  *
  505.  * Ugly calling convention alert:
  506.  * Return value with the low bits set means error value,
  507.  * ie
  508.  * if (ret & ~PAGE_MASK)
  509.  * error = ret;
  510.  *
  511.  * This function "knows" that -ENOMEM has the bits set.
  512.  */
  513. #ifndef HAVE_ARCH_UNMAPPED_AREA
  514. static inline unsigned long arch_get_unmapped_area(struct file *filp, unsigned long addr, unsigned long len, unsigned long pgoff, unsigned long flags)
  515. {
  516. struct vm_area_struct *vma;
  517. if (len > TASK_SIZE)
  518. return -ENOMEM;
  519. if (addr) {
  520. addr = PAGE_ALIGN(addr);
  521. vma = find_vma(current->mm, addr);
  522. if (TASK_SIZE - len >= addr &&
  523.     (!vma || addr + len <= vma->vm_start))
  524. return addr;
  525. }
  526. addr = PAGE_ALIGN(TASK_UNMAPPED_BASE);
  527. for (vma = find_vma(current->mm, addr); ; vma = vma->vm_next) {
  528. /* At this point:  (!vma || addr < vma->vm_end). */
  529. if (TASK_SIZE - len < addr)
  530. return -ENOMEM;
  531. if (!vma || addr + len <= vma->vm_start)
  532. return addr;
  533. addr = vma->vm_end;
  534. }
  535. }
  536. #else
  537. extern unsigned long arch_get_unmapped_area(struct file *, unsigned long, unsigned long, unsigned long, unsigned long);
  538. #endif
  539. unsigned long get_unmapped_area(struct file *file, unsigned long addr, unsigned long len, unsigned long pgoff, unsigned long flags)
  540. {
  541. if (flags & MAP_FIXED) {
  542. if (addr > TASK_SIZE - len)
  543. return -ENOMEM;
  544. if (addr & ~PAGE_MASK)
  545. return -EINVAL;
  546. return addr;
  547. }
  548. if (file && file->f_op && file->f_op->get_unmapped_area)
  549. return file->f_op->get_unmapped_area(file, addr, len, pgoff, flags);
  550. return arch_get_unmapped_area(file, addr, len, pgoff, flags);
  551. }
  552. /* Look up the first VMA which satisfies  addr < vm_end,  NULL if none. */
  553. struct vm_area_struct * find_vma(struct mm_struct * mm, unsigned long addr)
  554. {
  555. struct vm_area_struct *vma = NULL;
  556. if (mm) {
  557. /* Check the cache first. */
  558. /* (Cache hit rate is typically around 35%.) */
  559. vma = mm->mmap_cache;
  560. if (!(vma && vma->vm_end > addr && vma->vm_start <= addr)) {
  561. rb_node_t * rb_node;
  562. rb_node = mm->mm_rb.rb_node;
  563. vma = NULL;
  564. while (rb_node) {
  565. struct vm_area_struct * vma_tmp;
  566. vma_tmp = rb_entry(rb_node, struct vm_area_struct, vm_rb);
  567. if (vma_tmp->vm_end > addr) {
  568. vma = vma_tmp;
  569. if (vma_tmp->vm_start <= addr)
  570. break;
  571. rb_node = rb_node->rb_left;
  572. } else
  573. rb_node = rb_node->rb_right;
  574. }
  575. if (vma)
  576. mm->mmap_cache = vma;
  577. }
  578. }
  579. return vma;
  580. }
  581. /* Same as find_vma, but also return a pointer to the previous VMA in *pprev. */
  582. struct vm_area_struct * find_vma_prev(struct mm_struct * mm, unsigned long addr,
  583.       struct vm_area_struct **pprev)
  584. {
  585. if (mm) {
  586. /* Go through the RB tree quickly. */
  587. struct vm_area_struct * vma;
  588. rb_node_t * rb_node, * rb_last_right, * rb_prev;
  589. rb_node = mm->mm_rb.rb_node;
  590. rb_last_right = rb_prev = NULL;
  591. vma = NULL;
  592. while (rb_node) {
  593. struct vm_area_struct * vma_tmp;
  594. vma_tmp = rb_entry(rb_node, struct vm_area_struct, vm_rb);
  595. if (vma_tmp->vm_end > addr) {
  596. vma = vma_tmp;
  597. rb_prev = rb_last_right;
  598. if (vma_tmp->vm_start <= addr)
  599. break;
  600. rb_node = rb_node->rb_left;
  601. } else {
  602. rb_last_right = rb_node;
  603. rb_node = rb_node->rb_right;
  604. }
  605. }
  606. if (vma) {
  607. if (vma->vm_rb.rb_left) {
  608. rb_prev = vma->vm_rb.rb_left;
  609. while (rb_prev->rb_right)
  610. rb_prev = rb_prev->rb_right;
  611. }
  612. *pprev = NULL;
  613. if (rb_prev)
  614. *pprev = rb_entry(rb_prev, struct vm_area_struct, vm_rb);
  615. if ((rb_prev ? (*pprev)->vm_next : mm->mmap) != vma)
  616. BUG();
  617. return vma;
  618. }
  619. }
  620. *pprev = NULL;
  621. return NULL;
  622. }
  623. struct vm_area_struct * find_extend_vma(struct mm_struct * mm, unsigned long addr)
  624. {
  625. struct vm_area_struct * vma;
  626. unsigned long start;
  627. addr &= PAGE_MASK;
  628. vma = find_vma(mm,addr);
  629. if (!vma)
  630. return NULL;
  631. if (vma->vm_start <= addr)
  632. return vma;
  633. if (!(vma->vm_flags & VM_GROWSDOWN))
  634. return NULL;
  635. start = vma->vm_start;
  636. if (expand_stack(vma, addr))
  637. return NULL;
  638. if (vma->vm_flags & VM_LOCKED) {
  639. make_pages_present(addr, start);
  640. }
  641. return vma;
  642. }
  643. /* Normal function to fix up a mapping
  644.  * This function is the default for when an area has no specific
  645.  * function.  This may be used as part of a more specific routine.
  646.  * This function works out what part of an area is affected and
  647.  * adjusts the mapping information.  Since the actual page
  648.  * manipulation is done in do_mmap(), none need be done here,
  649.  * though it would probably be more appropriate.
  650.  *
  651.  * By the time this function is called, the area struct has been
  652.  * removed from the process mapping list, so it needs to be
  653.  * reinserted if necessary.
  654.  *
  655.  * The 4 main cases are:
  656.  *    Unmapping the whole area
  657.  *    Unmapping from the start of the segment to a point in it
  658.  *    Unmapping from an intermediate point to the end
  659.  *    Unmapping between to intermediate points, making a hole.
  660.  *
  661.  * Case 4 involves the creation of 2 new areas, for each side of
  662.  * the hole.  If possible, we reuse the existing area rather than
  663.  * allocate a new one, and the return indicates whether the old
  664.  * area was reused.
  665.  */
  666. static struct vm_area_struct * unmap_fixup(struct mm_struct *mm, 
  667. struct vm_area_struct *area, unsigned long addr, size_t len, 
  668. struct vm_area_struct *extra)
  669. {
  670. struct vm_area_struct *mpnt;
  671. unsigned long end = addr + len;
  672. area->vm_mm->total_vm -= len >> PAGE_SHIFT;
  673. if (area->vm_flags & VM_LOCKED)
  674. area->vm_mm->locked_vm -= len >> PAGE_SHIFT;
  675. /* Unmapping the whole area. */
  676. if (addr == area->vm_start && end == area->vm_end) {
  677. if (area->vm_ops && area->vm_ops->close)
  678. area->vm_ops->close(area);
  679. if (area->vm_file)
  680. fput(area->vm_file);
  681. kmem_cache_free(vm_area_cachep, area);
  682. return extra;
  683. }
  684. /* Work out to one of the ends. */
  685. if (end == area->vm_end) {
  686. /*
  687.  * here area isn't visible to the semaphore-less readers
  688.  * so we don't need to update it under the spinlock.
  689.  */
  690. area->vm_end = addr;
  691. lock_vma_mappings(area);
  692. spin_lock(&mm->page_table_lock);
  693. } else if (addr == area->vm_start) {
  694. area->vm_pgoff += (end - area->vm_start) >> PAGE_SHIFT;
  695. /* same locking considerations of the above case */
  696. area->vm_start = end;
  697. lock_vma_mappings(area);
  698. spin_lock(&mm->page_table_lock);
  699. } else {
  700. /* Unmapping a hole: area->vm_start < addr <= end < area->vm_end */
  701. /* Add end mapping -- leave beginning for below */
  702. mpnt = extra;
  703. extra = NULL;
  704. mpnt->vm_mm = area->vm_mm;
  705. mpnt->vm_start = end;
  706. mpnt->vm_end = area->vm_end;
  707. mpnt->vm_page_prot = area->vm_page_prot;
  708. mpnt->vm_flags = area->vm_flags;
  709. mpnt->vm_raend = 0;
  710. mpnt->vm_ops = area->vm_ops;
  711. mpnt->vm_pgoff = area->vm_pgoff + ((end - area->vm_start) >> PAGE_SHIFT);
  712. mpnt->vm_file = area->vm_file;
  713. mpnt->vm_private_data = area->vm_private_data;
  714. if (mpnt->vm_file)
  715. get_file(mpnt->vm_file);
  716. if (mpnt->vm_ops && mpnt->vm_ops->open)
  717. mpnt->vm_ops->open(mpnt);
  718. area->vm_end = addr; /* Truncate area */
  719. /* Because mpnt->vm_file == area->vm_file this locks
  720.  * things correctly.
  721.  */
  722. lock_vma_mappings(area);
  723. spin_lock(&mm->page_table_lock);
  724. __insert_vm_struct(mm, mpnt);
  725. }
  726. __insert_vm_struct(mm, area);
  727. spin_unlock(&mm->page_table_lock);
  728. unlock_vma_mappings(area);
  729. return extra;
  730. }
  731. /*
  732.  * Try to free as many page directory entries as we can,
  733.  * without having to work very hard at actually scanning
  734.  * the page tables themselves.
  735.  *
  736.  * Right now we try to free page tables if we have a nice
  737.  * PGDIR-aligned area that got free'd up. We could be more
  738.  * granular if we want to, but this is fast and simple,
  739.  * and covers the bad cases.
  740.  *
  741.  * "prev", if it exists, points to a vma before the one
  742.  * we just free'd - but there's no telling how much before.
  743.  */
  744. static void free_pgtables(struct mm_struct * mm, struct vm_area_struct *prev,
  745. unsigned long start, unsigned long end)
  746. {
  747. unsigned long first = start & PGDIR_MASK;
  748. unsigned long last = end + PGDIR_SIZE - 1;
  749. unsigned long start_index, end_index;
  750. if (!prev) {
  751. prev = mm->mmap;
  752. if (!prev)
  753. goto no_mmaps;
  754. if (prev->vm_end > start) {
  755. if (last > prev->vm_start)
  756. last = prev->vm_start;
  757. goto no_mmaps;
  758. }
  759. }
  760. for (;;) {
  761. struct vm_area_struct *next = prev->vm_next;
  762. if (next) {
  763. if (next->vm_start < start) {
  764. prev = next;
  765. continue;
  766. }
  767. if (last > next->vm_start)
  768. last = next->vm_start;
  769. }
  770. if (prev->vm_end > first)
  771. first = prev->vm_end + PGDIR_SIZE - 1;
  772. break;
  773. }
  774. no_mmaps:
  775. /*
  776.  * If the PGD bits are not consecutive in the virtual address, the
  777.  * old method of shifting the VA >> by PGDIR_SHIFT doesn't work.
  778.  */
  779. start_index = pgd_index(first);
  780. if (start_index < FIRST_USER_PGD_NR)
  781. start_index = FIRST_USER_PGD_NR;
  782. end_index = pgd_index(last);
  783. if (end_index > start_index) {
  784. clear_page_tables(mm, start_index, end_index - start_index);
  785. flush_tlb_pgtables(mm, first & PGDIR_MASK, last & PGDIR_MASK);
  786. }
  787. }
  788. /* Munmap is split into 2 main parts -- this part which finds
  789.  * what needs doing, and the areas themselves, which do the
  790.  * work.  This now handles partial unmappings.
  791.  * Jeremy Fitzhardine <jeremy@sw.oz.au>
  792.  */
  793. int do_munmap(struct mm_struct *mm, unsigned long addr, size_t len)
  794. {
  795. struct vm_area_struct *mpnt, *prev, **npp, *free, *extra;
  796. if ((addr & ~PAGE_MASK) || addr > TASK_SIZE || len > TASK_SIZE-addr)
  797. return -EINVAL;
  798. if ((len = PAGE_ALIGN(len)) == 0)
  799. return -EINVAL;
  800. /* Check if this memory area is ok - put it on the temporary
  801.  * list if so..  The checks here are pretty simple --
  802.  * every area affected in some way (by any overlap) is put
  803.  * on the list.  If nothing is put on, nothing is affected.
  804.  */
  805. mpnt = find_vma_prev(mm, addr, &prev);
  806. if (!mpnt)
  807. return 0;
  808. /* we have  addr < mpnt->vm_end  */
  809. if (mpnt->vm_start >= addr+len)
  810. return 0;
  811. /* If we'll make "hole", check the vm areas limit */
  812. if ((mpnt->vm_start < addr && mpnt->vm_end > addr+len)
  813.     && mm->map_count >= MAX_MAP_COUNT)
  814. return -ENOMEM;
  815. /*
  816.  * We may need one additional vma to fix up the mappings ... 
  817.  * and this is the last chance for an easy error exit.
  818.  */
  819. extra = kmem_cache_alloc(vm_area_cachep, SLAB_KERNEL);
  820. if (!extra)
  821. return -ENOMEM;
  822. npp = (prev ? &prev->vm_next : &mm->mmap);
  823. free = NULL;
  824. spin_lock(&mm->page_table_lock);
  825. for ( ; mpnt && mpnt->vm_start < addr+len; mpnt = *npp) {
  826. *npp = mpnt->vm_next;
  827. mpnt->vm_next = free;
  828. free = mpnt;
  829. rb_erase(&mpnt->vm_rb, &mm->mm_rb);
  830. }
  831. mm->mmap_cache = NULL; /* Kill the cache. */
  832. spin_unlock(&mm->page_table_lock);
  833. /* Ok - we have the memory areas we should free on the 'free' list,
  834.  * so release them, and unmap the page range..
  835.  * If the one of the segments is only being partially unmapped,
  836.  * it will put new vm_area_struct(s) into the address space.
  837.  * In that case we have to be careful with VM_DENYWRITE.
  838.  */
  839. while ((mpnt = free) != NULL) {
  840. unsigned long st, end, size;
  841. struct file *file = NULL;
  842. free = free->vm_next;
  843. st = addr < mpnt->vm_start ? mpnt->vm_start : addr;
  844. end = addr+len;
  845. end = end > mpnt->vm_end ? mpnt->vm_end : end;
  846. size = end - st;
  847. if (mpnt->vm_flags & VM_DENYWRITE &&
  848.     (st != mpnt->vm_start || end != mpnt->vm_end) &&
  849.     (file = mpnt->vm_file) != NULL) {
  850. atomic_dec(&file->f_dentry->d_inode->i_writecount);
  851. }
  852. remove_shared_vm_struct(mpnt);
  853. mm->map_count--;
  854. zap_page_range(mm, st, size);
  855. /*
  856.  * Fix the mapping, and free the old area if it wasn't reused.
  857.  */
  858. extra = unmap_fixup(mm, mpnt, st, size, extra);
  859. if (file)
  860. atomic_inc(&file->f_dentry->d_inode->i_writecount);
  861. }
  862. validate_mm(mm);
  863. /* Release the extra vma struct if it wasn't used */
  864. if (extra)
  865. kmem_cache_free(vm_area_cachep, extra);
  866. free_pgtables(mm, prev, addr, addr+len);
  867. return 0;
  868. }
  869. asmlinkage long sys_munmap(unsigned long addr, size_t len)
  870. {
  871. int ret;
  872. struct mm_struct *mm = current->mm;
  873. down_write(&mm->mmap_sem);
  874. ret = do_munmap(mm, addr, len);
  875. up_write(&mm->mmap_sem);
  876. return ret;
  877. }
  878. /*
  879.  *  this is really a simplified "do_mmap".  it only handles
  880.  *  anonymous maps.  eventually we may be able to do some
  881.  *  brk-specific accounting here.
  882.  */
  883. unsigned long do_brk(unsigned long addr, unsigned long len)
  884. {
  885. struct mm_struct * mm = current->mm;
  886. struct vm_area_struct * vma, * prev;
  887. unsigned long flags;
  888. rb_node_t ** rb_link, * rb_parent;
  889. len = PAGE_ALIGN(len);
  890. if (!len)
  891. return addr;
  892. /*
  893.  * mlock MCL_FUTURE?
  894.  */
  895. if (mm->def_flags & VM_LOCKED) {
  896. unsigned long locked = mm->locked_vm << PAGE_SHIFT;
  897. locked += len;
  898. if (locked > current->rlim[RLIMIT_MEMLOCK].rlim_cur)
  899. return -EAGAIN;
  900. }
  901. /*
  902.  * Clear old maps.  this also does some error checking for us
  903.  */
  904.  munmap_back:
  905. vma = find_vma_prepare(mm, addr, &prev, &rb_link, &rb_parent);
  906. if (vma && vma->vm_start < addr + len) {
  907. if (do_munmap(mm, addr, len))
  908. return -ENOMEM;
  909. goto munmap_back;
  910. }
  911. /* Check against address space limits *after* clearing old maps... */
  912. if ((mm->total_vm << PAGE_SHIFT) + len
  913.     > current->rlim[RLIMIT_AS].rlim_cur)
  914. return -ENOMEM;
  915. if (mm->map_count > MAX_MAP_COUNT)
  916. return -ENOMEM;
  917. if (!vm_enough_memory(len >> PAGE_SHIFT))
  918. return -ENOMEM;
  919. flags = calc_vm_flags(PROT_READ|PROT_WRITE|PROT_EXEC,
  920. MAP_FIXED|MAP_PRIVATE) | mm->def_flags;
  921. flags |= VM_MAYREAD | VM_MAYWRITE | VM_MAYEXEC;
  922. /* Can we just expand an old anonymous mapping? */
  923. if (rb_parent && vma_merge(mm, prev, rb_parent, addr, addr + len, flags))
  924. goto out;
  925. /*
  926.  * create a vma struct for an anonymous mapping
  927.  */
  928. vma = kmem_cache_alloc(vm_area_cachep, SLAB_KERNEL);
  929. if (!vma)
  930. return -ENOMEM;
  931. vma->vm_mm = mm;
  932. vma->vm_start = addr;
  933. vma->vm_end = addr + len;
  934. vma->vm_flags = flags;
  935. vma->vm_page_prot = protection_map[flags & 0x0f];
  936. vma->vm_ops = NULL;
  937. vma->vm_pgoff = 0;
  938. vma->vm_file = NULL;
  939. vma->vm_private_data = NULL;
  940. vma_link(mm, vma, prev, rb_link, rb_parent);
  941. out:
  942. mm->total_vm += len >> PAGE_SHIFT;
  943. if (flags & VM_LOCKED) {
  944. mm->locked_vm += len >> PAGE_SHIFT;
  945. make_pages_present(addr, addr + len);
  946. }
  947. return addr;
  948. }
  949. /* Build the RB tree corresponding to the VMA list. */
  950. void build_mmap_rb(struct mm_struct * mm)
  951. {
  952. struct vm_area_struct * vma;
  953. rb_node_t ** rb_link, * rb_parent;
  954. mm->mm_rb = RB_ROOT;
  955. rb_link = &mm->mm_rb.rb_node;
  956. rb_parent = NULL;
  957. for (vma = mm->mmap; vma; vma = vma->vm_next) {
  958. __vma_link_rb(mm, vma, rb_link, rb_parent);
  959. rb_parent = &vma->vm_rb;
  960. rb_link = &rb_parent->rb_right;
  961. }
  962. }
  963. /* Release all mmaps. */
  964. void exit_mmap(struct mm_struct * mm)
  965. {
  966. mmu_gather_t *tlb;
  967. struct vm_area_struct * mpnt;
  968. release_segments(mm);
  969. spin_lock(&mm->page_table_lock);
  970. tlb = tlb_gather_mmu(mm);
  971. flush_cache_mm(mm);
  972. mpnt = mm->mmap;
  973. while (mpnt) {
  974. unsigned long start = mpnt->vm_start;
  975. unsigned long end = mpnt->vm_end;
  976. mm->map_count--;
  977. remove_shared_vm_struct(mpnt);
  978. unmap_page_range(tlb, mm, start, end);
  979. mpnt = mpnt->vm_next;
  980. }
  981. /* This is just debugging */
  982. if (mm->map_count)
  983. BUG();
  984. tlb_finish_mmu(tlb, 0, TASK_SIZE);
  985. mpnt = mm->mmap;
  986. mm->mmap = mm->mmap_cache = NULL;
  987. mm->mm_rb = RB_ROOT;
  988. mm->rss = 0;
  989. mm->total_vm = 0;
  990. mm->locked_vm = 0;
  991. spin_unlock(&mm->page_table_lock);
  992. clear_page_tables(mm, FIRST_USER_PGD_NR, USER_PTRS_PER_PGD);
  993. /*
  994.  * Walk the list again, actually closing and freeing it
  995.  * without holding any MM locks.
  996.  */
  997. while (mpnt) {
  998. struct vm_area_struct * next = mpnt->vm_next;
  999. if (mpnt->vm_ops) {
  1000. if (mpnt->vm_ops->close)
  1001. mpnt->vm_ops->close(mpnt);
  1002. }
  1003. if (mpnt->vm_file)
  1004. fput(mpnt->vm_file);
  1005. kmem_cache_free(vm_area_cachep, mpnt);
  1006. mpnt = next;
  1007. }
  1008. }
  1009. /* Insert vm structure into process list sorted by address
  1010.  * and into the inode's i_mmap ring.  If vm_file is non-NULL
  1011.  * then the i_shared_lock must be held here.
  1012.  */
  1013. void __insert_vm_struct(struct mm_struct * mm, struct vm_area_struct * vma)
  1014. {
  1015. struct vm_area_struct * __vma, * prev;
  1016. rb_node_t ** rb_link, * rb_parent;
  1017. __vma = find_vma_prepare(mm, vma->vm_start, &prev, &rb_link, &rb_parent);
  1018. if (__vma && __vma->vm_start < vma->vm_end)
  1019. BUG();
  1020. __vma_link(mm, vma, prev, rb_link, rb_parent);
  1021. mm->map_count++;
  1022. validate_mm(mm);
  1023. }
  1024. void insert_vm_struct(struct mm_struct * mm, struct vm_area_struct * vma)
  1025. {
  1026. struct vm_area_struct * __vma, * prev;
  1027. rb_node_t ** rb_link, * rb_parent;
  1028. __vma = find_vma_prepare(mm, vma->vm_start, &prev, &rb_link, &rb_parent);
  1029. if (__vma && __vma->vm_start < vma->vm_end)
  1030. BUG();
  1031. vma_link(mm, vma, prev, rb_link, rb_parent);
  1032. validate_mm(mm);
  1033. }