1 /*- 2 * Copyright (c) 2017 John Baldwin <jhb@FreeBSD.org> 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 1. Redistributions of source code must retain the above copyright 8 * notice, this list of conditions and the following disclaimer. 9 * 2. Redistributions in binary form must reproduce the above copyright 10 * notice, this list of conditions and the following disclaimer in the 11 * documentation and/or other materials provided with the distribution. 12 * 13 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 14 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 17 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23 * SUCH DAMAGE. 24 * 25 */ 26 27 #include <sys/types.h> 28 #include <sys/elf.h> 29 #include <sys/proc.h> 30 #include <sys/ptrace.h> 31 #include <sys/reg.h> 32 #include <machine/pcb.h> 33 #ifdef VFP 34 #include <machine/vfp.h> 35 #endif 36 37 #ifdef VFP 38 static bool 39 get_arm_vfp(struct regset *rs, struct thread *td, void *buf, size_t *sizep) 40 { 41 if (buf != NULL) { 42 KASSERT(*sizep == sizeof(mcontext_vfp_t), 43 ("%s: invalid size", __func__)); 44 get_vfpcontext(td, buf); 45 } 46 *sizep = sizeof(mcontext_vfp_t); 47 return (true); 48 } 49 50 static bool 51 set_arm_vfp(struct regset *rs, struct thread *td, void *buf, 52 size_t size) 53 { 54 KASSERT(size == sizeof(mcontext_vfp_t), ("%s: invalid size", __func__)); 55 set_vfpcontext(td, buf); 56 return (true); 57 } 58 59 static struct regset regset_arm_vfp = { 60 .note = NT_ARM_VFP, 61 .size = sizeof(mcontext_vfp_t), 62 .get = get_arm_vfp, 63 .set = set_arm_vfp, 64 }; 65 ELF_REGSET(regset_arm_vfp); 66 #endif 67 68 static bool 69 get_arm_tls(struct regset *rs, struct thread *td, void *buf, 70 size_t *sizep) 71 { 72 if (buf != NULL) { 73 KASSERT(*sizep == sizeof(td->td_pcb->pcb_regs.sf_tpidrurw), 74 ("%s: invalid size", __func__)); 75 memcpy(buf, &td->td_pcb->pcb_regs.sf_tpidrurw, 76 sizeof(td->td_pcb->pcb_regs.sf_tpidrurw)); 77 } 78 *sizep = sizeof(td->td_pcb->pcb_regs.sf_tpidrurw); 79 80 return (true); 81 } 82 83 static struct regset regset_arm_tls = { 84 .note = NT_ARM_TLS, 85 .size = sizeof(uint32_t), 86 .get = get_arm_tls, 87 }; 88 ELF_REGSET(regset_arm_tls); 89 90 int 91 cpu_ptrace(struct thread *td, int req, void *addr, int data) 92 { 93 #ifdef VFP 94 mcontext_vfp_t vfp; 95 #endif 96 int error; 97 98 switch (req) { 99 #ifdef VFP 100 case PT_GETVFPREGS: 101 get_vfpcontext(td, &vfp); 102 error = copyout(&vfp, addr, sizeof(vfp)); 103 break; 104 case PT_SETVFPREGS: 105 error = copyin(addr, &vfp, sizeof(vfp)); 106 if (error == 0) 107 set_vfpcontext(td, &vfp); 108 break; 109 #endif 110 default: 111 error = EINVAL; 112 } 113 114 return (error); 115 } 116