190 lines
		
	
	
		
			4.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			190 lines
		
	
	
		
			4.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Alignment access counters and corresponding user-space interfaces.
 | |
|  *
 | |
|  * Copyright (C) 2009 ST Microelectronics
 | |
|  * Copyright (C) 2009 - 2010 Paul Mundt
 | |
|  *
 | |
|  * This file is subject to the terms and conditions of the GNU General Public
 | |
|  * License.  See the file "COPYING" in the main directory of this archive
 | |
|  * for more details.
 | |
|  */
 | |
| #include <linux/module.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/seq_file.h>
 | |
| #include <linux/proc_fs.h>
 | |
| #include <linux/uaccess.h>
 | |
| #include <linux/ratelimit.h>
 | |
| #include <asm/alignment.h>
 | |
| #include <asm/processor.h>
 | |
| 
 | |
| static unsigned long se_user;
 | |
| static unsigned long se_sys;
 | |
| static unsigned long se_half;
 | |
| static unsigned long se_word;
 | |
| static unsigned long se_dword;
 | |
| static unsigned long se_multi;
 | |
| /* bitfield: 1: warn 2: fixup 4: signal -> combinations 2|4 && 1|2|4 are not
 | |
|    valid! */
 | |
| static int se_usermode = UM_WARN | UM_FIXUP;
 | |
| /* 0: no warning 1: print a warning message, disabled by default */
 | |
| static int se_kernmode_warn;
 | |
| 
 | |
| core_param(alignment, se_usermode, int, 0600);
 | |
| 
 | |
| void inc_unaligned_byte_access(void)
 | |
| {
 | |
| 	se_half++;
 | |
| }
 | |
| 
 | |
| void inc_unaligned_word_access(void)
 | |
| {
 | |
| 	se_word++;
 | |
| }
 | |
| 
 | |
| void inc_unaligned_dword_access(void)
 | |
| {
 | |
| 	se_dword++;
 | |
| }
 | |
| 
 | |
| void inc_unaligned_multi_access(void)
 | |
| {
 | |
| 	se_multi++;
 | |
| }
 | |
| 
 | |
| void inc_unaligned_user_access(void)
 | |
| {
 | |
| 	se_user++;
 | |
| }
 | |
| 
 | |
| void inc_unaligned_kernel_access(void)
 | |
| {
 | |
| 	se_sys++;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * This defaults to the global policy which can be set from the command
 | |
|  * line, while processes can overload their preferences via prctl().
 | |
|  */
 | |
| unsigned int unaligned_user_action(void)
 | |
| {
 | |
| 	unsigned int action = se_usermode;
 | |
| 
 | |
| 	if (current->thread.flags & SH_THREAD_UAC_SIGBUS) {
 | |
| 		action &= ~UM_FIXUP;
 | |
| 		action |= UM_SIGNAL;
 | |
| 	}
 | |
| 
 | |
| 	if (current->thread.flags & SH_THREAD_UAC_NOPRINT)
 | |
| 		action &= ~UM_WARN;
 | |
| 
 | |
| 	return action;
 | |
| }
 | |
| 
 | |
| int get_unalign_ctl(struct task_struct *tsk, unsigned long addr)
 | |
| {
 | |
| 	return put_user(tsk->thread.flags & SH_THREAD_UAC_MASK,
 | |
| 			(unsigned int __user *)addr);
 | |
| }
 | |
| 
 | |
| int set_unalign_ctl(struct task_struct *tsk, unsigned int val)
 | |
| {
 | |
| 	tsk->thread.flags = (tsk->thread.flags & ~SH_THREAD_UAC_MASK) |
 | |
| 			    (val & SH_THREAD_UAC_MASK);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| void unaligned_fixups_notify(struct task_struct *tsk, insn_size_t insn,
 | |
| 			     struct pt_regs *regs)
 | |
| {
 | |
| 	if (user_mode(regs) && (se_usermode & UM_WARN))
 | |
| 		pr_notice_ratelimited("Fixing up unaligned userspace access "
 | |
| 			  "in \"%s\" pid=%d pc=0x%p ins=0x%04hx\n",
 | |
| 			  tsk->comm, task_pid_nr(tsk),
 | |
| 			  (void *)instruction_pointer(regs), insn);
 | |
| 	else if (se_kernmode_warn)
 | |
| 		pr_notice_ratelimited("Fixing up unaligned kernel access "
 | |
| 			  "in \"%s\" pid=%d pc=0x%p ins=0x%04hx\n",
 | |
| 			  tsk->comm, task_pid_nr(tsk),
 | |
| 			  (void *)instruction_pointer(regs), insn);
 | |
| }
 | |
| 
 | |
| static const char *se_usermode_action[] = {
 | |
| 	"ignored",
 | |
| 	"warn",
 | |
| 	"fixup",
 | |
| 	"fixup+warn",
 | |
| 	"signal",
 | |
| 	"signal+warn"
 | |
| };
 | |
| 
 | |
| static int alignment_proc_show(struct seq_file *m, void *v)
 | |
| {
 | |
| 	seq_printf(m, "User:\t\t%lu\n", se_user);
 | |
| 	seq_printf(m, "System:\t\t%lu\n", se_sys);
 | |
| 	seq_printf(m, "Half:\t\t%lu\n", se_half);
 | |
| 	seq_printf(m, "Word:\t\t%lu\n", se_word);
 | |
| 	seq_printf(m, "DWord:\t\t%lu\n", se_dword);
 | |
| 	seq_printf(m, "Multi:\t\t%lu\n", se_multi);
 | |
| 	seq_printf(m, "User faults:\t%i (%s)\n", se_usermode,
 | |
| 			se_usermode_action[se_usermode]);
 | |
| 	seq_printf(m, "Kernel faults:\t%i (fixup%s)\n", se_kernmode_warn,
 | |
| 			se_kernmode_warn ? "+warn" : "");
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int alignment_proc_open(struct inode *inode, struct file *file)
 | |
| {
 | |
| 	return single_open(file, alignment_proc_show, NULL);
 | |
| }
 | |
| 
 | |
| static ssize_t alignment_proc_write(struct file *file,
 | |
| 		const char __user *buffer, size_t count, loff_t *pos)
 | |
| {
 | |
| 	int *data = pde_data(file_inode(file));
 | |
| 	char mode;
 | |
| 
 | |
| 	if (count > 0) {
 | |
| 		if (get_user(mode, buffer))
 | |
| 			return -EFAULT;
 | |
| 		if (mode >= '0' && mode <= '5')
 | |
| 			*data = mode - '0';
 | |
| 	}
 | |
| 	return count;
 | |
| }
 | |
| 
 | |
| static const struct proc_ops alignment_proc_ops = {
 | |
| 	.proc_open	= alignment_proc_open,
 | |
| 	.proc_read	= seq_read,
 | |
| 	.proc_lseek	= seq_lseek,
 | |
| 	.proc_release	= single_release,
 | |
| 	.proc_write	= alignment_proc_write,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * This needs to be done after sysctl_init_bases(), otherwise sys/ will be
 | |
|  * overwritten.  Actually, this shouldn't be in sys/ at all since
 | |
|  * it isn't a sysctl, and it doesn't contain sysctl information.
 | |
|  * We now locate it in /proc/cpu/alignment instead.
 | |
|  */
 | |
| static int __init alignment_init(void)
 | |
| {
 | |
| 	struct proc_dir_entry *dir, *res;
 | |
| 
 | |
| 	dir = proc_mkdir("cpu", NULL);
 | |
| 	if (!dir)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	res = proc_create_data("alignment", S_IWUSR | S_IRUGO, dir,
 | |
| 			       &alignment_proc_ops, &se_usermode);
 | |
| 	if (!res)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
|         res = proc_create_data("kernel_alignment", S_IWUSR | S_IRUGO, dir,
 | |
| 			       &alignment_proc_ops, &se_kernmode_warn);
 | |
|         if (!res)
 | |
|                 return -ENOMEM;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| fs_initcall(alignment_init);
 |