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(__amd64__) 58 *regvalue = regs.r_rip; 59 #elif defined(__i386__) 60 *regvalue = regs.r_eip; 61 #elif defined(__mips__) 62 *regvalue = regs.r_regs[PC]; 63 #endif 64 break; 65 case REG_SP: 66 #if defined(__amd64__) 67 *regvalue = regs.r_rsp; 68 #elif defined(__i386__) 69 *regvalue = regs.r_esp; 70 #elif defined(__mips__) 71 *regvalue = regs.r_regs[SP]; 72 #endif 73 break; 74 default: 75 warn("ERROR: no support for reg number %d", reg); 76 return (-1); 77 } 78 79 return (0); 80 } 81 82 int 83 proc_regset(struct proc_handle *phdl, proc_reg_t reg, unsigned long regvalue) 84 { 85 struct reg regs; 86 87 if (phdl->status == PS_DEAD || phdl->status == PS_UNDEAD || 88 phdl->status == PS_IDLE) { 89 errno = ENOENT; 90 return (-1); 91 } 92 if (ptrace(PT_GETREGS, proc_getpid(phdl), (caddr_t)®s, 0) < 0) 93 return (-1); 94 switch (reg) { 95 case REG_PC: 96 #if defined(__amd64__) 97 regs.r_rip = regvalue; 98 #elif defined(__i386__) 99 regs.r_eip = regvalue; 100 #elif defined(__mips__) 101 regs.r_regs[PC] = regvalue; 102 #endif 103 break; 104 case REG_SP: 105 #if defined(__amd64__) 106 regs.r_rsp = regvalue; 107 #elif defined(__i386__) 108 regs.r_esp = regvalue; 109 #elif defined(__mips__) 110 regs.r_regs[PC] = regvalue; 111 #endif 112 break; 113 default: 114 warn("ERROR: no support for reg number %d", reg); 115 return (-1); 116 } 117 if (ptrace(PT_SETREGS, proc_getpid(phdl), (caddr_t)®s, 0) < 0) 118 return (-1); 119 120 return (0); 121 } 122