about summary refs log tree commit diff
path: root/sysdeps/loongarch/math_private.h
blob: 40cd54c8cfb2ae01e8f395541014b9cd4ca375bd (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
/* Internal math stuff.
   Copyright (C) 2022-2024 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
   <https://www.gnu.org/licenses/>.  */

#ifndef LOONGARCH_MATH_PRIVATE_H
#define LOONGARCH_MATH_PRIVATE_H 1

/* Inline functions to speed up the math library implementation.  The
   default versions of these routines are in generic/math_private.h
   and call fesetround, feholdexcept, etc.  These routines use inlined
   code instead.  */

#ifdef __loongarch_hard_float

#include <fenv.h>
#include <fenv_libc.h>
#include <fpu_control.h>

#define _FPU_MASK_ALL \
  (_FPU_MASK_V | _FPU_MASK_Z | _FPU_MASK_O | _FPU_MASK_U | _FPU_MASK_I \
   | FE_ALL_EXCEPT)

static __always_inline void
libc_feholdexcept_loongarch (fenv_t *envp)
{
  fpu_control_t cw;

  /* Save the current state.  */
  _FPU_GETCW (cw);
  envp->__fp_control_register = cw;

  /* Clear all exception enable bits and flags.  */
  cw &= ~(_FPU_MASK_ALL);
  _FPU_SETCW (cw);
}
#define libc_feholdexcept libc_feholdexcept_loongarch
#define libc_feholdexceptf libc_feholdexcept_loongarch
#define libc_feholdexceptl libc_feholdexcept_loongarch

static __always_inline void
libc_fesetround_loongarch (int round)
{
  fpu_control_t cw;

  /* Get current state.  */
  _FPU_GETCW (cw);

  /* Set rounding bits.  */
  cw &= ~_FPU_RC_MASK;
  cw |= round;

  /* Set new state.  */
  _FPU_SETCW (cw);
}
#define libc_fesetround libc_fesetround_loongarch
#define libc_fesetroundf libc_fesetround_loongarch
#define libc_fesetroundl libc_fesetround_loongarch

static __always_inline void
libc_feholdexcept_setround_loongarch (fenv_t *envp, int round)
{
  fpu_control_t cw;

  /* Save the current state.  */
  _FPU_GETCW (cw);
  envp->__fp_control_register = cw;

  /* Clear all exception enable bits and flags.  */
  cw &= ~(_FPU_MASK_ALL);

  /* Set rounding bits.  */
  cw &= ~_FPU_RC_MASK;
  cw |= round;

  /* Set new state.  */
  _FPU_SETCW (cw);
}
#define libc_feholdexcept_setround libc_feholdexcept_setround_loongarch
#define libc_feholdexcept_setroundf libc_feholdexcept_setround_loongarch
#define libc_feholdexcept_setroundl libc_feholdexcept_setround_loongarch

#define libc_feholdsetround libc_feholdexcept_setround_loongarch
#define libc_feholdsetroundf libc_feholdexcept_setround_loongarch
#define libc_feholdsetroundl libc_feholdexcept_setround_loongarch

static __always_inline void
libc_fesetenv_loongarch (fenv_t *envp)
{
  fpu_control_t cw __attribute__ ((unused));

  /* Read current state to flush fpu pipeline.  */
  _FPU_GETCW (cw);

  _FPU_SETCW (envp->__fp_control_register);
}
#define libc_fesetenv libc_fesetenv_loongarch
#define libc_fesetenvf libc_fesetenv_loongarch
#define libc_fesetenvl libc_fesetenv_loongarch

static __always_inline int
libc_feupdateenv_test_loongarch (fenv_t *envp, int excepts)
{
  /* int ret = fetestexcept (excepts); feupdateenv (envp); return ret; */
  int cw, temp;

  /* Get current control word.  */
  _FPU_GETCW (cw);

  /* Set flag bits (which are accumulative), and *also* set the
     cause bits.  The setting of the cause bits is what actually causes
     the hardware to generate the exception, if the corresponding enable
     bit is set as well.  */
  temp = cw & FE_ALL_EXCEPT;
  temp |= envp->__fp_control_register | (temp << CAUSE_SHIFT);

  /* Set new state.  */
  _FPU_SETCW (temp);

  return cw & excepts & FE_ALL_EXCEPT;
}
#define libc_feupdateenv_test libc_feupdateenv_test_loongarch
#define libc_feupdateenv_testf libc_feupdateenv_test_loongarch
#define libc_feupdateenv_testl libc_feupdateenv_test_loongarch

static __always_inline void
libc_feupdateenv_loongarch (fenv_t *envp)
{
  libc_feupdateenv_test_loongarch (envp, 0);
}
#define libc_feupdateenv libc_feupdateenv_loongarch
#define libc_feupdateenvf libc_feupdateenv_loongarch
#define libc_feupdateenvl libc_feupdateenv_loongarch

#define libc_feresetround libc_feupdateenv_loongarch
#define libc_feresetroundf libc_feupdateenv_loongarch
#define libc_feresetroundl libc_feupdateenv_loongarch

static __always_inline int
libc_fetestexcept_loongarch (int excepts)
{
  int cw;

  /* Get current control word.  */
  _FPU_GETCW (cw);

  return cw & excepts & FE_ALL_EXCEPT;
}
#define libc_fetestexcept libc_fetestexcept_loongarch
#define libc_fetestexceptf libc_fetestexcept_loongarch
#define libc_fetestexceptl libc_fetestexcept_loongarch

/*  Enable support for rounding mode context.  */
#define HAVE_RM_CTX 1

static __always_inline void
libc_feholdexcept_setround_loongarch_ctx (struct rm_ctx *ctx, int round)
{
  fpu_control_t old, new;

  /* Save the current state.  */
  _FPU_GETCW (old);
  ctx->env.__fp_control_register = old;

  /* Clear all exception enable bits and flags.  */
  new = old & ~(_FPU_MASK_ALL);

  /* Set rounding bits.  */
  new = (new & ~_FPU_RC_MASK) | round;

  if (__glibc_unlikely (new != old))
    {
      _FPU_SETCW (new);
      ctx->updated_status = true;
    }
  else
    ctx->updated_status = false;
}
#define libc_feholdexcept_setround_ctx libc_feholdexcept_setround_loongarch_ctx
#define libc_feholdexcept_setroundf_ctx \
  libc_feholdexcept_setround_loongarch_ctx
#define libc_feholdexcept_setroundl_ctx \
  libc_feholdexcept_setround_loongarch_ctx

static __always_inline void
libc_fesetenv_loongarch_ctx (struct rm_ctx *ctx)
{
  libc_fesetenv_loongarch (&ctx->env);
}
#define libc_fesetenv_ctx libc_fesetenv_loongarch_ctx
#define libc_fesetenvf_ctx libc_fesetenv_loongarch_ctx
#define libc_fesetenvl_ctx libc_fesetenv_loongarch_ctx

static __always_inline void
libc_feupdateenv_loongarch_ctx (struct rm_ctx *ctx)
{
  if (__glibc_unlikely (ctx->updated_status))
    libc_feupdateenv_test_loongarch (&ctx->env, 0);
}
#define libc_feupdateenv_ctx libc_feupdateenv_loongarch_ctx
#define libc_feupdateenvf_ctx libc_feupdateenv_loongarch_ctx
#define libc_feupdateenvl_ctx libc_feupdateenv_loongarch_ctx
#define libc_feresetround_ctx libc_feupdateenv_loongarch_ctx
#define libc_feresetroundf_ctx libc_feupdateenv_loongarch_ctx
#define libc_feresetroundl_ctx libc_feupdateenv_loongarch_ctx

static __always_inline void
libc_feholdsetround_loongarch_ctx (struct rm_ctx *ctx, int round)
{
  fpu_control_t old, new;

  /* Save the current state.  */
  _FPU_GETCW (old);
  ctx->env.__fp_control_register = old;

  /* Set rounding bits.  */
  new = (old & ~_FPU_RC_MASK) | round;

  if (__glibc_unlikely (new != old))
    {
      _FPU_SETCW (new);
      ctx->updated_status = true;
    }
  else
    ctx->updated_status = false;
}
#define libc_feholdsetround_ctx libc_feholdsetround_loongarch_ctx
#define libc_feholdsetroundf_ctx libc_feholdsetround_loongarch_ctx
#define libc_feholdsetroundl_ctx libc_feholdsetround_loongarch_ctx

#endif

#include_next <math_private.h>

#endif