[mirror_ubuntu-bionic-kernel.git] / arch / m32r / kernel / traps.c

// SPDX-License-Identifier: GPL-2.0
/*
 *  linux/arch/m32r/kernel/traps.c
 *
 *  Copyright (C) 2001, 2002  Hirokazu Takata, Hiroyuki Kondo,
 *                            Hitoshi Yamamoto
 */

/*
 * 'traps.c' handles hardware traps and faults after we have saved some
 * state in 'entry.S'.
 */
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/kallsyms.h>
#include <linux/stddef.h>
#include <linux/ptrace.h>
#include <linux/sched/debug.h>
#include <linux/sched/task_stack.h>
#include <linux/mm.h>
#include <linux/cpu.h>

#include <asm/page.h>
#include <asm/processor.h>

#include <linux/uaccess.h>
#include <asm/io.h>
#include <linux/atomic.h>

#include <asm/smp.h>

#include <linux/module.h>

asmlinkage void alignment_check(void);
asmlinkage void ei_handler(void);
asmlinkage void rie_handler(void);
asmlinkage void debug_trap(void);
asmlinkage void cache_flushing_handler(void);
asmlinkage void ill_trap(void);

#ifdef CONFIG_SMP
extern void smp_reschedule_interrupt(void);
extern void smp_invalidate_interrupt(void);
extern void smp_call_function_interrupt(void);
extern void smp_ipi_timer_interrupt(void);
extern void smp_flush_cache_all_interrupt(void);
extern void smp_call_function_single_interrupt(void);

/*
 * for Boot AP function
 */
asm (
	"	.section .eit_vector4,\"ax\"	\n"
	"	.global _AP_RE			\n"
	"	.global startup_AP		\n"
	"_AP_RE:				\n"
	"	.fill 32, 4, 0			\n"
	"_AP_EI: bra	startup_AP		\n"
	"	.previous			\n"
);
#endif  /* CONFIG_SMP */

extern unsigned long	eit_vector[];
#define BRA_INSN(func, entry)	\
	((unsigned long)func - (unsigned long)eit_vector - entry*4)/4 \
	+ 0xff000000UL

static void set_eit_vector_entries(void)
{
	extern void default_eit_handler(void);
	extern void system_call(void);
	extern void pie_handler(void);
	extern void ace_handler(void);
	extern void tme_handler(void);
	extern void _flush_cache_copyback_all(void);

	eit_vector[0] = 0xd0c00001; /* seth r0, 0x01 */
	eit_vector[1] = BRA_INSN(default_eit_handler, 1);
	eit_vector[4] = 0xd0c00010; /* seth r0, 0x10 */
	eit_vector[5] = BRA_INSN(default_eit_handler, 5);
	eit_vector[8] = BRA_INSN(rie_handler, 8);
	eit_vector[12] = BRA_INSN(alignment_check, 12);
	eit_vector[16] = BRA_INSN(ill_trap, 16);
	eit_vector[17] = BRA_INSN(debug_trap, 17);
	eit_vector[18] = BRA_INSN(system_call, 18);
	eit_vector[19] = BRA_INSN(ill_trap, 19);
	eit_vector[20] = BRA_INSN(ill_trap, 20);
	eit_vector[21] = BRA_INSN(ill_trap, 21);
	eit_vector[22] = BRA_INSN(ill_trap, 22);
	eit_vector[23] = BRA_INSN(ill_trap, 23);
	eit_vector[24] = BRA_INSN(ill_trap, 24);
	eit_vector[25] = BRA_INSN(ill_trap, 25);
	eit_vector[26] = BRA_INSN(ill_trap, 26);
	eit_vector[27] = BRA_INSN(ill_trap, 27);
	eit_vector[28] = BRA_INSN(cache_flushing_handler, 28);
	eit_vector[29] = BRA_INSN(ill_trap, 29);
	eit_vector[30] = BRA_INSN(ill_trap, 30);
	eit_vector[31] = BRA_INSN(ill_trap, 31);
	eit_vector[32] = BRA_INSN(ei_handler, 32);
	eit_vector[64] = BRA_INSN(pie_handler, 64);
#ifdef CONFIG_MMU
	eit_vector[68] = BRA_INSN(ace_handler, 68);
	eit_vector[72] = BRA_INSN(tme_handler, 72);
#endif /* CONFIG_MMU */
#ifdef CONFIG_SMP
	eit_vector[184] = (unsigned long)smp_reschedule_interrupt;
	eit_vector[185] = (unsigned long)smp_invalidate_interrupt;
	eit_vector[186] = (unsigned long)smp_call_function_interrupt;
	eit_vector[187] = (unsigned long)smp_ipi_timer_interrupt;
	eit_vector[188] = (unsigned long)smp_flush_cache_all_interrupt;
	eit_vector[189] = 0;	/* CPU_BOOT_IPI */
	eit_vector[190] = (unsigned long)smp_call_function_single_interrupt;
	eit_vector[191] = 0;
#endif
	_flush_cache_copyback_all();
}

void abort(void)
{
	BUG();

	/* if that doesn't kill us, halt */
	panic("Oops failed to kill thread");
}
EXPORT_SYMBOL(abort);

void __init trap_init(void)
{
	set_eit_vector_entries();

	/*
	 * Should be a barrier for any external CPU state.
	 */
	cpu_init();
}

static int kstack_depth_to_print = 24;

static void show_trace(struct task_struct *task, unsigned long *stack)
{
	unsigned long addr;

	if (!stack)
		stack = (unsigned long*)&stack;

	printk("Call Trace: ");
	while (!kstack_end(stack)) {
		addr = *stack++;
		if (__kernel_text_address(addr))
			printk("[<%08lx>] %pSR\n", addr, (void *)addr);
	}
	printk("\n");
}

void show_stack(struct task_struct *task, unsigned long *sp)
{
	unsigned long  *stack;
	int  i;

	/*
	 * debugging aid: "show_stack(NULL);" prints the
	 * back trace for this cpu.
	 */

	if(sp==NULL) {
		if (task)
			sp = (unsigned long *)task->thread.sp;
		else
			sp=(unsigned long*)&sp;
	}

	stack = sp;
	for(i=0; i < kstack_depth_to_print; i++) {
		if (kstack_end(stack))
			break;
		if (i && ((i % 4) == 0))
			printk("\n       ");
		printk("%08lx ", *stack++);
	}
	printk("\n");
	show_trace(task, sp);
}

static void show_registers(struct pt_regs *regs)
{
	int i = 0;
	int in_kernel = 1;
	unsigned long sp;

	printk("CPU:    %d\n", smp_processor_id());
	show_regs(regs);

	sp = (unsigned long) (1+regs);
	if (user_mode(regs)) {
		in_kernel = 0;
		sp = regs->spu;
		printk("SPU: %08lx\n", sp);
	} else {
		printk("SPI: %08lx\n", sp);
	}
	printk("Process %s (pid: %d, process nr: %d, stackpage=%08lx)",
		current->comm, task_pid_nr(current), 0xffff & i, 4096+(unsigned long)current);

	/*
	 * When in-kernel, we also print out the stack and code at the
	 * time of the fault..
	 */
	if (in_kernel) {
		printk("\nStack: ");
		show_stack(current, (unsigned long*) sp);

		printk("\nCode: ");
		if (regs->bpc < PAGE_OFFSET)
			goto bad;

		for(i=0;i<20;i++) {
			unsigned char c;
			if (__get_user(c, &((unsigned char*)regs->bpc)[i])) {
bad:
				printk(" Bad PC value.");
				break;
			}
			printk("%02x ", c);
		}
	}
	printk("\n");
}

static DEFINE_SPINLOCK(die_lock);

void die(const char * str, struct pt_regs * regs, long err)
{
	console_verbose();
	spin_lock_irq(&die_lock);
	bust_spinlocks(1);
	printk("%s: %04lx\n", str, err & 0xffff);
	show_registers(regs);
	bust_spinlocks(0);
	spin_unlock_irq(&die_lock);
	do_exit(SIGSEGV);
}

static __inline__ void die_if_kernel(const char * str,
	struct pt_regs * regs, long err)
{
	if (!user_mode(regs))
		die(str, regs, err);
}

static __inline__ void do_trap(int trapnr, int signr, const char * str,
	struct pt_regs * regs, long error_code, siginfo_t *info)
{
	if (user_mode(regs)) {
		/* trap_signal */
		struct task_struct *tsk = current;
		tsk->thread.error_code = error_code;
		tsk->thread.trap_no = trapnr;
		if (info)
			force_sig_info(signr, info, tsk);
		else
			force_sig(signr, tsk);
		return;
	} else {
		/* kernel_trap */
		if (!fixup_exception(regs))
			die(str, regs, error_code);
		return;
	}
}

#define DO_ERROR(trapnr, signr, str, name) \
asmlinkage void do_##name(struct pt_regs * regs, long error_code) \
{ \
	do_trap(trapnr, signr, NULL, regs, error_code, NULL); \
}

#define DO_ERROR_INFO(trapnr, signr, str, name, sicode, siaddr) \
asmlinkage void do_##name(struct pt_regs * regs, long error_code) \
{ \
	siginfo_t info; \
	info.si_signo = signr; \
	info.si_errno = 0; \
	info.si_code = sicode; \
	info.si_addr = (void __user *)siaddr; \
	do_trap(trapnr, signr, str, regs, error_code, &info); \
}

DO_ERROR( 1, SIGTRAP, "debug trap", debug_trap)
DO_ERROR_INFO(0x20, SIGILL,  "reserved instruction ", rie_handler, ILL_ILLOPC, regs->bpc)
DO_ERROR_INFO(0x100, SIGILL,  "privileged instruction", pie_handler, ILL_PRVOPC, regs->bpc)
DO_ERROR_INFO(-1, SIGILL,  "illegal trap", ill_trap, ILL_ILLTRP, regs->bpc)

extern int handle_unaligned_access(unsigned long, struct pt_regs *);

/* This code taken from arch/sh/kernel/traps.c */
asmlinkage void do_alignment_check(struct pt_regs *regs, long error_code)
{
	mm_segment_t oldfs;
	unsigned long insn;
	int tmp;

	oldfs = get_fs();

	if (user_mode(regs)) {
		local_irq_enable();
		current->thread.error_code = error_code;
		current->thread.trap_no = 0x17;

		set_fs(USER_DS);
		if (copy_from_user(&insn, (void *)regs->bpc, 4)) {
			set_fs(oldfs);
			goto uspace_segv;
		}
		tmp = handle_unaligned_access(insn, regs);
		set_fs(oldfs);

		if (!tmp)
			return;

	uspace_segv:
		printk(KERN_NOTICE "Killing process \"%s\" due to unaligned "
			"access\n", current->comm);
		force_sig(SIGSEGV, current);
	} else {
		set_fs(KERNEL_DS);
		if (copy_from_user(&insn, (void *)regs->bpc, 4)) {
			set_fs(oldfs);
			die("insn faulting in do_address_error", regs, 0);
		}
		handle_unaligned_access(insn, regs);
		set_fs(oldfs);
	}
}
Commit	Line	Data
b2441318	1	// SPDX-License-Identifier: GPL-2.0
1da177e4 LT	2	/*
	3	* linux/arch/m32r/kernel/traps.c
	4	*
	5	* Copyright (C) 2001, 2002 Hirokazu Takata, Hiroyuki Kondo,
	6	* Hitoshi Yamamoto
	7	*/
	8
1da177e4 LT	9	/*
	10	* 'traps.c' handles hardware traps and faults after we have saved some
	11	* state in 'entry.S'.
	12	*/
1da177e4 LT	13	#include <linux/init.h>
	14	#include <linux/kernel.h>
	15	#include <linux/kallsyms.h>
	16	#include <linux/stddef.h>
	17	#include <linux/ptrace.h>
b17b0153	18	#include <linux/sched/debug.h>
3f8c2452	19	#include <linux/sched/task_stack.h>
1da177e4	20	#include <linux/mm.h>
1777e463	21	#include <linux/cpu.h>
3f8c2452	22
1da177e4 LT	23	#include <asm/page.h>
	24	#include <asm/processor.h>
	25
7c0f6ba6	26	#include <linux/uaccess.h>
1da177e4	27	#include <asm/io.h>
60063497	28	#include <linux/atomic.h>
1da177e4 LT	29
	30	#include <asm/smp.h>
	31
	32	#include <linux/module.h>
	33
	34	asmlinkage void alignment_check(void);
	35	asmlinkage void ei_handler(void);
	36	asmlinkage void rie_handler(void);
	37	asmlinkage void debug_trap(void);
	38	asmlinkage void cache_flushing_handler(void);
9de11aab	39	asmlinkage void ill_trap(void);
1da177e4 LT	40
	41	#ifdef CONFIG_SMP
	42	extern void smp_reschedule_interrupt(void);
	43	extern void smp_invalidate_interrupt(void);
	44	extern void smp_call_function_interrupt(void);
	45	extern void smp_ipi_timer_interrupt(void);
	46	extern void smp_flush_cache_all_interrupt(void);
7b7426c8	47	extern void smp_call_function_single_interrupt(void);
1da177e4 LT	48
	49	/*
	50	* for Boot AP function
	51	*/
	52	asm (
	53	" .section .eit_vector4,\"ax\" \n"
	54	" .global _AP_RE \n"
	55	" .global startup_AP \n"
	56	"_AP_RE: \n"
	57	" .fill 32, 4, 0 \n"
	58	"_AP_EI: bra startup_AP \n"
	59	" .previous \n"
	60	);
	61	#endif /* CONFIG_SMP */
	62
	63	extern unsigned long eit_vector[];
	64	#define BRA_INSN(func, entry) \
	65	((unsigned long)func - (unsigned long)eit_vector - entry*4)/4 \
	66	+ 0xff000000UL
	67
81e48073	68	static void set_eit_vector_entries(void)
1da177e4 LT	69	{
	70	extern void default_eit_handler(void);
	71	extern void system_call(void);
	72	extern void pie_handler(void);
	73	extern void ace_handler(void);
	74	extern void tme_handler(void);
	75	extern void _flush_cache_copyback_all(void);
	76
	77	eit_vector[0] = 0xd0c00001; /* seth r0, 0x01 */
	78	eit_vector[1] = BRA_INSN(default_eit_handler, 1);
	79	eit_vector[4] = 0xd0c00010; /* seth r0, 0x10 */
	80	eit_vector[5] = BRA_INSN(default_eit_handler, 5);
	81	eit_vector[8] = BRA_INSN(rie_handler, 8);
	82	eit_vector[12] = BRA_INSN(alignment_check, 12);
9de11aab	83	eit_vector[16] = BRA_INSN(ill_trap, 16);
1da177e4 LT	84	eit_vector[17] = BRA_INSN(debug_trap, 17);
1da177e4 LT	85	eit_vector[18] = BRA_INSN(system_call, 18);
9de11aab HT	86	eit_vector[19] = BRA_INSN(ill_trap, 19);
	87	eit_vector[20] = BRA_INSN(ill_trap, 20);
	88	eit_vector[21] = BRA_INSN(ill_trap, 21);
	89	eit_vector[22] = BRA_INSN(ill_trap, 22);
	90	eit_vector[23] = BRA_INSN(ill_trap, 23);
	91	eit_vector[24] = BRA_INSN(ill_trap, 24);
	92	eit_vector[25] = BRA_INSN(ill_trap, 25);
	93	eit_vector[26] = BRA_INSN(ill_trap, 26);
	94	eit_vector[27] = BRA_INSN(ill_trap, 27);
1da177e4	95	eit_vector[28] = BRA_INSN(cache_flushing_handler, 28);
9de11aab HT	96	eit_vector[29] = BRA_INSN(ill_trap, 29);
	97	eit_vector[30] = BRA_INSN(ill_trap, 30);
	98	eit_vector[31] = BRA_INSN(ill_trap, 31);
1da177e4 LT	99	eit_vector[32] = BRA_INSN(ei_handler, 32);
	100	eit_vector[64] = BRA_INSN(pie_handler, 64);
	101	#ifdef CONFIG_MMU
	102	eit_vector[68] = BRA_INSN(ace_handler, 68);
	103	eit_vector[72] = BRA_INSN(tme_handler, 72);
	104	#endif /* CONFIG_MMU */
	105	#ifdef CONFIG_SMP
	106	eit_vector[184] = (unsigned long)smp_reschedule_interrupt;
	107	eit_vector[185] = (unsigned long)smp_invalidate_interrupt;
	108	eit_vector[186] = (unsigned long)smp_call_function_interrupt;
	109	eit_vector[187] = (unsigned long)smp_ipi_timer_interrupt;
	110	eit_vector[188] = (unsigned long)smp_flush_cache_all_interrupt;
0a3d31b7 TH	111	eit_vector[189] = 0; /* CPU_BOOT_IPI */
0a3d31b7 TH	112	eit_vector[190] = (unsigned long)smp_call_function_single_interrupt;
1da177e4 LT	113	eit_vector[191] = 0;
	114	#endif
	115	_flush_cache_copyback_all();
	116	}
	117
d22e3d69 SM	118	void abort(void)
	119	{
	120	BUG();
	121
	122	/* if that doesn't kill us, halt */
	123	panic("Oops failed to kill thread");
	124	}
	125	EXPORT_SYMBOL(abort);
	126
1da177e4 LT	127	void __init trap_init(void)
	128	{
	129	set_eit_vector_entries();
	130
	131	/*
	132	* Should be a barrier for any external CPU state.
	133	*/
	134	cpu_init();
	135	}
	136
81e48073	137	static int kstack_depth_to_print = 24;
1da177e4	138
81e48073	139	static void show_trace(struct task_struct task, unsigned long stack)
1da177e4 LT	140	{
	141	unsigned long addr;
	142
	143	if (!stack)
	144	stack = (unsigned long*)&stack;
	145
	146	printk("Call Trace: ");
	147	while (!kstack_end(stack)) {
	148	addr = *stack++;
c8d5cb74 JP	149	if (__kernel_text_address(addr))
c8d5cb74 JP	150	printk("[<%08lx>] %pSR\n", addr, (void *)addr);
1da177e4 LT	151	}
	152	printk("\n");
	153	}
	154
	155	void show_stack(struct task_struct task, unsigned long sp)
	156	{
	157	unsigned long *stack;
	158	int i;
	159
	160	/*
	161	* debugging aid: "show_stack(NULL);" prints the
	162	* back trace for this cpu.
	163	*/
	164
	165	if(sp==NULL) {
	166	if (task)
	167	sp = (unsigned long *)task->thread.sp;
	168	else
	169	sp=(unsigned long*)&sp;
	170	}
	171
	172	stack = sp;
	173	for(i=0; i < kstack_depth_to_print; i++) {
	174	if (kstack_end(stack))
	175	break;
	176	if (i && ((i % 4) == 0))
	177	printk("\n ");
	178	printk("%08lx ", *stack++);
	179	}
	180	printk("\n");
	181	show_trace(task, sp);
	182	}
	183
1da177e4 LT	184	static void show_registers(struct pt_regs *regs)
	185	{
	186	int i = 0;
	187	int in_kernel = 1;
	188	unsigned long sp;
	189
	190	printk("CPU: %d\n", smp_processor_id());
	191	show_regs(regs);
	192
	193	sp = (unsigned long) (1+regs);
	194	if (user_mode(regs)) {
	195	in_kernel = 0;
	196	sp = regs->spu;
	197	printk("SPU: %08lx\n", sp);
	198	} else {
	199	printk("SPI: %08lx\n", sp);
	200	}
	201	printk("Process %s (pid: %d, process nr: %d, stackpage=%08lx)",
19c5870c	202	current->comm, task_pid_nr(current), 0xffff & i, 4096+(unsigned long)current);
1da177e4 LT	203
	204	/*
	205	* When in-kernel, we also print out the stack and code at the
	206	* time of the fault..
	207	*/
	208	if (in_kernel) {
	209	printk("\nStack: ");
	210	show_stack(current, (unsigned long*) sp);
	211
	212	printk("\nCode: ");
	213	if (regs->bpc < PAGE_OFFSET)
	214	goto bad;
	215
	216	for(i=0;i<20;i++) {
	217	unsigned char c;
	218	if (__get_user(c, &((unsigned char*)regs->bpc)[i])) {
	219	bad:
	220	printk(" Bad PC value.");
	221	break;
	222	}
	223	printk("%02x ", c);
	224	}
	225	}
	226	printk("\n");
	227	}
	228
81e48073	229	static DEFINE_SPINLOCK(die_lock);
1da177e4 LT	230
	231	void die(const char * str, struct pt_regs * regs, long err)
	232	{
	233	console_verbose();
	234	spin_lock_irq(&die_lock);
	235	bust_spinlocks(1);
	236	printk("%s: %04lx\n", str, err & 0xffff);
	237	show_registers(regs);
	238	bust_spinlocks(0);
	239	spin_unlock_irq(&die_lock);
	240	do_exit(SIGSEGV);
	241	}
	242
	243	static __inline__ void die_if_kernel(const char * str,
	244	struct pt_regs * regs, long err)
	245	{
	246	if (!user_mode(regs))
	247	die(str, regs, err);
	248	}
	249
	250	static __inline__ void do_trap(int trapnr, int signr, const char * str,
	251	struct pt_regs * regs, long error_code, siginfo_t *info)
	252	{
	253	if (user_mode(regs)) {
	254	/* trap_signal */
	255	struct task_struct *tsk = current;
	256	tsk->thread.error_code = error_code;
	257	tsk->thread.trap_no = trapnr;
	258	if (info)
	259	force_sig_info(signr, info, tsk);
	260	else
	261	force_sig(signr, tsk);
	262	return;
	263	} else {
	264	/* kernel_trap */
	265	if (!fixup_exception(regs))
	266	die(str, regs, error_code);
	267	return;
	268	}
	269	}
	270
	271	#define DO_ERROR(trapnr, signr, str, name) \
	272	asmlinkage void do_##name(struct pt_regs * regs, long error_code) \
	273	{ \
12ea59e8	274	do_trap(trapnr, signr, NULL, regs, error_code, NULL); \
1da177e4 LT	275	}
	276
	277	#define DO_ERROR_INFO(trapnr, signr, str, name, sicode, siaddr) \
	278	asmlinkage void do_##name(struct pt_regs * regs, long error_code) \
	279	{ \
	280	siginfo_t info; \
	281	info.si_signo = signr; \
	282	info.si_errno = 0; \
	283	info.si_code = sicode; \
	284	info.si_addr = (void __user *)siaddr; \
	285	do_trap(trapnr, signr, str, regs, error_code, &info); \
	286	}
	287
	288	DO_ERROR( 1, SIGTRAP, "debug trap", debug_trap)
	289	DO_ERROR_INFO(0x20, SIGILL, "reserved instruction ", rie_handler, ILL_ILLOPC, regs->bpc)
9de11aab HT	290	DO_ERROR_INFO(0x100, SIGILL, "privileged instruction", pie_handler, ILL_PRVOPC, regs->bpc)
9de11aab HT	291	DO_ERROR_INFO(-1, SIGILL, "illegal trap", ill_trap, ILL_ILLTRP, regs->bpc)
1da177e4 LT	292
	293	extern int handle_unaligned_access(unsigned long, struct pt_regs *);
	294
	295	/* This code taken from arch/sh/kernel/traps.c */
	296	asmlinkage void do_alignment_check(struct pt_regs *regs, long error_code)
	297	{
	298	mm_segment_t oldfs;
	299	unsigned long insn;
	300	int tmp;
	301
	302	oldfs = get_fs();
	303
	304	if (user_mode(regs)) {
	305	local_irq_enable();
	306	current->thread.error_code = error_code;
	307	current->thread.trap_no = 0x17;
	308
	309	set_fs(USER_DS);
	310	if (copy_from_user(&insn, (void *)regs->bpc, 4)) {
	311	set_fs(oldfs);
	312	goto uspace_segv;
	313	}
	314	tmp = handle_unaligned_access(insn, regs);
	315	set_fs(oldfs);
	316
	317	if (!tmp)
	318	return;
	319
	320	uspace_segv:
	321	printk(KERN_NOTICE "Killing process \"%s\" due to unaligned "
	322	"access\n", current->comm);
	323	force_sig(SIGSEGV, current);
	324	} else {
	325	set_fs(KERNEL_DS);
	326	if (copy_from_user(&insn, (void *)regs->bpc, 4)) {
	327	set_fs(oldfs);
	328	die("insn faulting in do_address_error", regs, 0);
	329	}
	330	handle_unaligned_access(insn, regs);
	331	set_fs(oldfs);
	332	}
	333	}