| /* Private floating point rounding and exceptions handling. ARM VFP version. |
| Copyright (C) 2014-2018 Free Software Foundation, Inc. |
| This file is part of the GNU C Library. |
| |
| 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/>. */ |
| |
| #ifndef FENV_PRIVATE_H |
| #define FENV_PRIVATE_H 1 |
| |
| #include <fenv.h> |
| #include <fpu_control.h> |
| |
| static __always_inline void |
| libc_feholdexcept_vfp (fenv_t *envp) |
| { |
| fpu_control_t fpscr; |
| |
| _FPU_GETCW (fpscr); |
| envp->__cw = fpscr; |
| |
| /* Clear exception flags and set all exceptions to non-stop. */ |
| fpscr &= ~_FPU_MASK_EXCEPT; |
| _FPU_SETCW (fpscr); |
| } |
| |
| static __always_inline void |
| libc_fesetround_vfp (int round) |
| { |
| fpu_control_t fpscr; |
| |
| _FPU_GETCW (fpscr); |
| |
| /* Set new rounding mode if different. */ |
| if (__glibc_unlikely ((fpscr & _FPU_MASK_RM) != round)) |
| _FPU_SETCW ((fpscr & ~_FPU_MASK_RM) | round); |
| } |
| |
| static __always_inline void |
| libc_feholdexcept_setround_vfp (fenv_t *envp, int round) |
| { |
| fpu_control_t fpscr; |
| |
| _FPU_GETCW (fpscr); |
| envp->__cw = fpscr; |
| |
| /* Clear exception flags, set all exceptions to non-stop, |
| and set new rounding mode. */ |
| fpscr &= ~(_FPU_MASK_EXCEPT | _FPU_MASK_RM); |
| _FPU_SETCW (fpscr | round); |
| } |
| |
| static __always_inline void |
| libc_feholdsetround_vfp (fenv_t *envp, int round) |
| { |
| fpu_control_t fpscr; |
| |
| _FPU_GETCW (fpscr); |
| envp->__cw = fpscr; |
| |
| /* Set new rounding mode if different. */ |
| if (__glibc_unlikely ((fpscr & _FPU_MASK_RM) != round)) |
| _FPU_SETCW ((fpscr & ~_FPU_MASK_RM) | round); |
| } |
| |
| static __always_inline void |
| libc_feresetround_vfp (fenv_t *envp) |
| { |
| fpu_control_t fpscr, round; |
| |
| _FPU_GETCW (fpscr); |
| |
| /* Check whether rounding modes are different. */ |
| round = (envp->__cw ^ fpscr) & _FPU_MASK_RM; |
| |
| /* Restore the rounding mode if it was changed. */ |
| if (__glibc_unlikely (round != 0)) |
| _FPU_SETCW (fpscr ^ round); |
| } |
| |
| static __always_inline int |
| libc_fetestexcept_vfp (int ex) |
| { |
| fpu_control_t fpscr; |
| |
| _FPU_GETCW (fpscr); |
| return fpscr & ex & FE_ALL_EXCEPT; |
| } |
| |
| static __always_inline void |
| libc_fesetenv_vfp (const fenv_t *envp) |
| { |
| fpu_control_t fpscr, new_fpscr; |
| |
| _FPU_GETCW (fpscr); |
| new_fpscr = envp->__cw; |
| |
| /* Write new FPSCR if different (ignoring NZCV flags). */ |
| if (__glibc_unlikely (((fpscr ^ new_fpscr) & ~_FPU_MASK_NZCV) != 0)) |
| _FPU_SETCW (new_fpscr); |
| } |
| |
| static __always_inline int |
| libc_feupdateenv_test_vfp (const fenv_t *envp, int ex) |
| { |
| fpu_control_t fpscr, new_fpscr; |
| int excepts; |
| |
| _FPU_GETCW (fpscr); |
| |
| /* Merge current exception flags with the saved fenv. */ |
| excepts = fpscr & FE_ALL_EXCEPT; |
| new_fpscr = envp->__cw | excepts; |
| |
| /* Write new FPSCR if different (ignoring NZCV flags). */ |
| if (__glibc_unlikely (((fpscr ^ new_fpscr) & ~_FPU_MASK_NZCV) != 0)) |
| _FPU_SETCW (new_fpscr); |
| |
| /* Raise the exceptions if enabled in the new FP state. */ |
| if (__glibc_unlikely (excepts & (new_fpscr >> FE_EXCEPT_SHIFT))) |
| __feraiseexcept (excepts); |
| |
| return excepts & ex; |
| } |
| |
| static __always_inline void |
| libc_feupdateenv_vfp (const fenv_t *envp) |
| { |
| libc_feupdateenv_test_vfp (envp, 0); |
| } |
| |
| static __always_inline void |
| libc_feholdsetround_vfp_ctx (struct rm_ctx *ctx, int r) |
| { |
| fpu_control_t fpscr, round; |
| |
| _FPU_GETCW (fpscr); |
| ctx->updated_status = false; |
| ctx->env.__cw = fpscr; |
| |
| /* Check whether rounding modes are different. */ |
| round = (fpscr ^ r) & _FPU_MASK_RM; |
| |
| /* Set the rounding mode if changed. */ |
| if (__glibc_unlikely (round != 0)) |
| { |
| ctx->updated_status = true; |
| _FPU_SETCW (fpscr ^ round); |
| } |
| } |
| |
| static __always_inline void |
| libc_feresetround_vfp_ctx (struct rm_ctx *ctx) |
| { |
| /* Restore the rounding mode if updated. */ |
| if (__glibc_unlikely (ctx->updated_status)) |
| { |
| fpu_control_t fpscr; |
| |
| _FPU_GETCW (fpscr); |
| fpscr = (fpscr & ~_FPU_MASK_RM) | (ctx->env.__cw & _FPU_MASK_RM); |
| _FPU_SETCW (fpscr); |
| } |
| } |
| |
| static __always_inline void |
| libc_fesetenv_vfp_ctx (struct rm_ctx *ctx) |
| { |
| fpu_control_t fpscr, new_fpscr; |
| |
| _FPU_GETCW (fpscr); |
| new_fpscr = ctx->env.__cw; |
| |
| /* Write new FPSCR if different (ignoring NZCV flags). */ |
| if (__glibc_unlikely (((fpscr ^ new_fpscr) & ~_FPU_MASK_NZCV) != 0)) |
| _FPU_SETCW (new_fpscr); |
| } |
| |
| #ifndef __SOFTFP__ |
| |
| # define libc_feholdexcept libc_feholdexcept_vfp |
| # define libc_feholdexceptf libc_feholdexcept_vfp |
| # define libc_feholdexceptl libc_feholdexcept_vfp |
| |
| # define libc_fesetround libc_fesetround_vfp |
| # define libc_fesetroundf libc_fesetround_vfp |
| # define libc_fesetroundl libc_fesetround_vfp |
| |
| # define libc_feresetround libc_feresetround_vfp |
| # define libc_feresetroundf libc_feresetround_vfp |
| # define libc_feresetroundl libc_feresetround_vfp |
| |
| # define libc_feresetround_noex libc_fesetenv_vfp |
| # define libc_feresetround_noexf libc_fesetenv_vfp |
| # define libc_feresetround_noexl libc_fesetenv_vfp |
| |
| # define libc_feholdexcept_setround libc_feholdexcept_setround_vfp |
| # define libc_feholdexcept_setroundf libc_feholdexcept_setround_vfp |
| # define libc_feholdexcept_setroundl libc_feholdexcept_setround_vfp |
| |
| # define libc_feholdsetround libc_feholdsetround_vfp |
| # define libc_feholdsetroundf libc_feholdsetround_vfp |
| # define libc_feholdsetroundl libc_feholdsetround_vfp |
| |
| # define libc_fetestexcept libc_fetestexcept_vfp |
| # define libc_fetestexceptf libc_fetestexcept_vfp |
| # define libc_fetestexceptl libc_fetestexcept_vfp |
| |
| # define libc_fesetenv libc_fesetenv_vfp |
| # define libc_fesetenvf libc_fesetenv_vfp |
| # define libc_fesetenvl libc_fesetenv_vfp |
| |
| # define libc_feupdateenv libc_feupdateenv_vfp |
| # define libc_feupdateenvf libc_feupdateenv_vfp |
| # define libc_feupdateenvl libc_feupdateenv_vfp |
| |
| # define libc_feupdateenv_test libc_feupdateenv_test_vfp |
| # define libc_feupdateenv_testf libc_feupdateenv_test_vfp |
| # define libc_feupdateenv_testl libc_feupdateenv_test_vfp |
| |
| /* We have support for rounding mode context. */ |
| #define HAVE_RM_CTX 1 |
| |
| # define libc_feholdsetround_ctx libc_feholdsetround_vfp_ctx |
| # define libc_feresetround_ctx libc_feresetround_vfp_ctx |
| # define libc_feresetround_noex_ctx libc_fesetenv_vfp_ctx |
| |
| # define libc_feholdsetroundf_ctx libc_feholdsetround_vfp_ctx |
| # define libc_feresetroundf_ctx libc_feresetround_vfp_ctx |
| # define libc_feresetround_noexf_ctx libc_fesetenv_vfp_ctx |
| |
| # define libc_feholdsetroundl_ctx libc_feholdsetround_vfp_ctx |
| # define libc_feresetroundl_ctx libc_feresetround_vfp_ctx |
| # define libc_feresetround_noexl_ctx libc_fesetenv_vfp_ctx |
| |
| #endif |
| |
| #endif /* FENV_PRIVATE_H */ |