/* Copyright (C) 2001-2018 Free Software Foundation, Inc.

   This file is part of the GNU C Library.

   Contributed by Martin Schwidefsky (schwidefsky@de.ibm.com).

   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 <errno.h>

#include <sysdep.h>

#include <setjmp.h>

#include <bits/setjmp.h>

#include <stdlib.h>

#include <unistd.h>

#include <stap-probe.h>

/* Jump to the position specified by ENV, causing the

   setjmp call there to return VAL, or 1 if VAL is 0.  */

void

__longjmp (__jmp_buf env, int val)

{

#ifdef PTR_DEMANGLE

  uintptr_t guard = THREAD_GET_POINTER_GUARD ();

# ifdef CHECK_SP

  CHECK_SP (env, guard);

# endif

#elif defined CHECK_SP

  CHECK_SP (env, 0);

#endif

  register long int r2 __asm__ ("%r2") = val == 0 ? 1 : val;

#ifdef PTR_DEMANGLE

  register uintptr_t r3 __asm__ ("%r3") = guard;

  register void *r1 __asm__ ("%r1") = (void *) env;

#endif

  /* Restore registers and jump back.  */

  __asm__ __volatile__ (

			/* longjmp probe expects longjmp first argument, second

			   argument and target address.  */

#ifdef PTR_DEMANGLE

			"lmg  %%r4,%%r5,64(%1)\n\t"

			"xgr  %%r4,%2\n\t"

			"xgr  %%r5,%2\n\t"

			LIBC_PROBE_ASM (longjmp, 8@%1 -4@%0 8@%%r4)

#else

			LIBC_PROBE_ASM (longjmp, 8@%1 -4@%0 8@%%r14)

#endif

			/* restore fpregs  */

			"ld    %%f8,80(%1)\n\t"

			"ld    %%f9,88(%1)\n\t"

			"ld    %%f10,96(%1)\n\t"

			"ld    %%f11,104(%1)\n\t"

			"ld    %%f12,112(%1)\n\t"

			"ld    %%f13,120(%1)\n\t"

			"ld    %%f14,128(%1)\n\t"

			"ld    %%f15,136(%1)\n\t"

			/* restore gregs and return to jmp_buf target  */

#ifdef PTR_DEMANGLE

			"lmg  %%r6,%%r13,0(%1)\n\t"

			"lgr  %%r15,%%r5\n\t"

			LIBC_PROBE_ASM (longjmp_target, 8@%1 -4@%0 8@%%r4)

			"br   %%r4"

#else

			"lmg  %%r6,%%r15,0(%1)\n\t"

			LIBC_PROBE_ASM (longjmp_target, 8@%1 -4@%0 8@%%r14)

			"br   %%r14"

#endif

			: : "r" (r2),

#ifdef PTR_DEMANGLE

			  "r" (r1), "r" (r3)

#else

			  "a" (env)

#endif

			);

  /* Avoid `volatile function does return' warnings.  */

  for (;;);

}