qemu/target/tricore/op_helper.c
<<
>>
Prefs
   1/*
   2 *  Copyright (c) 2012-2014 Bastian Koppelmann C-Lab/University Paderborn
   3 *
   4 * This library is free software; you can redistribute it and/or
   5 * modify it under the terms of the GNU Lesser General Public
   6 * License as published by the Free Software Foundation; either
   7 * version 2.1 of the License, or (at your option) any later version.
   8 *
   9 * This library is distributed in the hope that it will be useful,
  10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12 * Lesser General Public License for more details.
  13 *
  14 * You should have received a copy of the GNU Lesser General Public
  15 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
  16 */
  17#include "qemu/osdep.h"
  18#include "cpu.h"
  19#include "qemu/host-utils.h"
  20#include "exec/helper-proto.h"
  21#include "exec/exec-all.h"
  22#include "exec/cpu_ldst.h"
  23#include <zlib.h> /* for crc32 */
  24
  25
  26/* Exception helpers */
  27
  28static void QEMU_NORETURN
  29raise_exception_sync_internal(CPUTriCoreState *env, uint32_t class, int tin,
  30                              uintptr_t pc, uint32_t fcd_pc)
  31{
  32    CPUState *cs = CPU(tricore_env_get_cpu(env));
  33    /* in case we come from a helper-call we need to restore the PC */
  34    cpu_restore_state(cs, pc, true);
  35
  36    /* Tin is loaded into d[15] */
  37    env->gpr_d[15] = tin;
  38
  39    if (class == TRAPC_CTX_MNG && tin == TIN3_FCU) {
  40        /* upper context cannot be saved, if the context list is empty */
  41    } else {
  42        helper_svucx(env);
  43    }
  44
  45    /* The return address in a[11] is updated */
  46    if (class == TRAPC_CTX_MNG && tin == TIN3_FCD) {
  47        env->SYSCON |= MASK_SYSCON_FCD_SF;
  48        /* when we run out of CSAs after saving a context a FCD trap is taken
  49           and the return address is the start of the trap handler which used
  50           the last CSA */
  51        env->gpr_a[11] = fcd_pc;
  52    } else if (class == TRAPC_SYSCALL) {
  53        env->gpr_a[11] = env->PC + 4;
  54    } else {
  55        env->gpr_a[11] = env->PC;
  56    }
  57    /* The stack pointer in A[10] is set to the Interrupt Stack Pointer (ISP)
  58       when the processor was not previously using the interrupt stack
  59       (in case of PSW.IS = 0). The stack pointer bit is set for using the
  60       interrupt stack: PSW.IS = 1. */
  61    if ((env->PSW & MASK_PSW_IS) == 0) {
  62        env->gpr_a[10] = env->ISP;
  63    }
  64    env->PSW |= MASK_PSW_IS;
  65    /* The I/O mode is set to Supervisor mode, which means all permissions
  66       are enabled: PSW.IO = 10 B .*/
  67    env->PSW |= (2 << 10);
  68
  69    /*The current Protection Register Set is set to 0: PSW.PRS = 00 B .*/
  70    env->PSW &= ~MASK_PSW_PRS;
  71
  72    /* The Call Depth Counter (CDC) is cleared, and the call depth limit is
  73       set for 64: PSW.CDC = 0000000 B .*/
  74    env->PSW &= ~MASK_PSW_CDC;
  75
  76    /* Call Depth Counter is enabled, PSW.CDE = 1. */
  77    env->PSW |= MASK_PSW_CDE;
  78
  79    /* Write permission to global registers A[0], A[1], A[8], A[9] is
  80       disabled: PSW.GW = 0. */
  81    env->PSW &= ~MASK_PSW_GW;
  82
  83    /*The interrupt system is globally disabled: ICR.IE = 0. The ‘old’
  84      ICR.IE and ICR.CCPN are saved */
  85
  86    /* PCXI.PIE = ICR.IE */
  87    env->PCXI = ((env->PCXI & ~MASK_PCXI_PIE_1_3) +
  88                ((env->ICR & MASK_ICR_IE_1_3) << 15));
  89    /* PCXI.PCPN = ICR.CCPN */
  90    env->PCXI = (env->PCXI & 0xffffff) +
  91                ((env->ICR & MASK_ICR_CCPN) << 24);
  92    /* Update PC using the trap vector table */
  93    env->PC = env->BTV | (class << 5);
  94
  95    cpu_loop_exit(cs);
  96}
  97
  98void helper_raise_exception_sync(CPUTriCoreState *env, uint32_t class,
  99                                 uint32_t tin)
 100{
 101    raise_exception_sync_internal(env, class, tin, 0, 0);
 102}
 103
 104static void raise_exception_sync_helper(CPUTriCoreState *env, uint32_t class,
 105                                        uint32_t tin, uintptr_t pc)
 106{
 107    raise_exception_sync_internal(env, class, tin, pc, 0);
 108}
 109
 110/* Addressing mode helper */
 111
 112static uint16_t reverse16(uint16_t val)
 113{
 114    uint8_t high = (uint8_t)(val >> 8);
 115    uint8_t low  = (uint8_t)(val & 0xff);
 116
 117    uint16_t rh, rl;
 118
 119    rl = (uint16_t)((high * 0x0202020202ULL & 0x010884422010ULL) % 1023);
 120    rh = (uint16_t)((low * 0x0202020202ULL & 0x010884422010ULL) % 1023);
 121
 122    return (rh << 8) | rl;
 123}
 124
 125uint32_t helper_br_update(uint32_t reg)
 126{
 127    uint32_t index = reg & 0xffff;
 128    uint32_t incr  = reg >> 16;
 129    uint32_t new_index = reverse16(reverse16(index) + reverse16(incr));
 130    return reg - index + new_index;
 131}
 132
 133uint32_t helper_circ_update(uint32_t reg, uint32_t off)
 134{
 135    uint32_t index = reg & 0xffff;
 136    uint32_t length = reg >> 16;
 137    int32_t new_index = index + off;
 138    if (new_index < 0) {
 139        new_index += length;
 140    } else {
 141        new_index %= length;
 142    }
 143    return reg - index + new_index;
 144}
 145
 146static uint32_t ssov32(CPUTriCoreState *env, int64_t arg)
 147{
 148    uint32_t ret;
 149    int64_t max_pos = INT32_MAX;
 150    int64_t max_neg = INT32_MIN;
 151    if (arg > max_pos) {
 152        env->PSW_USB_V = (1 << 31);
 153        env->PSW_USB_SV = (1 << 31);
 154        ret = (target_ulong)max_pos;
 155    } else {
 156        if (arg < max_neg) {
 157            env->PSW_USB_V = (1 << 31);
 158            env->PSW_USB_SV = (1 << 31);
 159            ret = (target_ulong)max_neg;
 160        } else {
 161            env->PSW_USB_V = 0;
 162            ret = (target_ulong)arg;
 163        }
 164    }
 165    env->PSW_USB_AV = arg ^ arg * 2u;
 166    env->PSW_USB_SAV |= env->PSW_USB_AV;
 167    return ret;
 168}
 169
 170static uint32_t suov32_pos(CPUTriCoreState *env, uint64_t arg)
 171{
 172    uint32_t ret;
 173    uint64_t max_pos = UINT32_MAX;
 174    if (arg > max_pos) {
 175        env->PSW_USB_V = (1 << 31);
 176        env->PSW_USB_SV = (1 << 31);
 177        ret = (target_ulong)max_pos;
 178    } else {
 179        env->PSW_USB_V = 0;
 180        ret = (target_ulong)arg;
 181     }
 182    env->PSW_USB_AV = arg ^ arg * 2u;
 183    env->PSW_USB_SAV |= env->PSW_USB_AV;
 184    return ret;
 185}
 186
 187static uint32_t suov32_neg(CPUTriCoreState *env, int64_t arg)
 188{
 189    uint32_t ret;
 190
 191    if (arg < 0) {
 192        env->PSW_USB_V = (1 << 31);
 193        env->PSW_USB_SV = (1 << 31);
 194        ret = 0;
 195    } else {
 196        env->PSW_USB_V = 0;
 197        ret = (target_ulong)arg;
 198    }
 199    env->PSW_USB_AV = arg ^ arg * 2u;
 200    env->PSW_USB_SAV |= env->PSW_USB_AV;
 201    return ret;
 202}
 203
 204static uint32_t ssov16(CPUTriCoreState *env, int32_t hw0, int32_t hw1)
 205{
 206    int32_t max_pos = INT16_MAX;
 207    int32_t max_neg = INT16_MIN;
 208    int32_t av0, av1;
 209
 210    env->PSW_USB_V = 0;
 211    av0 = hw0 ^ hw0 * 2u;
 212    if (hw0 > max_pos) {
 213        env->PSW_USB_V = (1 << 31);
 214        hw0 = max_pos;
 215    } else if (hw0 < max_neg) {
 216        env->PSW_USB_V = (1 << 31);
 217        hw0 = max_neg;
 218    }
 219
 220    av1 = hw1 ^ hw1 * 2u;
 221    if (hw1 > max_pos) {
 222        env->PSW_USB_V = (1 << 31);
 223        hw1 = max_pos;
 224    } else if (hw1 < max_neg) {
 225        env->PSW_USB_V = (1 << 31);
 226        hw1 = max_neg;
 227    }
 228
 229    env->PSW_USB_SV |= env->PSW_USB_V;
 230    env->PSW_USB_AV = (av0 | av1) << 16;
 231    env->PSW_USB_SAV |= env->PSW_USB_AV;
 232    return (hw0 & 0xffff) | (hw1 << 16);
 233}
 234
 235static uint32_t suov16(CPUTriCoreState *env, int32_t hw0, int32_t hw1)
 236{
 237    int32_t max_pos = UINT16_MAX;
 238    int32_t av0, av1;
 239
 240    env->PSW_USB_V = 0;
 241    av0 = hw0 ^ hw0 * 2u;
 242    if (hw0 > max_pos) {
 243        env->PSW_USB_V = (1 << 31);
 244        hw0 = max_pos;
 245    } else if (hw0 < 0) {
 246        env->PSW_USB_V = (1 << 31);
 247        hw0 = 0;
 248    }
 249
 250    av1 = hw1 ^ hw1 * 2u;
 251    if (hw1 > max_pos) {
 252        env->PSW_USB_V = (1 << 31);
 253        hw1 = max_pos;
 254    } else if (hw1 < 0) {
 255        env->PSW_USB_V = (1 << 31);
 256        hw1 = 0;
 257    }
 258
 259    env->PSW_USB_SV |= env->PSW_USB_V;
 260    env->PSW_USB_AV = (av0 | av1) << 16;
 261    env->PSW_USB_SAV |= env->PSW_USB_AV;
 262    return (hw0 & 0xffff) | (hw1 << 16);
 263}
 264
 265target_ulong helper_add_ssov(CPUTriCoreState *env, target_ulong r1,
 266                             target_ulong r2)
 267{
 268    int64_t t1 = sextract64(r1, 0, 32);
 269    int64_t t2 = sextract64(r2, 0, 32);
 270    int64_t result = t1 + t2;
 271    return ssov32(env, result);
 272}
 273
 274uint64_t helper_add64_ssov(CPUTriCoreState *env, uint64_t r1, uint64_t r2)
 275{
 276    uint64_t result;
 277    int64_t ovf;
 278
 279    result = r1 + r2;
 280    ovf = (result ^ r1) & ~(r1 ^ r2);
 281    env->PSW_USB_AV = (result ^ result * 2u) >> 32;
 282    env->PSW_USB_SAV |= env->PSW_USB_AV;
 283    if (ovf < 0) {
 284        env->PSW_USB_V = (1 << 31);
 285        env->PSW_USB_SV = (1 << 31);
 286        /* ext_ret > MAX_INT */
 287        if ((int64_t)r1 >= 0) {
 288            result = INT64_MAX;
 289        /* ext_ret < MIN_INT */
 290        } else {
 291            result = INT64_MIN;
 292        }
 293    } else {
 294        env->PSW_USB_V = 0;
 295    }
 296    return result;
 297}
 298
 299target_ulong helper_add_h_ssov(CPUTriCoreState *env, target_ulong r1,
 300                               target_ulong r2)
 301{
 302    int32_t ret_hw0, ret_hw1;
 303
 304    ret_hw0 = sextract32(r1, 0, 16) + sextract32(r2, 0, 16);
 305    ret_hw1 = sextract32(r1, 16, 16) + sextract32(r2, 16, 16);
 306    return ssov16(env, ret_hw0, ret_hw1);
 307}
 308
 309uint32_t helper_addr_h_ssov(CPUTriCoreState *env, uint64_t r1, uint32_t r2_l,
 310                            uint32_t r2_h)
 311{
 312    int64_t mul_res0 = sextract64(r1, 0, 32);
 313    int64_t mul_res1 = sextract64(r1, 32, 32);
 314    int64_t r2_low = sextract64(r2_l, 0, 32);
 315    int64_t r2_high = sextract64(r2_h, 0, 32);
 316    int64_t result0, result1;
 317    uint32_t ovf0, ovf1;
 318    uint32_t avf0, avf1;
 319
 320    ovf0 = ovf1 = 0;
 321
 322    result0 = r2_low + mul_res0 + 0x8000;
 323    result1 = r2_high + mul_res1 + 0x8000;
 324
 325    avf0 = result0 * 2u;
 326    avf0 = result0 ^ avf0;
 327    avf1 = result1 * 2u;
 328    avf1 = result1 ^ avf1;
 329
 330    if (result0 > INT32_MAX) {
 331        ovf0 = (1 << 31);
 332        result0 = INT32_MAX;
 333    } else if (result0 < INT32_MIN) {
 334        ovf0 = (1 << 31);
 335        result0 = INT32_MIN;
 336    }
 337
 338    if (result1 > INT32_MAX) {
 339        ovf1 = (1 << 31);
 340        result1 = INT32_MAX;
 341    } else if (result1 < INT32_MIN) {
 342        ovf1 = (1 << 31);
 343        result1 = INT32_MIN;
 344    }
 345
 346    env->PSW_USB_V = ovf0 | ovf1;
 347    env->PSW_USB_SV |= env->PSW_USB_V;
 348
 349    env->PSW_USB_AV = avf0 | avf1;
 350    env->PSW_USB_SAV |= env->PSW_USB_AV;
 351
 352    return (result1 & 0xffff0000ULL) | ((result0 >> 16) & 0xffffULL);
 353}
 354
 355uint32_t helper_addsur_h_ssov(CPUTriCoreState *env, uint64_t r1, uint32_t r2_l,
 356                              uint32_t r2_h)
 357{
 358    int64_t mul_res0 = sextract64(r1, 0, 32);
 359    int64_t mul_res1 = sextract64(r1, 32, 32);
 360    int64_t r2_low = sextract64(r2_l, 0, 32);
 361    int64_t r2_high = sextract64(r2_h, 0, 32);
 362    int64_t result0, result1;
 363    uint32_t ovf0, ovf1;
 364    uint32_t avf0, avf1;
 365
 366    ovf0 = ovf1 = 0;
 367
 368    result0 = r2_low - mul_res0 + 0x8000;
 369    result1 = r2_high + mul_res1 + 0x8000;
 370
 371    avf0 = result0 * 2u;
 372    avf0 = result0 ^ avf0;
 373    avf1 = result1 * 2u;
 374    avf1 = result1 ^ avf1;
 375
 376    if (result0 > INT32_MAX) {
 377        ovf0 = (1 << 31);
 378        result0 = INT32_MAX;
 379    } else if (result0 < INT32_MIN) {
 380        ovf0 = (1 << 31);
 381        result0 = INT32_MIN;
 382    }
 383
 384    if (result1 > INT32_MAX) {
 385        ovf1 = (1 << 31);
 386        result1 = INT32_MAX;
 387    } else if (result1 < INT32_MIN) {
 388        ovf1 = (1 << 31);
 389        result1 = INT32_MIN;
 390    }
 391
 392    env->PSW_USB_V = ovf0 | ovf1;
 393    env->PSW_USB_SV |= env->PSW_USB_V;
 394
 395    env->PSW_USB_AV = avf0 | avf1;
 396    env->PSW_USB_SAV |= env->PSW_USB_AV;
 397
 398    return (result1 & 0xffff0000ULL) | ((result0 >> 16) & 0xffffULL);
 399}
 400
 401
 402target_ulong helper_add_suov(CPUTriCoreState *env, target_ulong r1,
 403                             target_ulong r2)
 404{
 405    int64_t t1 = extract64(r1, 0, 32);
 406    int64_t t2 = extract64(r2, 0, 32);
 407    int64_t result = t1 + t2;
 408    return suov32_pos(env, result);
 409}
 410
 411target_ulong helper_add_h_suov(CPUTriCoreState *env, target_ulong r1,
 412                               target_ulong r2)
 413{
 414    int32_t ret_hw0, ret_hw1;
 415
 416    ret_hw0 = extract32(r1, 0, 16) + extract32(r2, 0, 16);
 417    ret_hw1 = extract32(r1, 16, 16) + extract32(r2, 16, 16);
 418    return suov16(env, ret_hw0, ret_hw1);
 419}
 420
 421target_ulong helper_sub_ssov(CPUTriCoreState *env, target_ulong r1,
 422                             target_ulong r2)
 423{
 424    int64_t t1 = sextract64(r1, 0, 32);
 425    int64_t t2 = sextract64(r2, 0, 32);
 426    int64_t result = t1 - t2;
 427    return ssov32(env, result);
 428}
 429
 430uint64_t helper_sub64_ssov(CPUTriCoreState *env, uint64_t r1, uint64_t r2)
 431{
 432    uint64_t result;
 433    int64_t ovf;
 434
 435    result = r1 - r2;
 436    ovf = (result ^ r1) & (r1 ^ r2);
 437    env->PSW_USB_AV = (result ^ result * 2u) >> 32;
 438    env->PSW_USB_SAV |= env->PSW_USB_AV;
 439    if (ovf < 0) {
 440        env->PSW_USB_V = (1 << 31);
 441        env->PSW_USB_SV = (1 << 31);
 442        /* ext_ret > MAX_INT */
 443        if ((int64_t)r1 >= 0) {
 444            result = INT64_MAX;
 445        /* ext_ret < MIN_INT */
 446        } else {
 447            result = INT64_MIN;
 448        }
 449    } else {
 450        env->PSW_USB_V = 0;
 451    }
 452    return result;
 453}
 454
 455target_ulong helper_sub_h_ssov(CPUTriCoreState *env, target_ulong r1,
 456                             target_ulong r2)
 457{
 458    int32_t ret_hw0, ret_hw1;
 459
 460    ret_hw0 = sextract32(r1, 0, 16) - sextract32(r2, 0, 16);
 461    ret_hw1 = sextract32(r1, 16, 16) - sextract32(r2, 16, 16);
 462    return ssov16(env, ret_hw0, ret_hw1);
 463}
 464
 465uint32_t helper_subr_h_ssov(CPUTriCoreState *env, uint64_t r1, uint32_t r2_l,
 466                            uint32_t r2_h)
 467{
 468    int64_t mul_res0 = sextract64(r1, 0, 32);
 469    int64_t mul_res1 = sextract64(r1, 32, 32);
 470    int64_t r2_low = sextract64(r2_l, 0, 32);
 471    int64_t r2_high = sextract64(r2_h, 0, 32);
 472    int64_t result0, result1;
 473    uint32_t ovf0, ovf1;
 474    uint32_t avf0, avf1;
 475
 476    ovf0 = ovf1 = 0;
 477
 478    result0 = r2_low - mul_res0 + 0x8000;
 479    result1 = r2_high - mul_res1 + 0x8000;
 480
 481    avf0 = result0 * 2u;
 482    avf0 = result0 ^ avf0;
 483    avf1 = result1 * 2u;
 484    avf1 = result1 ^ avf1;
 485
 486    if (result0 > INT32_MAX) {
 487        ovf0 = (1 << 31);
 488        result0 = INT32_MAX;
 489    } else if (result0 < INT32_MIN) {
 490        ovf0 = (1 << 31);
 491        result0 = INT32_MIN;
 492    }
 493
 494    if (result1 > INT32_MAX) {
 495        ovf1 = (1 << 31);
 496        result1 = INT32_MAX;
 497    } else if (result1 < INT32_MIN) {
 498        ovf1 = (1 << 31);
 499        result1 = INT32_MIN;
 500    }
 501
 502    env->PSW_USB_V = ovf0 | ovf1;
 503    env->PSW_USB_SV |= env->PSW_USB_V;
 504
 505    env->PSW_USB_AV = avf0 | avf1;
 506    env->PSW_USB_SAV |= env->PSW_USB_AV;
 507
 508    return (result1 & 0xffff0000ULL) | ((result0 >> 16) & 0xffffULL);
 509}
 510
 511uint32_t helper_subadr_h_ssov(CPUTriCoreState *env, uint64_t r1, uint32_t r2_l,
 512                              uint32_t r2_h)
 513{
 514    int64_t mul_res0 = sextract64(r1, 0, 32);
 515    int64_t mul_res1 = sextract64(r1, 32, 32);
 516    int64_t r2_low = sextract64(r2_l, 0, 32);
 517    int64_t r2_high = sextract64(r2_h, 0, 32);
 518    int64_t result0, result1;
 519    uint32_t ovf0, ovf1;
 520    uint32_t avf0, avf1;
 521
 522    ovf0 = ovf1 = 0;
 523
 524    result0 = r2_low + mul_res0 + 0x8000;
 525    result1 = r2_high - mul_res1 + 0x8000;
 526
 527    avf0 = result0 * 2u;
 528    avf0 = result0 ^ avf0;
 529    avf1 = result1 * 2u;
 530    avf1 = result1 ^ avf1;
 531
 532    if (result0 > INT32_MAX) {
 533        ovf0 = (1 << 31);
 534        result0 = INT32_MAX;
 535    } else if (result0 < INT32_MIN) {
 536        ovf0 = (1 << 31);
 537        result0 = INT32_MIN;
 538    }
 539
 540    if (result1 > INT32_MAX) {
 541        ovf1 = (1 << 31);
 542        result1 = INT32_MAX;
 543    } else if (result1 < INT32_MIN) {
 544        ovf1 = (1 << 31);
 545        result1 = INT32_MIN;
 546    }
 547
 548    env->PSW_USB_V = ovf0 | ovf1;
 549    env->PSW_USB_SV |= env->PSW_USB_V;
 550
 551    env->PSW_USB_AV = avf0 | avf1;
 552    env->PSW_USB_SAV |= env->PSW_USB_AV;
 553
 554    return (result1 & 0xffff0000ULL) | ((result0 >> 16) & 0xffffULL);
 555}
 556
 557target_ulong helper_sub_suov(CPUTriCoreState *env, target_ulong r1,
 558                             target_ulong r2)
 559{
 560    int64_t t1 = extract64(r1, 0, 32);
 561    int64_t t2 = extract64(r2, 0, 32);
 562    int64_t result = t1 - t2;
 563    return suov32_neg(env, result);
 564}
 565
 566target_ulong helper_sub_h_suov(CPUTriCoreState *env, target_ulong r1,
 567                               target_ulong r2)
 568{
 569    int32_t ret_hw0, ret_hw1;
 570
 571    ret_hw0 = extract32(r1, 0, 16) - extract32(r2, 0, 16);
 572    ret_hw1 = extract32(r1, 16, 16) - extract32(r2, 16, 16);
 573    return suov16(env, ret_hw0, ret_hw1);
 574}
 575
 576target_ulong helper_mul_ssov(CPUTriCoreState *env, target_ulong r1,
 577                             target_ulong r2)
 578{
 579    int64_t t1 = sextract64(r1, 0, 32);
 580    int64_t t2 = sextract64(r2, 0, 32);
 581    int64_t result = t1 * t2;
 582    return ssov32(env, result);
 583}
 584
 585target_ulong helper_mul_suov(CPUTriCoreState *env, target_ulong r1,
 586                             target_ulong r2)
 587{
 588    int64_t t1 = extract64(r1, 0, 32);
 589    int64_t t2 = extract64(r2, 0, 32);
 590    int64_t result = t1 * t2;
 591
 592    return suov32_pos(env, result);
 593}
 594
 595target_ulong helper_sha_ssov(CPUTriCoreState *env, target_ulong r1,
 596                             target_ulong r2)
 597{
 598    int64_t t1 = sextract64(r1, 0, 32);
 599    int32_t t2 = sextract64(r2, 0, 6);
 600    int64_t result;
 601    if (t2 == 0) {
 602        result = t1;
 603    } else if (t2 > 0) {
 604        result = t1 << t2;
 605    } else {
 606        result = t1 >> -t2;
 607    }
 608    return ssov32(env, result);
 609}
 610
 611uint32_t helper_abs_ssov(CPUTriCoreState *env, target_ulong r1)
 612{
 613    target_ulong result;
 614    result = ((int32_t)r1 >= 0) ? r1 : (0 - r1);
 615    return ssov32(env, result);
 616}
 617
 618uint32_t helper_abs_h_ssov(CPUTriCoreState *env, target_ulong r1)
 619{
 620    int32_t ret_h0, ret_h1;
 621
 622    ret_h0 = sextract32(r1, 0, 16);
 623    ret_h0 = (ret_h0 >= 0) ? ret_h0 : (0 - ret_h0);
 624
 625    ret_h1 = sextract32(r1, 16, 16);
 626    ret_h1 = (ret_h1 >= 0) ? ret_h1 : (0 - ret_h1);
 627
 628    return ssov16(env, ret_h0, ret_h1);
 629}
 630
 631target_ulong helper_absdif_ssov(CPUTriCoreState *env, target_ulong r1,
 632                                target_ulong r2)
 633{
 634    int64_t t1 = sextract64(r1, 0, 32);
 635    int64_t t2 = sextract64(r2, 0, 32);
 636    int64_t result;
 637
 638    if (t1 > t2) {
 639        result = t1 - t2;
 640    } else {
 641        result = t2 - t1;
 642    }
 643    return ssov32(env, result);
 644}
 645
 646uint32_t helper_absdif_h_ssov(CPUTriCoreState *env, target_ulong r1,
 647                              target_ulong r2)
 648{
 649    int32_t t1, t2;
 650    int32_t ret_h0, ret_h1;
 651
 652    t1 = sextract32(r1, 0, 16);
 653    t2 = sextract32(r2, 0, 16);
 654    if (t1 > t2) {
 655        ret_h0 = t1 - t2;
 656    } else {
 657        ret_h0 = t2 - t1;
 658    }
 659
 660    t1 = sextract32(r1, 16, 16);
 661    t2 = sextract32(r2, 16, 16);
 662    if (t1 > t2) {
 663        ret_h1 = t1 - t2;
 664    } else {
 665        ret_h1 = t2 - t1;
 666    }
 667
 668    return ssov16(env, ret_h0, ret_h1);
 669}
 670
 671target_ulong helper_madd32_ssov(CPUTriCoreState *env, target_ulong r1,
 672                                target_ulong r2, target_ulong r3)
 673{
 674    int64_t t1 = sextract64(r1, 0, 32);
 675    int64_t t2 = sextract64(r2, 0, 32);
 676    int64_t t3 = sextract64(r3, 0, 32);
 677    int64_t result;
 678
 679    result = t2 + (t1 * t3);
 680    return ssov32(env, result);
 681}
 682
 683target_ulong helper_madd32_suov(CPUTriCoreState *env, target_ulong r1,
 684                                target_ulong r2, target_ulong r3)
 685{
 686    uint64_t t1 = extract64(r1, 0, 32);
 687    uint64_t t2 = extract64(r2, 0, 32);
 688    uint64_t t3 = extract64(r3, 0, 32);
 689    int64_t result;
 690
 691    result = t2 + (t1 * t3);
 692    return suov32_pos(env, result);
 693}
 694
 695uint64_t helper_madd64_ssov(CPUTriCoreState *env, target_ulong r1,
 696                            uint64_t r2, target_ulong r3)
 697{
 698    uint64_t ret, ovf;
 699    int64_t t1 = sextract64(r1, 0, 32);
 700    int64_t t3 = sextract64(r3, 0, 32);
 701    int64_t mul;
 702
 703    mul = t1 * t3;
 704    ret = mul + r2;
 705    ovf = (ret ^ mul) & ~(mul ^ r2);
 706
 707    t1 = ret >> 32;
 708    env->PSW_USB_AV = t1 ^ t1 * 2u;
 709    env->PSW_USB_SAV |= env->PSW_USB_AV;
 710
 711    if ((int64_t)ovf < 0) {
 712        env->PSW_USB_V = (1 << 31);
 713        env->PSW_USB_SV = (1 << 31);
 714        /* ext_ret > MAX_INT */
 715        if (mul >= 0) {
 716            ret = INT64_MAX;
 717        /* ext_ret < MIN_INT */
 718        } else {
 719            ret = INT64_MIN;
 720        }
 721    } else {
 722        env->PSW_USB_V = 0;
 723    }
 724
 725    return ret;
 726}
 727
 728uint32_t
 729helper_madd32_q_add_ssov(CPUTriCoreState *env, uint64_t r1, uint64_t r2)
 730{
 731    int64_t result;
 732
 733    result = (r1 + r2);
 734
 735    env->PSW_USB_AV = (result ^ result * 2u);
 736    env->PSW_USB_SAV |= env->PSW_USB_AV;
 737
 738    /* we do the saturation by hand, since we produce an overflow on the host
 739       if the mul before was (0x80000000 * 0x80000000) << 1). If this is the
 740       case, we flip the saturated value. */
 741    if (r2 == 0x8000000000000000LL) {
 742        if (result > 0x7fffffffLL) {
 743            env->PSW_USB_V = (1 << 31);
 744            env->PSW_USB_SV = (1 << 31);
 745            result = INT32_MIN;
 746        } else if (result < -0x80000000LL) {
 747            env->PSW_USB_V = (1 << 31);
 748            env->PSW_USB_SV = (1 << 31);
 749            result = INT32_MAX;
 750        } else {
 751            env->PSW_USB_V = 0;
 752        }
 753    } else {
 754        if (result > 0x7fffffffLL) {
 755            env->PSW_USB_V = (1 << 31);
 756            env->PSW_USB_SV = (1 << 31);
 757            result = INT32_MAX;
 758        } else if (result < -0x80000000LL) {
 759            env->PSW_USB_V = (1 << 31);
 760            env->PSW_USB_SV = (1 << 31);
 761            result = INT32_MIN;
 762        } else {
 763            env->PSW_USB_V = 0;
 764        }
 765    }
 766    return (uint32_t)result;
 767}
 768
 769uint64_t helper_madd64_q_ssov(CPUTriCoreState *env, uint64_t r1, uint32_t r2,
 770                              uint32_t r3, uint32_t n)
 771{
 772    int64_t t1 = (int64_t)r1;
 773    int64_t t2 = sextract64(r2, 0, 32);
 774    int64_t t3 = sextract64(r3, 0, 32);
 775    int64_t result, mul;
 776    int64_t ovf;
 777
 778    mul = (t2 * t3) << n;
 779    result = mul + t1;
 780
 781    env->PSW_USB_AV = (result ^ result * 2u) >> 32;
 782    env->PSW_USB_SAV |= env->PSW_USB_AV;
 783
 784    ovf = (result ^ mul) & ~(mul ^ t1);
 785    /* we do the saturation by hand, since we produce an overflow on the host
 786       if the mul was (0x80000000 * 0x80000000) << 1). If this is the
 787       case, we flip the saturated value. */
 788    if ((r2 == 0x80000000) && (r3 == 0x80000000) && (n == 1)) {
 789        if (ovf >= 0) {
 790            env->PSW_USB_V = (1 << 31);
 791            env->PSW_USB_SV = (1 << 31);
 792            /* ext_ret > MAX_INT */
 793            if (mul < 0) {
 794                result = INT64_MAX;
 795            /* ext_ret < MIN_INT */
 796            } else {
 797               result = INT64_MIN;
 798            }
 799        } else {
 800            env->PSW_USB_V = 0;
 801        }
 802    } else {
 803        if (ovf < 0) {
 804            env->PSW_USB_V = (1 << 31);
 805            env->PSW_USB_SV = (1 << 31);
 806            /* ext_ret > MAX_INT */
 807            if (mul >= 0) {
 808                result = INT64_MAX;
 809            /* ext_ret < MIN_INT */
 810            } else {
 811               result = INT64_MIN;
 812            }
 813        } else {
 814            env->PSW_USB_V = 0;
 815        }
 816    }
 817    return (uint64_t)result;
 818}
 819
 820uint32_t helper_maddr_q_ssov(CPUTriCoreState *env, uint32_t r1, uint32_t r2,
 821                             uint32_t r3, uint32_t n)
 822{
 823    int64_t t1 = sextract64(r1, 0, 32);
 824    int64_t t2 = sextract64(r2, 0, 32);
 825    int64_t t3 = sextract64(r3, 0, 32);
 826    int64_t mul, ret;
 827
 828    if ((t2 == -0x8000ll) && (t3 == -0x8000ll) && (n == 1)) {
 829        mul = 0x7fffffff;
 830    } else {
 831        mul = (t2 * t3) << n;
 832    }
 833
 834    ret = t1 + mul + 0x8000;
 835
 836    env->PSW_USB_AV = ret ^ ret * 2u;
 837    env->PSW_USB_SAV |= env->PSW_USB_AV;
 838
 839    if (ret > 0x7fffffffll) {
 840        env->PSW_USB_V = (1 << 31);
 841        env->PSW_USB_SV |= env->PSW_USB_V;
 842        ret = INT32_MAX;
 843    } else if (ret < -0x80000000ll) {
 844        env->PSW_USB_V = (1 << 31);
 845        env->PSW_USB_SV |= env->PSW_USB_V;
 846        ret = INT32_MIN;
 847    } else {
 848        env->PSW_USB_V = 0;
 849    }
 850    return ret & 0xffff0000ll;
 851}
 852
 853uint64_t helper_madd64_suov(CPUTriCoreState *env, target_ulong r1,
 854                            uint64_t r2, target_ulong r3)
 855{
 856    uint64_t ret, mul;
 857    uint64_t t1 = extract64(r1, 0, 32);
 858    uint64_t t3 = extract64(r3, 0, 32);
 859
 860    mul = t1 * t3;
 861    ret = mul + r2;
 862
 863    t1 = ret >> 32;
 864    env->PSW_USB_AV = t1 ^ t1 * 2u;
 865    env->PSW_USB_SAV |= env->PSW_USB_AV;
 866
 867    if (ret < r2) {
 868        env->PSW_USB_V = (1 << 31);
 869        env->PSW_USB_SV = (1 << 31);
 870        /* saturate */
 871        ret = UINT64_MAX;
 872    } else {
 873        env->PSW_USB_V = 0;
 874    }
 875    return ret;
 876}
 877
 878target_ulong helper_msub32_ssov(CPUTriCoreState *env, target_ulong r1,
 879                                target_ulong r2, target_ulong r3)
 880{
 881    int64_t t1 = sextract64(r1, 0, 32);
 882    int64_t t2 = sextract64(r2, 0, 32);
 883    int64_t t3 = sextract64(r3, 0, 32);
 884    int64_t result;
 885
 886    result = t2 - (t1 * t3);
 887    return ssov32(env, result);
 888}
 889
 890target_ulong helper_msub32_suov(CPUTriCoreState *env, target_ulong r1,
 891                                target_ulong r2, target_ulong r3)
 892{
 893    uint64_t t1 = extract64(r1, 0, 32);
 894    uint64_t t2 = extract64(r2, 0, 32);
 895    uint64_t t3 = extract64(r3, 0, 32);
 896    uint64_t result;
 897    uint64_t mul;
 898
 899    mul = (t1 * t3);
 900    result = t2 - mul;
 901
 902    env->PSW_USB_AV = result ^ result * 2u;
 903    env->PSW_USB_SAV |= env->PSW_USB_AV;
 904    /* we calculate ovf by hand here, because the multiplication can overflow on
 905       the host, which would give false results if we compare to less than
 906       zero */
 907    if (mul > t2) {
 908        env->PSW_USB_V = (1 << 31);
 909        env->PSW_USB_SV = (1 << 31);
 910        result = 0;
 911    } else {
 912        env->PSW_USB_V = 0;
 913    }
 914    return result;
 915}
 916
 917uint64_t helper_msub64_ssov(CPUTriCoreState *env, target_ulong r1,
 918                            uint64_t r2, target_ulong r3)
 919{
 920    uint64_t ret, ovf;
 921    int64_t t1 = sextract64(r1, 0, 32);
 922    int64_t t3 = sextract64(r3, 0, 32);
 923    int64_t mul;
 924
 925    mul = t1 * t3;
 926    ret = r2 - mul;
 927    ovf = (ret ^ r2) & (mul ^ r2);
 928
 929    t1 = ret >> 32;
 930    env->PSW_USB_AV = t1 ^ t1 * 2u;
 931    env->PSW_USB_SAV |= env->PSW_USB_AV;
 932
 933    if ((int64_t)ovf < 0) {
 934        env->PSW_USB_V = (1 << 31);
 935        env->PSW_USB_SV = (1 << 31);
 936        /* ext_ret > MAX_INT */
 937        if (mul < 0) {
 938            ret = INT64_MAX;
 939        /* ext_ret < MIN_INT */
 940        } else {
 941            ret = INT64_MIN;
 942        }
 943    } else {
 944        env->PSW_USB_V = 0;
 945    }
 946    return ret;
 947}
 948
 949uint64_t helper_msub64_suov(CPUTriCoreState *env, target_ulong r1,
 950                            uint64_t r2, target_ulong r3)
 951{
 952    uint64_t ret, mul;
 953    uint64_t t1 = extract64(r1, 0, 32);
 954    uint64_t t3 = extract64(r3, 0, 32);
 955
 956    mul = t1 * t3;
 957    ret = r2 - mul;
 958
 959    t1 = ret >> 32;
 960    env->PSW_USB_AV = t1 ^ t1 * 2u;
 961    env->PSW_USB_SAV |= env->PSW_USB_AV;
 962
 963    if (ret > r2) {
 964        env->PSW_USB_V = (1 << 31);
 965        env->PSW_USB_SV = (1 << 31);
 966        /* saturate */
 967        ret = 0;
 968    } else {
 969        env->PSW_USB_V = 0;
 970    }
 971    return ret;
 972}
 973
 974uint32_t
 975helper_msub32_q_sub_ssov(CPUTriCoreState *env, uint64_t r1, uint64_t r2)
 976{
 977    int64_t result;
 978    int64_t t1 = (int64_t)r1;
 979    int64_t t2 = (int64_t)r2;
 980
 981    result = t1 - t2;
 982
 983    env->PSW_USB_AV = (result ^ result * 2u);
 984    env->PSW_USB_SAV |= env->PSW_USB_AV;
 985
 986    /* we do the saturation by hand, since we produce an overflow on the host
 987       if the mul before was (0x80000000 * 0x80000000) << 1). If this is the
 988       case, we flip the saturated value. */
 989    if (r2 == 0x8000000000000000LL) {
 990        if (result > 0x7fffffffLL) {
 991            env->PSW_USB_V = (1 << 31);
 992            env->PSW_USB_SV = (1 << 31);
 993            result = INT32_MIN;
 994        } else if (result < -0x80000000LL) {
 995            env->PSW_USB_V = (1 << 31);
 996            env->PSW_USB_SV = (1 << 31);
 997            result = INT32_MAX;
 998        } else {
 999            env->PSW_USB_V = 0;
1000        }
1001    } else {
1002        if (result > 0x7fffffffLL) {
1003            env->PSW_USB_V = (1 << 31);
1004            env->PSW_USB_SV = (1 << 31);
1005            result = INT32_MAX;
1006        } else if (result < -0x80000000LL) {
1007            env->PSW_USB_V = (1 << 31);
1008            env->PSW_USB_SV = (1 << 31);
1009            result = INT32_MIN;
1010        } else {
1011            env->PSW_USB_V = 0;
1012        }
1013    }
1014    return (uint32_t)result;
1015}
1016
1017uint64_t helper_msub64_q_ssov(CPUTriCoreState *env, uint64_t r1, uint32_t r2,
1018                              uint32_t r3, uint32_t n)
1019{
1020    int64_t t1 = (int64_t)r1;
1021    int64_t t2 = sextract64(r2, 0, 32);
1022    int64_t t3 = sextract64(r3, 0, 32);
1023    int64_t result, mul;
1024    int64_t ovf;
1025
1026    mul = (t2 * t3) << n;
1027    result = t1 - mul;
1028
1029    env->PSW_USB_AV = (result ^ result * 2u) >> 32;
1030    env->PSW_USB_SAV |= env->PSW_USB_AV;
1031
1032    ovf = (result ^ t1) & (t1 ^ mul);
1033    /* we do the saturation by hand, since we produce an overflow on the host
1034       if the mul before was (0x80000000 * 0x80000000) << 1). If this is the
1035       case, we flip the saturated value. */
1036    if (mul == 0x8000000000000000LL) {
1037        if (ovf >= 0) {
1038            env->PSW_USB_V = (1 << 31);
1039            env->PSW_USB_SV = (1 << 31);
1040            /* ext_ret > MAX_INT */
1041            if (mul >= 0) {
1042                result = INT64_MAX;
1043            /* ext_ret < MIN_INT */
1044            } else {
1045               result = INT64_MIN;
1046            }
1047        } else {
1048            env->PSW_USB_V = 0;
1049        }
1050    } else {
1051        if (ovf < 0) {
1052            env->PSW_USB_V = (1 << 31);
1053            env->PSW_USB_SV = (1 << 31);
1054            /* ext_ret > MAX_INT */
1055            if (mul < 0) {
1056                result = INT64_MAX;
1057            /* ext_ret < MIN_INT */
1058            } else {
1059               result = INT64_MIN;
1060            }
1061        } else {
1062            env->PSW_USB_V = 0;
1063        }
1064    }
1065
1066    return (uint64_t)result;
1067}
1068
1069uint32_t helper_msubr_q_ssov(CPUTriCoreState *env, uint32_t r1, uint32_t r2,
1070                             uint32_t r3, uint32_t n)
1071{
1072    int64_t t1 = sextract64(r1, 0, 32);
1073    int64_t t2 = sextract64(r2, 0, 32);
1074    int64_t t3 = sextract64(r3, 0, 32);
1075    int64_t mul, ret;
1076
1077    if ((t2 == -0x8000ll) && (t3 == -0x8000ll) && (n == 1)) {
1078        mul = 0x7fffffff;
1079    } else {
1080        mul = (t2 * t3) << n;
1081    }
1082
1083    ret = t1 - mul + 0x8000;
1084
1085    env->PSW_USB_AV = ret ^ ret * 2u;
1086    env->PSW_USB_SAV |= env->PSW_USB_AV;
1087
1088    if (ret > 0x7fffffffll) {
1089        env->PSW_USB_V = (1 << 31);
1090        env->PSW_USB_SV |= env->PSW_USB_V;
1091        ret = INT32_MAX;
1092    } else if (ret < -0x80000000ll) {
1093        env->PSW_USB_V = (1 << 31);
1094        env->PSW_USB_SV |= env->PSW_USB_V;
1095        ret = INT32_MIN;
1096    } else {
1097        env->PSW_USB_V = 0;
1098    }
1099    return ret & 0xffff0000ll;
1100}
1101
1102uint32_t helper_abs_b(CPUTriCoreState *env, target_ulong arg)
1103{
1104    int32_t b, i;
1105    int32_t ovf = 0;
1106    int32_t avf = 0;
1107    int32_t ret = 0;
1108
1109    for (i = 0; i < 4; i++) {
1110        b = sextract32(arg, i * 8, 8);
1111        b = (b >= 0) ? b : (0 - b);
1112        ovf |= (b > 0x7F) || (b < -0x80);
1113        avf |= b ^ b * 2u;
1114        ret |= (b & 0xff) << (i * 8);
1115    }
1116
1117    env->PSW_USB_V = ovf << 31;
1118    env->PSW_USB_SV |= env->PSW_USB_V;
1119    env->PSW_USB_AV = avf << 24;
1120    env->PSW_USB_SAV |= env->PSW_USB_AV;
1121
1122    return ret;
1123}
1124
1125uint32_t helper_abs_h(CPUTriCoreState *env, target_ulong arg)
1126{
1127    int32_t h, i;
1128    int32_t ovf = 0;
1129    int32_t avf = 0;
1130    int32_t ret = 0;
1131
1132    for (i = 0; i < 2; i++) {
1133        h = sextract32(arg, i * 16, 16);
1134        h = (h >= 0) ? h : (0 - h);
1135        ovf |= (h > 0x7FFF) || (h < -0x8000);
1136        avf |= h ^ h * 2u;
1137        ret |= (h & 0xffff) << (i * 16);
1138    }
1139
1140    env->PSW_USB_V = ovf << 31;
1141    env->PSW_USB_SV |= env->PSW_USB_V;
1142    env->PSW_USB_AV = avf << 16;
1143    env->PSW_USB_SAV |= env->PSW_USB_AV;
1144
1145    return ret;
1146}
1147
1148uint32_t helper_absdif_b(CPUTriCoreState *env, target_ulong r1, target_ulong r2)
1149{
1150    int32_t b, i;
1151    int32_t extr_r2;
1152    int32_t ovf = 0;
1153    int32_t avf = 0;
1154    int32_t ret = 0;
1155
1156    for (i = 0; i < 4; i++) {
1157        extr_r2 = sextract32(r2, i * 8, 8);
1158        b = sextract32(r1, i * 8, 8);
1159        b = (b > extr_r2) ? (b - extr_r2) : (extr_r2 - b);
1160        ovf |= (b > 0x7F) || (b < -0x80);
1161        avf |= b ^ b * 2u;
1162        ret |= (b & 0xff) << (i * 8);
1163    }
1164
1165    env->PSW_USB_V = ovf << 31;
1166    env->PSW_USB_SV |= env->PSW_USB_V;
1167    env->PSW_USB_AV = avf << 24;
1168    env->PSW_USB_SAV |= env->PSW_USB_AV;
1169    return ret;
1170}
1171
1172uint32_t helper_absdif_h(CPUTriCoreState *env, target_ulong r1, target_ulong r2)
1173{
1174    int32_t h, i;
1175    int32_t extr_r2;
1176    int32_t ovf = 0;
1177    int32_t avf = 0;
1178    int32_t ret = 0;
1179
1180    for (i = 0; i < 2; i++) {
1181        extr_r2 = sextract32(r2, i * 16, 16);
1182        h = sextract32(r1, i * 16, 16);
1183        h = (h > extr_r2) ? (h - extr_r2) : (extr_r2 - h);
1184        ovf |= (h > 0x7FFF) || (h < -0x8000);
1185        avf |= h ^ h * 2u;
1186        ret |= (h & 0xffff) << (i * 16);
1187    }
1188
1189    env->PSW_USB_V = ovf << 31;
1190    env->PSW_USB_SV |= env->PSW_USB_V;
1191    env->PSW_USB_AV = avf << 16;
1192    env->PSW_USB_SAV |= env->PSW_USB_AV;
1193
1194    return ret;
1195}
1196
1197uint32_t helper_addr_h(CPUTriCoreState *env, uint64_t r1, uint32_t r2_l,
1198                       uint32_t r2_h)
1199{
1200    int64_t mul_res0 = sextract64(r1, 0, 32);
1201    int64_t mul_res1 = sextract64(r1, 32, 32);
1202    int64_t r2_low = sextract64(r2_l, 0, 32);
1203    int64_t r2_high = sextract64(r2_h, 0, 32);
1204    int64_t result0, result1;
1205    uint32_t ovf0, ovf1;
1206    uint32_t avf0, avf1;
1207
1208    ovf0 = ovf1 = 0;
1209
1210    result0 = r2_low + mul_res0 + 0x8000;
1211    result1 = r2_high + mul_res1 + 0x8000;
1212
1213    if ((result0 > INT32_MAX) || (result0 < INT32_MIN)) {
1214        ovf0 = (1 << 31);
1215    }
1216
1217    if ((result1 > INT32_MAX) || (result1 < INT32_MIN)) {
1218        ovf1 = (1 << 31);
1219    }
1220
1221    env->PSW_USB_V = ovf0 | ovf1;
1222    env->PSW_USB_SV |= env->PSW_USB_V;
1223
1224    avf0 = result0 * 2u;
1225    avf0 = result0 ^ avf0;
1226    avf1 = result1 * 2u;
1227    avf1 = result1 ^ avf1;
1228
1229    env->PSW_USB_AV = avf0 | avf1;
1230    env->PSW_USB_SAV |= env->PSW_USB_AV;
1231
1232    return (result1 & 0xffff0000ULL) | ((result0 >> 16) & 0xffffULL);
1233}
1234
1235uint32_t helper_addsur_h(CPUTriCoreState *env, uint64_t r1, uint32_t r2_l,
1236                         uint32_t r2_h)
1237{
1238    int64_t mul_res0 = sextract64(r1, 0, 32);
1239    int64_t mul_res1 = sextract64(r1, 32, 32);
1240    int64_t r2_low = sextract64(r2_l, 0, 32);
1241    int64_t r2_high = sextract64(r2_h, 0, 32);
1242    int64_t result0, result1;
1243    uint32_t ovf0, ovf1;
1244    uint32_t avf0, avf1;
1245
1246    ovf0 = ovf1 = 0;
1247
1248    result0 = r2_low - mul_res0 + 0x8000;
1249    result1 = r2_high + mul_res1 + 0x8000;
1250
1251    if ((result0 > INT32_MAX) || (result0 < INT32_MIN)) {
1252        ovf0 = (1 << 31);
1253    }
1254
1255    if ((result1 > INT32_MAX) || (result1 < INT32_MIN)) {
1256        ovf1 = (1 << 31);
1257    }
1258
1259    env->PSW_USB_V = ovf0 | ovf1;
1260    env->PSW_USB_SV |= env->PSW_USB_V;
1261
1262    avf0 = result0 * 2u;
1263    avf0 = result0 ^ avf0;
1264    avf1 = result1 * 2u;
1265    avf1 = result1 ^ avf1;
1266
1267    env->PSW_USB_AV = avf0 | avf1;
1268    env->PSW_USB_SAV |= env->PSW_USB_AV;
1269
1270    return (result1 & 0xffff0000ULL) | ((result0 >> 16) & 0xffffULL);
1271}
1272
1273uint32_t helper_maddr_q(CPUTriCoreState *env, uint32_t r1, uint32_t r2,
1274                        uint32_t r3, uint32_t n)
1275{
1276    int64_t t1 = sextract64(r1, 0, 32);
1277    int64_t t2 = sextract64(r2, 0, 32);
1278    int64_t t3 = sextract64(r3, 0, 32);
1279    int64_t mul, ret;
1280
1281    if ((t2 == -0x8000ll) && (t3 == -0x8000ll) && (n == 1)) {
1282        mul = 0x7fffffff;
1283    } else {
1284        mul = (t2 * t3) << n;
1285    }
1286
1287    ret = t1 + mul + 0x8000;
1288
1289    if ((ret > 0x7fffffffll) || (ret < -0x80000000ll)) {
1290        env->PSW_USB_V = (1 << 31);
1291        env->PSW_USB_SV |= env->PSW_USB_V;
1292    } else {
1293        env->PSW_USB_V = 0;
1294    }
1295    env->PSW_USB_AV = ret ^ ret * 2u;
1296    env->PSW_USB_SAV |= env->PSW_USB_AV;
1297
1298    return ret & 0xffff0000ll;
1299}
1300
1301uint32_t helper_add_b(CPUTriCoreState *env, target_ulong r1, target_ulong r2)
1302{
1303    int32_t b, i;
1304    int32_t extr_r1, extr_r2;
1305    int32_t ovf = 0;
1306    int32_t avf = 0;
1307    uint32_t ret = 0;
1308
1309    for (i = 0; i < 4; i++) {
1310        extr_r1 = sextract32(r1, i * 8, 8);
1311        extr_r2 = sextract32(r2, i * 8, 8);
1312
1313        b = extr_r1 + extr_r2;
1314        ovf |= ((b > 0x7f) || (b < -0x80));
1315        avf |= b ^ b * 2u;
1316        ret |= ((b & 0xff) << (i*8));
1317    }
1318
1319    env->PSW_USB_V = (ovf << 31);
1320    env->PSW_USB_SV |= env->PSW_USB_V;
1321    env->PSW_USB_AV = avf << 24;
1322    env->PSW_USB_SAV |= env->PSW_USB_AV;
1323
1324    return ret;
1325}
1326
1327uint32_t helper_add_h(CPUTriCoreState *env, target_ulong r1, target_ulong r2)
1328{
1329    int32_t h, i;
1330    int32_t extr_r1, extr_r2;
1331    int32_t ovf = 0;
1332    int32_t avf = 0;
1333    int32_t ret = 0;
1334
1335    for (i = 0; i < 2; i++) {
1336        extr_r1 = sextract32(r1, i * 16, 16);
1337        extr_r2 = sextract32(r2, i * 16, 16);
1338        h = extr_r1 + extr_r2;
1339        ovf |= ((h > 0x7fff) || (h < -0x8000));
1340        avf |= h ^ h * 2u;
1341        ret |= (h & 0xffff) << (i * 16);
1342    }
1343
1344    env->PSW_USB_V = (ovf << 31);
1345    env->PSW_USB_SV |= env->PSW_USB_V;
1346    env->PSW_USB_AV = (avf << 16);
1347    env->PSW_USB_SAV |= env->PSW_USB_AV;
1348
1349    return ret;
1350}
1351
1352uint32_t helper_subr_h(CPUTriCoreState *env, uint64_t r1, uint32_t r2_l,
1353                       uint32_t r2_h)
1354{
1355    int64_t mul_res0 = sextract64(r1, 0, 32);
1356    int64_t mul_res1 = sextract64(r1, 32, 32);
1357    int64_t r2_low = sextract64(r2_l, 0, 32);
1358    int64_t r2_high = sextract64(r2_h, 0, 32);
1359    int64_t result0, result1;
1360    uint32_t ovf0, ovf1;
1361    uint32_t avf0, avf1;
1362
1363    ovf0 = ovf1 = 0;
1364
1365    result0 = r2_low - mul_res0 + 0x8000;
1366    result1 = r2_high - mul_res1 + 0x8000;
1367
1368    if ((result0 > INT32_MAX) || (result0 < INT32_MIN)) {
1369        ovf0 = (1 << 31);
1370    }
1371
1372    if ((result1 > INT32_MAX) || (result1 < INT32_MIN)) {
1373        ovf1 = (1 << 31);
1374    }
1375
1376    env->PSW_USB_V = ovf0 | ovf1;
1377    env->PSW_USB_SV |= env->PSW_USB_V;
1378
1379    avf0 = result0 * 2u;
1380    avf0 = result0 ^ avf0;
1381    avf1 = result1 * 2u;
1382    avf1 = result1 ^ avf1;
1383
1384    env->PSW_USB_AV = avf0 | avf1;
1385    env->PSW_USB_SAV |= env->PSW_USB_AV;
1386
1387    return (result1 & 0xffff0000ULL) | ((result0 >> 16) & 0xffffULL);
1388}
1389
1390uint32_t helper_subadr_h(CPUTriCoreState *env, uint64_t r1, uint32_t r2_l,
1391                         uint32_t r2_h)
1392{
1393    int64_t mul_res0 = sextract64(r1, 0, 32);
1394    int64_t mul_res1 = sextract64(r1, 32, 32);
1395    int64_t r2_low = sextract64(r2_l, 0, 32);
1396    int64_t r2_high = sextract64(r2_h, 0, 32);
1397    int64_t result0, result1;
1398    uint32_t ovf0, ovf1;
1399    uint32_t avf0, avf1;
1400
1401    ovf0 = ovf1 = 0;
1402
1403    result0 = r2_low + mul_res0 + 0x8000;
1404    result1 = r2_high - mul_res1 + 0x8000;
1405
1406    if ((result0 > INT32_MAX) || (result0 < INT32_MIN)) {
1407        ovf0 = (1 << 31);
1408    }
1409
1410    if ((result1 > INT32_MAX) || (result1 < INT32_MIN)) {
1411        ovf1 = (1 << 31);
1412    }
1413
1414    env->PSW_USB_V = ovf0 | ovf1;
1415    env->PSW_USB_SV |= env->PSW_USB_V;
1416
1417    avf0 = result0 * 2u;
1418    avf0 = result0 ^ avf0;
1419    avf1 = result1 * 2u;
1420    avf1 = result1 ^ avf1;
1421
1422    env->PSW_USB_AV = avf0 | avf1;
1423    env->PSW_USB_SAV |= env->PSW_USB_AV;
1424
1425    return (result1 & 0xffff0000ULL) | ((result0 >> 16) & 0xffffULL);
1426}
1427
1428uint32_t helper_msubr_q(CPUTriCoreState *env, uint32_t r1, uint32_t r2,
1429                        uint32_t r3, uint32_t n)
1430{
1431    int64_t t1 = sextract64(r1, 0, 32);
1432    int64_t t2 = sextract64(r2, 0, 32);
1433    int64_t t3 = sextract64(r3, 0, 32);
1434    int64_t mul, ret;
1435
1436    if ((t2 == -0x8000ll) && (t3 == -0x8000ll) && (n == 1)) {
1437        mul = 0x7fffffff;
1438    } else {
1439        mul = (t2 * t3) << n;
1440    }
1441
1442    ret = t1 - mul + 0x8000;
1443
1444    if ((ret > 0x7fffffffll) || (ret < -0x80000000ll)) {
1445        env->PSW_USB_V = (1 << 31);
1446        env->PSW_USB_SV |= env->PSW_USB_V;
1447    } else {
1448        env->PSW_USB_V = 0;
1449    }
1450    env->PSW_USB_AV = ret ^ ret * 2u;
1451    env->PSW_USB_SAV |= env->PSW_USB_AV;
1452
1453    return ret & 0xffff0000ll;
1454}
1455
1456uint32_t helper_sub_b(CPUTriCoreState *env, target_ulong r1, target_ulong r2)
1457{
1458    int32_t b, i;
1459    int32_t extr_r1, extr_r2;
1460    int32_t ovf = 0;
1461    int32_t avf = 0;
1462    uint32_t ret = 0;
1463
1464    for (i = 0; i < 4; i++) {
1465        extr_r1 = sextract32(r1, i * 8, 8);
1466        extr_r2 = sextract32(r2, i * 8, 8);
1467
1468        b = extr_r1 - extr_r2;
1469        ovf |= ((b > 0x7f) || (b < -0x80));
1470        avf |= b ^ b * 2u;
1471        ret |= ((b & 0xff) << (i*8));
1472    }
1473
1474    env->PSW_USB_V = (ovf << 31);
1475    env->PSW_USB_SV |= env->PSW_USB_V;
1476    env->PSW_USB_AV = avf << 24;
1477    env->PSW_USB_SAV |= env->PSW_USB_AV;
1478
1479    return ret;
1480}
1481
1482uint32_t helper_sub_h(CPUTriCoreState *env, target_ulong r1, target_ulong r2)
1483{
1484    int32_t h, i;
1485    int32_t extr_r1, extr_r2;
1486    int32_t ovf = 0;
1487    int32_t avf = 0;
1488    int32_t ret = 0;
1489
1490    for (i = 0; i < 2; i++) {
1491        extr_r1 = sextract32(r1, i * 16, 16);
1492        extr_r2 = sextract32(r2, i * 16, 16);
1493        h = extr_r1 - extr_r2;
1494        ovf |= ((h > 0x7fff) || (h < -0x8000));
1495        avf |= h ^ h * 2u;
1496        ret |= (h & 0xffff) << (i * 16);
1497    }
1498
1499    env->PSW_USB_V = (ovf << 31);
1500    env->PSW_USB_SV |= env->PSW_USB_V;
1501    env->PSW_USB_AV = avf << 16;
1502    env->PSW_USB_SAV |= env->PSW_USB_AV;
1503
1504    return ret;
1505}
1506
1507uint32_t helper_eq_b(target_ulong r1, target_ulong r2)
1508{
1509    int32_t ret;
1510    int32_t i, msk;
1511
1512    ret = 0;
1513    msk = 0xff;
1514    for (i = 0; i < 4; i++) {
1515        if ((r1 & msk) == (r2 & msk)) {
1516            ret |= msk;
1517        }
1518        msk = msk << 8;
1519    }
1520
1521    return ret;
1522}
1523
1524uint32_t helper_eq_h(target_ulong r1, target_ulong r2)
1525{
1526    int32_t ret = 0;
1527
1528    if ((r1 & 0xffff) == (r2 & 0xffff)) {
1529        ret = 0xffff;
1530    }
1531
1532    if ((r1 & 0xffff0000) == (r2 & 0xffff0000)) {
1533        ret |= 0xffff0000;
1534    }
1535
1536    return ret;
1537}
1538
1539uint32_t helper_eqany_b(target_ulong r1, target_ulong r2)
1540{
1541    int32_t i;
1542    uint32_t ret = 0;
1543
1544    for (i = 0; i < 4; i++) {
1545        ret |= (sextract32(r1,  i * 8, 8) == sextract32(r2,  i * 8, 8));
1546    }
1547
1548    return ret;
1549}
1550
1551uint32_t helper_eqany_h(target_ulong r1, target_ulong r2)
1552{
1553    uint32_t ret;
1554
1555    ret = (sextract32(r1, 0, 16) == sextract32(r2,  0, 16));
1556    ret |= (sextract32(r1, 16, 16) == sextract32(r2,  16, 16));
1557
1558    return ret;
1559}
1560
1561uint32_t helper_lt_b(target_ulong r1, target_ulong r2)
1562{
1563    int32_t i;
1564    uint32_t ret = 0;
1565
1566    for (i = 0; i < 4; i++) {
1567        if (sextract32(r1,  i * 8, 8) < sextract32(r2,  i * 8, 8)) {
1568            ret |= (0xff << (i * 8));
1569        }
1570    }
1571
1572    return ret;
1573}
1574
1575uint32_t helper_lt_bu(target_ulong r1, target_ulong r2)
1576{
1577    int32_t i;
1578    uint32_t ret = 0;
1579
1580    for (i = 0; i < 4; i++) {
1581        if (extract32(r1,  i * 8, 8) < extract32(r2,  i * 8, 8)) {
1582            ret |= (0xff << (i * 8));
1583        }
1584    }
1585
1586    return ret;
1587}
1588
1589uint32_t helper_lt_h(target_ulong r1, target_ulong r2)
1590{
1591    uint32_t ret = 0;
1592
1593    if (sextract32(r1,  0, 16) < sextract32(r2,  0, 16)) {
1594        ret |= 0xffff;
1595    }
1596
1597    if (sextract32(r1,  16, 16) < sextract32(r2,  16, 16)) {
1598        ret |= 0xffff0000;
1599    }
1600
1601    return ret;
1602}
1603
1604uint32_t helper_lt_hu(target_ulong r1, target_ulong r2)
1605{
1606    uint32_t ret = 0;
1607
1608    if (extract32(r1,  0, 16) < extract32(r2,  0, 16)) {
1609        ret |= 0xffff;
1610    }
1611
1612    if (extract32(r1,  16, 16) < extract32(r2,  16, 16)) {
1613        ret |= 0xffff0000;
1614    }
1615
1616    return ret;
1617}
1618
1619#define EXTREMA_H_B(name, op)                                 \
1620uint32_t helper_##name ##_b(target_ulong r1, target_ulong r2) \
1621{                                                             \
1622    int32_t i, extr_r1, extr_r2;                              \
1623    uint32_t ret = 0;                                         \
1624                                                              \
1625    for (i = 0; i < 4; i++) {                                 \
1626        extr_r1 = sextract32(r1, i * 8, 8);                   \
1627        extr_r2 = sextract32(r2, i * 8, 8);                   \
1628        extr_r1 = (extr_r1 op extr_r2) ? extr_r1 : extr_r2;   \
1629        ret |= (extr_r1 & 0xff) << (i * 8);                   \
1630    }                                                         \
1631    return ret;                                               \
1632}                                                             \
1633                                                              \
1634uint32_t helper_##name ##_bu(target_ulong r1, target_ulong r2)\
1635{                                                             \
1636    int32_t i;                                                \
1637    uint32_t extr_r1, extr_r2;                                \
1638    uint32_t ret = 0;                                         \
1639                                                              \
1640    for (i = 0; i < 4; i++) {                                 \
1641        extr_r1 = extract32(r1, i * 8, 8);                    \
1642        extr_r2 = extract32(r2, i * 8, 8);                    \
1643        extr_r1 = (extr_r1 op extr_r2) ? extr_r1 : extr_r2;   \
1644        ret |= (extr_r1 & 0xff) << (i * 8);                   \
1645    }                                                         \
1646    return ret;                                               \
1647}                                                             \
1648                                                              \
1649uint32_t helper_##name ##_h(target_ulong r1, target_ulong r2) \
1650{                                                             \
1651    int32_t extr_r1, extr_r2;                                 \
1652    uint32_t ret = 0;                                         \
1653                                                              \
1654    extr_r1 = sextract32(r1, 0, 16);                          \
1655    extr_r2 = sextract32(r2, 0, 16);                          \
1656    ret = (extr_r1 op extr_r2) ? extr_r1 : extr_r2;           \
1657    ret = ret & 0xffff;                                       \
1658                                                              \
1659    extr_r1 = sextract32(r1, 16, 16);                         \
1660    extr_r2 = sextract32(r2, 16, 16);                         \
1661    extr_r1 = (extr_r1 op extr_r2) ? extr_r1 : extr_r2;       \
1662    ret |= extr_r1 << 16;                                     \
1663                                                              \
1664    return ret;                                               \
1665}                                                             \
1666                                                              \
1667uint32_t helper_##name ##_hu(target_ulong r1, target_ulong r2)\
1668{                                                             \
1669    uint32_t extr_r1, extr_r2;                                \
1670    uint32_t ret = 0;                                         \
1671                                                              \
1672    extr_r1 = extract32(r1, 0, 16);                           \
1673    extr_r2 = extract32(r2, 0, 16);                           \
1674    ret = (extr_r1 op extr_r2) ? extr_r1 : extr_r2;           \
1675    ret = ret & 0xffff;                                       \
1676                                                              \
1677    extr_r1 = extract32(r1, 16, 16);                          \
1678    extr_r2 = extract32(r2, 16, 16);                          \
1679    extr_r1 = (extr_r1 op extr_r2) ? extr_r1 : extr_r2;       \
1680    ret |= extr_r1 << (16);                                   \
1681                                                              \
1682    return ret;                                               \
1683}                                                             \
1684                                                              \
1685uint64_t helper_ix##name(uint64_t r1, uint32_t r2)            \
1686{                                                             \
1687    int64_t r2l, r2h, r1hl;                                   \
1688    uint64_t ret = 0;                                         \
1689                                                              \
1690    ret = ((r1 + 2) & 0xffff);                                \
1691    r2l = sextract64(r2, 0, 16);                              \
1692    r2h = sextract64(r2, 16, 16);                             \
1693    r1hl = sextract64(r1, 32, 16);                            \
1694                                                              \
1695    if ((r2l op ## = r2h) && (r2l op r1hl)) {                 \
1696        ret |= (r2l & 0xffff) << 32;                          \
1697        ret |= extract64(r1, 0, 16) << 16;                    \
1698    } else if ((r2h op r2l) && (r2h op r1hl)) {               \
1699        ret |= extract64(r2, 16, 16) << 32;                   \
1700        ret |= extract64(r1 + 1, 0, 16) << 16;                \
1701    } else {                                                  \
1702        ret |= r1 & 0xffffffff0000ull;                        \
1703    }                                                         \
1704    return ret;                                               \
1705}                                                             \
1706                                                              \
1707uint64_t helper_ix##name ##_u(uint64_t r1, uint32_t r2)       \
1708{                                                             \
1709    int64_t r2l, r2h, r1hl;                                   \
1710    uint64_t ret = 0;                                         \
1711                                                              \
1712    ret = ((r1 + 2) & 0xffff);                                \
1713    r2l = extract64(r2, 0, 16);                               \
1714    r2h = extract64(r2, 16, 16);                              \
1715    r1hl = extract64(r1, 32, 16);                             \
1716                                                              \
1717    if ((r2l op ## = r2h) && (r2l op r1hl)) {                 \
1718        ret |= (r2l & 0xffff) << 32;                          \
1719        ret |= extract64(r1, 0, 16) << 16;                    \
1720    } else if ((r2h op r2l) && (r2h op r1hl)) {               \
1721        ret |= extract64(r2, 16, 16) << 32;                   \
1722        ret |= extract64(r1 + 1, 0, 16) << 16;                \
1723    } else {                                                  \
1724        ret |= r1 & 0xffffffff0000ull;                        \
1725    }                                                         \
1726    return ret;                                               \
1727}
1728
1729EXTREMA_H_B(max, >)
1730EXTREMA_H_B(min, <)
1731
1732#undef EXTREMA_H_B
1733
1734uint32_t helper_clo_h(target_ulong r1)
1735{
1736    uint32_t ret_hw0 = extract32(r1, 0, 16);
1737    uint32_t ret_hw1 = extract32(r1, 16, 16);
1738
1739    ret_hw0 = clo32(ret_hw0 << 16);
1740    ret_hw1 = clo32(ret_hw1 << 16);
1741
1742    if (ret_hw0 > 16) {
1743        ret_hw0 = 16;
1744    }
1745    if (ret_hw1 > 16) {
1746        ret_hw1 = 16;
1747    }
1748
1749    return ret_hw0 | (ret_hw1 << 16);
1750}
1751
1752uint32_t helper_clz_h(target_ulong r1)
1753{
1754    uint32_t ret_hw0 = extract32(r1, 0, 16);
1755    uint32_t ret_hw1 = extract32(r1, 16, 16);
1756
1757    ret_hw0 = clz32(ret_hw0 << 16);
1758    ret_hw1 = clz32(ret_hw1 << 16);
1759
1760    if (ret_hw0 > 16) {
1761        ret_hw0 = 16;
1762    }
1763    if (ret_hw1 > 16) {
1764        ret_hw1 = 16;
1765    }
1766
1767    return ret_hw0 | (ret_hw1 << 16);
1768}
1769
1770uint32_t helper_cls_h(target_ulong r1)
1771{
1772    uint32_t ret_hw0 = extract32(r1, 0, 16);
1773    uint32_t ret_hw1 = extract32(r1, 16, 16);
1774
1775    ret_hw0 = clrsb32(ret_hw0 << 16);
1776    ret_hw1 = clrsb32(ret_hw1 << 16);
1777
1778    if (ret_hw0 > 15) {
1779        ret_hw0 = 15;
1780    }
1781    if (ret_hw1 > 15) {
1782        ret_hw1 = 15;
1783    }
1784
1785    return ret_hw0 | (ret_hw1 << 16);
1786}
1787
1788uint32_t helper_sh(target_ulong r1, target_ulong r2)
1789{
1790    int32_t shift_count = sextract32(r2, 0, 6);
1791
1792    if (shift_count == -32) {
1793        return 0;
1794    } else if (shift_count < 0) {
1795        return r1 >> -shift_count;
1796    } else {
1797        return r1 << shift_count;
1798    }
1799}
1800
1801uint32_t helper_sh_h(target_ulong r1, target_ulong r2)
1802{
1803    int32_t ret_hw0, ret_hw1;
1804    int32_t shift_count;
1805
1806    shift_count = sextract32(r2, 0, 5);
1807
1808    if (shift_count == -16) {
1809        return 0;
1810    } else if (shift_count < 0) {
1811        ret_hw0 = extract32(r1, 0, 16) >> -shift_count;
1812        ret_hw1 = extract32(r1, 16, 16) >> -shift_count;
1813        return (ret_hw0 & 0xffff) | (ret_hw1 << 16);
1814    } else {
1815        ret_hw0 = extract32(r1, 0, 16) << shift_count;
1816        ret_hw1 = extract32(r1, 16, 16) << shift_count;
1817        return (ret_hw0 & 0xffff) | (ret_hw1 << 16);
1818    }
1819}
1820
1821uint32_t helper_sha(CPUTriCoreState *env, target_ulong r1, target_ulong r2)
1822{
1823    int32_t shift_count;
1824    int64_t result, t1;
1825    uint32_t ret;
1826
1827    shift_count = sextract32(r2, 0, 6);
1828    t1 = sextract32(r1, 0, 32);
1829
1830    if (shift_count == 0) {
1831        env->PSW_USB_C = env->PSW_USB_V = 0;
1832        ret = r1;
1833    } else if (shift_count == -32) {
1834        env->PSW_USB_C = r1;
1835        env->PSW_USB_V = 0;
1836        ret = t1 >> 31;
1837    } else if (shift_count > 0) {
1838        result = t1 << shift_count;
1839        /* calc carry */
1840        env->PSW_USB_C = ((result & 0xffffffff00000000ULL) != 0);
1841        /* calc v */
1842        env->PSW_USB_V = (((result > 0x7fffffffLL) ||
1843                           (result < -0x80000000LL)) << 31);
1844        /* calc sv */
1845        env->PSW_USB_SV |= env->PSW_USB_V;
1846        ret = (uint32_t)result;
1847    } else {
1848        env->PSW_USB_V = 0;
1849        env->PSW_USB_C = (r1 & ((1 << -shift_count) - 1));
1850        ret = t1 >> -shift_count;
1851    }
1852
1853    env->PSW_USB_AV = ret ^ ret * 2u;
1854    env->PSW_USB_SAV |= env->PSW_USB_AV;
1855
1856    return ret;
1857}
1858
1859uint32_t helper_sha_h(target_ulong r1, target_ulong r2)
1860{
1861    int32_t shift_count;
1862    int32_t ret_hw0, ret_hw1;
1863
1864    shift_count = sextract32(r2, 0, 5);
1865
1866    if (shift_count == 0) {
1867        return r1;
1868    } else if (shift_count < 0) {
1869        ret_hw0 = sextract32(r1, 0, 16) >> -shift_count;
1870        ret_hw1 = sextract32(r1, 16, 16) >> -shift_count;
1871        return (ret_hw0 & 0xffff) | (ret_hw1 << 16);
1872    } else {
1873        ret_hw0 = sextract32(r1, 0, 16) << shift_count;
1874        ret_hw1 = sextract32(r1, 16, 16) << shift_count;
1875        return (ret_hw0 & 0xffff) | (ret_hw1 << 16);
1876    }
1877}
1878
1879uint32_t helper_bmerge(target_ulong r1, target_ulong r2)
1880{
1881    uint32_t i, ret;
1882
1883    ret = 0;
1884    for (i = 0; i < 16; i++) {
1885        ret |= (r1 & 1) << (2 * i + 1);
1886        ret |= (r2 & 1) << (2 * i);
1887        r1 = r1 >> 1;
1888        r2 = r2 >> 1;
1889    }
1890    return ret;
1891}
1892
1893uint64_t helper_bsplit(uint32_t r1)
1894{
1895    int32_t i;
1896    uint64_t ret;
1897
1898    ret = 0;
1899    for (i = 0; i < 32; i = i + 2) {
1900        /* even */
1901        ret |= (r1 & 1) << (i/2);
1902        r1 = r1 >> 1;
1903        /* odd */
1904        ret |= (uint64_t)(r1 & 1) << (i/2 + 32);
1905        r1 = r1 >> 1;
1906    }
1907    return ret;
1908}
1909
1910uint32_t helper_parity(target_ulong r1)
1911{
1912    uint32_t ret;
1913    uint32_t nOnes, i;
1914
1915    ret = 0;
1916    nOnes = 0;
1917    for (i = 0; i < 8; i++) {
1918        ret ^= (r1 & 1);
1919        r1 = r1 >> 1;
1920    }
1921    /* second byte */
1922    nOnes = 0;
1923    for (i = 0; i < 8; i++) {
1924        nOnes ^= (r1 & 1);
1925        r1 = r1 >> 1;
1926    }
1927    ret |= nOnes << 8;
1928    /* third byte */
1929    nOnes = 0;
1930    for (i = 0; i < 8; i++) {
1931        nOnes ^= (r1 & 1);
1932        r1 = r1 >> 1;
1933    }
1934    ret |= nOnes << 16;
1935    /* fourth byte */
1936    nOnes = 0;
1937    for (i = 0; i < 8; i++) {
1938        nOnes ^= (r1 & 1);
1939        r1 = r1 >> 1;
1940    }
1941    ret |= nOnes << 24;
1942
1943    return ret;
1944}
1945
1946uint32_t helper_pack(uint32_t carry, uint32_t r1_low, uint32_t r1_high,
1947                     target_ulong r2)
1948{
1949    uint32_t ret;
1950    int32_t fp_exp, fp_frac, temp_exp, fp_exp_frac;
1951    int32_t int_exp  = r1_high;
1952    int32_t int_mant = r1_low;
1953    uint32_t flag_rnd = (int_mant & (1 << 7)) && (
1954                        (int_mant & (1 << 8)) ||
1955                        (int_mant & 0x7f)     ||
1956                        (carry != 0));
1957    if (((int_mant & (1<<31)) == 0) && (int_exp == 255)) {
1958        fp_exp = 255;
1959        fp_frac = extract32(int_mant, 8, 23);
1960    } else if ((int_mant & (1<<31)) && (int_exp >= 127)) {
1961        fp_exp  = 255;
1962        fp_frac = 0;
1963    } else if ((int_mant & (1<<31)) && (int_exp <= -128)) {
1964        fp_exp  = 0;
1965        fp_frac = 0;
1966    } else if (int_mant == 0) {
1967        fp_exp  = 0;
1968        fp_frac = 0;
1969    } else {
1970        if (((int_mant & (1 << 31)) == 0)) {
1971            temp_exp = 0;
1972        } else {
1973            temp_exp = int_exp + 128;
1974        }
1975        fp_exp_frac = (((temp_exp & 0xff) << 23) |
1976                      extract32(int_mant, 8, 23))
1977                      + flag_rnd;
1978        fp_exp  = extract32(fp_exp_frac, 23, 8);
1979        fp_frac = extract32(fp_exp_frac, 0, 23);
1980    }
1981    ret = r2 & (1 << 31);
1982    ret = ret + (fp_exp << 23);
1983    ret = ret + (fp_frac & 0x7fffff);
1984
1985    return ret;
1986}
1987
1988uint64_t helper_unpack(target_ulong arg1)
1989{
1990    int32_t fp_exp  = extract32(arg1, 23, 8);
1991    int32_t fp_frac = extract32(arg1, 0, 23);
1992    uint64_t ret;
1993    int32_t int_exp, int_mant;
1994
1995    if (fp_exp == 255) {
1996        int_exp = 255;
1997        int_mant = (fp_frac << 7);
1998    } else if ((fp_exp == 0) && (fp_frac == 0)) {
1999        int_exp  = -127;
2000        int_mant = 0;
2001    } else if ((fp_exp == 0) && (fp_frac != 0)) {
2002        int_exp  = -126;
2003        int_mant = (fp_frac << 7);
2004    } else {
2005        int_exp  = fp_exp - 127;
2006        int_mant = (fp_frac << 7);
2007        int_mant |= (1 << 30);
2008    }
2009    ret = int_exp;
2010    ret = ret << 32;
2011    ret |= int_mant;
2012
2013    return ret;
2014}
2015
2016uint64_t helper_dvinit_b_13(CPUTriCoreState *env, uint32_t r1, uint32_t r2)
2017{
2018    uint64_t ret;
2019    int32_t abs_sig_dividend, abs_divisor;
2020
2021    ret = sextract32(r1, 0, 32);
2022    ret = ret << 24;
2023    if (!((r1 & 0x80000000) == (r2 & 0x80000000))) {
2024        ret |= 0xffffff;
2025    }
2026
2027    abs_sig_dividend = abs((int32_t)r1) >> 8;
2028    abs_divisor = abs((int32_t)r2);
2029    /* calc overflow
2030       ofv if (a/b >= 255) <=> (a/255 >= b) */
2031    env->PSW_USB_V = (abs_sig_dividend >= abs_divisor) << 31;
2032    env->PSW_USB_V = env->PSW_USB_V << 31;
2033    env->PSW_USB_SV |= env->PSW_USB_V;
2034    env->PSW_USB_AV = 0;
2035
2036    return ret;
2037}
2038
2039uint64_t helper_dvinit_b_131(CPUTriCoreState *env, uint32_t r1, uint32_t r2)
2040{
2041    uint64_t ret = sextract32(r1, 0, 32);
2042
2043    ret = ret << 24;
2044    if (!((r1 & 0x80000000) == (r2 & 0x80000000))) {
2045        ret |= 0xffffff;
2046    }
2047    /* calc overflow */
2048    env->PSW_USB_V = ((r2 == 0) || ((r2 == 0xffffffff) && (r1 == 0xffffff80)));
2049    env->PSW_USB_V = env->PSW_USB_V << 31;
2050    env->PSW_USB_SV |= env->PSW_USB_V;
2051    env->PSW_USB_AV = 0;
2052
2053    return ret;
2054}
2055
2056uint64_t helper_dvinit_h_13(CPUTriCoreState *env, uint32_t r1, uint32_t r2)
2057{
2058    uint64_t ret;
2059    int32_t abs_sig_dividend, abs_divisor;
2060
2061    ret = sextract32(r1, 0, 32);
2062    ret = ret << 16;
2063    if (!((r1 & 0x80000000) == (r2 & 0x80000000))) {
2064        ret |= 0xffff;
2065    }
2066
2067    abs_sig_dividend = abs((int32_t)r1) >> 16;
2068    abs_divisor = abs((int32_t)r2);
2069    /* calc overflow
2070       ofv if (a/b >= 0xffff) <=> (a/0xffff >= b) */
2071    env->PSW_USB_V = (abs_sig_dividend >= abs_divisor) << 31;
2072    env->PSW_USB_V = env->PSW_USB_V << 31;
2073    env->PSW_USB_SV |= env->PSW_USB_V;
2074    env->PSW_USB_AV = 0;
2075
2076    return ret;
2077}
2078
2079uint64_t helper_dvinit_h_131(CPUTriCoreState *env, uint32_t r1, uint32_t r2)
2080{
2081    uint64_t ret = sextract32(r1, 0, 32);
2082
2083    ret = ret << 16;
2084    if (!((r1 & 0x80000000) == (r2 & 0x80000000))) {
2085        ret |= 0xffff;
2086    }
2087    /* calc overflow */
2088    env->PSW_USB_V = ((r2 == 0) || ((r2 == 0xffffffff) && (r1 == 0xffff8000)));
2089    env->PSW_USB_V = env->PSW_USB_V << 31;
2090    env->PSW_USB_SV |= env->PSW_USB_V;
2091    env->PSW_USB_AV = 0;
2092
2093    return ret;
2094}
2095
2096uint64_t helper_dvadj(uint64_t r1, uint32_t r2)
2097{
2098    int32_t x_sign = (r1 >> 63);
2099    int32_t q_sign = x_sign ^ (r2 >> 31);
2100    int32_t eq_pos = x_sign & ((r1 >> 32) == r2);
2101    int32_t eq_neg = x_sign & ((r1 >> 32) == -r2);
2102    uint32_t quotient;
2103    uint64_t remainder;
2104
2105    if ((q_sign & ~eq_neg) | eq_pos) {
2106        quotient = (r1 + 1) & 0xffffffff;
2107    } else {
2108        quotient = r1 & 0xffffffff;
2109    }
2110
2111    if (eq_pos | eq_neg) {
2112        remainder = 0;
2113    } else {
2114        remainder = (r1 & 0xffffffff00000000ull);
2115    }
2116    return remainder | quotient;
2117}
2118
2119uint64_t helper_dvstep(uint64_t r1, uint32_t r2)
2120{
2121    int32_t dividend_sign = extract64(r1, 63, 1);
2122    int32_t divisor_sign = extract32(r2, 31, 1);
2123    int32_t quotient_sign = (dividend_sign != divisor_sign);
2124    int32_t addend, dividend_quotient, remainder;
2125    int32_t i, temp;
2126
2127    if (quotient_sign) {
2128        addend = r2;
2129    } else {
2130        addend = -r2;
2131    }
2132    dividend_quotient = (int32_t)r1;
2133    remainder = (int32_t)(r1 >> 32);
2134
2135    for (i = 0; i < 8; i++) {
2136        remainder = (remainder << 1) | extract32(dividend_quotient, 31, 1);
2137        dividend_quotient <<= 1;
2138        temp = remainder + addend;
2139        if ((temp < 0) == dividend_sign) {
2140            remainder = temp;
2141        }
2142        if (((temp < 0) == dividend_sign)) {
2143            dividend_quotient = dividend_quotient | !quotient_sign;
2144        } else {
2145            dividend_quotient = dividend_quotient | quotient_sign;
2146        }
2147    }
2148    return ((uint64_t)remainder << 32) | (uint32_t)dividend_quotient;
2149}
2150
2151uint64_t helper_dvstep_u(uint64_t r1, uint32_t r2)
2152{
2153    int32_t dividend_quotient = extract64(r1, 0, 32);
2154    int64_t remainder = extract64(r1, 32, 32);
2155    int32_t i;
2156    int64_t temp;
2157    for (i = 0; i < 8; i++) {
2158        remainder = (remainder << 1) | extract32(dividend_quotient, 31, 1);
2159        dividend_quotient <<= 1;
2160        temp = (remainder & 0xffffffff) - r2;
2161        if (temp >= 0) {
2162            remainder = temp;
2163        }
2164        dividend_quotient = dividend_quotient | !(temp < 0);
2165    }
2166    return ((uint64_t)remainder << 32) | (uint32_t)dividend_quotient;
2167}
2168
2169uint64_t helper_divide(CPUTriCoreState *env, uint32_t r1, uint32_t r2)
2170{
2171    int32_t quotient, remainder;
2172    int32_t dividend = (int32_t)r1;
2173    int32_t divisor = (int32_t)r2;
2174
2175    if (divisor == 0) {
2176        if (dividend >= 0) {
2177            quotient = 0x7fffffff;
2178            remainder = 0;
2179        } else {
2180            quotient = 0x80000000;
2181            remainder = 0;
2182        }
2183        env->PSW_USB_V = (1 << 31);
2184    } else if ((divisor == 0xffffffff) && (dividend == 0x80000000)) {
2185        quotient = 0x7fffffff;
2186        remainder = 0;
2187        env->PSW_USB_V = (1 << 31);
2188    } else {
2189        remainder = dividend % divisor;
2190        quotient = (dividend - remainder)/divisor;
2191        env->PSW_USB_V = 0;
2192    }
2193    env->PSW_USB_SV |= env->PSW_USB_V;
2194    env->PSW_USB_AV = 0;
2195    return ((uint64_t)remainder << 32) | (uint32_t)quotient;
2196}
2197
2198uint64_t helper_divide_u(CPUTriCoreState *env, uint32_t r1, uint32_t r2)
2199{
2200    uint32_t quotient, remainder;
2201    uint32_t dividend = r1;
2202    uint32_t divisor = r2;
2203
2204    if (divisor == 0) {
2205        quotient = 0xffffffff;
2206        remainder = 0;
2207        env->PSW_USB_V = (1 << 31);
2208    } else {
2209        remainder = dividend % divisor;
2210        quotient = (dividend - remainder)/divisor;
2211        env->PSW_USB_V = 0;
2212    }
2213    env->PSW_USB_SV |= env->PSW_USB_V;
2214    env->PSW_USB_AV = 0;
2215    return ((uint64_t)remainder << 32) | quotient;
2216}
2217
2218uint64_t helper_mul_h(uint32_t arg00, uint32_t arg01,
2219                      uint32_t arg10, uint32_t arg11, uint32_t n)
2220{
2221    uint32_t result0, result1;
2222
2223    int32_t sc1 = ((arg00 & 0xffff) == 0x8000) &&
2224                  ((arg10 & 0xffff) == 0x8000) && (n == 1);
2225    int32_t sc0 = ((arg01 & 0xffff) == 0x8000) &&
2226                  ((arg11 & 0xffff) == 0x8000) && (n == 1);
2227    if (sc1) {
2228        result1 = 0x7fffffff;
2229    } else {
2230        result1 = (((uint32_t)(arg00 * arg10)) << n);
2231    }
2232    if (sc0) {
2233        result0 = 0x7fffffff;
2234    } else {
2235        result0 = (((uint32_t)(arg01 * arg11)) << n);
2236    }
2237    return (((uint64_t)result1 << 32)) | result0;
2238}
2239
2240uint64_t helper_mulm_h(uint32_t arg00, uint32_t arg01,
2241                       uint32_t arg10, uint32_t arg11, uint32_t n)
2242{
2243    uint64_t ret;
2244    int64_t result0, result1;
2245
2246    int32_t sc1 = ((arg00 & 0xffff) == 0x8000) &&
2247                  ((arg10 & 0xffff) == 0x8000) && (n == 1);
2248    int32_t sc0 = ((arg01 & 0xffff) == 0x8000) &&
2249                  ((arg11 & 0xffff) == 0x8000) && (n == 1);
2250
2251    if (sc1) {
2252        result1 = 0x7fffffff;
2253    } else {
2254        result1 = (((int32_t)arg00 * (int32_t)arg10) << n);
2255    }
2256    if (sc0) {
2257        result0 = 0x7fffffff;
2258    } else {
2259        result0 = (((int32_t)arg01 * (int32_t)arg11) << n);
2260    }
2261    ret = (result1 + result0);
2262    ret = ret << 16;
2263    return ret;
2264}
2265uint32_t helper_mulr_h(uint32_t arg00, uint32_t arg01,
2266                       uint32_t arg10, uint32_t arg11, uint32_t n)
2267{
2268    uint32_t result0, result1;
2269
2270    int32_t sc1 = ((arg00 & 0xffff) == 0x8000) &&
2271                  ((arg10 & 0xffff) == 0x8000) && (n == 1);
2272    int32_t sc0 = ((arg01 & 0xffff) == 0x8000) &&
2273                  ((arg11 & 0xffff) == 0x8000) && (n == 1);
2274
2275    if (sc1) {
2276        result1 = 0x7fffffff;
2277    } else {
2278        result1 = ((arg00 * arg10) << n) + 0x8000;
2279    }
2280    if (sc0) {
2281        result0 = 0x7fffffff;
2282    } else {
2283        result0 = ((arg01 * arg11) << n) + 0x8000;
2284    }
2285    return (result1 & 0xffff0000) | (result0 >> 16);
2286}
2287
2288uint32_t helper_crc32(uint32_t arg0, uint32_t arg1)
2289{
2290    uint8_t buf[4];
2291    stl_be_p(buf, arg0);
2292
2293    return crc32(arg1, buf, 4);
2294}
2295
2296/* context save area (CSA) related helpers */
2297
2298static int cdc_increment(target_ulong *psw)
2299{
2300    if ((*psw & MASK_PSW_CDC) == 0x7f) {
2301        return 0;
2302    }
2303
2304    (*psw)++;
2305    /* check for overflow */
2306    int lo = clo32((*psw & MASK_PSW_CDC) << (32 - 7));
2307    int mask = (1u << (7 - lo)) - 1;
2308    int count = *psw & mask;
2309    if (count == 0) {
2310        (*psw)--;
2311        return 1;
2312    }
2313    return 0;
2314}
2315
2316static int cdc_decrement(target_ulong *psw)
2317{
2318    if ((*psw & MASK_PSW_CDC) == 0x7f) {
2319        return 0;
2320    }
2321    /* check for underflow */
2322    int lo = clo32((*psw & MASK_PSW_CDC) << (32 - 7));
2323    int mask = (1u << (7 - lo)) - 1;
2324    int count = *psw & mask;
2325    if (count == 0) {
2326        return 1;
2327    }
2328    (*psw)--;
2329    return 0;
2330}
2331
2332static bool cdc_zero(target_ulong *psw)
2333{
2334    int cdc = *psw & MASK_PSW_CDC;
2335    /* Returns TRUE if PSW.CDC.COUNT == 0 or if PSW.CDC ==
2336       7'b1111111, otherwise returns FALSE. */
2337    if (cdc == 0x7f) {
2338        return true;
2339    }
2340    /* find CDC.COUNT */
2341    int lo = clo32((*psw & MASK_PSW_CDC) << (32 - 7));
2342    int mask = (1u << (7 - lo)) - 1;
2343    int count = *psw & mask;
2344    return count == 0;
2345}
2346
2347static void save_context_upper(CPUTriCoreState *env, int ea)
2348{
2349    cpu_stl_data(env, ea, env->PCXI);
2350    cpu_stl_data(env, ea+4, psw_read(env));
2351    cpu_stl_data(env, ea+8, env->gpr_a[10]);
2352    cpu_stl_data(env, ea+12, env->gpr_a[11]);
2353    cpu_stl_data(env, ea+16, env->gpr_d[8]);
2354    cpu_stl_data(env, ea+20, env->gpr_d[9]);
2355    cpu_stl_data(env, ea+24, env->gpr_d[10]);
2356    cpu_stl_data(env, ea+28, env->gpr_d[11]);
2357    cpu_stl_data(env, ea+32, env->gpr_a[12]);
2358    cpu_stl_data(env, ea+36, env->gpr_a[13]);
2359    cpu_stl_data(env, ea+40, env->gpr_a[14]);
2360    cpu_stl_data(env, ea+44, env->gpr_a[15]);
2361    cpu_stl_data(env, ea+48, env->gpr_d[12]);
2362    cpu_stl_data(env, ea+52, env->gpr_d[13]);
2363    cpu_stl_data(env, ea+56, env->gpr_d[14]);
2364    cpu_stl_data(env, ea+60, env->gpr_d[15]);
2365}
2366
2367static void save_context_lower(CPUTriCoreState *env, int ea)
2368{
2369    cpu_stl_data(env, ea, env->PCXI);
2370    cpu_stl_data(env, ea+4, env->gpr_a[11]);
2371    cpu_stl_data(env, ea+8, env->gpr_a[2]);
2372    cpu_stl_data(env, ea+12, env->gpr_a[3]);
2373    cpu_stl_data(env, ea+16, env->gpr_d[0]);
2374    cpu_stl_data(env, ea+20, env->gpr_d[1]);
2375    cpu_stl_data(env, ea+24, env->gpr_d[2]);
2376    cpu_stl_data(env, ea+28, env->gpr_d[3]);
2377    cpu_stl_data(env, ea+32, env->gpr_a[4]);
2378    cpu_stl_data(env, ea+36, env->gpr_a[5]);
2379    cpu_stl_data(env, ea+40, env->gpr_a[6]);
2380    cpu_stl_data(env, ea+44, env->gpr_a[7]);
2381    cpu_stl_data(env, ea+48, env->gpr_d[4]);
2382    cpu_stl_data(env, ea+52, env->gpr_d[5]);
2383    cpu_stl_data(env, ea+56, env->gpr_d[6]);
2384    cpu_stl_data(env, ea+60, env->gpr_d[7]);
2385}
2386
2387static void restore_context_upper(CPUTriCoreState *env, int ea,
2388                                  target_ulong *new_PCXI, target_ulong *new_PSW)
2389{
2390    *new_PCXI = cpu_ldl_data(env, ea);
2391    *new_PSW = cpu_ldl_data(env, ea+4);
2392    env->gpr_a[10] = cpu_ldl_data(env, ea+8);
2393    env->gpr_a[11] = cpu_ldl_data(env, ea+12);
2394    env->gpr_d[8]  = cpu_ldl_data(env, ea+16);
2395    env->gpr_d[9]  = cpu_ldl_data(env, ea+20);
2396    env->gpr_d[10] = cpu_ldl_data(env, ea+24);
2397    env->gpr_d[11] = cpu_ldl_data(env, ea+28);
2398    env->gpr_a[12] = cpu_ldl_data(env, ea+32);
2399    env->gpr_a[13] = cpu_ldl_data(env, ea+36);
2400    env->gpr_a[14] = cpu_ldl_data(env, ea+40);
2401    env->gpr_a[15] = cpu_ldl_data(env, ea+44);
2402    env->gpr_d[12] = cpu_ldl_data(env, ea+48);
2403    env->gpr_d[13] = cpu_ldl_data(env, ea+52);
2404    env->gpr_d[14] = cpu_ldl_data(env, ea+56);
2405    env->gpr_d[15] = cpu_ldl_data(env, ea+60);
2406}
2407
2408static void restore_context_lower(CPUTriCoreState *env, int ea,
2409                                  target_ulong *ra, target_ulong *pcxi)
2410{
2411    *pcxi = cpu_ldl_data(env, ea);
2412    *ra = cpu_ldl_data(env, ea+4);
2413    env->gpr_a[2] = cpu_ldl_data(env, ea+8);
2414    env->gpr_a[3] = cpu_ldl_data(env, ea+12);
2415    env->gpr_d[0] = cpu_ldl_data(env, ea+16);
2416    env->gpr_d[1] = cpu_ldl_data(env, ea+20);
2417    env->gpr_d[2] = cpu_ldl_data(env, ea+24);
2418    env->gpr_d[3] = cpu_ldl_data(env, ea+28);
2419    env->gpr_a[4] = cpu_ldl_data(env, ea+32);
2420    env->gpr_a[5] = cpu_ldl_data(env, ea+36);
2421    env->gpr_a[6] = cpu_ldl_data(env, ea+40);
2422    env->gpr_a[7] = cpu_ldl_data(env, ea+44);
2423    env->gpr_d[4] = cpu_ldl_data(env, ea+48);
2424    env->gpr_d[5] = cpu_ldl_data(env, ea+52);
2425    env->gpr_d[6] = cpu_ldl_data(env, ea+56);
2426    env->gpr_d[7] = cpu_ldl_data(env, ea+60);
2427}
2428
2429void helper_call(CPUTriCoreState *env, uint32_t next_pc)
2430{
2431    target_ulong tmp_FCX;
2432    target_ulong ea;
2433    target_ulong new_FCX;
2434    target_ulong psw;
2435
2436    psw = psw_read(env);
2437    /* if (FCX == 0) trap(FCU); */
2438    if (env->FCX == 0) {
2439        /* FCU trap */
2440        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_FCU, GETPC());
2441    }
2442    /* if (PSW.CDE) then if (cdc_increment()) then trap(CDO); */
2443    if (psw & MASK_PSW_CDE) {
2444        if (cdc_increment(&psw)) {
2445            /* CDO trap */
2446            raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_CDO, GETPC());
2447        }
2448    }
2449    /* PSW.CDE = 1;*/
2450    psw |= MASK_PSW_CDE;
2451    /* tmp_FCX = FCX; */
2452    tmp_FCX = env->FCX;
2453    /* EA = {FCX.FCXS, 6'b0, FCX.FCXO, 6'b0}; */
2454    ea = ((env->FCX & MASK_FCX_FCXS) << 12) +
2455         ((env->FCX & MASK_FCX_FCXO) << 6);
2456    /* new_FCX = M(EA, word); */
2457    new_FCX = cpu_ldl_data(env, ea);
2458    /* M(EA, 16 * word) = {PCXI, PSW, A[10], A[11], D[8], D[9], D[10], D[11],
2459                           A[12], A[13], A[14], A[15], D[12], D[13], D[14],
2460                           D[15]}; */
2461    save_context_upper(env, ea);
2462
2463    /* PCXI.PCPN = ICR.CCPN; */
2464    env->PCXI = (env->PCXI & 0xffffff) +
2465                ((env->ICR & MASK_ICR_CCPN) << 24);
2466    /* PCXI.PIE = ICR.IE; */
2467    env->PCXI = ((env->PCXI & ~MASK_PCXI_PIE_1_3) +
2468                ((env->ICR & MASK_ICR_IE_1_3) << 15));
2469    /* PCXI.UL = 1; */
2470    env->PCXI |= MASK_PCXI_UL;
2471
2472    /* PCXI[19: 0] = FCX[19: 0]; */
2473    env->PCXI = (env->PCXI & 0xfff00000) + (env->FCX & 0xfffff);
2474    /* FCX[19: 0] = new_FCX[19: 0]; */
2475    env->FCX = (env->FCX & 0xfff00000) + (new_FCX & 0xfffff);
2476    /* A[11] = next_pc[31: 0]; */
2477    env->gpr_a[11] = next_pc;
2478
2479    /* if (tmp_FCX == LCX) trap(FCD);*/
2480    if (tmp_FCX == env->LCX) {
2481        /* FCD trap */
2482        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_FCD, GETPC());
2483    }
2484    psw_write(env, psw);
2485}
2486
2487void helper_ret(CPUTriCoreState *env)
2488{
2489    target_ulong ea;
2490    target_ulong new_PCXI;
2491    target_ulong new_PSW, psw;
2492
2493    psw = psw_read(env);
2494     /* if (PSW.CDE) then if (cdc_decrement()) then trap(CDU);*/
2495    if (psw & MASK_PSW_CDE) {
2496        if (cdc_decrement(&psw)) {
2497            /* CDU trap */
2498            psw_write(env, psw);
2499            raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_CDU, GETPC());
2500        }
2501    }
2502    /*   if (PCXI[19: 0] == 0) then trap(CSU); */
2503    if ((env->PCXI & 0xfffff) == 0) {
2504        /* CSU trap */
2505        psw_write(env, psw);
2506        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_CSU, GETPC());
2507    }
2508    /* if (PCXI.UL == 0) then trap(CTYP); */
2509    if ((env->PCXI & MASK_PCXI_UL) == 0) {
2510        /* CTYP trap */
2511        cdc_increment(&psw); /* restore to the start of helper */
2512        psw_write(env, psw);
2513        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_CTYP, GETPC());
2514    }
2515    /* PC = {A11 [31: 1], 1’b0}; */
2516    env->PC = env->gpr_a[11] & 0xfffffffe;
2517
2518    /* EA = {PCXI.PCXS, 6'b0, PCXI.PCXO, 6'b0}; */
2519    ea = ((env->PCXI & MASK_PCXI_PCXS) << 12) +
2520         ((env->PCXI & MASK_PCXI_PCXO) << 6);
2521    /* {new_PCXI, new_PSW, A[10], A[11], D[8], D[9], D[10], D[11], A[12],
2522        A[13], A[14], A[15], D[12], D[13], D[14], D[15]} = M(EA, 16 * word); */
2523    restore_context_upper(env, ea, &new_PCXI, &new_PSW);
2524    /* M(EA, word) = FCX; */
2525    cpu_stl_data(env, ea, env->FCX);
2526    /* FCX[19: 0] = PCXI[19: 0]; */
2527    env->FCX = (env->FCX & 0xfff00000) + (env->PCXI & 0x000fffff);
2528    /* PCXI = new_PCXI; */
2529    env->PCXI = new_PCXI;
2530
2531    if (tricore_feature(env, TRICORE_FEATURE_13)) {
2532        /* PSW = new_PSW */
2533        psw_write(env, new_PSW);
2534    } else {
2535        /* PSW = {new_PSW[31:26], PSW[25:24], new_PSW[23:0]}; */
2536        psw_write(env, (new_PSW & ~(0x3000000)) + (psw & (0x3000000)));
2537    }
2538}
2539
2540void helper_bisr(CPUTriCoreState *env, uint32_t const9)
2541{
2542    target_ulong tmp_FCX;
2543    target_ulong ea;
2544    target_ulong new_FCX;
2545
2546    if (env->FCX == 0) {
2547        /* FCU trap */
2548       raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_FCU, GETPC());
2549    }
2550
2551    tmp_FCX = env->FCX;
2552    ea = ((env->FCX & 0xf0000) << 12) + ((env->FCX & 0xffff) << 6);
2553
2554    /* new_FCX = M(EA, word); */
2555    new_FCX = cpu_ldl_data(env, ea);
2556    /* M(EA, 16 * word) = {PCXI, A[11], A[2], A[3], D[0], D[1], D[2], D[3], A[4]
2557                           , A[5], A[6], A[7], D[4], D[5], D[6], D[7]}; */
2558    save_context_lower(env, ea);
2559
2560
2561    /* PCXI.PCPN = ICR.CCPN */
2562    env->PCXI = (env->PCXI & 0xffffff) +
2563                 ((env->ICR & MASK_ICR_CCPN) << 24);
2564    /* PCXI.PIE  = ICR.IE */
2565    env->PCXI = ((env->PCXI & ~MASK_PCXI_PIE_1_3) +
2566                 ((env->ICR & MASK_ICR_IE_1_3) << 15));
2567    /* PCXI.UL = 0 */
2568    env->PCXI &= ~(MASK_PCXI_UL);
2569    /* PCXI[19: 0] = FCX[19: 0] */
2570    env->PCXI = (env->PCXI & 0xfff00000) + (env->FCX & 0xfffff);
2571    /* FXC[19: 0] = new_FCX[19: 0] */
2572    env->FCX = (env->FCX & 0xfff00000) + (new_FCX & 0xfffff);
2573    /* ICR.IE = 1 */
2574    env->ICR |= MASK_ICR_IE_1_3;
2575
2576    env->ICR |= const9; /* ICR.CCPN = const9[7: 0];*/
2577
2578    if (tmp_FCX == env->LCX) {
2579        /* FCD trap */
2580        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_FCD, GETPC());
2581    }
2582}
2583
2584void helper_rfe(CPUTriCoreState *env)
2585{
2586    target_ulong ea;
2587    target_ulong new_PCXI;
2588    target_ulong new_PSW;
2589    /* if (PCXI[19: 0] == 0) then trap(CSU); */
2590    if ((env->PCXI & 0xfffff) == 0) {
2591        /* raise csu trap */
2592        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_CSU, GETPC());
2593    }
2594    /* if (PCXI.UL == 0) then trap(CTYP); */
2595    if ((env->PCXI & MASK_PCXI_UL) == 0) {
2596        /* raise CTYP trap */
2597        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_CTYP, GETPC());
2598    }
2599    /* if (!cdc_zero() AND PSW.CDE) then trap(NEST); */
2600    if (!cdc_zero(&(env->PSW)) && (env->PSW & MASK_PSW_CDE)) {
2601        /* raise NEST trap */
2602        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_NEST, GETPC());
2603    }
2604    env->PC = env->gpr_a[11] & ~0x1;
2605    /* ICR.IE = PCXI.PIE; */
2606    env->ICR = (env->ICR & ~MASK_ICR_IE_1_3)
2607            + ((env->PCXI & MASK_PCXI_PIE_1_3) >> 15);
2608    /* ICR.CCPN = PCXI.PCPN; */
2609    env->ICR = (env->ICR & ~MASK_ICR_CCPN) +
2610               ((env->PCXI & MASK_PCXI_PCPN) >> 24);
2611    /*EA = {PCXI.PCXS, 6'b0, PCXI.PCXO, 6'b0};*/
2612    ea = ((env->PCXI & MASK_PCXI_PCXS) << 12) +
2613         ((env->PCXI & MASK_PCXI_PCXO) << 6);
2614    /*{new_PCXI, PSW, A[10], A[11], D[8], D[9], D[10], D[11], A[12],
2615      A[13], A[14], A[15], D[12], D[13], D[14], D[15]} = M(EA, 16 * word); */
2616    restore_context_upper(env, ea, &new_PCXI, &new_PSW);
2617    /* M(EA, word) = FCX;*/
2618    cpu_stl_data(env, ea, env->FCX);
2619    /* FCX[19: 0] = PCXI[19: 0]; */
2620    env->FCX = (env->FCX & 0xfff00000) + (env->PCXI & 0x000fffff);
2621    /* PCXI = new_PCXI; */
2622    env->PCXI = new_PCXI;
2623    /* write psw */
2624    psw_write(env, new_PSW);
2625}
2626
2627void helper_rfm(CPUTriCoreState *env)
2628{
2629    env->PC = (env->gpr_a[11] & ~0x1);
2630    /* ICR.IE = PCXI.PIE; */
2631    env->ICR = (env->ICR & ~MASK_ICR_IE_1_3)
2632            | ((env->PCXI & MASK_PCXI_PIE_1_3) >> 15);
2633    /* ICR.CCPN = PCXI.PCPN; */
2634    env->ICR = (env->ICR & ~MASK_ICR_CCPN) |
2635               ((env->PCXI & MASK_PCXI_PCPN) >> 24);
2636    /* {PCXI, PSW, A[10], A[11]} = M(DCX, 4 * word); */
2637    env->PCXI = cpu_ldl_data(env, env->DCX);
2638    psw_write(env, cpu_ldl_data(env, env->DCX+4));
2639    env->gpr_a[10] = cpu_ldl_data(env, env->DCX+8);
2640    env->gpr_a[11] = cpu_ldl_data(env, env->DCX+12);
2641
2642    if (tricore_feature(env, TRICORE_FEATURE_131)) {
2643        env->DBGTCR = 0;
2644    }
2645}
2646
2647void helper_ldlcx(CPUTriCoreState *env, uint32_t ea)
2648{
2649    uint32_t dummy;
2650    /* insn doesn't load PCXI and RA */
2651    restore_context_lower(env, ea, &dummy, &dummy);
2652}
2653
2654void helper_lducx(CPUTriCoreState *env, uint32_t ea)
2655{
2656    uint32_t dummy;
2657    /* insn doesn't load PCXI and PSW */
2658    restore_context_upper(env, ea, &dummy, &dummy);
2659}
2660
2661void helper_stlcx(CPUTriCoreState *env, uint32_t ea)
2662{
2663    save_context_lower(env, ea);
2664}
2665
2666void helper_stucx(CPUTriCoreState *env, uint32_t ea)
2667{
2668    save_context_upper(env, ea);
2669}
2670
2671void helper_svlcx(CPUTriCoreState *env)
2672{
2673    target_ulong tmp_FCX;
2674    target_ulong ea;
2675    target_ulong new_FCX;
2676
2677    if (env->FCX == 0) {
2678        /* FCU trap */
2679        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_FCU, GETPC());
2680    }
2681    /* tmp_FCX = FCX; */
2682    tmp_FCX = env->FCX;
2683    /* EA = {FCX.FCXS, 6'b0, FCX.FCXO, 6'b0}; */
2684    ea = ((env->FCX & MASK_FCX_FCXS) << 12) +
2685         ((env->FCX & MASK_FCX_FCXO) << 6);
2686    /* new_FCX = M(EA, word); */
2687    new_FCX = cpu_ldl_data(env, ea);
2688    /* M(EA, 16 * word) = {PCXI, PSW, A[10], A[11], D[8], D[9], D[10], D[11],
2689                           A[12], A[13], A[14], A[15], D[12], D[13], D[14],
2690                           D[15]}; */
2691    save_context_lower(env, ea);
2692
2693    /* PCXI.PCPN = ICR.CCPN; */
2694    env->PCXI = (env->PCXI & 0xffffff) +
2695                ((env->ICR & MASK_ICR_CCPN) << 24);
2696    /* PCXI.PIE = ICR.IE; */
2697    env->PCXI = ((env->PCXI & ~MASK_PCXI_PIE_1_3) +
2698                ((env->ICR & MASK_ICR_IE_1_3) << 15));
2699    /* PCXI.UL = 0; */
2700    env->PCXI &= ~MASK_PCXI_UL;
2701
2702    /* PCXI[19: 0] = FCX[19: 0]; */
2703    env->PCXI = (env->PCXI & 0xfff00000) + (env->FCX & 0xfffff);
2704    /* FCX[19: 0] = new_FCX[19: 0]; */
2705    env->FCX = (env->FCX & 0xfff00000) + (new_FCX & 0xfffff);
2706
2707    /* if (tmp_FCX == LCX) trap(FCD);*/
2708    if (tmp_FCX == env->LCX) {
2709        /* FCD trap */
2710        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_FCD, GETPC());
2711    }
2712}
2713
2714void helper_svucx(CPUTriCoreState *env)
2715{
2716    target_ulong tmp_FCX;
2717    target_ulong ea;
2718    target_ulong new_FCX;
2719
2720    if (env->FCX == 0) {
2721        /* FCU trap */
2722        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_FCU, GETPC());
2723    }
2724    /* tmp_FCX = FCX; */
2725    tmp_FCX = env->FCX;
2726    /* EA = {FCX.FCXS, 6'b0, FCX.FCXO, 6'b0}; */
2727    ea = ((env->FCX & MASK_FCX_FCXS) << 12) +
2728         ((env->FCX & MASK_FCX_FCXO) << 6);
2729    /* new_FCX = M(EA, word); */
2730    new_FCX = cpu_ldl_data(env, ea);
2731    /* M(EA, 16 * word) = {PCXI, PSW, A[10], A[11], D[8], D[9], D[10], D[11],
2732                           A[12], A[13], A[14], A[15], D[12], D[13], D[14],
2733                           D[15]}; */
2734    save_context_upper(env, ea);
2735
2736    /* PCXI.PCPN = ICR.CCPN; */
2737    env->PCXI = (env->PCXI & 0xffffff) +
2738                ((env->ICR & MASK_ICR_CCPN) << 24);
2739    /* PCXI.PIE = ICR.IE; */
2740    env->PCXI = ((env->PCXI & ~MASK_PCXI_PIE_1_3) +
2741                ((env->ICR & MASK_ICR_IE_1_3) << 15));
2742    /* PCXI.UL = 1; */
2743    env->PCXI |= MASK_PCXI_UL;
2744
2745    /* PCXI[19: 0] = FCX[19: 0]; */
2746    env->PCXI = (env->PCXI & 0xfff00000) + (env->FCX & 0xfffff);
2747    /* FCX[19: 0] = new_FCX[19: 0]; */
2748    env->FCX = (env->FCX & 0xfff00000) + (new_FCX & 0xfffff);
2749
2750    /* if (tmp_FCX == LCX) trap(FCD);*/
2751    if (tmp_FCX == env->LCX) {
2752        /* FCD trap */
2753        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_FCD, GETPC());
2754    }
2755}
2756
2757void helper_rslcx(CPUTriCoreState *env)
2758{
2759    target_ulong ea;
2760    target_ulong new_PCXI;
2761    /*   if (PCXI[19: 0] == 0) then trap(CSU); */
2762    if ((env->PCXI & 0xfffff) == 0) {
2763        /* CSU trap */
2764        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_CSU, GETPC());
2765    }
2766    /* if (PCXI.UL == 1) then trap(CTYP); */
2767    if ((env->PCXI & MASK_PCXI_UL) != 0) {
2768        /* CTYP trap */
2769        raise_exception_sync_helper(env, TRAPC_CTX_MNG, TIN3_CTYP, GETPC());
2770    }
2771    /* EA = {PCXI.PCXS, 6'b0, PCXI.PCXO, 6'b0}; */
2772    ea = ((env->PCXI & MASK_PCXI_PCXS) << 12) +
2773         ((env->PCXI & MASK_PCXI_PCXO) << 6);
2774    /* {new_PCXI, A[11], A[10], A[11], D[8], D[9], D[10], D[11], A[12],
2775        A[13], A[14], A[15], D[12], D[13], D[14], D[15]} = M(EA, 16 * word); */
2776    restore_context_lower(env, ea, &env->gpr_a[11], &new_PCXI);
2777    /* M(EA, word) = FCX; */
2778    cpu_stl_data(env, ea, env->FCX);
2779    /* M(EA, word) = FCX; */
2780    cpu_stl_data(env, ea, env->FCX);
2781    /* FCX[19: 0] = PCXI[19: 0]; */
2782    env->FCX = (env->FCX & 0xfff00000) + (env->PCXI & 0x000fffff);
2783    /* PCXI = new_PCXI; */
2784    env->PCXI = new_PCXI;
2785}
2786
2787void helper_psw_write(CPUTriCoreState *env, uint32_t arg)
2788{
2789    psw_write(env, arg);
2790}
2791
2792uint32_t helper_psw_read(CPUTriCoreState *env)
2793{
2794    return psw_read(env);
2795}
2796
2797
2798static inline void QEMU_NORETURN do_raise_exception_err(CPUTriCoreState *env,
2799                                                        uint32_t exception,
2800                                                        int error_code,
2801                                                        uintptr_t pc)
2802{
2803    CPUState *cs = CPU(tricore_env_get_cpu(env));
2804    cs->exception_index = exception;
2805    env->error_code = error_code;
2806    /* now we have a real cpu fault */
2807    cpu_loop_exit_restore(cs, pc);
2808}
2809
2810void tlb_fill(CPUState *cs, target_ulong addr, int size,
2811              MMUAccessType access_type, int mmu_idx, uintptr_t retaddr)
2812{
2813    int ret;
2814    ret = cpu_tricore_handle_mmu_fault(cs, addr, access_type, mmu_idx);
2815    if (ret) {
2816        TriCoreCPU *cpu = TRICORE_CPU(cs);
2817        CPUTriCoreState *env = &cpu->env;
2818        do_raise_exception_err(env, cs->exception_index,
2819                               env->error_code, retaddr);
2820    }
2821}
2822