1 /* 2 * Copyright (c) 2010 The FreeBSD Foundation 3 * All rights reserved. 4 * 5 * This software was developed by Rui Paulo under sponsorship from the 6 * FreeBSD Foundation. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 */ 29 30 #include <sys/cdefs.h> 31 __FBSDID("$FreeBSD$"); 32 33 #include <sys/types.h> 34 #include <sys/ptrace.h> 35 36 #include <err.h> 37 #include <stdio.h> 38 #include <string.h> 39 #include <errno.h> 40 #include "_libproc.h" 41 42 int 43 proc_regget(struct proc_handle *phdl, proc_reg_t reg, unsigned long *regvalue) 44 { 45 struct reg regs; 46 47 if (phdl->status == PS_DEAD || phdl->status == PS_UNDEAD || 48 phdl->status == PS_IDLE) { 49 errno = ENOENT; 50 return (-1); 51 } 52 memset(®s, 0, sizeof(regs)); 53 if (ptrace(PT_GETREGS, proc_getpid(phdl), (caddr_t)®s, 0) < 0) 54 return (-1); 55 switch (reg) { 56 case REG_PC: 57 #if defined(__aarch64__) 58 *regvalue = regs.elr; 59 #elif defined(__amd64__) 60 *regvalue = regs.r_rip; 61 #elif defined(__arm__) 62 *regvalue = regs.r_pc; 63 #elif defined(__i386__) 64 *regvalue = regs.r_eip; 65 #elif defined(__mips__) 66 *regvalue = regs.r_regs[PC]; 67 #elif defined(__powerpc__) 68 *regvalue = regs.pc; 69 #endif 70 break; 71 case REG_SP: 72 #if defined(__aarch64__) 73 *regvalue = regs.sp; 74 #elif defined(__amd64__) 75 *regvalue = regs.r_rsp; 76 #elif defined(__arm__) 77 *regvalue = regs.r_sp; 78 #elif defined(__i386__) 79 *regvalue = regs.r_esp; 80 #elif defined(__mips__) 81 *regvalue = regs.r_regs[SP]; 82 #elif defined(__powerpc__) 83 *regvalue = regs.fixreg[1]; 84 #endif 85 break; 86 default: 87 DPRINTFX("ERROR: no support for reg number %d", reg); 88 return (-1); 89 } 90 91 return (0); 92 } 93 94 int 95 proc_regset(struct proc_handle *phdl, proc_reg_t reg, unsigned long regvalue) 96 { 97 struct reg regs; 98 99 if (phdl->status == PS_DEAD || phdl->status == PS_UNDEAD || 100 phdl->status == PS_IDLE) { 101 errno = ENOENT; 102 return (-1); 103 } 104 if (ptrace(PT_GETREGS, proc_getpid(phdl), (caddr_t)®s, 0) < 0) 105 return (-1); 106 switch (reg) { 107 case REG_PC: 108 #if defined(__aarch64__) 109 regs.elr = regvalue; 110 #elif defined(__amd64__) 111 regs.r_rip = regvalue; 112 #elif defined(__arm__) 113 regs.r_pc = regvalue; 114 #elif defined(__i386__) 115 regs.r_eip = regvalue; 116 #elif defined(__mips__) 117 regs.r_regs[PC] = regvalue; 118 #elif defined(__powerpc__) 119 regs.pc = regvalue; 120 #endif 121 break; 122 case REG_SP: 123 #if defined(__aarch64__) 124 regs.sp = regvalue; 125 #elif defined(__amd64__) 126 regs.r_rsp = regvalue; 127 #elif defined(__arm__) 128 regs.r_sp = regvalue; 129 #elif defined(__i386__) 130 regs.r_esp = regvalue; 131 #elif defined(__mips__) 132 regs.r_regs[PC] = regvalue; 133 #elif defined(__powerpc__) 134 regs.fixreg[1] = regvalue; 135 #endif 136 break; 137 default: 138 DPRINTFX("ERROR: no support for reg number %d", reg); 139 return (-1); 140 } 141 if (ptrace(PT_SETREGS, proc_getpid(phdl), (caddr_t)®s, 0) < 0) 142 return (-1); 143 144 return (0); 145 } 146