xref: /netbsd-src/sys/arch/arm/arm/process_machdep.c (revision 181254a7b1bdde6873432bffef2d2decc4b5c22f)
1 /*	$NetBSD: process_machdep.c,v 1.33 2018/01/24 09:04:44 skrll Exp $	*/
2 
3 /*
4  * Copyright (c) 1993 The Regents of the University of California.
5  * All rights reserved.
6  *
7  * This code is derived from software contributed to Berkeley by
8  * Jan-Simon Pendry.
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions
12  * are met:
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  * 3. Neither the name of the University nor the names of its contributors
19  *    may be used to endorse or promote products derived from this software
20  *    without specific prior written permission.
21  *
22  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
23  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
26  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32  * SUCH DAMAGE.
33  *
34  * From:
35  *	Id: procfs_i386.c,v 4.1 1993/12/17 10:47:45 jsp Rel
36  */
37 
38 /*
39  * Copyright (c) 1995 Frank Lancaster.  All rights reserved.
40  * Copyright (c) 1995 Tools GmbH.  All rights reserved.
41  * All rights reserved.
42  *
43  * Redistribution and use in source and binary forms, with or without
44  * modification, are permitted provided that the following conditions
45  * are met:
46  * 1. Redistributions of source code must retain the above copyright
47  *    notice, this list of conditions and the following disclaimer.
48  * 2. Redistributions in binary form must reproduce the above copyright
49  *    notice, this list of conditions and the following disclaimer in the
50  *    documentation and/or other materials provided with the distribution.
51  * 3. All advertising materials mentioning features or use of this software
52  *    must display the following acknowledgement:
53  *      This product includes software developed by TooLs GmbH.
54  * 4. The name of TooLs GmbH may not be used to endorse or promote products
55  *    derived from this software without specific prior written permission.
56  *
57  * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
58  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
59  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
60  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
61  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
62  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
63  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
64  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
65  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
66  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
67  */
68 
69 /*
70  * Copyright (c) 1995 Charles M. Hannum.  All rights reserved.
71  * Copyright (c) 1993 Jan-Simon Pendry
72  * All rights reserved.
73  *
74  * This code is derived from software contributed to Berkeley by
75  * Jan-Simon Pendry.
76  *
77  * Redistribution and use in source and binary forms, with or without
78  * modification, are permitted provided that the following conditions
79  * are met:
80  * 1. Redistributions of source code must retain the above copyright
81  *    notice, this list of conditions and the following disclaimer.
82  * 2. Redistributions in binary form must reproduce the above copyright
83  *    notice, this list of conditions and the following disclaimer in the
84  *    documentation and/or other materials provided with the distribution.
85  * 3. All advertising materials mentioning features or use of this software
86  *    must display the following acknowledgement:
87  *	This product includes software developed by the University of
88  *	California, Berkeley and its contributors.
89  * 4. Neither the name of the University nor the names of its contributors
90  *    may be used to endorse or promote products derived from this software
91  *    without specific prior written permission.
92  *
93  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
94  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
95  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
96  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
97  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
98  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
99  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
100  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
101  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
102  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
103  * SUCH DAMAGE.
104  *
105  * From:
106  *	Id: procfs_i386.c,v 4.1 1993/12/17 10:47:45 jsp Rel
107  */
108 
109 /*
110  * This file may seem a bit stylized, but that so that it's easier to port.
111  * Functions to be implemented here are:
112  *
113  * process_read_regs(proc, regs)
114  *	Get the current user-visible register set from the process
115  *	and copy it into the regs structure (<machine/reg.h>).
116  *	The process is stopped at the time read_regs is called.
117  *
118  * process_write_regs(proc, regs)
119  *	Update the current register set from the passed in regs
120  *	structure.  Take care to avoid clobbering special CPU
121  *	registers or privileged bits in the PSL.
122  *	The process is stopped at the time write_regs is called.
123  *
124  * process_sstep(proc, sstep)
125  *	Arrange for the process to trap or not trap depending on sstep
126  *	after executing a single instruction.
127  *
128  * process_set_pc(proc)
129  *	Set the process's program counter.
130  */
131 
132 #include "opt_armfpe.h"
133 
134 #include <sys/param.h>
135 
136 __KERNEL_RCSID(0, "$NetBSD: process_machdep.c,v 1.33 2018/01/24 09:04:44 skrll Exp $");
137 
138 #include <sys/proc.h>
139 #include <sys/ptrace.h>
140 #include <sys/systm.h>
141 
142 #include <arm/armreg.h>
143 #include <arm/vfpreg.h>
144 #include <arm/locore.h>
145 
146 #include <machine/pcb.h>
147 #include <machine/reg.h>
148 
149 int
150 process_read_regs(struct lwp *l, struct reg *regs)
151 {
152 	struct trapframe * const tf = lwp_trapframe(l);
153 
154 	KASSERT(tf != NULL);
155 	memcpy((void *)regs->r, (void *)&tf->tf_r0, sizeof(regs->r));
156 	regs->r_sp = tf->tf_usr_sp;
157 	regs->r_lr = tf->tf_usr_lr;
158 	regs->r_pc = tf->tf_pc;
159 	regs->r_cpsr = tf->tf_spsr;
160 
161 	KASSERT(VALID_R15_PSR(tf->tf_pc, tf->tf_spsr));
162 
163 #ifdef THUMB_CODE
164 	if (tf->tf_spsr & PSR_T_bit)
165 		regs->r_pc |= 1;
166 #endif
167 
168 	return 0;
169 }
170 
171 int
172 process_read_fpregs(struct lwp *l, struct fpreg *regs, size_t *sz)
173 {
174 #ifdef FPU_VFP
175 	if (curcpu()->ci_vfp_id == 0) {
176 		memset(regs, 0, sizeof(*regs));
177 		return 0;
178 	}
179 	const struct pcb * const pcb = lwp_getpcb(l);
180 	vfp_savecontext(l);
181 	regs->fpr_vfp = pcb->pcb_vfp;
182 	regs->fpr_vfp.vfp_fpexc &= ~VFP_FPEXC_EN;
183 #endif
184 	return 0;
185 }
186 
187 int
188 process_write_regs(struct lwp *l, const struct reg *regs)
189 {
190 	struct trapframe * const tf = lwp_trapframe(l);
191 
192 	KASSERT(tf != NULL);
193 	memcpy(&tf->tf_r0, regs->r, sizeof(regs->r));
194 	tf->tf_usr_sp = regs->r_sp;
195 	tf->tf_usr_lr = regs->r_lr;
196 	tf->tf_pc = regs->r_pc;
197 	tf->tf_spsr &=  ~(PSR_FLAGS | PSR_T_bit);
198 	tf->tf_spsr |= regs->r_cpsr & PSR_FLAGS;
199 #ifdef THUMB_CODE
200 	if ((regs->r_pc & 1) || (regs->r_cpsr & PSR_T_bit))
201 		tf->tf_spsr |= PSR_T_bit;
202 #endif
203 	KASSERT(VALID_R15_PSR(tf->tf_pc, tf->tf_spsr));
204 
205 	return 0;
206 }
207 
208 int
209 process_write_fpregs(struct lwp *l, const struct fpreg *regs, size_t sz)
210 {
211 #ifdef FPU_VFP
212 	if (curcpu()->ci_vfp_id == 0) {
213 		return EINVAL;
214 	}
215 	struct pcb * const pcb = lwp_getpcb(l);
216 	vfp_discardcontext(l, true);
217 	pcb->pcb_vfp = regs->fpr_vfp;
218 	pcb->pcb_vfp.vfp_fpexc &= ~VFP_FPEXC_EN;
219 #endif
220 	return 0;
221 }
222 
223 int
224 process_set_pc(struct lwp *l, void *addr)
225 {
226 	struct trapframe * const tf = lwp_trapframe(l);
227 
228 	KASSERT(tf != NULL);
229 	tf->tf_pc = (int)addr;
230 #ifdef THUMB_CODE
231 	if (((int)addr) & 1)
232 		tf->tf_spsr |= PSR_T_bit;
233 	else
234 		tf->tf_spsr &= ~PSR_T_bit;
235 #endif
236 
237 	return 0;
238 }
239