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
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
|
/* $OpenBSD: uthread_machdep.c,v 1.5 2011/01/04 05:34:09 guenther Exp $ */
/*
* Copyright (c) 2004 Theo de Raadt
*
* Permission to use, copy, modify, and distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
#include <machine/param.h>
#include <pthread.h>
#include "pthread_private.h"
struct frame {
long fr_gs;
long fr_fs;
long fr_es;
long fr_ds;
long flag;
long fr_r15;
long fr_r14;
long fr_r13;
long fr_r12;
long fr_r11;
long fr_r10;
long fr_r9;
long fr_r8;
long fr_rdi;
long fr_rsi;
long fr_rbp;
long fr_rbx;
long fr_rdx;
long fr_rcx;
long fr_rax;
long fr_rip;
int fr_cs; /* XXX unreachable? */
int pad;
};
#define copyreg(reg, lval) \
__asm__("mov %%" #reg ", %0" : "=g"(lval))
/*
* Given a stack and an entry function, initialise a state
* structure that can be later switched to.
*/
void
_thread_machdep_init(struct _machdep_state* statep, void *base, int len,
void (*entry)(void))
{
struct frame *f;
int foo;
/* Locate the initial frame, aligned at the top of the stack */
f = (struct frame *)(((long)base + len - sizeof *f) & ~ALIGNBYTES);
copyreg(cs, foo);
f->fr_cs = foo;
copyreg(ds, foo);
f->fr_ds = foo;
copyreg(es, foo);
f->fr_es = foo;
copyreg(fs, foo);
f->fr_fs = foo;
copyreg(gs, foo);
f->fr_gs = foo;
f->fr_rbp = (long)-1;
f->fr_rip = (long)entry;
statep->rsp = (long)f;
_thread_machdep_save_float_state(statep);
}
#define fxsave(addr) __asm("fxsave %0" : "=m" (*addr))
#define fxrstor(addr) __asm("fxrstor %0" : : "m" (*addr))
#define fwait() __asm("fwait")
#define fninit() __asm("fninit")
void
_thread_machdep_save_float_state(struct _machdep_state *ms)
{
fxsave(&ms->fpreg);
fninit();
fwait();
}
void
_thread_machdep_restore_float_state(struct _machdep_state *ms)
{
fxrstor(&ms->fpreg);
}
|
