dump_stack: unify debug information printed by show_regs()
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / sparc / kernel / process_64.c
CommitLineData
5526b7e4 1/* arch/sparc64/kernel/process.c
1da177e4 2 *
93dae5b7 3 * Copyright (C) 1995, 1996, 2008 David S. Miller (davem@davemloft.net)
1da177e4
LT
4 * Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be)
5 * Copyright (C) 1997, 1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
6 */
7
8/*
9 * This file handles the architecture-dependent parts of process handling..
10 */
11
12#include <stdarg.h>
13
1da177e4 14#include <linux/errno.h>
066bcaca 15#include <linux/export.h>
1da177e4
LT
16#include <linux/sched.h>
17#include <linux/kernel.h>
1da177e4 18#include <linux/mm.h>
4e950f6f 19#include <linux/fs.h>
1da177e4 20#include <linux/smp.h>
1da177e4
LT
21#include <linux/stddef.h>
22#include <linux/ptrace.h>
23#include <linux/slab.h>
24#include <linux/user.h>
1da177e4
LT
25#include <linux/delay.h>
26#include <linux/compat.h>
038cb01e 27#include <linux/tick.h>
1da177e4 28#include <linux/init.h>
e0204409 29#include <linux/cpu.h>
916ca14a 30#include <linux/perf_event.h>
b1422401 31#include <linux/elfcore.h>
93dae5b7 32#include <linux/sysrq.h>
802c64b3 33#include <linux/nmi.h>
1da177e4 34
1da177e4 35#include <asm/uaccess.h>
1da177e4
LT
36#include <asm/page.h>
37#include <asm/pgalloc.h>
38#include <asm/pgtable.h>
39#include <asm/processor.h>
40#include <asm/pstate.h>
41#include <asm/elf.h>
42#include <asm/fpumacro.h>
43#include <asm/head.h>
44#include <asm/cpudata.h>
74bf4312 45#include <asm/mmu_context.h>
1da177e4 46#include <asm/unistd.h>
30c91d57 47#include <asm/hypervisor.h>
b1422401 48#include <asm/syscalls.h>
93dae5b7
DM
49#include <asm/irq_regs.h>
50#include <asm/smp.h>
916ca14a 51#include <asm/pcr.h>
1da177e4 52
4f70f7a9
DM
53#include "kstack.h"
54
87fa05ae
SR
55/* Idle loop support on sparc64. */
56void arch_cpu_idle(void)
1da177e4 57{
802c64b3
DM
58 if (tlb_type != hypervisor) {
59 touch_nmi_watchdog();
87fa05ae 60 } else {
30c91d57
DM
61 unsigned long pstate;
62
87fa05ae
SR
63 /* The sun4v sleeping code requires that we have PSTATE.IE cleared over
64 * the cpu sleep hypervisor call.
65 */
30c91d57
DM
66 __asm__ __volatile__(
67 "rdpr %%pstate, %0\n\t"
68 "andn %0, %1, %0\n\t"
69 "wrpr %0, %%g0, %%pstate"
70 : "=&r" (pstate)
71 : "i" (PSTATE_IE));
72
87fa05ae 73 if (!need_resched() && !cpu_is_offline(smp_processor_id()))
30c91d57
DM
74 sun4v_cpu_yield();
75
76 /* Re-enable interrupts. */
77 __asm__ __volatile__(
78 "rdpr %%pstate, %0\n\t"
79 "or %0, %1, %0\n\t"
80 "wrpr %0, %%g0, %%pstate"
81 : "=&r" (pstate)
82 : "i" (PSTATE_IE));
1da177e4 83 }
87fa05ae 84 local_irq_enable();
30c91d57 85}
1da177e4 86
e0204409 87#ifdef CONFIG_HOTPLUG_CPU
87fa05ae
SR
88void arch_cpu_idle_dead()
89{
90 sched_preempt_enable_no_resched();
91 cpu_play_dead();
1da177e4 92}
87fa05ae 93#endif
1da177e4 94
959a85ad 95#ifdef CONFIG_COMPAT
1da177e4
LT
96static void show_regwindow32(struct pt_regs *regs)
97{
98 struct reg_window32 __user *rw;
99 struct reg_window32 r_w;
100 mm_segment_t old_fs;
101
102 __asm__ __volatile__ ("flushw");
103 rw = compat_ptr((unsigned)regs->u_regs[14]);
104 old_fs = get_fs();
105 set_fs (USER_DS);
106 if (copy_from_user (&r_w, rw, sizeof(r_w))) {
107 set_fs (old_fs);
108 return;
109 }
110
111 set_fs (old_fs);
112 printk("l0: %08x l1: %08x l2: %08x l3: %08x "
113 "l4: %08x l5: %08x l6: %08x l7: %08x\n",
114 r_w.locals[0], r_w.locals[1], r_w.locals[2], r_w.locals[3],
115 r_w.locals[4], r_w.locals[5], r_w.locals[6], r_w.locals[7]);
116 printk("i0: %08x i1: %08x i2: %08x i3: %08x "
117 "i4: %08x i5: %08x i6: %08x i7: %08x\n",
118 r_w.ins[0], r_w.ins[1], r_w.ins[2], r_w.ins[3],
119 r_w.ins[4], r_w.ins[5], r_w.ins[6], r_w.ins[7]);
120}
959a85ad
DM
121#else
122#define show_regwindow32(regs) do { } while (0)
123#endif
1da177e4
LT
124
125static void show_regwindow(struct pt_regs *regs)
126{
127 struct reg_window __user *rw;
128 struct reg_window *rwk;
129 struct reg_window r_w;
130 mm_segment_t old_fs;
131
132 if ((regs->tstate & TSTATE_PRIV) || !(test_thread_flag(TIF_32BIT))) {
133 __asm__ __volatile__ ("flushw");
134 rw = (struct reg_window __user *)
135 (regs->u_regs[14] + STACK_BIAS);
136 rwk = (struct reg_window *)
137 (regs->u_regs[14] + STACK_BIAS);
138 if (!(regs->tstate & TSTATE_PRIV)) {
139 old_fs = get_fs();
140 set_fs (USER_DS);
141 if (copy_from_user (&r_w, rw, sizeof(r_w))) {
142 set_fs (old_fs);
143 return;
144 }
145 rwk = &r_w;
146 set_fs (old_fs);
147 }
148 } else {
149 show_regwindow32(regs);
150 return;
151 }
152 printk("l0: %016lx l1: %016lx l2: %016lx l3: %016lx\n",
153 rwk->locals[0], rwk->locals[1], rwk->locals[2], rwk->locals[3]);
154 printk("l4: %016lx l5: %016lx l6: %016lx l7: %016lx\n",
155 rwk->locals[4], rwk->locals[5], rwk->locals[6], rwk->locals[7]);
156 printk("i0: %016lx i1: %016lx i2: %016lx i3: %016lx\n",
157 rwk->ins[0], rwk->ins[1], rwk->ins[2], rwk->ins[3]);
158 printk("i4: %016lx i5: %016lx i6: %016lx i7: %016lx\n",
159 rwk->ins[4], rwk->ins[5], rwk->ins[6], rwk->ins[7]);
160 if (regs->tstate & TSTATE_PRIV)
4fe3ebec 161 printk("I7: <%pS>\n", (void *) rwk->ins[7]);
1da177e4
LT
162}
163
dbf3e950 164void show_regs(struct pt_regs *regs)
1da177e4 165{
a43cb95d
TH
166 show_regs_print_info(KERN_DEFAULT);
167
1da177e4
LT
168 printk("TSTATE: %016lx TPC: %016lx TNPC: %016lx Y: %08x %s\n", regs->tstate,
169 regs->tpc, regs->tnpc, regs->y, print_tainted());
4fe3ebec 170 printk("TPC: <%pS>\n", (void *) regs->tpc);
1da177e4
LT
171 printk("g0: %016lx g1: %016lx g2: %016lx g3: %016lx\n",
172 regs->u_regs[0], regs->u_regs[1], regs->u_regs[2],
173 regs->u_regs[3]);
174 printk("g4: %016lx g5: %016lx g6: %016lx g7: %016lx\n",
175 regs->u_regs[4], regs->u_regs[5], regs->u_regs[6],
176 regs->u_regs[7]);
177 printk("o0: %016lx o1: %016lx o2: %016lx o3: %016lx\n",
178 regs->u_regs[8], regs->u_regs[9], regs->u_regs[10],
179 regs->u_regs[11]);
180 printk("o4: %016lx o5: %016lx sp: %016lx ret_pc: %016lx\n",
181 regs->u_regs[12], regs->u_regs[13], regs->u_regs[14],
182 regs->u_regs[15]);
4fe3ebec 183 printk("RPC: <%pS>\n", (void *) regs->u_regs[15]);
1da177e4 184 show_regwindow(regs);
87e8f0e3 185 show_stack(current, (unsigned long *) regs->u_regs[UREG_FP]);
1da177e4
LT
186}
187
916ca14a
DM
188union global_cpu_snapshot global_cpu_snapshot[NR_CPUS];
189static DEFINE_SPINLOCK(global_cpu_snapshot_lock);
93dae5b7
DM
190
191static void __global_reg_self(struct thread_info *tp, struct pt_regs *regs,
192 int this_cpu)
193{
916ca14a
DM
194 struct global_reg_snapshot *rp;
195
93dae5b7
DM
196 flushw_all();
197
916ca14a
DM
198 rp = &global_cpu_snapshot[this_cpu].reg;
199
200 rp->tstate = regs->tstate;
201 rp->tpc = regs->tpc;
202 rp->tnpc = regs->tnpc;
203 rp->o7 = regs->u_regs[UREG_I7];
93dae5b7
DM
204
205 if (regs->tstate & TSTATE_PRIV) {
206 struct reg_window *rw;
207
208 rw = (struct reg_window *)
209 (regs->u_regs[UREG_FP] + STACK_BIAS);
4f70f7a9 210 if (kstack_valid(tp, (unsigned long) rw)) {
916ca14a 211 rp->i7 = rw->ins[7];
5afe2738
DM
212 rw = (struct reg_window *)
213 (rw->ins[6] + STACK_BIAS);
4f70f7a9 214 if (kstack_valid(tp, (unsigned long) rw))
916ca14a 215 rp->rpc = rw->ins[7];
5afe2738
DM
216 }
217 } else {
916ca14a
DM
218 rp->i7 = 0;
219 rp->rpc = 0;
5afe2738 220 }
916ca14a 221 rp->thread = tp;
93dae5b7
DM
222}
223
224/* In order to avoid hangs we do not try to synchronize with the
225 * global register dump client cpus. The last store they make is to
226 * the thread pointer, so do a short poll waiting for that to become
227 * non-NULL.
228 */
229static void __global_reg_poll(struct global_reg_snapshot *gp)
230{
231 int limit = 0;
232
233 while (!gp->thread && ++limit < 100) {
234 barrier();
235 udelay(1);
236 }
237}
238
47cab6a7 239void arch_trigger_all_cpu_backtrace(void)
93dae5b7
DM
240{
241 struct thread_info *tp = current_thread_info();
242 struct pt_regs *regs = get_irq_regs();
93dae5b7
DM
243 unsigned long flags;
244 int this_cpu, cpu;
245
246 if (!regs)
247 regs = tp->kregs;
248
916ca14a 249 spin_lock_irqsave(&global_cpu_snapshot_lock, flags);
93dae5b7 250
916ca14a 251 memset(global_cpu_snapshot, 0, sizeof(global_cpu_snapshot));
93dae5b7
DM
252
253 this_cpu = raw_smp_processor_id();
254
255 __global_reg_self(tp, regs, this_cpu);
256
257 smp_fetch_global_regs();
258
259 for_each_online_cpu(cpu) {
916ca14a 260 struct global_reg_snapshot *gp = &global_cpu_snapshot[cpu].reg;
93dae5b7
DM
261
262 __global_reg_poll(gp);
263
264 tp = gp->thread;
265 printk("%c CPU[%3d]: TSTATE[%016lx] TPC[%016lx] TNPC[%016lx] TASK[%s:%d]\n",
266 (cpu == this_cpu ? '*' : ' '), cpu,
267 gp->tstate, gp->tpc, gp->tnpc,
268 ((tp && tp->task) ? tp->task->comm : "NULL"),
269 ((tp && tp->task) ? tp->task->pid : -1));
4fe3ebec 270
93dae5b7 271 if (gp->tstate & TSTATE_PRIV) {
5afe2738 272 printk(" TPC[%pS] O7[%pS] I7[%pS] RPC[%pS]\n",
4fe3ebec
DM
273 (void *) gp->tpc,
274 (void *) gp->o7,
5afe2738
DM
275 (void *) gp->i7,
276 (void *) gp->rpc);
4fe3ebec 277 } else {
5afe2738
DM
278 printk(" TPC[%lx] O7[%lx] I7[%lx] RPC[%lx]\n",
279 gp->tpc, gp->o7, gp->i7, gp->rpc);
93dae5b7
DM
280 }
281 }
282
916ca14a 283 memset(global_cpu_snapshot, 0, sizeof(global_cpu_snapshot));
93dae5b7 284
916ca14a 285 spin_unlock_irqrestore(&global_cpu_snapshot_lock, flags);
93dae5b7
DM
286}
287
09ee167c
DM
288#ifdef CONFIG_MAGIC_SYSRQ
289
1495cc9d 290static void sysrq_handle_globreg(int key)
09ee167c 291{
47cab6a7 292 arch_trigger_all_cpu_backtrace();
09ee167c
DM
293}
294
93dae5b7
DM
295static struct sysrq_key_op sparc_globalreg_op = {
296 .handler = sysrq_handle_globreg,
916ca14a 297 .help_msg = "global-regs(Y)",
93dae5b7
DM
298 .action_msg = "Show Global CPU Regs",
299};
300
916ca14a 301static void __global_pmu_self(int this_cpu)
93dae5b7 302{
916ca14a
DM
303 struct global_pmu_snapshot *pp;
304 int i, num;
305
306 pp = &global_cpu_snapshot[this_cpu].pmu;
307
308 num = 1;
309 if (tlb_type == hypervisor &&
310 sun4v_chip_type >= SUN4V_CHIP_NIAGARA4)
311 num = 4;
312
313 for (i = 0; i < num; i++) {
314 pp->pcr[i] = pcr_ops->read_pcr(i);
315 pp->pic[i] = pcr_ops->read_pic(i);
316 }
93dae5b7
DM
317}
318
916ca14a
DM
319static void __global_pmu_poll(struct global_pmu_snapshot *pp)
320{
321 int limit = 0;
322
323 while (!pp->pcr[0] && ++limit < 100) {
324 barrier();
325 udelay(1);
326 }
327}
328
329static void pmu_snapshot_all_cpus(void)
93dae5b7 330{
916ca14a
DM
331 unsigned long flags;
332 int this_cpu, cpu;
333
334 spin_lock_irqsave(&global_cpu_snapshot_lock, flags);
335
336 memset(global_cpu_snapshot, 0, sizeof(global_cpu_snapshot));
337
338 this_cpu = raw_smp_processor_id();
339
340 __global_pmu_self(this_cpu);
341
342 smp_fetch_global_pmu();
343
344 for_each_online_cpu(cpu) {
345 struct global_pmu_snapshot *pp = &global_cpu_snapshot[cpu].pmu;
346
347 __global_pmu_poll(pp);
348
349 printk("%c CPU[%3d]: PCR[%08lx:%08lx:%08lx:%08lx] PIC[%08lx:%08lx:%08lx:%08lx]\n",
350 (cpu == this_cpu ? '*' : ' '), cpu,
351 pp->pcr[0], pp->pcr[1], pp->pcr[2], pp->pcr[3],
352 pp->pic[0], pp->pic[1], pp->pic[2], pp->pic[3]);
353 }
354
355 memset(global_cpu_snapshot, 0, sizeof(global_cpu_snapshot));
356
357 spin_unlock_irqrestore(&global_cpu_snapshot_lock, flags);
358}
359
360static void sysrq_handle_globpmu(int key)
361{
362 pmu_snapshot_all_cpus();
363}
364
365static struct sysrq_key_op sparc_globalpmu_op = {
366 .handler = sysrq_handle_globpmu,
367 .help_msg = "global-pmu(X)",
368 .action_msg = "Show Global PMU Regs",
369};
370
371static int __init sparc_sysrq_init(void)
372{
373 int ret = register_sysrq_key('y', &sparc_globalreg_op);
374
375 if (!ret)
376 ret = register_sysrq_key('x', &sparc_globalpmu_op);
377 return ret;
93dae5b7
DM
378}
379
916ca14a 380core_initcall(sparc_sysrq_init);
93dae5b7
DM
381
382#endif
383
1da177e4
LT
384unsigned long thread_saved_pc(struct task_struct *tsk)
385{
f3169641 386 struct thread_info *ti = task_thread_info(tsk);
1da177e4
LT
387 unsigned long ret = 0xdeadbeefUL;
388
389 if (ti && ti->ksp) {
390 unsigned long *sp;
391 sp = (unsigned long *)(ti->ksp + STACK_BIAS);
392 if (((unsigned long)sp & (sizeof(long) - 1)) == 0UL &&
393 sp[14]) {
394 unsigned long *fp;
395 fp = (unsigned long *)(sp[14] + STACK_BIAS);
396 if (((unsigned long)fp & (sizeof(long) - 1)) == 0UL)
397 ret = fp[15];
398 }
399 }
400 return ret;
401}
402
403/* Free current thread data structures etc.. */
404void exit_thread(void)
405{
406 struct thread_info *t = current_thread_info();
407
408 if (t->utraps) {
409 if (t->utraps[0] < 2)
410 kfree (t->utraps);
411 else
412 t->utraps[0]--;
413 }
1da177e4
LT
414}
415
416void flush_thread(void)
417{
418 struct thread_info *t = current_thread_info();
74bf4312 419 struct mm_struct *mm;
1da177e4 420
74bf4312
DM
421 mm = t->task->mm;
422 if (mm)
98c5584c 423 tsb_context_switch(mm);
1da177e4 424
1da177e4
LT
425 set_thread_wsaved(0);
426
1da177e4
LT
427 /* Clear FPU register state. */
428 t->fpsaved[0] = 0;
1da177e4
LT
429}
430
431/* It's a bit more tricky when 64-bit tasks are involved... */
432static unsigned long clone_stackframe(unsigned long csp, unsigned long psp)
433{
517ffce4 434 bool stack_64bit = test_thread_64bit_stack(psp);
1da177e4
LT
435 unsigned long fp, distance, rval;
436
517ffce4 437 if (stack_64bit) {
1da177e4
LT
438 csp += STACK_BIAS;
439 psp += STACK_BIAS;
440 __get_user(fp, &(((struct reg_window __user *)psp)->ins[6]));
441 fp += STACK_BIAS;
517ffce4
DM
442 if (test_thread_flag(TIF_32BIT))
443 fp &= 0xffffffff;
1da177e4
LT
444 } else
445 __get_user(fp, &(((struct reg_window32 __user *)psp)->ins[6]));
446
f036d9f3
DM
447 /* Now align the stack as this is mandatory in the Sparc ABI
448 * due to how register windows work. This hides the
449 * restriction from thread libraries etc.
1da177e4 450 */
f036d9f3 451 csp &= ~15UL;
1da177e4
LT
452
453 distance = fp - psp;
454 rval = (csp - distance);
455 if (copy_in_user((void __user *) rval, (void __user *) psp, distance))
456 rval = 0;
517ffce4 457 else if (!stack_64bit) {
1da177e4
LT
458 if (put_user(((u32)csp),
459 &(((struct reg_window32 __user *)rval)->ins[6])))
460 rval = 0;
461 } else {
462 if (put_user(((u64)csp - STACK_BIAS),
463 &(((struct reg_window __user *)rval)->ins[6])))
464 rval = 0;
465 else
466 rval = rval - STACK_BIAS;
467 }
468
469 return rval;
470}
471
472/* Standard stuff. */
473static inline void shift_window_buffer(int first_win, int last_win,
474 struct thread_info *t)
475{
476 int i;
477
478 for (i = first_win; i < last_win; i++) {
479 t->rwbuf_stkptrs[i] = t->rwbuf_stkptrs[i+1];
480 memcpy(&t->reg_window[i], &t->reg_window[i+1],
481 sizeof(struct reg_window));
482 }
483}
484
485void synchronize_user_stack(void)
486{
487 struct thread_info *t = current_thread_info();
488 unsigned long window;
489
490 flush_user_windows();
491 if ((window = get_thread_wsaved()) != 0) {
1da177e4
LT
492 window -= 1;
493 do {
1da177e4 494 struct reg_window *rwin = &t->reg_window[window];
517ffce4
DM
495 int winsize = sizeof(struct reg_window);
496 unsigned long sp;
497
498 sp = t->rwbuf_stkptrs[window];
499
500 if (test_thread_64bit_stack(sp))
501 sp += STACK_BIAS;
502 else
503 winsize = sizeof(struct reg_window32);
1da177e4
LT
504
505 if (!copy_to_user((char __user *)sp, rwin, winsize)) {
506 shift_window_buffer(window, get_thread_wsaved() - 1, t);
507 set_thread_wsaved(get_thread_wsaved() - 1);
508 }
509 } while (window--);
510 }
511}
512
314ef685
DM
513static void stack_unaligned(unsigned long sp)
514{
515 siginfo_t info;
516
517 info.si_signo = SIGBUS;
518 info.si_errno = 0;
519 info.si_code = BUS_ADRALN;
520 info.si_addr = (void __user *) sp;
521 info.si_trapno = 0;
522 force_sig_info(SIGBUS, &info, current);
523}
524
1da177e4
LT
525void fault_in_user_windows(void)
526{
527 struct thread_info *t = current_thread_info();
528 unsigned long window;
1da177e4
LT
529
530 flush_user_windows();
531 window = get_thread_wsaved();
532
314ef685 533 if (likely(window != 0)) {
1da177e4
LT
534 window -= 1;
535 do {
1da177e4 536 struct reg_window *rwin = &t->reg_window[window];
517ffce4
DM
537 int winsize = sizeof(struct reg_window);
538 unsigned long sp;
539
540 sp = t->rwbuf_stkptrs[window];
541
542 if (test_thread_64bit_stack(sp))
543 sp += STACK_BIAS;
544 else
545 winsize = sizeof(struct reg_window32);
1da177e4 546
314ef685
DM
547 if (unlikely(sp & 0x7UL))
548 stack_unaligned(sp);
549
550 if (unlikely(copy_to_user((char __user *)sp,
551 rwin, winsize)))
1da177e4
LT
552 goto barf;
553 } while (window--);
554 }
555 set_thread_wsaved(0);
556 return;
557
558barf:
559 set_thread_wsaved(window + 1);
560 do_exit(SIGILL);
561}
562
563asmlinkage long sparc_do_fork(unsigned long clone_flags,
564 unsigned long stack_start,
565 struct pt_regs *regs,
566 unsigned long stack_size)
567{
568 int __user *parent_tid_ptr, *child_tid_ptr;
1e38c126
DM
569 unsigned long orig_i1 = regs->u_regs[UREG_I1];
570 long ret;
1da177e4
LT
571
572#ifdef CONFIG_COMPAT
573 if (test_thread_flag(TIF_32BIT)) {
574 parent_tid_ptr = compat_ptr(regs->u_regs[UREG_I2]);
575 child_tid_ptr = compat_ptr(regs->u_regs[UREG_I4]);
576 } else
577#endif
578 {
579 parent_tid_ptr = (int __user *) regs->u_regs[UREG_I2];
580 child_tid_ptr = (int __user *) regs->u_regs[UREG_I4];
581 }
582
e80d6661 583 ret = do_fork(clone_flags, stack_start, stack_size,
1e38c126
DM
584 parent_tid_ptr, child_tid_ptr);
585
586 /* If we get an error and potentially restart the system
587 * call, we're screwed because copy_thread() clobbered
588 * the parent's %o1. So detect that case and restore it
589 * here.
590 */
591 if ((unsigned long)ret >= -ERESTART_RESTARTBLOCK)
592 regs->u_regs[UREG_I1] = orig_i1;
593
594 return ret;
1da177e4
LT
595}
596
597/* Copy a Sparc thread. The fork() return value conventions
598 * under SunOS are nothing short of bletcherous:
599 * Parent --> %o0 == childs pid, %o1 == 0
600 * Child --> %o0 == parents pid, %o1 == 1
601 */
6f2c55b8 602int copy_thread(unsigned long clone_flags, unsigned long sp,
afa86fc4 603 unsigned long arg, struct task_struct *p)
1da177e4 604{
ee3eea16 605 struct thread_info *t = task_thread_info(p);
afa86fc4 606 struct pt_regs *regs = current_pt_regs();
a051bc5b
DM
607 struct sparc_stackf *parent_sf;
608 unsigned long child_stack_sz;
1da177e4 609 char *child_trap_frame;
1da177e4 610
a051bc5b 611 /* Calculate offset to stack_frame & pt_regs */
1918c7f5 612 child_stack_sz = (STACKFRAME_SZ + TRACEREG_SZ);
a051bc5b
DM
613 child_trap_frame = (task_stack_page(p) +
614 (THREAD_SIZE - child_stack_sz));
a051bc5b 615
db7d9a4e 616 t->new_child = 1;
1da177e4 617 t->ksp = ((unsigned long) child_trap_frame) - STACK_BIAS;
a051bc5b
DM
618 t->kregs = (struct pt_regs *) (child_trap_frame +
619 sizeof(struct sparc_stackf));
1da177e4
LT
620 t->fpsaved[0] = 0;
621
1918c7f5
AV
622 if (unlikely(p->flags & PF_KTHREAD)) {
623 memset(child_trap_frame, 0, child_stack_sz);
624 __thread_flag_byte_ptr(t)[TI_FLAG_BYTE_CWP] =
625 (current_pt_regs()->tstate + 1) & TSTATE_CWP;
dff933da 626 t->current_ds = ASI_P;
1918c7f5
AV
627 t->kregs->u_regs[UREG_G1] = sp; /* function */
628 t->kregs->u_regs[UREG_G2] = arg;
629 return 0;
1da177e4
LT
630 }
631
1918c7f5
AV
632 parent_sf = ((struct sparc_stackf *) regs) - 1;
633 memcpy(child_trap_frame, parent_sf, child_stack_sz);
634 if (t->flags & _TIF_32BIT) {
635 sp &= 0x00000000ffffffffUL;
636 regs->u_regs[UREG_FP] &= 0x00000000ffffffffUL;
637 }
638 t->kregs->u_regs[UREG_FP] = sp;
639 __thread_flag_byte_ptr(t)[TI_FLAG_BYTE_CWP] =
640 (regs->tstate + 1) & TSTATE_CWP;
641 t->current_ds = ASI_AIUS;
642 if (sp != regs->u_regs[UREG_FP]) {
643 unsigned long csp;
644
645 csp = clone_stackframe(sp, regs->u_regs[UREG_FP]);
646 if (!csp)
647 return -EFAULT;
648 t->kregs->u_regs[UREG_FP] = csp;
649 }
650 if (t->utraps)
651 t->utraps[0]++;
652
1da177e4
LT
653 /* Set the return value for the child. */
654 t->kregs->u_regs[UREG_I0] = current->pid;
655 t->kregs->u_regs[UREG_I1] = 1;
656
657 /* Set the second return value for the parent. */
658 regs->u_regs[UREG_I1] = 0;
659
660 if (clone_flags & CLONE_SETTLS)
661 t->kregs->u_regs[UREG_G7] = regs->u_regs[UREG_I3];
662
663 return 0;
664}
665
1da177e4
LT
666typedef struct {
667 union {
668 unsigned int pr_regs[32];
669 unsigned long pr_dregs[16];
670 } pr_fr;
671 unsigned int __unused;
672 unsigned int pr_fsr;
673 unsigned char pr_qcnt;
674 unsigned char pr_q_entrysize;
675 unsigned char pr_en;
676 unsigned int pr_q[64];
677} elf_fpregset_t32;
678
679/*
680 * fill in the fpu structure for a core dump.
681 */
682int dump_fpu (struct pt_regs * regs, elf_fpregset_t * fpregs)
683{
684 unsigned long *kfpregs = current_thread_info()->fpregs;
685 unsigned long fprs = current_thread_info()->fpsaved[0];
686
687 if (test_thread_flag(TIF_32BIT)) {
688 elf_fpregset_t32 *fpregs32 = (elf_fpregset_t32 *)fpregs;
689
690 if (fprs & FPRS_DL)
691 memcpy(&fpregs32->pr_fr.pr_regs[0], kfpregs,
692 sizeof(unsigned int) * 32);
693 else
694 memset(&fpregs32->pr_fr.pr_regs[0], 0,
695 sizeof(unsigned int) * 32);
696 fpregs32->pr_qcnt = 0;
697 fpregs32->pr_q_entrysize = 8;
698 memset(&fpregs32->pr_q[0], 0,
699 (sizeof(unsigned int) * 64));
700 if (fprs & FPRS_FEF) {
701 fpregs32->pr_fsr = (unsigned int) current_thread_info()->xfsr[0];
702 fpregs32->pr_en = 1;
703 } else {
704 fpregs32->pr_fsr = 0;
705 fpregs32->pr_en = 0;
706 }
707 } else {
708 if(fprs & FPRS_DL)
709 memcpy(&fpregs->pr_regs[0], kfpregs,
710 sizeof(unsigned int) * 32);
711 else
712 memset(&fpregs->pr_regs[0], 0,
713 sizeof(unsigned int) * 32);
714 if(fprs & FPRS_DU)
715 memcpy(&fpregs->pr_regs[16], kfpregs+16,
716 sizeof(unsigned int) * 32);
717 else
718 memset(&fpregs->pr_regs[16], 0,
719 sizeof(unsigned int) * 32);
720 if(fprs & FPRS_FEF) {
721 fpregs->pr_fsr = current_thread_info()->xfsr[0];
722 fpregs->pr_gsr = current_thread_info()->gsr[0];
723 } else {
724 fpregs->pr_fsr = fpregs->pr_gsr = 0;
725 }
726 fpregs->pr_fprs = fprs;
727 }
728 return 1;
729}
917c3660 730EXPORT_SYMBOL(dump_fpu);
1da177e4 731
1da177e4
LT
732unsigned long get_wchan(struct task_struct *task)
733{
734 unsigned long pc, fp, bias = 0;
4f70f7a9 735 struct thread_info *tp;
1da177e4
LT
736 struct reg_window *rw;
737 unsigned long ret = 0;
738 int count = 0;
739
740 if (!task || task == current ||
741 task->state == TASK_RUNNING)
742 goto out;
743
4f70f7a9 744 tp = task_thread_info(task);
1da177e4 745 bias = STACK_BIAS;
f3169641 746 fp = task_thread_info(task)->ksp + bias;
1da177e4
LT
747
748 do {
4f70f7a9 749 if (!kstack_valid(tp, fp))
1da177e4
LT
750 break;
751 rw = (struct reg_window *) fp;
752 pc = rw->ins[7];
753 if (!in_sched_functions(pc)) {
754 ret = pc;
755 goto out;
756 }
757 fp = rw->ins[6] + bias;
758 } while (++count < 16);
759
760out:
761 return ret;
762}