|
@@ -36,6 +36,8 @@
|
|
|
#include <linux/kallsyms.h>
|
|
|
#include <linux/mqueue.h>
|
|
|
#include <linux/hardirq.h>
|
|
|
+#include <linux/utsname.h>
|
|
|
+#include <linux/kprobes.h>
|
|
|
|
|
|
#include <asm/pgtable.h>
|
|
|
#include <asm/uaccess.h>
|
|
@@ -44,6 +46,11 @@
|
|
|
#include <asm/processor.h>
|
|
|
#include <asm/mmu.h>
|
|
|
#include <asm/prom.h>
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+#include <asm/firmware.h>
|
|
|
+#include <asm/plpar_wrappers.h>
|
|
|
+#include <asm/time.h>
|
|
|
+#endif
|
|
|
|
|
|
extern unsigned long _get_SP(void);
|
|
|
|
|
@@ -53,26 +60,6 @@ struct task_struct *last_task_used_altivec = NULL;
|
|
|
struct task_struct *last_task_used_spe = NULL;
|
|
|
#endif
|
|
|
|
|
|
-static struct fs_struct init_fs = INIT_FS;
|
|
|
-static struct files_struct init_files = INIT_FILES;
|
|
|
-static struct signal_struct init_signals = INIT_SIGNALS(init_signals);
|
|
|
-static struct sighand_struct init_sighand = INIT_SIGHAND(init_sighand);
|
|
|
-struct mm_struct init_mm = INIT_MM(init_mm);
|
|
|
-EXPORT_SYMBOL(init_mm);
|
|
|
-
|
|
|
-/* this is 8kB-aligned so we can get to the thread_info struct
|
|
|
- at the base of it from the stack pointer with 1 integer instruction. */
|
|
|
-union thread_union init_thread_union
|
|
|
- __attribute__((__section__(".data.init_task"))) =
|
|
|
-{ INIT_THREAD_INFO(init_task) };
|
|
|
-
|
|
|
-/* initial task structure */
|
|
|
-struct task_struct init_task = INIT_TASK(init_task);
|
|
|
-EXPORT_SYMBOL(init_task);
|
|
|
-
|
|
|
-/* only used to get secondary processor up */
|
|
|
-struct task_struct *current_set[NR_CPUS] = {&init_task, };
|
|
|
-
|
|
|
/*
|
|
|
* Make sure the floating-point register state in the
|
|
|
* the thread_struct is up to date for task tsk.
|
|
@@ -237,7 +224,10 @@ int set_dabr(unsigned long dabr)
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+DEFINE_PER_CPU(struct cpu_usage, cpu_usage_array);
|
|
|
static DEFINE_PER_CPU(unsigned long, current_dabr);
|
|
|
+#endif
|
|
|
|
|
|
struct task_struct *__switch_to(struct task_struct *prev,
|
|
|
struct task_struct *new)
|
|
@@ -308,10 +298,27 @@ struct task_struct *__switch_to(struct task_struct *prev,
|
|
|
set_dabr(new->thread.dabr);
|
|
|
__get_cpu_var(current_dabr) = new->thread.dabr;
|
|
|
}
|
|
|
+
|
|
|
+ flush_tlb_pending();
|
|
|
#endif
|
|
|
|
|
|
new_thread = &new->thread;
|
|
|
old_thread = ¤t->thread;
|
|
|
+
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+ /*
|
|
|
+ * Collect processor utilization data per process
|
|
|
+ */
|
|
|
+ if (firmware_has_feature(FW_FEATURE_SPLPAR)) {
|
|
|
+ struct cpu_usage *cu = &__get_cpu_var(cpu_usage_array);
|
|
|
+ long unsigned start_tb, current_tb;
|
|
|
+ start_tb = old_thread->start_tb;
|
|
|
+ cu->current_tb = current_tb = mfspr(SPRN_PURR);
|
|
|
+ old_thread->accum_tb += (current_tb - start_tb);
|
|
|
+ new_thread->start_tb = current_tb;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
local_irq_save(flags);
|
|
|
last = _switch(old_thread, new_thread);
|
|
|
|
|
@@ -320,37 +327,106 @@ struct task_struct *__switch_to(struct task_struct *prev,
|
|
|
return last;
|
|
|
}
|
|
|
|
|
|
+static int instructions_to_print = 16;
|
|
|
+
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+#define BAD_PC(pc) ((REGION_ID(pc) != KERNEL_REGION_ID) && \
|
|
|
+ (REGION_ID(pc) != VMALLOC_REGION_ID))
|
|
|
+#else
|
|
|
+#define BAD_PC(pc) ((pc) < KERNELBASE)
|
|
|
+#endif
|
|
|
+
|
|
|
+static void show_instructions(struct pt_regs *regs)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ unsigned long pc = regs->nip - (instructions_to_print * 3 / 4 *
|
|
|
+ sizeof(int));
|
|
|
+
|
|
|
+ printk("Instruction dump:");
|
|
|
+
|
|
|
+ for (i = 0; i < instructions_to_print; i++) {
|
|
|
+ int instr;
|
|
|
+
|
|
|
+ if (!(i % 8))
|
|
|
+ printk("\n");
|
|
|
+
|
|
|
+ if (BAD_PC(pc) || __get_user(instr, (unsigned int *)pc)) {
|
|
|
+ printk("XXXXXXXX ");
|
|
|
+ } else {
|
|
|
+ if (regs->nip == pc)
|
|
|
+ printk("<%08x> ", instr);
|
|
|
+ else
|
|
|
+ printk("%08x ", instr);
|
|
|
+ }
|
|
|
+
|
|
|
+ pc += sizeof(int);
|
|
|
+ }
|
|
|
+
|
|
|
+ printk("\n");
|
|
|
+}
|
|
|
+
|
|
|
+static struct regbit {
|
|
|
+ unsigned long bit;
|
|
|
+ const char *name;
|
|
|
+} msr_bits[] = {
|
|
|
+ {MSR_EE, "EE"},
|
|
|
+ {MSR_PR, "PR"},
|
|
|
+ {MSR_FP, "FP"},
|
|
|
+ {MSR_ME, "ME"},
|
|
|
+ {MSR_IR, "IR"},
|
|
|
+ {MSR_DR, "DR"},
|
|
|
+ {0, NULL}
|
|
|
+};
|
|
|
+
|
|
|
+static void printbits(unsigned long val, struct regbit *bits)
|
|
|
+{
|
|
|
+ const char *sep = "";
|
|
|
+
|
|
|
+ printk("<");
|
|
|
+ for (; bits->bit; ++bits)
|
|
|
+ if (val & bits->bit) {
|
|
|
+ printk("%s%s", sep, bits->name);
|
|
|
+ sep = ",";
|
|
|
+ }
|
|
|
+ printk(">");
|
|
|
+}
|
|
|
+
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+#define REG "%016lX"
|
|
|
+#define REGS_PER_LINE 4
|
|
|
+#define LAST_VOLATILE 13
|
|
|
+#else
|
|
|
+#define REG "%08lX"
|
|
|
+#define REGS_PER_LINE 8
|
|
|
+#define LAST_VOLATILE 12
|
|
|
+#endif
|
|
|
+
|
|
|
void show_regs(struct pt_regs * regs)
|
|
|
{
|
|
|
int i, trap;
|
|
|
|
|
|
- printk("NIP: %08lX LR: %08lX SP: %08lX REGS: %p TRAP: %04lx %s\n",
|
|
|
- regs->nip, regs->link, regs->gpr[1], regs, regs->trap,
|
|
|
- print_tainted());
|
|
|
- printk("MSR: %08lx EE: %01x PR: %01x FP: %01x ME: %01x IR/DR: %01x%01x\n",
|
|
|
- regs->msr, regs->msr&MSR_EE ? 1 : 0, regs->msr&MSR_PR ? 1 : 0,
|
|
|
- regs->msr & MSR_FP ? 1 : 0,regs->msr&MSR_ME ? 1 : 0,
|
|
|
- regs->msr&MSR_IR ? 1 : 0,
|
|
|
- regs->msr&MSR_DR ? 1 : 0);
|
|
|
+ printk("NIP: "REG" LR: "REG" CTR: "REG"\n",
|
|
|
+ regs->nip, regs->link, regs->ctr);
|
|
|
+ printk("REGS: %p TRAP: %04lx %s (%s)\n",
|
|
|
+ regs, regs->trap, print_tainted(), system_utsname.release);
|
|
|
+ printk("MSR: "REG" ", regs->msr);
|
|
|
+ printbits(regs->msr, msr_bits);
|
|
|
+ printk(" CR: %08lX XER: %08lX\n", regs->ccr, regs->xer);
|
|
|
trap = TRAP(regs);
|
|
|
if (trap == 0x300 || trap == 0x600)
|
|
|
- printk("DAR: %08lX, DSISR: %08lX\n", regs->dar, regs->dsisr);
|
|
|
- printk("TASK = %p[%d] '%s' THREAD: %p\n",
|
|
|
+ printk("DAR: "REG", DSISR: "REG"\n", regs->dar, regs->dsisr);
|
|
|
+ printk("TASK = %p[%d] '%s' THREAD: %p",
|
|
|
current, current->pid, current->comm, current->thread_info);
|
|
|
- printk("Last syscall: %ld ", current->thread.last_syscall);
|
|
|
|
|
|
#ifdef CONFIG_SMP
|
|
|
printk(" CPU: %d", smp_processor_id());
|
|
|
#endif /* CONFIG_SMP */
|
|
|
|
|
|
for (i = 0; i < 32; i++) {
|
|
|
- long r;
|
|
|
- if ((i % 8) == 0)
|
|
|
+ if ((i % REGS_PER_LINE) == 0)
|
|
|
printk("\n" KERN_INFO "GPR%02d: ", i);
|
|
|
- if (__get_user(r, ®s->gpr[i]))
|
|
|
- break;
|
|
|
- printk("%08lX ", r);
|
|
|
- if (i == 12 && !FULL_REGS(regs))
|
|
|
+ printk(REG " ", regs->gpr[i]);
|
|
|
+ if (i == LAST_VOLATILE && !FULL_REGS(regs))
|
|
|
break;
|
|
|
}
|
|
|
printk("\n");
|
|
@@ -359,16 +435,20 @@ void show_regs(struct pt_regs * regs)
|
|
|
* Lookup NIP late so we have the best change of getting the
|
|
|
* above info out without failing
|
|
|
*/
|
|
|
- printk("NIP [%08lx] ", regs->nip);
|
|
|
+ printk("NIP ["REG"] ", regs->nip);
|
|
|
print_symbol("%s\n", regs->nip);
|
|
|
- printk("LR [%08lx] ", regs->link);
|
|
|
+ printk("LR ["REG"] ", regs->link);
|
|
|
print_symbol("%s\n", regs->link);
|
|
|
#endif
|
|
|
show_stack(current, (unsigned long *) regs->gpr[1]);
|
|
|
+ if (!user_mode(regs))
|
|
|
+ show_instructions(regs);
|
|
|
}
|
|
|
|
|
|
void exit_thread(void)
|
|
|
{
|
|
|
+ kprobe_flush_task(current);
|
|
|
+
|
|
|
#ifndef CONFIG_SMP
|
|
|
if (last_task_used_math == current)
|
|
|
last_task_used_math = NULL;
|
|
@@ -385,6 +465,14 @@ void exit_thread(void)
|
|
|
|
|
|
void flush_thread(void)
|
|
|
{
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+ struct thread_info *t = current_thread_info();
|
|
|
+
|
|
|
+ if (t->flags & _TIF_ABI_PENDING)
|
|
|
+ t->flags ^= (_TIF_ABI_PENDING | _TIF_32BIT);
|
|
|
+#endif
|
|
|
+ kprobe_flush_task(current);
|
|
|
+
|
|
|
#ifndef CONFIG_SMP
|
|
|
if (last_task_used_math == current)
|
|
|
last_task_used_math = NULL;
|
|
@@ -425,15 +513,13 @@ void prepare_to_copy(struct task_struct *tsk)
|
|
|
/*
|
|
|
* Copy a thread..
|
|
|
*/
|
|
|
-int
|
|
|
-copy_thread(int nr, unsigned long clone_flags, unsigned long usp,
|
|
|
- unsigned long unused,
|
|
|
- struct task_struct *p, struct pt_regs *regs)
|
|
|
+int copy_thread(int nr, unsigned long clone_flags, unsigned long usp,
|
|
|
+ unsigned long unused, struct task_struct *p,
|
|
|
+ struct pt_regs *regs)
|
|
|
{
|
|
|
struct pt_regs *childregs, *kregs;
|
|
|
extern void ret_from_fork(void);
|
|
|
unsigned long sp = (unsigned long)p->thread_info + THREAD_SIZE;
|
|
|
- unsigned long childframe;
|
|
|
|
|
|
CHECK_FULL_REGS(regs);
|
|
|
/* Copy registers */
|
|
@@ -443,17 +529,26 @@ copy_thread(int nr, unsigned long clone_flags, unsigned long usp,
|
|
|
if ((childregs->msr & MSR_PR) == 0) {
|
|
|
/* for kernel thread, set `current' and stackptr in new task */
|
|
|
childregs->gpr[1] = sp + sizeof(struct pt_regs);
|
|
|
+#ifdef CONFIG_PPC32
|
|
|
childregs->gpr[2] = (unsigned long) p;
|
|
|
+#else
|
|
|
+ clear_ti_thread_flag(p->thread_info, TIF_32BIT);
|
|
|
+#endif
|
|
|
p->thread.regs = NULL; /* no user register state */
|
|
|
} else {
|
|
|
childregs->gpr[1] = usp;
|
|
|
p->thread.regs = childregs;
|
|
|
- if (clone_flags & CLONE_SETTLS)
|
|
|
- childregs->gpr[2] = childregs->gpr[6];
|
|
|
+ if (clone_flags & CLONE_SETTLS) {
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+ if (!test_thread_flag(TIF_32BIT))
|
|
|
+ childregs->gpr[13] = childregs->gpr[6];
|
|
|
+ else
|
|
|
+#endif
|
|
|
+ childregs->gpr[2] = childregs->gpr[6];
|
|
|
+ }
|
|
|
}
|
|
|
childregs->gpr[3] = 0; /* Result from fork() */
|
|
|
sp -= STACK_FRAME_OVERHEAD;
|
|
|
- childframe = sp;
|
|
|
|
|
|
/*
|
|
|
* The way this works is that at some point in the future
|
|
@@ -467,9 +562,30 @@ copy_thread(int nr, unsigned long clone_flags, unsigned long usp,
|
|
|
kregs = (struct pt_regs *) sp;
|
|
|
sp -= STACK_FRAME_OVERHEAD;
|
|
|
p->thread.ksp = sp;
|
|
|
- kregs->nip = (unsigned long)ret_from_fork;
|
|
|
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+ if (cpu_has_feature(CPU_FTR_SLB)) {
|
|
|
+ unsigned long sp_vsid = get_kernel_vsid(sp);
|
|
|
+
|
|
|
+ sp_vsid <<= SLB_VSID_SHIFT;
|
|
|
+ sp_vsid |= SLB_VSID_KERNEL;
|
|
|
+ if (cpu_has_feature(CPU_FTR_16M_PAGE))
|
|
|
+ sp_vsid |= SLB_VSID_L;
|
|
|
+
|
|
|
+ p->thread.ksp_vsid = sp_vsid;
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * The PPC64 ABI makes use of a TOC to contain function
|
|
|
+ * pointers. The function (ret_from_except) is actually a pointer
|
|
|
+ * to the TOC entry. The first entry is a pointer to the actual
|
|
|
+ * function.
|
|
|
+ */
|
|
|
+ kregs->nip = *((unsigned long *)ret_from_fork);
|
|
|
+#else
|
|
|
+ kregs->nip = (unsigned long)ret_from_fork;
|
|
|
p->thread.last_syscall = -1;
|
|
|
+#endif
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -477,18 +593,61 @@ copy_thread(int nr, unsigned long clone_flags, unsigned long usp,
|
|
|
/*
|
|
|
* Set up a thread for executing a new program
|
|
|
*/
|
|
|
-void start_thread(struct pt_regs *regs, unsigned long nip, unsigned long sp)
|
|
|
+void start_thread(struct pt_regs *regs, unsigned long start, unsigned long sp)
|
|
|
{
|
|
|
set_fs(USER_DS);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * If we exec out of a kernel thread then thread.regs will not be
|
|
|
+ * set. Do it now.
|
|
|
+ */
|
|
|
+ if (!current->thread.regs) {
|
|
|
+ unsigned long childregs = (unsigned long)current->thread_info +
|
|
|
+ THREAD_SIZE;
|
|
|
+ childregs -= sizeof(struct pt_regs);
|
|
|
+ current->thread.regs = (struct pt_regs *)childregs;
|
|
|
+ }
|
|
|
+
|
|
|
memset(regs->gpr, 0, sizeof(regs->gpr));
|
|
|
regs->ctr = 0;
|
|
|
regs->link = 0;
|
|
|
regs->xer = 0;
|
|
|
regs->ccr = 0;
|
|
|
- regs->mq = 0;
|
|
|
- regs->nip = nip;
|
|
|
regs->gpr[1] = sp;
|
|
|
+
|
|
|
+#ifdef CONFIG_PPC32
|
|
|
+ regs->mq = 0;
|
|
|
+ regs->nip = start;
|
|
|
regs->msr = MSR_USER;
|
|
|
+#else
|
|
|
+ if (test_thread_flag(TIF_32BIT)) {
|
|
|
+ unsigned long entry, toc, load_addr = regs->gpr[2];
|
|
|
+
|
|
|
+ /* start is a relocated pointer to the function descriptor for
|
|
|
+ * the elf _start routine. The first entry in the function
|
|
|
+ * descriptor is the entry address of _start and the second
|
|
|
+ * entry is the TOC value we need to use.
|
|
|
+ */
|
|
|
+ __get_user(entry, (unsigned long __user *)start);
|
|
|
+ __get_user(toc, (unsigned long __user *)start+1);
|
|
|
+
|
|
|
+ /* Check whether the e_entry function descriptor entries
|
|
|
+ * need to be relocated before we can use them.
|
|
|
+ */
|
|
|
+ if (load_addr != 0) {
|
|
|
+ entry += load_addr;
|
|
|
+ toc += load_addr;
|
|
|
+ }
|
|
|
+ regs->nip = entry;
|
|
|
+ regs->gpr[2] = toc;
|
|
|
+ regs->msr = MSR_USER64;
|
|
|
+ } else {
|
|
|
+ regs->nip = start;
|
|
|
+ regs->gpr[2] = 0;
|
|
|
+ regs->msr = MSR_USER32;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
#ifndef CONFIG_SMP
|
|
|
if (last_task_used_math == current)
|
|
|
last_task_used_math = NULL;
|
|
@@ -506,6 +665,7 @@ void start_thread(struct pt_regs *regs, unsigned long nip, unsigned long sp)
|
|
|
#ifdef CONFIG_ALTIVEC
|
|
|
memset(current->thread.vr, 0, sizeof(current->thread.vr));
|
|
|
memset(¤t->thread.vscr, 0, sizeof(current->thread.vscr));
|
|
|
+ current->thread.vscr.u[3] = 0x00010000; /* Java mode disabled */
|
|
|
current->thread.vrsave = 0;
|
|
|
current->thread.used_vr = 0;
|
|
|
#endif /* CONFIG_ALTIVEC */
|
|
@@ -532,22 +692,23 @@ int set_fpexc_mode(struct task_struct *tsk, unsigned int val)
|
|
|
#ifdef CONFIG_SPE
|
|
|
tsk->thread.fpexc_mode = val &
|
|
|
(PR_FP_EXC_SW_ENABLE | PR_FP_ALL_EXCEPT);
|
|
|
+ return 0;
|
|
|
#else
|
|
|
return -EINVAL;
|
|
|
#endif
|
|
|
- } else {
|
|
|
- /* on a CONFIG_SPE this does not hurt us. The bits that
|
|
|
- * __pack_fe01 use do not overlap with bits used for
|
|
|
- * PR_FP_EXC_SW_ENABLE. Additionally, the MSR[FE0,FE1] bits
|
|
|
- * on CONFIG_SPE implementations are reserved so writing to
|
|
|
- * them does not change anything */
|
|
|
- if (val > PR_FP_EXC_PRECISE)
|
|
|
- return -EINVAL;
|
|
|
- tsk->thread.fpexc_mode = __pack_fe01(val);
|
|
|
- if (regs != NULL && (regs->msr & MSR_FP) != 0)
|
|
|
- regs->msr = (regs->msr & ~(MSR_FE0|MSR_FE1))
|
|
|
- | tsk->thread.fpexc_mode;
|
|
|
}
|
|
|
+
|
|
|
+ /* on a CONFIG_SPE this does not hurt us. The bits that
|
|
|
+ * __pack_fe01 use do not overlap with bits used for
|
|
|
+ * PR_FP_EXC_SW_ENABLE. Additionally, the MSR[FE0,FE1] bits
|
|
|
+ * on CONFIG_SPE implementations are reserved so writing to
|
|
|
+ * them does not change anything */
|
|
|
+ if (val > PR_FP_EXC_PRECISE)
|
|
|
+ return -EINVAL;
|
|
|
+ tsk->thread.fpexc_mode = __pack_fe01(val);
|
|
|
+ if (regs != NULL && (regs->msr & MSR_FP) != 0)
|
|
|
+ regs->msr = (regs->msr & ~(MSR_FE0|MSR_FE1))
|
|
|
+ | tsk->thread.fpexc_mode;
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -566,6 +727,8 @@ int get_fpexc_mode(struct task_struct *tsk, unsigned long adr)
|
|
|
return put_user(val, (unsigned int __user *) adr);
|
|
|
}
|
|
|
|
|
|
+#define TRUNC_PTR(x) ((typeof(x))(((unsigned long)(x)) & 0xffffffff))
|
|
|
+
|
|
|
int sys_clone(unsigned long clone_flags, unsigned long usp,
|
|
|
int __user *parent_tidp, void __user *child_threadptr,
|
|
|
int __user *child_tidp, int p6,
|
|
@@ -574,6 +737,12 @@ int sys_clone(unsigned long clone_flags, unsigned long usp,
|
|
|
CHECK_FULL_REGS(regs);
|
|
|
if (usp == 0)
|
|
|
usp = regs->gpr[1]; /* stack pointer for child */
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+ if (test_thread_flag(TIF_32BIT)) {
|
|
|
+ parent_tidp = TRUNC_PTR(parent_tidp);
|
|
|
+ child_tidp = TRUNC_PTR(child_tidp);
|
|
|
+ }
|
|
|
+#endif
|
|
|
return do_fork(clone_flags, usp, regs, 0, parent_tidp, child_tidp);
|
|
|
}
|
|
|
|
|
@@ -599,7 +768,7 @@ int sys_execve(unsigned long a0, unsigned long a1, unsigned long a2,
|
|
|
struct pt_regs *regs)
|
|
|
{
|
|
|
int error;
|
|
|
- char * filename;
|
|
|
+ char *filename;
|
|
|
|
|
|
filename = getname((char __user *) a0);
|
|
|
error = PTR_ERR(filename);
|
|
@@ -644,67 +813,19 @@ static int validate_sp(unsigned long sp, struct task_struct *p,
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-void dump_stack(void)
|
|
|
-{
|
|
|
- show_stack(current, NULL);
|
|
|
-}
|
|
|
-
|
|
|
-EXPORT_SYMBOL(dump_stack);
|
|
|
-
|
|
|
-void show_stack(struct task_struct *tsk, unsigned long *stack)
|
|
|
-{
|
|
|
- unsigned long sp, stack_top, prev_sp, ret;
|
|
|
- int count = 0;
|
|
|
- unsigned long next_exc = 0;
|
|
|
- struct pt_regs *regs;
|
|
|
- extern char ret_from_except, ret_from_except_full, ret_from_syscall;
|
|
|
-
|
|
|
- sp = (unsigned long) stack;
|
|
|
- if (tsk == NULL)
|
|
|
- tsk = current;
|
|
|
- if (sp == 0) {
|
|
|
- if (tsk == current)
|
|
|
- asm("mr %0,1" : "=r" (sp));
|
|
|
- else
|
|
|
- sp = tsk->thread.ksp;
|
|
|
- }
|
|
|
-
|
|
|
- prev_sp = (unsigned long) (tsk->thread_info + 1);
|
|
|
- stack_top = (unsigned long) tsk->thread_info + THREAD_SIZE;
|
|
|
- while (count < 16 && sp > prev_sp && sp < stack_top && (sp & 3) == 0) {
|
|
|
- if (count == 0) {
|
|
|
- printk("Call trace:");
|
|
|
-#ifdef CONFIG_KALLSYMS
|
|
|
- printk("\n");
|
|
|
-#endif
|
|
|
- } else {
|
|
|
- if (next_exc) {
|
|
|
- ret = next_exc;
|
|
|
- next_exc = 0;
|
|
|
- } else
|
|
|
- ret = *(unsigned long *)(sp + 4);
|
|
|
- printk(" [%08lx] ", ret);
|
|
|
-#ifdef CONFIG_KALLSYMS
|
|
|
- print_symbol("%s", ret);
|
|
|
- printk("\n");
|
|
|
-#endif
|
|
|
- if (ret == (unsigned long) &ret_from_except
|
|
|
- || ret == (unsigned long) &ret_from_except_full
|
|
|
- || ret == (unsigned long) &ret_from_syscall) {
|
|
|
- /* sp + 16 points to an exception frame */
|
|
|
- regs = (struct pt_regs *) (sp + 16);
|
|
|
- if (sp + 16 + sizeof(*regs) <= stack_top)
|
|
|
- next_exc = regs->nip;
|
|
|
- }
|
|
|
- }
|
|
|
- ++count;
|
|
|
- sp = *(unsigned long *)sp;
|
|
|
- }
|
|
|
-#ifndef CONFIG_KALLSYMS
|
|
|
- if (count > 0)
|
|
|
- printk("\n");
|
|
|
+#ifdef CONFIG_PPC64
|
|
|
+#define MIN_STACK_FRAME 112 /* same as STACK_FRAME_OVERHEAD, in fact */
|
|
|
+#define FRAME_LR_SAVE 2
|
|
|
+#define INT_FRAME_SIZE (sizeof(struct pt_regs) + STACK_FRAME_OVERHEAD + 288)
|
|
|
+#define REGS_MARKER 0x7265677368657265ul
|
|
|
+#define FRAME_MARKER 12
|
|
|
+#else
|
|
|
+#define MIN_STACK_FRAME 16
|
|
|
+#define FRAME_LR_SAVE 1
|
|
|
+#define INT_FRAME_SIZE (sizeof(struct pt_regs) + STACK_FRAME_OVERHEAD)
|
|
|
+#define REGS_MARKER 0x72656773ul
|
|
|
+#define FRAME_MARKER 2
|
|
|
#endif
|
|
|
-}
|
|
|
|
|
|
unsigned long get_wchan(struct task_struct *p)
|
|
|
{
|
|
@@ -715,15 +836,15 @@ unsigned long get_wchan(struct task_struct *p)
|
|
|
return 0;
|
|
|
|
|
|
sp = p->thread.ksp;
|
|
|
- if (!validate_sp(sp, p, 16))
|
|
|
+ if (!validate_sp(sp, p, MIN_STACK_FRAME))
|
|
|
return 0;
|
|
|
|
|
|
do {
|
|
|
sp = *(unsigned long *)sp;
|
|
|
- if (!validate_sp(sp, p, 16))
|
|
|
+ if (!validate_sp(sp, p, MIN_STACK_FRAME))
|
|
|
return 0;
|
|
|
if (count > 0) {
|
|
|
- ip = *(unsigned long *)(sp + 4);
|
|
|
+ ip = ((unsigned long *)sp)[FRAME_LR_SAVE];
|
|
|
if (!in_sched_functions(ip))
|
|
|
return ip;
|
|
|
}
|
|
@@ -731,3 +852,64 @@ unsigned long get_wchan(struct task_struct *p)
|
|
|
return 0;
|
|
|
}
|
|
|
EXPORT_SYMBOL(get_wchan);
|
|
|
+
|
|
|
+static int kstack_depth_to_print = 64;
|
|
|
+
|
|
|
+void show_stack(struct task_struct *tsk, unsigned long *stack)
|
|
|
+{
|
|
|
+ unsigned long sp, ip, lr, newsp;
|
|
|
+ int count = 0;
|
|
|
+ int firstframe = 1;
|
|
|
+
|
|
|
+ sp = (unsigned long) stack;
|
|
|
+ if (tsk == NULL)
|
|
|
+ tsk = current;
|
|
|
+ if (sp == 0) {
|
|
|
+ if (tsk == current)
|
|
|
+ asm("mr %0,1" : "=r" (sp));
|
|
|
+ else
|
|
|
+ sp = tsk->thread.ksp;
|
|
|
+ }
|
|
|
+
|
|
|
+ lr = 0;
|
|
|
+ printk("Call Trace:\n");
|
|
|
+ do {
|
|
|
+ if (!validate_sp(sp, tsk, MIN_STACK_FRAME))
|
|
|
+ return;
|
|
|
+
|
|
|
+ stack = (unsigned long *) sp;
|
|
|
+ newsp = stack[0];
|
|
|
+ ip = stack[FRAME_LR_SAVE];
|
|
|
+ if (!firstframe || ip != lr) {
|
|
|
+ printk("["REG"] ["REG"] ", sp, ip);
|
|
|
+ print_symbol("%s", ip);
|
|
|
+ if (firstframe)
|
|
|
+ printk(" (unreliable)");
|
|
|
+ printk("\n");
|
|
|
+ }
|
|
|
+ firstframe = 0;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * See if this is an exception frame.
|
|
|
+ * We look for the "regshere" marker in the current frame.
|
|
|
+ */
|
|
|
+ if (validate_sp(sp, tsk, INT_FRAME_SIZE)
|
|
|
+ && stack[FRAME_MARKER] == REGS_MARKER) {
|
|
|
+ struct pt_regs *regs = (struct pt_regs *)
|
|
|
+ (sp + STACK_FRAME_OVERHEAD);
|
|
|
+ printk("--- Exception: %lx", regs->trap);
|
|
|
+ print_symbol(" at %s\n", regs->nip);
|
|
|
+ lr = regs->link;
|
|
|
+ print_symbol(" LR = %s\n", lr);
|
|
|
+ firstframe = 1;
|
|
|
+ }
|
|
|
+
|
|
|
+ sp = newsp;
|
|
|
+ } while (count++ < kstack_depth_to_print);
|
|
|
+}
|
|
|
+
|
|
|
+void dump_stack(void)
|
|
|
+{
|
|
|
+ show_stack(current, NULL);
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(dump_stack);
|