1 /*
2  * Copyright (C) 2004 PathScale, Inc
3  * Copyright (C) 2004 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
4  * Licensed under the GPL
5  */
6 
7 #include <errno.h>
8 #include <sys/ptrace.h>
9 #ifdef __i386__
10 #include <sys/user.h>
11 #endif
12 #include "longjmp.h"
13 #include "sysdep/ptrace_user.h"
14 
save_fp_registers(int pid,unsigned long * fp_regs)15 int save_fp_registers(int pid, unsigned long *fp_regs)
16 {
17 	if (ptrace(PTRACE_GETFPREGS, pid, 0, fp_regs) < 0)
18 		return -errno;
19 	return 0;
20 }
21 
restore_fp_registers(int pid,unsigned long * fp_regs)22 int restore_fp_registers(int pid, unsigned long *fp_regs)
23 {
24 	if (ptrace(PTRACE_SETFPREGS, pid, 0, fp_regs) < 0)
25 		return -errno;
26 	return 0;
27 }
28 
29 #ifdef __i386__
30 int have_fpx_regs = 1;
save_fpx_registers(int pid,unsigned long * fp_regs)31 int save_fpx_registers(int pid, unsigned long *fp_regs)
32 {
33 	if (ptrace(PTRACE_GETFPXREGS, pid, 0, fp_regs) < 0)
34 		return -errno;
35 	return 0;
36 }
37 
restore_fpx_registers(int pid,unsigned long * fp_regs)38 int restore_fpx_registers(int pid, unsigned long *fp_regs)
39 {
40 	if (ptrace(PTRACE_SETFPXREGS, pid, 0, fp_regs) < 0)
41 		return -errno;
42 	return 0;
43 }
44 
get_fp_registers(int pid,unsigned long * regs)45 int get_fp_registers(int pid, unsigned long *regs)
46 {
47 	if (have_fpx_regs)
48 		return save_fpx_registers(pid, regs);
49 	else
50 		return save_fp_registers(pid, regs);
51 }
52 
put_fp_registers(int pid,unsigned long * regs)53 int put_fp_registers(int pid, unsigned long *regs)
54 {
55 	if (have_fpx_regs)
56 		return restore_fpx_registers(pid, regs);
57 	else
58 		return restore_fp_registers(pid, regs);
59 }
60 
arch_init_registers(int pid)61 void arch_init_registers(int pid)
62 {
63 	struct user_fpxregs_struct fpx_regs;
64 	int err;
65 
66 	err = ptrace(PTRACE_GETFPXREGS, pid, 0, &fpx_regs);
67 	if (!err)
68 		return;
69 
70 	if (errno != EIO)
71 		panic("check_ptrace : PTRACE_GETFPXREGS failed, errno = %d",
72 		      errno);
73 
74 	have_fpx_regs = 0;
75 }
76 #else
77 
get_fp_registers(int pid,unsigned long * regs)78 int get_fp_registers(int pid, unsigned long *regs)
79 {
80 	return save_fp_registers(pid, regs);
81 }
82 
put_fp_registers(int pid,unsigned long * regs)83 int put_fp_registers(int pid, unsigned long *regs)
84 {
85 	return restore_fp_registers(pid, regs);
86 }
87 
88 #endif
89 
get_thread_reg(int reg,jmp_buf * buf)90 unsigned long get_thread_reg(int reg, jmp_buf *buf)
91 {
92 	switch (reg) {
93 #ifdef __i386__
94 	case HOST_IP:
95 		return buf[0]->__eip;
96 	case HOST_SP:
97 		return buf[0]->__esp;
98 	case HOST_BP:
99 		return buf[0]->__ebp;
100 #else
101 	case HOST_IP:
102 		return buf[0]->__rip;
103 	case HOST_SP:
104 		return buf[0]->__rsp;
105 	case HOST_BP:
106 		return buf[0]->__rbp;
107 #endif
108 	default:
109 		printk(UM_KERN_ERR "get_thread_regs - unknown register %d\n",
110 		       reg);
111 		return 0;
112 	}
113 }
114