| 
									
										
										
										
											2014-08-19 20:41:43 +01:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * Copyright (c) 2014, The Linux Foundation. All rights reserved. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This program is free software; you can redistribute it and/or modify | 
					
						
							|  |  |  |  * it under the terms of the GNU General Public License version 2 and | 
					
						
							|  |  |  |  * only version 2 as published by the Free Software Foundation. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This program is distributed in the hope that it will be useful, | 
					
						
							|  |  |  |  * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
					
						
							|  |  |  |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
					
						
							|  |  |  |  * GNU General Public License for more details. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | #include <linux/kernel.h>
 | 
					
						
							|  |  |  | #include <linux/mm.h>
 | 
					
						
							|  |  |  | #include <linux/module.h>
 | 
					
						
							|  |  |  | #include <linux/sched.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include <asm/pgtable.h>
 | 
					
						
							|  |  |  | #include <asm/tlbflush.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | struct page_change_data { | 
					
						
							|  |  |  | 	pgprot_t set_mask; | 
					
						
							|  |  |  | 	pgprot_t clear_mask; | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int change_page_range(pte_t *ptep, pgtable_t token, unsigned long addr, | 
					
						
							|  |  |  | 			void *data) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct page_change_data *cdata = data; | 
					
						
							|  |  |  | 	pte_t pte = *ptep; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	pte = clear_pte_bit(pte, cdata->clear_mask); | 
					
						
							|  |  |  | 	pte = set_pte_bit(pte, cdata->set_mask); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	set_pte(ptep, pte); | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int change_memory_common(unsigned long addr, int numpages, | 
					
						
							|  |  |  | 				pgprot_t set_mask, pgprot_t clear_mask) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	unsigned long start = addr; | 
					
						
							|  |  |  | 	unsigned long size = PAGE_SIZE*numpages; | 
					
						
							|  |  |  | 	unsigned long end = start + size; | 
					
						
							|  |  |  | 	int ret; | 
					
						
							|  |  |  | 	struct page_change_data data; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!IS_ALIGNED(addr, PAGE_SIZE)) { | 
					
						
							| 
									
										
										
										
											2014-09-11 23:10:32 +01:00
										 |  |  | 		start &= PAGE_MASK; | 
					
						
							|  |  |  | 		end = start + size; | 
					
						
							| 
									
										
										
										
											2014-08-19 20:41:43 +01:00
										 |  |  | 		WARN_ON_ONCE(1); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2015-02-25 14:14:55 -08:00
										 |  |  | 	if (start < MODULES_VADDR || start >= MODULES_END) | 
					
						
							|  |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (end < MODULES_VADDR || end >= MODULES_END) | 
					
						
							| 
									
										
										
										
											2014-08-19 20:41:43 +01:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	data.set_mask = set_mask; | 
					
						
							|  |  |  | 	data.clear_mask = clear_mask; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	ret = apply_to_page_range(&init_mm, start, size, change_page_range, | 
					
						
							|  |  |  | 					&data); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	flush_tlb_kernel_range(start, end); | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | int set_memory_ro(unsigned long addr, int numpages) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	return change_memory_common(addr, numpages, | 
					
						
							|  |  |  | 					__pgprot(PTE_RDONLY), | 
					
						
							|  |  |  | 					__pgprot(PTE_WRITE)); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | EXPORT_SYMBOL_GPL(set_memory_ro); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | int set_memory_rw(unsigned long addr, int numpages) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	return change_memory_common(addr, numpages, | 
					
						
							|  |  |  | 					__pgprot(PTE_WRITE), | 
					
						
							|  |  |  | 					__pgprot(PTE_RDONLY)); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | EXPORT_SYMBOL_GPL(set_memory_rw); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | int set_memory_nx(unsigned long addr, int numpages) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	return change_memory_common(addr, numpages, | 
					
						
							|  |  |  | 					__pgprot(PTE_PXN), | 
					
						
							|  |  |  | 					__pgprot(0)); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | EXPORT_SYMBOL_GPL(set_memory_nx); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | int set_memory_x(unsigned long addr, int numpages) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	return change_memory_common(addr, numpages, | 
					
						
							|  |  |  | 					__pgprot(0), | 
					
						
							|  |  |  | 					__pgprot(PTE_PXN)); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | EXPORT_SYMBOL_GPL(set_memory_x); |