qemu/target/hppa/op_helper.c
<<
>>
Prefs
   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
  26void 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
  35static 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
  44void HELPER(tsv)(CPUHPPAState *env, target_ulong cond)
  45{
  46    if (unlikely((target_long)cond < 0)) {
  47        dynexcp(env, EXCP_SIGFPE, GETPC());
  48    }
  49}
  50
  51void HELPER(tcond)(CPUHPPAState *env, target_ulong cond)
  52{
  53    if (unlikely(cond)) {
  54        dynexcp(env, EXCP_SIGFPE, GETPC());
  55    }
  56}
  57
  58static 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
  79void 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
 105void 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
 135target_ulong HELPER(probe_r)(target_ulong addr)
 136{
 137    return page_check_range(addr, 1, PAGE_READ);
 138}
 139
 140target_ulong HELPER(probe_w)(target_ulong addr)
 141{
 142    return page_check_range(addr, 1, PAGE_WRITE);
 143}
 144
 145void 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
 173void 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
 183static 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
 209float32 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
 216float32 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
 223float32 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
 230float32 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
 237float32 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
 244float32 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
 251float64 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
 258float64 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
 265float64 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
 272float64 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
 279float64 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
 286float64 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
 293float64 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
 301float32 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
 309float32 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
 316float32 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
 323float64 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
 330float64 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
 337int32_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
 344int32_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
 351int64_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
 358int64_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
 365int32_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
 372int32_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
 379int64_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
 386int64_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
 393float32 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
 400float32 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
 407float64 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
 414float64 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
 421uint32_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
 428uint32_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
 435uint64_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
 442uint64_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
 449uint32_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
 456uint32_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
 463uint64_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
 470uint64_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
 477static 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
 516void 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
 529void 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
 542float32 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
 549float32 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
 557float64 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
 564float64 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}
 571