Blame sysdeps/unix/sysv/linux/mips/swapcontext.S

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)