| 1 | /*
|
|---|
| 2 | Copyright Oliver Kowalke 2009.
|
|---|
| 3 | Distributed under the Boost Software License, Version 1.0.
|
|---|
| 4 | (See accompanying file LICENSE_1_0.txt or copy at
|
|---|
| 5 | http://www.boost.org/LICENSE_1_0.txt)
|
|---|
| 6 | */
|
|---|
| 7 |
|
|---|
| 8 | /*******************************************************
|
|---|
| 9 | * *
|
|---|
| 10 | * ------------------------------------------------- *
|
|---|
| 11 | * | 0 | 1 | 2 | 3 | 4 | 5 | 6 | 7 | *
|
|---|
| 12 | * ------------------------------------------------- *
|
|---|
| 13 | * | 0 | 4 | 8 | 12 | 16 | 20 | 24 | 28 | *
|
|---|
| 14 | * ------------------------------------------------- *
|
|---|
| 15 | * | F14 | F15 | F16 | F17 | *
|
|---|
| 16 | * ------------------------------------------------- *
|
|---|
| 17 | * ------------------------------------------------- *
|
|---|
| 18 | * | 8 | 9 | 10 | 11 | 12 | 13 | 14 | 15 | *
|
|---|
| 19 | * ------------------------------------------------- *
|
|---|
| 20 | * | 32 | 36 | 40 | 44 | 48 | 52 | 56 | 60 | *
|
|---|
| 21 | * ------------------------------------------------- *
|
|---|
| 22 | * | F18 | F19 | F20 | F21 | *
|
|---|
| 23 | * ------------------------------------------------- *
|
|---|
| 24 | * ------------------------------------------------- *
|
|---|
| 25 | * | 16 | 17 | 18 | 19 | 20 | 21 | 22 | 23 | *
|
|---|
| 26 | * ------------------------------------------------- *
|
|---|
| 27 | * | 64 | 68 | 72 | 76 | 80 | 84 | 88 | 92 | *
|
|---|
| 28 | * ------------------------------------------------- *
|
|---|
| 29 | * | F22 | F23 | F24 | F25 | *
|
|---|
| 30 | * ------------------------------------------------- *
|
|---|
| 31 | * ------------------------------------------------- *
|
|---|
| 32 | * | 24 | 25 | 26 | 27 | 28 | 29 | 30 | 31 | *
|
|---|
| 33 | * ------------------------------------------------- *
|
|---|
| 34 | * | 96 | 100 | 104 | 108 | 112 | 116 | 120 | 124 | *
|
|---|
| 35 | * ------------------------------------------------- *
|
|---|
| 36 | * | F26 | F27 | F28 | F29 | *
|
|---|
| 37 | * ------------------------------------------------- *
|
|---|
| 38 | * ------------------------------------------------- *
|
|---|
| 39 | * | 32 | 33 | 34 | 35 | 36 | 37 | 38 | 39 | *
|
|---|
| 40 | * ------------------------------------------------- *
|
|---|
| 41 | * | 128 | 132 | 136 | 140 | 144 | 148 | 152 | 156 | *
|
|---|
| 42 | * ------------------------------------------------- *
|
|---|
| 43 | * | F30 | F31 | fpscr | TOC | *
|
|---|
| 44 | * ------------------------------------------------- *
|
|---|
| 45 | * ------------------------------------------------- *
|
|---|
| 46 | * | 40 | 41 | 42 | 43 | 44 | 45 | 46 | 47 | *
|
|---|
| 47 | * ------------------------------------------------- *
|
|---|
| 48 | * | 160 | 164 | 168 | 172 | 176 | 180 | 184 | 188 | *
|
|---|
| 49 | * ------------------------------------------------- *
|
|---|
| 50 | * | R14 | R15 | R16 | R17 | *
|
|---|
| 51 | * ------------------------------------------------- *
|
|---|
| 52 | * ------------------------------------------------- *
|
|---|
| 53 | * | 48 | 49 | 50 | 51 | 52 | 53 | 54 | 55 | *
|
|---|
| 54 | * ------------------------------------------------- *
|
|---|
| 55 | * | 192 | 196 | 200 | 204 | 208 | 212 | 216 | 220 | *
|
|---|
| 56 | * ------------------------------------------------- *
|
|---|
| 57 | * | R18 | R19 | R20 | R21 | *
|
|---|
| 58 | * ------------------------------------------------- *
|
|---|
| 59 | * ------------------------------------------------- *
|
|---|
| 60 | * | 56 | 57 | 58 | 59 | 60 | 61 | 62 | 63 | *
|
|---|
| 61 | * ------------------------------------------------- *
|
|---|
| 62 | * | 224 | 228 | 232 | 236 | 240 | 244 | 248 | 252 | *
|
|---|
| 63 | * ------------------------------------------------- *
|
|---|
| 64 | * | R22 | R23 | R24 | R25 | *
|
|---|
| 65 | * ------------------------------------------------- *
|
|---|
| 66 | * ------------------------------------------------- *
|
|---|
| 67 | * | 64 | 65 | 66 | 67 | 68 | 69 | 70 | 71 | *
|
|---|
| 68 | * ------------------------------------------------- *
|
|---|
| 69 | * | 256 | 260 | 264 | 268 | 272 | 276 | 280 | 284 | *
|
|---|
| 70 | * ------------------------------------------------- *
|
|---|
| 71 | * | R26 | R27 | R28 | R29 | *
|
|---|
| 72 | * ------------------------------------------------- *
|
|---|
| 73 | * ------------------------------------------------- *
|
|---|
| 74 | * | 72 | 73 | 74 | 75 | 76 | 77 | 78 | 79 | *
|
|---|
| 75 | * ------------------------------------------------- *
|
|---|
| 76 | * | 288 | 292 | 296 | 300 | 304 | 308 | 312 | 316 | *
|
|---|
| 77 | * ------------------------------------------------- *
|
|---|
| 78 | * ------------------------------------------------- *
|
|---|
| 79 | * | R30 | R31 | CR | LR | *
|
|---|
| 80 | * ------------------------------------------------- *
|
|---|
| 81 | * ------------------------------------------------- *
|
|---|
| 82 | * | 80 | 81 | | *
|
|---|
| 83 | * ------------------------------------------------- *
|
|---|
| 84 | * | 320 | 324 | | *
|
|---|
| 85 | * ------------------------------------------------- *
|
|---|
| 86 | * | PC | | *
|
|---|
| 87 | * ------------------------------------------------- *
|
|---|
| 88 | * *
|
|---|
| 89 | *******************************************************/
|
|---|
| 90 |
|
|---|
| 91 | .globl jump_fcontext
|
|---|
| 92 | #if _CALL_ELF == 2
|
|---|
| 93 | .text
|
|---|
| 94 | .align 2
|
|---|
| 95 | jump_fcontext:
|
|---|
| 96 | addis %r2, %r12, .TOC.-jump_fcontext@ha
|
|---|
| 97 | addi %r2, %r2, .TOC.-jump_fcontext@l
|
|---|
| 98 | .localentry jump_fcontext, . - jump_fcontext
|
|---|
| 99 | #else
|
|---|
| 100 | .section ".opd","aw"
|
|---|
| 101 | .align 3
|
|---|
| 102 | jump_fcontext:
|
|---|
| 103 | # ifdef _CALL_LINUX
|
|---|
| 104 | .quad .L.jump_fcontext,.TOC.@tocbase,0
|
|---|
| 105 | .type jump_fcontext,@function
|
|---|
| 106 | .text
|
|---|
| 107 | .align 2
|
|---|
| 108 | .L.jump_fcontext:
|
|---|
| 109 | # else
|
|---|
| 110 | .hidden .jump_fcontext
|
|---|
| 111 | .globl .jump_fcontext
|
|---|
| 112 | .quad .jump_fcontext,.TOC.@tocbase,0
|
|---|
| 113 | .size jump_fcontext,24
|
|---|
| 114 | .type .jump_fcontext,@function
|
|---|
| 115 | .text
|
|---|
| 116 | .align 2
|
|---|
| 117 | .jump_fcontext:
|
|---|
| 118 | # endif
|
|---|
| 119 | #endif
|
|---|
| 120 | # reserve space on stack
|
|---|
| 121 | subi %r1, %r1, 328
|
|---|
| 122 |
|
|---|
| 123 | #if _CALL_ELF != 2
|
|---|
| 124 | std %r2, 152(%r1) # save TOC
|
|---|
| 125 | #endif
|
|---|
| 126 | std %r14, 160(%r1) # save R14
|
|---|
| 127 | std %r15, 168(%r1) # save R15
|
|---|
| 128 | std %r16, 176(%r1) # save R16
|
|---|
| 129 | std %r17, 184(%r1) # save R17
|
|---|
| 130 | std %r18, 192(%r1) # save R18
|
|---|
| 131 | std %r19, 200(%r1) # save R19
|
|---|
| 132 | std %r20, 208(%r1) # save R20
|
|---|
| 133 | std %r21, 216(%r1) # save R21
|
|---|
| 134 | std %r22, 224(%r1) # save R22
|
|---|
| 135 | std %r23, 232(%r1) # save R23
|
|---|
| 136 | std %r24, 240(%r1) # save R24
|
|---|
| 137 | std %r25, 248(%r1) # save R25
|
|---|
| 138 | std %r26, 256(%r1) # save R26
|
|---|
| 139 | std %r27, 264(%r1) # save R27
|
|---|
| 140 | std %r28, 272(%r1) # save R28
|
|---|
| 141 | std %r29, 280(%r1) # save R29
|
|---|
| 142 | std %r30, 288(%r1) # save R30
|
|---|
| 143 | std %r31, 296(%r1) # save R31
|
|---|
| 144 |
|
|---|
| 145 | # save CR
|
|---|
| 146 | mfcr %r0
|
|---|
| 147 | std %r0, 304(%r1)
|
|---|
| 148 | # save LR
|
|---|
| 149 | mflr %r0
|
|---|
| 150 | std %r0, 312(%r1)
|
|---|
| 151 | # save LR as PC
|
|---|
| 152 | std %r0, 320(%r1)
|
|---|
| 153 |
|
|---|
| 154 | # test if fpu env should be preserved
|
|---|
| 155 | cmpwi cr7, %r6, 0
|
|---|
| 156 | beq cr7, 1f
|
|---|
| 157 |
|
|---|
| 158 | stfd %f14, 0(%r1) # save F14
|
|---|
| 159 | stfd %f15, 8(%r1) # save F15
|
|---|
| 160 | stfd %f16, 16(%r1) # save F16
|
|---|
| 161 | stfd %f17, 24(%r1) # save F17
|
|---|
| 162 | stfd %f18, 32(%r1) # save F18
|
|---|
| 163 | stfd %f19, 40(%r1) # save F19
|
|---|
| 164 | stfd %f20, 48(%r1) # save F20
|
|---|
| 165 | stfd %f21, 56(%r1) # save F21
|
|---|
| 166 | stfd %f22, 64(%r1) # save F22
|
|---|
| 167 | stfd %f23, 72(%r1) # save F23
|
|---|
| 168 | stfd %f24, 80(%r1) # save F24
|
|---|
| 169 | stfd %f25, 88(%r1) # save F25
|
|---|
| 170 | stfd %f26, 96(%r1) # save F26
|
|---|
| 171 | stfd %f27, 104(%r1) # save F27
|
|---|
| 172 | stfd %f28, 112(%r1) # save F28
|
|---|
| 173 | stfd %f29, 120(%r1) # save F29
|
|---|
| 174 | stfd %f30, 128(%r1) # save F30
|
|---|
| 175 | stfd %f31, 136(%r1) # save F31
|
|---|
| 176 | mffs %f0 # load FPSCR
|
|---|
| 177 | stfd %f0, 144(%r1) # save FPSCR
|
|---|
| 178 |
|
|---|
| 179 | 1:
|
|---|
| 180 | # store RSP (pointing to context-data) in R3
|
|---|
| 181 | std %r1, 0(%r3)
|
|---|
| 182 |
|
|---|
| 183 | # restore RSP (pointing to context-data) from R4
|
|---|
| 184 | mr %r1, %r4
|
|---|
| 185 |
|
|---|
| 186 | # test if fpu env should be preserved
|
|---|
| 187 | cmpwi cr7, %r6, 0
|
|---|
| 188 | beq cr7, 2f
|
|---|
| 189 |
|
|---|
| 190 | lfd %f14, 0(%r1) # restore F14
|
|---|
| 191 | lfd %f15, 8(%r1) # restore F15
|
|---|
| 192 | lfd %f16, 16(%r1) # restore F16
|
|---|
| 193 | lfd %f17, 24(%r1) # restore F17
|
|---|
| 194 | lfd %f18, 32(%r1) # restore F18
|
|---|
| 195 | lfd %f19, 40(%r1) # restore F19
|
|---|
| 196 | lfd %f20, 48(%r1) # restore F20
|
|---|
| 197 | lfd %f21, 56(%r1) # restore F21
|
|---|
| 198 | lfd %f22, 64(%r1) # restore F22
|
|---|
| 199 | lfd %f23, 72(%r1) # restore F23
|
|---|
| 200 | lfd %f24, 80(%r1) # restore F24
|
|---|
| 201 | lfd %f25, 88(%r1) # restore F25
|
|---|
| 202 | lfd %f26, 96(%r1) # restore F26
|
|---|
| 203 | lfd %f27, 104(%r1) # restore F27
|
|---|
| 204 | lfd %f28, 112(%r1) # restore F28
|
|---|
| 205 | lfd %f29, 120(%r1) # restore F29
|
|---|
| 206 | lfd %f30, 128(%r1) # restore F30
|
|---|
| 207 | lfd %f31, 136(%r1) # restore F31
|
|---|
| 208 | lfd %f0, 144(%r1) # load FPSCR
|
|---|
| 209 | mtfsf 0xff, %f0 # restore FPSCR
|
|---|
| 210 |
|
|---|
| 211 | 2:
|
|---|
| 212 | #if _CALL_ELF != 2
|
|---|
| 213 | ld %r2, 152(%r1) # restore TOC
|
|---|
| 214 | #endif
|
|---|
| 215 | ld %r14, 160(%r1) # restore R14
|
|---|
| 216 | ld %r15, 168(%r1) # restore R15
|
|---|
| 217 | ld %r16, 176(%r1) # restore R16
|
|---|
| 218 | ld %r17, 184(%r1) # restore R17
|
|---|
| 219 | ld %r18, 192(%r1) # restore R18
|
|---|
| 220 | ld %r19, 200(%r1) # restore R19
|
|---|
| 221 | ld %r20, 208(%r1) # restore R20
|
|---|
| 222 | ld %r21, 216(%r1) # restore R21
|
|---|
| 223 | ld %r22, 224(%r1) # restore R22
|
|---|
| 224 | ld %r23, 232(%r1) # restore R23
|
|---|
| 225 | ld %r24, 240(%r1) # restore R24
|
|---|
| 226 | ld %r25, 248(%r1) # restore R25
|
|---|
| 227 | ld %r26, 256(%r1) # restore R26
|
|---|
| 228 | ld %r27, 264(%r1) # restore R27
|
|---|
| 229 | ld %r28, 272(%r1) # restore R28
|
|---|
| 230 | ld %r29, 280(%r1) # restore R29
|
|---|
| 231 | ld %r30, 288(%r1) # restore R30
|
|---|
| 232 | ld %r31, 296(%r1) # restore R31
|
|---|
| 233 |
|
|---|
| 234 | # restore CR
|
|---|
| 235 | ld %r0, 304(%r1)
|
|---|
| 236 | mtcr %r0
|
|---|
| 237 | # restore LR
|
|---|
| 238 | ld %r0, 312(%r1)
|
|---|
| 239 | mtlr %r0
|
|---|
| 240 |
|
|---|
| 241 | # load PC
|
|---|
| 242 | ld %r12, 320(%r1)
|
|---|
| 243 | # restore CTR
|
|---|
| 244 | mtctr %r12
|
|---|
| 245 |
|
|---|
| 246 | # adjust stack
|
|---|
| 247 | addi %r1, %r1, 328
|
|---|
| 248 |
|
|---|
| 249 | # use third arg as return value after jump
|
|---|
| 250 | # use third arg as first arg in context function
|
|---|
| 251 | mr %r3, %r5
|
|---|
| 252 |
|
|---|
| 253 | # jump to context
|
|---|
| 254 | bctr
|
|---|
| 255 | #if _CALL_ELF == 2
|
|---|
| 256 | .size jump_fcontext, .-jump_fcontext
|
|---|
| 257 | #else
|
|---|
| 258 | # ifdef _CALL_LINUX
|
|---|
| 259 | .size .jump_fcontext, .-.L.jump_fcontext
|
|---|
| 260 | # else
|
|---|
| 261 | .size .jump_fcontext, .-.jump_fcontext
|
|---|
| 262 | # endif
|
|---|
| 263 | #endif
|
|---|
| 264 |
|
|---|
| 265 |
|
|---|
| 266 | /* Mark that we don't need executable stack. */
|
|---|
| 267 | .section .note.GNU-stack,"",%progbits
|
|---|