Linux Audio

Check our new training course

Loading...
Note: File does not exist in v6.2.
  1/*
  2 * Copyright 2010 Tilera Corporation. All Rights Reserved.
  3 *
  4 *   This program is free software; you can redistribute it and/or
  5 *   modify it under the terms of the GNU General Public License
  6 *   as published by the Free Software Foundation, version 2.
  7 *
  8 *   This program is distributed in the hope that it will be useful, but
  9 *   WITHOUT ANY WARRANTY; without even the implied warranty of
 10 *   MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
 11 *   NON INFRINGEMENT.  See the GNU General Public License for
 12 *   more details.
 13 */
 14
 15#include <linux/sched.h>
 16#include <linux/kernel.h>
 17#include <linux/kprobes.h>
 18#include <linux/kdebug.h>
 19#include <linux/module.h>
 20#include <linux/reboot.h>
 21#include <linux/uaccess.h>
 22#include <linux/ptrace.h>
 23#include <asm/stack.h>
 24#include <asm/traps.h>
 25#include <asm/setup.h>
 26
 27#include <arch/interrupts.h>
 28#include <arch/spr_def.h>
 29#include <arch/opcode.h>
 30
 31void __init trap_init(void)
 32{
 33	/* Nothing needed here since we link code at .intrpt */
 34}
 35
 36int unaligned_fixup = 1;
 37
 38static int __init setup_unaligned_fixup(char *str)
 39{
 40	/*
 41	 * Say "=-1" to completely disable it.  If you just do "=0", we
 42	 * will still parse the instruction, then fire a SIGBUS with
 43	 * the correct address from inside the single_step code.
 44	 */
 45	if (kstrtoint(str, 0, &unaligned_fixup) != 0)
 46		return 0;
 47
 48	pr_info("Fixups for unaligned data accesses are %s\n",
 49		unaligned_fixup >= 0 ?
 50		(unaligned_fixup ? "enabled" : "disabled") :
 51		"completely disabled");
 52	return 1;
 53}
 54__setup("unaligned_fixup=", setup_unaligned_fixup);
 55
 56#if CHIP_HAS_TILE_DMA()
 57
 58static int dma_disabled;
 59
 60static int __init nodma(char *str)
 61{
 62	pr_info("User-space DMA is disabled\n");
 63	dma_disabled = 1;
 64	return 1;
 65}
 66__setup("nodma", nodma);
 67
 68/* How to decode SPR_GPV_REASON */
 69#define IRET_ERROR (1U << 31)
 70#define MT_ERROR   (1U << 30)
 71#define MF_ERROR   (1U << 29)
 72#define SPR_INDEX  ((1U << 15) - 1)
 73#define SPR_MPL_SHIFT  9  /* starting bit position for MPL encoded in SPR */
 74
 75/*
 76 * See if this GPV is just to notify the kernel of SPR use and we can
 77 * retry the user instruction after adjusting some MPLs suitably.
 78 */
 79static int retry_gpv(unsigned int gpv_reason)
 80{
 81	int mpl;
 82
 83	if (gpv_reason & IRET_ERROR)
 84		return 0;
 85
 86	BUG_ON((gpv_reason & (MT_ERROR|MF_ERROR)) == 0);
 87	mpl = (gpv_reason & SPR_INDEX) >> SPR_MPL_SHIFT;
 88	if (mpl == INT_DMA_NOTIFY && !dma_disabled) {
 89		/* User is turning on DMA. Allow it and retry. */
 90		printk(KERN_DEBUG "Process %d/%s is now enabled for DMA\n",
 91		       current->pid, current->comm);
 92		BUG_ON(current->thread.tile_dma_state.enabled);
 93		current->thread.tile_dma_state.enabled = 1;
 94		grant_dma_mpls();
 95		return 1;
 96	}
 97
 98	return 0;
 99}
100
101#endif /* CHIP_HAS_TILE_DMA() */
102
103extern tile_bundle_bits bpt_code;
104
105asm(".pushsection .rodata.bpt_code,\"a\";"
106    ".align 8;"
107    "bpt_code: bpt;"
108    ".size bpt_code,.-bpt_code;"
109    ".popsection");
110
111static int special_ill(tile_bundle_bits bundle, int *sigp, int *codep)
112{
113	int sig, code, maxcode;
114
115	if (bundle == bpt_code) {
116		*sigp = SIGTRAP;
117		*codep = TRAP_BRKPT;
118		return 1;
119	}
120
121	/* If it's a "raise" bundle, then "ill" must be in pipe X1. */
122#ifdef __tilegx__
123	if ((bundle & TILEGX_BUNDLE_MODE_MASK) != 0)
124		return 0;
125	if (get_Opcode_X1(bundle) != RRR_0_OPCODE_X1)
126		return 0;
127	if (get_RRROpcodeExtension_X1(bundle) != UNARY_RRR_0_OPCODE_X1)
128		return 0;
129	if (get_UnaryOpcodeExtension_X1(bundle) != ILL_UNARY_OPCODE_X1)
130		return 0;
131#else
132	if (bundle & TILEPRO_BUNDLE_Y_ENCODING_MASK)
133		return 0;
134	if (get_Opcode_X1(bundle) != SHUN_0_OPCODE_X1)
135		return 0;
136	if (get_UnShOpcodeExtension_X1(bundle) != UN_0_SHUN_0_OPCODE_X1)
137		return 0;
138	if (get_UnOpcodeExtension_X1(bundle) != ILL_UN_0_SHUN_0_OPCODE_X1)
139		return 0;
140#endif
141
142	/* Check that the magic distinguishers are set to mean "raise". */
143	if (get_Dest_X1(bundle) != 29 || get_SrcA_X1(bundle) != 37)
144		return 0;
145
146	/* There must be an "addli zero, zero, VAL" in X0. */
147	if (get_Opcode_X0(bundle) != ADDLI_OPCODE_X0)
148		return 0;
149	if (get_Dest_X0(bundle) != TREG_ZERO)
150		return 0;
151	if (get_SrcA_X0(bundle) != TREG_ZERO)
152		return 0;
153
154	/*
155	 * Validate the proposed signal number and si_code value.
156	 * Note that we embed these in the static instruction itself
157	 * so that we perturb the register state as little as possible
158	 * at the time of the actual fault; it's unlikely you'd ever
159	 * need to dynamically choose which kind of fault to raise
160	 * from user space.
161	 */
162	sig = get_Imm16_X0(bundle) & 0x3f;
163	switch (sig) {
164	case SIGILL:
165		maxcode = NSIGILL;
166		break;
167	case SIGFPE:
168		maxcode = NSIGFPE;
169		break;
170	case SIGSEGV:
171		maxcode = NSIGSEGV;
172		break;
173	case SIGBUS:
174		maxcode = NSIGBUS;
175		break;
176	case SIGTRAP:
177		maxcode = NSIGTRAP;
178		break;
179	default:
180		return 0;
181	}
182	code = (get_Imm16_X0(bundle) >> 6) & 0xf;
183	if (code <= 0 || code > maxcode)
184		return 0;
185
186	/* Make it the requested signal. */
187	*sigp = sig;
188	*codep = code | __SI_FAULT;
189	return 1;
190}
191
192static const char *const int_name[] = {
193	[INT_MEM_ERROR] = "Memory error",
194	[INT_ILL] = "Illegal instruction",
195	[INT_GPV] = "General protection violation",
196	[INT_UDN_ACCESS] = "UDN access",
197	[INT_IDN_ACCESS] = "IDN access",
198#if CHIP_HAS_SN()
199	[INT_SN_ACCESS] = "SN access",
200#endif
201	[INT_SWINT_3] = "Software interrupt 3",
202	[INT_SWINT_2] = "Software interrupt 2",
203	[INT_SWINT_0] = "Software interrupt 0",
204	[INT_UNALIGN_DATA] = "Unaligned data",
205	[INT_DOUBLE_FAULT] = "Double fault",
206#ifdef __tilegx__
207	[INT_ILL_TRANS] = "Illegal virtual address",
208#endif
209};
210
211static int do_bpt(struct pt_regs *regs)
212{
213	unsigned long bundle, bcode, bpt;
214
215	bundle = *(unsigned long *)instruction_pointer(regs);
216
217	/*
218	 * bpt shoule be { bpt; nop }, which is 0x286a44ae51485000ULL.
219	 * we encode the unused least significant bits for other purpose.
220	 */
221	bpt = bundle & ~((1ULL << 12) - 1);
222	if (bpt != TILE_BPT_BUNDLE)
223		return 0;
224
225	bcode = bundle & ((1ULL << 12) - 1);
226	/*
227	 * notify the kprobe handlers, if instruction is likely to
228	 * pertain to them.
229	 */
230	switch (bcode) {
231	/* breakpoint_insn */
232	case 0:
233		notify_die(DIE_BREAK, "debug", regs, bundle,
234			INT_ILL, SIGTRAP);
235		break;
236	/* compiled_bpt */
237	case DIE_COMPILED_BPT:
238		notify_die(DIE_COMPILED_BPT, "debug", regs, bundle,
239			INT_ILL, SIGTRAP);
240		break;
241	/* breakpoint2_insn */
242	case DIE_SSTEPBP:
243		notify_die(DIE_SSTEPBP, "single_step", regs, bundle,
244			INT_ILL, SIGTRAP);
245		break;
246	default:
247		return 0;
248	}
249
250	return 1;
251}
252
253void __kprobes do_trap(struct pt_regs *regs, int fault_num,
254		       unsigned long reason)
255{
256	siginfo_t info = { 0 };
257	int signo, code;
258	unsigned long address = 0;
259	tile_bundle_bits instr;
260	int is_kernel = !user_mode(regs);
261
262	/* Handle breakpoints, etc. */
263	if (is_kernel && fault_num == INT_ILL && do_bpt(regs))
264		return;
265
266	/* Re-enable interrupts, if they were previously enabled. */
267	if (!(regs->flags & PT_FLAGS_DISABLE_IRQ))
268		local_irq_enable();
269
270	/*
271	 * If it hits in kernel mode and we can't fix it up, just exit the
272	 * current process and hope for the best.
273	 */
274	if (is_kernel) {
275		const char *name;
276		char buf[100];
277		if (fixup_exception(regs))  /* ILL_TRANS or UNALIGN_DATA */
278			return;
279		if (fault_num >= 0 &&
280		    fault_num < ARRAY_SIZE(int_name) &&
281		    int_name[fault_num] != NULL)
282			name = int_name[fault_num];
283		else
284			name = "Unknown interrupt";
285		if (fault_num == INT_GPV)
286			snprintf(buf, sizeof(buf), "; GPV_REASON %#lx", reason);
287#ifdef __tilegx__
288		else if (fault_num == INT_ILL_TRANS)
289			snprintf(buf, sizeof(buf), "; address %#lx", reason);
290#endif
291		else
292			buf[0] = '\0';
293		pr_alert("Kernel took bad trap %d (%s) at PC %#lx%s\n",
294			 fault_num, name, regs->pc, buf);
295		show_regs(regs);
296		do_exit(SIGKILL);  /* FIXME: implement i386 die() */
297	}
298
299	switch (fault_num) {
300	case INT_MEM_ERROR:
301		signo = SIGBUS;
302		code = BUS_OBJERR;
303		break;
304	case INT_ILL:
305		if (copy_from_user(&instr, (void __user *)regs->pc,
306				   sizeof(instr))) {
307			pr_err("Unreadable instruction for INT_ILL: %#lx\n",
308			       regs->pc);
309			do_exit(SIGKILL);
310		}
311		if (!special_ill(instr, &signo, &code)) {
312			signo = SIGILL;
313			code = ILL_ILLOPC;
314		}
315		address = regs->pc;
316		break;
317	case INT_GPV:
318#if CHIP_HAS_TILE_DMA()
319		if (retry_gpv(reason))
320			return;
321#endif
322		/*FALLTHROUGH*/
323	case INT_UDN_ACCESS:
324	case INT_IDN_ACCESS:
325#if CHIP_HAS_SN()
326	case INT_SN_ACCESS:
327#endif
328		signo = SIGILL;
329		code = ILL_PRVREG;
330		address = regs->pc;
331		break;
332	case INT_SWINT_3:
333	case INT_SWINT_2:
334	case INT_SWINT_0:
335		signo = SIGILL;
336		code = ILL_ILLTRP;
337		address = regs->pc;
338		break;
339	case INT_UNALIGN_DATA:
340#ifndef __tilegx__  /* Emulated support for single step debugging */
341		if (unaligned_fixup >= 0) {
342			struct single_step_state *state =
343				current_thread_info()->step_state;
344			if (!state ||
345			    (void __user *)(regs->pc) != state->buffer) {
346				single_step_once(regs);
347				return;
348			}
349		}
350#endif
351		signo = SIGBUS;
352		code = BUS_ADRALN;
353		address = 0;
354		break;
355	case INT_DOUBLE_FAULT:
356		/*
357		 * For double fault, "reason" is actually passed as
358		 * SYSTEM_SAVE_K_2, the hypervisor's double-fault info, so
359		 * we can provide the original fault number rather than
360		 * the uninteresting "INT_DOUBLE_FAULT" so the user can
361		 * learn what actually struck while PL0 ICS was set.
362		 */
363		fault_num = reason;
364		signo = SIGILL;
365		code = ILL_DBLFLT;
366		address = regs->pc;
367		break;
368#ifdef __tilegx__
369	case INT_ILL_TRANS: {
370		/* Avoid a hardware erratum with the return address stack. */
371		fill_ra_stack();
372
373		signo = SIGSEGV;
374		address = reason;
375		code = SEGV_MAPERR;
376		break;
377	}
378#endif
379	default:
380		panic("Unexpected do_trap interrupt number %d", fault_num);
381	}
382
383	info.si_signo = signo;
384	info.si_code = code;
385	info.si_addr = (void __user *)address;
386	if (signo == SIGILL)
387		info.si_trapno = fault_num;
388	if (signo != SIGTRAP)
389		trace_unhandled_signal("trap", regs, address, signo);
390	force_sig_info(signo, &info, current);
391}
392
393void do_nmi(struct pt_regs *regs, int fault_num, unsigned long reason)
394{
395	switch (reason) {
396	case TILE_NMI_DUMP_STACK:
397		do_nmi_dump_stack(regs);
398		break;
399	default:
400		panic("Unexpected do_nmi type %ld", reason);
401		return;
402	}
403}
404
405/* Deprecated function currently only used here. */
406extern void _dump_stack(int dummy, ulong pc, ulong lr, ulong sp, ulong r52);
407
408void kernel_double_fault(int dummy, ulong pc, ulong lr, ulong sp, ulong r52)
409{
410	_dump_stack(dummy, pc, lr, sp, r52);
411	pr_emerg("Double fault: exiting\n");
412	machine_halt();
413}