|
Packit |
6c4009 |
/* Save and set current context.
|
|
Packit |
6c4009 |
Copyright (C) 2009-2018 Free Software Foundation, Inc.
|
|
Packit |
6c4009 |
This file is part of the GNU C Library.
|
|
Packit |
6c4009 |
Contributed by Maciej W. Rozycki <macro@codesourcery.com>.
|
|
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 <sys/asm.h>
|
|
Packit |
6c4009 |
#include <sys/fpregdef.h>
|
|
Packit |
6c4009 |
#include <sys/regdef.h>
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#include "ucontext_i.h"
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* int swapcontext (ucontext_t *oucp, const ucontext_t *ucp) */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
.text
|
|
Packit |
6c4009 |
.set nomips16
|
|
Packit |
6c4009 |
LOCALSZ = 0
|
|
Packit |
6c4009 |
ARGSZ = 0
|
|
Packit |
6c4009 |
MASK = 0x00000000
|
|
Packit |
6c4009 |
#ifdef __PIC__
|
|
Packit |
6c4009 |
LOCALSZ = 1 /* save gp */
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
#if _MIPS_SIM != _ABIO32
|
|
Packit |
6c4009 |
ARGSZ = 1 /* save a1 */
|
|
Packit |
6c4009 |
# ifdef __PIC__
|
|
Packit |
6c4009 |
MASK = 0x10000000
|
|
Packit |
6c4009 |
# endif
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
FRAMESZ = (((ARGSZ + LOCALSZ) * SZREG) + ALSZ) & ALMASK
|
|
Packit |
6c4009 |
GPOFF = FRAMESZ - ((ARGSZ + 1) * SZREG)
|
|
Packit |
6c4009 |
#if _MIPS_SIM != _ABIO32
|
|
Packit |
6c4009 |
A1OFF = FRAMESZ - (1 * SZREG) /* callee-allocated */
|
|
Packit |
6c4009 |
#else
|
|
Packit |
6c4009 |
A1OFF = FRAMESZ + (1 * SZREG) /* caller-allocated */
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
MCONTEXT_GREGSZ = 8
|
|
Packit |
6c4009 |
#if _MIPS_SIM == _ABIO32 && __BYTE_ORDER__ == __ORDER_BIG_ENDIAN__
|
|
Packit |
6c4009 |
MCONTEXT_GREGOFF = 4
|
|
Packit |
6c4009 |
#else
|
|
Packit |
6c4009 |
MCONTEXT_GREGOFF = 0
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
NESTED (__swapcontext, FRAMESZ, ra)
|
|
Packit |
6c4009 |
.mask MASK, -(ARGSZ * SZREG)
|
|
Packit |
6c4009 |
.fmask 0x00000000, 0
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#ifdef __PIC__
|
|
Packit |
6c4009 |
SETUP_GP
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
move a2, sp
|
|
Packit |
6c4009 |
# define _SP a2
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
# if _MIPS_SIM != _ABIO32
|
|
Packit |
6c4009 |
move a3, gp
|
|
Packit |
6c4009 |
# define _GP a3
|
|
Packit |
6c4009 |
# endif
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
PTR_ADDIU sp, -FRAMESZ
|
|
Packit |
6c4009 |
cfi_adjust_cfa_offset (FRAMESZ)
|
|
Packit |
6c4009 |
SETUP_GP64_STACK (GPOFF, __swapcontext)
|
|
Packit |
6c4009 |
SAVE_GP (GPOFF)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#else /* ! __PIC__ */
|
|
Packit |
6c4009 |
# define _SP sp
|
|
Packit |
6c4009 |
# define _GP gp
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#endif /* ! __PIC__ */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#ifdef PROF
|
|
Packit |
6c4009 |
.set noat
|
|
Packit |
6c4009 |
move AT, ra
|
|
Packit |
6c4009 |
jal _mcount
|
|
Packit |
6c4009 |
.set at
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Store a magic flag. */
|
|
Packit |
6c4009 |
li v1, 1
|
|
Packit |
6c4009 |
/* zero */
|
|
Packit |
6c4009 |
REG_S v1, (MCONTEXT_GREGOFF + 0 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
REG_S s0, (MCONTEXT_GREGOFF + 16 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S s1, (MCONTEXT_GREGOFF + 17 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S s2, (MCONTEXT_GREGOFF + 18 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S s3, (MCONTEXT_GREGOFF + 19 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S s4, (MCONTEXT_GREGOFF + 20 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S s5, (MCONTEXT_GREGOFF + 21 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S s6, (MCONTEXT_GREGOFF + 22 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S s7, (MCONTEXT_GREGOFF + 23 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
#if ! defined (__PIC__) || _MIPS_SIM != _ABIO32
|
|
Packit |
6c4009 |
REG_S _GP, (MCONTEXT_GREGOFF + 28 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
REG_S _SP, (MCONTEXT_GREGOFF + 29 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S fp, (MCONTEXT_GREGOFF + 30 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S ra, (MCONTEXT_GREGOFF + 31 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(a0)
|
|
Packit |
6c4009 |
REG_S ra, (MCONTEXT_GREGOFF + MCONTEXT_PC)(a0)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#ifdef __mips_hard_float
|
|
Packit |
6c4009 |
# if _MIPS_SIM == _ABI64
|
|
Packit |
6c4009 |
s.d fs0, (24 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs1, (25 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs2, (26 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs3, (27 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs4, (28 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs5, (29 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs6, (30 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs7, (31 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
# else /* _MIPS_SIM != _ABI64 */
|
|
Packit |
6c4009 |
s.d fs0, (20 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs1, (22 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs2, (24 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs3, (26 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs4, (28 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
s.d fs5, (30 * SZREG + MCONTEXT_FPREGS)(a0)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
# endif /* _MIPS_SIM != _ABI64 */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
cfc1 v1, fcr31
|
|
Packit |
6c4009 |
sw v1, MCONTEXT_FPC_CSR(a0)
|
|
Packit |
6c4009 |
#endif /* __mips_hard_float */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
REG_S a1, A1OFF(sp)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* rt_sigprocmask (SIG_SETMASK, &ucp->uc_sigmask, &oucp->uc_sigmask, _NSIG8) */
|
|
Packit |
6c4009 |
li a3, _NSIG8
|
|
Packit |
6c4009 |
PTR_ADDU a2, a0, UCONTEXT_SIGMASK
|
|
Packit |
6c4009 |
PTR_ADDU a1, a1, UCONTEXT_SIGMASK
|
|
Packit |
6c4009 |
li a0, SIG_SETMASK
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
li v0, SYS_ify (rt_sigprocmask)
|
|
Packit |
6c4009 |
syscall
|
|
Packit |
6c4009 |
bnez a3, 99f
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
REG_L v0, A1OFF(sp)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#ifdef __mips_hard_float
|
|
Packit |
6c4009 |
# if _MIPS_SIM == _ABI64
|
|
Packit |
6c4009 |
l.d fs0, (24 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs1, (25 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs2, (26 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs3, (27 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs4, (28 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs5, (29 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs6, (30 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs7, (31 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
# else /* _MIPS_SIM != _ABI64 */
|
|
Packit |
6c4009 |
l.d fs0, (20 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs1, (22 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs2, (24 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs3, (26 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs4, (28 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
l.d fs5, (30 * SZREG + MCONTEXT_FPREGS)(v0)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
# endif /* _MIPS_SIM != _ABI64 */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
lw v1, MCONTEXT_FPC_CSR(v0)
|
|
Packit |
6c4009 |
ctc1 v1, fcr31
|
|
Packit |
6c4009 |
#endif /* __mips_hard_float */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Note the contents of argument registers will be random
|
|
Packit |
6c4009 |
unless makecontext() has been called. */
|
|
Packit |
6c4009 |
REG_L a0, (MCONTEXT_GREGOFF + 4 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L a1, (MCONTEXT_GREGOFF + 5 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L a2, (MCONTEXT_GREGOFF + 6 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L a3, (MCONTEXT_GREGOFF + 7 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
#if _MIPS_SIM != _ABIO32
|
|
Packit |
6c4009 |
REG_L a4, (MCONTEXT_GREGOFF + 8 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L a5, (MCONTEXT_GREGOFF + 9 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L a6, (MCONTEXT_GREGOFF + 10 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L a7, (MCONTEXT_GREGOFF + 11 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
REG_L s0, (MCONTEXT_GREGOFF + 16 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L s1, (MCONTEXT_GREGOFF + 17 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L s2, (MCONTEXT_GREGOFF + 18 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L s3, (MCONTEXT_GREGOFF + 19 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L s4, (MCONTEXT_GREGOFF + 20 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L s5, (MCONTEXT_GREGOFF + 21 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L s6, (MCONTEXT_GREGOFF + 22 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L s7, (MCONTEXT_GREGOFF + 23 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
#if ! defined (__PIC__) || _MIPS_SIM != _ABIO32
|
|
Packit |
6c4009 |
REG_L gp, (MCONTEXT_GREGOFF + 28 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
REG_L sp, (MCONTEXT_GREGOFF + 29 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L fp, (MCONTEXT_GREGOFF + 30 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L ra, (MCONTEXT_GREGOFF + 31 * MCONTEXT_GREGSZ + MCONTEXT_GREGS)(v0)
|
|
Packit |
6c4009 |
REG_L t9, (MCONTEXT_GREGOFF + MCONTEXT_PC)(v0)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
move v0, zero
|
|
Packit |
6c4009 |
jr t9
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
99:
|
|
Packit |
6c4009 |
#ifdef __PIC__
|
|
Packit |
6c4009 |
PTR_LA t9, JUMPTARGET (__syscall_error)
|
|
Packit |
6c4009 |
RESTORE_GP64_STACK
|
|
Packit |
6c4009 |
PTR_ADDIU sp, FRAMESZ
|
|
Packit |
6c4009 |
cfi_adjust_cfa_offset (-FRAMESZ)
|
|
Packit |
6c4009 |
jr t9
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#else /* ! __PIC__ */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
j JUMPTARGET (__syscall_error)
|
|
Packit |
6c4009 |
#endif /* ! __PIC__ */
|
|
Packit |
6c4009 |
PSEUDO_END (__swapcontext)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
weak_alias (__swapcontext, swapcontext)
|