[mirror_ubuntu-artful-kernel.git] / arch / score / kernel / traps.c

/*
 * arch/score/kernel/traps.c
 *
 * Score Processor version.
 *
 * Copyright (C) 2009 Sunplus Core Technology Co., Ltd.
 *  Chen Liqin <liqin.chen@sunplusct.com>
 *  Lennox Wu <lennox.wu@sunplusct.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * 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.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, see the file COPYING, or write
 * to the Free Software Foundation, Inc.,
 * 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 */

#include <linux/extable.h>
#include <linux/sched.h>

#include <asm/cacheflush.h>
#include <asm/irq.h>
#include <asm/irq_regs.h>
#include <linux/uaccess.h>

unsigned long exception_handlers[32];

/*
 * The architecture-independent show_stack generator
 */
void show_stack(struct task_struct *task, unsigned long *sp)
{
	int i;
	long stackdata;

	sp = sp ? sp : (unsigned long *)&sp;

	printk(KERN_NOTICE "Stack: ");
	i = 1;
	while ((long) sp & (PAGE_SIZE - 1)) {
		if (i && ((i % 8) == 0))
			printk(KERN_NOTICE "\n");
		if (i > 40) {
			printk(KERN_NOTICE " ...");
			break;
		}

		if (__get_user(stackdata, sp++)) {
			printk(KERN_NOTICE " (Bad stack address)");
			break;
		}

		printk(KERN_NOTICE " %08lx", stackdata);
		i++;
	}
	printk(KERN_NOTICE "\n");
}

static void show_trace(long *sp)
{
	int i;
	long addr;

	sp = sp ? sp : (long *) &sp;

	printk(KERN_NOTICE "Call Trace:  ");
	i = 1;
	while ((long) sp & (PAGE_SIZE - 1)) {
		if (__get_user(addr, sp++)) {
			if (i && ((i % 6) == 0))
				printk(KERN_NOTICE "\n");
			printk(KERN_NOTICE " (Bad stack address)\n");
			break;
		}

		if (kernel_text_address(addr)) {
			if (i && ((i % 6) == 0))
				printk(KERN_NOTICE "\n");
			if (i > 40) {
				printk(KERN_NOTICE " ...");
				break;
			}

			printk(KERN_NOTICE " [<%08lx>]", addr);
			i++;
		}
	}
	printk(KERN_NOTICE "\n");
}

static void show_code(unsigned int *pc)
{
	long i;

	printk(KERN_NOTICE "\nCode:");

	for (i = -3; i < 6; i++) {
		unsigned long insn;
		if (__get_user(insn, pc + i)) {
			printk(KERN_NOTICE " (Bad address in epc)\n");
			break;
		}
		printk(KERN_NOTICE "%c%08lx%c", (i ? ' ' : '<'),
			insn, (i ? ' ' : '>'));
	}
}

/*
 * FIXME: really the generic show_regs should take a const pointer argument.
 */
void show_regs(struct pt_regs *regs)
{
	show_regs_print_info(KERN_DEFAULT);

	printk("r0 : %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n",
		regs->regs[0], regs->regs[1], regs->regs[2], regs->regs[3],
		regs->regs[4], regs->regs[5], regs->regs[6], regs->regs[7]);
	printk("r8 : %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n",
		regs->regs[8], regs->regs[9], regs->regs[10], regs->regs[11],
		regs->regs[12], regs->regs[13], regs->regs[14], regs->regs[15]);
	printk("r16: %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n",
		regs->regs[16], regs->regs[17], regs->regs[18], regs->regs[19],
		regs->regs[20], regs->regs[21], regs->regs[22], regs->regs[23]);
	printk("r24: %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n",
		regs->regs[24], regs->regs[25], regs->regs[26], regs->regs[27],
		regs->regs[28], regs->regs[29], regs->regs[30], regs->regs[31]);

	printk("CEH : %08lx\n", regs->ceh);
	printk("CEL : %08lx\n", regs->cel);

	printk("EMA:%08lx, epc:%08lx %s\nPSR: %08lx\nECR:%08lx\nCondition : %08lx\n",
		regs->cp0_ema, regs->cp0_epc, print_tainted(), regs->cp0_psr,
		regs->cp0_ecr, regs->cp0_condition);
}

static void show_registers(struct pt_regs *regs)
{
	show_regs(regs);
	printk(KERN_NOTICE "Process %s (pid: %d, stackpage=%08lx)\n",
		current->comm, current->pid, (unsigned long) current);
	show_stack(current_thread_info()->task, (long *) regs->regs[0]);
	show_trace((long *) regs->regs[0]);
	show_code((unsigned int *) regs->cp0_epc);
	printk(KERN_NOTICE "\n");
}

void __die(const char *str, struct pt_regs *regs, const char *file,
	const char *func, unsigned long line)
{
	console_verbose();
	printk("%s", str);
	if (file && func)
		printk(" in %s:%s, line %ld", file, func, line);
	printk(":\n");
	show_registers(regs);
	do_exit(SIGSEGV);
}

void __die_if_kernel(const char *str, struct pt_regs *regs,
		const char *file, const char *func, unsigned long line)
{
	if (!user_mode(regs))
		__die(str, regs, file, func, line);
}

asmlinkage void do_adelinsn(struct pt_regs *regs)
{
	printk("do_ADE-linsn:ema:0x%08lx:epc:0x%08lx\n",
		 regs->cp0_ema, regs->cp0_epc);
	die_if_kernel("do_ade execution Exception\n", regs);
	force_sig(SIGBUS, current);
}

asmlinkage void do_adedata(struct pt_regs *regs)
{
	const struct exception_table_entry *fixup;
	fixup = search_exception_tables(regs->cp0_epc);
	if (fixup) {
		regs->cp0_epc = fixup->fixup;
		return;
	}
	printk("do_ADE-data:ema:0x%08lx:epc:0x%08lx\n",
		 regs->cp0_ema, regs->cp0_epc);
	die_if_kernel("do_ade execution Exception\n", regs);
	force_sig(SIGBUS, current);
}

asmlinkage void do_pel(struct pt_regs *regs)
{
	die_if_kernel("do_pel execution Exception", regs);
	force_sig(SIGFPE, current);
}

asmlinkage void do_cee(struct pt_regs *regs)
{
	die_if_kernel("do_cee execution Exception", regs);
	force_sig(SIGFPE, current);
}

asmlinkage void do_cpe(struct pt_regs *regs)
{
	die_if_kernel("do_cpe execution Exception", regs);
	force_sig(SIGFPE, current);
}

asmlinkage void do_be(struct pt_regs *regs)
{
	die_if_kernel("do_be execution Exception", regs);
	force_sig(SIGBUS, current);
}

asmlinkage void do_ov(struct pt_regs *regs)
{
	siginfo_t info;

	die_if_kernel("do_ov execution Exception", regs);

	info.si_code = FPE_INTOVF;
	info.si_signo = SIGFPE;
	info.si_errno = 0;
	info.si_addr = (void *)regs->cp0_epc;
	force_sig_info(SIGFPE, &info, current);
}

asmlinkage void do_tr(struct pt_regs *regs)
{
	die_if_kernel("do_tr execution Exception", regs);
	force_sig(SIGTRAP, current);
}

asmlinkage void do_ri(struct pt_regs *regs)
{
	unsigned long epc_insn;
	unsigned long epc = regs->cp0_epc;

	read_tsk_long(current, epc, &epc_insn);
	if (current->thread.single_step == 1) {
		if ((epc == current->thread.addr1) ||
		    (epc == current->thread.addr2)) {
			user_disable_single_step(current);
			force_sig(SIGTRAP, current);
			return;
		} else
			BUG();
	} else if ((epc_insn == BREAKPOINT32_INSN) ||
		   ((epc_insn & 0x0000FFFF) == 0x7002) ||
		   ((epc_insn & 0xFFFF0000) == 0x70020000)) {
			force_sig(SIGTRAP, current);
			return;
	} else {
		die_if_kernel("do_ri execution Exception", regs);
		force_sig(SIGILL, current);
	}
}

asmlinkage void do_ccu(struct pt_regs *regs)
{
	die_if_kernel("do_ccu execution Exception", regs);
	force_sig(SIGILL, current);
}

asmlinkage void do_reserved(struct pt_regs *regs)
{
	/*
	 * Game over - no way to handle this if it ever occurs.  Most probably
	 * caused by a new unknown cpu type or after another deadly
	 * hard/software error.
	 */
	die_if_kernel("do_reserved execution Exception", regs);
	show_regs(regs);
	panic("Caught reserved exception - should not happen.");
}

/*
 * NMI exception handler.
 */
void nmi_exception_handler(struct pt_regs *regs)
{
	die_if_kernel("nmi_exception_handler execution Exception", regs);
	die("NMI", regs);
}

/* Install CPU exception handler */
void *set_except_vector(int n, void *addr)
{
	unsigned long handler = (unsigned long) addr;
	unsigned long old_handler = exception_handlers[n];

	exception_handlers[n] = handler;
	return (void *)old_handler;
}

void __init trap_init(void)
{
	int i;

	pgd_current = (unsigned long)init_mm.pgd;
	/* DEBUG EXCEPTION */
	memcpy((void *)DEBUG_VECTOR_BASE_ADDR,
			&debug_exception_vector, DEBUG_VECTOR_SIZE);
	/* NMI EXCEPTION */
	memcpy((void *)GENERAL_VECTOR_BASE_ADDR,
			&general_exception_vector, GENERAL_VECTOR_SIZE);

	/*
	 * Initialise exception handlers
	 */
	for (i = 0; i <= 31; i++)
		set_except_vector(i, handle_reserved);

	set_except_vector(1, handle_nmi);
	set_except_vector(2, handle_adelinsn);
	set_except_vector(3, handle_tlb_refill);
	set_except_vector(4, handle_tlb_invaild);
	set_except_vector(5, handle_ibe);
	set_except_vector(6, handle_pel);
	set_except_vector(7, handle_sys);
	set_except_vector(8, handle_ccu);
	set_except_vector(9, handle_ri);
	set_except_vector(10, handle_tr);
	set_except_vector(11, handle_adedata);
	set_except_vector(12, handle_adedata);
	set_except_vector(13, handle_tlb_refill);
	set_except_vector(14, handle_tlb_invaild);
	set_except_vector(15, handle_mod);
	set_except_vector(16, handle_cee);
	set_except_vector(17, handle_cpe);
	set_except_vector(18, handle_dbe);
	flush_icache_range(DEBUG_VECTOR_BASE_ADDR, IRQ_VECTOR_BASE_ADDR);

	atomic_inc(&init_mm.mm_count);
	current->active_mm = &init_mm;
	cpu_cache_init();
}
Commit	Line	Data
6bc9a396 CL	1	/*
	2	* arch/score/kernel/traps.c
	3	*
	4	* Score Processor version.
	5	*
	6	* Copyright (C) 2009 Sunplus Core Technology Co., Ltd.
	7	* Chen Liqin <liqin.chen@sunplusct.com>
	8	* Lennox Wu <lennox.wu@sunplusct.com>
	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of the GNU General Public License as published by
	12	* the Free Software Foundation; either version 2 of the License, or
	13	* (at your option) any later version.
	14	*
	15	* This program is distributed in the hope that it will be useful,
	16	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	17	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	18	* GNU General Public License for more details.
	19	*
	20	* You should have received a copy of the GNU General Public License
	21	* along with this program; if not, see the file COPYING, or write
	22	* to the Free Software Foundation, Inc.,
	23	* 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
	24	*/
	25
0f296af8	26	#include <linux/extable.h>
6bc9a396 CL	27	#include <linux/sched.h>
	28
	29	#include <asm/cacheflush.h>
	30	#include <asm/irq.h>
	31	#include <asm/irq_regs.h>
7c0f6ba6	32	#include <linux/uaccess.h>
6bc9a396 CL	33
	34	unsigned long exception_handlers[32];
	35
	36	/*
	37	* The architecture-independent show_stack generator
	38	*/
	39	void show_stack(struct task_struct task, unsigned long sp)
	40	{
	41	int i;
	42	long stackdata;
	43
	44	sp = sp ? sp : (unsigned long *)&sp;
	45
	46	printk(KERN_NOTICE "Stack: ");
	47	i = 1;
	48	while ((long) sp & (PAGE_SIZE - 1)) {
	49	if (i && ((i % 8) == 0))
	50	printk(KERN_NOTICE "\n");
	51	if (i > 40) {
	52	printk(KERN_NOTICE " ...");
	53	break;
	54	}
	55
	56	if (__get_user(stackdata, sp++)) {
	57	printk(KERN_NOTICE " (Bad stack address)");
	58	break;
	59	}
	60
	61	printk(KERN_NOTICE " %08lx", stackdata);
	62	i++;
	63	}
	64	printk(KERN_NOTICE "\n");
	65	}
	66
	67	static void show_trace(long *sp)
	68	{
	69	int i;
	70	long addr;
	71
	72	sp = sp ? sp : (long *) &sp;
	73
	74	printk(KERN_NOTICE "Call Trace: ");
	75	i = 1;
	76	while ((long) sp & (PAGE_SIZE - 1)) {
	77	if (__get_user(addr, sp++)) {
	78	if (i && ((i % 6) == 0))
	79	printk(KERN_NOTICE "\n");
	80	printk(KERN_NOTICE " (Bad stack address)\n");
	81	break;
	82	}
	83
	84	if (kernel_text_address(addr)) {
	85	if (i && ((i % 6) == 0))
	86	printk(KERN_NOTICE "\n");
	87	if (i > 40) {
	88	printk(KERN_NOTICE " ...");
	89	break;
	90	}
	91
	92	printk(KERN_NOTICE " [<%08lx>]", addr);
	93	i++;
	94	}
	95	}
	96	printk(KERN_NOTICE "\n");
97	}
98
99	static void show_code(unsigned int *pc)
100	{
101	long i;
102
103	printk(KERN_NOTICE "\nCode:");
104
105	for (i = -3; i < 6; i++) {
106	unsigned long insn;
107	if (__get_user(insn, pc + i)) {
108	printk(KERN_NOTICE " (Bad address in epc)\n");
109	break;
110	}
111	printk(KERN_NOTICE "%c%08lx%c", (i ? ' ' : '<'),
112	insn, (i ? ' ' : '>'));
113	}
114	}
115
116	/*
117	* FIXME: really the generic show_regs should take a const pointer argument.
118	*/
119	void show_regs(struct pt_regs *regs)
120	{
a43cb95d TH	121	show_regs_print_info(KERN_DEFAULT);
a43cb95d TH	122
6bc9a396 CL	123	printk("r0 : %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n",
	124	regs->regs[0], regs->regs[1], regs->regs[2], regs->regs[3],
	125	regs->regs[4], regs->regs[5], regs->regs[6], regs->regs[7]);
	126	printk("r8 : %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n",
	127	regs->regs[8], regs->regs[9], regs->regs[10], regs->regs[11],
	128	regs->regs[12], regs->regs[13], regs->regs[14], regs->regs[15]);
	129	printk("r16: %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n",
	130	regs->regs[16], regs->regs[17], regs->regs[18], regs->regs[19],
	131	regs->regs[20], regs->regs[21], regs->regs[22], regs->regs[23]);
	132	printk("r24: %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n",
	133	regs->regs[24], regs->regs[25], regs->regs[26], regs->regs[27],
	134	regs->regs[28], regs->regs[29], regs->regs[30], regs->regs[31]);
	135
	136	printk("CEH : %08lx\n", regs->ceh);
	137	printk("CEL : %08lx\n", regs->cel);
	138
	139	printk("EMA:%08lx, epc:%08lx %s\nPSR: %08lx\nECR:%08lx\nCondition : %08lx\n",
	140	regs->cp0_ema, regs->cp0_epc, print_tainted(), regs->cp0_psr,
	141	regs->cp0_ecr, regs->cp0_condition);
	142	}
	143
	144	static void show_registers(struct pt_regs *regs)
	145	{
	146	show_regs(regs);
	147	printk(KERN_NOTICE "Process %s (pid: %d, stackpage=%08lx)\n",
	148	current->comm, current->pid, (unsigned long) current);
	149	show_stack(current_thread_info()->task, (long *) regs->regs[0]);
	150	show_trace((long *) regs->regs[0]);
	151	show_code((unsigned int *) regs->cp0_epc);
	152	printk(KERN_NOTICE "\n");
	153	}
	154
6bc9a396 CL	155	void __die(const char str, struct pt_regs regs, const char *file,
	156	const char *func, unsigned long line)
	157	{
	158	console_verbose();
	159	printk("%s", str);
	160	if (file && func)
	161	printk(" in %s:%s, line %ld", file, func, line);
	162	printk(":\n");
	163	show_registers(regs);
	164	do_exit(SIGSEGV);
	165	}
	166
	167	void __die_if_kernel(const char str, struct pt_regs regs,
	168	const char file, const char func, unsigned long line)
	169	{
	170	if (!user_mode(regs))
	171	__die(str, regs, file, func, line);
	172	}
	173
	174	asmlinkage void do_adelinsn(struct pt_regs *regs)
	175	{
	176	printk("do_ADE-linsn:ema:0x%08lx:epc:0x%08lx\n",
	177	regs->cp0_ema, regs->cp0_epc);
	178	die_if_kernel("do_ade execution Exception\n", regs);
	179	force_sig(SIGBUS, current);
	180	}
	181
	182	asmlinkage void do_adedata(struct pt_regs *regs)
	183	{
	184	const struct exception_table_entry *fixup;
	185	fixup = search_exception_tables(regs->cp0_epc);
	186	if (fixup) {
	187	regs->cp0_epc = fixup->fixup;
	188	return;
	189	}
	190	printk("do_ADE-data:ema:0x%08lx:epc:0x%08lx\n",
	191	regs->cp0_ema, regs->cp0_epc);
	192	die_if_kernel("do_ade execution Exception\n", regs);
	193	force_sig(SIGBUS, current);
	194	}
	195
	196	asmlinkage void do_pel(struct pt_regs *regs)
	197	{
	198	die_if_kernel("do_pel execution Exception", regs);
	199	force_sig(SIGFPE, current);
	200	}
	201
	202	asmlinkage void do_cee(struct pt_regs *regs)
	203	{
	204	die_if_kernel("do_cee execution Exception", regs);
	205	force_sig(SIGFPE, current);
	206	}
	207
	208	asmlinkage void do_cpe(struct pt_regs *regs)
	209	{
	210	die_if_kernel("do_cpe execution Exception", regs);
	211	force_sig(SIGFPE, current);
	212	}
	213
	214	asmlinkage void do_be(struct pt_regs *regs)
	215	{
	216	die_if_kernel("do_be execution Exception", regs);
	217	force_sig(SIGBUS, current);
	218	}
219
220	asmlinkage void do_ov(struct pt_regs *regs)
221	{
222	siginfo_t info;
223
224	die_if_kernel("do_ov execution Exception", regs);
225
226	info.si_code = FPE_INTOVF;
227	info.si_signo = SIGFPE;
228	info.si_errno = 0;
229	info.si_addr = (void *)regs->cp0_epc;
230	force_sig_info(SIGFPE, &info, current);
231	}
232
233	asmlinkage void do_tr(struct pt_regs *regs)
234	{
235	die_if_kernel("do_tr execution Exception", regs);
236	force_sig(SIGTRAP, current);
237	}
238
239	asmlinkage void do_ri(struct pt_regs *regs)
240	{
241	unsigned long epc_insn;
242	unsigned long epc = regs->cp0_epc;
243
244	read_tsk_long(current, epc, &epc_insn);
245	if (current->thread.single_step == 1) {
246	if ((epc == current->thread.addr1) \|\|
247	(epc == current->thread.addr2)) {
0402c91a	248	user_disable_single_step(current);
6bc9a396 CL	249	force_sig(SIGTRAP, current);
	250	return;
	251	} else
	252	BUG();
	253	} else if ((epc_insn == BREAKPOINT32_INSN) \|\|
	254	((epc_insn & 0x0000FFFF) == 0x7002) \|\|
	255	((epc_insn & 0xFFFF0000) == 0x70020000)) {
	256	force_sig(SIGTRAP, current);
	257	return;
	258	} else {
	259	die_if_kernel("do_ri execution Exception", regs);
	260	force_sig(SIGILL, current);
	261	}
	262	}
	263
	264	asmlinkage void do_ccu(struct pt_regs *regs)
	265	{
	266	die_if_kernel("do_ccu execution Exception", regs);
	267	force_sig(SIGILL, current);
	268	}
	269
	270	asmlinkage void do_reserved(struct pt_regs *regs)
	271	{
	272	/*
	273	* Game over - no way to handle this if it ever occurs. Most probably
	274	* caused by a new unknown cpu type or after another deadly
	275	* hard/software error.
	276	*/
	277	die_if_kernel("do_reserved execution Exception", regs);
	278	show_regs(regs);
	279	panic("Caught reserved exception - should not happen.");
	280	}
	281
	282	/*
	283	* NMI exception handler.
	284	*/
	285	void nmi_exception_handler(struct pt_regs *regs)
	286	{
	287	die_if_kernel("nmi_exception_handler execution Exception", regs);
	288	die("NMI", regs);
	289	}
	290
	291	/* Install CPU exception handler */
	292	void set_except_vector(int n, void addr)
	293	{
	294	unsigned long handler = (unsigned long) addr;
	295	unsigned long old_handler = exception_handlers[n];
	296
	297	exception_handlers[n] = handler;
	298	return (void *)old_handler;
	299	}
	300
	301	void __init trap_init(void)
	302	{
	303	int i;
	304
	305	pgd_current = (unsigned long)init_mm.pgd;
	306	/* DEBUG EXCEPTION */
	307	memcpy((void *)DEBUG_VECTOR_BASE_ADDR,
	308	&debug_exception_vector, DEBUG_VECTOR_SIZE);
	309	/* NMI EXCEPTION */
	310	memcpy((void *)GENERAL_VECTOR_BASE_ADDR,
	311	&general_exception_vector, GENERAL_VECTOR_SIZE);
	312
313	/*
314	* Initialise exception handlers
315	*/
316	for (i = 0; i <= 31; i++)
317	set_except_vector(i, handle_reserved);
318
319	set_except_vector(1, handle_nmi);
320	set_except_vector(2, handle_adelinsn);
321	set_except_vector(3, handle_tlb_refill);
322	set_except_vector(4, handle_tlb_invaild);
323	set_except_vector(5, handle_ibe);
324	set_except_vector(6, handle_pel);
325	set_except_vector(7, handle_sys);
326	set_except_vector(8, handle_ccu);
327	set_except_vector(9, handle_ri);
328	set_except_vector(10, handle_tr);
329	set_except_vector(11, handle_adedata);
330	set_except_vector(12, handle_adedata);
331	set_except_vector(13, handle_tlb_refill);
332	set_except_vector(14, handle_tlb_invaild);
333	set_except_vector(15, handle_mod);
334	set_except_vector(16, handle_cee);
335	set_except_vector(17, handle_cpe);
336	set_except_vector(18, handle_dbe);
337	flush_icache_range(DEBUG_VECTOR_BASE_ADDR, IRQ_VECTOR_BASE_ADDR);
338
339	atomic_inc(&init_mm.mm_count);
340	current->active_mm = &init_mm;
341	cpu_cache_init();
342	}