143 lines
		
	
	
		
			3.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			143 lines
		
	
	
		
			3.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  *  linux/arch/arm/mm/mmap.c
 | |
|  */
 | |
| #include <linux/fs.h>
 | |
| #include <linux/mm.h>
 | |
| #include <linux/mman.h>
 | |
| #include <linux/shm.h>
 | |
| #include <linux/sched.h>
 | |
| #include <linux/io.h>
 | |
| #include <asm/cputype.h>
 | |
| #include <asm/system.h>
 | |
| 
 | |
| #define COLOUR_ALIGN(addr,pgoff)		\
 | |
| 	((((addr)+SHMLBA-1)&~(SHMLBA-1)) +	\
 | |
| 	 (((pgoff)<<PAGE_SHIFT) & (SHMLBA-1)))
 | |
| 
 | |
| /*
 | |
|  * We need to ensure that shared mappings are correctly aligned to
 | |
|  * avoid aliasing issues with VIPT caches.  We need to ensure that
 | |
|  * a specific page of an object is always mapped at a multiple of
 | |
|  * SHMLBA bytes.
 | |
|  *
 | |
|  * We unconditionally provide this function for all cases, however
 | |
|  * in the VIVT case, we optimise out the alignment rules.
 | |
|  */
 | |
| unsigned long
 | |
| arch_get_unmapped_area(struct file *filp, unsigned long addr,
 | |
| 		unsigned long len, unsigned long pgoff, unsigned long flags)
 | |
| {
 | |
| 	struct mm_struct *mm = current->mm;
 | |
| 	struct vm_area_struct *vma;
 | |
| 	unsigned long start_addr;
 | |
| #ifdef CONFIG_CPU_V6
 | |
| 	unsigned int cache_type;
 | |
| 	int do_align = 0, aliasing = 0;
 | |
| 
 | |
| 	/*
 | |
| 	 * We only need to do colour alignment if either the I or D
 | |
| 	 * caches alias.  This is indicated by bits 9 and 21 of the
 | |
| 	 * cache type register.
 | |
| 	 */
 | |
| 	cache_type = read_cpuid_cachetype();
 | |
| 	if (cache_type != read_cpuid_id()) {
 | |
| 		aliasing = (cache_type | cache_type >> 12) & (1 << 11);
 | |
| 		if (aliasing)
 | |
| 			do_align = filp || flags & MAP_SHARED;
 | |
| 	}
 | |
| #else
 | |
| #define do_align 0
 | |
| #define aliasing 0
 | |
| #endif
 | |
| 
 | |
| 	/*
 | |
| 	 * We enforce the MAP_FIXED case.
 | |
| 	 */
 | |
| 	if (flags & MAP_FIXED) {
 | |
| 		if (aliasing && flags & MAP_SHARED &&
 | |
| 		    (addr - (pgoff << PAGE_SHIFT)) & (SHMLBA - 1))
 | |
| 			return -EINVAL;
 | |
| 		return addr;
 | |
| 	}
 | |
| 
 | |
| 	if (len > TASK_SIZE)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	if (addr) {
 | |
| 		if (do_align)
 | |
| 			addr = COLOUR_ALIGN(addr, pgoff);
 | |
| 		else
 | |
| 			addr = PAGE_ALIGN(addr);
 | |
| 
 | |
| 		vma = find_vma(mm, addr);
 | |
| 		if (TASK_SIZE - len >= addr &&
 | |
| 		    (!vma || addr + len <= vma->vm_start))
 | |
| 			return addr;
 | |
| 	}
 | |
| 	if (len > mm->cached_hole_size) {
 | |
| 	        start_addr = addr = mm->free_area_cache;
 | |
| 	} else {
 | |
| 	        start_addr = addr = TASK_UNMAPPED_BASE;
 | |
| 	        mm->cached_hole_size = 0;
 | |
| 	}
 | |
| 
 | |
| full_search:
 | |
| 	if (do_align)
 | |
| 		addr = COLOUR_ALIGN(addr, pgoff);
 | |
| 	else
 | |
| 		addr = PAGE_ALIGN(addr);
 | |
| 
 | |
| 	for (vma = find_vma(mm, addr); ; vma = vma->vm_next) {
 | |
| 		/* At this point:  (!vma || addr < vma->vm_end). */
 | |
| 		if (TASK_SIZE - len < addr) {
 | |
| 			/*
 | |
| 			 * Start a new search - just in case we missed
 | |
| 			 * some holes.
 | |
| 			 */
 | |
| 			if (start_addr != TASK_UNMAPPED_BASE) {
 | |
| 				start_addr = addr = TASK_UNMAPPED_BASE;
 | |
| 				mm->cached_hole_size = 0;
 | |
| 				goto full_search;
 | |
| 			}
 | |
| 			return -ENOMEM;
 | |
| 		}
 | |
| 		if (!vma || addr + len <= vma->vm_start) {
 | |
| 			/*
 | |
| 			 * Remember the place where we stopped the search:
 | |
| 			 */
 | |
| 			mm->free_area_cache = addr + len;
 | |
| 			return addr;
 | |
| 		}
 | |
| 		if (addr + mm->cached_hole_size < vma->vm_start)
 | |
| 		        mm->cached_hole_size = vma->vm_start - addr;
 | |
| 		addr = vma->vm_end;
 | |
| 		if (do_align)
 | |
| 			addr = COLOUR_ALIGN(addr, pgoff);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * You really shouldn't be using read() or write() on /dev/mem.  This
 | |
|  * might go away in the future.
 | |
|  */
 | |
| int valid_phys_addr_range(unsigned long addr, size_t size)
 | |
| {
 | |
| 	if (addr < PHYS_OFFSET)
 | |
| 		return 0;
 | |
| 	if (addr + size > __pa(high_memory - 1) + 1)
 | |
| 		return 0;
 | |
| 
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * We don't use supersection mappings for mmap() on /dev/mem, which
 | |
|  * means that we can't map the memory area above the 4G barrier into
 | |
|  * userspace.
 | |
|  */
 | |
| int valid_mmap_phys_addr_range(unsigned long pfn, size_t size)
 | |
| {
 | |
| 	return !(pfn + (size >> PAGE_SHIFT) > 0x00100000);
 | |
| }
 |