target-tricore/op_helper.c

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