[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / parisc / mm / fault.c

/*
 * 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.
 *
 *
 * Copyright (C) 1995, 1996, 1997, 1998 by Ralf Baechle
 * Copyright 1999 SuSE GmbH (Philipp Rumpf, prumpf@tux.org)
 * Copyright 1999 Hewlett Packard Co.
 *
 */

#include <linux/mm.h>
#include <linux/ptrace.h>
#include <linux/sched.h>
#include <linux/interrupt.h>
#include <linux/module.h>

#include <asm/uaccess.h>
#include <asm/traps.h>

#define PRINT_USER_FAULTS /* (turn this on if you want user faults to be */
			 /*  dumped to the console via printk)          */


/* Various important other fields */
#define bit22set(x)		(x & 0x00000200)
#define bits23_25set(x)		(x & 0x000001c0)
#define isGraphicsFlushRead(x)	((x & 0xfc003fdf) == 0x04001a80)
				/* extended opcode is 0x6a */

#define BITSSET		0x1c0	/* for identifying LDCW */


DEFINE_PER_CPU(struct exception_data, exception_data);

/*
 * parisc_acctyp(unsigned int inst) --
 *    Given a PA-RISC memory access instruction, determine if the
 *    the instruction would perform a memory read or memory write
 *    operation.
 *
 *    This function assumes that the given instruction is a memory access
 *    instruction (i.e. you should really only call it if you know that
 *    the instruction has generated some sort of a memory access fault).
 *
 * Returns:
 *   VM_READ  if read operation
 *   VM_WRITE if write operation
 *   VM_EXEC  if execute operation
 */
static unsigned long
parisc_acctyp(unsigned long code, unsigned int inst)
{
	if (code == 6 || code == 16)
	    return VM_EXEC;

	switch (inst & 0xf0000000) {
	case 0x40000000: /* load */
	case 0x50000000: /* new load */
		return VM_READ;

	case 0x60000000: /* store */
	case 0x70000000: /* new store */
		return VM_WRITE;

	case 0x20000000: /* coproc */
	case 0x30000000: /* coproc2 */
		if (bit22set(inst))
			return VM_WRITE;

	case 0x0: /* indexed/memory management */
		if (bit22set(inst)) {
			/*
			 * Check for the 'Graphics Flush Read' instruction.
			 * It resembles an FDC instruction, except for bits
			 * 20 and 21. Any combination other than zero will
			 * utilize the block mover functionality on some
			 * older PA-RISC platforms.  The case where a block
			 * move is performed from VM to graphics IO space
			 * should be treated as a READ.
			 *
			 * The significance of bits 20,21 in the FDC
			 * instruction is:
			 *
			 *   00  Flush data cache (normal instruction behavior)
			 *   01  Graphics flush write  (IO space -> VM)
			 *   10  Graphics flush read   (VM -> IO space)
			 *   11  Graphics flush read/write (VM <-> IO space)
			 */
			if (isGraphicsFlushRead(inst))
				return VM_READ;
			return VM_WRITE;
		} else {
			/*
			 * Check for LDCWX and LDCWS (semaphore instructions).
			 * If bits 23 through 25 are all 1's it is one of
			 * the above two instructions and is a write.
			 *
			 * Note: With the limited bits we are looking at,
			 * this will also catch PROBEW and PROBEWI. However,
			 * these should never get in here because they don't
			 * generate exceptions of the type:
			 *   Data TLB miss fault/data page fault
			 *   Data memory protection trap
			 */
			if (bits23_25set(inst) == BITSSET)
				return VM_WRITE;
		}
		return VM_READ; /* Default */
	}
	return VM_READ; /* Default */
}

#undef bit22set
#undef bits23_25set
#undef isGraphicsFlushRead
#undef BITSSET


#if 0
/* This is the treewalk to find a vma which is the highest that has
 * a start < addr.  We're using find_vma_prev instead right now, but
 * we might want to use this at some point in the future.  Probably
 * not, but I want it committed to CVS so I don't lose it :-)
 */
			while (tree != vm_avl_empty) {
				if (tree->vm_start > addr) {
					tree = tree->vm_avl_left;
				} else {
					prev = tree;
					if (prev->vm_next == NULL)
						break;
					if (prev->vm_next->vm_start > addr)
						break;
					tree = tree->vm_avl_right;
				}
			}
#endif

int fixup_exception(struct pt_regs *regs)
{
	const struct exception_table_entry *fix;

	fix = search_exception_tables(regs->iaoq[0]);
	if (fix) {
		struct exception_data *d;
		d = &__get_cpu_var(exception_data);
		d->fault_ip = regs->iaoq[0];
		d->fault_space = regs->isr;
		d->fault_addr = regs->ior;

		regs->iaoq[0] = ((fix->fixup) & ~3);
		/*
		 * NOTE: In some cases the faulting instruction
		 * may be in the delay slot of a branch. We
		 * don't want to take the branch, so we don't
		 * increment iaoq[1], instead we set it to be
		 * iaoq[0]+4, and clear the B bit in the PSW
		 */
		regs->iaoq[1] = regs->iaoq[0] + 4;
		regs->gr[0] &= ~PSW_B; /* IPSW in gr[0] */

		return 1;
	}

	return 0;
}

void do_page_fault(struct pt_regs *regs, unsigned long code,
			      unsigned long address)
{
	struct vm_area_struct *vma, *prev_vma;
	struct task_struct *tsk = current;
	struct mm_struct *mm = tsk->mm;
	unsigned long acc_type;
	int fault;
	unsigned int flags = FAULT_FLAG_ALLOW_RETRY | FAULT_FLAG_KILLABLE;

	if (in_atomic() || !mm)
		goto no_context;

	if (user_mode(regs))
		flags |= FAULT_FLAG_USER;
	if (acc_type & VM_WRITE)
		flags |= FAULT_FLAG_WRITE;
retry:
	down_read(&mm->mmap_sem);
	vma = find_vma_prev(mm, address, &prev_vma);
	if (!vma || address < vma->vm_start)
		goto check_expansion;
/*
 * Ok, we have a good vm_area for this memory access. We still need to
 * check the access permissions.
 */

good_area:

	acc_type = parisc_acctyp(code,regs->iir);

	if ((vma->vm_flags & acc_type) != acc_type)
		goto bad_area;

	/*
	 * If for any reason at all we couldn't handle the fault, make
	 * sure we exit gracefully rather than endlessly redo the
	 * fault.
	 */

	fault = handle_mm_fault(mm, vma, address, flags);

	if ((fault & VM_FAULT_RETRY) && fatal_signal_pending(current))
		return;

	if (unlikely(fault & VM_FAULT_ERROR)) {
		/*
		 * We hit a shared mapping outside of the file, or some
		 * other thing happened to us that made us unable to
		 * handle the page fault gracefully.
		 */
		if (fault & VM_FAULT_OOM)
			goto out_of_memory;
		else if (fault & VM_FAULT_SIGSEGV)
			goto bad_area;
		else if (fault & VM_FAULT_SIGBUS)
			goto bad_area;
		BUG();
	}
	if (flags & FAULT_FLAG_ALLOW_RETRY) {
		if (fault & VM_FAULT_MAJOR)
			current->maj_flt++;
		else
			current->min_flt++;
		if (fault & VM_FAULT_RETRY) {
			flags &= ~FAULT_FLAG_ALLOW_RETRY;

			/*
			 * No need to up_read(&mm->mmap_sem) as we would
			 * have already released it in __lock_page_or_retry
			 * in mm/filemap.c.
			 */

			goto retry;
		}
	}
	up_read(&mm->mmap_sem);
	return;

check_expansion:
	vma = prev_vma;
	if (vma && (expand_stack(vma, address) == 0))
		goto good_area;

/*
 * Something tried to access memory that isn't in our memory map..
 */
bad_area:
	up_read(&mm->mmap_sem);

	if (user_mode(regs)) {
		struct siginfo si;

#ifdef PRINT_USER_FAULTS
		printk(KERN_DEBUG "\n");
		printk(KERN_DEBUG "do_page_fault() pid=%d command='%s' type=%lu address=0x%08lx\n",
		    task_pid_nr(tsk), tsk->comm, code, address);
		if (vma) {
			printk(KERN_DEBUG "vm_start = 0x%08lx, vm_end = 0x%08lx\n",
					vma->vm_start, vma->vm_end);
		}
		show_regs(regs);
#endif
		/* FIXME: actually we need to get the signo and code correct */
		si.si_signo = SIGSEGV;
		si.si_errno = 0;
		si.si_code = SEGV_MAPERR;
		si.si_addr = (void __user *) address;
		force_sig_info(SIGSEGV, &si, current);
		return;
	}

no_context:

	if (!user_mode(regs) && fixup_exception(regs)) {
		return;
	}

	parisc_terminate("Bad Address (null pointer deref?)", regs, code, address);

  out_of_memory:
	up_read(&mm->mmap_sem);
	if (!user_mode(regs))
		goto no_context;
	pagefault_out_of_memory();
}
Commit	Line	Data
071327ec	1	/*
1da177e4 LT	2	* This file is subject to the terms and conditions of the GNU General Public
	3	* License. See the file "COPYING" in the main directory of this archive
	4	* for more details.
	5	*
	6	*
	7	* Copyright (C) 1995, 1996, 1997, 1998 by Ralf Baechle
	8	* Copyright 1999 SuSE GmbH (Philipp Rumpf, prumpf@tux.org)
	9	* Copyright 1999 Hewlett Packard Co.
	10	*
	11	*/
	12
	13	#include <linux/mm.h>
	14	#include <linux/ptrace.h>
	15	#include <linux/sched.h>
	16	#include <linux/interrupt.h>
	17	#include <linux/module.h>
	18
	19	#include <asm/uaccess.h>
	20	#include <asm/traps.h>
	21
	22	#define PRINT_USER_FAULTS /* (turn this on if you want user faults to be */
	23	/* dumped to the console via printk) */
	24
	25
1da177e4 LT	26	/* Various important other fields */
	27	#define bit22set(x) (x & 0x00000200)
	28	#define bits23_25set(x) (x & 0x000001c0)
	29	#define isGraphicsFlushRead(x) ((x & 0xfc003fdf) == 0x04001a80)
	30	/* extended opcode is 0x6a */
	31
	32	#define BITSSET 0x1c0 /* for identifying LDCW */
	33
	34
	35	DEFINE_PER_CPU(struct exception_data, exception_data);
	36
	37	/*
	38	* parisc_acctyp(unsigned int inst) --
	39	* Given a PA-RISC memory access instruction, determine if the
	40	* the instruction would perform a memory read or memory write
	41	* operation.
	42	*
	43	* This function assumes that the given instruction is a memory access
	44	* instruction (i.e. you should really only call it if you know that
	45	* the instruction has generated some sort of a memory access fault).
	46	*
	47	* Returns:
	48	* VM_READ if read operation
	49	* VM_WRITE if write operation
	50	* VM_EXEC if execute operation
	51	*/
	52	static unsigned long
	53	parisc_acctyp(unsigned long code, unsigned int inst)
	54	{
	55	if (code == 6 \|\| code == 16)
	56	return VM_EXEC;
	57
	58	switch (inst & 0xf0000000) {
	59	case 0x40000000: /* load */
	60	case 0x50000000: /* new load */
	61	return VM_READ;
	62
	63	case 0x60000000: /* store */
	64	case 0x70000000: /* new store */
	65	return VM_WRITE;
	66
	67	case 0x20000000: /* coproc */
	68	case 0x30000000: /* coproc2 */
	69	if (bit22set(inst))
	70	return VM_WRITE;
	71
	72	case 0x0: /* indexed/memory management */
	73	if (bit22set(inst)) {
	74	/*
	75	* Check for the 'Graphics Flush Read' instruction.
	76	* It resembles an FDC instruction, except for bits
	77	* 20 and 21. Any combination other than zero will
	78	* utilize the block mover functionality on some
	79	* older PA-RISC platforms. The case where a block
	80	* move is performed from VM to graphics IO space
	81	* should be treated as a READ.
	82	*
	83	* The significance of bits 20,21 in the FDC
	84	* instruction is:
	85	*
	86	* 00 Flush data cache (normal instruction behavior)
	87	* 01 Graphics flush write (IO space -> VM)
	88	* 10 Graphics flush read (VM -> IO space)
	89	* 11 Graphics flush read/write (VM <-> IO space)
90	*/
91	if (isGraphicsFlushRead(inst))
92	return VM_READ;
93	return VM_WRITE;
94	} else {
95	/*
96	* Check for LDCWX and LDCWS (semaphore instructions).
97	* If bits 23 through 25 are all 1's it is one of
98	* the above two instructions and is a write.
99	*
100	* Note: With the limited bits we are looking at,
101	* this will also catch PROBEW and PROBEWI. However,
102	* these should never get in here because they don't
103	* generate exceptions of the type:
104	* Data TLB miss fault/data page fault
105	* Data memory protection trap
106	*/
107	if (bits23_25set(inst) == BITSSET)
108	return VM_WRITE;
109	}
110	return VM_READ; /* Default */
111	}
112	return VM_READ; /* Default */
113	}
114
115	#undef bit22set
116	#undef bits23_25set
117	#undef isGraphicsFlushRead
118	#undef BITSSET
119
120
121	#if 0
122	/* This is the treewalk to find a vma which is the highest that has
123	* a start < addr. We're using find_vma_prev instead right now, but
124	* we might want to use this at some point in the future. Probably
125	* not, but I want it committed to CVS so I don't lose it :-)
126	*/
127	while (tree != vm_avl_empty) {
128	if (tree->vm_start > addr) {
129	tree = tree->vm_avl_left;
130	} else {
131	prev = tree;
132	if (prev->vm_next == NULL)
133	break;
134	if (prev->vm_next->vm_start > addr)
135	break;
136	tree = tree->vm_avl_right;
137	}
138	}
139	#endif
140
c61c25eb KM	141	int fixup_exception(struct pt_regs *regs)
	142	{
	143	const struct exception_table_entry *fix;
	144
	145	fix = search_exception_tables(regs->iaoq[0]);
	146	if (fix) {
	147	struct exception_data *d;
	148	d = &__get_cpu_var(exception_data);
	149	d->fault_ip = regs->iaoq[0];
	150	d->fault_space = regs->isr;
	151	d->fault_addr = regs->ior;
	152
	153	regs->iaoq[0] = ((fix->fixup) & ~3);
	154	/*
	155	* NOTE: In some cases the faulting instruction
	156	* may be in the delay slot of a branch. We
	157	* don't want to take the branch, so we don't
	158	* increment iaoq[1], instead we set it to be
	159	* iaoq[0]+4, and clear the B bit in the PSW
	160	*/
	161	regs->iaoq[1] = regs->iaoq[0] + 4;
	162	regs->gr[0] &= ~PSW_B; /* IPSW in gr[0] */
	163
	164	return 1;
	165	}
	166
	167	return 0;
	168	}
	169
1da177e4 LT	170	void do_page_fault(struct pt_regs *regs, unsigned long code,
	171	unsigned long address)
	172	{
	173	struct vm_area_struct vma, prev_vma;
	174	struct task_struct *tsk = current;
	175	struct mm_struct *mm = tsk->mm;
1da177e4	176	unsigned long acc_type;
83c54070	177	int fault;
38057477	178	unsigned int flags = FAULT_FLAG_ALLOW_RETRY \| FAULT_FLAG_KILLABLE;
1da177e4	179
6edaf68a	180	if (in_atomic() \|\| !mm)
1da177e4 LT	181	goto no_context;
1da177e4 LT	182
e2ec2c2b JW	183	if (user_mode(regs))
	184	flags \|= FAULT_FLAG_USER;
	185	if (acc_type & VM_WRITE)
	186	flags \|= FAULT_FLAG_WRITE;
38057477	187	retry:
1da177e4 LT	188	down_read(&mm->mmap_sem);
	189	vma = find_vma_prev(mm, address, &prev_vma);
	190	if (!vma \|\| address < vma->vm_start)
	191	goto check_expansion;
	192	/*
	193	* Ok, we have a good vm_area for this memory access. We still need to
	194	* check the access permissions.
	195	*/
	196
	197	good_area:
	198
	199	acc_type = parisc_acctyp(code,regs->iir);
	200
	201	if ((vma->vm_flags & acc_type) != acc_type)
	202	goto bad_area;
	203
	204	/*
	205	* If for any reason at all we couldn't handle the fault, make
	206	* sure we exit gracefully rather than endlessly redo the
	207	* fault.
	208	*/
	209
e2ec2c2b	210	fault = handle_mm_fault(mm, vma, address, flags);
38057477 KC	211
	212	if ((fault & VM_FAULT_RETRY) && fatal_signal_pending(current))
	213	return;
	214
83c54070	215	if (unlikely(fault & VM_FAULT_ERROR)) {
1da177e4	216	/*
67a5a59d	217	* We hit a shared mapping outside of the file, or some
6e346228 LT	218	* other thing happened to us that made us unable to
6e346228 LT	219	* handle the page fault gracefully.
1da177e4	220	*/
83c54070 NP	221	if (fault & VM_FAULT_OOM)
83c54070 NP	222	goto out_of_memory;
0c42d1fb LT	223	else if (fault & VM_FAULT_SIGSEGV)
0c42d1fb LT	224	goto bad_area;
83c54070 NP	225	else if (fault & VM_FAULT_SIGBUS)
	226	goto bad_area;
	227	BUG();
1da177e4	228	}
38057477 KC	229	if (flags & FAULT_FLAG_ALLOW_RETRY) {
	230	if (fault & VM_FAULT_MAJOR)
	231	current->maj_flt++;
	232	else
	233	current->min_flt++;
	234	if (fault & VM_FAULT_RETRY) {
	235	flags &= ~FAULT_FLAG_ALLOW_RETRY;
	236
	237	/*
	238	* No need to up_read(&mm->mmap_sem) as we would
	239	* have already released it in __lock_page_or_retry
	240	* in mm/filemap.c.
	241	*/
	242
	243	goto retry;
	244	}
	245	}
1da177e4 LT	246	up_read(&mm->mmap_sem);
	247	return;
	248
	249	check_expansion:
	250	vma = prev_vma;
	251	if (vma && (expand_stack(vma, address) == 0))
	252	goto good_area;
	253
	254	/*
	255	* Something tried to access memory that isn't in our memory map..
	256	*/
	257	bad_area:
	258	up_read(&mm->mmap_sem);
	259
	260	if (user_mode(regs)) {
	261	struct siginfo si;
	262
	263	#ifdef PRINT_USER_FAULTS
	264	printk(KERN_DEBUG "\n");
	265	printk(KERN_DEBUG "do_page_fault() pid=%d command='%s' type=%lu address=0x%08lx\n",
19c5870c	266	task_pid_nr(tsk), tsk->comm, code, address);
1da177e4 LT	267	if (vma) {
	268	printk(KERN_DEBUG "vm_start = 0x%08lx, vm_end = 0x%08lx\n",
	269	vma->vm_start, vma->vm_end);
	270	}
	271	show_regs(regs);
	272	#endif
	273	/* FIXME: actually we need to get the signo and code correct */
	274	si.si_signo = SIGSEGV;
	275	si.si_errno = 0;
	276	si.si_code = SEGV_MAPERR;
	277	si.si_addr = (void __user *) address;
	278	force_sig_info(SIGSEGV, &si, current);
	279	return;
	280	}
	281
	282	no_context:
	283
c61c25eb KM	284	if (!user_mode(regs) && fixup_exception(regs)) {
c61c25eb KM	285	return;
1da177e4 LT	286	}
	287
	288	parisc_terminate("Bad Address (null pointer deref?)", regs, code, address);
	289
	290	out_of_memory:
	291	up_read(&mm->mmap_sem);
53e30d02 NP	292	if (!user_mode(regs))
	293	goto no_context;
	294	pagefault_out_of_memory();
1da177e4	295	}