target/hppa/op_helper.c

   1 /*
   2  * Helpers for HPPA instructions.
   3  *
   4  * Copyright (c) 2016 Richard Henderson <rth@twiddle.net>
   5  *
   6  * This library is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU Lesser General Public
   8  * License as published by the Free Software Foundation; either
   9  * version 2 of the License, or (at your option) any later version.
  10  *
  11  * This library is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * Lesser General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU Lesser General Public
  17  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include "qemu/osdep.h"
  21 #include "cpu.h"
  22 #include "exec/exec-all.h"
  23 #include "exec/helper-proto.h"
  24 #include "exec/cpu_ldst.h"
  25
  26 void QEMU_NORETURN HELPER(excp)(CPUHPPAState *env, int excp)
  27 {
  28     HPPACPU *cpu = hppa_env_get_cpu(env);
  29     CPUState *cs = CPU(cpu);
  30
  31     cs->exception_index = excp;
  32     cpu_loop_exit(cs);
  33 }
  34
  35 static void QEMU_NORETURN dynexcp(CPUHPPAState *env, int excp, uintptr_t ra)
  36 {
  37     HPPACPU *cpu = hppa_env_get_cpu(env);
  38     CPUState *cs = CPU(cpu);
  39
  40     cs->exception_index = excp;
  41     cpu_loop_exit_restore(cs, ra);
  42 }
  43
  44 void HELPER(tsv)(CPUHPPAState *env, target_ulong cond)
  45 {
  46     if (unlikely((target_long)cond < 0)) {
  47         dynexcp(env, EXCP_SIGFPE, GETPC());
  48     }
  49 }
  50
  51 void HELPER(tcond)(CPUHPPAState *env, target_ulong cond)
  52 {
  53     if (unlikely(cond)) {
  54         dynexcp(env, EXCP_SIGFPE, GETPC());
  55     }
  56 }
  57
  58 static void atomic_store_3(CPUHPPAState *env, target_ulong addr, uint32_t val,
  59                            uint32_t mask, uintptr_t ra)
  60 {
  61     uint32_t old, new, cmp;
  62
  63 #ifdef CONFIG_USER_ONLY
  64     uint32_t *haddr = g2h(addr - 1);
  65     old = *haddr;
  66     while (1) {
  67         new = (old & ~mask) | (val & mask);
  68         cmp = atomic_cmpxchg(haddr, old, new);
  69         if (cmp == old) {
  70             return;
  71         }
  72         old = cmp;
  73     }
  74 #else
  75 #error "Not implemented."
  76 #endif
  77 }
  78
  79 void HELPER(stby_b)(CPUHPPAState *env, target_ulong addr, target_ulong val)
  80 {
  81     uintptr_t ra = GETPC();
  82
  83     switch (addr & 3) {
  84     case 3:
  85         cpu_stb_data_ra(env, addr, val, ra);
  86         break;
  87     case 2:
  88         cpu_stw_data_ra(env, addr, val, ra);
  89         break;
  90     case 1:
  91         /* The 3 byte store must appear atomic.  */
  92         if (parallel_cpus) {
  93             atomic_store_3(env, addr, val, 0x00ffffffu, ra);
  94         } else {
  95             cpu_stb_data_ra(env, addr, val >> 16, ra);
  96             cpu_stw_data_ra(env, addr + 1, val, ra);
  97         }
  98         break;
  99     default:
 100         cpu_stl_data_ra(env, addr, val, ra);
 101         break;
 102     }
 103 }
 104
 105 void HELPER(stby_e)(CPUHPPAState *env, target_ulong addr, target_ulong val)
 106 {
 107     uintptr_t ra = GETPC();
 108
 109     switch (addr & 3) {
 110     case 3:
 111         /* The 3 byte store must appear atomic.  */
 112         if (parallel_cpus) {
 113             atomic_store_3(env, addr - 3, val, 0xffffff00u, ra);
 114         } else {
 115             cpu_stw_data_ra(env, addr - 3, val >> 16, ra);
 116             cpu_stb_data_ra(env, addr - 1, val >> 8, ra);
 117         }
 118         break;
 119     case 2:
 120         cpu_stw_data_ra(env, addr - 2, val >> 16, ra);
 121         break;
 122     case 1:
 123         cpu_stb_data_ra(env, addr - 1, val >> 24, ra);
 124         break;
 125     default:
 126         /* Nothing is stored, but protection is checked and the
 127            cacheline is marked dirty.  */
 128 #ifndef CONFIG_USER_ONLY
 129         probe_write(env, addr, cpu_mmu_index(env, 0), ra);
 130 #endif
 131         break;
 132     }
 133 }
 134
 135 target_ulong HELPER(probe_r)(target_ulong addr)
 136 {
 137     return page_check_range(addr, 1, PAGE_READ);
 138 }
 139
 140 target_ulong HELPER(probe_w)(target_ulong addr)
 141 {
 142     return page_check_range(addr, 1, PAGE_WRITE);
 143 }
 144
 145 void HELPER(loaded_fr0)(CPUHPPAState *env)
 146 {
 147     uint32_t shadow = env->fr[0] >> 32;
 148     int rm, d;
 149
 150     env->fr0_shadow = shadow;
 151
 152     switch (extract32(shadow, 9, 2)) {
 153     default:
 154         rm = float_round_nearest_even;
 155         break;
 156     case 1:
 157         rm = float_round_to_zero;
 158         break;
 159     case 2:
 160         rm = float_round_up;
 161         break;
 162     case 3:
 163         rm = float_round_down;
 164         break;
 165     }
 166     set_float_rounding_mode(rm, &env->fp_status);
 167
 168     d = extract32(shadow, 5, 1);
 169     set_flush_to_zero(d, &env->fp_status);
 170     set_flush_inputs_to_zero(d, &env->fp_status);
 171 }
 172
 173 void cpu_hppa_loaded_fr0(CPUHPPAState *env)
 174 {
 175     helper_loaded_fr0(env);
 176 }
 177
 178 #define CONVERT_BIT(X, SRC, DST)        \
 179     ((SRC) > (DST)                      \
 180      ? (X) / ((SRC) / (DST)) & (DST)    \
 181      : ((X) & (SRC)) * ((DST) / (SRC)))
 182
 183 static void update_fr0_op(CPUHPPAState *env, uintptr_t ra)
 184 {
 185     uint32_t soft_exp = get_float_exception_flags(&env->fp_status);
 186     uint32_t hard_exp = 0;
 187     uint32_t shadow = env->fr0_shadow;
 188
 189     if (likely(soft_exp == 0)) {
 190         env->fr[0] = (uint64_t)shadow << 32;
 191         return;
 192     }
 193     set_float_exception_flags(0, &env->fp_status);
 194
 195     hard_exp |= CONVERT_BIT(soft_exp, float_flag_inexact,   1u << 0);
 196     hard_exp |= CONVERT_BIT(soft_exp, float_flag_underflow, 1u << 1);
 197     hard_exp |= CONVERT_BIT(soft_exp, float_flag_overflow,  1u << 2);
 198     hard_exp |= CONVERT_BIT(soft_exp, float_flag_divbyzero, 1u << 3);
 199     hard_exp |= CONVERT_BIT(soft_exp, float_flag_invalid,   1u << 4);
 200     shadow |= hard_exp << (32 - 5);
 201     env->fr0_shadow = shadow;
 202     env->fr[0] = (uint64_t)shadow << 32;
 203
 204     if (hard_exp & shadow) {
 205         dynexcp(env, EXCP_SIGFPE, ra);
 206     }
 207 }
 208
 209 float32 HELPER(fsqrt_s)(CPUHPPAState *env, float32 arg)
 210 {
 211     float32 ret = float32_sqrt(arg, &env->fp_status);
 212     update_fr0_op(env, GETPC());
 213     return ret;
 214 }
 215
 216 float32 HELPER(frnd_s)(CPUHPPAState *env, float32 arg)
 217 {
 218     float32 ret = float32_round_to_int(arg, &env->fp_status);
 219     update_fr0_op(env, GETPC());
 220     return ret;
 221 }
 222
 223 float32 HELPER(fadd_s)(CPUHPPAState *env, float32 a, float32 b)
 224 {
 225     float32 ret = float32_add(a, b, &env->fp_status);
 226     update_fr0_op(env, GETPC());
 227     return ret;
 228 }
 229
 230 float32 HELPER(fsub_s)(CPUHPPAState *env, float32 a, float32 b)
 231 {
 232     float32 ret = float32_sub(a, b, &env->fp_status);
 233     update_fr0_op(env, GETPC());
 234     return ret;
 235 }
 236
 237 float32 HELPER(fmpy_s)(CPUHPPAState *env, float32 a, float32 b)
 238 {
 239     float32 ret = float32_mul(a, b, &env->fp_status);
 240     update_fr0_op(env, GETPC());
 241     return ret;
 242 }
 243
 244 float32 HELPER(fdiv_s)(CPUHPPAState *env, float32 a, float32 b)
 245 {
 246     float32 ret = float32_div(a, b, &env->fp_status);
 247     update_fr0_op(env, GETPC());
 248     return ret;
 249 }
 250
 251 float64 HELPER(fsqrt_d)(CPUHPPAState *env, float64 arg)
 252 {
 253     float64 ret = float64_sqrt(arg, &env->fp_status);
 254     update_fr0_op(env, GETPC());
 255     return ret;
 256 }
 257
 258 float64 HELPER(frnd_d)(CPUHPPAState *env, float64 arg)
 259 {
 260     float64 ret = float64_round_to_int(arg, &env->fp_status);
 261     update_fr0_op(env, GETPC());
 262     return ret;
 263 }
 264
 265 float64 HELPER(fadd_d)(CPUHPPAState *env, float64 a, float64 b)
 266 {
 267     float64 ret = float64_add(a, b, &env->fp_status);
 268     update_fr0_op(env, GETPC());
 269     return ret;
 270 }
 271
 272 float64 HELPER(fsub_d)(CPUHPPAState *env, float64 a, float64 b)
 273 {
 274     float64 ret = float64_sub(a, b, &env->fp_status);
 275     update_fr0_op(env, GETPC());
 276     return ret;
 277 }
 278
 279 float64 HELPER(fmpy_d)(CPUHPPAState *env, float64 a, float64 b)
 280 {
 281     float64 ret = float64_mul(a, b, &env->fp_status);
 282     update_fr0_op(env, GETPC());
 283     return ret;
 284 }
 285
 286 float64 HELPER(fdiv_d)(CPUHPPAState *env, float64 a, float64 b)
 287 {
 288     float64 ret = float64_div(a, b, &env->fp_status);
 289     update_fr0_op(env, GETPC());
 290     return ret;
 291 }
 292
 293 float64 HELPER(fcnv_s_d)(CPUHPPAState *env, float32 arg)
 294 {
 295     float64 ret = float32_to_float64(arg, &env->fp_status);
 296     ret = float64_maybe_silence_nan(ret, &env->fp_status);
 297     update_fr0_op(env, GETPC());
 298     return ret;
 299 }
 300
 301 float32 HELPER(fcnv_d_s)(CPUHPPAState *env, float64 arg)
 302 {
 303     float32 ret = float64_to_float32(arg, &env->fp_status);
 304     ret = float32_maybe_silence_nan(ret, &env->fp_status);
 305     update_fr0_op(env, GETPC());
 306     return ret;
 307 }
 308
 309 float32 HELPER(fcnv_w_s)(CPUHPPAState *env, int32_t arg)
 310 {
 311     float32 ret = int32_to_float32(arg, &env->fp_status);
 312     update_fr0_op(env, GETPC());
 313     return ret;
 314 }
 315
 316 float32 HELPER(fcnv_dw_s)(CPUHPPAState *env, int64_t arg)
 317 {
 318     float32 ret = int64_to_float32(arg, &env->fp_status);
 319     update_fr0_op(env, GETPC());
 320     return ret;
 321 }
 322
 323 float64 HELPER(fcnv_w_d)(CPUHPPAState *env, int32_t arg)
 324 {
 325     float64 ret = int32_to_float64(arg, &env->fp_status);
 326     update_fr0_op(env, GETPC());
 327     return ret;
 328 }
 329
 330 float64 HELPER(fcnv_dw_d)(CPUHPPAState *env, int64_t arg)
 331 {
 332     float64 ret = int64_to_float64(arg, &env->fp_status);
 333     update_fr0_op(env, GETPC());
 334     return ret;
 335 }
 336
 337 int32_t HELPER(fcnv_s_w)(CPUHPPAState *env, float32 arg)
 338 {
 339     int32_t ret = float32_to_int32(arg, &env->fp_status);
 340     update_fr0_op(env, GETPC());
 341     return ret;
 342 }
 343
 344 int32_t HELPER(fcnv_d_w)(CPUHPPAState *env, float64 arg)
 345 {
 346     int32_t ret = float64_to_int32(arg, &env->fp_status);
 347     update_fr0_op(env, GETPC());
 348     return ret;
 349 }
 350
 351 int64_t HELPER(fcnv_s_dw)(CPUHPPAState *env, float32 arg)
 352 {
 353     int64_t ret = float32_to_int64(arg, &env->fp_status);
 354     update_fr0_op(env, GETPC());
 355     return ret;
 356 }
 357
 358 int64_t HELPER(fcnv_d_dw)(CPUHPPAState *env, float64 arg)
 359 {
 360     int64_t ret = float64_to_int64(arg, &env->fp_status);
 361     update_fr0_op(env, GETPC());
 362     return ret;
 363 }
 364
 365 int32_t HELPER(fcnv_t_s_w)(CPUHPPAState *env, float32 arg)
 366 {
 367     int32_t ret = float32_to_int32_round_to_zero(arg, &env->fp_status);
 368     update_fr0_op(env, GETPC());
 369     return ret;
 370 }
 371
 372 int32_t HELPER(fcnv_t_d_w)(CPUHPPAState *env, float64 arg)
 373 {
 374     int32_t ret = float64_to_int32_round_to_zero(arg, &env->fp_status);
 375     update_fr0_op(env, GETPC());
 376     return ret;
 377 }
 378
 379 int64_t HELPER(fcnv_t_s_dw)(CPUHPPAState *env, float32 arg)
 380 {
 381     int64_t ret = float32_to_int64_round_to_zero(arg, &env->fp_status);
 382     update_fr0_op(env, GETPC());
 383     return ret;
 384 }
 385
 386 int64_t HELPER(fcnv_t_d_dw)(CPUHPPAState *env, float64 arg)
 387 {
 388     int64_t ret = float64_to_int64_round_to_zero(arg, &env->fp_status);
 389     update_fr0_op(env, GETPC());
 390     return ret;
 391 }
 392
 393 float32 HELPER(fcnv_uw_s)(CPUHPPAState *env, uint32_t arg)
 394 {
 395     float32 ret = uint32_to_float32(arg, &env->fp_status);
 396     update_fr0_op(env, GETPC());
 397     return ret;
 398 }
 399
 400 float32 HELPER(fcnv_udw_s)(CPUHPPAState *env, uint64_t arg)
 401 {
 402     float32 ret = uint64_to_float32(arg, &env->fp_status);
 403     update_fr0_op(env, GETPC());
 404     return ret;
 405 }
 406
 407 float64 HELPER(fcnv_uw_d)(CPUHPPAState *env, uint32_t arg)
 408 {
 409     float64 ret = uint32_to_float64(arg, &env->fp_status);
 410     update_fr0_op(env, GETPC());
 411     return ret;
 412 }
 413
 414 float64 HELPER(fcnv_udw_d)(CPUHPPAState *env, uint64_t arg)
 415 {
 416     float64 ret = uint64_to_float64(arg, &env->fp_status);
 417     update_fr0_op(env, GETPC());
 418     return ret;
 419 }
 420
 421 uint32_t HELPER(fcnv_s_uw)(CPUHPPAState *env, float32 arg)
 422 {
 423     uint32_t ret = float32_to_uint32(arg, &env->fp_status);
 424     update_fr0_op(env, GETPC());
 425     return ret;
 426 }
 427
 428 uint32_t HELPER(fcnv_d_uw)(CPUHPPAState *env, float64 arg)
 429 {
 430     uint32_t ret = float64_to_uint32(arg, &env->fp_status);
 431     update_fr0_op(env, GETPC());
 432     return ret;
 433 }
 434
 435 uint64_t HELPER(fcnv_s_udw)(CPUHPPAState *env, float32 arg)
 436 {
 437     uint64_t ret = float32_to_uint64(arg, &env->fp_status);
 438     update_fr0_op(env, GETPC());
 439     return ret;
 440 }
 441
 442 uint64_t HELPER(fcnv_d_udw)(CPUHPPAState *env, float64 arg)
 443 {
 444     uint64_t ret = float64_to_uint64(arg, &env->fp_status);
 445     update_fr0_op(env, GETPC());
 446     return ret;
 447 }
 448
 449 uint32_t HELPER(fcnv_t_s_uw)(CPUHPPAState *env, float32 arg)
 450 {
 451     uint32_t ret = float32_to_uint32_round_to_zero(arg, &env->fp_status);
 452     update_fr0_op(env, GETPC());
 453     return ret;
 454 }
 455
 456 uint32_t HELPER(fcnv_t_d_uw)(CPUHPPAState *env, float64 arg)
 457 {
 458     uint32_t ret = float64_to_uint32_round_to_zero(arg, &env->fp_status);
 459     update_fr0_op(env, GETPC());
 460     return ret;
 461 }
 462
 463 uint64_t HELPER(fcnv_t_s_udw)(CPUHPPAState *env, float32 arg)
 464 {
 465     uint64_t ret = float32_to_uint64_round_to_zero(arg, &env->fp_status);
 466     update_fr0_op(env, GETPC());
 467     return ret;
 468 }
 469
 470 uint64_t HELPER(fcnv_t_d_udw)(CPUHPPAState *env, float64 arg)
 471 {
 472     uint64_t ret = float64_to_uint64_round_to_zero(arg, &env->fp_status);
 473     update_fr0_op(env, GETPC());
 474     return ret;
 475 }
 476
 477 static void update_fr0_cmp(CPUHPPAState *env, uint32_t y, uint32_t c, int r)
 478 {
 479     uint32_t shadow = env->fr0_shadow;
 480
 481     switch (r) {
 482     case float_relation_greater:
 483         c = extract32(c, 4, 1);
 484         break;
 485     case float_relation_less:
 486         c = extract32(c, 3, 1);
 487         break;
 488     case float_relation_equal:
 489         c = extract32(c, 2, 1);
 490         break;
 491     case float_relation_unordered:
 492         c = extract32(c, 1, 1);
 493         break;
 494     default:
 495         g_assert_not_reached();
 496     }
 497
 498     if (y) {
 499         /* targeted comparison */
 500         /* set fpsr[ca[y - 1]] to current compare */
 501         shadow = deposit32(shadow, 21 - (y - 1), 1, c);
 502     } else {
 503         /* queued comparison */
 504         /* shift cq right by one place */
 505         shadow = deposit32(shadow, 11, 10, extract32(shadow, 12, 10));
 506         /* move fpsr[c] to fpsr[cq[0]] */
 507         shadow = deposit32(shadow, 21, 1, extract32(shadow, 26, 1));
 508         /* set fpsr[c] to current compare */
 509         shadow = deposit32(shadow, 26, 1, c);
 510     }
 511
 512     env->fr0_shadow = shadow;
 513     env->fr[0] = (uint64_t)shadow << 32;
 514 }
 515
 516 void HELPER(fcmp_s)(CPUHPPAState *env, float32 a, float32 b,
 517                     uint32_t y, uint32_t c)
 518 {
 519     int r;
 520     if (c & 1) {
 521         r = float32_compare(a, b, &env->fp_status);
 522     } else {
 523         r = float32_compare_quiet(a, b, &env->fp_status);
 524     }
 525     update_fr0_op(env, GETPC());
 526     update_fr0_cmp(env, y, c, r);
 527 }
 528
 529 void HELPER(fcmp_d)(CPUHPPAState *env, float64 a, float64 b,
 530                     uint32_t y, uint32_t c)
 531 {
 532     int r;
 533     if (c & 1) {
 534         r = float64_compare(a, b, &env->fp_status);
 535     } else {
 536         r = float64_compare_quiet(a, b, &env->fp_status);
 537     }
 538     update_fr0_op(env, GETPC());
 539     update_fr0_cmp(env, y, c, r);
 540 }
 541
 542 float32 HELPER(fmpyfadd_s)(CPUHPPAState *env, float32 a, float32 b, float32 c)
 543 {
 544     float32 ret = float32_muladd(a, b, c, 0, &env->fp_status);
 545     update_fr0_op(env, GETPC());
 546     return ret;
 547 }
 548
 549 float32 HELPER(fmpynfadd_s)(CPUHPPAState *env, float32 a, float32 b, float32 c)
 550 {
 551     float32 ret = float32_muladd(a, b, c, float_muladd_negate_product,
 552                                  &env->fp_status);
 553     update_fr0_op(env, GETPC());
 554     return ret;
 555 }
 556
 557 float64 HELPER(fmpyfadd_d)(CPUHPPAState *env, float64 a, float64 b, float64 c)
 558 {
 559     float64 ret = float64_muladd(a, b, c, 0, &env->fp_status);
 560     update_fr0_op(env, GETPC());
 561     return ret;
 562 }
 563
 564 float64 HELPER(fmpynfadd_d)(CPUHPPAState *env, float64 a, float64 b, float64 c)
 565 {
 566     float64 ret = float64_muladd(a, b, c, float_muladd_negate_product,
 567                                  &env->fp_status);
 568     update_fr0_op(env, GETPC());
 569     return ret;
 570 }