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
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
|
/* Create new context.
Copyright (C) 2002-2012 Free Software Foundation, Inc.
This file is part of the GNU C Library.
The GNU C Library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public
License as published by the Free Software Foundation; either
version 2.1 of the License, or (at your option) any later version.
The GNU C Library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
Lesser General Public License for more details.
You should have received a copy of the GNU Lesser General Public
License along with the GNU C Library; if not, see
<http://www.gnu.org/licenses/>. */
#include <sysdep.h>
#include <kernel-features.h>
#define __ASSEMBLY__
#include <asm/ptrace.h>
#include "ucontext_i.h"
#include <asm/errno.h>
ENTRY(__makecontext)
CALL_MCOUNT 3
/* Save parameters into the parameter save area of callers frame. */
std r3,FRAME_PARM1_SAVE(r1) /* ucontext_t *ucp */
std r4,FRAME_PARM2_SAVE(r1) /* void (*func)(void) */
std r5,FRAME_PARM3_SAVE(r1) /* int argc */
std r6,FRAME_PARM4_SAVE(r1) /* ... */
std r7,FRAME_PARM5_SAVE(r1)
std r8,FRAME_PARM6_SAVE(r1)
std r9,FRAME_PARM7_SAVE(r1)
std r10,FRAME_PARM8_SAVE(r1)
mflr r0
/* Get the address of the target functions first parameter. */
addi r6,r1,FRAME_PARM4_SAVE
std r0,FRAME_LR_SAVE(r1)
cfi_offset (lr, FRAME_LR_SAVE)
stdu r1,-128(r1)
cfi_adjust_cfa_offset (128)
/* Get the ucontexts stack pointer and size. Compute the top of stack
and round down to a quadword boundary. Then stack a dummy frame
with a null back chain. We store the context pointer in the frames
"compiler double word" field so we can recover if is the function
returns. Finally save the callers link register and TOC pointer
into this frame so the debugger can display a backtrace.
*/
ld r7,UCONTEXT_STACK_SP(r3)
ld r0,UCONTEXT_STACK_SIZE(r3)
add r7,r7,r0
clrrdi r7,r7,4
li r0,0
stdu r0,-64(r7)
std r3,FRAME_PARM1_SAVE(r7) /* Store context in dummy parm1. */
mflr r0
std r2,FRAME_TOC_SAVE(r7) /* Store the TOC pointer for later. */
std r0,FRAME_LR_SAVE(r7)
/* Now we need to stack another frame to hold the parameter save area
for the function. We need to allocate a frame with the minimum 48
byte header and 8 parameter register. However if there are more
than 8 parameters addition space is need to hold all the parameters.
The total size it rounded up to a quadword multiple then a frame is
stacked. This address is stored in the ucontext as GPR 1. */
cmpdi cr1,r5,8
sldi r8,r5,3
bgt cr1,L(gt8)
li r8,64
L(gt8):
addi r8,r8,FRAME_PARM_SAVE+8 /* Add header plus rounding factor. */
clrrdi r8,r8,4 /* Round down to quadword. */
subf r8,r8,r7
std r7,0(r8) /* Stack the frame. */
std r8,(SIGCONTEXT_GP_REGS+(PT_R1*8))(r3)
/* Now we need to copy the target functions parameters. The functions
parameters are saved in the parameter save area. We skip over the
first three parameters and copy up to 8 double word into the
SIGCONTEXT_GP_REGS starting with R3. If there are more than 8
parameters then doublewords 8-N are copied into the parameter
save area of the context frame. */
cmpdi r5,0
beq L(noparms)
mr r0,r5
ble cr1,L(le8)
li r0,8
L(le8):
mtctr r0
addi r7,r6,-8
addi r9,r3,(SIGCONTEXT_GP_REGS+(PT_R3*8)-8)
L(parmloop2):
ldu r0,8(r7)
stdu r0,8(r9)
bdnz L(parmloop2)
addi r0,r5,-8
ble cr1,L(noparms)
mtctr r0
addi r9,r8,FRAME_PARM9_SAVE-8
L(parmloop):
ldu r0,8(r7)
stdu r0,8(r9)
bdnz L(parmloop)
L(noparms):
/* Load the function address and TOC from the function descriptor
and store them in the ucontext as NIP and r2. Store the 3rd
field of the function descriptor into the ucontext as r11 in case
the calling language needs the "environment pointer". */
ld r0,0(r4)
ld r10,8(r4);
ld r9,16(r4);
std r0,(SIGCONTEXT_GP_REGS+(PT_NIP*8))(r3)
std r10,(SIGCONTEXT_GP_REGS+(PT_R2*8))(r3)
std r9,(SIGCONTEXT_GP_REGS+(PT_R11*8))(r3)
/* If the target function returns we need to do some cleanup. We use a
code trick to get the address of our cleanup function into the link
register. Do not add any code between here and L(exitcode). */
bl L(gotexitcodeaddr);
/* This is the helper code which gets called if a function which
is registered with 'makecontext' returns. In this case we
have to install the context listed in the uc_link element of
the context 'makecontext' manipulated at the time of the
'makecontext' call. If the pointer is NULL the process must
terminate. */
L(exitcode):
/* Recover the ucontext and TOC from the dummy frame. */
ld r1,FRAME_BACKCHAIN(r1) /* Unstack the parameter save area frame. */
ld r3,FRAME_PARM1_SAVE(r1)
ld r2,FRAME_TOC_SAVE(r1)
ld r3,UCONTEXT_LINK(r3) /* Load the resume context. */
cmpdi r3,0
beq L(do_exit)
bl JUMPTARGET(__setcontext)
nop
/* If setcontext returns (which can happen if the syscall fails) we will
exit the program with error status (-1). */
li r3,-1
L(do_exit):
#ifdef SHARED
b JUMPTARGET(__GI_exit);
#else
b JUMPTARGET(exit);
nop
#endif
b L(do_exit)
/* The address of the exit code is in the link register. Store the lr
in the ucontext as LNK so the target function will return to our
exit code. */
L(gotexitcodeaddr):
mflr r0
std r0,(SIGCONTEXT_GP_REGS+(PT_LNK*8))(r3)
ld r0,128+FRAME_LR_SAVE(r1)
addi r1,r1,128
mtlr r0
blr
END(__makecontext)
weak_alias (__makecontext, makecontext)
|
