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