stacktrace.c 2.38 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13
/*
 * arch/s390/kernel/stacktrace.c
 *
 * Stack trace management functions
 *
 *  Copyright (C) IBM Corp. 2006
 *  Author(s): Heiko Carstens <heiko.carstens@de.ibm.com>
 */

#include <linux/sched.h>
#include <linux/stacktrace.h>
#include <linux/kallsyms.h>

14 15 16
static unsigned long save_context_stack(struct stack_trace *trace,
					unsigned long sp,
					unsigned long low,
17 18
					unsigned long high,
					int savesched)
19 20 21 22 23 24 25 26 27 28 29 30
{
	struct stack_frame *sf;
	struct pt_regs *regs;
	unsigned long addr;

	while(1) {
		sp &= PSW_ADDR_INSN;
		if (sp < low || sp > high)
			return sp;
		sf = (struct stack_frame *)sp;
		while(1) {
			addr = sf->gprs[8] & PSW_ADDR_INSN;
Heiko Carstens's avatar
Heiko Carstens committed
31
			if (!trace->skip)
32 33
				trace->entries[trace->nr_entries++] = addr;
			else
Heiko Carstens's avatar
Heiko Carstens committed
34
				trace->skip--;
35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50
			if (trace->nr_entries >= trace->max_entries)
				return sp;
			low = sp;
			sp = sf->back_chain & PSW_ADDR_INSN;
			if (!sp)
				break;
			if (sp <= low || sp > high - sizeof(*sf))
				return sp;
			sf = (struct stack_frame *)sp;
		}
		/* Zero backchain detected, check for interrupt frame. */
		sp = (unsigned long)(sf + 1);
		if (sp <= low || sp > high - sizeof(*regs))
			return sp;
		regs = (struct pt_regs *)sp;
		addr = regs->psw.addr & PSW_ADDR_INSN;
51 52 53 54 55 56
		if (savesched || !in_sched_functions(addr)) {
			if (!trace->skip)
				trace->entries[trace->nr_entries++] = addr;
			else
				trace->skip--;
		}
57 58 59 60 61 62 63
		if (trace->nr_entries >= trace->max_entries)
			return sp;
		low = sp;
		sp = regs->gprs[15];
	}
}

64
void save_stack_trace(struct stack_trace *trace)
65 66
{
	register unsigned long sp asm ("15");
Christian Borntraeger's avatar
Christian Borntraeger committed
67
	unsigned long orig_sp, new_sp;
68

Christian Borntraeger's avatar
Christian Borntraeger committed
69
	orig_sp = sp & PSW_ADDR_INSN;
Heiko Carstens's avatar
Heiko Carstens committed
70 71
	new_sp = save_context_stack(trace, orig_sp,
				    S390_lowcore.panic_stack - PAGE_SIZE,
72
				    S390_lowcore.panic_stack, 1);
73
	if (new_sp != orig_sp)
74
		return;
Heiko Carstens's avatar
Heiko Carstens committed
75 76
	new_sp = save_context_stack(trace, new_sp,
				    S390_lowcore.async_stack - ASYNC_SIZE,
77
				    S390_lowcore.async_stack, 1);
78
	if (new_sp != orig_sp)
79
		return;
Heiko Carstens's avatar
Heiko Carstens committed
80
	save_context_stack(trace, new_sp,
81
			   S390_lowcore.thread_info,
82 83 84 85 86 87 88 89 90 91 92 93 94
			   S390_lowcore.thread_info + THREAD_SIZE, 1);
}

void save_stack_trace_tsk(struct task_struct *tsk, struct stack_trace *trace)
{
	unsigned long sp, low, high;

	sp = tsk->thread.ksp & PSW_ADDR_INSN;
	low = (unsigned long) task_stack_page(tsk);
	high = (unsigned long) task_pt_regs(tsk);
	save_context_stack(trace, sp, low, high, 0);
	if (trace->nr_entries < trace->max_entries)
		trace->entries[trace->nr_entries++] = ULONG_MAX;
95
}