target/xtensa/fpu_helper.c

   1 /*
   2  * Copyright (c) 2011 - 2019, Max Filippov, Open Source and Linux Lab.
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions are met:
   7  *     * Redistributions of source code must retain the above copyright
   8  *       notice, this list of conditions and the following disclaimer.
   9  *     * Redistributions in binary form must reproduce the above copyright
  10  *       notice, this list of conditions and the following disclaimer in the
  11  *       documentation and/or other materials provided with the distribution.
  12  *     * Neither the name of the Open Source and Linux Lab nor the
  13  *       names of its contributors may be used to endorse or promote products
  14  *       derived from this software without specific prior written permission.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  17  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  19  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  20  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  21  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  22  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  23  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  25  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  26  */
  27
  28 #include "qemu/osdep.h"
  29 #include "qemu/main-loop.h"
  30 #include "cpu.h"
  31 #include "exec/helper-proto.h"
  32 #include "qemu/host-utils.h"
  33 #include "exec/exec-all.h"
  34 #include "fpu/softfloat.h"
  35
  36 enum {
  37     XTENSA_FP_I = 0x1,
  38     XTENSA_FP_U = 0x2,
  39     XTENSA_FP_O = 0x4,
  40     XTENSA_FP_Z = 0x8,
  41     XTENSA_FP_V = 0x10,
  42 };
  43
  44 enum {
  45     XTENSA_FCR_FLAGS_SHIFT = 2,
  46     XTENSA_FSR_FLAGS_SHIFT = 7,
  47 };
  48
  49 static const struct {
  50     uint32_t xtensa_fp_flag;
  51     int softfloat_fp_flag;
  52 } xtensa_fp_flag_map[] = {
  53     { XTENSA_FP_I, float_flag_inexact, },
  54     { XTENSA_FP_U, float_flag_underflow, },
  55     { XTENSA_FP_O, float_flag_overflow, },
  56     { XTENSA_FP_Z, float_flag_divbyzero, },
  57     { XTENSA_FP_V, float_flag_invalid, },
  58 };
  59
  60 void HELPER(wur_fpu2k_fcr)(CPUXtensaState *env, uint32_t v)
  61 {
  62     static const int rounding_mode[] = {
  63         float_round_nearest_even,
  64         float_round_to_zero,
  65         float_round_up,
  66         float_round_down,
  67     };
  68
  69     env->uregs[FCR] = v & 0xfffff07f;
  70     set_float_rounding_mode(rounding_mode[v & 3], &env->fp_status);
  71 }
  72
  73 void HELPER(wur_fpu_fcr)(CPUXtensaState *env, uint32_t v)
  74 {
  75     static const int rounding_mode[] = {
  76         float_round_nearest_even,
  77         float_round_to_zero,
  78         float_round_up,
  79         float_round_down,
  80     };
  81
  82     if (v & 0xfffff000) {
  83         qemu_log_mask(LOG_GUEST_ERROR,
  84                       "MBZ field of FCR is written non-zero: %08x\n", v);
  85     }
  86     env->uregs[FCR] = v & 0x0000007f;
  87     set_float_rounding_mode(rounding_mode[v & 3], &env->fp_status);
  88 }
  89
  90 void HELPER(wur_fpu_fsr)(CPUXtensaState *env, uint32_t v)
  91 {
  92     uint32_t flags = v >> XTENSA_FSR_FLAGS_SHIFT;
  93     int fef = 0;
  94     unsigned i;
  95
  96     if (v & 0xfffff000) {
  97         qemu_log_mask(LOG_GUEST_ERROR,
  98                       "MBZ field of FSR is written non-zero: %08x\n", v);
  99     }
 100     env->uregs[FSR] = v & 0x00000f80;
 101     for (i = 0; i < ARRAY_SIZE(xtensa_fp_flag_map); ++i) {
 102         if (flags & xtensa_fp_flag_map[i].xtensa_fp_flag) {
 103             fef |= xtensa_fp_flag_map[i].softfloat_fp_flag;
 104         }
 105     }
 106     set_float_exception_flags(fef, &env->fp_status);
 107 }
 108
 109 uint32_t HELPER(rur_fpu_fsr)(CPUXtensaState *env)
 110 {
 111     uint32_t flags = 0;
 112     int fef = get_float_exception_flags(&env->fp_status);
 113     unsigned i;
 114
 115     for (i = 0; i < ARRAY_SIZE(xtensa_fp_flag_map); ++i) {
 116         if (fef & xtensa_fp_flag_map[i].softfloat_fp_flag) {
 117             flags |= xtensa_fp_flag_map[i].xtensa_fp_flag;
 118         }
 119     }
 120     env->uregs[FSR] = flags << XTENSA_FSR_FLAGS_SHIFT;
 121     return flags << XTENSA_FSR_FLAGS_SHIFT;
 122 }
 123
 124 float64 HELPER(abs_d)(float64 v)
 125 {
 126     return float64_abs(v);
 127 }
 128
 129 float32 HELPER(abs_s)(float32 v)
 130 {
 131     return float32_abs(v);
 132 }
 133
 134 float64 HELPER(neg_d)(float64 v)
 135 {
 136     return float64_chs(v);
 137 }
 138
 139 float32 HELPER(neg_s)(float32 v)
 140 {
 141     return float32_chs(v);
 142 }
 143
 144 float32 HELPER(fpu2k_add_s)(CPUXtensaState *env, float32 a, float32 b)
 145 {
 146     return float32_add(a, b, &env->fp_status);
 147 }
 148
 149 float32 HELPER(fpu2k_sub_s)(CPUXtensaState *env, float32 a, float32 b)
 150 {
 151     return float32_sub(a, b, &env->fp_status);
 152 }
 153
 154 float32 HELPER(fpu2k_mul_s)(CPUXtensaState *env, float32 a, float32 b)
 155 {
 156     return float32_mul(a, b, &env->fp_status);
 157 }
 158
 159 float32 HELPER(fpu2k_madd_s)(CPUXtensaState *env,
 160                              float32 a, float32 b, float32 c)
 161 {
 162     return float32_muladd(b, c, a, 0, &env->fp_status);
 163 }
 164
 165 float32 HELPER(fpu2k_msub_s)(CPUXtensaState *env,
 166                              float32 a, float32 b, float32 c)
 167 {
 168     return float32_muladd(b, c, a, float_muladd_negate_product,
 169                           &env->fp_status);
 170 }
 171
 172 float64 HELPER(add_d)(CPUXtensaState *env, float64 a, float64 b)
 173 {
 174     set_use_first_nan(true, &env->fp_status);
 175     return float64_add(a, b, &env->fp_status);
 176 }
 177
 178 float32 HELPER(add_s)(CPUXtensaState *env, float32 a, float32 b)
 179 {
 180     set_use_first_nan(env->config->use_first_nan, &env->fp_status);
 181     return float32_add(a, b, &env->fp_status);
 182 }
 183
 184 float64 HELPER(sub_d)(CPUXtensaState *env, float64 a, float64 b)
 185 {
 186     set_use_first_nan(true, &env->fp_status);
 187     return float64_sub(a, b, &env->fp_status);
 188 }
 189
 190 float32 HELPER(sub_s)(CPUXtensaState *env, float32 a, float32 b)
 191 {
 192     set_use_first_nan(env->config->use_first_nan, &env->fp_status);
 193     return float32_sub(a, b, &env->fp_status);
 194 }
 195
 196 float64 HELPER(mul_d)(CPUXtensaState *env, float64 a, float64 b)
 197 {
 198     set_use_first_nan(true, &env->fp_status);
 199     return float64_mul(a, b, &env->fp_status);
 200 }
 201
 202 float32 HELPER(mul_s)(CPUXtensaState *env, float32 a, float32 b)
 203 {
 204     set_use_first_nan(env->config->use_first_nan, &env->fp_status);
 205     return float32_mul(a, b, &env->fp_status);
 206 }
 207
 208 float64 HELPER(madd_d)(CPUXtensaState *env, float64 a, float64 b, float64 c)
 209 {
 210     set_use_first_nan(env->config->use_first_nan, &env->fp_status);
 211     return float64_muladd(b, c, a, 0, &env->fp_status);
 212 }
 213
 214 float32 HELPER(madd_s)(CPUXtensaState *env, float32 a, float32 b, float32 c)
 215 {
 216     set_use_first_nan(env->config->use_first_nan, &env->fp_status);
 217     return float32_muladd(b, c, a, 0, &env->fp_status);
 218 }
 219
 220 float64 HELPER(msub_d)(CPUXtensaState *env, float64 a, float64 b, float64 c)
 221 {
 222     set_use_first_nan(env->config->use_first_nan, &env->fp_status);
 223     return float64_muladd(b, c, a, float_muladd_negate_product,
 224                           &env->fp_status);
 225 }
 226
 227 float32 HELPER(msub_s)(CPUXtensaState *env, float32 a, float32 b, float32 c)
 228 {
 229     set_use_first_nan(env->config->use_first_nan, &env->fp_status);
 230     return float32_muladd(b, c, a, float_muladd_negate_product,
 231                           &env->fp_status);
 232 }
 233
 234 float64 HELPER(mkdadj_d)(CPUXtensaState *env, float64 a, float64 b)
 235 {
 236     set_use_first_nan(true, &env->fp_status);
 237     return float64_div(b, a, &env->fp_status);
 238 }
 239
 240 float32 HELPER(mkdadj_s)(CPUXtensaState *env, float32 a, float32 b)
 241 {
 242     set_use_first_nan(env->config->use_first_nan, &env->fp_status);
 243     return float32_div(b, a, &env->fp_status);
 244 }
 245
 246 float64 HELPER(mksadj_d)(CPUXtensaState *env, float64 v)
 247 {
 248     set_use_first_nan(true, &env->fp_status);
 249     return float64_sqrt(v, &env->fp_status);
 250 }
 251
 252 float32 HELPER(mksadj_s)(CPUXtensaState *env, float32 v)
 253 {
 254     set_use_first_nan(env->config->use_first_nan, &env->fp_status);
 255     return float32_sqrt(v, &env->fp_status);
 256 }
 257
 258 uint32_t HELPER(ftoi_d)(CPUXtensaState *env, float64 v,
 259                         uint32_t rounding_mode, uint32_t scale)
 260 {
 261     float_status fp_status = env->fp_status;
 262     uint32_t res;
 263
 264     set_float_rounding_mode(rounding_mode, &fp_status);
 265     res = float64_to_int32(float64_scalbn(v, scale, &fp_status), &fp_status);
 266     set_float_exception_flags(get_float_exception_flags(&fp_status),
 267                               &env->fp_status);
 268     return res;
 269 }
 270
 271 uint32_t HELPER(ftoi_s)(CPUXtensaState *env, float32 v,
 272                         uint32_t rounding_mode, uint32_t scale)
 273 {
 274     float_status fp_status = env->fp_status;
 275     uint32_t res;
 276
 277     set_float_rounding_mode(rounding_mode, &fp_status);
 278     res = float32_to_int32(float32_scalbn(v, scale, &fp_status), &fp_status);
 279     set_float_exception_flags(get_float_exception_flags(&fp_status),
 280                               &env->fp_status);
 281     return res;
 282 }
 283
 284 uint32_t HELPER(ftoui_d)(CPUXtensaState *env, float64 v,
 285                          uint32_t rounding_mode, uint32_t scale)
 286 {
 287     float_status fp_status = env->fp_status;
 288     float64 res;
 289     uint32_t rv;
 290
 291     set_float_rounding_mode(rounding_mode, &fp_status);
 292
 293     res = float64_scalbn(v, scale, &fp_status);
 294
 295     if (float64_is_neg(v) && !float64_is_any_nan(v)) {
 296         set_float_exception_flags(float_flag_invalid, &fp_status);
 297         rv = float64_to_int32(res, &fp_status);
 298     } else {
 299         rv = float64_to_uint32(res, &fp_status);
 300     }
 301     set_float_exception_flags(get_float_exception_flags(&fp_status),
 302                               &env->fp_status);
 303     return rv;
 304 }
 305
 306 uint32_t HELPER(ftoui_s)(CPUXtensaState *env, float32 v,
 307                          uint32_t rounding_mode, uint32_t scale)
 308 {
 309     float_status fp_status = env->fp_status;
 310     float32 res;
 311     uint32_t rv;
 312
 313     set_float_rounding_mode(rounding_mode, &fp_status);
 314
 315     res = float32_scalbn(v, scale, &fp_status);
 316
 317     if (float32_is_neg(v) && !float32_is_any_nan(v)) {
 318         rv = float32_to_int32(res, &fp_status);
 319         if (rv) {
 320             set_float_exception_flags(float_flag_invalid, &fp_status);
 321         }
 322     } else {
 323         rv = float32_to_uint32(res, &fp_status);
 324     }
 325     set_float_exception_flags(get_float_exception_flags(&fp_status),
 326                               &env->fp_status);
 327     return rv;
 328 }
 329
 330 float64 HELPER(itof_d)(CPUXtensaState *env, uint32_t v, uint32_t scale)
 331 {
 332     return float64_scalbn(int32_to_float64(v, &env->fp_status),
 333                           (int32_t)scale, &env->fp_status);
 334 }
 335
 336 float32 HELPER(itof_s)(CPUXtensaState *env, uint32_t v, uint32_t scale)
 337 {
 338     return float32_scalbn(int32_to_float32(v, &env->fp_status),
 339                           (int32_t)scale, &env->fp_status);
 340 }
 341
 342 float64 HELPER(uitof_d)(CPUXtensaState *env, uint32_t v, uint32_t scale)
 343 {
 344     return float64_scalbn(uint32_to_float64(v, &env->fp_status),
 345                           (int32_t)scale, &env->fp_status);
 346 }
 347
 348 float32 HELPER(uitof_s)(CPUXtensaState *env, uint32_t v, uint32_t scale)
 349 {
 350     return float32_scalbn(uint32_to_float32(v, &env->fp_status),
 351                           (int32_t)scale, &env->fp_status);
 352 }
 353
 354 float64 HELPER(cvtd_s)(CPUXtensaState *env, float32 v)
 355 {
 356     return float32_to_float64(v, &env->fp_status);
 357 }
 358
 359 float32 HELPER(cvts_d)(CPUXtensaState *env, float64 v)
 360 {
 361     return float64_to_float32(v, &env->fp_status);
 362 }
 363
 364 uint32_t HELPER(un_d)(CPUXtensaState *env, float64 a, float64 b)
 365 {
 366     return float64_unordered_quiet(a, b, &env->fp_status);
 367 }
 368
 369 uint32_t HELPER(un_s)(CPUXtensaState *env, float32 a, float32 b)
 370 {
 371     return float32_unordered_quiet(a, b, &env->fp_status);
 372 }
 373
 374 uint32_t HELPER(oeq_d)(CPUXtensaState *env, float64 a, float64 b)
 375 {
 376     return float64_eq_quiet(a, b, &env->fp_status);
 377 }
 378
 379 uint32_t HELPER(oeq_s)(CPUXtensaState *env, float32 a, float32 b)
 380 {
 381     return float32_eq_quiet(a, b, &env->fp_status);
 382 }
 383
 384 uint32_t HELPER(ueq_d)(CPUXtensaState *env, float64 a, float64 b)
 385 {
 386     FloatRelation v = float64_compare_quiet(a, b, &env->fp_status);
 387
 388     return v == float_relation_equal ||
 389            v == float_relation_unordered;
 390 }
 391
 392 uint32_t HELPER(ueq_s)(CPUXtensaState *env, float32 a, float32 b)
 393 {
 394     FloatRelation v = float32_compare_quiet(a, b, &env->fp_status);
 395
 396     return v == float_relation_equal ||
 397            v == float_relation_unordered;
 398 }
 399
 400 uint32_t HELPER(olt_d)(CPUXtensaState *env, float64 a, float64 b)
 401 {
 402     return float64_lt(a, b, &env->fp_status);
 403 }
 404
 405 uint32_t HELPER(olt_s)(CPUXtensaState *env, float32 a, float32 b)
 406 {
 407     return float32_lt(a, b, &env->fp_status);
 408 }
 409
 410 uint32_t HELPER(ult_d)(CPUXtensaState *env, float64 a, float64 b)
 411 {
 412     FloatRelation v = float64_compare_quiet(a, b, &env->fp_status);
 413
 414     return v == float_relation_less ||
 415            v == float_relation_unordered;
 416 }
 417
 418 uint32_t HELPER(ult_s)(CPUXtensaState *env, float32 a, float32 b)
 419 {
 420     FloatRelation v = float32_compare_quiet(a, b, &env->fp_status);
 421
 422     return v == float_relation_less ||
 423            v == float_relation_unordered;
 424 }
 425
 426 uint32_t HELPER(ole_d)(CPUXtensaState *env, float64 a, float64 b)
 427 {
 428     return float64_le(a, b, &env->fp_status);
 429 }
 430
 431 uint32_t HELPER(ole_s)(CPUXtensaState *env, float32 a, float32 b)
 432 {
 433     return float32_le(a, b, &env->fp_status);
 434 }
 435
 436 uint32_t HELPER(ule_d)(CPUXtensaState *env, float64 a, float64 b)
 437 {
 438     FloatRelation v = float64_compare_quiet(a, b, &env->fp_status);
 439
 440     return v != float_relation_greater;
 441 }
 442
 443 uint32_t HELPER(ule_s)(CPUXtensaState *env, float32 a, float32 b)
 444 {
 445     FloatRelation v = float32_compare_quiet(a, b, &env->fp_status);
 446
 447     return v != float_relation_greater;
 448 }