This source file includes following definitions.
- process_frame
- process_fpframe
- process_xmm_to_s87
- process_fninit_xmm
- process_read_regs
- process_read_fpregs
- process_s87_to_xmm
- process_write_regs
- process_write_fpregs
- process_read_xmmregs
- process_write_xmmregs
- process_sstep
- process_set_pc
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63 #include <sys/param.h>
64 #include <sys/systm.h>
65 #include <sys/time.h>
66 #include <sys/kernel.h>
67 #include <sys/proc.h>
68 #include <sys/user.h>
69 #include <sys/vnode.h>
70 #include <sys/ptrace.h>
71
72 #include <machine/psl.h>
73 #include <machine/reg.h>
74 #include <machine/segments.h>
75
76 #ifdef VM86
77 #include <machine/vm86.h>
78 #endif
79
80 #include "npx.h"
81
82 static __inline struct trapframe *process_frame(struct proc *);
83 static __inline union savefpu *process_fpframe(struct proc *);
84 void process_fninit_xmm(struct savexmm *);
85
86 static __inline struct trapframe *
87 process_frame(struct proc *p)
88 {
89
90 return (p->p_md.md_regs);
91 }
92
93 static __inline union savefpu *
94 process_fpframe(struct proc *p)
95 {
96
97 return (&p->p_addr->u_pcb.pcb_savefpu);
98 }
99
100 void
101 process_xmm_to_s87(const struct savexmm *sxmm, struct save87 *s87)
102 {
103 int i;
104
105
106 s87->sv_env.en_cw = sxmm->sv_env.en_cw;
107 s87->sv_env.en_sw = sxmm->sv_env.en_sw;
108
109 s87->sv_env.en_fip = sxmm->sv_env.en_fip;
110 s87->sv_env.en_fcs = sxmm->sv_env.en_fcs;
111 s87->sv_env.en_opcode = sxmm->sv_env.en_opcode;
112 s87->sv_env.en_foo = sxmm->sv_env.en_foo;
113 s87->sv_env.en_fos = sxmm->sv_env.en_fos;
114
115
116 for (i = 0; i < 8; i++) {
117 if (sxmm->sv_env.en_tw & (1U << i))
118 s87->sv_env.en_tw &= ~(3U << (i * 2));
119 else
120 s87->sv_env.en_tw |= (3U << (i * 2));
121
122 if (sxmm->sv_ex_tw & (1U << i))
123 s87->sv_ex_tw &= ~(3U << (i * 2));
124 else
125 s87->sv_ex_tw |= (3U << (i * 2));
126
127 memcpy(&s87->sv_ac[i].fp_bytes, &sxmm->sv_ac[i].fp_bytes,
128 sizeof(s87->sv_ac[i].fp_bytes));
129 }
130
131 s87->sv_ex_sw = sxmm->sv_ex_sw;
132 }
133
134 void
135 process_fninit_xmm(struct savexmm *sxmm)
136 {
137
138
139
140
141 uint32_t mxcsr = sxmm->sv_env.en_mxcsr;
142 uint16_t cw = sxmm->sv_env.en_cw;
143
144
145 memset(sxmm, 0, sizeof(*sxmm));
146 sxmm->sv_env.en_cw = cw;
147 sxmm->sv_env.en_mxcsr = mxcsr;
148 sxmm->sv_env.en_sw = 0x0000;
149 sxmm->sv_env.en_tw = 0x00;
150 }
151
152 int
153 process_read_regs(struct proc *p, struct reg *regs)
154 {
155 struct trapframe *tf = process_frame(p);
156
157 #ifdef VM86
158 if (tf->tf_eflags & PSL_VM) {
159 regs->r_gs = tf->tf_vm86_gs & 0xffff;
160 regs->r_fs = tf->tf_vm86_fs & 0xffff;
161 regs->r_es = tf->tf_vm86_es & 0xffff;
162 regs->r_ds = tf->tf_vm86_ds & 0xffff;
163 regs->r_eflags = get_vflags(p);
164 } else
165 #endif
166 {
167 regs->r_gs = tf->tf_gs & 0xffff;
168 regs->r_fs = tf->tf_fs & 0xffff;
169 regs->r_es = tf->tf_es & 0xffff;
170 regs->r_ds = tf->tf_ds & 0xffff;
171 regs->r_eflags = tf->tf_eflags;
172 }
173 regs->r_edi = tf->tf_edi;
174 regs->r_esi = tf->tf_esi;
175 regs->r_ebp = tf->tf_ebp;
176 regs->r_ebx = tf->tf_ebx;
177 regs->r_edx = tf->tf_edx;
178 regs->r_ecx = tf->tf_ecx;
179 regs->r_eax = tf->tf_eax;
180 regs->r_eip = tf->tf_eip;
181 regs->r_cs = tf->tf_cs & 0xffff;
182 regs->r_esp = tf->tf_esp;
183 regs->r_ss = tf->tf_ss & 0xffff;
184
185 return (0);
186 }
187
188 int
189 process_read_fpregs(struct proc *p, struct fpreg *regs)
190 {
191 union savefpu *frame = process_fpframe(p);
192
193 if (p->p_md.md_flags & MDP_USEDFPU) {
194 #if NNPX > 0
195 npxsave_proc(p, 1);
196 #endif
197 } else {
198
199 if (i386_use_fxsave) {
200 process_fninit_xmm(&frame->sv_xmm);
201 } else {
202
203
204
205
206 uint16_t cw = frame->sv_87.sv_env.en_cw;
207
208 memset(&frame->sv_87, 0, sizeof(frame->sv_87));
209 frame->sv_87.sv_env.en_cw = cw;
210 frame->sv_87.sv_env.en_sw = 0x0000;
211 frame->sv_87.sv_env.en_tw = 0xffff;
212 }
213 p->p_md.md_flags |= MDP_USEDFPU;
214 }
215
216 if (i386_use_fxsave) {
217 struct save87 s87;
218
219
220 process_xmm_to_s87(&frame->sv_xmm, &s87);
221 memcpy(regs, &s87, sizeof(*regs));
222 } else
223 memcpy(regs, &frame->sv_87, sizeof(*regs));
224
225 return (0);
226 }
227
228 #ifdef PTRACE
229
230 void
231 process_s87_to_xmm(const struct save87 *s87, struct savexmm *sxmm)
232 {
233 int i;
234
235
236 sxmm->sv_env.en_cw = s87->sv_env.en_cw;
237 sxmm->sv_env.en_sw = s87->sv_env.en_sw;
238
239 sxmm->sv_env.en_fip = s87->sv_env.en_fip;
240 sxmm->sv_env.en_fcs = s87->sv_env.en_fcs;
241 sxmm->sv_env.en_opcode = s87->sv_env.en_opcode;
242 sxmm->sv_env.en_foo = s87->sv_env.en_foo;
243 sxmm->sv_env.en_fos = s87->sv_env.en_fos;
244
245
246 for (i = 0; i < 8; i++) {
247 if (((s87->sv_env.en_tw >> (i * 2)) & 3) == 3)
248 sxmm->sv_env.en_tw &= ~(1U << i);
249 else
250 sxmm->sv_env.en_tw |= (1U << i);
251
252 if (((s87->sv_ex_tw >> (i * 2)) & 3) == 3)
253 sxmm->sv_ex_tw &= ~(1U << i);
254 else
255 sxmm->sv_ex_tw |= (1U << i);
256
257 memcpy(&sxmm->sv_ac[i].fp_bytes, &s87->sv_ac[i].fp_bytes,
258 sizeof(sxmm->sv_ac[i].fp_bytes));
259 }
260
261 sxmm->sv_ex_sw = s87->sv_ex_sw;
262 }
263
264 int
265 process_write_regs(struct proc *p, struct reg *regs)
266 {
267 struct trapframe *tf = process_frame(p);
268
269 #ifdef VM86
270 if (tf->tf_eflags & PSL_VM) {
271 tf->tf_vm86_gs = regs->r_gs & 0xffff;
272 tf->tf_vm86_fs = regs->r_fs & 0xffff;
273 tf->tf_vm86_es = regs->r_es & 0xffff;
274 tf->tf_vm86_ds = regs->r_ds & 0xffff;
275 set_vflags(p, regs->r_eflags);
276 } else
277 #endif
278 {
279
280
281
282 if (((regs->r_eflags ^ tf->tf_eflags) & PSL_USERSTATIC) != 0 ||
283 !USERMODE(regs->r_cs, regs->r_eflags))
284 return (EINVAL);
285
286 tf->tf_gs = regs->r_gs & 0xffff;
287 tf->tf_fs = regs->r_fs & 0xffff;
288 tf->tf_es = regs->r_es & 0xffff;
289 tf->tf_ds = regs->r_ds & 0xffff;
290 tf->tf_eflags = regs->r_eflags;
291 }
292 tf->tf_edi = regs->r_edi;
293 tf->tf_esi = regs->r_esi;
294 tf->tf_ebp = regs->r_ebp;
295 tf->tf_ebx = regs->r_ebx;
296 tf->tf_edx = regs->r_edx;
297 tf->tf_ecx = regs->r_ecx;
298 tf->tf_eax = regs->r_eax;
299 tf->tf_eip = regs->r_eip;
300 tf->tf_cs = regs->r_cs & 0xffff;
301 tf->tf_esp = regs->r_esp;
302 tf->tf_ss = regs->r_ss & 0xffff;
303
304 return (0);
305 }
306
307 int
308 process_write_fpregs(struct proc *p, struct fpreg *regs)
309 {
310 union savefpu *frame = process_fpframe(p);
311
312 if (p->p_md.md_flags & MDP_USEDFPU) {
313 #if NNPX > 0
314 npxsave_proc(p, 0);
315 #endif
316 } else
317 p->p_md.md_flags |= MDP_USEDFPU;
318
319 if (i386_use_fxsave) {
320 struct save87 s87;
321
322
323 memcpy(&s87, regs, sizeof(*regs));
324 process_s87_to_xmm(&s87, &frame->sv_xmm);
325 } else
326 memcpy(&frame->sv_87, regs, sizeof(*regs));
327
328 return (0);
329 }
330
331 int
332 process_read_xmmregs(struct proc *p, struct xmmregs *regs)
333 {
334 union savefpu *frame = process_fpframe(p);
335
336 if (!i386_use_fxsave)
337 return (EINVAL);
338
339 if (p->p_md.md_flags & MDP_USEDFPU) {
340 #if NNPX > 0
341 npxsave_proc(p, 1);
342 #endif
343 } else {
344
345 process_fninit_xmm(&frame->sv_xmm);
346 p->p_md.md_flags |= MDP_USEDFPU;
347 }
348
349 memcpy(regs, &frame->sv_xmm, sizeof(*regs));
350 return (0);
351 }
352
353 int
354 process_write_xmmregs(struct proc *p, const struct xmmregs *regs)
355 {
356 union savefpu *frame = process_fpframe(p);
357
358 if (!i386_use_fxsave)
359 return (EINVAL);
360
361 if (p->p_md.md_flags & MDP_USEDFPU) {
362 #if NNPX > 0
363 npxsave_proc(p, 0);
364 #endif
365 } else
366 p->p_md.md_flags |= MDP_USEDFPU;
367
368 memcpy(&frame->sv_xmm, regs, sizeof(*regs));
369 return (0);
370 }
371
372 int
373 process_sstep(struct proc *p, int sstep)
374 {
375 struct trapframe *tf = process_frame(p);
376
377 if (sstep)
378 tf->tf_eflags |= PSL_T;
379 else
380 tf->tf_eflags &= ~PSL_T;
381
382 return (0);
383 }
384
385 int
386 process_set_pc(struct proc *p, caddr_t addr)
387 {
388 struct trapframe *tf = process_frame(p);
389
390 tf->tf_eip = (int)addr;
391
392 return (0);
393 }
394
395 #endif