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/cdefs.h> 28 __FBSDID("$FreeBSD$"); 29 30 #include <sys/types.h> 31 #include <sys/elf.h> 32 #include <sys/proc.h> 33 #include <sys/ptrace.h> 34 #include <sys/reg.h> 35 #include <machine/pcb.h> 36 #ifdef VFP 37 #include <machine/vfp.h> 38 #endif 39 40 #ifdef VFP 41 static bool 42 get_arm_vfp(struct regset *rs, struct thread *td, void *buf, size_t *sizep) 43 { 44 if (buf != NULL) { 45 KASSERT(*sizep == sizeof(mcontext_vfp_t), 46 ("%s: invalid size", __func__)); 47 get_vfpcontext(td, buf); 48 } 49 *sizep = sizeof(mcontext_vfp_t); 50 return (true); 51 } 52 53 static bool 54 set_arm_vfp(struct regset *rs, struct thread *td, void *buf, 55 size_t size) 56 { 57 KASSERT(size == sizeof(mcontext_vfp_t), ("%s: invalid size", __func__)); 58 set_vfpcontext(td, buf); 59 return (true); 60 } 61 62 static struct regset regset_arm_vfp = { 63 .note = NT_ARM_VFP, 64 .size = sizeof(mcontext_vfp_t), 65 .get = get_arm_vfp, 66 .set = set_arm_vfp, 67 }; 68 ELF_REGSET(regset_arm_vfp); 69 #endif 70 71 static bool 72 get_arm_tls(struct regset *rs, struct thread *td, void *buf, 73 size_t *sizep) 74 { 75 if (buf != NULL) { 76 KASSERT(*sizep == sizeof(td->td_pcb->pcb_regs.sf_tpidrurw), 77 ("%s: invalid size", __func__)); 78 memcpy(buf, &td->td_pcb->pcb_regs.sf_tpidrurw, 79 sizeof(td->td_pcb->pcb_regs.sf_tpidrurw)); 80 } 81 *sizep = sizeof(td->td_pcb->pcb_regs.sf_tpidrurw); 82 83 return (true); 84 } 85 86 static struct regset regset_arm_tls = { 87 .note = NT_ARM_TLS, 88 .size = sizeof(uint32_t), 89 .get = get_arm_tls, 90 }; 91 ELF_REGSET(regset_arm_tls); 92 93 int 94 cpu_ptrace(struct thread *td, int req, void *addr, int data) 95 { 96 #ifdef VFP 97 mcontext_vfp_t vfp; 98 #endif 99 int error; 100 101 switch (req) { 102 #ifdef VFP 103 case PT_GETVFPREGS: 104 get_vfpcontext(td, &vfp); 105 error = copyout(&vfp, addr, sizeof(vfp)); 106 break; 107 case PT_SETVFPREGS: 108 error = copyin(addr, &vfp, sizeof(vfp)); 109 if (error == 0) 110 set_vfpcontext(td, &vfp); 111 break; 112 #endif 113 default: 114 error = EINVAL; 115 } 116 117 return (error); 118 } 119