|
Packit |
6c4009 |
/* Modify saved context.
|
|
Packit |
6c4009 |
Copyright (C) 2015-2018 Free Software Foundation, Inc.
|
|
Packit |
6c4009 |
This file is part of the GNU C Library.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
The GNU C Library is free software; you can redistribute it and/or
|
|
Packit |
6c4009 |
modify it under the terms of the GNU Lesser General Public
|
|
Packit |
6c4009 |
License as published by the Free Software Foundation; either
|
|
Packit |
6c4009 |
version 2.1 of the License, or (at your option) any later version.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
The GNU C Library is distributed in the hope that it will be useful,
|
|
Packit |
6c4009 |
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit |
6c4009 |
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Packit |
6c4009 |
Lesser General Public License for more details.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
You should have received a copy of the GNU Lesser General Public
|
|
Packit |
6c4009 |
License along with the GNU C Library; if not, see
|
|
Packit |
6c4009 |
<http://www.gnu.org/licenses/>. */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#include <sysdep.h>
|
|
Packit |
6c4009 |
#include "ucontext_i.h"
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* int swapcontext (ucontext_t *oucp, const ucontext_t *ucp) */
|
|
Packit |
6c4009 |
.text
|
|
Packit |
6c4009 |
ENTRY(__swapcontext)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Same as getcontext(). */
|
|
Packit |
6c4009 |
stw r16, (UCONTEXT_MCONTEXT + 16*4)(r4)
|
|
Packit |
6c4009 |
stw r17, (UCONTEXT_MCONTEXT + 17*4)(r4)
|
|
Packit |
6c4009 |
stw r18, (UCONTEXT_MCONTEXT + 18*4)(r4)
|
|
Packit |
6c4009 |
stw r19, (UCONTEXT_MCONTEXT + 19*4)(r4)
|
|
Packit |
6c4009 |
stw r20, (UCONTEXT_MCONTEXT + 20*4)(r4)
|
|
Packit |
6c4009 |
stw r21, (UCONTEXT_MCONTEXT + 21*4)(r4)
|
|
Packit |
6c4009 |
stw r22, (UCONTEXT_MCONTEXT + 22*4)(r4)
|
|
Packit |
6c4009 |
stw ra, (UCONTEXT_MCONTEXT + 24*4)(r4)
|
|
Packit |
6c4009 |
stw fp, (UCONTEXT_MCONTEXT + 25*4)(r4)
|
|
Packit |
6c4009 |
stw gp, (UCONTEXT_MCONTEXT + 26*4)(r4)
|
|
Packit |
6c4009 |
/* Store return address at place for EA. */
|
|
Packit |
6c4009 |
stw ra, (UCONTEXT_MCONTEXT + 28*4)(r4)
|
|
Packit |
6c4009 |
stw sp, (UCONTEXT_MCONTEXT + 29*4)(r4)
|
|
Packit |
6c4009 |
/* Store zero for return success. */
|
|
Packit |
6c4009 |
stw zero, (UCONTEXT_MCONTEXT + 2*4)(r4)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Store value "1" at uc_flags to recognize as getcontext created. */
|
|
Packit |
6c4009 |
movi r2, 1
|
|
Packit |
6c4009 |
stw r2, UCONTEXT_FLAGS(r4)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Store MCONTEXT_VERSION at first word of mcontext_t. */
|
|
Packit |
6c4009 |
movi r2, MCONTEXT_VERSION
|
|
Packit |
6c4009 |
stw r2, UCONTEXT_MCONTEXT(r4)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Save ucp to non-argument syscall preserved register. */
|
|
Packit |
6c4009 |
mov r10, r5
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Get signal mask. */
|
|
Packit |
6c4009 |
/* rt_sigprocmask (SIG_BLOCK, NULL, &ucp->uc_sigmask, _NSIG8) */
|
|
Packit |
6c4009 |
movi r7, _NSIG8
|
|
Packit |
6c4009 |
addi r6, r4, UCONTEXT_SIGMASK
|
|
Packit |
6c4009 |
mov r5, zero
|
|
Packit |
6c4009 |
movi r4, SIG_BLOCK
|
|
Packit |
6c4009 |
movi r2, SYS_ify (rt_sigprocmask)
|
|
Packit |
6c4009 |
trap
|
|
Packit |
6c4009 |
bne r7, zero, SYSCALL_ERROR_LABEL
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Same as setcontext(). */
|
|
Packit |
6c4009 |
ldw r5, UCONTEXT_FLAGS(r10)
|
|
Packit |
6c4009 |
movi r6, 1
|
|
Packit |
6c4009 |
bne r5, r6, .Lsigreturn
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Restore signal mask. */
|
|
Packit |
6c4009 |
/* rt_sigprocmask (SIG_SETMASK, &ucp->uc_sigmask, NULL, _NSIG8) */
|
|
Packit |
6c4009 |
movi r7, _NSIG8
|
|
Packit |
6c4009 |
addi r5, r10, UCONTEXT_SIGMASK
|
|
Packit |
6c4009 |
mov r6, zero
|
|
Packit |
6c4009 |
movi r4, SIG_SETMASK
|
|
Packit |
6c4009 |
movi r2, SYS_ify (rt_sigprocmask)
|
|
Packit |
6c4009 |
trap
|
|
Packit |
6c4009 |
bne r7, zero, SYSCALL_ERROR_LABEL
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Restore argument registers, for the makecontext() case. */
|
|
Packit |
6c4009 |
ldw r4, (UCONTEXT_MCONTEXT + 4*4)(r10)
|
|
Packit |
6c4009 |
ldw r5, (UCONTEXT_MCONTEXT + 5*4)(r10)
|
|
Packit |
6c4009 |
ldw r6, (UCONTEXT_MCONTEXT + 6*4)(r10)
|
|
Packit |
6c4009 |
ldw r7, (UCONTEXT_MCONTEXT + 7*4)(r10)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
ldw r16, (UCONTEXT_MCONTEXT + 16*4)(r10)
|
|
Packit |
6c4009 |
ldw r17, (UCONTEXT_MCONTEXT + 17*4)(r10)
|
|
Packit |
6c4009 |
ldw r18, (UCONTEXT_MCONTEXT + 18*4)(r10)
|
|
Packit |
6c4009 |
ldw r19, (UCONTEXT_MCONTEXT + 19*4)(r10)
|
|
Packit |
6c4009 |
ldw r20, (UCONTEXT_MCONTEXT + 20*4)(r10)
|
|
Packit |
6c4009 |
ldw r21, (UCONTEXT_MCONTEXT + 21*4)(r10)
|
|
Packit |
6c4009 |
ldw r22, (UCONTEXT_MCONTEXT + 22*4)(r10)
|
|
Packit |
6c4009 |
ldw ra, (UCONTEXT_MCONTEXT + 24*4)(r10)
|
|
Packit |
6c4009 |
ldw fp, (UCONTEXT_MCONTEXT + 25*4)(r10)
|
|
Packit |
6c4009 |
ldw gp, (UCONTEXT_MCONTEXT + 26*4)(r10)
|
|
Packit |
6c4009 |
/* Load address to continue execution. */
|
|
Packit |
6c4009 |
ldw r3, (UCONTEXT_MCONTEXT + 28*4)(r10)
|
|
Packit |
6c4009 |
ldw sp, (UCONTEXT_MCONTEXT + 29*4)(r10)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
mov r2, zero
|
|
Packit |
6c4009 |
jmp r3
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
.Lsigreturn:
|
|
Packit |
6c4009 |
addi sp, sp, -RT_SIGFRAME_SIZE
|
|
Packit |
6c4009 |
cfi_adjust_cfa_offset (RT_SIGFRAME_SIZE)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
addi r2, sp, RT_SIGFRAME_UCONTEXT
|
|
Packit |
6c4009 |
movi r3, UCONTEXT_SIZE-4
|
|
Packit |
6c4009 |
1:
|
|
Packit |
6c4009 |
add r6, r4, r3
|
|
Packit |
6c4009 |
ldw r5, 0(r6)
|
|
Packit |
6c4009 |
add r7, r2, r3
|
|
Packit |
6c4009 |
addi r3, r3, -4
|
|
Packit |
6c4009 |
stw r5, 0(r7)
|
|
Packit |
6c4009 |
bgt r3, zero, 1b
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
movi r2, SYS_ify (rt_sigreturn)
|
|
Packit |
6c4009 |
trap
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
addi sp, sp, RT_SIGFRAME_SIZE
|
|
Packit |
6c4009 |
cfi_adjust_cfa_offset (-RT_SIGFRAME_SIZE)
|
|
Packit |
6c4009 |
br SYSCALL_ERROR_LABEL
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
PSEUDO_END (__swapcontext)
|
|
Packit |
6c4009 |
weak_alias (__swapcontext, swapcontext)
|