|
Packit |
6c4009 |
/* Copyright (C) 2001-2018 Free Software Foundation, Inc.
|
|
Packit |
6c4009 |
This file is part of the GNU C Library.
|
|
Packit |
6c4009 |
Contributed by Ryan S. Arnold <rsa@us.ibm.com>
|
|
Packit |
6c4009 |
Sean Curry <spcurry@us.ibm.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 <errno.h>
|
|
Packit |
6c4009 |
#include <stdio.h>
|
|
Packit |
6c4009 |
#include <stdlib.h>
|
|
Packit |
6c4009 |
#include <string.h>
|
|
Packit |
6c4009 |
#include <ucontext.h>
|
|
Packit |
6c4009 |
#include <unistd.h>
|
|
Packit |
6c4009 |
#include <link.h>
|
|
Packit |
6c4009 |
#include <elf.h>
|
|
Packit |
6c4009 |
#include <fpu_control.h>
|
|
Packit |
6c4009 |
#include <sys/auxv.h>
|
|
Packit |
6c4009 |
#include <support/support.h>
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
static ucontext_t ctx[3];
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
volatile int global;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
static int back_in_main;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
volatile static ElfW(auxv_t) *auxv = NULL;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
ElfW(Addr) query_auxv(int type)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
FILE *auxv_f;
|
|
Packit |
6c4009 |
ElfW(auxv_t) auxv_struct;
|
|
Packit |
6c4009 |
ElfW(auxv_t) *auxv_temp;
|
|
Packit |
6c4009 |
int i = 0;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* if the /proc/self/auxv file has not been manually copied into the heap
|
|
Packit |
6c4009 |
yet, then do it */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
if(auxv == NULL)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
auxv_f = fopen("/proc/self/auxv", "r");
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
if(auxv_f == 0)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
perror("Error opening file for reading");
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
auxv = xmalloc (getpagesize ());
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
do
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
fread(&auxv_struct, sizeof(ElfW(auxv_t)), 1, auxv_f);
|
|
Packit |
6c4009 |
auxv[i] = auxv_struct;
|
|
Packit |
6c4009 |
i++;
|
|
Packit |
6c4009 |
} while(auxv_struct.a_type != AT_NULL);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
auxv_temp = (ElfW(auxv_t) *)auxv;
|
|
Packit |
6c4009 |
i = 0;
|
|
Packit |
6c4009 |
do
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if(auxv_temp[i].a_type == type)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
return auxv_temp[i].a_un.a_val;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
i++;
|
|
Packit |
6c4009 |
} while (auxv_temp[i].a_type != AT_NULL);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
typedef unsigned int di_fpscr_t __attribute__ ((__mode__ (__DI__)));
|
|
Packit |
6c4009 |
typedef unsigned int si_fpscr_t __attribute__ ((__mode__ (__SI__)));
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#define _FPSCR_RESERVED 0xfffffff8ffffff04ULL
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#define _FPSCR_TEST0_DRN 0x0000000400000000ULL
|
|
Packit |
6c4009 |
#define _FPSCR_TEST0_RN 0x0000000000000003ULL
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#define _FPSCR_TEST1_DRN 0x0000000300000000ULL
|
|
Packit |
6c4009 |
#define _FPSCR_TEST1_RN 0x0000000000000002ULL
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Macros for accessing the hardware control word on Power6[x]. */
|
|
Packit |
6c4009 |
#define _GET_DI_FPSCR(__fpscr) \
|
|
Packit |
6c4009 |
({union { double d; di_fpscr_t fpscr; } u; \
|
|
Packit |
6c4009 |
register double fr; \
|
|
Packit |
6c4009 |
__asm__ ("mffs %0" : "=f" (fr)); \
|
|
Packit |
6c4009 |
u.d = fr; \
|
|
Packit |
6c4009 |
(__fpscr) = u.fpscr; \
|
|
Packit |
6c4009 |
u.fpscr; \
|
|
Packit |
6c4009 |
})
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* We make sure to zero fp after we use it in order to prevent stale data
|
|
Packit |
6c4009 |
in an fp register from making a test-case pass erroneously. */
|
|
Packit |
6c4009 |
# define _SET_DI_FPSCR(__fpscr) \
|
|
Packit |
6c4009 |
{ union { double d; di_fpscr_t fpscr; } u; \
|
|
Packit |
6c4009 |
register double fr; \
|
|
Packit |
6c4009 |
u.fpscr = __fpscr; \
|
|
Packit |
6c4009 |
fr = u.d; \
|
|
Packit |
6c4009 |
/* Set the entire 64-bit FPSCR. */ \
|
|
Packit |
6c4009 |
__asm__ (".machine push; " \
|
|
Packit |
6c4009 |
".machine \"power6\"; " \
|
|
Packit |
6c4009 |
"mtfsf 255,%0,1,0; " \
|
|
Packit |
6c4009 |
".machine pop" : : "f" (fr)); \
|
|
Packit |
6c4009 |
fr = 0.0; \
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
# define _GET_SI_FPSCR(__fpscr) \
|
|
Packit |
6c4009 |
({union { double d; di_fpscr_t fpscr; } u; \
|
|
Packit |
6c4009 |
register double fr; \
|
|
Packit |
6c4009 |
__asm__ ("mffs %0" : "=f" (fr)); \
|
|
Packit |
6c4009 |
u.d = fr; \
|
|
Packit |
6c4009 |
(__fpscr) = (si_fpscr_t) u.fpscr; \
|
|
Packit |
6c4009 |
(si_fpscr_t) u.fpscr; \
|
|
Packit |
6c4009 |
})
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* We make sure to zero fp after we use it in order to prevent stale data
|
|
Packit |
6c4009 |
in an fp register from making a test-case pass erroneously. */
|
|
Packit |
6c4009 |
# define _SET_SI_FPSCR(__fpscr) \
|
|
Packit |
6c4009 |
{ union { double d; di_fpscr_t fpscr; } u; \
|
|
Packit |
6c4009 |
register double fr; \
|
|
Packit |
6c4009 |
/* More-or-less arbitrary; this is a QNaN. */ \
|
|
Packit |
6c4009 |
u.fpscr = 0xfff80000ULL << 32; \
|
|
Packit |
6c4009 |
u.fpscr |= __fpscr & 0xffffffffULL; \
|
|
Packit |
6c4009 |
fr = u.d; \
|
|
Packit |
6c4009 |
__asm__ ("mtfsf 255,%0" : : "f" (fr)); \
|
|
Packit |
6c4009 |
fr = 0.0; \
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
void prime_special_regs(int which)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
ElfW(Addr) a_val;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
di_fpscr_t di_fpscr __attribute__ ((__aligned__(8)));
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
a_val = query_auxv(AT_HWCAP);
|
|
Packit |
6c4009 |
if(a_val == -1)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
puts ("querying the auxv for the hwcap failed");
|
|
Packit |
6c4009 |
_exit (1);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Indicates a 64-bit FPSCR. */
|
|
Packit |
6c4009 |
if (a_val & PPC_FEATURE_HAS_DFP)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
_GET_DI_FPSCR(di_fpscr);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Overwrite the existing DRN and RN if there is one. */
|
|
Packit |
6c4009 |
if (which == 0)
|
|
Packit |
6c4009 |
di_fpscr = ((di_fpscr & _FPSCR_RESERVED) | (_FPSCR_TEST0_DRN | _FPSCR_TEST0_RN));
|
|
Packit |
6c4009 |
else
|
|
Packit |
6c4009 |
di_fpscr = ((di_fpscr & _FPSCR_RESERVED) | (_FPSCR_TEST1_DRN | _FPSCR_TEST1_RN));
|
|
Packit |
6c4009 |
puts ("Priming 64-bit FPSCR with:");
|
|
Packit |
6c4009 |
printf("0x%.16llx\n",(unsigned long long int)di_fpscr);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
_SET_DI_FPSCR(di_fpscr);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
else
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
puts ("32-bit FPSCR found and will be tested.");
|
|
Packit |
6c4009 |
_GET_SI_FPSCR(di_fpscr);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Overwrite the existing RN if there is one. */
|
|
Packit |
6c4009 |
if (which == 0)
|
|
Packit |
6c4009 |
di_fpscr = ((di_fpscr & _FPSCR_RESERVED) | (_FPSCR_TEST0_RN));
|
|
Packit |
6c4009 |
else
|
|
Packit |
6c4009 |
di_fpscr = ((di_fpscr & _FPSCR_RESERVED) | (_FPSCR_TEST1_RN));
|
|
Packit |
6c4009 |
puts ("Priming 32-bit FPSCR with:");
|
|
Packit |
6c4009 |
printf("0x%.8lx\n",(unsigned long int) di_fpscr);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
_SET_SI_FPSCR(di_fpscr);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
void clear_special_regs(void)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
ElfW(Addr) a_val;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
di_fpscr_t di_fpscr __attribute__ ((__aligned__(8)));
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
union {
|
|
Packit |
6c4009 |
double d;
|
|
Packit |
6c4009 |
unsigned long long int lli;
|
|
Packit |
6c4009 |
unsigned int li[2];
|
|
Packit |
6c4009 |
} dlli;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
a_val = query_auxv(AT_HWCAP);
|
|
Packit |
6c4009 |
if(a_val == -1)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
puts ("querying the auxv for the hwcap failed");
|
|
Packit |
6c4009 |
_exit (1);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#if __WORDSIZE == 32
|
|
Packit |
6c4009 |
dlli.d = ctx[0].uc_mcontext.uc_regs->fpregs.fpscr;
|
|
Packit |
6c4009 |
#else
|
|
Packit |
6c4009 |
dlli.d = ctx[0].uc_mcontext.fp_regs[32];
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
puts("The FPSCR value saved in the ucontext_t is:");
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Indicates a 64-bit FPSCR. */
|
|
Packit |
6c4009 |
if (a_val & PPC_FEATURE_HAS_DFP)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
printf("0x%.16llx\n",dlli.lli);
|
|
Packit |
6c4009 |
di_fpscr = 0x0;
|
|
Packit |
6c4009 |
puts ("Clearing the 64-bit FPSCR to:");
|
|
Packit |
6c4009 |
printf("0x%.16llx\n",(unsigned long long int) di_fpscr);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
_SET_DI_FPSCR(di_fpscr);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
else
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
printf("0x%.8x\n",(unsigned int) dlli.li[1]);
|
|
Packit |
6c4009 |
di_fpscr = 0x0;
|
|
Packit |
6c4009 |
puts ("Clearing the 32-bit FPSCR to:");
|
|
Packit |
6c4009 |
printf("0x%.8lx\n",(unsigned long int) di_fpscr);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
_SET_SI_FPSCR(di_fpscr);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
void test_special_regs(int which)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
ElfW(Addr) a_val;
|
|
Packit |
6c4009 |
unsigned long long int test;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
di_fpscr_t di_fpscr __attribute__ ((__aligned__(8)));
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
a_val = query_auxv(AT_HWCAP);
|
|
Packit |
6c4009 |
if(a_val == -1)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
puts ("querying the auxv for the hwcap failed");
|
|
Packit |
6c4009 |
_exit (2);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Indicates a 64-bit FPSCR. */
|
|
Packit |
6c4009 |
if (a_val & PPC_FEATURE_HAS_DFP)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
_GET_DI_FPSCR(di_fpscr);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
if (which == 0)
|
|
Packit |
6c4009 |
puts ("After setcontext the 64-bit FPSCR contains:");
|
|
Packit |
6c4009 |
else
|
|
Packit |
6c4009 |
puts ("After swapcontext the 64-bit FPSCR contains:");
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
printf("0x%.16llx\n",(unsigned long long int) di_fpscr);
|
|
Packit |
6c4009 |
test = (_FPSCR_TEST0_DRN | _FPSCR_TEST0_RN);
|
|
Packit |
6c4009 |
if((di_fpscr & (test)) != (test))
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
printf ("%s: DRN and RN bits set before getcontext were not preserved across [set|swap]context call: %m",__FUNCTION__);
|
|
Packit |
6c4009 |
_exit (3);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
else
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
_GET_SI_FPSCR(di_fpscr);
|
|
Packit |
6c4009 |
if (which == 0)
|
|
Packit |
6c4009 |
puts ("After setcontext the 32-bit FPSCR contains:");
|
|
Packit |
6c4009 |
else
|
|
Packit |
6c4009 |
puts ("After swapcontext the 32-bit FPSCR contains:");
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
printf("0x%.8lx\n",(unsigned long int) di_fpscr);
|
|
Packit |
6c4009 |
test = _FPSCR_TEST0_RN;
|
|
Packit |
6c4009 |
if((di_fpscr & test) != test)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
printf ("%s: RN bit set before getcontext was not preserved across [set|swap]context call: %m",__FUNCTION__);
|
|
Packit |
6c4009 |
_exit (4);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
static void
|
|
Packit |
6c4009 |
check_called (void)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if (back_in_main == 0)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
puts ("program did not reach main again");
|
|
Packit |
6c4009 |
_exit (5);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int
|
|
Packit |
6c4009 |
main (void)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
atexit (check_called);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
puts ("priming the FPSCR with a marker");
|
|
Packit |
6c4009 |
prime_special_regs (0);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
puts ("making contexts");
|
|
Packit |
6c4009 |
if (getcontext (&ctx[0]) != 0)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if (errno == ENOSYS)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
back_in_main = 1;
|
|
Packit |
6c4009 |
exit (0);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
printf ("%s: getcontext: %m\n", __FUNCTION__);
|
|
Packit |
6c4009 |
exit (6);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Play some tricks with this context. */
|
|
Packit |
6c4009 |
if (++global == 1)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
clear_special_regs ( );
|
|
Packit |
6c4009 |
if (setcontext (&ctx[0]) != 0)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
printf ("%s: setcontext: %m\n", __FUNCTION__);
|
|
Packit |
6c4009 |
exit (7);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
if (global != 2)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
printf ("%s: 'global' not incremented twice\n", __FUNCTION__);
|
|
Packit |
6c4009 |
exit (8);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
test_special_regs (0);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
global = 0;
|
|
Packit |
6c4009 |
if (getcontext (&ctx[0]) != 0)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
printf ("%s: getcontext: %m\n", __FUNCTION__);
|
|
Packit |
6c4009 |
exit (9);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
if (++global == 1)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
puts ("priming the FPSCR with a marker");
|
|
Packit |
6c4009 |
prime_special_regs (1);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
puts ("swapping contexts");
|
|
Packit |
6c4009 |
if (swapcontext (&ctx[1], &ctx[0]) != 0)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
printf ("%s: swapcontext: %m\n", __FUNCTION__);
|
|
Packit |
6c4009 |
exit (9);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
if (global != 2)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
printf ("%s: 'global' not incremented twice\n", __FUNCTION__);
|
|
Packit |
6c4009 |
exit (10);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
test_special_regs (1);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
puts ("back at main program");
|
|
Packit |
6c4009 |
back_in_main = 1;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
puts ("test succeeded");
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
}
|