1235eb015SJia Liu /* 2235eb015SJia Liu * MIPS ASE DSP Instruction emulation helpers for QEMU. 3235eb015SJia Liu * 4235eb015SJia Liu * Copyright (c) 2012 Jia Liu <proljc@gmail.com> 5fe65a1faSDongxue Zhang * Dongxue Zhang <elta.era@gmail.com> 6235eb015SJia Liu * This library is free software; you can redistribute it and/or 7235eb015SJia Liu * modify it under the terms of the GNU Lesser General Public 8235eb015SJia Liu * License as published by the Free Software Foundation; either 9235eb015SJia Liu * version 2 of the License, or (at your option) any later version. 10235eb015SJia Liu * 11235eb015SJia Liu * This library is distributed in the hope that it will be useful, 12235eb015SJia Liu * but WITHOUT ANY WARRANTY; without even the implied warranty of 13235eb015SJia Liu * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 14235eb015SJia Liu * Lesser General Public License for more details. 15235eb015SJia Liu * 16235eb015SJia Liu * You should have received a copy of the GNU Lesser General Public 17235eb015SJia Liu * License along with this library; if not, see <http://www.gnu.org/licenses/>. 18235eb015SJia Liu */ 19235eb015SJia Liu 20235eb015SJia Liu #include "cpu.h" 21235eb015SJia Liu #include "helper.h" 22235eb015SJia Liu 23652613abSAurelien Jarno /* As the byte ordering doesn't matter, i.e. all columns are treated 24652613abSAurelien Jarno identically, these unions can be used directly. */ 25652613abSAurelien Jarno typedef union { 26652613abSAurelien Jarno uint8_t ub[4]; 27652613abSAurelien Jarno int8_t sb[4]; 28652613abSAurelien Jarno uint16_t uh[2]; 29652613abSAurelien Jarno int16_t sh[2]; 30652613abSAurelien Jarno uint32_t uw[1]; 31652613abSAurelien Jarno int32_t sw[1]; 32652613abSAurelien Jarno } DSP32Value; 33652613abSAurelien Jarno 34652613abSAurelien Jarno typedef union { 35652613abSAurelien Jarno uint8_t ub[8]; 36652613abSAurelien Jarno int8_t sb[8]; 37652613abSAurelien Jarno uint16_t uh[4]; 38652613abSAurelien Jarno int16_t sh[4]; 39652613abSAurelien Jarno uint32_t uw[2]; 40652613abSAurelien Jarno int32_t sw[2]; 41652613abSAurelien Jarno uint64_t ul[1]; 42652613abSAurelien Jarno int64_t sl[1]; 43652613abSAurelien Jarno } DSP64Value; 44652613abSAurelien Jarno 45235eb015SJia Liu /*** MIPS DSP internal functions begin ***/ 46235eb015SJia Liu #define MIPSDSP_ABS(x) (((x) >= 0) ? x : -x) 4720c334a7SPetar Jovanovic #define MIPSDSP_OVERFLOW_ADD(a, b, c, d) (~(a ^ b) & (a ^ c) & d) 4820c334a7SPetar Jovanovic #define MIPSDSP_OVERFLOW_SUB(a, b, c, d) ((a ^ b) & (a ^ c) & d) 49235eb015SJia Liu 50235eb015SJia Liu static inline void set_DSPControl_overflow_flag(uint32_t flag, int position, 51235eb015SJia Liu CPUMIPSState *env) 52235eb015SJia Liu { 53235eb015SJia Liu env->active_tc.DSPControl |= (target_ulong)flag << position; 54235eb015SJia Liu } 55235eb015SJia Liu 56235eb015SJia Liu static inline void set_DSPControl_carryflag(uint32_t flag, CPUMIPSState *env) 57235eb015SJia Liu { 58235eb015SJia Liu env->active_tc.DSPControl |= (target_ulong)flag << 13; 59235eb015SJia Liu } 60235eb015SJia Liu 61235eb015SJia Liu static inline uint32_t get_DSPControl_carryflag(CPUMIPSState *env) 62235eb015SJia Liu { 63235eb015SJia Liu return (env->active_tc.DSPControl >> 13) & 0x01; 64235eb015SJia Liu } 65235eb015SJia Liu 66235eb015SJia Liu static inline void set_DSPControl_24(uint32_t flag, int len, CPUMIPSState *env) 67235eb015SJia Liu { 68235eb015SJia Liu uint32_t filter; 69235eb015SJia Liu 70235eb015SJia Liu filter = ((0x01 << len) - 1) << 24; 71235eb015SJia Liu filter = ~filter; 72235eb015SJia Liu 73235eb015SJia Liu env->active_tc.DSPControl &= filter; 74235eb015SJia Liu env->active_tc.DSPControl |= (target_ulong)flag << 24; 75235eb015SJia Liu } 76235eb015SJia Liu 77235eb015SJia Liu static inline uint32_t get_DSPControl_24(int len, CPUMIPSState *env) 78235eb015SJia Liu { 79235eb015SJia Liu uint32_t filter; 80235eb015SJia Liu 81235eb015SJia Liu filter = (0x01 << len) - 1; 82235eb015SJia Liu 83235eb015SJia Liu return (env->active_tc.DSPControl >> 24) & filter; 84235eb015SJia Liu } 85235eb015SJia Liu 86235eb015SJia Liu static inline void set_DSPControl_pos(uint32_t pos, CPUMIPSState *env) 87235eb015SJia Liu { 88235eb015SJia Liu target_ulong dspc; 89235eb015SJia Liu 90235eb015SJia Liu dspc = env->active_tc.DSPControl; 91235eb015SJia Liu #ifndef TARGET_MIPS64 92235eb015SJia Liu dspc = dspc & 0xFFFFFFC0; 93235eb015SJia Liu dspc |= pos; 94235eb015SJia Liu #else 95235eb015SJia Liu dspc = dspc & 0xFFFFFF80; 96235eb015SJia Liu dspc |= pos; 97235eb015SJia Liu #endif 98235eb015SJia Liu env->active_tc.DSPControl = dspc; 99235eb015SJia Liu } 100235eb015SJia Liu 101235eb015SJia Liu static inline uint32_t get_DSPControl_pos(CPUMIPSState *env) 102235eb015SJia Liu { 103235eb015SJia Liu target_ulong dspc; 104235eb015SJia Liu uint32_t pos; 105235eb015SJia Liu 106235eb015SJia Liu dspc = env->active_tc.DSPControl; 107235eb015SJia Liu 108235eb015SJia Liu #ifndef TARGET_MIPS64 109235eb015SJia Liu pos = dspc & 0x3F; 110235eb015SJia Liu #else 111235eb015SJia Liu pos = dspc & 0x7F; 112235eb015SJia Liu #endif 113235eb015SJia Liu 114235eb015SJia Liu return pos; 115235eb015SJia Liu } 116235eb015SJia Liu 117235eb015SJia Liu static inline void set_DSPControl_efi(uint32_t flag, CPUMIPSState *env) 118235eb015SJia Liu { 119235eb015SJia Liu env->active_tc.DSPControl &= 0xFFFFBFFF; 120235eb015SJia Liu env->active_tc.DSPControl |= (target_ulong)flag << 14; 121235eb015SJia Liu } 122235eb015SJia Liu 123235eb015SJia Liu #define DO_MIPS_SAT_ABS(size) \ 124235eb015SJia Liu static inline int##size##_t mipsdsp_sat_abs##size(int##size##_t a, \ 125235eb015SJia Liu CPUMIPSState *env) \ 126235eb015SJia Liu { \ 127235eb015SJia Liu if (a == INT##size##_MIN) { \ 128235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); \ 129235eb015SJia Liu return INT##size##_MAX; \ 130235eb015SJia Liu } else { \ 131235eb015SJia Liu return MIPSDSP_ABS(a); \ 132235eb015SJia Liu } \ 133235eb015SJia Liu } 134235eb015SJia Liu DO_MIPS_SAT_ABS(8) 135235eb015SJia Liu DO_MIPS_SAT_ABS(16) 136235eb015SJia Liu DO_MIPS_SAT_ABS(32) 137235eb015SJia Liu #undef DO_MIPS_SAT_ABS 138235eb015SJia Liu 139235eb015SJia Liu /* get sum value */ 140235eb015SJia Liu static inline int16_t mipsdsp_add_i16(int16_t a, int16_t b, CPUMIPSState *env) 141235eb015SJia Liu { 142235eb015SJia Liu int16_t tempI; 143235eb015SJia Liu 144235eb015SJia Liu tempI = a + b; 145235eb015SJia Liu 14620c334a7SPetar Jovanovic if (MIPSDSP_OVERFLOW_ADD(a, b, tempI, 0x8000)) { 147235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 148235eb015SJia Liu } 149235eb015SJia Liu 150235eb015SJia Liu return tempI; 151235eb015SJia Liu } 152235eb015SJia Liu 153235eb015SJia Liu static inline int16_t mipsdsp_sat_add_i16(int16_t a, int16_t b, 154235eb015SJia Liu CPUMIPSState *env) 155235eb015SJia Liu { 156235eb015SJia Liu int16_t tempS; 157235eb015SJia Liu 158235eb015SJia Liu tempS = a + b; 159235eb015SJia Liu 16020c334a7SPetar Jovanovic if (MIPSDSP_OVERFLOW_ADD(a, b, tempS, 0x8000)) { 161235eb015SJia Liu if (a > 0) { 162235eb015SJia Liu tempS = 0x7FFF; 163235eb015SJia Liu } else { 164235eb015SJia Liu tempS = 0x8000; 165235eb015SJia Liu } 166235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 167235eb015SJia Liu } 168235eb015SJia Liu 169235eb015SJia Liu return tempS; 170235eb015SJia Liu } 171235eb015SJia Liu 172235eb015SJia Liu static inline int32_t mipsdsp_sat_add_i32(int32_t a, int32_t b, 173235eb015SJia Liu CPUMIPSState *env) 174235eb015SJia Liu { 175235eb015SJia Liu int32_t tempI; 176235eb015SJia Liu 177235eb015SJia Liu tempI = a + b; 178235eb015SJia Liu 17920c334a7SPetar Jovanovic if (MIPSDSP_OVERFLOW_ADD(a, b, tempI, 0x80000000)) { 180235eb015SJia Liu if (a > 0) { 181235eb015SJia Liu tempI = 0x7FFFFFFF; 182235eb015SJia Liu } else { 183235eb015SJia Liu tempI = 0x80000000; 184235eb015SJia Liu } 185235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 186235eb015SJia Liu } 187235eb015SJia Liu 188235eb015SJia Liu return tempI; 189235eb015SJia Liu } 190235eb015SJia Liu 191235eb015SJia Liu static inline uint8_t mipsdsp_add_u8(uint8_t a, uint8_t b, CPUMIPSState *env) 192235eb015SJia Liu { 193235eb015SJia Liu uint16_t temp; 194235eb015SJia Liu 195235eb015SJia Liu temp = (uint16_t)a + (uint16_t)b; 196235eb015SJia Liu 197235eb015SJia Liu if (temp & 0x0100) { 198235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 199235eb015SJia Liu } 200235eb015SJia Liu 201235eb015SJia Liu return temp & 0xFF; 202235eb015SJia Liu } 203235eb015SJia Liu 204235eb015SJia Liu static inline uint16_t mipsdsp_add_u16(uint16_t a, uint16_t b, 205235eb015SJia Liu CPUMIPSState *env) 206235eb015SJia Liu { 207235eb015SJia Liu uint32_t temp; 208235eb015SJia Liu 209235eb015SJia Liu temp = (uint32_t)a + (uint32_t)b; 210235eb015SJia Liu 211235eb015SJia Liu if (temp & 0x00010000) { 212235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 213235eb015SJia Liu } 214235eb015SJia Liu 215235eb015SJia Liu return temp & 0xFFFF; 216235eb015SJia Liu } 217235eb015SJia Liu 218235eb015SJia Liu static inline uint8_t mipsdsp_sat_add_u8(uint8_t a, uint8_t b, 219235eb015SJia Liu CPUMIPSState *env) 220235eb015SJia Liu { 221235eb015SJia Liu uint8_t result; 222235eb015SJia Liu uint16_t temp; 223235eb015SJia Liu 224235eb015SJia Liu temp = (uint16_t)a + (uint16_t)b; 225235eb015SJia Liu result = temp & 0xFF; 226235eb015SJia Liu 227235eb015SJia Liu if (0x0100 & temp) { 228235eb015SJia Liu result = 0xFF; 229235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 230235eb015SJia Liu } 231235eb015SJia Liu 232235eb015SJia Liu return result; 233235eb015SJia Liu } 234235eb015SJia Liu 235235eb015SJia Liu static inline uint16_t mipsdsp_sat_add_u16(uint16_t a, uint16_t b, 236235eb015SJia Liu CPUMIPSState *env) 237235eb015SJia Liu { 238235eb015SJia Liu uint16_t result; 239235eb015SJia Liu uint32_t temp; 240235eb015SJia Liu 241235eb015SJia Liu temp = (uint32_t)a + (uint32_t)b; 242235eb015SJia Liu result = temp & 0xFFFF; 243235eb015SJia Liu 244235eb015SJia Liu if (0x00010000 & temp) { 245235eb015SJia Liu result = 0xFFFF; 246235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 247235eb015SJia Liu } 248235eb015SJia Liu 249235eb015SJia Liu return result; 250235eb015SJia Liu } 251235eb015SJia Liu 252235eb015SJia Liu static inline int32_t mipsdsp_sat32_acc_q31(int32_t acc, int32_t a, 253235eb015SJia Liu CPUMIPSState *env) 254235eb015SJia Liu { 255235eb015SJia Liu int64_t temp; 256235eb015SJia Liu int32_t temp32, temp31, result; 257235eb015SJia Liu int64_t temp_sum; 258235eb015SJia Liu 259235eb015SJia Liu #ifndef TARGET_MIPS64 260235eb015SJia Liu temp = ((uint64_t)env->active_tc.HI[acc] << 32) | 261235eb015SJia Liu (uint64_t)env->active_tc.LO[acc]; 262235eb015SJia Liu #else 263235eb015SJia Liu temp = (uint64_t)env->active_tc.LO[acc]; 264235eb015SJia Liu #endif 265235eb015SJia Liu 266235eb015SJia Liu temp_sum = (int64_t)a + temp; 267235eb015SJia Liu 268235eb015SJia Liu temp32 = (temp_sum >> 32) & 0x01; 269235eb015SJia Liu temp31 = (temp_sum >> 31) & 0x01; 270235eb015SJia Liu result = temp_sum & 0xFFFFFFFF; 271235eb015SJia Liu 272235eb015SJia Liu if (temp32 != temp31) { 273235eb015SJia Liu if (temp32 == 0) { 274235eb015SJia Liu result = 0x7FFFFFFF; 275235eb015SJia Liu } else { 276235eb015SJia Liu result = 0x80000000; 277235eb015SJia Liu } 278235eb015SJia Liu set_DSPControl_overflow_flag(1, 16 + acc, env); 279235eb015SJia Liu } 280235eb015SJia Liu 281235eb015SJia Liu return result; 282235eb015SJia Liu } 283235eb015SJia Liu 284235eb015SJia Liu /* a[0] is LO, a[1] is HI. */ 285235eb015SJia Liu static inline void mipsdsp_sat64_acc_add_q63(int64_t *ret, 286235eb015SJia Liu int32_t ac, 287235eb015SJia Liu int64_t *a, 288235eb015SJia Liu CPUMIPSState *env) 289235eb015SJia Liu { 290235eb015SJia Liu bool temp64; 291235eb015SJia Liu 292235eb015SJia Liu ret[0] = env->active_tc.LO[ac] + a[0]; 293235eb015SJia Liu ret[1] = env->active_tc.HI[ac] + a[1]; 294235eb015SJia Liu 295235eb015SJia Liu if (((uint64_t)ret[0] < (uint64_t)env->active_tc.LO[ac]) && 296235eb015SJia Liu ((uint64_t)ret[0] < (uint64_t)a[0])) { 297235eb015SJia Liu ret[1] += 1; 298235eb015SJia Liu } 299235eb015SJia Liu temp64 = ret[1] & 1; 300235eb015SJia Liu if (temp64 != ((ret[0] >> 63) & 0x01)) { 301235eb015SJia Liu if (temp64) { 302235eb015SJia Liu ret[0] = (0x01ull << 63); 303235eb015SJia Liu ret[1] = ~0ull; 304235eb015SJia Liu } else { 305235eb015SJia Liu ret[0] = (0x01ull << 63) - 1; 306235eb015SJia Liu ret[1] = 0x00; 307235eb015SJia Liu } 308235eb015SJia Liu set_DSPControl_overflow_flag(1, 16 + ac, env); 309235eb015SJia Liu } 310235eb015SJia Liu } 311235eb015SJia Liu 312235eb015SJia Liu static inline void mipsdsp_sat64_acc_sub_q63(int64_t *ret, 313235eb015SJia Liu int32_t ac, 314235eb015SJia Liu int64_t *a, 315235eb015SJia Liu CPUMIPSState *env) 316235eb015SJia Liu { 317235eb015SJia Liu bool temp64; 318235eb015SJia Liu 319235eb015SJia Liu ret[0] = env->active_tc.LO[ac] - a[0]; 320235eb015SJia Liu ret[1] = env->active_tc.HI[ac] - a[1]; 321235eb015SJia Liu 322235eb015SJia Liu if ((uint64_t)ret[0] > (uint64_t)env->active_tc.LO[ac]) { 323235eb015SJia Liu ret[1] -= 1; 324235eb015SJia Liu } 325235eb015SJia Liu temp64 = ret[1] & 1; 326235eb015SJia Liu if (temp64 != ((ret[0] >> 63) & 0x01)) { 327235eb015SJia Liu if (temp64) { 328235eb015SJia Liu ret[0] = (0x01ull << 63); 329235eb015SJia Liu ret[1] = ~0ull; 330235eb015SJia Liu } else { 331235eb015SJia Liu ret[0] = (0x01ull << 63) - 1; 332235eb015SJia Liu ret[1] = 0x00; 333235eb015SJia Liu } 334235eb015SJia Liu set_DSPControl_overflow_flag(1, 16 + ac, env); 335235eb015SJia Liu } 336235eb015SJia Liu } 337235eb015SJia Liu 338235eb015SJia Liu static inline int32_t mipsdsp_mul_i16_i16(int16_t a, int16_t b, 339235eb015SJia Liu CPUMIPSState *env) 340235eb015SJia Liu { 341235eb015SJia Liu int32_t temp; 342235eb015SJia Liu 343235eb015SJia Liu temp = (int32_t)a * (int32_t)b; 344235eb015SJia Liu 345235eb015SJia Liu if ((temp > (int)0x7FFF) || (temp < (int)0xFFFF8000)) { 346235eb015SJia Liu set_DSPControl_overflow_flag(1, 21, env); 347235eb015SJia Liu } 348235eb015SJia Liu temp &= 0x0000FFFF; 349235eb015SJia Liu 350235eb015SJia Liu return temp; 351235eb015SJia Liu } 352235eb015SJia Liu 353235eb015SJia Liu static inline int32_t mipsdsp_mul_u16_u16(int32_t a, int32_t b) 354235eb015SJia Liu { 355235eb015SJia Liu return a * b; 356235eb015SJia Liu } 357235eb015SJia Liu 358235eb015SJia Liu static inline int32_t mipsdsp_mul_i32_i32(int32_t a, int32_t b) 359235eb015SJia Liu { 360235eb015SJia Liu return a * b; 361235eb015SJia Liu } 362235eb015SJia Liu 363235eb015SJia Liu static inline int32_t mipsdsp_sat16_mul_i16_i16(int16_t a, int16_t b, 364235eb015SJia Liu CPUMIPSState *env) 365235eb015SJia Liu { 366235eb015SJia Liu int32_t temp; 367235eb015SJia Liu 368235eb015SJia Liu temp = (int32_t)a * (int32_t)b; 369235eb015SJia Liu 370235eb015SJia Liu if (temp > (int)0x7FFF) { 371235eb015SJia Liu temp = 0x00007FFF; 372235eb015SJia Liu set_DSPControl_overflow_flag(1, 21, env); 373235eb015SJia Liu } else if (temp < (int)0xffff8000) { 374235eb015SJia Liu temp = 0xFFFF8000; 375235eb015SJia Liu set_DSPControl_overflow_flag(1, 21, env); 376235eb015SJia Liu } 377235eb015SJia Liu temp &= 0x0000FFFF; 378235eb015SJia Liu 379235eb015SJia Liu return temp; 380235eb015SJia Liu } 381235eb015SJia Liu 382235eb015SJia Liu static inline int32_t mipsdsp_mul_q15_q15_overflowflag21(uint16_t a, uint16_t b, 383235eb015SJia Liu CPUMIPSState *env) 384235eb015SJia Liu { 385235eb015SJia Liu int32_t temp; 386235eb015SJia Liu 387235eb015SJia Liu if ((a == 0x8000) && (b == 0x8000)) { 388235eb015SJia Liu temp = 0x7FFFFFFF; 389235eb015SJia Liu set_DSPControl_overflow_flag(1, 21, env); 390235eb015SJia Liu } else { 391235eb015SJia Liu temp = ((int32_t)(int16_t)a * (int32_t)(int16_t)b) << 1; 392235eb015SJia Liu } 393235eb015SJia Liu 394235eb015SJia Liu return temp; 395235eb015SJia Liu } 396235eb015SJia Liu 397235eb015SJia Liu /* right shift */ 398235eb015SJia Liu static inline uint8_t mipsdsp_rshift_u8(uint8_t a, target_ulong mov) 399235eb015SJia Liu { 400235eb015SJia Liu return a >> mov; 401235eb015SJia Liu } 402235eb015SJia Liu 403235eb015SJia Liu static inline uint16_t mipsdsp_rshift_u16(uint16_t a, target_ulong mov) 404235eb015SJia Liu { 405235eb015SJia Liu return a >> mov; 406235eb015SJia Liu } 407235eb015SJia Liu 408235eb015SJia Liu static inline int8_t mipsdsp_rashift8(int8_t a, target_ulong mov) 409235eb015SJia Liu { 410235eb015SJia Liu return a >> mov; 411235eb015SJia Liu } 412235eb015SJia Liu 413235eb015SJia Liu static inline int16_t mipsdsp_rashift16(int16_t a, target_ulong mov) 414235eb015SJia Liu { 415235eb015SJia Liu return a >> mov; 416235eb015SJia Liu } 417235eb015SJia Liu 418235eb015SJia Liu static inline int32_t mipsdsp_rashift32(int32_t a, target_ulong mov) 419235eb015SJia Liu { 420235eb015SJia Liu return a >> mov; 421235eb015SJia Liu } 422235eb015SJia Liu 423235eb015SJia Liu static inline int16_t mipsdsp_rshift1_add_q16(int16_t a, int16_t b) 424235eb015SJia Liu { 425235eb015SJia Liu int32_t temp; 426235eb015SJia Liu 427235eb015SJia Liu temp = (int32_t)a + (int32_t)b; 428235eb015SJia Liu 429235eb015SJia Liu return (temp >> 1) & 0xFFFF; 430235eb015SJia Liu } 431235eb015SJia Liu 432235eb015SJia Liu /* round right shift */ 433235eb015SJia Liu static inline int16_t mipsdsp_rrshift1_add_q16(int16_t a, int16_t b) 434235eb015SJia Liu { 435235eb015SJia Liu int32_t temp; 436235eb015SJia Liu 437235eb015SJia Liu temp = (int32_t)a + (int32_t)b; 438235eb015SJia Liu temp += 1; 439235eb015SJia Liu 440235eb015SJia Liu return (temp >> 1) & 0xFFFF; 441235eb015SJia Liu } 442235eb015SJia Liu 443235eb015SJia Liu static inline int32_t mipsdsp_rshift1_add_q32(int32_t a, int32_t b) 444235eb015SJia Liu { 445235eb015SJia Liu int64_t temp; 446235eb015SJia Liu 447235eb015SJia Liu temp = (int64_t)a + (int64_t)b; 448235eb015SJia Liu 449235eb015SJia Liu return (temp >> 1) & 0xFFFFFFFF; 450235eb015SJia Liu } 451235eb015SJia Liu 452235eb015SJia Liu static inline int32_t mipsdsp_rrshift1_add_q32(int32_t a, int32_t b) 453235eb015SJia Liu { 454235eb015SJia Liu int64_t temp; 455235eb015SJia Liu 456235eb015SJia Liu temp = (int64_t)a + (int64_t)b; 457235eb015SJia Liu temp += 1; 458235eb015SJia Liu 459235eb015SJia Liu return (temp >> 1) & 0xFFFFFFFF; 460235eb015SJia Liu } 461235eb015SJia Liu 462235eb015SJia Liu static inline uint8_t mipsdsp_rshift1_add_u8(uint8_t a, uint8_t b) 463235eb015SJia Liu { 464235eb015SJia Liu uint16_t temp; 465235eb015SJia Liu 466235eb015SJia Liu temp = (uint16_t)a + (uint16_t)b; 467235eb015SJia Liu 468235eb015SJia Liu return (temp >> 1) & 0x00FF; 469235eb015SJia Liu } 470235eb015SJia Liu 471235eb015SJia Liu static inline uint8_t mipsdsp_rrshift1_add_u8(uint8_t a, uint8_t b) 472235eb015SJia Liu { 473235eb015SJia Liu uint16_t temp; 474235eb015SJia Liu 475235eb015SJia Liu temp = (uint16_t)a + (uint16_t)b + 1; 476235eb015SJia Liu 477235eb015SJia Liu return (temp >> 1) & 0x00FF; 478235eb015SJia Liu } 479235eb015SJia Liu 480235eb015SJia Liu static inline uint8_t mipsdsp_rshift1_sub_u8(uint8_t a, uint8_t b) 481235eb015SJia Liu { 482235eb015SJia Liu uint16_t temp; 483235eb015SJia Liu 484235eb015SJia Liu temp = (uint16_t)a - (uint16_t)b; 485235eb015SJia Liu 486235eb015SJia Liu return (temp >> 1) & 0x00FF; 487235eb015SJia Liu } 488235eb015SJia Liu 489235eb015SJia Liu static inline uint8_t mipsdsp_rrshift1_sub_u8(uint8_t a, uint8_t b) 490235eb015SJia Liu { 491235eb015SJia Liu uint16_t temp; 492235eb015SJia Liu 493235eb015SJia Liu temp = (uint16_t)a - (uint16_t)b + 1; 494235eb015SJia Liu 495235eb015SJia Liu return (temp >> 1) & 0x00FF; 496235eb015SJia Liu } 497235eb015SJia Liu 498235eb015SJia Liu /* 128 bits long. p[0] is LO, p[1] is HI. */ 499235eb015SJia Liu static inline void mipsdsp_rndrashift_short_acc(int64_t *p, 500235eb015SJia Liu int32_t ac, 501235eb015SJia Liu int32_t shift, 502235eb015SJia Liu CPUMIPSState *env) 503235eb015SJia Liu { 504235eb015SJia Liu int64_t acc; 505235eb015SJia Liu 506235eb015SJia Liu acc = ((int64_t)env->active_tc.HI[ac] << 32) | 507235eb015SJia Liu ((int64_t)env->active_tc.LO[ac] & 0xFFFFFFFF); 5088b758d05SPetar Jovanovic p[0] = (shift == 0) ? (acc << 1) : (acc >> (shift - 1)); 509235eb015SJia Liu p[1] = (acc >> 63) & 0x01; 510235eb015SJia Liu } 511235eb015SJia Liu 512235eb015SJia Liu /* 128 bits long. p[0] is LO, p[1] is HI */ 513235eb015SJia Liu static inline void mipsdsp_rashift_acc(uint64_t *p, 514235eb015SJia Liu uint32_t ac, 515235eb015SJia Liu uint32_t shift, 516235eb015SJia Liu CPUMIPSState *env) 517235eb015SJia Liu { 518235eb015SJia Liu uint64_t tempB, tempA; 519235eb015SJia Liu 520235eb015SJia Liu tempB = env->active_tc.HI[ac]; 521235eb015SJia Liu tempA = env->active_tc.LO[ac]; 522235eb015SJia Liu shift = shift & 0x1F; 523235eb015SJia Liu 524235eb015SJia Liu if (shift == 0) { 525235eb015SJia Liu p[1] = tempB; 526235eb015SJia Liu p[0] = tempA; 527235eb015SJia Liu } else { 528235eb015SJia Liu p[0] = (tempB << (64 - shift)) | (tempA >> shift); 529235eb015SJia Liu p[1] = (int64_t)tempB >> shift; 530235eb015SJia Liu } 531235eb015SJia Liu } 532235eb015SJia Liu 533235eb015SJia Liu /* 128 bits long. p[0] is LO, p[1] is HI , p[2] is sign of HI.*/ 534235eb015SJia Liu static inline void mipsdsp_rndrashift_acc(uint64_t *p, 535235eb015SJia Liu uint32_t ac, 536235eb015SJia Liu uint32_t shift, 537235eb015SJia Liu CPUMIPSState *env) 538235eb015SJia Liu { 539235eb015SJia Liu int64_t tempB, tempA; 540235eb015SJia Liu 541235eb015SJia Liu tempB = env->active_tc.HI[ac]; 542235eb015SJia Liu tempA = env->active_tc.LO[ac]; 543235eb015SJia Liu shift = shift & 0x3F; 544235eb015SJia Liu 545235eb015SJia Liu if (shift == 0) { 546235eb015SJia Liu p[2] = tempB >> 63; 547235eb015SJia Liu p[1] = (tempB << 1) | (tempA >> 63); 548235eb015SJia Liu p[0] = tempA << 1; 549235eb015SJia Liu } else { 550235eb015SJia Liu p[0] = (tempB << (65 - shift)) | (tempA >> (shift - 1)); 551235eb015SJia Liu p[1] = (int64_t)tempB >> (shift - 1); 552235eb015SJia Liu if (tempB >= 0) { 553235eb015SJia Liu p[2] = 0x0; 554235eb015SJia Liu } else { 555235eb015SJia Liu p[2] = ~0ull; 556235eb015SJia Liu } 557235eb015SJia Liu } 558235eb015SJia Liu } 559235eb015SJia Liu 560235eb015SJia Liu static inline int32_t mipsdsp_mul_q15_q15(int32_t ac, uint16_t a, uint16_t b, 561235eb015SJia Liu CPUMIPSState *env) 562235eb015SJia Liu { 563235eb015SJia Liu int32_t temp; 564235eb015SJia Liu 565235eb015SJia Liu if ((a == 0x8000) && (b == 0x8000)) { 566235eb015SJia Liu temp = 0x7FFFFFFF; 567235eb015SJia Liu set_DSPControl_overflow_flag(1, 16 + ac, env); 568235eb015SJia Liu } else { 569b1ca31d7SPetar Jovanovic temp = ((int16_t)a * (int16_t)b) << 1; 570235eb015SJia Liu } 571235eb015SJia Liu 572235eb015SJia Liu return temp; 573235eb015SJia Liu } 574235eb015SJia Liu 575235eb015SJia Liu static inline int64_t mipsdsp_mul_q31_q31(int32_t ac, uint32_t a, uint32_t b, 576235eb015SJia Liu CPUMIPSState *env) 577235eb015SJia Liu { 578235eb015SJia Liu uint64_t temp; 579235eb015SJia Liu 580235eb015SJia Liu if ((a == 0x80000000) && (b == 0x80000000)) { 581235eb015SJia Liu temp = (0x01ull << 63) - 1; 582235eb015SJia Liu set_DSPControl_overflow_flag(1, 16 + ac, env); 583235eb015SJia Liu } else { 584235eb015SJia Liu temp = ((uint64_t)a * (uint64_t)b) << 1; 585235eb015SJia Liu } 586235eb015SJia Liu 587235eb015SJia Liu return temp; 588235eb015SJia Liu } 589235eb015SJia Liu 590235eb015SJia Liu static inline uint16_t mipsdsp_mul_u8_u8(uint8_t a, uint8_t b) 591235eb015SJia Liu { 592235eb015SJia Liu return (uint16_t)a * (uint16_t)b; 593235eb015SJia Liu } 594235eb015SJia Liu 595235eb015SJia Liu static inline uint16_t mipsdsp_mul_u8_u16(uint8_t a, uint16_t b, 596235eb015SJia Liu CPUMIPSState *env) 597235eb015SJia Liu { 598235eb015SJia Liu uint32_t tempI; 599235eb015SJia Liu 600235eb015SJia Liu tempI = (uint32_t)a * (uint32_t)b; 601235eb015SJia Liu if (tempI > 0x0000FFFF) { 602235eb015SJia Liu tempI = 0x0000FFFF; 603235eb015SJia Liu set_DSPControl_overflow_flag(1, 21, env); 604235eb015SJia Liu } 605235eb015SJia Liu 606235eb015SJia Liu return tempI & 0x0000FFFF; 607235eb015SJia Liu } 608235eb015SJia Liu 609235eb015SJia Liu static inline uint64_t mipsdsp_mul_u32_u32(uint32_t a, uint32_t b) 610235eb015SJia Liu { 611235eb015SJia Liu return (uint64_t)a * (uint64_t)b; 612235eb015SJia Liu } 613235eb015SJia Liu 614235eb015SJia Liu static inline int16_t mipsdsp_rndq15_mul_q15_q15(uint16_t a, uint16_t b, 615235eb015SJia Liu CPUMIPSState *env) 616235eb015SJia Liu { 617235eb015SJia Liu uint32_t temp; 618235eb015SJia Liu 619235eb015SJia Liu if ((a == 0x8000) && (b == 0x8000)) { 620235eb015SJia Liu temp = 0x7FFF0000; 621235eb015SJia Liu set_DSPControl_overflow_flag(1, 21, env); 622235eb015SJia Liu } else { 623235eb015SJia Liu temp = (a * b) << 1; 624235eb015SJia Liu temp = temp + 0x00008000; 625235eb015SJia Liu } 626235eb015SJia Liu 627235eb015SJia Liu return (temp & 0xFFFF0000) >> 16; 628235eb015SJia Liu } 629235eb015SJia Liu 630235eb015SJia Liu static inline int32_t mipsdsp_sat16_mul_q15_q15(uint16_t a, uint16_t b, 631235eb015SJia Liu CPUMIPSState *env) 632235eb015SJia Liu { 633235eb015SJia Liu int32_t temp; 634235eb015SJia Liu 635235eb015SJia Liu if ((a == 0x8000) && (b == 0x8000)) { 636235eb015SJia Liu temp = 0x7FFF0000; 637235eb015SJia Liu set_DSPControl_overflow_flag(1, 21, env); 638235eb015SJia Liu } else { 6399c19eb1eSPetar Jovanovic temp = (int16_t)a * (int16_t)b; 640235eb015SJia Liu temp = temp << 1; 641235eb015SJia Liu } 642235eb015SJia Liu 643235eb015SJia Liu return (temp >> 16) & 0x0000FFFF; 644235eb015SJia Liu } 645235eb015SJia Liu 646235eb015SJia Liu static inline uint16_t mipsdsp_trunc16_sat16_round(int32_t a, 647235eb015SJia Liu CPUMIPSState *env) 648235eb015SJia Liu { 649235eb015SJia Liu int64_t temp; 650235eb015SJia Liu 651235eb015SJia Liu temp = (int32_t)a + 0x00008000; 652235eb015SJia Liu 653235eb015SJia Liu if (a > (int)0x7fff8000) { 654235eb015SJia Liu temp = 0x7FFFFFFF; 655235eb015SJia Liu set_DSPControl_overflow_flag(1, 22, env); 656235eb015SJia Liu } 657235eb015SJia Liu 658235eb015SJia Liu return (temp >> 16) & 0xFFFF; 659235eb015SJia Liu } 660235eb015SJia Liu 661235eb015SJia Liu static inline uint8_t mipsdsp_sat8_reduce_precision(uint16_t a, 662235eb015SJia Liu CPUMIPSState *env) 663235eb015SJia Liu { 664235eb015SJia Liu uint16_t mag; 665235eb015SJia Liu uint32_t sign; 666235eb015SJia Liu 667235eb015SJia Liu sign = (a >> 15) & 0x01; 668235eb015SJia Liu mag = a & 0x7FFF; 669235eb015SJia Liu 670235eb015SJia Liu if (sign == 0) { 671235eb015SJia Liu if (mag > 0x7F80) { 672235eb015SJia Liu set_DSPControl_overflow_flag(1, 22, env); 673235eb015SJia Liu return 0xFF; 674235eb015SJia Liu } else { 675235eb015SJia Liu return (mag >> 7) & 0xFFFF; 676235eb015SJia Liu } 677235eb015SJia Liu } else { 678235eb015SJia Liu set_DSPControl_overflow_flag(1, 22, env); 679235eb015SJia Liu return 0x00; 680235eb015SJia Liu } 681235eb015SJia Liu } 682235eb015SJia Liu 683235eb015SJia Liu static inline uint8_t mipsdsp_lshift8(uint8_t a, uint8_t s, CPUMIPSState *env) 684235eb015SJia Liu { 685235eb015SJia Liu uint8_t sign; 686235eb015SJia Liu uint8_t discard; 687235eb015SJia Liu 688235eb015SJia Liu if (s == 0) { 689235eb015SJia Liu return a; 690235eb015SJia Liu } else { 691235eb015SJia Liu sign = (a >> 7) & 0x01; 692235eb015SJia Liu if (sign != 0) { 693235eb015SJia Liu discard = (((0x01 << (8 - s)) - 1) << s) | 694235eb015SJia Liu ((a >> (6 - (s - 1))) & ((0x01 << s) - 1)); 695235eb015SJia Liu } else { 696235eb015SJia Liu discard = a >> (6 - (s - 1)); 697235eb015SJia Liu } 698235eb015SJia Liu 699235eb015SJia Liu if (discard != 0x00) { 700235eb015SJia Liu set_DSPControl_overflow_flag(1, 22, env); 701235eb015SJia Liu } 702235eb015SJia Liu return a << s; 703235eb015SJia Liu } 704235eb015SJia Liu } 705235eb015SJia Liu 706235eb015SJia Liu static inline uint16_t mipsdsp_lshift16(uint16_t a, uint8_t s, 707235eb015SJia Liu CPUMIPSState *env) 708235eb015SJia Liu { 709235eb015SJia Liu uint8_t sign; 710235eb015SJia Liu uint16_t discard; 711235eb015SJia Liu 712235eb015SJia Liu if (s == 0) { 713235eb015SJia Liu return a; 714235eb015SJia Liu } else { 715235eb015SJia Liu sign = (a >> 15) & 0x01; 716235eb015SJia Liu if (sign != 0) { 717235eb015SJia Liu discard = (((0x01 << (16 - s)) - 1) << s) | 718235eb015SJia Liu ((a >> (14 - (s - 1))) & ((0x01 << s) - 1)); 719235eb015SJia Liu } else { 720235eb015SJia Liu discard = a >> (14 - (s - 1)); 721235eb015SJia Liu } 722235eb015SJia Liu 723235eb015SJia Liu if ((discard != 0x0000) && (discard != 0xFFFF)) { 724235eb015SJia Liu set_DSPControl_overflow_flag(1, 22, env); 725235eb015SJia Liu } 726235eb015SJia Liu return a << s; 727235eb015SJia Liu } 728235eb015SJia Liu } 729235eb015SJia Liu 730235eb015SJia Liu 731235eb015SJia Liu static inline uint32_t mipsdsp_lshift32(uint32_t a, uint8_t s, 732235eb015SJia Liu CPUMIPSState *env) 733235eb015SJia Liu { 734235eb015SJia Liu uint32_t discard; 735235eb015SJia Liu 736235eb015SJia Liu if (s == 0) { 737235eb015SJia Liu return a; 738235eb015SJia Liu } else { 739235eb015SJia Liu discard = (int32_t)a >> (31 - (s - 1)); 740235eb015SJia Liu 741235eb015SJia Liu if ((discard != 0x00000000) && (discard != 0xFFFFFFFF)) { 742235eb015SJia Liu set_DSPControl_overflow_flag(1, 22, env); 743235eb015SJia Liu } 744235eb015SJia Liu return a << s; 745235eb015SJia Liu } 746235eb015SJia Liu } 747235eb015SJia Liu 748235eb015SJia Liu static inline uint16_t mipsdsp_sat16_lshift(uint16_t a, uint8_t s, 749235eb015SJia Liu CPUMIPSState *env) 750235eb015SJia Liu { 751235eb015SJia Liu uint8_t sign; 752235eb015SJia Liu uint16_t discard; 753235eb015SJia Liu 754235eb015SJia Liu if (s == 0) { 755235eb015SJia Liu return a; 756235eb015SJia Liu } else { 757235eb015SJia Liu sign = (a >> 15) & 0x01; 758235eb015SJia Liu if (sign != 0) { 759235eb015SJia Liu discard = (((0x01 << (16 - s)) - 1) << s) | 760235eb015SJia Liu ((a >> (14 - (s - 1))) & ((0x01 << s) - 1)); 761235eb015SJia Liu } else { 762235eb015SJia Liu discard = a >> (14 - (s - 1)); 763235eb015SJia Liu } 764235eb015SJia Liu 765235eb015SJia Liu if ((discard != 0x0000) && (discard != 0xFFFF)) { 766235eb015SJia Liu set_DSPControl_overflow_flag(1, 22, env); 767235eb015SJia Liu return (sign == 0) ? 0x7FFF : 0x8000; 768235eb015SJia Liu } else { 769235eb015SJia Liu return a << s; 770235eb015SJia Liu } 771235eb015SJia Liu } 772235eb015SJia Liu } 773235eb015SJia Liu 774235eb015SJia Liu static inline uint32_t mipsdsp_sat32_lshift(uint32_t a, uint8_t s, 775235eb015SJia Liu CPUMIPSState *env) 776235eb015SJia Liu { 777235eb015SJia Liu uint8_t sign; 778235eb015SJia Liu uint32_t discard; 779235eb015SJia Liu 780235eb015SJia Liu if (s == 0) { 781235eb015SJia Liu return a; 782235eb015SJia Liu } else { 783235eb015SJia Liu sign = (a >> 31) & 0x01; 784235eb015SJia Liu if (sign != 0) { 785235eb015SJia Liu discard = (((0x01 << (32 - s)) - 1) << s) | 786235eb015SJia Liu ((a >> (30 - (s - 1))) & ((0x01 << s) - 1)); 787235eb015SJia Liu } else { 788235eb015SJia Liu discard = a >> (30 - (s - 1)); 789235eb015SJia Liu } 790235eb015SJia Liu 791235eb015SJia Liu if ((discard != 0x00000000) && (discard != 0xFFFFFFFF)) { 792235eb015SJia Liu set_DSPControl_overflow_flag(1, 22, env); 793235eb015SJia Liu return (sign == 0) ? 0x7FFFFFFF : 0x80000000; 794235eb015SJia Liu } else { 795235eb015SJia Liu return a << s; 796235eb015SJia Liu } 797235eb015SJia Liu } 798235eb015SJia Liu } 799235eb015SJia Liu 800235eb015SJia Liu static inline uint8_t mipsdsp_rnd8_rashift(uint8_t a, uint8_t s) 801235eb015SJia Liu { 802235eb015SJia Liu uint32_t temp; 803235eb015SJia Liu 804235eb015SJia Liu if (s == 0) { 805235eb015SJia Liu temp = (uint32_t)a << 1; 806235eb015SJia Liu } else { 807235eb015SJia Liu temp = (int32_t)(int8_t)a >> (s - 1); 808235eb015SJia Liu } 809235eb015SJia Liu 810235eb015SJia Liu return (temp + 1) >> 1; 811235eb015SJia Liu } 812235eb015SJia Liu 813235eb015SJia Liu static inline uint16_t mipsdsp_rnd16_rashift(uint16_t a, uint8_t s) 814235eb015SJia Liu { 815235eb015SJia Liu uint32_t temp; 816235eb015SJia Liu 817235eb015SJia Liu if (s == 0) { 818235eb015SJia Liu temp = (uint32_t)a << 1; 819235eb015SJia Liu } else { 820235eb015SJia Liu temp = (int32_t)(int16_t)a >> (s - 1); 821235eb015SJia Liu } 822235eb015SJia Liu 823235eb015SJia Liu return (temp + 1) >> 1; 824235eb015SJia Liu } 825235eb015SJia Liu 826235eb015SJia Liu static inline uint32_t mipsdsp_rnd32_rashift(uint32_t a, uint8_t s) 827235eb015SJia Liu { 828235eb015SJia Liu int64_t temp; 829235eb015SJia Liu 830235eb015SJia Liu if (s == 0) { 831235eb015SJia Liu temp = (uint64_t)a << 1; 832235eb015SJia Liu } else { 833235eb015SJia Liu temp = (int64_t)(int32_t)a >> (s - 1); 834235eb015SJia Liu } 835235eb015SJia Liu temp += 1; 836235eb015SJia Liu 837235eb015SJia Liu return (temp >> 1) & 0xFFFFFFFFull; 838235eb015SJia Liu } 839235eb015SJia Liu 840235eb015SJia Liu static inline uint16_t mipsdsp_sub_i16(int16_t a, int16_t b, CPUMIPSState *env) 841235eb015SJia Liu { 842235eb015SJia Liu int16_t temp; 843235eb015SJia Liu 844235eb015SJia Liu temp = a - b; 84520c334a7SPetar Jovanovic if (MIPSDSP_OVERFLOW_SUB(a, b, temp, 0x8000)) { 846235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 847235eb015SJia Liu } 848235eb015SJia Liu 849235eb015SJia Liu return temp; 850235eb015SJia Liu } 851235eb015SJia Liu 852235eb015SJia Liu static inline uint16_t mipsdsp_sat16_sub(int16_t a, int16_t b, 853235eb015SJia Liu CPUMIPSState *env) 854235eb015SJia Liu { 855235eb015SJia Liu int16_t temp; 856235eb015SJia Liu 857235eb015SJia Liu temp = a - b; 85820c334a7SPetar Jovanovic if (MIPSDSP_OVERFLOW_SUB(a, b, temp, 0x8000)) { 85920c334a7SPetar Jovanovic if (a >= 0) { 860235eb015SJia Liu temp = 0x7FFF; 861235eb015SJia Liu } else { 862235eb015SJia Liu temp = 0x8000; 863235eb015SJia Liu } 864235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 865235eb015SJia Liu } 866235eb015SJia Liu 867235eb015SJia Liu return temp; 868235eb015SJia Liu } 869235eb015SJia Liu 870235eb015SJia Liu static inline uint32_t mipsdsp_sat32_sub(int32_t a, int32_t b, 871235eb015SJia Liu CPUMIPSState *env) 872235eb015SJia Liu { 873235eb015SJia Liu int32_t temp; 874235eb015SJia Liu 875235eb015SJia Liu temp = a - b; 87620c334a7SPetar Jovanovic if (MIPSDSP_OVERFLOW_SUB(a, b, temp, 0x80000000)) { 87720c334a7SPetar Jovanovic if (a >= 0) { 878235eb015SJia Liu temp = 0x7FFFFFFF; 879235eb015SJia Liu } else { 880235eb015SJia Liu temp = 0x80000000; 881235eb015SJia Liu } 882235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 883235eb015SJia Liu } 884235eb015SJia Liu 885235eb015SJia Liu return temp & 0xFFFFFFFFull; 886235eb015SJia Liu } 887235eb015SJia Liu 888235eb015SJia Liu static inline uint16_t mipsdsp_rshift1_sub_q16(int16_t a, int16_t b) 889235eb015SJia Liu { 890235eb015SJia Liu int32_t temp; 891235eb015SJia Liu 892235eb015SJia Liu temp = (int32_t)a - (int32_t)b; 893235eb015SJia Liu 894235eb015SJia Liu return (temp >> 1) & 0x0000FFFF; 895235eb015SJia Liu } 896235eb015SJia Liu 897235eb015SJia Liu static inline uint16_t mipsdsp_rrshift1_sub_q16(int16_t a, int16_t b) 898235eb015SJia Liu { 899235eb015SJia Liu int32_t temp; 900235eb015SJia Liu 901235eb015SJia Liu temp = (int32_t)a - (int32_t)b; 902235eb015SJia Liu temp += 1; 903235eb015SJia Liu 904235eb015SJia Liu return (temp >> 1) & 0x0000FFFF; 905235eb015SJia Liu } 906235eb015SJia Liu 907235eb015SJia Liu static inline uint32_t mipsdsp_rshift1_sub_q32(int32_t a, int32_t b) 908235eb015SJia Liu { 909235eb015SJia Liu int64_t temp; 910235eb015SJia Liu 911235eb015SJia Liu temp = (int64_t)a - (int64_t)b; 912235eb015SJia Liu 913235eb015SJia Liu return (temp >> 1) & 0xFFFFFFFFull; 914235eb015SJia Liu } 915235eb015SJia Liu 916235eb015SJia Liu static inline uint32_t mipsdsp_rrshift1_sub_q32(int32_t a, int32_t b) 917235eb015SJia Liu { 918235eb015SJia Liu int64_t temp; 919235eb015SJia Liu 920235eb015SJia Liu temp = (int64_t)a - (int64_t)b; 921235eb015SJia Liu temp += 1; 922235eb015SJia Liu 923235eb015SJia Liu return (temp >> 1) & 0xFFFFFFFFull; 924235eb015SJia Liu } 925235eb015SJia Liu 926235eb015SJia Liu static inline uint16_t mipsdsp_sub_u16_u16(uint16_t a, uint16_t b, 927235eb015SJia Liu CPUMIPSState *env) 928235eb015SJia Liu { 929235eb015SJia Liu uint8_t temp16; 930235eb015SJia Liu uint32_t temp; 931235eb015SJia Liu 932235eb015SJia Liu temp = (uint32_t)a - (uint32_t)b; 933235eb015SJia Liu temp16 = (temp >> 16) & 0x01; 934235eb015SJia Liu if (temp16 == 1) { 935235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 936235eb015SJia Liu } 937235eb015SJia Liu return temp & 0x0000FFFF; 938235eb015SJia Liu } 939235eb015SJia Liu 940235eb015SJia Liu static inline uint16_t mipsdsp_satu16_sub_u16_u16(uint16_t a, uint16_t b, 941235eb015SJia Liu CPUMIPSState *env) 942235eb015SJia Liu { 943235eb015SJia Liu uint8_t temp16; 944235eb015SJia Liu uint32_t temp; 945235eb015SJia Liu 946235eb015SJia Liu temp = (uint32_t)a - (uint32_t)b; 947235eb015SJia Liu temp16 = (temp >> 16) & 0x01; 948235eb015SJia Liu 949235eb015SJia Liu if (temp16 == 1) { 950235eb015SJia Liu temp = 0x0000; 951235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 952235eb015SJia Liu } 953235eb015SJia Liu 954235eb015SJia Liu return temp & 0x0000FFFF; 955235eb015SJia Liu } 956235eb015SJia Liu 957235eb015SJia Liu static inline uint8_t mipsdsp_sub_u8(uint8_t a, uint8_t b, CPUMIPSState *env) 958235eb015SJia Liu { 959235eb015SJia Liu uint8_t temp8; 960235eb015SJia Liu uint16_t temp; 961235eb015SJia Liu 962235eb015SJia Liu temp = (uint16_t)a - (uint16_t)b; 963235eb015SJia Liu temp8 = (temp >> 8) & 0x01; 964235eb015SJia Liu if (temp8 == 1) { 965235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 966235eb015SJia Liu } 967235eb015SJia Liu 968235eb015SJia Liu return temp & 0x00FF; 969235eb015SJia Liu } 970235eb015SJia Liu 971235eb015SJia Liu static inline uint8_t mipsdsp_satu8_sub(uint8_t a, uint8_t b, CPUMIPSState *env) 972235eb015SJia Liu { 973235eb015SJia Liu uint8_t temp8; 974235eb015SJia Liu uint16_t temp; 975235eb015SJia Liu 976235eb015SJia Liu temp = (uint16_t)a - (uint16_t)b; 977235eb015SJia Liu temp8 = (temp >> 8) & 0x01; 978235eb015SJia Liu if (temp8 == 1) { 979235eb015SJia Liu temp = 0x00; 980235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 981235eb015SJia Liu } 982235eb015SJia Liu 983235eb015SJia Liu return temp & 0x00FF; 984235eb015SJia Liu } 985235eb015SJia Liu 986235eb015SJia Liu static inline uint32_t mipsdsp_sub32(int32_t a, int32_t b, CPUMIPSState *env) 987235eb015SJia Liu { 988235eb015SJia Liu int32_t temp; 989235eb015SJia Liu 990235eb015SJia Liu temp = a - b; 99120c334a7SPetar Jovanovic if (MIPSDSP_OVERFLOW_SUB(a, b, temp, 0x80000000)) { 992235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 993235eb015SJia Liu } 994235eb015SJia Liu 995235eb015SJia Liu return temp; 996235eb015SJia Liu } 997235eb015SJia Liu 998235eb015SJia Liu static inline int32_t mipsdsp_add_i32(int32_t a, int32_t b, CPUMIPSState *env) 999235eb015SJia Liu { 1000235eb015SJia Liu int32_t temp; 1001235eb015SJia Liu 1002235eb015SJia Liu temp = a + b; 1003235eb015SJia Liu 100420c334a7SPetar Jovanovic if (MIPSDSP_OVERFLOW_ADD(a, b, temp, 0x80000000)) { 1005235eb015SJia Liu set_DSPControl_overflow_flag(1, 20, env); 1006235eb015SJia Liu } 1007235eb015SJia Liu 1008235eb015SJia Liu return temp; 1009235eb015SJia Liu } 1010235eb015SJia Liu 1011235eb015SJia Liu static inline int32_t mipsdsp_cmp_eq(int32_t a, int32_t b) 1012235eb015SJia Liu { 1013235eb015SJia Liu return a == b; 1014235eb015SJia Liu } 1015235eb015SJia Liu 1016235eb015SJia Liu static inline int32_t mipsdsp_cmp_le(int32_t a, int32_t b) 1017235eb015SJia Liu { 1018235eb015SJia Liu return a <= b; 1019235eb015SJia Liu } 1020235eb015SJia Liu 1021235eb015SJia Liu static inline int32_t mipsdsp_cmp_lt(int32_t a, int32_t b) 1022235eb015SJia Liu { 1023235eb015SJia Liu return a < b; 1024235eb015SJia Liu } 1025235eb015SJia Liu 1026235eb015SJia Liu static inline int32_t mipsdsp_cmpu_eq(uint32_t a, uint32_t b) 1027235eb015SJia Liu { 1028235eb015SJia Liu return a == b; 1029235eb015SJia Liu } 1030235eb015SJia Liu 1031235eb015SJia Liu static inline int32_t mipsdsp_cmpu_le(uint32_t a, uint32_t b) 1032235eb015SJia Liu { 1033235eb015SJia Liu return a <= b; 1034235eb015SJia Liu } 1035235eb015SJia Liu 1036235eb015SJia Liu static inline int32_t mipsdsp_cmpu_lt(uint32_t a, uint32_t b) 1037235eb015SJia Liu { 1038235eb015SJia Liu return a < b; 1039235eb015SJia Liu } 1040235eb015SJia Liu /*** MIPS DSP internal functions end ***/ 1041461c08dfSJia Liu 1042461c08dfSJia Liu #define MIPSDSP_LHI 0xFFFFFFFF00000000ull 1043461c08dfSJia Liu #define MIPSDSP_LLO 0x00000000FFFFFFFFull 1044461c08dfSJia Liu #define MIPSDSP_HI 0xFFFF0000 1045461c08dfSJia Liu #define MIPSDSP_LO 0x0000FFFF 1046461c08dfSJia Liu #define MIPSDSP_Q3 0xFF000000 1047461c08dfSJia Liu #define MIPSDSP_Q2 0x00FF0000 1048461c08dfSJia Liu #define MIPSDSP_Q1 0x0000FF00 1049461c08dfSJia Liu #define MIPSDSP_Q0 0x000000FF 1050461c08dfSJia Liu 1051461c08dfSJia Liu #define MIPSDSP_SPLIT32_8(num, a, b, c, d) \ 1052461c08dfSJia Liu do { \ 1053461c08dfSJia Liu a = (num >> 24) & MIPSDSP_Q0; \ 1054461c08dfSJia Liu b = (num >> 16) & MIPSDSP_Q0; \ 1055461c08dfSJia Liu c = (num >> 8) & MIPSDSP_Q0; \ 1056461c08dfSJia Liu d = num & MIPSDSP_Q0; \ 1057461c08dfSJia Liu } while (0) 1058461c08dfSJia Liu 1059461c08dfSJia Liu #define MIPSDSP_SPLIT32_16(num, a, b) \ 1060461c08dfSJia Liu do { \ 1061461c08dfSJia Liu a = (num >> 16) & MIPSDSP_LO; \ 1062461c08dfSJia Liu b = num & MIPSDSP_LO; \ 1063461c08dfSJia Liu } while (0) 1064461c08dfSJia Liu 1065461c08dfSJia Liu #define MIPSDSP_RETURN32_8(a, b, c, d) ((target_long)(int32_t) \ 1066461c08dfSJia Liu (((uint32_t)a << 24) | \ 1067461c08dfSJia Liu (((uint32_t)b << 16) | \ 1068461c08dfSJia Liu (((uint32_t)c << 8) | \ 1069461c08dfSJia Liu ((uint32_t)d & 0xFF))))) 1070461c08dfSJia Liu #define MIPSDSP_RETURN32_16(a, b) ((target_long)(int32_t) \ 1071461c08dfSJia Liu (((uint32_t)a << 16) | \ 1072461c08dfSJia Liu ((uint32_t)b & 0xFFFF))) 1073461c08dfSJia Liu 1074461c08dfSJia Liu #ifdef TARGET_MIPS64 1075461c08dfSJia Liu #define MIPSDSP_SPLIT64_16(num, a, b, c, d) \ 1076461c08dfSJia Liu do { \ 1077461c08dfSJia Liu a = (num >> 48) & MIPSDSP_LO; \ 1078461c08dfSJia Liu b = (num >> 32) & MIPSDSP_LO; \ 1079461c08dfSJia Liu c = (num >> 16) & MIPSDSP_LO; \ 1080461c08dfSJia Liu d = num & MIPSDSP_LO; \ 1081461c08dfSJia Liu } while (0) 1082461c08dfSJia Liu 1083461c08dfSJia Liu #define MIPSDSP_SPLIT64_32(num, a, b) \ 1084461c08dfSJia Liu do { \ 1085461c08dfSJia Liu a = (num >> 32) & MIPSDSP_LLO; \ 1086461c08dfSJia Liu b = num & MIPSDSP_LLO; \ 1087461c08dfSJia Liu } while (0) 1088461c08dfSJia Liu 1089461c08dfSJia Liu #define MIPSDSP_RETURN64_16(a, b, c, d) (((uint64_t)a << 48) | \ 1090461c08dfSJia Liu ((uint64_t)b << 32) | \ 1091461c08dfSJia Liu ((uint64_t)c << 16) | \ 1092461c08dfSJia Liu (uint64_t)d) 1093461c08dfSJia Liu #define MIPSDSP_RETURN64_32(a, b) (((uint64_t)a << 32) | (uint64_t)b) 1094461c08dfSJia Liu #endif 1095461c08dfSJia Liu 1096461c08dfSJia Liu /** DSP Arithmetic Sub-class insns **/ 109775d012acSAurelien Jarno #define MIPSDSP32_UNOP_ENV(name, func, element) \ 109875d012acSAurelien Jarno target_ulong helper_##name(target_ulong rt, CPUMIPSState *env) \ 109975d012acSAurelien Jarno { \ 110075d012acSAurelien Jarno DSP32Value dt; \ 110175d012acSAurelien Jarno unsigned int i, n; \ 110275d012acSAurelien Jarno \ 110375d012acSAurelien Jarno n = sizeof(DSP32Value) / sizeof(dt.element[0]); \ 110475d012acSAurelien Jarno dt.sw[0] = rt; \ 110575d012acSAurelien Jarno \ 110675d012acSAurelien Jarno for (i = 0; i < n; i++) { \ 110775d012acSAurelien Jarno dt.element[i] = mipsdsp_##func(dt.element[i], env); \ 110875d012acSAurelien Jarno } \ 110975d012acSAurelien Jarno \ 111075d012acSAurelien Jarno return (target_long)dt.sw[0]; \ 111175d012acSAurelien Jarno } 111275d012acSAurelien Jarno MIPSDSP32_UNOP_ENV(absq_s_ph, sat_abs16, sh) 111375d012acSAurelien Jarno MIPSDSP32_UNOP_ENV(absq_s_qb, sat_abs8, sb) 111475d012acSAurelien Jarno MIPSDSP32_UNOP_ENV(absq_s_w, sat_abs32, sw) 111575d012acSAurelien Jarno #undef MIPSDSP32_UNOP_ENV 111675d012acSAurelien Jarno 111775d012acSAurelien Jarno #if defined(TARGET_MIPS64) 111875d012acSAurelien Jarno #define MIPSDSP64_UNOP_ENV(name, func, element) \ 111975d012acSAurelien Jarno target_ulong helper_##name(target_ulong rt, CPUMIPSState *env) \ 112075d012acSAurelien Jarno { \ 112175d012acSAurelien Jarno DSP64Value dt; \ 112275d012acSAurelien Jarno unsigned int i, n; \ 112375d012acSAurelien Jarno \ 112475d012acSAurelien Jarno n = sizeof(DSP64Value) / sizeof(dt.element[0]); \ 112575d012acSAurelien Jarno dt.sl[0] = rt; \ 112675d012acSAurelien Jarno \ 112775d012acSAurelien Jarno for (i = 0; i < n; i++) { \ 112875d012acSAurelien Jarno dt.element[i] = mipsdsp_##func(dt.element[i], env); \ 112975d012acSAurelien Jarno } \ 113075d012acSAurelien Jarno \ 113175d012acSAurelien Jarno return dt.sl[0]; \ 113275d012acSAurelien Jarno } 113375d012acSAurelien Jarno MIPSDSP64_UNOP_ENV(absq_s_ob, sat_abs8, sb) 113475d012acSAurelien Jarno MIPSDSP64_UNOP_ENV(absq_s_qh, sat_abs16, sh) 113575d012acSAurelien Jarno MIPSDSP64_UNOP_ENV(absq_s_pw, sat_abs32, sw) 113675d012acSAurelien Jarno #undef MIPSDSP64_UNOP_ENV 113775d012acSAurelien Jarno #endif 113875d012acSAurelien Jarno 11396de0e6c1SAurelien Jarno #define MIPSDSP32_BINOP(name, func, element) \ 11406de0e6c1SAurelien Jarno target_ulong helper_##name(target_ulong rs, target_ulong rt) \ 1141461c08dfSJia Liu { \ 11426de0e6c1SAurelien Jarno DSP32Value ds, dt; \ 11436de0e6c1SAurelien Jarno unsigned int i, n; \ 1144461c08dfSJia Liu \ 11456de0e6c1SAurelien Jarno n = sizeof(DSP32Value) / sizeof(ds.element[0]); \ 11466de0e6c1SAurelien Jarno ds.sw[0] = rs; \ 11476de0e6c1SAurelien Jarno dt.sw[0] = rt; \ 1148461c08dfSJia Liu \ 11496de0e6c1SAurelien Jarno for (i = 0; i < n; i++) { \ 11506de0e6c1SAurelien Jarno ds.element[i] = mipsdsp_##func(ds.element[i], dt.element[i]); \ 11516de0e6c1SAurelien Jarno } \ 1152461c08dfSJia Liu \ 11536de0e6c1SAurelien Jarno return (target_long)ds.sw[0]; \ 1154461c08dfSJia Liu } 11556de0e6c1SAurelien Jarno MIPSDSP32_BINOP(addqh_ph, rshift1_add_q16, sh); 11566de0e6c1SAurelien Jarno MIPSDSP32_BINOP(addqh_r_ph, rrshift1_add_q16, sh); 11576de0e6c1SAurelien Jarno MIPSDSP32_BINOP(addqh_r_w, rrshift1_add_q32, sw); 11586de0e6c1SAurelien Jarno MIPSDSP32_BINOP(addqh_w, rshift1_add_q32, sw); 11596de0e6c1SAurelien Jarno MIPSDSP32_BINOP(adduh_qb, rshift1_add_u8, ub); 11606de0e6c1SAurelien Jarno MIPSDSP32_BINOP(adduh_r_qb, rrshift1_add_u8, ub); 11616de0e6c1SAurelien Jarno MIPSDSP32_BINOP(subqh_ph, rshift1_sub_q16, sh); 11626de0e6c1SAurelien Jarno MIPSDSP32_BINOP(subqh_r_ph, rrshift1_sub_q16, sh); 11636de0e6c1SAurelien Jarno MIPSDSP32_BINOP(subqh_r_w, rrshift1_sub_q32, sw); 11646de0e6c1SAurelien Jarno MIPSDSP32_BINOP(subqh_w, rshift1_sub_q32, sw); 11656de0e6c1SAurelien Jarno #undef MIPSDSP32_BINOP 1166461c08dfSJia Liu 11676de0e6c1SAurelien Jarno #define MIPSDSP32_BINOP_ENV(name, func, element) \ 11686de0e6c1SAurelien Jarno target_ulong helper_##name(target_ulong rs, target_ulong rt, \ 1169461c08dfSJia Liu CPUMIPSState *env) \ 1170461c08dfSJia Liu { \ 11716de0e6c1SAurelien Jarno DSP32Value ds, dt; \ 11726de0e6c1SAurelien Jarno unsigned int i, n; \ 1173461c08dfSJia Liu \ 11746de0e6c1SAurelien Jarno n = sizeof(DSP32Value) / sizeof(ds.element[0]); \ 11756de0e6c1SAurelien Jarno ds.sw[0] = rs; \ 11766de0e6c1SAurelien Jarno dt.sw[0] = rt; \ 1177461c08dfSJia Liu \ 11786de0e6c1SAurelien Jarno for (i = 0 ; i < n ; i++) { \ 11796de0e6c1SAurelien Jarno ds.element[i] = mipsdsp_##func(ds.element[i], dt.element[i], env); \ 11806de0e6c1SAurelien Jarno } \ 1181461c08dfSJia Liu \ 11826de0e6c1SAurelien Jarno return (target_long)ds.sw[0]; \ 1183461c08dfSJia Liu } 11846de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addq_ph, add_i16, sh) 11856de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addq_s_ph, sat_add_i16, sh) 11866de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addq_s_w, sat_add_i32, sw); 11876de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addu_ph, add_u16, sh) 11886de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addu_qb, add_u8, ub); 11896de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addu_s_ph, sat_add_u16, sh) 11906de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addu_s_qb, sat_add_u8, ub); 11916de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subq_ph, sub_i16, sh); 11926de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subq_s_ph, sat16_sub, sh); 11936de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subq_s_w, sat32_sub, sw); 11946de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subu_ph, sub_u16_u16, sh); 11956de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subu_qb, sub_u8, ub); 11966de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subu_s_ph, satu16_sub_u16_u16, sh); 11976de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subu_s_qb, satu8_sub, ub); 11986de0e6c1SAurelien Jarno #undef MIPSDSP32_BINOP_ENV 1199461c08dfSJia Liu 1200461c08dfSJia Liu #ifdef TARGET_MIPS64 12016de0e6c1SAurelien Jarno #define MIPSDSP64_BINOP(name, func, element) \ 12026de0e6c1SAurelien Jarno target_ulong helper_##name(target_ulong rs, target_ulong rt) \ 12036de0e6c1SAurelien Jarno { \ 12046de0e6c1SAurelien Jarno DSP64Value ds, dt; \ 12056de0e6c1SAurelien Jarno unsigned int i, n; \ 12066de0e6c1SAurelien Jarno \ 12076de0e6c1SAurelien Jarno n = sizeof(DSP64Value) / sizeof(ds.element[0]); \ 12086de0e6c1SAurelien Jarno ds.sl[0] = rs; \ 12096de0e6c1SAurelien Jarno dt.sl[0] = rt; \ 12106de0e6c1SAurelien Jarno \ 12116de0e6c1SAurelien Jarno for (i = 0 ; i < n ; i++) { \ 12126de0e6c1SAurelien Jarno ds.element[i] = mipsdsp_##func(ds.element[i], dt.element[i]); \ 12136de0e6c1SAurelien Jarno } \ 12146de0e6c1SAurelien Jarno \ 12156de0e6c1SAurelien Jarno return ds.sl[0]; \ 12166de0e6c1SAurelien Jarno } 12176de0e6c1SAurelien Jarno MIPSDSP64_BINOP(adduh_ob, rshift1_add_u8, ub); 12186de0e6c1SAurelien Jarno MIPSDSP64_BINOP(adduh_r_ob, rrshift1_add_u8, ub); 12196de0e6c1SAurelien Jarno MIPSDSP64_BINOP(subuh_ob, rshift1_sub_u8, ub); 12206de0e6c1SAurelien Jarno MIPSDSP64_BINOP(subuh_r_ob, rrshift1_sub_u8, ub); 12216de0e6c1SAurelien Jarno #undef MIPSDSP64_BINOP 12226de0e6c1SAurelien Jarno 12236de0e6c1SAurelien Jarno #define MIPSDSP64_BINOP_ENV(name, func, element) \ 12246de0e6c1SAurelien Jarno target_ulong helper_##name(target_ulong rs, target_ulong rt, \ 1225461c08dfSJia Liu CPUMIPSState *env) \ 1226461c08dfSJia Liu { \ 12276de0e6c1SAurelien Jarno DSP64Value ds, dt; \ 12286de0e6c1SAurelien Jarno unsigned int i, n; \ 1229461c08dfSJia Liu \ 12306de0e6c1SAurelien Jarno n = sizeof(DSP64Value) / sizeof(ds.element[0]); \ 12316de0e6c1SAurelien Jarno ds.sl[0] = rs; \ 12326de0e6c1SAurelien Jarno dt.sl[0] = rt; \ 1233461c08dfSJia Liu \ 12346de0e6c1SAurelien Jarno for (i = 0 ; i < n ; i++) { \ 12356de0e6c1SAurelien Jarno ds.element[i] = mipsdsp_##func(ds.element[i], dt.element[i], env); \ 12366de0e6c1SAurelien Jarno } \ 1237461c08dfSJia Liu \ 12386de0e6c1SAurelien Jarno return ds.sl[0]; \ 1239461c08dfSJia Liu } 12406de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addq_pw, add_i32, sw); 12416de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addq_qh, add_i16, sh); 12426de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addq_s_pw, sat_add_i32, sw); 12436de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addq_s_qh, sat_add_i16, sh); 12446de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addu_ob, add_u8, uh); 12456de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addu_qh, add_u16, uh); 12466de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addu_s_ob, sat_add_u8, uh); 12476de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addu_s_qh, sat_add_u16, uh); 12486de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subq_pw, sub32, sw); 12496de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subq_qh, sub_i16, sh); 12506de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subq_s_pw, sat32_sub, sw); 12516de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subq_s_qh, sat16_sub, sh); 12526de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subu_ob, sub_u8, uh); 12536de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subu_qh, sub_u16_u16, uh); 12546de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subu_s_ob, satu8_sub, uh); 12556de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subu_s_qh, satu16_sub_u16_u16, uh); 12566de0e6c1SAurelien Jarno #undef MIPSDSP64_BINOP_ENV 1257461c08dfSJia Liu 1258461c08dfSJia Liu #endif 1259461c08dfSJia Liu 1260461c08dfSJia Liu #define SUBUH_QB(name, var) \ 1261461c08dfSJia Liu target_ulong helper_##name##_qb(target_ulong rs, target_ulong rt) \ 1262461c08dfSJia Liu { \ 1263461c08dfSJia Liu uint8_t rs3, rs2, rs1, rs0; \ 1264461c08dfSJia Liu uint8_t rt3, rt2, rt1, rt0; \ 1265461c08dfSJia Liu uint8_t tempD, tempC, tempB, tempA; \ 1266461c08dfSJia Liu \ 1267461c08dfSJia Liu MIPSDSP_SPLIT32_8(rs, rs3, rs2, rs1, rs0); \ 1268461c08dfSJia Liu MIPSDSP_SPLIT32_8(rt, rt3, rt2, rt1, rt0); \ 1269461c08dfSJia Liu \ 1270461c08dfSJia Liu tempD = ((uint16_t)rs3 - (uint16_t)rt3 + var) >> 1; \ 1271461c08dfSJia Liu tempC = ((uint16_t)rs2 - (uint16_t)rt2 + var) >> 1; \ 1272461c08dfSJia Liu tempB = ((uint16_t)rs1 - (uint16_t)rt1 + var) >> 1; \ 1273461c08dfSJia Liu tempA = ((uint16_t)rs0 - (uint16_t)rt0 + var) >> 1; \ 1274461c08dfSJia Liu \ 1275461c08dfSJia Liu return ((uint32_t)tempD << 24) | ((uint32_t)tempC << 16) | \ 1276461c08dfSJia Liu ((uint32_t)tempB << 8) | ((uint32_t)tempA); \ 1277461c08dfSJia Liu } 1278461c08dfSJia Liu 1279461c08dfSJia Liu SUBUH_QB(subuh, 0); 1280461c08dfSJia Liu SUBUH_QB(subuh_r, 1); 1281461c08dfSJia Liu 1282461c08dfSJia Liu #undef SUBUH_QB 1283461c08dfSJia Liu 1284461c08dfSJia Liu target_ulong helper_addsc(target_ulong rs, target_ulong rt, CPUMIPSState *env) 1285461c08dfSJia Liu { 1286461c08dfSJia Liu uint64_t temp, tempRs, tempRt; 1287461c08dfSJia Liu int32_t flag; 1288461c08dfSJia Liu 1289461c08dfSJia Liu tempRs = (uint64_t)rs & MIPSDSP_LLO; 1290461c08dfSJia Liu tempRt = (uint64_t)rt & MIPSDSP_LLO; 1291461c08dfSJia Liu 1292461c08dfSJia Liu temp = tempRs + tempRt; 1293461c08dfSJia Liu flag = (temp & 0x0100000000ull) >> 32; 1294461c08dfSJia Liu set_DSPControl_carryflag(flag, env); 1295461c08dfSJia Liu 1296461c08dfSJia Liu return (target_long)(int32_t)(temp & MIPSDSP_LLO); 1297461c08dfSJia Liu } 1298461c08dfSJia Liu 1299461c08dfSJia Liu target_ulong helper_addwc(target_ulong rs, target_ulong rt, CPUMIPSState *env) 1300461c08dfSJia Liu { 1301461c08dfSJia Liu uint32_t rd; 1302461c08dfSJia Liu int32_t temp32, temp31; 1303461c08dfSJia Liu int64_t tempL; 1304461c08dfSJia Liu 1305461c08dfSJia Liu tempL = (int64_t)(int32_t)rs + (int64_t)(int32_t)rt + 1306461c08dfSJia Liu get_DSPControl_carryflag(env); 1307461c08dfSJia Liu temp31 = (tempL >> 31) & 0x01; 1308461c08dfSJia Liu temp32 = (tempL >> 32) & 0x01; 1309461c08dfSJia Liu 1310461c08dfSJia Liu if (temp31 != temp32) { 1311461c08dfSJia Liu set_DSPControl_overflow_flag(1, 20, env); 1312461c08dfSJia Liu } 1313461c08dfSJia Liu 1314461c08dfSJia Liu rd = tempL & MIPSDSP_LLO; 1315461c08dfSJia Liu 1316461c08dfSJia Liu return (target_long)(int32_t)rd; 1317461c08dfSJia Liu } 1318461c08dfSJia Liu 1319461c08dfSJia Liu target_ulong helper_modsub(target_ulong rs, target_ulong rt) 1320461c08dfSJia Liu { 1321461c08dfSJia Liu int32_t decr; 1322461c08dfSJia Liu uint16_t lastindex; 1323461c08dfSJia Liu target_ulong rd; 1324461c08dfSJia Liu 1325461c08dfSJia Liu decr = rt & MIPSDSP_Q0; 1326461c08dfSJia Liu lastindex = (rt >> 8) & MIPSDSP_LO; 1327461c08dfSJia Liu 1328461c08dfSJia Liu if ((rs & MIPSDSP_LLO) == 0x00000000) { 1329461c08dfSJia Liu rd = (target_ulong)lastindex; 1330461c08dfSJia Liu } else { 1331461c08dfSJia Liu rd = rs - decr; 1332461c08dfSJia Liu } 1333461c08dfSJia Liu 1334461c08dfSJia Liu return rd; 1335461c08dfSJia Liu } 1336461c08dfSJia Liu 1337461c08dfSJia Liu target_ulong helper_raddu_w_qb(target_ulong rs) 1338461c08dfSJia Liu { 13390a16c79cSAurelien Jarno target_ulong ret = 0; 13400a16c79cSAurelien Jarno DSP32Value ds; 13410a16c79cSAurelien Jarno unsigned int i; 1342461c08dfSJia Liu 13430a16c79cSAurelien Jarno ds.uw[0] = rs; 13440a16c79cSAurelien Jarno for (i = 0; i < 4; i++) { 13450a16c79cSAurelien Jarno ret += ds.ub[i]; 13460a16c79cSAurelien Jarno } 13470a16c79cSAurelien Jarno return ret; 1348461c08dfSJia Liu } 1349461c08dfSJia Liu 1350461c08dfSJia Liu #if defined(TARGET_MIPS64) 1351461c08dfSJia Liu target_ulong helper_raddu_l_ob(target_ulong rs) 1352461c08dfSJia Liu { 13530a16c79cSAurelien Jarno target_ulong ret = 0; 13540a16c79cSAurelien Jarno DSP64Value ds; 13550a16c79cSAurelien Jarno unsigned int i; 1356461c08dfSJia Liu 13570a16c79cSAurelien Jarno ds.ul[0] = rs; 1358461c08dfSJia Liu for (i = 0; i < 8; i++) { 13590a16c79cSAurelien Jarno ret += ds.ub[i]; 1360461c08dfSJia Liu } 13610a16c79cSAurelien Jarno return ret; 1362461c08dfSJia Liu } 1363461c08dfSJia Liu #endif 1364461c08dfSJia Liu 1365461c08dfSJia Liu #define PRECR_QB_PH(name, a, b)\ 1366461c08dfSJia Liu target_ulong helper_##name##_qb_ph(target_ulong rs, target_ulong rt) \ 1367461c08dfSJia Liu { \ 1368461c08dfSJia Liu uint8_t tempD, tempC, tempB, tempA; \ 1369461c08dfSJia Liu \ 1370461c08dfSJia Liu tempD = (rs >> a) & MIPSDSP_Q0; \ 1371461c08dfSJia Liu tempC = (rs >> b) & MIPSDSP_Q0; \ 1372461c08dfSJia Liu tempB = (rt >> a) & MIPSDSP_Q0; \ 1373461c08dfSJia Liu tempA = (rt >> b) & MIPSDSP_Q0; \ 1374461c08dfSJia Liu \ 1375461c08dfSJia Liu return MIPSDSP_RETURN32_8(tempD, tempC, tempB, tempA); \ 1376461c08dfSJia Liu } 1377461c08dfSJia Liu 1378461c08dfSJia Liu PRECR_QB_PH(precr, 16, 0); 1379461c08dfSJia Liu PRECR_QB_PH(precrq, 24, 8); 1380461c08dfSJia Liu 1381461c08dfSJia Liu #undef PRECR_QB_OH 1382461c08dfSJia Liu 1383461c08dfSJia Liu target_ulong helper_precr_sra_ph_w(uint32_t sa, target_ulong rs, 1384461c08dfSJia Liu target_ulong rt) 1385461c08dfSJia Liu { 1386461c08dfSJia Liu uint16_t tempB, tempA; 1387461c08dfSJia Liu 1388461c08dfSJia Liu tempB = ((int32_t)rt >> sa) & MIPSDSP_LO; 1389461c08dfSJia Liu tempA = ((int32_t)rs >> sa) & MIPSDSP_LO; 1390461c08dfSJia Liu 1391461c08dfSJia Liu return MIPSDSP_RETURN32_16(tempB, tempA); 1392461c08dfSJia Liu } 1393461c08dfSJia Liu 1394461c08dfSJia Liu target_ulong helper_precr_sra_r_ph_w(uint32_t sa, 1395461c08dfSJia Liu target_ulong rs, target_ulong rt) 1396461c08dfSJia Liu { 1397461c08dfSJia Liu uint64_t tempB, tempA; 1398461c08dfSJia Liu 1399461c08dfSJia Liu /* If sa = 0, then (sa - 1) = -1 will case shift error, so we need else. */ 1400461c08dfSJia Liu if (sa == 0) { 1401461c08dfSJia Liu tempB = (rt & MIPSDSP_LO) << 1; 1402461c08dfSJia Liu tempA = (rs & MIPSDSP_LO) << 1; 1403461c08dfSJia Liu } else { 1404461c08dfSJia Liu tempB = ((int32_t)rt >> (sa - 1)) + 1; 1405461c08dfSJia Liu tempA = ((int32_t)rs >> (sa - 1)) + 1; 1406461c08dfSJia Liu } 1407461c08dfSJia Liu rt = (((tempB >> 1) & MIPSDSP_LO) << 16) | ((tempA >> 1) & MIPSDSP_LO); 1408461c08dfSJia Liu 1409461c08dfSJia Liu return (target_long)(int32_t)rt; 1410461c08dfSJia Liu } 1411461c08dfSJia Liu 1412461c08dfSJia Liu target_ulong helper_precrq_ph_w(target_ulong rs, target_ulong rt) 1413461c08dfSJia Liu { 1414461c08dfSJia Liu uint16_t tempB, tempA; 1415461c08dfSJia Liu 1416461c08dfSJia Liu tempB = (rs & MIPSDSP_HI) >> 16; 1417461c08dfSJia Liu tempA = (rt & MIPSDSP_HI) >> 16; 1418461c08dfSJia Liu 1419461c08dfSJia Liu return MIPSDSP_RETURN32_16(tempB, tempA); 1420461c08dfSJia Liu } 1421461c08dfSJia Liu 1422461c08dfSJia Liu target_ulong helper_precrq_rs_ph_w(target_ulong rs, target_ulong rt, 1423461c08dfSJia Liu CPUMIPSState *env) 1424461c08dfSJia Liu { 1425461c08dfSJia Liu uint16_t tempB, tempA; 1426461c08dfSJia Liu 1427461c08dfSJia Liu tempB = mipsdsp_trunc16_sat16_round(rs, env); 1428461c08dfSJia Liu tempA = mipsdsp_trunc16_sat16_round(rt, env); 1429461c08dfSJia Liu 1430461c08dfSJia Liu return MIPSDSP_RETURN32_16(tempB, tempA); 1431461c08dfSJia Liu } 1432461c08dfSJia Liu 1433461c08dfSJia Liu #if defined(TARGET_MIPS64) 1434461c08dfSJia Liu target_ulong helper_precr_ob_qh(target_ulong rs, target_ulong rt) 1435461c08dfSJia Liu { 1436461c08dfSJia Liu uint8_t rs6, rs4, rs2, rs0; 1437461c08dfSJia Liu uint8_t rt6, rt4, rt2, rt0; 1438461c08dfSJia Liu uint64_t temp; 1439461c08dfSJia Liu 1440461c08dfSJia Liu rs6 = (rs >> 48) & MIPSDSP_Q0; 1441461c08dfSJia Liu rs4 = (rs >> 32) & MIPSDSP_Q0; 1442461c08dfSJia Liu rs2 = (rs >> 16) & MIPSDSP_Q0; 1443461c08dfSJia Liu rs0 = rs & MIPSDSP_Q0; 1444461c08dfSJia Liu rt6 = (rt >> 48) & MIPSDSP_Q0; 1445461c08dfSJia Liu rt4 = (rt >> 32) & MIPSDSP_Q0; 1446461c08dfSJia Liu rt2 = (rt >> 16) & MIPSDSP_Q0; 1447461c08dfSJia Liu rt0 = rt & MIPSDSP_Q0; 1448461c08dfSJia Liu 1449461c08dfSJia Liu temp = ((uint64_t)rs6 << 56) | ((uint64_t)rs4 << 48) | 1450461c08dfSJia Liu ((uint64_t)rs2 << 40) | ((uint64_t)rs0 << 32) | 1451461c08dfSJia Liu ((uint64_t)rt6 << 24) | ((uint64_t)rt4 << 16) | 1452461c08dfSJia Liu ((uint64_t)rt2 << 8) | (uint64_t)rt0; 1453461c08dfSJia Liu 1454461c08dfSJia Liu return temp; 1455461c08dfSJia Liu } 1456461c08dfSJia Liu 1457461c08dfSJia Liu #define PRECR_QH_PW(name, var) \ 1458461c08dfSJia Liu target_ulong helper_precr_##name##_qh_pw(target_ulong rs, target_ulong rt, \ 1459461c08dfSJia Liu uint32_t sa) \ 1460461c08dfSJia Liu { \ 1461461c08dfSJia Liu uint16_t rs3, rs2, rs1, rs0; \ 1462461c08dfSJia Liu uint16_t rt3, rt2, rt1, rt0; \ 1463461c08dfSJia Liu uint16_t tempD, tempC, tempB, tempA; \ 1464461c08dfSJia Liu \ 1465461c08dfSJia Liu MIPSDSP_SPLIT64_16(rs, rs3, rs2, rs1, rs0); \ 1466461c08dfSJia Liu MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0); \ 1467461c08dfSJia Liu \ 1468461c08dfSJia Liu /* When sa = 0, we use rt2, rt0, rs2, rs0; \ 1469461c08dfSJia Liu * when sa != 0, we use rt3, rt1, rs3, rs1. */ \ 1470461c08dfSJia Liu if (sa == 0) { \ 1471461c08dfSJia Liu tempD = rt2 << var; \ 1472461c08dfSJia Liu tempC = rt0 << var; \ 1473461c08dfSJia Liu tempB = rs2 << var; \ 1474461c08dfSJia Liu tempA = rs0 << var; \ 1475461c08dfSJia Liu } else { \ 1476461c08dfSJia Liu tempD = (((int16_t)rt3 >> sa) + var) >> var; \ 1477461c08dfSJia Liu tempC = (((int16_t)rt1 >> sa) + var) >> var; \ 1478461c08dfSJia Liu tempB = (((int16_t)rs3 >> sa) + var) >> var; \ 1479461c08dfSJia Liu tempA = (((int16_t)rs1 >> sa) + var) >> var; \ 1480461c08dfSJia Liu } \ 1481461c08dfSJia Liu \ 1482461c08dfSJia Liu return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA); \ 1483461c08dfSJia Liu } 1484461c08dfSJia Liu 1485461c08dfSJia Liu PRECR_QH_PW(sra, 0); 1486461c08dfSJia Liu PRECR_QH_PW(sra_r, 1); 1487461c08dfSJia Liu 1488461c08dfSJia Liu #undef PRECR_QH_PW 1489461c08dfSJia Liu 1490461c08dfSJia Liu target_ulong helper_precrq_ob_qh(target_ulong rs, target_ulong rt) 1491461c08dfSJia Liu { 1492461c08dfSJia Liu uint8_t rs6, rs4, rs2, rs0; 1493461c08dfSJia Liu uint8_t rt6, rt4, rt2, rt0; 1494461c08dfSJia Liu uint64_t temp; 1495461c08dfSJia Liu 1496461c08dfSJia Liu rs6 = (rs >> 56) & MIPSDSP_Q0; 1497461c08dfSJia Liu rs4 = (rs >> 40) & MIPSDSP_Q0; 1498461c08dfSJia Liu rs2 = (rs >> 24) & MIPSDSP_Q0; 1499461c08dfSJia Liu rs0 = (rs >> 8) & MIPSDSP_Q0; 1500461c08dfSJia Liu rt6 = (rt >> 56) & MIPSDSP_Q0; 1501461c08dfSJia Liu rt4 = (rt >> 40) & MIPSDSP_Q0; 1502461c08dfSJia Liu rt2 = (rt >> 24) & MIPSDSP_Q0; 1503461c08dfSJia Liu rt0 = (rt >> 8) & MIPSDSP_Q0; 1504461c08dfSJia Liu 1505461c08dfSJia Liu temp = ((uint64_t)rs6 << 56) | ((uint64_t)rs4 << 48) | 1506461c08dfSJia Liu ((uint64_t)rs2 << 40) | ((uint64_t)rs0 << 32) | 1507461c08dfSJia Liu ((uint64_t)rt6 << 24) | ((uint64_t)rt4 << 16) | 1508461c08dfSJia Liu ((uint64_t)rt2 << 8) | (uint64_t)rt0; 1509461c08dfSJia Liu 1510461c08dfSJia Liu return temp; 1511461c08dfSJia Liu } 1512461c08dfSJia Liu 1513461c08dfSJia Liu target_ulong helper_precrq_qh_pw(target_ulong rs, target_ulong rt) 1514461c08dfSJia Liu { 1515461c08dfSJia Liu uint16_t tempD, tempC, tempB, tempA; 1516461c08dfSJia Liu 1517461c08dfSJia Liu tempD = (rs >> 48) & MIPSDSP_LO; 1518461c08dfSJia Liu tempC = (rs >> 16) & MIPSDSP_LO; 1519461c08dfSJia Liu tempB = (rt >> 48) & MIPSDSP_LO; 1520461c08dfSJia Liu tempA = (rt >> 16) & MIPSDSP_LO; 1521461c08dfSJia Liu 1522461c08dfSJia Liu return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA); 1523461c08dfSJia Liu } 1524461c08dfSJia Liu 1525461c08dfSJia Liu target_ulong helper_precrq_rs_qh_pw(target_ulong rs, target_ulong rt, 1526461c08dfSJia Liu CPUMIPSState *env) 1527461c08dfSJia Liu { 1528461c08dfSJia Liu uint32_t rs2, rs0; 1529461c08dfSJia Liu uint32_t rt2, rt0; 1530461c08dfSJia Liu uint16_t tempD, tempC, tempB, tempA; 1531461c08dfSJia Liu 1532461c08dfSJia Liu rs2 = (rs >> 32) & MIPSDSP_LLO; 1533461c08dfSJia Liu rs0 = rs & MIPSDSP_LLO; 1534461c08dfSJia Liu rt2 = (rt >> 32) & MIPSDSP_LLO; 1535461c08dfSJia Liu rt0 = rt & MIPSDSP_LLO; 1536461c08dfSJia Liu 1537461c08dfSJia Liu tempD = mipsdsp_trunc16_sat16_round(rs2, env); 1538461c08dfSJia Liu tempC = mipsdsp_trunc16_sat16_round(rs0, env); 1539461c08dfSJia Liu tempB = mipsdsp_trunc16_sat16_round(rt2, env); 1540461c08dfSJia Liu tempA = mipsdsp_trunc16_sat16_round(rt0, env); 1541461c08dfSJia Liu 1542461c08dfSJia Liu return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA); 1543461c08dfSJia Liu } 1544461c08dfSJia Liu 1545461c08dfSJia Liu target_ulong helper_precrq_pw_l(target_ulong rs, target_ulong rt) 1546461c08dfSJia Liu { 1547461c08dfSJia Liu uint32_t tempB, tempA; 1548461c08dfSJia Liu 1549461c08dfSJia Liu tempB = (rs >> 32) & MIPSDSP_LLO; 1550461c08dfSJia Liu tempA = (rt >> 32) & MIPSDSP_LLO; 1551461c08dfSJia Liu 1552461c08dfSJia Liu return MIPSDSP_RETURN64_32(tempB, tempA); 1553461c08dfSJia Liu } 1554461c08dfSJia Liu #endif 1555461c08dfSJia Liu 1556461c08dfSJia Liu target_ulong helper_precrqu_s_qb_ph(target_ulong rs, target_ulong rt, 1557461c08dfSJia Liu CPUMIPSState *env) 1558461c08dfSJia Liu { 1559461c08dfSJia Liu uint8_t tempD, tempC, tempB, tempA; 1560461c08dfSJia Liu uint16_t rsh, rsl, rth, rtl; 1561461c08dfSJia Liu 1562461c08dfSJia Liu rsh = (rs & MIPSDSP_HI) >> 16; 1563461c08dfSJia Liu rsl = rs & MIPSDSP_LO; 1564461c08dfSJia Liu rth = (rt & MIPSDSP_HI) >> 16; 1565461c08dfSJia Liu rtl = rt & MIPSDSP_LO; 1566461c08dfSJia Liu 1567461c08dfSJia Liu tempD = mipsdsp_sat8_reduce_precision(rsh, env); 1568461c08dfSJia Liu tempC = mipsdsp_sat8_reduce_precision(rsl, env); 1569461c08dfSJia Liu tempB = mipsdsp_sat8_reduce_precision(rth, env); 1570461c08dfSJia Liu tempA = mipsdsp_sat8_reduce_precision(rtl, env); 1571461c08dfSJia Liu 1572461c08dfSJia Liu return MIPSDSP_RETURN32_8(tempD, tempC, tempB, tempA); 1573461c08dfSJia Liu } 1574461c08dfSJia Liu 1575461c08dfSJia Liu #if defined(TARGET_MIPS64) 1576461c08dfSJia Liu target_ulong helper_precrqu_s_ob_qh(target_ulong rs, target_ulong rt, 1577461c08dfSJia Liu CPUMIPSState *env) 1578461c08dfSJia Liu { 1579461c08dfSJia Liu int i; 1580461c08dfSJia Liu uint16_t rs3, rs2, rs1, rs0; 1581461c08dfSJia Liu uint16_t rt3, rt2, rt1, rt0; 1582461c08dfSJia Liu uint8_t temp[8]; 1583461c08dfSJia Liu uint64_t result; 1584461c08dfSJia Liu 1585461c08dfSJia Liu result = 0; 1586461c08dfSJia Liu 1587461c08dfSJia Liu MIPSDSP_SPLIT64_16(rs, rs3, rs2, rs1, rs0); 1588461c08dfSJia Liu MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0); 1589461c08dfSJia Liu 1590461c08dfSJia Liu temp[7] = mipsdsp_sat8_reduce_precision(rs3, env); 1591461c08dfSJia Liu temp[6] = mipsdsp_sat8_reduce_precision(rs2, env); 1592461c08dfSJia Liu temp[5] = mipsdsp_sat8_reduce_precision(rs1, env); 1593461c08dfSJia Liu temp[4] = mipsdsp_sat8_reduce_precision(rs0, env); 1594461c08dfSJia Liu temp[3] = mipsdsp_sat8_reduce_precision(rt3, env); 1595461c08dfSJia Liu temp[2] = mipsdsp_sat8_reduce_precision(rt2, env); 1596461c08dfSJia Liu temp[1] = mipsdsp_sat8_reduce_precision(rt1, env); 1597461c08dfSJia Liu temp[0] = mipsdsp_sat8_reduce_precision(rt0, env); 1598461c08dfSJia Liu 1599461c08dfSJia Liu for (i = 0; i < 8; i++) { 1600461c08dfSJia Liu result |= (uint64_t)temp[i] << (8 * i); 1601461c08dfSJia Liu } 1602461c08dfSJia Liu 1603461c08dfSJia Liu return result; 1604461c08dfSJia Liu } 1605461c08dfSJia Liu 1606461c08dfSJia Liu #define PRECEQ_PW(name, a, b) \ 1607461c08dfSJia Liu target_ulong helper_preceq_pw_##name(target_ulong rt) \ 1608461c08dfSJia Liu { \ 1609461c08dfSJia Liu uint16_t tempB, tempA; \ 1610461c08dfSJia Liu uint32_t tempBI, tempAI; \ 1611461c08dfSJia Liu \ 1612461c08dfSJia Liu tempB = (rt >> a) & MIPSDSP_LO; \ 1613461c08dfSJia Liu tempA = (rt >> b) & MIPSDSP_LO; \ 1614461c08dfSJia Liu \ 1615461c08dfSJia Liu tempBI = (uint32_t)tempB << 16; \ 1616461c08dfSJia Liu tempAI = (uint32_t)tempA << 16; \ 1617461c08dfSJia Liu \ 1618461c08dfSJia Liu return MIPSDSP_RETURN64_32(tempBI, tempAI); \ 1619461c08dfSJia Liu } 1620461c08dfSJia Liu 1621461c08dfSJia Liu PRECEQ_PW(qhl, 48, 32); 1622461c08dfSJia Liu PRECEQ_PW(qhr, 16, 0); 1623461c08dfSJia Liu PRECEQ_PW(qhla, 48, 16); 1624461c08dfSJia Liu PRECEQ_PW(qhra, 32, 0); 1625461c08dfSJia Liu 1626461c08dfSJia Liu #undef PRECEQ_PW 1627461c08dfSJia Liu 1628461c08dfSJia Liu #endif 1629461c08dfSJia Liu 1630461c08dfSJia Liu #define PRECEQU_PH(name, a, b) \ 1631461c08dfSJia Liu target_ulong helper_precequ_ph_##name(target_ulong rt) \ 1632461c08dfSJia Liu { \ 1633461c08dfSJia Liu uint16_t tempB, tempA; \ 1634461c08dfSJia Liu \ 1635461c08dfSJia Liu tempB = (rt >> a) & MIPSDSP_Q0; \ 1636461c08dfSJia Liu tempA = (rt >> b) & MIPSDSP_Q0; \ 1637461c08dfSJia Liu \ 1638461c08dfSJia Liu tempB = tempB << 7; \ 1639461c08dfSJia Liu tempA = tempA << 7; \ 1640461c08dfSJia Liu \ 1641461c08dfSJia Liu return MIPSDSP_RETURN32_16(tempB, tempA); \ 1642461c08dfSJia Liu } 1643461c08dfSJia Liu 1644461c08dfSJia Liu PRECEQU_PH(qbl, 24, 16); 1645461c08dfSJia Liu PRECEQU_PH(qbr, 8, 0); 1646461c08dfSJia Liu PRECEQU_PH(qbla, 24, 8); 1647461c08dfSJia Liu PRECEQU_PH(qbra, 16, 0); 1648461c08dfSJia Liu 1649461c08dfSJia Liu #undef PRECEQU_PH 1650461c08dfSJia Liu 1651461c08dfSJia Liu #if defined(TARGET_MIPS64) 1652461c08dfSJia Liu #define PRECEQU_QH(name, a, b, c, d) \ 1653461c08dfSJia Liu target_ulong helper_precequ_qh_##name(target_ulong rt) \ 1654461c08dfSJia Liu { \ 1655461c08dfSJia Liu uint16_t tempD, tempC, tempB, tempA; \ 1656461c08dfSJia Liu \ 1657461c08dfSJia Liu tempD = (rt >> a) & MIPSDSP_Q0; \ 1658461c08dfSJia Liu tempC = (rt >> b) & MIPSDSP_Q0; \ 1659461c08dfSJia Liu tempB = (rt >> c) & MIPSDSP_Q0; \ 1660461c08dfSJia Liu tempA = (rt >> d) & MIPSDSP_Q0; \ 1661461c08dfSJia Liu \ 1662461c08dfSJia Liu tempD = tempD << 7; \ 1663461c08dfSJia Liu tempC = tempC << 7; \ 1664461c08dfSJia Liu tempB = tempB << 7; \ 1665461c08dfSJia Liu tempA = tempA << 7; \ 1666461c08dfSJia Liu \ 1667461c08dfSJia Liu return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA); \ 1668461c08dfSJia Liu } 1669461c08dfSJia Liu 1670461c08dfSJia Liu PRECEQU_QH(obl, 56, 48, 40, 32); 1671461c08dfSJia Liu PRECEQU_QH(obr, 24, 16, 8, 0); 1672461c08dfSJia Liu PRECEQU_QH(obla, 56, 40, 24, 8); 1673461c08dfSJia Liu PRECEQU_QH(obra, 48, 32, 16, 0); 1674461c08dfSJia Liu 1675461c08dfSJia Liu #undef PRECEQU_QH 1676461c08dfSJia Liu 1677461c08dfSJia Liu #endif 1678461c08dfSJia Liu 1679461c08dfSJia Liu #define PRECEU_PH(name, a, b) \ 1680461c08dfSJia Liu target_ulong helper_preceu_ph_##name(target_ulong rt) \ 1681461c08dfSJia Liu { \ 1682461c08dfSJia Liu uint16_t tempB, tempA; \ 1683461c08dfSJia Liu \ 1684461c08dfSJia Liu tempB = (rt >> a) & MIPSDSP_Q0; \ 1685461c08dfSJia Liu tempA = (rt >> b) & MIPSDSP_Q0; \ 1686461c08dfSJia Liu \ 1687461c08dfSJia Liu return MIPSDSP_RETURN32_16(tempB, tempA); \ 1688461c08dfSJia Liu } 1689461c08dfSJia Liu 1690461c08dfSJia Liu PRECEU_PH(qbl, 24, 16); 1691461c08dfSJia Liu PRECEU_PH(qbr, 8, 0); 1692461c08dfSJia Liu PRECEU_PH(qbla, 24, 8); 1693461c08dfSJia Liu PRECEU_PH(qbra, 16, 0); 1694461c08dfSJia Liu 1695461c08dfSJia Liu #undef PRECEU_PH 1696461c08dfSJia Liu 1697461c08dfSJia Liu #if defined(TARGET_MIPS64) 1698461c08dfSJia Liu #define PRECEU_QH(name, a, b, c, d) \ 1699461c08dfSJia Liu target_ulong helper_preceu_qh_##name(target_ulong rt) \ 1700461c08dfSJia Liu { \ 1701461c08dfSJia Liu uint16_t tempD, tempC, tempB, tempA; \ 1702461c08dfSJia Liu \ 1703461c08dfSJia Liu tempD = (rt >> a) & MIPSDSP_Q0; \ 1704461c08dfSJia Liu tempC = (rt >> b) & MIPSDSP_Q0; \ 1705461c08dfSJia Liu tempB = (rt >> c) & MIPSDSP_Q0; \ 1706461c08dfSJia Liu tempA = (rt >> d) & MIPSDSP_Q0; \ 1707461c08dfSJia Liu \ 1708461c08dfSJia Liu return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA); \ 1709461c08dfSJia Liu } 1710461c08dfSJia Liu 1711461c08dfSJia Liu PRECEU_QH(obl, 56, 48, 40, 32); 1712461c08dfSJia Liu PRECEU_QH(obr, 24, 16, 8, 0); 1713461c08dfSJia Liu PRECEU_QH(obla, 56, 40, 24, 8); 1714461c08dfSJia Liu PRECEU_QH(obra, 48, 32, 16, 0); 1715461c08dfSJia Liu 1716461c08dfSJia Liu #undef PRECEU_QH 1717461c08dfSJia Liu 1718461c08dfSJia Liu #endif 1719461c08dfSJia Liu 172077c5fa8bSJia Liu /** DSP GPR-Based Shift Sub-class insns **/ 172177c5fa8bSJia Liu #define SHIFT_QB(name, func) \ 172277c5fa8bSJia Liu target_ulong helper_##name##_qb(target_ulong sa, target_ulong rt) \ 172377c5fa8bSJia Liu { \ 172477c5fa8bSJia Liu uint8_t rt3, rt2, rt1, rt0; \ 172577c5fa8bSJia Liu \ 172677c5fa8bSJia Liu sa = sa & 0x07; \ 172777c5fa8bSJia Liu \ 172877c5fa8bSJia Liu MIPSDSP_SPLIT32_8(rt, rt3, rt2, rt1, rt0); \ 172977c5fa8bSJia Liu \ 173077c5fa8bSJia Liu rt3 = mipsdsp_##func(rt3, sa); \ 173177c5fa8bSJia Liu rt2 = mipsdsp_##func(rt2, sa); \ 173277c5fa8bSJia Liu rt1 = mipsdsp_##func(rt1, sa); \ 173377c5fa8bSJia Liu rt0 = mipsdsp_##func(rt0, sa); \ 173477c5fa8bSJia Liu \ 173577c5fa8bSJia Liu return MIPSDSP_RETURN32_8(rt3, rt2, rt1, rt0); \ 173677c5fa8bSJia Liu } 173777c5fa8bSJia Liu 173877c5fa8bSJia Liu #define SHIFT_QB_ENV(name, func) \ 173977c5fa8bSJia Liu target_ulong helper_##name##_qb(target_ulong sa, target_ulong rt,\ 174077c5fa8bSJia Liu CPUMIPSState *env) \ 174177c5fa8bSJia Liu { \ 174277c5fa8bSJia Liu uint8_t rt3, rt2, rt1, rt0; \ 174377c5fa8bSJia Liu \ 174477c5fa8bSJia Liu sa = sa & 0x07; \ 174577c5fa8bSJia Liu \ 174677c5fa8bSJia Liu MIPSDSP_SPLIT32_8(rt, rt3, rt2, rt1, rt0); \ 174777c5fa8bSJia Liu \ 174877c5fa8bSJia Liu rt3 = mipsdsp_##func(rt3, sa, env); \ 174977c5fa8bSJia Liu rt2 = mipsdsp_##func(rt2, sa, env); \ 175077c5fa8bSJia Liu rt1 = mipsdsp_##func(rt1, sa, env); \ 175177c5fa8bSJia Liu rt0 = mipsdsp_##func(rt0, sa, env); \ 175277c5fa8bSJia Liu \ 175377c5fa8bSJia Liu return MIPSDSP_RETURN32_8(rt3, rt2, rt1, rt0); \ 175477c5fa8bSJia Liu } 175577c5fa8bSJia Liu 175677c5fa8bSJia Liu SHIFT_QB_ENV(shll, lshift8); 175777c5fa8bSJia Liu SHIFT_QB(shrl, rshift_u8); 175877c5fa8bSJia Liu 175977c5fa8bSJia Liu SHIFT_QB(shra, rashift8); 176077c5fa8bSJia Liu SHIFT_QB(shra_r, rnd8_rashift); 176177c5fa8bSJia Liu 176277c5fa8bSJia Liu #undef SHIFT_QB 176377c5fa8bSJia Liu #undef SHIFT_QB_ENV 176477c5fa8bSJia Liu 176577c5fa8bSJia Liu #if defined(TARGET_MIPS64) 176677c5fa8bSJia Liu #define SHIFT_OB(name, func) \ 176777c5fa8bSJia Liu target_ulong helper_##name##_ob(target_ulong rt, target_ulong sa) \ 176877c5fa8bSJia Liu { \ 176977c5fa8bSJia Liu int i; \ 177077c5fa8bSJia Liu uint8_t rt_t[8]; \ 177177c5fa8bSJia Liu uint64_t temp; \ 177277c5fa8bSJia Liu \ 177377c5fa8bSJia Liu sa = sa & 0x07; \ 177477c5fa8bSJia Liu temp = 0; \ 177577c5fa8bSJia Liu \ 177677c5fa8bSJia Liu for (i = 0; i < 8; i++) { \ 177777c5fa8bSJia Liu rt_t[i] = (rt >> (8 * i)) & MIPSDSP_Q0; \ 177877c5fa8bSJia Liu rt_t[i] = mipsdsp_##func(rt_t[i], sa); \ 177977c5fa8bSJia Liu temp |= (uint64_t)rt_t[i] << (8 * i); \ 178077c5fa8bSJia Liu } \ 178177c5fa8bSJia Liu \ 178277c5fa8bSJia Liu return temp; \ 178377c5fa8bSJia Liu } 178477c5fa8bSJia Liu 178577c5fa8bSJia Liu #define SHIFT_OB_ENV(name, func) \ 178677c5fa8bSJia Liu target_ulong helper_##name##_ob(target_ulong rt, target_ulong sa, \ 178777c5fa8bSJia Liu CPUMIPSState *env) \ 178877c5fa8bSJia Liu { \ 178977c5fa8bSJia Liu int i; \ 179077c5fa8bSJia Liu uint8_t rt_t[8]; \ 179177c5fa8bSJia Liu uint64_t temp; \ 179277c5fa8bSJia Liu \ 179377c5fa8bSJia Liu sa = sa & 0x07; \ 179477c5fa8bSJia Liu temp = 0; \ 179577c5fa8bSJia Liu \ 179677c5fa8bSJia Liu for (i = 0; i < 8; i++) { \ 179777c5fa8bSJia Liu rt_t[i] = (rt >> (8 * i)) & MIPSDSP_Q0; \ 179877c5fa8bSJia Liu rt_t[i] = mipsdsp_##func(rt_t[i], sa, env); \ 179977c5fa8bSJia Liu temp |= (uint64_t)rt_t[i] << (8 * i); \ 180077c5fa8bSJia Liu } \ 180177c5fa8bSJia Liu \ 180277c5fa8bSJia Liu return temp; \ 180377c5fa8bSJia Liu } 180477c5fa8bSJia Liu 180577c5fa8bSJia Liu SHIFT_OB_ENV(shll, lshift8); 180677c5fa8bSJia Liu SHIFT_OB(shrl, rshift_u8); 180777c5fa8bSJia Liu 180877c5fa8bSJia Liu SHIFT_OB(shra, rashift8); 180977c5fa8bSJia Liu SHIFT_OB(shra_r, rnd8_rashift); 181077c5fa8bSJia Liu 181177c5fa8bSJia Liu #undef SHIFT_OB 181277c5fa8bSJia Liu #undef SHIFT_OB_ENV 181377c5fa8bSJia Liu 181477c5fa8bSJia Liu #endif 181577c5fa8bSJia Liu 181677c5fa8bSJia Liu #define SHIFT_PH(name, func) \ 181777c5fa8bSJia Liu target_ulong helper_##name##_ph(target_ulong sa, target_ulong rt, \ 181877c5fa8bSJia Liu CPUMIPSState *env) \ 181977c5fa8bSJia Liu { \ 182077c5fa8bSJia Liu uint16_t rth, rtl; \ 182177c5fa8bSJia Liu \ 182277c5fa8bSJia Liu sa = sa & 0x0F; \ 182377c5fa8bSJia Liu \ 182477c5fa8bSJia Liu MIPSDSP_SPLIT32_16(rt, rth, rtl); \ 182577c5fa8bSJia Liu \ 182677c5fa8bSJia Liu rth = mipsdsp_##func(rth, sa, env); \ 182777c5fa8bSJia Liu rtl = mipsdsp_##func(rtl, sa, env); \ 182877c5fa8bSJia Liu \ 182977c5fa8bSJia Liu return MIPSDSP_RETURN32_16(rth, rtl); \ 183077c5fa8bSJia Liu } 183177c5fa8bSJia Liu 183277c5fa8bSJia Liu SHIFT_PH(shll, lshift16); 183377c5fa8bSJia Liu SHIFT_PH(shll_s, sat16_lshift); 183477c5fa8bSJia Liu 183577c5fa8bSJia Liu #undef SHIFT_PH 183677c5fa8bSJia Liu 183777c5fa8bSJia Liu #if defined(TARGET_MIPS64) 183877c5fa8bSJia Liu #define SHIFT_QH(name, func) \ 183977c5fa8bSJia Liu target_ulong helper_##name##_qh(target_ulong rt, target_ulong sa) \ 184077c5fa8bSJia Liu { \ 184177c5fa8bSJia Liu uint16_t rt3, rt2, rt1, rt0; \ 184277c5fa8bSJia Liu \ 184377c5fa8bSJia Liu sa = sa & 0x0F; \ 184477c5fa8bSJia Liu \ 184577c5fa8bSJia Liu MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0); \ 184677c5fa8bSJia Liu \ 184777c5fa8bSJia Liu rt3 = mipsdsp_##func(rt3, sa); \ 184877c5fa8bSJia Liu rt2 = mipsdsp_##func(rt2, sa); \ 184977c5fa8bSJia Liu rt1 = mipsdsp_##func(rt1, sa); \ 185077c5fa8bSJia Liu rt0 = mipsdsp_##func(rt0, sa); \ 185177c5fa8bSJia Liu \ 185277c5fa8bSJia Liu return MIPSDSP_RETURN64_16(rt3, rt2, rt1, rt0); \ 185377c5fa8bSJia Liu } 185477c5fa8bSJia Liu 185577c5fa8bSJia Liu #define SHIFT_QH_ENV(name, func) \ 185677c5fa8bSJia Liu target_ulong helper_##name##_qh(target_ulong rt, target_ulong sa, \ 185777c5fa8bSJia Liu CPUMIPSState *env) \ 185877c5fa8bSJia Liu { \ 185977c5fa8bSJia Liu uint16_t rt3, rt2, rt1, rt0; \ 186077c5fa8bSJia Liu \ 186177c5fa8bSJia Liu sa = sa & 0x0F; \ 186277c5fa8bSJia Liu \ 186377c5fa8bSJia Liu MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0); \ 186477c5fa8bSJia Liu \ 186577c5fa8bSJia Liu rt3 = mipsdsp_##func(rt3, sa, env); \ 186677c5fa8bSJia Liu rt2 = mipsdsp_##func(rt2, sa, env); \ 186777c5fa8bSJia Liu rt1 = mipsdsp_##func(rt1, sa, env); \ 186877c5fa8bSJia Liu rt0 = mipsdsp_##func(rt0, sa, env); \ 186977c5fa8bSJia Liu \ 187077c5fa8bSJia Liu return MIPSDSP_RETURN64_16(rt3, rt2, rt1, rt0); \ 187177c5fa8bSJia Liu } 187277c5fa8bSJia Liu 187377c5fa8bSJia Liu SHIFT_QH_ENV(shll, lshift16); 187477c5fa8bSJia Liu SHIFT_QH_ENV(shll_s, sat16_lshift); 187577c5fa8bSJia Liu 187677c5fa8bSJia Liu SHIFT_QH(shrl, rshift_u16); 187777c5fa8bSJia Liu SHIFT_QH(shra, rashift16); 187877c5fa8bSJia Liu SHIFT_QH(shra_r, rnd16_rashift); 187977c5fa8bSJia Liu 188077c5fa8bSJia Liu #undef SHIFT_QH 188177c5fa8bSJia Liu #undef SHIFT_QH_ENV 188277c5fa8bSJia Liu 188377c5fa8bSJia Liu #endif 188477c5fa8bSJia Liu 188577c5fa8bSJia Liu #define SHIFT_W(name, func) \ 188677c5fa8bSJia Liu target_ulong helper_##name##_w(target_ulong sa, target_ulong rt) \ 188777c5fa8bSJia Liu { \ 188877c5fa8bSJia Liu uint32_t temp; \ 188977c5fa8bSJia Liu \ 189077c5fa8bSJia Liu sa = sa & 0x1F; \ 189177c5fa8bSJia Liu temp = mipsdsp_##func(rt, sa); \ 189277c5fa8bSJia Liu \ 189377c5fa8bSJia Liu return (target_long)(int32_t)temp; \ 189477c5fa8bSJia Liu } 189577c5fa8bSJia Liu 189677c5fa8bSJia Liu #define SHIFT_W_ENV(name, func) \ 189777c5fa8bSJia Liu target_ulong helper_##name##_w(target_ulong sa, target_ulong rt, \ 189877c5fa8bSJia Liu CPUMIPSState *env) \ 189977c5fa8bSJia Liu { \ 190077c5fa8bSJia Liu uint32_t temp; \ 190177c5fa8bSJia Liu \ 190277c5fa8bSJia Liu sa = sa & 0x1F; \ 190377c5fa8bSJia Liu temp = mipsdsp_##func(rt, sa, env); \ 190477c5fa8bSJia Liu \ 190577c5fa8bSJia Liu return (target_long)(int32_t)temp; \ 190677c5fa8bSJia Liu } 190777c5fa8bSJia Liu 190877c5fa8bSJia Liu SHIFT_W_ENV(shll_s, sat32_lshift); 190977c5fa8bSJia Liu SHIFT_W(shra_r, rnd32_rashift); 191077c5fa8bSJia Liu 191177c5fa8bSJia Liu #undef SHIFT_W 191277c5fa8bSJia Liu #undef SHIFT_W_ENV 191377c5fa8bSJia Liu 191477c5fa8bSJia Liu #if defined(TARGET_MIPS64) 191577c5fa8bSJia Liu #define SHIFT_PW(name, func) \ 191677c5fa8bSJia Liu target_ulong helper_##name##_pw(target_ulong rt, target_ulong sa) \ 191777c5fa8bSJia Liu { \ 191877c5fa8bSJia Liu uint32_t rt1, rt0; \ 191977c5fa8bSJia Liu \ 192077c5fa8bSJia Liu sa = sa & 0x1F; \ 192177c5fa8bSJia Liu MIPSDSP_SPLIT64_32(rt, rt1, rt0); \ 192277c5fa8bSJia Liu \ 192377c5fa8bSJia Liu rt1 = mipsdsp_##func(rt1, sa); \ 192477c5fa8bSJia Liu rt0 = mipsdsp_##func(rt0, sa); \ 192577c5fa8bSJia Liu \ 192677c5fa8bSJia Liu return MIPSDSP_RETURN64_32(rt1, rt0); \ 192777c5fa8bSJia Liu } 192877c5fa8bSJia Liu 192977c5fa8bSJia Liu #define SHIFT_PW_ENV(name, func) \ 193077c5fa8bSJia Liu target_ulong helper_##name##_pw(target_ulong rt, target_ulong sa, \ 193177c5fa8bSJia Liu CPUMIPSState *env) \ 193277c5fa8bSJia Liu { \ 193377c5fa8bSJia Liu uint32_t rt1, rt0; \ 193477c5fa8bSJia Liu \ 193577c5fa8bSJia Liu sa = sa & 0x1F; \ 193677c5fa8bSJia Liu MIPSDSP_SPLIT64_32(rt, rt1, rt0); \ 193777c5fa8bSJia Liu \ 193877c5fa8bSJia Liu rt1 = mipsdsp_##func(rt1, sa, env); \ 193977c5fa8bSJia Liu rt0 = mipsdsp_##func(rt0, sa, env); \ 194077c5fa8bSJia Liu \ 194177c5fa8bSJia Liu return MIPSDSP_RETURN64_32(rt1, rt0); \ 194277c5fa8bSJia Liu } 194377c5fa8bSJia Liu 194477c5fa8bSJia Liu SHIFT_PW_ENV(shll, lshift32); 194577c5fa8bSJia Liu SHIFT_PW_ENV(shll_s, sat32_lshift); 194677c5fa8bSJia Liu 194777c5fa8bSJia Liu SHIFT_PW(shra, rashift32); 194877c5fa8bSJia Liu SHIFT_PW(shra_r, rnd32_rashift); 194977c5fa8bSJia Liu 195077c5fa8bSJia Liu #undef SHIFT_PW 195177c5fa8bSJia Liu #undef SHIFT_PW_ENV 195277c5fa8bSJia Liu 195377c5fa8bSJia Liu #endif 195477c5fa8bSJia Liu 195577c5fa8bSJia Liu #define SHIFT_PH(name, func) \ 195677c5fa8bSJia Liu target_ulong helper_##name##_ph(target_ulong sa, target_ulong rt) \ 195777c5fa8bSJia Liu { \ 195877c5fa8bSJia Liu uint16_t rth, rtl; \ 195977c5fa8bSJia Liu \ 196077c5fa8bSJia Liu sa = sa & 0x0F; \ 196177c5fa8bSJia Liu \ 196277c5fa8bSJia Liu MIPSDSP_SPLIT32_16(rt, rth, rtl); \ 196377c5fa8bSJia Liu \ 196477c5fa8bSJia Liu rth = mipsdsp_##func(rth, sa); \ 196577c5fa8bSJia Liu rtl = mipsdsp_##func(rtl, sa); \ 196677c5fa8bSJia Liu \ 196777c5fa8bSJia Liu return MIPSDSP_RETURN32_16(rth, rtl); \ 196877c5fa8bSJia Liu } 196977c5fa8bSJia Liu 197077c5fa8bSJia Liu SHIFT_PH(shrl, rshift_u16); 197177c5fa8bSJia Liu SHIFT_PH(shra, rashift16); 197277c5fa8bSJia Liu SHIFT_PH(shra_r, rnd16_rashift); 197377c5fa8bSJia Liu 197477c5fa8bSJia Liu #undef SHIFT_PH 197577c5fa8bSJia Liu 1976a22260aeSJia Liu /** DSP Multiply Sub-class insns **/ 1977a22260aeSJia Liu /* Return value made up by two 16bits value. 1978a22260aeSJia Liu * FIXME give the macro a better name. 1979a22260aeSJia Liu */ 1980a22260aeSJia Liu #define MUL_RETURN32_16_PH(name, func, \ 1981a22260aeSJia Liu rsmov1, rsmov2, rsfilter, \ 1982a22260aeSJia Liu rtmov1, rtmov2, rtfilter) \ 1983a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt, \ 1984a22260aeSJia Liu CPUMIPSState *env) \ 1985a22260aeSJia Liu { \ 1986a22260aeSJia Liu uint16_t rsB, rsA, rtB, rtA; \ 1987a22260aeSJia Liu \ 1988a22260aeSJia Liu rsB = (rs >> rsmov1) & rsfilter; \ 1989a22260aeSJia Liu rsA = (rs >> rsmov2) & rsfilter; \ 1990a22260aeSJia Liu rtB = (rt >> rtmov1) & rtfilter; \ 1991a22260aeSJia Liu rtA = (rt >> rtmov2) & rtfilter; \ 1992a22260aeSJia Liu \ 1993a22260aeSJia Liu rsB = mipsdsp_##func(rsB, rtB, env); \ 1994a22260aeSJia Liu rsA = mipsdsp_##func(rsA, rtA, env); \ 1995a22260aeSJia Liu \ 1996a22260aeSJia Liu return MIPSDSP_RETURN32_16(rsB, rsA); \ 1997a22260aeSJia Liu } 1998a22260aeSJia Liu 1999a22260aeSJia Liu MUL_RETURN32_16_PH(muleu_s_ph_qbl, mul_u8_u16, \ 2000a22260aeSJia Liu 24, 16, MIPSDSP_Q0, \ 2001a22260aeSJia Liu 16, 0, MIPSDSP_LO); 2002a22260aeSJia Liu MUL_RETURN32_16_PH(muleu_s_ph_qbr, mul_u8_u16, \ 2003a22260aeSJia Liu 8, 0, MIPSDSP_Q0, \ 2004a22260aeSJia Liu 16, 0, MIPSDSP_LO); 2005a22260aeSJia Liu MUL_RETURN32_16_PH(mulq_rs_ph, rndq15_mul_q15_q15, \ 2006a22260aeSJia Liu 16, 0, MIPSDSP_LO, \ 2007a22260aeSJia Liu 16, 0, MIPSDSP_LO); 2008a22260aeSJia Liu MUL_RETURN32_16_PH(mul_ph, mul_i16_i16, \ 2009a22260aeSJia Liu 16, 0, MIPSDSP_LO, \ 2010a22260aeSJia Liu 16, 0, MIPSDSP_LO); 2011a22260aeSJia Liu MUL_RETURN32_16_PH(mul_s_ph, sat16_mul_i16_i16, \ 2012a22260aeSJia Liu 16, 0, MIPSDSP_LO, \ 2013a22260aeSJia Liu 16, 0, MIPSDSP_LO); 2014a22260aeSJia Liu MUL_RETURN32_16_PH(mulq_s_ph, sat16_mul_q15_q15, \ 2015a22260aeSJia Liu 16, 0, MIPSDSP_LO, \ 2016a22260aeSJia Liu 16, 0, MIPSDSP_LO); 2017a22260aeSJia Liu 2018a22260aeSJia Liu #undef MUL_RETURN32_16_PH 2019a22260aeSJia Liu 2020a22260aeSJia Liu #define MUL_RETURN32_32_ph(name, func, movbits) \ 2021a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt, \ 2022a22260aeSJia Liu CPUMIPSState *env) \ 2023a22260aeSJia Liu { \ 2024a22260aeSJia Liu int16_t rsh, rth; \ 2025a22260aeSJia Liu int32_t temp; \ 2026a22260aeSJia Liu \ 2027a22260aeSJia Liu rsh = (rs >> movbits) & MIPSDSP_LO; \ 2028a22260aeSJia Liu rth = (rt >> movbits) & MIPSDSP_LO; \ 2029a22260aeSJia Liu temp = mipsdsp_##func(rsh, rth, env); \ 2030a22260aeSJia Liu \ 2031a22260aeSJia Liu return (target_long)(int32_t)temp; \ 2032a22260aeSJia Liu } 2033a22260aeSJia Liu 2034a22260aeSJia Liu MUL_RETURN32_32_ph(muleq_s_w_phl, mul_q15_q15_overflowflag21, 16); 2035a22260aeSJia Liu MUL_RETURN32_32_ph(muleq_s_w_phr, mul_q15_q15_overflowflag21, 0); 2036a22260aeSJia Liu 2037a22260aeSJia Liu #undef MUL_RETURN32_32_ph 2038a22260aeSJia Liu 2039a22260aeSJia Liu #define MUL_VOID_PH(name, use_ac_env) \ 2040a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \ 2041a22260aeSJia Liu CPUMIPSState *env) \ 2042a22260aeSJia Liu { \ 2043a22260aeSJia Liu int16_t rsh, rsl, rth, rtl; \ 2044a22260aeSJia Liu int32_t tempB, tempA; \ 2045a22260aeSJia Liu int64_t acc, dotp; \ 2046a22260aeSJia Liu \ 2047a22260aeSJia Liu MIPSDSP_SPLIT32_16(rs, rsh, rsl); \ 2048a22260aeSJia Liu MIPSDSP_SPLIT32_16(rt, rth, rtl); \ 2049a22260aeSJia Liu \ 2050a22260aeSJia Liu if (use_ac_env == 1) { \ 2051a22260aeSJia Liu tempB = mipsdsp_mul_q15_q15(ac, rsh, rth, env); \ 2052a22260aeSJia Liu tempA = mipsdsp_mul_q15_q15(ac, rsl, rtl, env); \ 2053a22260aeSJia Liu } else { \ 2054a22260aeSJia Liu tempB = mipsdsp_mul_u16_u16(rsh, rth); \ 2055a22260aeSJia Liu tempA = mipsdsp_mul_u16_u16(rsl, rtl); \ 2056a22260aeSJia Liu } \ 2057a22260aeSJia Liu \ 2058a22260aeSJia Liu dotp = (int64_t)tempB - (int64_t)tempA; \ 2059a22260aeSJia Liu acc = ((uint64_t)env->active_tc.HI[ac] << 32) | \ 2060a22260aeSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); \ 2061a22260aeSJia Liu dotp = dotp + acc; \ 2062a22260aeSJia Liu env->active_tc.HI[ac] = (target_long)(int32_t) \ 2063a22260aeSJia Liu ((dotp & MIPSDSP_LHI) >> 32); \ 2064a22260aeSJia Liu env->active_tc.LO[ac] = (target_long)(int32_t)(dotp & MIPSDSP_LLO); \ 2065a22260aeSJia Liu } 2066a22260aeSJia Liu 2067a22260aeSJia Liu MUL_VOID_PH(mulsaq_s_w_ph, 1); 2068a22260aeSJia Liu MUL_VOID_PH(mulsa_w_ph, 0); 2069a22260aeSJia Liu 2070a22260aeSJia Liu #undef MUL_VOID_PH 2071a22260aeSJia Liu 2072a22260aeSJia Liu #if defined(TARGET_MIPS64) 2073a22260aeSJia Liu #define MUL_RETURN64_16_QH(name, func, \ 2074a22260aeSJia Liu rsmov1, rsmov2, rsmov3, rsmov4, rsfilter, \ 2075a22260aeSJia Liu rtmov1, rtmov2, rtmov3, rtmov4, rtfilter) \ 2076a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt, \ 2077a22260aeSJia Liu CPUMIPSState *env) \ 2078a22260aeSJia Liu { \ 2079a22260aeSJia Liu uint16_t rs3, rs2, rs1, rs0; \ 2080a22260aeSJia Liu uint16_t rt3, rt2, rt1, rt0; \ 2081a22260aeSJia Liu uint16_t tempD, tempC, tempB, tempA; \ 2082a22260aeSJia Liu \ 2083a22260aeSJia Liu rs3 = (rs >> rsmov1) & rsfilter; \ 2084a22260aeSJia Liu rs2 = (rs >> rsmov2) & rsfilter; \ 2085a22260aeSJia Liu rs1 = (rs >> rsmov3) & rsfilter; \ 2086a22260aeSJia Liu rs0 = (rs >> rsmov4) & rsfilter; \ 2087a22260aeSJia Liu rt3 = (rt >> rtmov1) & rtfilter; \ 2088a22260aeSJia Liu rt2 = (rt >> rtmov2) & rtfilter; \ 2089a22260aeSJia Liu rt1 = (rt >> rtmov3) & rtfilter; \ 2090a22260aeSJia Liu rt0 = (rt >> rtmov4) & rtfilter; \ 2091a22260aeSJia Liu \ 2092a22260aeSJia Liu tempD = mipsdsp_##func(rs3, rt3, env); \ 2093a22260aeSJia Liu tempC = mipsdsp_##func(rs2, rt2, env); \ 2094a22260aeSJia Liu tempB = mipsdsp_##func(rs1, rt1, env); \ 2095a22260aeSJia Liu tempA = mipsdsp_##func(rs0, rt0, env); \ 2096a22260aeSJia Liu \ 2097a22260aeSJia Liu return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA); \ 2098a22260aeSJia Liu } 2099a22260aeSJia Liu 2100a22260aeSJia Liu MUL_RETURN64_16_QH(muleu_s_qh_obl, mul_u8_u16, \ 2101a22260aeSJia Liu 56, 48, 40, 32, MIPSDSP_Q0, \ 2102a22260aeSJia Liu 48, 32, 16, 0, MIPSDSP_LO); 2103a22260aeSJia Liu MUL_RETURN64_16_QH(muleu_s_qh_obr, mul_u8_u16, \ 2104a22260aeSJia Liu 24, 16, 8, 0, MIPSDSP_Q0, \ 2105a22260aeSJia Liu 48, 32, 16, 0, MIPSDSP_LO); 2106a22260aeSJia Liu MUL_RETURN64_16_QH(mulq_rs_qh, rndq15_mul_q15_q15, \ 2107a22260aeSJia Liu 48, 32, 16, 0, MIPSDSP_LO, \ 2108a22260aeSJia Liu 48, 32, 16, 0, MIPSDSP_LO); 2109a22260aeSJia Liu 2110a22260aeSJia Liu #undef MUL_RETURN64_16_QH 2111a22260aeSJia Liu 2112a22260aeSJia Liu #define MUL_RETURN64_32_QH(name, \ 2113a22260aeSJia Liu rsmov1, rsmov2, \ 2114a22260aeSJia Liu rtmov1, rtmov2) \ 2115a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt, \ 2116a22260aeSJia Liu CPUMIPSState *env) \ 2117a22260aeSJia Liu { \ 2118a22260aeSJia Liu uint16_t rsB, rsA; \ 2119a22260aeSJia Liu uint16_t rtB, rtA; \ 2120a22260aeSJia Liu uint32_t tempB, tempA; \ 2121a22260aeSJia Liu \ 2122a22260aeSJia Liu rsB = (rs >> rsmov1) & MIPSDSP_LO; \ 2123a22260aeSJia Liu rsA = (rs >> rsmov2) & MIPSDSP_LO; \ 2124a22260aeSJia Liu rtB = (rt >> rtmov1) & MIPSDSP_LO; \ 2125a22260aeSJia Liu rtA = (rt >> rtmov2) & MIPSDSP_LO; \ 2126a22260aeSJia Liu \ 2127a22260aeSJia Liu tempB = mipsdsp_mul_q15_q15(5, rsB, rtB, env); \ 2128a22260aeSJia Liu tempA = mipsdsp_mul_q15_q15(5, rsA, rtA, env); \ 2129a22260aeSJia Liu \ 2130a22260aeSJia Liu return ((uint64_t)tempB << 32) | (uint64_t)tempA; \ 2131a22260aeSJia Liu } 2132a22260aeSJia Liu 2133a22260aeSJia Liu MUL_RETURN64_32_QH(muleq_s_pw_qhl, 48, 32, 48, 32); 2134a22260aeSJia Liu MUL_RETURN64_32_QH(muleq_s_pw_qhr, 16, 0, 16, 0); 2135a22260aeSJia Liu 2136a22260aeSJia Liu #undef MUL_RETURN64_32_QH 2137a22260aeSJia Liu 2138a22260aeSJia Liu void helper_mulsaq_s_w_qh(target_ulong rs, target_ulong rt, uint32_t ac, 2139a22260aeSJia Liu CPUMIPSState *env) 2140a22260aeSJia Liu { 2141a22260aeSJia Liu int16_t rs3, rs2, rs1, rs0; 2142a22260aeSJia Liu int16_t rt3, rt2, rt1, rt0; 2143a22260aeSJia Liu int32_t tempD, tempC, tempB, tempA; 2144a22260aeSJia Liu int64_t acc[2]; 2145a22260aeSJia Liu int64_t temp[2]; 2146a22260aeSJia Liu int64_t temp_sum; 2147a22260aeSJia Liu 2148a22260aeSJia Liu MIPSDSP_SPLIT64_16(rs, rs3, rs2, rs1, rs0); 2149a22260aeSJia Liu MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0); 2150a22260aeSJia Liu 2151a22260aeSJia Liu tempD = mipsdsp_mul_q15_q15(ac, rs3, rt3, env); 2152a22260aeSJia Liu tempC = mipsdsp_mul_q15_q15(ac, rs2, rt2, env); 2153a22260aeSJia Liu tempB = mipsdsp_mul_q15_q15(ac, rs1, rt1, env); 2154a22260aeSJia Liu tempA = mipsdsp_mul_q15_q15(ac, rs0, rt0, env); 2155a22260aeSJia Liu 2156a22260aeSJia Liu temp[0] = ((int32_t)tempD - (int32_t)tempC) + 2157a22260aeSJia Liu ((int32_t)tempB - (int32_t)tempA); 2158a22260aeSJia Liu temp[0] = (int64_t)(temp[0] << 30) >> 30; 2159a22260aeSJia Liu if (((temp[0] >> 33) & 0x01) == 0) { 2160a22260aeSJia Liu temp[1] = 0x00; 2161a22260aeSJia Liu } else { 2162a22260aeSJia Liu temp[1] = ~0ull; 2163a22260aeSJia Liu } 2164a22260aeSJia Liu 2165a22260aeSJia Liu acc[0] = env->active_tc.LO[ac]; 2166a22260aeSJia Liu acc[1] = env->active_tc.HI[ac]; 2167a22260aeSJia Liu 2168a22260aeSJia Liu temp_sum = acc[0] + temp[0]; 2169a22260aeSJia Liu if (((uint64_t)temp_sum < (uint64_t)acc[0]) && 2170a22260aeSJia Liu ((uint64_t)temp_sum < (uint64_t)temp[0])) { 2171a22260aeSJia Liu acc[1] += 1; 2172a22260aeSJia Liu } 2173a22260aeSJia Liu acc[0] = temp_sum; 2174a22260aeSJia Liu acc[1] += temp[1]; 2175a22260aeSJia Liu 2176a22260aeSJia Liu env->active_tc.HI[ac] = acc[1]; 2177a22260aeSJia Liu env->active_tc.LO[ac] = acc[0]; 2178a22260aeSJia Liu } 2179a22260aeSJia Liu #endif 2180a22260aeSJia Liu 2181a22260aeSJia Liu #define DP_QB(name, func, is_add, rsmov1, rsmov2, rtmov1, rtmov2) \ 2182a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \ 2183a22260aeSJia Liu CPUMIPSState *env) \ 2184a22260aeSJia Liu { \ 2185a22260aeSJia Liu uint8_t rs3, rs2; \ 2186a22260aeSJia Liu uint8_t rt3, rt2; \ 2187a22260aeSJia Liu uint16_t tempB, tempA; \ 2188a22260aeSJia Liu uint64_t tempC, dotp; \ 2189a22260aeSJia Liu \ 2190a22260aeSJia Liu rs3 = (rs >> rsmov1) & MIPSDSP_Q0; \ 2191a22260aeSJia Liu rs2 = (rs >> rsmov2) & MIPSDSP_Q0; \ 2192a22260aeSJia Liu rt3 = (rt >> rtmov1) & MIPSDSP_Q0; \ 2193a22260aeSJia Liu rt2 = (rt >> rtmov2) & MIPSDSP_Q0; \ 2194a22260aeSJia Liu tempB = mipsdsp_##func(rs3, rt3); \ 2195a22260aeSJia Liu tempA = mipsdsp_##func(rs2, rt2); \ 2196a22260aeSJia Liu dotp = (int64_t)tempB + (int64_t)tempA; \ 2197a22260aeSJia Liu if (is_add) { \ 2198a22260aeSJia Liu tempC = (((uint64_t)env->active_tc.HI[ac] << 32) | \ 2199a22260aeSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO)) \ 2200a22260aeSJia Liu + dotp; \ 2201a22260aeSJia Liu } else { \ 2202a22260aeSJia Liu tempC = (((uint64_t)env->active_tc.HI[ac] << 32) | \ 2203a22260aeSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO)) \ 2204a22260aeSJia Liu - dotp; \ 2205a22260aeSJia Liu } \ 2206a22260aeSJia Liu \ 2207a22260aeSJia Liu env->active_tc.HI[ac] = (target_long)(int32_t) \ 2208a22260aeSJia Liu ((tempC & MIPSDSP_LHI) >> 32); \ 2209a22260aeSJia Liu env->active_tc.LO[ac] = (target_long)(int32_t)(tempC & MIPSDSP_LLO); \ 2210a22260aeSJia Liu } 2211a22260aeSJia Liu 2212a22260aeSJia Liu DP_QB(dpau_h_qbl, mul_u8_u8, 1, 24, 16, 24, 16); 2213a22260aeSJia Liu DP_QB(dpau_h_qbr, mul_u8_u8, 1, 8, 0, 8, 0); 2214a22260aeSJia Liu DP_QB(dpsu_h_qbl, mul_u8_u8, 0, 24, 16, 24, 16); 2215a22260aeSJia Liu DP_QB(dpsu_h_qbr, mul_u8_u8, 0, 8, 0, 8, 0); 2216a22260aeSJia Liu 2217a22260aeSJia Liu #undef DP_QB 2218a22260aeSJia Liu 2219a22260aeSJia Liu #if defined(TARGET_MIPS64) 2220a22260aeSJia Liu #define DP_OB(name, add_sub, \ 2221a22260aeSJia Liu rsmov1, rsmov2, rsmov3, rsmov4, \ 2222a22260aeSJia Liu rtmov1, rtmov2, rtmov3, rtmov4) \ 2223a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \ 2224a22260aeSJia Liu CPUMIPSState *env) \ 2225a22260aeSJia Liu { \ 2226a22260aeSJia Liu uint8_t rsD, rsC, rsB, rsA; \ 2227a22260aeSJia Liu uint8_t rtD, rtC, rtB, rtA; \ 2228a22260aeSJia Liu uint16_t tempD, tempC, tempB, tempA; \ 2229a22260aeSJia Liu uint64_t temp[2]; \ 2230a22260aeSJia Liu uint64_t acc[2]; \ 2231a22260aeSJia Liu uint64_t temp_sum; \ 2232a22260aeSJia Liu \ 2233a22260aeSJia Liu temp[0] = 0; \ 2234a22260aeSJia Liu temp[1] = 0; \ 2235a22260aeSJia Liu \ 2236a22260aeSJia Liu rsD = (rs >> rsmov1) & MIPSDSP_Q0; \ 2237a22260aeSJia Liu rsC = (rs >> rsmov2) & MIPSDSP_Q0; \ 2238a22260aeSJia Liu rsB = (rs >> rsmov3) & MIPSDSP_Q0; \ 2239a22260aeSJia Liu rsA = (rs >> rsmov4) & MIPSDSP_Q0; \ 2240a22260aeSJia Liu rtD = (rt >> rtmov1) & MIPSDSP_Q0; \ 2241a22260aeSJia Liu rtC = (rt >> rtmov2) & MIPSDSP_Q0; \ 2242a22260aeSJia Liu rtB = (rt >> rtmov3) & MIPSDSP_Q0; \ 2243a22260aeSJia Liu rtA = (rt >> rtmov4) & MIPSDSP_Q0; \ 2244a22260aeSJia Liu \ 2245a22260aeSJia Liu tempD = mipsdsp_mul_u8_u8(rsD, rtD); \ 2246a22260aeSJia Liu tempC = mipsdsp_mul_u8_u8(rsC, rtC); \ 2247a22260aeSJia Liu tempB = mipsdsp_mul_u8_u8(rsB, rtB); \ 2248a22260aeSJia Liu tempA = mipsdsp_mul_u8_u8(rsA, rtA); \ 2249a22260aeSJia Liu \ 2250a22260aeSJia Liu temp[0] = (uint64_t)tempD + (uint64_t)tempC + \ 2251a22260aeSJia Liu (uint64_t)tempB + (uint64_t)tempA; \ 2252a22260aeSJia Liu \ 2253a22260aeSJia Liu acc[0] = env->active_tc.LO[ac]; \ 2254a22260aeSJia Liu acc[1] = env->active_tc.HI[ac]; \ 2255a22260aeSJia Liu \ 2256a22260aeSJia Liu if (add_sub) { \ 2257a22260aeSJia Liu temp_sum = acc[0] + temp[0]; \ 2258a22260aeSJia Liu if (((uint64_t)temp_sum < (uint64_t)acc[0]) && \ 2259a22260aeSJia Liu ((uint64_t)temp_sum < (uint64_t)temp[0])) { \ 2260a22260aeSJia Liu acc[1] += 1; \ 2261a22260aeSJia Liu } \ 2262a22260aeSJia Liu temp[0] = temp_sum; \ 2263a22260aeSJia Liu temp[1] = acc[1] + temp[1]; \ 2264a22260aeSJia Liu } else { \ 2265a22260aeSJia Liu temp_sum = acc[0] - temp[0]; \ 2266a22260aeSJia Liu if ((uint64_t)temp_sum > (uint64_t)acc[0]) { \ 2267a22260aeSJia Liu acc[1] -= 1; \ 2268a22260aeSJia Liu } \ 2269a22260aeSJia Liu temp[0] = temp_sum; \ 2270a22260aeSJia Liu temp[1] = acc[1] - temp[1]; \ 2271a22260aeSJia Liu } \ 2272a22260aeSJia Liu \ 2273a22260aeSJia Liu env->active_tc.HI[ac] = temp[1]; \ 2274a22260aeSJia Liu env->active_tc.LO[ac] = temp[0]; \ 2275a22260aeSJia Liu } 2276a22260aeSJia Liu 2277a22260aeSJia Liu DP_OB(dpau_h_obl, 1, 56, 48, 40, 32, 56, 48, 40, 32); 2278a22260aeSJia Liu DP_OB(dpau_h_obr, 1, 24, 16, 8, 0, 24, 16, 8, 0); 2279a22260aeSJia Liu DP_OB(dpsu_h_obl, 0, 56, 48, 40, 32, 56, 48, 40, 32); 2280a22260aeSJia Liu DP_OB(dpsu_h_obr, 0, 24, 16, 8, 0, 24, 16, 8, 0); 2281a22260aeSJia Liu 2282a22260aeSJia Liu #undef DP_OB 2283a22260aeSJia Liu #endif 2284a22260aeSJia Liu 2285a22260aeSJia Liu #define DP_NOFUNC_PH(name, is_add, rsmov1, rsmov2, rtmov1, rtmov2) \ 2286a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \ 2287a22260aeSJia Liu CPUMIPSState *env) \ 2288a22260aeSJia Liu { \ 2289da1a4cefSPetar Jovanovic int16_t rsB, rsA, rtB, rtA; \ 2290a22260aeSJia Liu int32_t tempA, tempB; \ 2291a22260aeSJia Liu int64_t acc; \ 2292a22260aeSJia Liu \ 2293a22260aeSJia Liu rsB = (rs >> rsmov1) & MIPSDSP_LO; \ 2294a22260aeSJia Liu rsA = (rs >> rsmov2) & MIPSDSP_LO; \ 2295a22260aeSJia Liu rtB = (rt >> rtmov1) & MIPSDSP_LO; \ 2296a22260aeSJia Liu rtA = (rt >> rtmov2) & MIPSDSP_LO; \ 2297a22260aeSJia Liu \ 2298a22260aeSJia Liu tempB = (int32_t)rsB * (int32_t)rtB; \ 2299a22260aeSJia Liu tempA = (int32_t)rsA * (int32_t)rtA; \ 2300a22260aeSJia Liu \ 2301a22260aeSJia Liu acc = ((uint64_t)env->active_tc.HI[ac] << 32) | \ 2302a22260aeSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); \ 2303a22260aeSJia Liu \ 2304a22260aeSJia Liu if (is_add) { \ 2305a22260aeSJia Liu acc = acc + ((int64_t)tempB + (int64_t)tempA); \ 2306a22260aeSJia Liu } else { \ 2307a22260aeSJia Liu acc = acc - ((int64_t)tempB + (int64_t)tempA); \ 2308a22260aeSJia Liu } \ 2309a22260aeSJia Liu \ 2310a22260aeSJia Liu env->active_tc.HI[ac] = (target_long)(int32_t)((acc & MIPSDSP_LHI) >> 32); \ 2311a22260aeSJia Liu env->active_tc.LO[ac] = (target_long)(int32_t)(acc & MIPSDSP_LLO); \ 2312a22260aeSJia Liu } 2313a22260aeSJia Liu 2314a22260aeSJia Liu DP_NOFUNC_PH(dpa_w_ph, 1, 16, 0, 16, 0); 2315a22260aeSJia Liu DP_NOFUNC_PH(dpax_w_ph, 1, 16, 0, 0, 16); 2316a22260aeSJia Liu DP_NOFUNC_PH(dps_w_ph, 0, 16, 0, 16, 0); 2317a22260aeSJia Liu DP_NOFUNC_PH(dpsx_w_ph, 0, 16, 0, 0, 16); 2318a22260aeSJia Liu #undef DP_NOFUNC_PH 2319a22260aeSJia Liu 2320a22260aeSJia Liu #define DP_HASFUNC_PH(name, is_add, rsmov1, rsmov2, rtmov1, rtmov2) \ 2321a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \ 2322a22260aeSJia Liu CPUMIPSState *env) \ 2323a22260aeSJia Liu { \ 2324a22260aeSJia Liu int16_t rsB, rsA, rtB, rtA; \ 2325a22260aeSJia Liu int32_t tempB, tempA; \ 2326a22260aeSJia Liu int64_t acc, dotp; \ 2327a22260aeSJia Liu \ 2328a22260aeSJia Liu rsB = (rs >> rsmov1) & MIPSDSP_LO; \ 2329a22260aeSJia Liu rsA = (rs >> rsmov2) & MIPSDSP_LO; \ 2330a22260aeSJia Liu rtB = (rt >> rtmov1) & MIPSDSP_LO; \ 2331a22260aeSJia Liu rtA = (rt >> rtmov2) & MIPSDSP_LO; \ 2332a22260aeSJia Liu \ 2333a22260aeSJia Liu tempB = mipsdsp_mul_q15_q15(ac, rsB, rtB, env); \ 2334a22260aeSJia Liu tempA = mipsdsp_mul_q15_q15(ac, rsA, rtA, env); \ 2335a22260aeSJia Liu \ 2336a22260aeSJia Liu dotp = (int64_t)tempB + (int64_t)tempA; \ 2337a22260aeSJia Liu acc = ((uint64_t)env->active_tc.HI[ac] << 32) | \ 2338a22260aeSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); \ 2339a22260aeSJia Liu \ 2340a22260aeSJia Liu if (is_add) { \ 2341a22260aeSJia Liu acc = acc + dotp; \ 2342a22260aeSJia Liu } else { \ 2343a22260aeSJia Liu acc = acc - dotp; \ 2344a22260aeSJia Liu } \ 2345a22260aeSJia Liu \ 2346a22260aeSJia Liu env->active_tc.HI[ac] = (target_long)(int32_t) \ 2347a22260aeSJia Liu ((acc & MIPSDSP_LHI) >> 32); \ 2348a22260aeSJia Liu env->active_tc.LO[ac] = (target_long)(int32_t) \ 2349a22260aeSJia Liu (acc & MIPSDSP_LLO); \ 2350a22260aeSJia Liu } 2351a22260aeSJia Liu 2352a22260aeSJia Liu DP_HASFUNC_PH(dpaq_s_w_ph, 1, 16, 0, 16, 0); 2353a22260aeSJia Liu DP_HASFUNC_PH(dpaqx_s_w_ph, 1, 16, 0, 0, 16); 2354a22260aeSJia Liu DP_HASFUNC_PH(dpsq_s_w_ph, 0, 16, 0, 16, 0); 2355a22260aeSJia Liu DP_HASFUNC_PH(dpsqx_s_w_ph, 0, 16, 0, 0, 16); 2356a22260aeSJia Liu 2357a22260aeSJia Liu #undef DP_HASFUNC_PH 2358a22260aeSJia Liu 2359a22260aeSJia Liu #define DP_128OPERATION_PH(name, is_add) \ 2360a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \ 2361a22260aeSJia Liu CPUMIPSState *env) \ 2362a22260aeSJia Liu { \ 2363a22260aeSJia Liu int16_t rsh, rsl, rth, rtl; \ 2364a22260aeSJia Liu int32_t tempB, tempA, tempC62_31, tempC63; \ 2365a22260aeSJia Liu int64_t acc, dotp, tempC; \ 2366a22260aeSJia Liu \ 2367a22260aeSJia Liu MIPSDSP_SPLIT32_16(rs, rsh, rsl); \ 2368a22260aeSJia Liu MIPSDSP_SPLIT32_16(rt, rth, rtl); \ 2369a22260aeSJia Liu \ 2370a22260aeSJia Liu tempB = mipsdsp_mul_q15_q15(ac, rsh, rtl, env); \ 2371a22260aeSJia Liu tempA = mipsdsp_mul_q15_q15(ac, rsl, rth, env); \ 2372a22260aeSJia Liu \ 2373a22260aeSJia Liu dotp = (int64_t)tempB + (int64_t)tempA; \ 2374a22260aeSJia Liu acc = ((uint64_t)env->active_tc.HI[ac] << 32) | \ 2375a22260aeSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); \ 2376a22260aeSJia Liu if (is_add) { \ 2377a22260aeSJia Liu tempC = acc + dotp; \ 2378a22260aeSJia Liu } else { \ 2379a22260aeSJia Liu tempC = acc - dotp; \ 2380a22260aeSJia Liu } \ 2381a22260aeSJia Liu tempC63 = (tempC >> 63) & 0x01; \ 2382a22260aeSJia Liu tempC62_31 = (tempC >> 31) & 0xFFFFFFFF; \ 2383a22260aeSJia Liu \ 2384a22260aeSJia Liu if ((tempC63 == 0) && (tempC62_31 != 0x00000000)) { \ 2385a22260aeSJia Liu tempC = 0x7FFFFFFF; \ 2386a22260aeSJia Liu set_DSPControl_overflow_flag(1, 16 + ac, env); \ 2387a22260aeSJia Liu } \ 2388a22260aeSJia Liu \ 2389a22260aeSJia Liu if ((tempC63 == 1) && (tempC62_31 != 0xFFFFFFFF)) { \ 2390a22260aeSJia Liu tempC = (int64_t)(int32_t)0x80000000; \ 2391a22260aeSJia Liu set_DSPControl_overflow_flag(1, 16 + ac, env); \ 2392a22260aeSJia Liu } \ 2393a22260aeSJia Liu \ 2394a22260aeSJia Liu env->active_tc.HI[ac] = (target_long)(int32_t) \ 2395a22260aeSJia Liu ((tempC & MIPSDSP_LHI) >> 32); \ 2396a22260aeSJia Liu env->active_tc.LO[ac] = (target_long)(int32_t) \ 2397a22260aeSJia Liu (tempC & MIPSDSP_LLO); \ 2398a22260aeSJia Liu } 2399a22260aeSJia Liu 2400a22260aeSJia Liu DP_128OPERATION_PH(dpaqx_sa_w_ph, 1); 2401a22260aeSJia Liu DP_128OPERATION_PH(dpsqx_sa_w_ph, 0); 2402a22260aeSJia Liu 2403a22260aeSJia Liu #undef DP_128OPERATION_HP 2404a22260aeSJia Liu 2405a22260aeSJia Liu #if defined(TARGET_MIPS64) 2406a22260aeSJia Liu #define DP_QH(name, is_add, use_ac_env) \ 2407a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \ 2408a22260aeSJia Liu CPUMIPSState *env) \ 2409a22260aeSJia Liu { \ 2410a22260aeSJia Liu int32_t rs3, rs2, rs1, rs0; \ 2411a22260aeSJia Liu int32_t rt3, rt2, rt1, rt0; \ 2412a22260aeSJia Liu int32_t tempD, tempC, tempB, tempA; \ 2413a22260aeSJia Liu int64_t acc[2]; \ 2414a22260aeSJia Liu int64_t temp[2]; \ 2415a22260aeSJia Liu int64_t temp_sum; \ 2416a22260aeSJia Liu \ 2417a22260aeSJia Liu MIPSDSP_SPLIT64_16(rs, rs3, rs2, rs1, rs0); \ 2418a22260aeSJia Liu MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0); \ 2419a22260aeSJia Liu \ 2420a22260aeSJia Liu if (use_ac_env) { \ 2421a22260aeSJia Liu tempD = mipsdsp_mul_q15_q15(ac, rs3, rt3, env); \ 2422a22260aeSJia Liu tempC = mipsdsp_mul_q15_q15(ac, rs2, rt2, env); \ 2423a22260aeSJia Liu tempB = mipsdsp_mul_q15_q15(ac, rs1, rt1, env); \ 2424a22260aeSJia Liu tempA = mipsdsp_mul_q15_q15(ac, rs0, rt0, env); \ 2425a22260aeSJia Liu } else { \ 2426a22260aeSJia Liu tempD = mipsdsp_mul_u16_u16(rs3, rt3); \ 2427a22260aeSJia Liu tempC = mipsdsp_mul_u16_u16(rs2, rt2); \ 2428a22260aeSJia Liu tempB = mipsdsp_mul_u16_u16(rs1, rt1); \ 2429a22260aeSJia Liu tempA = mipsdsp_mul_u16_u16(rs0, rt0); \ 2430a22260aeSJia Liu } \ 2431a22260aeSJia Liu \ 2432a22260aeSJia Liu temp[0] = (int64_t)tempD + (int64_t)tempC + \ 2433a22260aeSJia Liu (int64_t)tempB + (int64_t)tempA; \ 2434a22260aeSJia Liu \ 2435a22260aeSJia Liu if (temp[0] >= 0) { \ 2436a22260aeSJia Liu temp[1] = 0; \ 2437a22260aeSJia Liu } else { \ 2438a22260aeSJia Liu temp[1] = ~0ull; \ 2439a22260aeSJia Liu } \ 2440a22260aeSJia Liu \ 2441a22260aeSJia Liu acc[1] = env->active_tc.HI[ac]; \ 2442a22260aeSJia Liu acc[0] = env->active_tc.LO[ac]; \ 2443a22260aeSJia Liu \ 2444a22260aeSJia Liu if (is_add) { \ 2445a22260aeSJia Liu temp_sum = acc[0] + temp[0]; \ 2446a22260aeSJia Liu if (((uint64_t)temp_sum < (uint64_t)acc[0]) && \ 2447a22260aeSJia Liu ((uint64_t)temp_sum < (uint64_t)temp[0])) { \ 2448a22260aeSJia Liu acc[1] = acc[1] + 1; \ 2449a22260aeSJia Liu } \ 2450a22260aeSJia Liu temp[0] = temp_sum; \ 2451a22260aeSJia Liu temp[1] = acc[1] + temp[1]; \ 2452a22260aeSJia Liu } else { \ 2453a22260aeSJia Liu temp_sum = acc[0] - temp[0]; \ 2454a22260aeSJia Liu if ((uint64_t)temp_sum > (uint64_t)acc[0]) { \ 2455a22260aeSJia Liu acc[1] = acc[1] - 1; \ 2456a22260aeSJia Liu } \ 2457a22260aeSJia Liu temp[0] = temp_sum; \ 2458a22260aeSJia Liu temp[1] = acc[1] - temp[1]; \ 2459a22260aeSJia Liu } \ 2460a22260aeSJia Liu \ 2461a22260aeSJia Liu env->active_tc.HI[ac] = temp[1]; \ 2462a22260aeSJia Liu env->active_tc.LO[ac] = temp[0]; \ 2463a22260aeSJia Liu } 2464a22260aeSJia Liu 2465a22260aeSJia Liu DP_QH(dpa_w_qh, 1, 0); 2466a22260aeSJia Liu DP_QH(dpaq_s_w_qh, 1, 1); 2467a22260aeSJia Liu DP_QH(dps_w_qh, 0, 0); 2468a22260aeSJia Liu DP_QH(dpsq_s_w_qh, 0, 1); 2469a22260aeSJia Liu 2470a22260aeSJia Liu #undef DP_QH 2471a22260aeSJia Liu 2472a22260aeSJia Liu #endif 2473a22260aeSJia Liu 2474a22260aeSJia Liu #define DP_L_W(name, is_add) \ 2475a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \ 2476a22260aeSJia Liu CPUMIPSState *env) \ 2477a22260aeSJia Liu { \ 2478a22260aeSJia Liu int32_t temp63; \ 2479a22260aeSJia Liu int64_t dotp, acc; \ 2480a22260aeSJia Liu uint64_t temp; \ 248120c334a7SPetar Jovanovic bool overflow; \ 2482a22260aeSJia Liu \ 2483a22260aeSJia Liu dotp = mipsdsp_mul_q31_q31(ac, rs, rt, env); \ 2484a22260aeSJia Liu acc = ((uint64_t)env->active_tc.HI[ac] << 32) | \ 2485a22260aeSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); \ 248620c334a7SPetar Jovanovic if (is_add) { \ 248720c334a7SPetar Jovanovic temp = acc + dotp; \ 248820c334a7SPetar Jovanovic overflow = MIPSDSP_OVERFLOW_ADD((uint64_t)acc, (uint64_t)dotp, \ 248920c334a7SPetar Jovanovic temp, (0x01ull << 63)); \ 249020c334a7SPetar Jovanovic } else { \ 249120c334a7SPetar Jovanovic temp = acc - dotp; \ 249220c334a7SPetar Jovanovic overflow = MIPSDSP_OVERFLOW_SUB((uint64_t)acc, (uint64_t)dotp, \ 249320c334a7SPetar Jovanovic temp, (0x01ull << 63)); \ 2494a22260aeSJia Liu } \ 2495a22260aeSJia Liu \ 249620c334a7SPetar Jovanovic if (overflow) { \ 2497a22260aeSJia Liu temp63 = (temp >> 63) & 0x01; \ 2498a22260aeSJia Liu if (temp63 == 1) { \ 2499a22260aeSJia Liu temp = (0x01ull << 63) - 1; \ 2500a22260aeSJia Liu } else { \ 2501a22260aeSJia Liu temp = 0x01ull << 63; \ 2502a22260aeSJia Liu } \ 2503a22260aeSJia Liu \ 2504a22260aeSJia Liu set_DSPControl_overflow_flag(1, 16 + ac, env); \ 2505a22260aeSJia Liu } \ 2506a22260aeSJia Liu \ 2507a22260aeSJia Liu env->active_tc.HI[ac] = (target_long)(int32_t) \ 2508a22260aeSJia Liu ((temp & MIPSDSP_LHI) >> 32); \ 2509a22260aeSJia Liu env->active_tc.LO[ac] = (target_long)(int32_t) \ 2510a22260aeSJia Liu (temp & MIPSDSP_LLO); \ 2511a22260aeSJia Liu } 2512a22260aeSJia Liu 2513a22260aeSJia Liu DP_L_W(dpaq_sa_l_w, 1); 2514a22260aeSJia Liu DP_L_W(dpsq_sa_l_w, 0); 2515a22260aeSJia Liu 2516a22260aeSJia Liu #undef DP_L_W 2517a22260aeSJia Liu 2518a22260aeSJia Liu #if defined(TARGET_MIPS64) 2519a22260aeSJia Liu #define DP_L_PW(name, func) \ 2520a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \ 2521a22260aeSJia Liu CPUMIPSState *env) \ 2522a22260aeSJia Liu { \ 2523a22260aeSJia Liu int32_t rs1, rs0; \ 2524a22260aeSJia Liu int32_t rt1, rt0; \ 2525a22260aeSJia Liu int64_t tempB[2], tempA[2]; \ 2526a22260aeSJia Liu int64_t temp[2]; \ 2527a22260aeSJia Liu int64_t acc[2]; \ 2528a22260aeSJia Liu int64_t temp_sum; \ 2529a22260aeSJia Liu \ 2530a22260aeSJia Liu temp[0] = 0; \ 2531a22260aeSJia Liu temp[1] = 0; \ 2532a22260aeSJia Liu \ 2533a22260aeSJia Liu MIPSDSP_SPLIT64_32(rs, rs1, rs0); \ 2534a22260aeSJia Liu MIPSDSP_SPLIT64_32(rt, rt1, rt0); \ 2535a22260aeSJia Liu \ 2536a22260aeSJia Liu tempB[0] = mipsdsp_mul_q31_q31(ac, rs1, rt1, env); \ 2537a22260aeSJia Liu tempA[0] = mipsdsp_mul_q31_q31(ac, rs0, rt0, env); \ 2538a22260aeSJia Liu \ 2539a22260aeSJia Liu if (tempB[0] >= 0) { \ 2540a22260aeSJia Liu tempB[1] = 0x00; \ 2541a22260aeSJia Liu } else { \ 2542a22260aeSJia Liu tempB[1] = ~0ull; \ 2543a22260aeSJia Liu } \ 2544a22260aeSJia Liu \ 2545a22260aeSJia Liu if (tempA[0] >= 0) { \ 2546a22260aeSJia Liu tempA[1] = 0x00; \ 2547a22260aeSJia Liu } else { \ 2548a22260aeSJia Liu tempA[1] = ~0ull; \ 2549a22260aeSJia Liu } \ 2550a22260aeSJia Liu \ 2551a22260aeSJia Liu temp_sum = tempB[0] + tempA[0]; \ 2552a22260aeSJia Liu if (((uint64_t)temp_sum < (uint64_t)tempB[0]) && \ 2553a22260aeSJia Liu ((uint64_t)temp_sum < (uint64_t)tempA[0])) { \ 2554a22260aeSJia Liu temp[1] += 1; \ 2555a22260aeSJia Liu } \ 2556a22260aeSJia Liu temp[0] = temp_sum; \ 2557a22260aeSJia Liu temp[1] += tempB[1] + tempA[1]; \ 2558a22260aeSJia Liu \ 2559a22260aeSJia Liu mipsdsp_##func(acc, ac, temp, env); \ 2560a22260aeSJia Liu \ 2561a22260aeSJia Liu env->active_tc.HI[ac] = acc[1]; \ 2562a22260aeSJia Liu env->active_tc.LO[ac] = acc[0]; \ 2563a22260aeSJia Liu } 2564a22260aeSJia Liu 2565a22260aeSJia Liu DP_L_PW(dpaq_sa_l_pw, sat64_acc_add_q63); 2566a22260aeSJia Liu DP_L_PW(dpsq_sa_l_pw, sat64_acc_sub_q63); 2567a22260aeSJia Liu 2568a22260aeSJia Liu #undef DP_L_PW 2569a22260aeSJia Liu 2570a22260aeSJia Liu void helper_mulsaq_s_l_pw(target_ulong rs, target_ulong rt, uint32_t ac, 2571a22260aeSJia Liu CPUMIPSState *env) 2572a22260aeSJia Liu { 2573a22260aeSJia Liu int32_t rs1, rs0; 2574a22260aeSJia Liu int32_t rt1, rt0; 2575a22260aeSJia Liu int64_t tempB[2], tempA[2]; 2576a22260aeSJia Liu int64_t temp[2]; 2577a22260aeSJia Liu int64_t acc[2]; 2578a22260aeSJia Liu int64_t temp_sum; 2579a22260aeSJia Liu 2580a22260aeSJia Liu rs1 = (rs >> 32) & MIPSDSP_LLO; 2581a22260aeSJia Liu rs0 = rs & MIPSDSP_LLO; 2582a22260aeSJia Liu rt1 = (rt >> 32) & MIPSDSP_LLO; 2583a22260aeSJia Liu rt0 = rt & MIPSDSP_LLO; 2584a22260aeSJia Liu 2585a22260aeSJia Liu tempB[0] = mipsdsp_mul_q31_q31(ac, rs1, rt1, env); 2586a22260aeSJia Liu tempA[0] = mipsdsp_mul_q31_q31(ac, rs0, rt0, env); 2587a22260aeSJia Liu 2588a22260aeSJia Liu if (tempB[0] >= 0) { 2589a22260aeSJia Liu tempB[1] = 0x00; 2590a22260aeSJia Liu } else { 2591a22260aeSJia Liu tempB[1] = ~0ull; 2592a22260aeSJia Liu } 2593a22260aeSJia Liu 2594a22260aeSJia Liu if (tempA[0] >= 0) { 2595a22260aeSJia Liu tempA[1] = 0x00; 2596a22260aeSJia Liu } else { 2597a22260aeSJia Liu tempA[1] = ~0ull; 2598a22260aeSJia Liu } 2599a22260aeSJia Liu 2600a22260aeSJia Liu acc[0] = env->active_tc.LO[ac]; 2601a22260aeSJia Liu acc[1] = env->active_tc.HI[ac]; 2602a22260aeSJia Liu 2603a22260aeSJia Liu temp_sum = tempB[0] - tempA[0]; 2604a22260aeSJia Liu if ((uint64_t)temp_sum > (uint64_t)tempB[0]) { 2605a22260aeSJia Liu tempB[1] -= 1; 2606a22260aeSJia Liu } 2607a22260aeSJia Liu temp[0] = temp_sum; 2608a22260aeSJia Liu temp[1] = tempB[1] - tempA[1]; 2609a22260aeSJia Liu 2610a22260aeSJia Liu if ((temp[1] & 0x01) == 0) { 2611a22260aeSJia Liu temp[1] = 0x00; 2612a22260aeSJia Liu } else { 2613a22260aeSJia Liu temp[1] = ~0ull; 2614a22260aeSJia Liu } 2615a22260aeSJia Liu 2616a22260aeSJia Liu temp_sum = acc[0] + temp[0]; 2617a22260aeSJia Liu if (((uint64_t)temp_sum < (uint64_t)acc[0]) && 2618a22260aeSJia Liu ((uint64_t)temp_sum < (uint64_t)temp[0])) { 2619a22260aeSJia Liu acc[1] += 1; 2620a22260aeSJia Liu } 2621a22260aeSJia Liu acc[0] = temp_sum; 2622a22260aeSJia Liu acc[1] += temp[1]; 2623a22260aeSJia Liu 2624a22260aeSJia Liu env->active_tc.HI[ac] = acc[1]; 2625a22260aeSJia Liu env->active_tc.LO[ac] = acc[0]; 2626a22260aeSJia Liu } 2627a22260aeSJia Liu #endif 2628a22260aeSJia Liu 2629a22260aeSJia Liu #define MAQ_S_W(name, mov) \ 2630a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \ 2631a22260aeSJia Liu CPUMIPSState *env) \ 2632a22260aeSJia Liu { \ 2633a22260aeSJia Liu int16_t rsh, rth; \ 2634a22260aeSJia Liu int32_t tempA; \ 2635a22260aeSJia Liu int64_t tempL, acc; \ 2636a22260aeSJia Liu \ 2637a22260aeSJia Liu rsh = (rs >> mov) & MIPSDSP_LO; \ 2638a22260aeSJia Liu rth = (rt >> mov) & MIPSDSP_LO; \ 2639a22260aeSJia Liu tempA = mipsdsp_mul_q15_q15(ac, rsh, rth, env); \ 2640a22260aeSJia Liu acc = ((uint64_t)env->active_tc.HI[ac] << 32) | \ 2641a22260aeSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); \ 2642a22260aeSJia Liu tempL = (int64_t)tempA + acc; \ 2643a22260aeSJia Liu env->active_tc.HI[ac] = (target_long)(int32_t) \ 2644a22260aeSJia Liu ((tempL & MIPSDSP_LHI) >> 32); \ 2645a22260aeSJia Liu env->active_tc.LO[ac] = (target_long)(int32_t) \ 2646a22260aeSJia Liu (tempL & MIPSDSP_LLO); \ 2647a22260aeSJia Liu } 2648a22260aeSJia Liu 2649a22260aeSJia Liu MAQ_S_W(maq_s_w_phl, 16); 2650a22260aeSJia Liu MAQ_S_W(maq_s_w_phr, 0); 2651a22260aeSJia Liu 2652a22260aeSJia Liu #undef MAQ_S_W 2653a22260aeSJia Liu 2654a22260aeSJia Liu #define MAQ_SA_W(name, mov) \ 2655a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \ 2656a22260aeSJia Liu CPUMIPSState *env) \ 2657a22260aeSJia Liu { \ 2658a22260aeSJia Liu int16_t rsh, rth; \ 2659a22260aeSJia Liu int32_t tempA; \ 2660a22260aeSJia Liu \ 2661a22260aeSJia Liu rsh = (rs >> mov) & MIPSDSP_LO; \ 2662a22260aeSJia Liu rth = (rt >> mov) & MIPSDSP_LO; \ 2663a22260aeSJia Liu tempA = mipsdsp_mul_q15_q15(ac, rsh, rth, env); \ 2664a22260aeSJia Liu tempA = mipsdsp_sat32_acc_q31(ac, tempA, env); \ 2665a22260aeSJia Liu \ 2666a22260aeSJia Liu env->active_tc.HI[ac] = (target_long)(int32_t)(((int64_t)tempA & \ 2667a22260aeSJia Liu MIPSDSP_LHI) >> 32); \ 2668a22260aeSJia Liu env->active_tc.LO[ac] = (target_long)(int32_t)((int64_t)tempA & \ 2669a22260aeSJia Liu MIPSDSP_LLO); \ 2670a22260aeSJia Liu } 2671a22260aeSJia Liu 2672a22260aeSJia Liu MAQ_SA_W(maq_sa_w_phl, 16); 2673a22260aeSJia Liu MAQ_SA_W(maq_sa_w_phr, 0); 2674a22260aeSJia Liu 2675a22260aeSJia Liu #undef MAQ_SA_W 2676a22260aeSJia Liu 2677a22260aeSJia Liu #define MULQ_W(name, addvar) \ 2678a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt, \ 2679a22260aeSJia Liu CPUMIPSState *env) \ 2680a22260aeSJia Liu { \ 2681a345481bSPetar Jovanovic int32_t rs_t, rt_t; \ 2682a22260aeSJia Liu int32_t tempI; \ 2683a22260aeSJia Liu int64_t tempL; \ 2684a22260aeSJia Liu \ 2685a22260aeSJia Liu rs_t = rs & MIPSDSP_LLO; \ 2686a22260aeSJia Liu rt_t = rt & MIPSDSP_LLO; \ 2687a22260aeSJia Liu \ 2688a22260aeSJia Liu if ((rs_t == 0x80000000) && (rt_t == 0x80000000)) { \ 2689a22260aeSJia Liu tempL = 0x7FFFFFFF00000000ull; \ 2690a22260aeSJia Liu set_DSPControl_overflow_flag(1, 21, env); \ 2691a22260aeSJia Liu } else { \ 2692a22260aeSJia Liu tempL = ((int64_t)rs_t * (int64_t)rt_t) << 1; \ 2693a22260aeSJia Liu tempL += addvar; \ 2694a22260aeSJia Liu } \ 2695a22260aeSJia Liu tempI = (tempL & MIPSDSP_LHI) >> 32; \ 2696a22260aeSJia Liu \ 2697a22260aeSJia Liu return (target_long)(int32_t)tempI; \ 2698a22260aeSJia Liu } 2699a22260aeSJia Liu 2700a22260aeSJia Liu MULQ_W(mulq_s_w, 0); 2701a22260aeSJia Liu MULQ_W(mulq_rs_w, 0x80000000ull); 2702a22260aeSJia Liu 2703a22260aeSJia Liu #undef MULQ_W 2704a22260aeSJia Liu 2705a22260aeSJia Liu #if defined(TARGET_MIPS64) 2706a22260aeSJia Liu 2707a22260aeSJia Liu #define MAQ_S_W_QH(name, mov) \ 2708a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \ 2709a22260aeSJia Liu CPUMIPSState *env) \ 2710a22260aeSJia Liu { \ 2711a22260aeSJia Liu int16_t rs_t, rt_t; \ 2712a22260aeSJia Liu int32_t temp_mul; \ 2713a22260aeSJia Liu int64_t temp[2]; \ 2714a22260aeSJia Liu int64_t acc[2]; \ 2715a22260aeSJia Liu int64_t temp_sum; \ 2716a22260aeSJia Liu \ 2717a22260aeSJia Liu temp[0] = 0; \ 2718a22260aeSJia Liu temp[1] = 0; \ 2719a22260aeSJia Liu \ 2720a22260aeSJia Liu rs_t = (rs >> mov) & MIPSDSP_LO; \ 2721a22260aeSJia Liu rt_t = (rt >> mov) & MIPSDSP_LO; \ 2722a22260aeSJia Liu temp_mul = mipsdsp_mul_q15_q15(ac, rs_t, rt_t, env); \ 2723a22260aeSJia Liu \ 2724a22260aeSJia Liu temp[0] = (int64_t)temp_mul; \ 2725a22260aeSJia Liu if (temp[0] >= 0) { \ 2726a22260aeSJia Liu temp[1] = 0x00; \ 2727a22260aeSJia Liu } else { \ 2728a22260aeSJia Liu temp[1] = ~0ull; \ 2729a22260aeSJia Liu } \ 2730a22260aeSJia Liu \ 2731a22260aeSJia Liu acc[0] = env->active_tc.LO[ac]; \ 2732a22260aeSJia Liu acc[1] = env->active_tc.HI[ac]; \ 2733a22260aeSJia Liu \ 2734a22260aeSJia Liu temp_sum = acc[0] + temp[0]; \ 2735a22260aeSJia Liu if (((uint64_t)temp_sum < (uint64_t)acc[0]) && \ 2736a22260aeSJia Liu ((uint64_t)temp_sum < (uint64_t)temp[0])) { \ 2737a22260aeSJia Liu acc[1] += 1; \ 2738a22260aeSJia Liu } \ 2739a22260aeSJia Liu acc[0] = temp_sum; \ 2740a22260aeSJia Liu acc[1] += temp[1]; \ 2741a22260aeSJia Liu \ 2742a22260aeSJia Liu env->active_tc.HI[ac] = acc[1]; \ 2743a22260aeSJia Liu env->active_tc.LO[ac] = acc[0]; \ 2744a22260aeSJia Liu } 2745a22260aeSJia Liu 2746a22260aeSJia Liu MAQ_S_W_QH(maq_s_w_qhll, 48); 2747a22260aeSJia Liu MAQ_S_W_QH(maq_s_w_qhlr, 32); 2748a22260aeSJia Liu MAQ_S_W_QH(maq_s_w_qhrl, 16); 2749a22260aeSJia Liu MAQ_S_W_QH(maq_s_w_qhrr, 0); 2750a22260aeSJia Liu 2751a22260aeSJia Liu #undef MAQ_S_W_QH 2752a22260aeSJia Liu 2753a22260aeSJia Liu #define MAQ_SA_W(name, mov) \ 2754a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \ 2755a22260aeSJia Liu CPUMIPSState *env) \ 2756a22260aeSJia Liu { \ 2757a22260aeSJia Liu int16_t rs_t, rt_t; \ 2758a22260aeSJia Liu int32_t temp; \ 2759a22260aeSJia Liu int64_t acc[2]; \ 2760a22260aeSJia Liu \ 2761a22260aeSJia Liu rs_t = (rs >> mov) & MIPSDSP_LO; \ 2762a22260aeSJia Liu rt_t = (rt >> mov) & MIPSDSP_LO; \ 2763a22260aeSJia Liu temp = mipsdsp_mul_q15_q15(ac, rs_t, rt_t, env); \ 2764a22260aeSJia Liu temp = mipsdsp_sat32_acc_q31(ac, temp, env); \ 2765a22260aeSJia Liu \ 2766a22260aeSJia Liu acc[0] = (int64_t)(int32_t)temp; \ 2767a22260aeSJia Liu if (acc[0] >= 0) { \ 2768a22260aeSJia Liu acc[1] = 0x00; \ 2769a22260aeSJia Liu } else { \ 2770a22260aeSJia Liu acc[1] = ~0ull; \ 2771a22260aeSJia Liu } \ 2772a22260aeSJia Liu \ 2773a22260aeSJia Liu env->active_tc.HI[ac] = acc[1]; \ 2774a22260aeSJia Liu env->active_tc.LO[ac] = acc[0]; \ 2775a22260aeSJia Liu } 2776a22260aeSJia Liu 2777a22260aeSJia Liu MAQ_SA_W(maq_sa_w_qhll, 48); 2778a22260aeSJia Liu MAQ_SA_W(maq_sa_w_qhlr, 32); 2779a22260aeSJia Liu MAQ_SA_W(maq_sa_w_qhrl, 16); 2780a22260aeSJia Liu MAQ_SA_W(maq_sa_w_qhrr, 0); 2781a22260aeSJia Liu 2782a22260aeSJia Liu #undef MAQ_SA_W 2783a22260aeSJia Liu 2784a22260aeSJia Liu #define MAQ_S_L_PW(name, mov) \ 2785a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \ 2786a22260aeSJia Liu CPUMIPSState *env) \ 2787a22260aeSJia Liu { \ 2788a22260aeSJia Liu int32_t rs_t, rt_t; \ 2789a22260aeSJia Liu int64_t temp[2]; \ 2790a22260aeSJia Liu int64_t acc[2]; \ 2791a22260aeSJia Liu int64_t temp_sum; \ 2792a22260aeSJia Liu \ 2793a22260aeSJia Liu temp[0] = 0; \ 2794a22260aeSJia Liu temp[1] = 0; \ 2795a22260aeSJia Liu \ 2796a22260aeSJia Liu rs_t = (rs >> mov) & MIPSDSP_LLO; \ 2797a22260aeSJia Liu rt_t = (rt >> mov) & MIPSDSP_LLO; \ 2798a22260aeSJia Liu \ 2799a22260aeSJia Liu temp[0] = mipsdsp_mul_q31_q31(ac, rs_t, rt_t, env); \ 2800a22260aeSJia Liu if (temp[0] >= 0) { \ 2801a22260aeSJia Liu temp[1] = 0x00; \ 2802a22260aeSJia Liu } else { \ 2803a22260aeSJia Liu temp[1] = ~0ull; \ 2804a22260aeSJia Liu } \ 2805a22260aeSJia Liu \ 2806a22260aeSJia Liu acc[0] = env->active_tc.LO[ac]; \ 2807a22260aeSJia Liu acc[1] = env->active_tc.HI[ac]; \ 2808a22260aeSJia Liu \ 2809a22260aeSJia Liu temp_sum = acc[0] + temp[0]; \ 2810a22260aeSJia Liu if (((uint64_t)temp_sum < (uint64_t)acc[0]) && \ 2811a22260aeSJia Liu ((uint64_t)temp_sum < (uint64_t)temp[0])) { \ 2812a22260aeSJia Liu acc[1] += 1; \ 2813a22260aeSJia Liu } \ 2814a22260aeSJia Liu acc[0] = temp_sum; \ 2815a22260aeSJia Liu acc[1] += temp[1]; \ 2816a22260aeSJia Liu \ 2817a22260aeSJia Liu env->active_tc.HI[ac] = acc[1]; \ 2818a22260aeSJia Liu env->active_tc.LO[ac] = acc[0]; \ 2819a22260aeSJia Liu } 2820a22260aeSJia Liu 2821a22260aeSJia Liu MAQ_S_L_PW(maq_s_l_pwl, 32); 2822a22260aeSJia Liu MAQ_S_L_PW(maq_s_l_pwr, 0); 2823a22260aeSJia Liu 2824a22260aeSJia Liu #undef MAQ_S_L_PW 2825a22260aeSJia Liu 2826a22260aeSJia Liu #define DM_OPERATE(name, func, is_add, sigext) \ 2827a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \ 2828a22260aeSJia Liu CPUMIPSState *env) \ 2829a22260aeSJia Liu { \ 2830a22260aeSJia Liu int32_t rs1, rs0; \ 2831a22260aeSJia Liu int32_t rt1, rt0; \ 2832a22260aeSJia Liu int64_t tempBL[2], tempAL[2]; \ 2833a22260aeSJia Liu int64_t acc[2]; \ 2834a22260aeSJia Liu int64_t temp[2]; \ 2835a22260aeSJia Liu int64_t temp_sum; \ 2836a22260aeSJia Liu \ 2837a22260aeSJia Liu temp[0] = 0x00; \ 2838a22260aeSJia Liu temp[1] = 0x00; \ 2839a22260aeSJia Liu \ 2840a22260aeSJia Liu MIPSDSP_SPLIT64_32(rs, rs1, rs0); \ 2841a22260aeSJia Liu MIPSDSP_SPLIT64_32(rt, rt1, rt0); \ 2842a22260aeSJia Liu \ 2843a22260aeSJia Liu if (sigext) { \ 2844a22260aeSJia Liu tempBL[0] = (int64_t)mipsdsp_##func(rs1, rt1); \ 2845a22260aeSJia Liu tempAL[0] = (int64_t)mipsdsp_##func(rs0, rt0); \ 2846a22260aeSJia Liu \ 2847a22260aeSJia Liu if (tempBL[0] >= 0) { \ 2848a22260aeSJia Liu tempBL[1] = 0x0; \ 2849a22260aeSJia Liu } else { \ 2850a22260aeSJia Liu tempBL[1] = ~0ull; \ 2851a22260aeSJia Liu } \ 2852a22260aeSJia Liu \ 2853a22260aeSJia Liu if (tempAL[0] >= 0) { \ 2854a22260aeSJia Liu tempAL[1] = 0x0; \ 2855a22260aeSJia Liu } else { \ 2856a22260aeSJia Liu tempAL[1] = ~0ull; \ 2857a22260aeSJia Liu } \ 2858a22260aeSJia Liu } else { \ 2859a22260aeSJia Liu tempBL[0] = mipsdsp_##func(rs1, rt1); \ 2860a22260aeSJia Liu tempAL[0] = mipsdsp_##func(rs0, rt0); \ 2861a22260aeSJia Liu tempBL[1] = 0; \ 2862a22260aeSJia Liu tempAL[1] = 0; \ 2863a22260aeSJia Liu } \ 2864a22260aeSJia Liu \ 2865a22260aeSJia Liu acc[1] = env->active_tc.HI[ac]; \ 2866a22260aeSJia Liu acc[0] = env->active_tc.LO[ac]; \ 2867a22260aeSJia Liu \ 2868a22260aeSJia Liu temp_sum = tempBL[0] + tempAL[0]; \ 2869a22260aeSJia Liu if (((uint64_t)temp_sum < (uint64_t)tempBL[0]) && \ 2870a22260aeSJia Liu ((uint64_t)temp_sum < (uint64_t)tempAL[0])) { \ 2871a22260aeSJia Liu temp[1] += 1; \ 2872a22260aeSJia Liu } \ 2873a22260aeSJia Liu temp[0] = temp_sum; \ 2874a22260aeSJia Liu temp[1] += tempBL[1] + tempAL[1]; \ 2875a22260aeSJia Liu \ 2876a22260aeSJia Liu if (is_add) { \ 2877a22260aeSJia Liu temp_sum = acc[0] + temp[0]; \ 2878a22260aeSJia Liu if (((uint64_t)temp_sum < (uint64_t)acc[0]) && \ 2879a22260aeSJia Liu ((uint64_t)temp_sum < (uint64_t)temp[0])) { \ 2880a22260aeSJia Liu acc[1] += 1; \ 2881a22260aeSJia Liu } \ 2882a22260aeSJia Liu temp[0] = temp_sum; \ 2883a22260aeSJia Liu temp[1] = acc[1] + temp[1]; \ 2884a22260aeSJia Liu } else { \ 2885a22260aeSJia Liu temp_sum = acc[0] - temp[0]; \ 2886a22260aeSJia Liu if ((uint64_t)temp_sum > (uint64_t)acc[0]) { \ 2887a22260aeSJia Liu acc[1] -= 1; \ 2888a22260aeSJia Liu } \ 2889a22260aeSJia Liu temp[0] = temp_sum; \ 2890a22260aeSJia Liu temp[1] = acc[1] - temp[1]; \ 2891a22260aeSJia Liu } \ 2892a22260aeSJia Liu \ 2893a22260aeSJia Liu env->active_tc.HI[ac] = temp[1]; \ 2894a22260aeSJia Liu env->active_tc.LO[ac] = temp[0]; \ 2895a22260aeSJia Liu } 2896a22260aeSJia Liu 2897a22260aeSJia Liu DM_OPERATE(dmadd, mul_i32_i32, 1, 1); 2898a22260aeSJia Liu DM_OPERATE(dmaddu, mul_u32_u32, 1, 0); 2899a22260aeSJia Liu DM_OPERATE(dmsub, mul_i32_i32, 0, 1); 2900a22260aeSJia Liu DM_OPERATE(dmsubu, mul_u32_u32, 0, 0); 2901a22260aeSJia Liu #undef DM_OPERATE 2902a22260aeSJia Liu #endif 2903a22260aeSJia Liu 29041cb6686cSJia Liu /** DSP Bit/Manipulation Sub-class insns **/ 29051cb6686cSJia Liu target_ulong helper_bitrev(target_ulong rt) 29061cb6686cSJia Liu { 29071cb6686cSJia Liu int32_t temp; 29081cb6686cSJia Liu uint32_t rd; 29091cb6686cSJia Liu int i; 29101cb6686cSJia Liu 29111cb6686cSJia Liu temp = rt & MIPSDSP_LO; 29121cb6686cSJia Liu rd = 0; 29131cb6686cSJia Liu for (i = 0; i < 16; i++) { 29141cb6686cSJia Liu rd = (rd << 1) | (temp & 1); 29151cb6686cSJia Liu temp = temp >> 1; 29161cb6686cSJia Liu } 29171cb6686cSJia Liu 29181cb6686cSJia Liu return (target_ulong)rd; 29191cb6686cSJia Liu } 29201cb6686cSJia Liu 29211cb6686cSJia Liu #define BIT_INSV(name, posfilter, sizefilter, ret_type) \ 29221cb6686cSJia Liu target_ulong helper_##name(CPUMIPSState *env, target_ulong rs, \ 29231cb6686cSJia Liu target_ulong rt) \ 29241cb6686cSJia Liu { \ 29251cb6686cSJia Liu uint32_t pos, size, msb, lsb; \ 29261cb6686cSJia Liu target_ulong filter; \ 29271cb6686cSJia Liu target_ulong temp, temprs, temprt; \ 29281cb6686cSJia Liu target_ulong dspc; \ 29291cb6686cSJia Liu \ 29301cb6686cSJia Liu dspc = env->active_tc.DSPControl; \ 29311cb6686cSJia Liu \ 29321cb6686cSJia Liu pos = dspc & posfilter; \ 29331cb6686cSJia Liu size = (dspc >> 7) & sizefilter; \ 29341cb6686cSJia Liu \ 29351cb6686cSJia Liu msb = pos + size - 1; \ 29361cb6686cSJia Liu lsb = pos; \ 29371cb6686cSJia Liu \ 29381cb6686cSJia Liu if (lsb > msb || (msb > TARGET_LONG_BITS)) { \ 29391cb6686cSJia Liu return rt; \ 29401cb6686cSJia Liu } \ 29411cb6686cSJia Liu \ 29421cb6686cSJia Liu filter = ((int32_t)0x01 << size) - 1; \ 29431cb6686cSJia Liu filter = filter << pos; \ 294434f5606eSPetar Jovanovic temprs = (rs << pos) & filter; \ 29451cb6686cSJia Liu temprt = rt & ~filter; \ 29461cb6686cSJia Liu temp = temprs | temprt; \ 29471cb6686cSJia Liu \ 29481cb6686cSJia Liu return (target_long)(ret_type)temp; \ 29491cb6686cSJia Liu } 29501cb6686cSJia Liu 29511cb6686cSJia Liu BIT_INSV(insv, 0x1F, 0x1F, int32_t); 29521cb6686cSJia Liu #ifdef TARGET_MIPS64 29531cb6686cSJia Liu BIT_INSV(dinsv, 0x7F, 0x3F, target_long); 29541cb6686cSJia Liu #endif 29551cb6686cSJia Liu 29561cb6686cSJia Liu #undef BIT_INSV 29571cb6686cSJia Liu 29581cb6686cSJia Liu 295926690560SJia Liu /** DSP Compare-Pick Sub-class insns **/ 296026690560SJia Liu #define CMP_HAS_RET(name, func, split_num, filter, bit_size) \ 296126690560SJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt) \ 296226690560SJia Liu { \ 296326690560SJia Liu uint32_t rs_t, rt_t; \ 296426690560SJia Liu uint8_t cc; \ 296526690560SJia Liu uint32_t temp = 0; \ 296626690560SJia Liu int i; \ 296726690560SJia Liu \ 296826690560SJia Liu for (i = 0; i < split_num; i++) { \ 296926690560SJia Liu rs_t = (rs >> (bit_size * i)) & filter; \ 297026690560SJia Liu rt_t = (rt >> (bit_size * i)) & filter; \ 297126690560SJia Liu cc = mipsdsp_##func(rs_t, rt_t); \ 297226690560SJia Liu temp |= cc << i; \ 297326690560SJia Liu } \ 297426690560SJia Liu \ 297526690560SJia Liu return (target_ulong)temp; \ 297626690560SJia Liu } 297726690560SJia Liu 297826690560SJia Liu CMP_HAS_RET(cmpgu_eq_qb, cmpu_eq, 4, MIPSDSP_Q0, 8); 297926690560SJia Liu CMP_HAS_RET(cmpgu_lt_qb, cmpu_lt, 4, MIPSDSP_Q0, 8); 298026690560SJia Liu CMP_HAS_RET(cmpgu_le_qb, cmpu_le, 4, MIPSDSP_Q0, 8); 298126690560SJia Liu 298226690560SJia Liu #ifdef TARGET_MIPS64 298326690560SJia Liu CMP_HAS_RET(cmpgu_eq_ob, cmpu_eq, 8, MIPSDSP_Q0, 8); 298426690560SJia Liu CMP_HAS_RET(cmpgu_lt_ob, cmpu_lt, 8, MIPSDSP_Q0, 8); 298526690560SJia Liu CMP_HAS_RET(cmpgu_le_ob, cmpu_le, 8, MIPSDSP_Q0, 8); 298626690560SJia Liu #endif 298726690560SJia Liu 298826690560SJia Liu #undef CMP_HAS_RET 298926690560SJia Liu 299026690560SJia Liu 299126690560SJia Liu #define CMP_NO_RET(name, func, split_num, filter, bit_size) \ 299226690560SJia Liu void helper_##name(target_ulong rs, target_ulong rt, \ 299326690560SJia Liu CPUMIPSState *env) \ 299426690560SJia Liu { \ 299526690560SJia Liu int##bit_size##_t rs_t, rt_t; \ 299626690560SJia Liu int##bit_size##_t flag = 0; \ 299726690560SJia Liu int##bit_size##_t cc; \ 299826690560SJia Liu int i; \ 299926690560SJia Liu \ 300026690560SJia Liu for (i = 0; i < split_num; i++) { \ 300126690560SJia Liu rs_t = (rs >> (bit_size * i)) & filter; \ 300226690560SJia Liu rt_t = (rt >> (bit_size * i)) & filter; \ 300326690560SJia Liu \ 300426690560SJia Liu cc = mipsdsp_##func((int32_t)rs_t, (int32_t)rt_t); \ 300526690560SJia Liu flag |= cc << i; \ 300626690560SJia Liu } \ 300726690560SJia Liu \ 300826690560SJia Liu set_DSPControl_24(flag, split_num, env); \ 300926690560SJia Liu } 301026690560SJia Liu 301126690560SJia Liu CMP_NO_RET(cmpu_eq_qb, cmpu_eq, 4, MIPSDSP_Q0, 8); 301226690560SJia Liu CMP_NO_RET(cmpu_lt_qb, cmpu_lt, 4, MIPSDSP_Q0, 8); 301326690560SJia Liu CMP_NO_RET(cmpu_le_qb, cmpu_le, 4, MIPSDSP_Q0, 8); 301426690560SJia Liu 301526690560SJia Liu CMP_NO_RET(cmp_eq_ph, cmp_eq, 2, MIPSDSP_LO, 16); 301626690560SJia Liu CMP_NO_RET(cmp_lt_ph, cmp_lt, 2, MIPSDSP_LO, 16); 301726690560SJia Liu CMP_NO_RET(cmp_le_ph, cmp_le, 2, MIPSDSP_LO, 16); 301826690560SJia Liu 301926690560SJia Liu #ifdef TARGET_MIPS64 302026690560SJia Liu CMP_NO_RET(cmpu_eq_ob, cmpu_eq, 8, MIPSDSP_Q0, 8); 302126690560SJia Liu CMP_NO_RET(cmpu_lt_ob, cmpu_lt, 8, MIPSDSP_Q0, 8); 302226690560SJia Liu CMP_NO_RET(cmpu_le_ob, cmpu_le, 8, MIPSDSP_Q0, 8); 302326690560SJia Liu 302426690560SJia Liu CMP_NO_RET(cmp_eq_qh, cmp_eq, 4, MIPSDSP_LO, 16); 302526690560SJia Liu CMP_NO_RET(cmp_lt_qh, cmp_lt, 4, MIPSDSP_LO, 16); 302626690560SJia Liu CMP_NO_RET(cmp_le_qh, cmp_le, 4, MIPSDSP_LO, 16); 302726690560SJia Liu 302826690560SJia Liu CMP_NO_RET(cmp_eq_pw, cmp_eq, 2, MIPSDSP_LLO, 32); 302926690560SJia Liu CMP_NO_RET(cmp_lt_pw, cmp_lt, 2, MIPSDSP_LLO, 32); 303026690560SJia Liu CMP_NO_RET(cmp_le_pw, cmp_le, 2, MIPSDSP_LLO, 32); 303126690560SJia Liu #endif 303226690560SJia Liu #undef CMP_NO_RET 303326690560SJia Liu 303426690560SJia Liu #if defined(TARGET_MIPS64) 303526690560SJia Liu 303626690560SJia Liu #define CMPGDU_OB(name) \ 303726690560SJia Liu target_ulong helper_cmpgdu_##name##_ob(target_ulong rs, target_ulong rt, \ 303826690560SJia Liu CPUMIPSState *env) \ 303926690560SJia Liu { \ 304026690560SJia Liu int i; \ 304126690560SJia Liu uint8_t rs_t, rt_t; \ 304226690560SJia Liu uint32_t cond; \ 304326690560SJia Liu \ 304426690560SJia Liu cond = 0; \ 304526690560SJia Liu \ 304626690560SJia Liu for (i = 0; i < 8; i++) { \ 304726690560SJia Liu rs_t = (rs >> (8 * i)) & MIPSDSP_Q0; \ 304826690560SJia Liu rt_t = (rt >> (8 * i)) & MIPSDSP_Q0; \ 304926690560SJia Liu \ 305026690560SJia Liu if (mipsdsp_cmpu_##name(rs_t, rt_t)) { \ 305126690560SJia Liu cond |= 0x01 << i; \ 305226690560SJia Liu } \ 305326690560SJia Liu } \ 305426690560SJia Liu \ 305526690560SJia Liu set_DSPControl_24(cond, 8, env); \ 305626690560SJia Liu \ 305726690560SJia Liu return (uint64_t)cond; \ 305826690560SJia Liu } 305926690560SJia Liu 306026690560SJia Liu CMPGDU_OB(eq) 306126690560SJia Liu CMPGDU_OB(lt) 306226690560SJia Liu CMPGDU_OB(le) 306326690560SJia Liu #undef CMPGDU_OB 306426690560SJia Liu #endif 306526690560SJia Liu 306626690560SJia Liu #define PICK_INSN(name, split_num, filter, bit_size, ret32bit) \ 306726690560SJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt, \ 306826690560SJia Liu CPUMIPSState *env) \ 306926690560SJia Liu { \ 307026690560SJia Liu uint32_t rs_t, rt_t; \ 307126690560SJia Liu uint32_t cc; \ 307226690560SJia Liu target_ulong dsp; \ 307326690560SJia Liu int i; \ 307426690560SJia Liu target_ulong result = 0; \ 307526690560SJia Liu \ 307626690560SJia Liu dsp = env->active_tc.DSPControl; \ 307726690560SJia Liu for (i = 0; i < split_num; i++) { \ 307826690560SJia Liu rs_t = (rs >> (bit_size * i)) & filter; \ 307926690560SJia Liu rt_t = (rt >> (bit_size * i)) & filter; \ 308026690560SJia Liu cc = (dsp >> (24 + i)) & 0x01; \ 308126690560SJia Liu cc = cc == 1 ? rs_t : rt_t; \ 308226690560SJia Liu \ 308326690560SJia Liu result |= (target_ulong)cc << (bit_size * i); \ 308426690560SJia Liu } \ 308526690560SJia Liu \ 308626690560SJia Liu if (ret32bit) { \ 308726690560SJia Liu result = (target_long)(int32_t)(result & MIPSDSP_LLO); \ 308826690560SJia Liu } \ 308926690560SJia Liu \ 309026690560SJia Liu return result; \ 309126690560SJia Liu } 309226690560SJia Liu 309326690560SJia Liu PICK_INSN(pick_qb, 4, MIPSDSP_Q0, 8, 1); 309426690560SJia Liu PICK_INSN(pick_ph, 2, MIPSDSP_LO, 16, 1); 309526690560SJia Liu 309626690560SJia Liu #ifdef TARGET_MIPS64 309726690560SJia Liu PICK_INSN(pick_ob, 8, MIPSDSP_Q0, 8, 0); 309826690560SJia Liu PICK_INSN(pick_qh, 4, MIPSDSP_LO, 16, 0); 309926690560SJia Liu PICK_INSN(pick_pw, 2, MIPSDSP_LLO, 32, 0); 310026690560SJia Liu #endif 310126690560SJia Liu #undef PICK_INSN 310226690560SJia Liu 310326690560SJia Liu target_ulong helper_packrl_ph(target_ulong rs, target_ulong rt) 310426690560SJia Liu { 310526690560SJia Liu uint32_t rsl, rth; 310626690560SJia Liu 310726690560SJia Liu rsl = rs & MIPSDSP_LO; 310826690560SJia Liu rth = (rt & MIPSDSP_HI) >> 16; 310926690560SJia Liu 311026690560SJia Liu return (target_long)(int32_t)((rsl << 16) | rth); 311126690560SJia Liu } 311226690560SJia Liu 311326690560SJia Liu #if defined(TARGET_MIPS64) 311426690560SJia Liu target_ulong helper_packrl_pw(target_ulong rs, target_ulong rt) 311526690560SJia Liu { 311626690560SJia Liu uint32_t rs0, rt1; 311726690560SJia Liu 311826690560SJia Liu rs0 = rs & MIPSDSP_LLO; 311926690560SJia Liu rt1 = (rt >> 32) & MIPSDSP_LLO; 312026690560SJia Liu 312126690560SJia Liu return ((uint64_t)rs0 << 32) | (uint64_t)rt1; 312226690560SJia Liu } 312326690560SJia Liu #endif 312426690560SJia Liu 3125b53371edSJia Liu /** DSP Accumulator and DSPControl Access Sub-class insns **/ 3126b53371edSJia Liu target_ulong helper_extr_w(target_ulong ac, target_ulong shift, 3127b53371edSJia Liu CPUMIPSState *env) 3128b53371edSJia Liu { 3129b53371edSJia Liu int32_t tempI; 3130b53371edSJia Liu int64_t tempDL[2]; 3131b53371edSJia Liu 3132b8abbbe8SPetar Jovanovic shift = shift & 0x1F; 3133b53371edSJia Liu 3134b53371edSJia Liu mipsdsp_rndrashift_short_acc(tempDL, ac, shift, env); 3135b53371edSJia Liu if ((tempDL[1] != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) && 3136b53371edSJia Liu (tempDL[1] != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) { 3137b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3138b53371edSJia Liu } 3139b53371edSJia Liu 3140b53371edSJia Liu tempI = (tempDL[0] >> 1) & MIPSDSP_LLO; 3141b53371edSJia Liu 3142b53371edSJia Liu tempDL[0] += 1; 3143b53371edSJia Liu if (tempDL[0] == 0) { 3144b53371edSJia Liu tempDL[1] += 1; 3145b53371edSJia Liu } 3146b53371edSJia Liu 31478b758d05SPetar Jovanovic if (((tempDL[1] & 0x01) != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) && 31488b758d05SPetar Jovanovic ((tempDL[1] & 0x01) != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) { 3149b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3150b53371edSJia Liu } 3151b53371edSJia Liu 3152b53371edSJia Liu return (target_long)tempI; 3153b53371edSJia Liu } 3154b53371edSJia Liu 3155b53371edSJia Liu target_ulong helper_extr_r_w(target_ulong ac, target_ulong shift, 3156b53371edSJia Liu CPUMIPSState *env) 3157b53371edSJia Liu { 3158b53371edSJia Liu int64_t tempDL[2]; 3159b53371edSJia Liu 3160b8abbbe8SPetar Jovanovic shift = shift & 0x1F; 3161b53371edSJia Liu 3162b53371edSJia Liu mipsdsp_rndrashift_short_acc(tempDL, ac, shift, env); 3163b53371edSJia Liu if ((tempDL[1] != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) && 3164b53371edSJia Liu (tempDL[1] != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) { 3165b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3166b53371edSJia Liu } 3167b53371edSJia Liu 3168b53371edSJia Liu tempDL[0] += 1; 3169b53371edSJia Liu if (tempDL[0] == 0) { 3170b53371edSJia Liu tempDL[1] += 1; 3171b53371edSJia Liu } 3172b53371edSJia Liu 31738b758d05SPetar Jovanovic if (((tempDL[1] & 0x01) != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) && 31748b758d05SPetar Jovanovic ((tempDL[1] & 0x01) != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) { 3175b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3176b53371edSJia Liu } 3177b53371edSJia Liu 3178b53371edSJia Liu return (target_long)(int32_t)(tempDL[0] >> 1); 3179b53371edSJia Liu } 3180b53371edSJia Liu 3181b53371edSJia Liu target_ulong helper_extr_rs_w(target_ulong ac, target_ulong shift, 3182b53371edSJia Liu CPUMIPSState *env) 3183b53371edSJia Liu { 3184b53371edSJia Liu int32_t tempI, temp64; 3185b53371edSJia Liu int64_t tempDL[2]; 3186b53371edSJia Liu 3187b8abbbe8SPetar Jovanovic shift = shift & 0x1F; 3188b53371edSJia Liu 3189b53371edSJia Liu mipsdsp_rndrashift_short_acc(tempDL, ac, shift, env); 3190b53371edSJia Liu if ((tempDL[1] != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) && 3191b53371edSJia Liu (tempDL[1] != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) { 3192b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3193b53371edSJia Liu } 3194b53371edSJia Liu tempDL[0] += 1; 3195b53371edSJia Liu if (tempDL[0] == 0) { 3196b53371edSJia Liu tempDL[1] += 1; 3197b53371edSJia Liu } 3198b53371edSJia Liu tempI = tempDL[0] >> 1; 3199b53371edSJia Liu 32008b758d05SPetar Jovanovic if (((tempDL[1] & 0x01) != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) && 32018b758d05SPetar Jovanovic ((tempDL[1] & 0x01) != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) { 32028b758d05SPetar Jovanovic temp64 = tempDL[1] & 0x01; 3203b53371edSJia Liu if (temp64 == 0) { 3204b53371edSJia Liu tempI = 0x7FFFFFFF; 3205b53371edSJia Liu } else { 3206b53371edSJia Liu tempI = 0x80000000; 3207b53371edSJia Liu } 3208b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3209b53371edSJia Liu } 3210b53371edSJia Liu 3211b53371edSJia Liu return (target_long)tempI; 3212b53371edSJia Liu } 3213b53371edSJia Liu 3214b53371edSJia Liu #if defined(TARGET_MIPS64) 3215b53371edSJia Liu target_ulong helper_dextr_w(target_ulong ac, target_ulong shift, 3216b53371edSJia Liu CPUMIPSState *env) 3217b53371edSJia Liu { 3218b53371edSJia Liu uint64_t temp[3]; 3219b53371edSJia Liu 3220b53371edSJia Liu shift = shift & 0x3F; 3221b53371edSJia Liu 3222b53371edSJia Liu mipsdsp_rndrashift_acc(temp, ac, shift, env); 3223b53371edSJia Liu 3224b53371edSJia Liu return (int64_t)(int32_t)(temp[0] >> 1); 3225b53371edSJia Liu } 3226b53371edSJia Liu 3227b53371edSJia Liu target_ulong helper_dextr_r_w(target_ulong ac, target_ulong shift, 3228b53371edSJia Liu CPUMIPSState *env) 3229b53371edSJia Liu { 3230b53371edSJia Liu uint64_t temp[3]; 3231b53371edSJia Liu uint32_t temp128; 3232b53371edSJia Liu 3233b53371edSJia Liu shift = shift & 0x3F; 3234b53371edSJia Liu mipsdsp_rndrashift_acc(temp, ac, shift, env); 3235b53371edSJia Liu 3236b53371edSJia Liu temp[0] += 1; 3237b53371edSJia Liu if (temp[0] == 0) { 3238b53371edSJia Liu temp[1] += 1; 3239b53371edSJia Liu if (temp[1] == 0) { 3240b53371edSJia Liu temp[2] += 1; 3241b53371edSJia Liu } 3242b53371edSJia Liu } 3243b53371edSJia Liu 3244b53371edSJia Liu temp128 = temp[2] & 0x01; 3245b53371edSJia Liu 3246b53371edSJia Liu if ((temp128 != 0 || temp[1] != 0) && 3247b53371edSJia Liu (temp128 != 1 || temp[1] != ~0ull)) { 3248b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3249b53371edSJia Liu } 3250b53371edSJia Liu 3251b53371edSJia Liu return (int64_t)(int32_t)(temp[0] >> 1); 3252b53371edSJia Liu } 3253b53371edSJia Liu 3254b53371edSJia Liu target_ulong helper_dextr_rs_w(target_ulong ac, target_ulong shift, 3255b53371edSJia Liu CPUMIPSState *env) 3256b53371edSJia Liu { 3257b53371edSJia Liu uint64_t temp[3]; 3258b53371edSJia Liu uint32_t temp128; 3259b53371edSJia Liu 3260b53371edSJia Liu shift = shift & 0x3F; 3261b53371edSJia Liu mipsdsp_rndrashift_acc(temp, ac, shift, env); 3262b53371edSJia Liu 3263b53371edSJia Liu temp[0] += 1; 3264b53371edSJia Liu if (temp[0] == 0) { 3265b53371edSJia Liu temp[1] += 1; 3266b53371edSJia Liu if (temp[1] == 0) { 3267b53371edSJia Liu temp[2] += 1; 3268b53371edSJia Liu } 3269b53371edSJia Liu } 3270b53371edSJia Liu 3271b53371edSJia Liu temp128 = temp[2] & 0x01; 3272b53371edSJia Liu 3273b53371edSJia Liu if ((temp128 != 0 || temp[1] != 0) && 3274b53371edSJia Liu (temp128 != 1 || temp[1] != ~0ull)) { 3275b53371edSJia Liu if (temp128 == 0) { 3276b53371edSJia Liu temp[0] = 0x0FFFFFFFF; 3277b53371edSJia Liu } else { 32781cfd981fSBlue Swirl temp[0] = 0x0100000000ULL; 3279b53371edSJia Liu } 3280b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3281b53371edSJia Liu } 3282b53371edSJia Liu 3283b53371edSJia Liu return (int64_t)(int32_t)(temp[0] >> 1); 3284b53371edSJia Liu } 3285b53371edSJia Liu 3286b53371edSJia Liu target_ulong helper_dextr_l(target_ulong ac, target_ulong shift, 3287b53371edSJia Liu CPUMIPSState *env) 3288b53371edSJia Liu { 3289b53371edSJia Liu uint64_t temp[3]; 3290b53371edSJia Liu target_ulong result; 3291b53371edSJia Liu 3292b53371edSJia Liu shift = shift & 0x3F; 3293b53371edSJia Liu 3294b53371edSJia Liu mipsdsp_rndrashift_acc(temp, ac, shift, env); 3295b53371edSJia Liu result = (temp[1] << 63) | (temp[0] >> 1); 3296b53371edSJia Liu 3297b53371edSJia Liu return result; 3298b53371edSJia Liu } 3299b53371edSJia Liu 3300b53371edSJia Liu target_ulong helper_dextr_r_l(target_ulong ac, target_ulong shift, 3301b53371edSJia Liu CPUMIPSState *env) 3302b53371edSJia Liu { 3303b53371edSJia Liu uint64_t temp[3]; 3304b53371edSJia Liu uint32_t temp128; 3305b53371edSJia Liu target_ulong result; 3306b53371edSJia Liu 3307b53371edSJia Liu shift = shift & 0x3F; 3308b53371edSJia Liu mipsdsp_rndrashift_acc(temp, ac, shift, env); 3309b53371edSJia Liu 3310b53371edSJia Liu temp[0] += 1; 3311b53371edSJia Liu if (temp[0] == 0) { 3312b53371edSJia Liu temp[1] += 1; 3313b53371edSJia Liu if (temp[1] == 0) { 3314b53371edSJia Liu temp[2] += 1; 3315b53371edSJia Liu } 3316b53371edSJia Liu } 3317b53371edSJia Liu 3318b53371edSJia Liu temp128 = temp[2] & 0x01; 3319b53371edSJia Liu 3320b53371edSJia Liu if ((temp128 != 0 || temp[1] != 0) && 3321b53371edSJia Liu (temp128 != 1 || temp[1] != ~0ull)) { 3322b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3323b53371edSJia Liu } 3324b53371edSJia Liu 3325b53371edSJia Liu result = (temp[1] << 63) | (temp[0] >> 1); 3326b53371edSJia Liu 3327b53371edSJia Liu return result; 3328b53371edSJia Liu } 3329b53371edSJia Liu 3330b53371edSJia Liu target_ulong helper_dextr_rs_l(target_ulong ac, target_ulong shift, 3331b53371edSJia Liu CPUMIPSState *env) 3332b53371edSJia Liu { 3333b53371edSJia Liu uint64_t temp[3]; 3334b53371edSJia Liu uint32_t temp128; 3335b53371edSJia Liu target_ulong result; 3336b53371edSJia Liu 3337b53371edSJia Liu shift = shift & 0x3F; 3338b53371edSJia Liu mipsdsp_rndrashift_acc(temp, ac, shift, env); 3339b53371edSJia Liu 3340b53371edSJia Liu temp[0] += 1; 3341b53371edSJia Liu if (temp[0] == 0) { 3342b53371edSJia Liu temp[1] += 1; 3343b53371edSJia Liu if (temp[1] == 0) { 3344b53371edSJia Liu temp[2] += 1; 3345b53371edSJia Liu } 3346b53371edSJia Liu } 3347b53371edSJia Liu 3348b53371edSJia Liu temp128 = temp[2] & 0x01; 3349b53371edSJia Liu 3350b53371edSJia Liu if ((temp128 != 0 || temp[1] != 0) && 3351b53371edSJia Liu (temp128 != 1 || temp[1] != ~0ull)) { 3352b53371edSJia Liu if (temp128 == 0) { 3353b53371edSJia Liu temp[1] &= ~0x00ull - 1; 3354b53371edSJia Liu temp[0] |= ~0x00ull - 1; 3355b53371edSJia Liu } else { 3356b53371edSJia Liu temp[1] |= 0x01; 3357b53371edSJia Liu temp[0] &= 0x01; 3358b53371edSJia Liu } 3359b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3360b53371edSJia Liu } 3361b53371edSJia Liu result = (temp[1] << 63) | (temp[0] >> 1); 3362b53371edSJia Liu 3363b53371edSJia Liu return result; 3364b53371edSJia Liu } 3365b53371edSJia Liu #endif 3366b53371edSJia Liu 3367b53371edSJia Liu target_ulong helper_extr_s_h(target_ulong ac, target_ulong shift, 3368b53371edSJia Liu CPUMIPSState *env) 3369b53371edSJia Liu { 3370b8abbbe8SPetar Jovanovic int64_t temp, acc; 3371b53371edSJia Liu 3372b8abbbe8SPetar Jovanovic shift = shift & 0x1F; 3373b53371edSJia Liu 3374b8abbbe8SPetar Jovanovic acc = ((int64_t)env->active_tc.HI[ac] << 32) | 3375b8abbbe8SPetar Jovanovic ((int64_t)env->active_tc.LO[ac] & 0xFFFFFFFF); 3376b8abbbe8SPetar Jovanovic 3377b8abbbe8SPetar Jovanovic temp = acc >> shift; 3378b8abbbe8SPetar Jovanovic 3379b53371edSJia Liu if (temp > (int64_t)0x7FFF) { 3380b53371edSJia Liu temp = 0x00007FFF; 3381b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 33821cfd981fSBlue Swirl } else if (temp < (int64_t)0xFFFFFFFFFFFF8000ULL) { 3383b53371edSJia Liu temp = 0xFFFF8000; 3384b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3385b53371edSJia Liu } 3386b53371edSJia Liu 3387b53371edSJia Liu return (target_long)(int32_t)(temp & 0xFFFFFFFF); 3388b53371edSJia Liu } 3389b53371edSJia Liu 3390b53371edSJia Liu 3391b53371edSJia Liu #if defined(TARGET_MIPS64) 3392b53371edSJia Liu target_ulong helper_dextr_s_h(target_ulong ac, target_ulong shift, 3393b53371edSJia Liu CPUMIPSState *env) 3394b53371edSJia Liu { 3395b53371edSJia Liu int64_t temp[2]; 3396b53371edSJia Liu uint32_t temp127; 3397b53371edSJia Liu 3398b53371edSJia Liu shift = shift & 0x1F; 3399b53371edSJia Liu 3400b53371edSJia Liu mipsdsp_rashift_acc((uint64_t *)temp, ac, shift, env); 3401b53371edSJia Liu 3402b53371edSJia Liu temp127 = (temp[1] >> 63) & 0x01; 3403b53371edSJia Liu 3404b53371edSJia Liu if ((temp127 == 0) && (temp[1] > 0 || temp[0] > 32767)) { 3405b53371edSJia Liu temp[0] &= 0xFFFF0000; 3406b53371edSJia Liu temp[0] |= 0x00007FFF; 3407b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3408b53371edSJia Liu } else if ((temp127 == 1) && 3409b53371edSJia Liu (temp[1] < 0xFFFFFFFFFFFFFFFFll 3410b53371edSJia Liu || temp[0] < 0xFFFFFFFFFFFF1000ll)) { 3411b53371edSJia Liu temp[0] &= 0xFFFF0000; 3412b53371edSJia Liu temp[0] |= 0x00008000; 3413b53371edSJia Liu set_DSPControl_overflow_flag(1, 23, env); 3414b53371edSJia Liu } 3415b53371edSJia Liu 3416b53371edSJia Liu return (int64_t)(int16_t)(temp[0] & MIPSDSP_LO); 3417b53371edSJia Liu } 3418b53371edSJia Liu 3419b53371edSJia Liu #endif 3420b53371edSJia Liu 3421b53371edSJia Liu target_ulong helper_extp(target_ulong ac, target_ulong size, CPUMIPSState *env) 3422b53371edSJia Liu { 3423b53371edSJia Liu int32_t start_pos; 3424b53371edSJia Liu int sub; 3425b53371edSJia Liu uint32_t temp; 3426b53371edSJia Liu uint64_t acc; 3427b53371edSJia Liu 3428b53371edSJia Liu size = size & 0x1F; 3429b53371edSJia Liu 3430b53371edSJia Liu temp = 0; 3431b53371edSJia Liu start_pos = get_DSPControl_pos(env); 3432b53371edSJia Liu sub = start_pos - (size + 1); 3433b53371edSJia Liu if (sub >= -1) { 3434b53371edSJia Liu acc = ((uint64_t)env->active_tc.HI[ac] << 32) | 3435b53371edSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); 3436b53371edSJia Liu temp = (acc >> (start_pos - size)) & 3437b53371edSJia Liu (((uint32_t)0x01 << (size + 1)) - 1); 3438b53371edSJia Liu set_DSPControl_efi(0, env); 3439b53371edSJia Liu } else { 3440b53371edSJia Liu set_DSPControl_efi(1, env); 3441b53371edSJia Liu } 3442b53371edSJia Liu 3443b53371edSJia Liu return (target_ulong)temp; 3444b53371edSJia Liu } 3445b53371edSJia Liu 3446b53371edSJia Liu target_ulong helper_extpdp(target_ulong ac, target_ulong size, 3447b53371edSJia Liu CPUMIPSState *env) 3448b53371edSJia Liu { 3449b53371edSJia Liu int32_t start_pos; 3450b53371edSJia Liu int sub; 3451b53371edSJia Liu uint32_t temp; 3452b53371edSJia Liu uint64_t acc; 3453b53371edSJia Liu 3454b53371edSJia Liu size = size & 0x1F; 3455b53371edSJia Liu temp = 0; 3456b53371edSJia Liu start_pos = get_DSPControl_pos(env); 3457b53371edSJia Liu sub = start_pos - (size + 1); 3458b53371edSJia Liu if (sub >= -1) { 3459b53371edSJia Liu acc = ((uint64_t)env->active_tc.HI[ac] << 32) | 3460b53371edSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); 3461b53371edSJia Liu temp = (acc >> (start_pos - size)) & 3462b53371edSJia Liu (((uint32_t)0x01 << (size + 1)) - 1); 3463b53371edSJia Liu 3464b53371edSJia Liu set_DSPControl_pos(start_pos - (size + 1), env); 3465b53371edSJia Liu set_DSPControl_efi(0, env); 3466b53371edSJia Liu } else { 3467b53371edSJia Liu set_DSPControl_efi(1, env); 3468b53371edSJia Liu } 3469b53371edSJia Liu 3470b53371edSJia Liu return (target_ulong)temp; 3471b53371edSJia Liu } 3472b53371edSJia Liu 3473b53371edSJia Liu 3474b53371edSJia Liu #if defined(TARGET_MIPS64) 3475b53371edSJia Liu target_ulong helper_dextp(target_ulong ac, target_ulong size, CPUMIPSState *env) 3476b53371edSJia Liu { 3477b53371edSJia Liu int start_pos; 3478b53371edSJia Liu int len; 3479b53371edSJia Liu int sub; 3480b53371edSJia Liu uint64_t tempB, tempA; 3481b53371edSJia Liu uint64_t temp; 3482b53371edSJia Liu 3483b53371edSJia Liu temp = 0; 3484b53371edSJia Liu 3485b53371edSJia Liu size = size & 0x3F; 3486b53371edSJia Liu start_pos = get_DSPControl_pos(env); 3487b53371edSJia Liu len = start_pos - size; 3488b53371edSJia Liu tempB = env->active_tc.HI[ac]; 3489b53371edSJia Liu tempA = env->active_tc.LO[ac]; 3490b53371edSJia Liu 3491b53371edSJia Liu sub = start_pos - (size + 1); 3492b53371edSJia Liu 3493b53371edSJia Liu if (sub >= -1) { 3494b53371edSJia Liu temp = (tempB << (64 - len)) | (tempA >> len); 3495b53371edSJia Liu temp = temp & ((0x01 << (size + 1)) - 1); 3496b53371edSJia Liu set_DSPControl_efi(0, env); 3497b53371edSJia Liu } else { 3498b53371edSJia Liu set_DSPControl_efi(1, env); 3499b53371edSJia Liu } 3500b53371edSJia Liu 3501b53371edSJia Liu return temp; 3502b53371edSJia Liu } 3503b53371edSJia Liu 3504b53371edSJia Liu target_ulong helper_dextpdp(target_ulong ac, target_ulong size, 3505b53371edSJia Liu CPUMIPSState *env) 3506b53371edSJia Liu { 3507b53371edSJia Liu int start_pos; 3508b53371edSJia Liu int len; 3509b53371edSJia Liu int sub; 3510b53371edSJia Liu uint64_t tempB, tempA; 3511b53371edSJia Liu uint64_t temp; 3512b53371edSJia Liu 3513b53371edSJia Liu temp = 0; 3514b53371edSJia Liu size = size & 0x3F; 3515b53371edSJia Liu start_pos = get_DSPControl_pos(env); 3516b53371edSJia Liu len = start_pos - size; 3517b53371edSJia Liu tempB = env->active_tc.HI[ac]; 3518b53371edSJia Liu tempA = env->active_tc.LO[ac]; 3519b53371edSJia Liu 3520b53371edSJia Liu sub = start_pos - (size + 1); 3521b53371edSJia Liu 3522b53371edSJia Liu if (sub >= -1) { 3523b53371edSJia Liu temp = (tempB << (64 - len)) | (tempA >> len); 3524b53371edSJia Liu temp = temp & ((0x01 << (size + 1)) - 1); 3525b53371edSJia Liu set_DSPControl_pos(sub, env); 3526b53371edSJia Liu set_DSPControl_efi(0, env); 3527b53371edSJia Liu } else { 3528b53371edSJia Liu set_DSPControl_efi(1, env); 3529b53371edSJia Liu } 3530b53371edSJia Liu 3531b53371edSJia Liu return temp; 3532b53371edSJia Liu } 3533b53371edSJia Liu 3534b53371edSJia Liu #endif 3535b53371edSJia Liu 3536b53371edSJia Liu void helper_shilo(target_ulong ac, target_ulong rs, CPUMIPSState *env) 3537b53371edSJia Liu { 3538b53371edSJia Liu int8_t rs5_0; 3539b53371edSJia Liu uint64_t temp, acc; 3540b53371edSJia Liu 3541b53371edSJia Liu rs5_0 = rs & 0x3F; 3542b53371edSJia Liu rs5_0 = (int8_t)(rs5_0 << 2) >> 2; 354319e6c50dSPetar Jovanovic 354419e6c50dSPetar Jovanovic if (unlikely(rs5_0 == 0)) { 354519e6c50dSPetar Jovanovic return; 354619e6c50dSPetar Jovanovic } 354719e6c50dSPetar Jovanovic 3548b53371edSJia Liu acc = (((uint64_t)env->active_tc.HI[ac] << 32) & MIPSDSP_LHI) | 3549b53371edSJia Liu ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); 355019e6c50dSPetar Jovanovic 3551b53371edSJia Liu if (rs5_0 > 0) { 3552b53371edSJia Liu temp = acc >> rs5_0; 3553b53371edSJia Liu } else { 355419e6c50dSPetar Jovanovic temp = acc << -rs5_0; 3555b53371edSJia Liu } 3556b53371edSJia Liu 3557b53371edSJia Liu env->active_tc.HI[ac] = (target_ulong)(int32_t)((temp & MIPSDSP_LHI) >> 32); 3558b53371edSJia Liu env->active_tc.LO[ac] = (target_ulong)(int32_t)(temp & MIPSDSP_LLO); 3559b53371edSJia Liu } 3560b53371edSJia Liu 3561b53371edSJia Liu #if defined(TARGET_MIPS64) 3562b53371edSJia Liu void helper_dshilo(target_ulong shift, target_ulong ac, CPUMIPSState *env) 3563b53371edSJia Liu { 3564b53371edSJia Liu int8_t shift_t; 3565b53371edSJia Liu uint64_t tempB, tempA; 3566b53371edSJia Liu 3567b53371edSJia Liu shift_t = (int8_t)(shift << 1) >> 1; 3568b53371edSJia Liu 3569b53371edSJia Liu tempB = env->active_tc.HI[ac]; 3570b53371edSJia Liu tempA = env->active_tc.LO[ac]; 3571b53371edSJia Liu 3572b53371edSJia Liu if (shift_t != 0) { 3573b53371edSJia Liu if (shift_t >= 0) { 3574b53371edSJia Liu tempA = (tempB << (64 - shift_t)) | (tempA >> shift_t); 3575b53371edSJia Liu tempB = tempB >> shift_t; 3576b53371edSJia Liu } else { 3577b53371edSJia Liu shift_t = -shift_t; 3578b53371edSJia Liu tempB = (tempB << shift_t) | (tempA >> (64 - shift_t)); 3579b53371edSJia Liu tempA = tempA << shift_t; 3580b53371edSJia Liu } 3581b53371edSJia Liu } 3582b53371edSJia Liu 3583b53371edSJia Liu env->active_tc.HI[ac] = tempB; 3584b53371edSJia Liu env->active_tc.LO[ac] = tempA; 3585b53371edSJia Liu } 3586b53371edSJia Liu 3587b53371edSJia Liu #endif 3588b53371edSJia Liu void helper_mthlip(target_ulong ac, target_ulong rs, CPUMIPSState *env) 3589b53371edSJia Liu { 3590b53371edSJia Liu int32_t tempA, tempB, pos; 3591b53371edSJia Liu 3592b53371edSJia Liu tempA = rs; 3593b53371edSJia Liu tempB = env->active_tc.LO[ac]; 3594b53371edSJia Liu env->active_tc.HI[ac] = (target_long)tempB; 3595b53371edSJia Liu env->active_tc.LO[ac] = (target_long)tempA; 3596b53371edSJia Liu pos = get_DSPControl_pos(env); 3597b53371edSJia Liu 3598b53371edSJia Liu if (pos > 32) { 3599b53371edSJia Liu return; 3600b53371edSJia Liu } else { 3601b53371edSJia Liu set_DSPControl_pos(pos + 32, env); 3602b53371edSJia Liu } 3603b53371edSJia Liu } 3604b53371edSJia Liu 3605b53371edSJia Liu #if defined(TARGET_MIPS64) 3606b53371edSJia Liu void helper_dmthlip(target_ulong rs, target_ulong ac, CPUMIPSState *env) 3607b53371edSJia Liu { 3608b53371edSJia Liu uint8_t ac_t; 3609b53371edSJia Liu uint8_t pos; 3610b53371edSJia Liu uint64_t tempB, tempA; 3611b53371edSJia Liu 3612b53371edSJia Liu ac_t = ac & 0x3; 3613b53371edSJia Liu 3614b53371edSJia Liu tempA = rs; 3615b53371edSJia Liu tempB = env->active_tc.LO[ac_t]; 3616b53371edSJia Liu 3617b53371edSJia Liu env->active_tc.HI[ac_t] = tempB; 3618b53371edSJia Liu env->active_tc.LO[ac_t] = tempA; 3619b53371edSJia Liu 3620b53371edSJia Liu pos = get_DSPControl_pos(env); 3621b53371edSJia Liu 3622b53371edSJia Liu if (pos <= 64) { 3623b53371edSJia Liu pos = pos + 64; 3624b53371edSJia Liu set_DSPControl_pos(pos, env); 3625b53371edSJia Liu } 3626b53371edSJia Liu } 3627b53371edSJia Liu #endif 3628b53371edSJia Liu 3629084d0497SRichard Henderson void cpu_wrdsp(uint32_t rs, uint32_t mask_num, CPUMIPSState *env) 3630b53371edSJia Liu { 3631b53371edSJia Liu uint8_t mask[6]; 3632b53371edSJia Liu uint8_t i; 3633b53371edSJia Liu uint32_t newbits, overwrite; 3634b53371edSJia Liu target_ulong dsp; 3635b53371edSJia Liu 3636b53371edSJia Liu newbits = 0x00; 3637b53371edSJia Liu overwrite = 0xFFFFFFFF; 3638b53371edSJia Liu dsp = env->active_tc.DSPControl; 3639b53371edSJia Liu 3640b53371edSJia Liu for (i = 0; i < 6; i++) { 3641b53371edSJia Liu mask[i] = (mask_num >> i) & 0x01; 3642b53371edSJia Liu } 3643b53371edSJia Liu 3644b53371edSJia Liu if (mask[0] == 1) { 3645b53371edSJia Liu #if defined(TARGET_MIPS64) 3646b53371edSJia Liu overwrite &= 0xFFFFFF80; 3647b53371edSJia Liu newbits &= 0xFFFFFF80; 3648b53371edSJia Liu newbits |= 0x0000007F & rs; 3649b53371edSJia Liu #else 3650b53371edSJia Liu overwrite &= 0xFFFFFFC0; 3651b53371edSJia Liu newbits &= 0xFFFFFFC0; 3652b53371edSJia Liu newbits |= 0x0000003F & rs; 3653b53371edSJia Liu #endif 3654b53371edSJia Liu } 3655b53371edSJia Liu 3656b53371edSJia Liu if (mask[1] == 1) { 3657b53371edSJia Liu overwrite &= 0xFFFFE07F; 3658b53371edSJia Liu newbits &= 0xFFFFE07F; 3659b53371edSJia Liu newbits |= 0x00001F80 & rs; 3660b53371edSJia Liu } 3661b53371edSJia Liu 3662b53371edSJia Liu if (mask[2] == 1) { 3663b53371edSJia Liu overwrite &= 0xFFFFDFFF; 3664b53371edSJia Liu newbits &= 0xFFFFDFFF; 3665b53371edSJia Liu newbits |= 0x00002000 & rs; 3666b53371edSJia Liu } 3667b53371edSJia Liu 3668b53371edSJia Liu if (mask[3] == 1) { 3669b53371edSJia Liu overwrite &= 0xFF00FFFF; 3670b53371edSJia Liu newbits &= 0xFF00FFFF; 3671b53371edSJia Liu newbits |= 0x00FF0000 & rs; 3672b53371edSJia Liu } 3673b53371edSJia Liu 3674b53371edSJia Liu if (mask[4] == 1) { 3675b53371edSJia Liu overwrite &= 0x00FFFFFF; 3676b53371edSJia Liu newbits &= 0x00FFFFFF; 3677eec8972aSPetar Jovanovic #if defined(TARGET_MIPS64) 3678b53371edSJia Liu newbits |= 0xFF000000 & rs; 3679eec8972aSPetar Jovanovic #else 3680eec8972aSPetar Jovanovic newbits |= 0x0F000000 & rs; 3681eec8972aSPetar Jovanovic #endif 3682b53371edSJia Liu } 3683b53371edSJia Liu 3684b53371edSJia Liu if (mask[5] == 1) { 3685b53371edSJia Liu overwrite &= 0xFFFFBFFF; 3686b53371edSJia Liu newbits &= 0xFFFFBFFF; 3687b53371edSJia Liu newbits |= 0x00004000 & rs; 3688b53371edSJia Liu } 3689b53371edSJia Liu 3690b53371edSJia Liu dsp = dsp & overwrite; 3691b53371edSJia Liu dsp = dsp | newbits; 3692b53371edSJia Liu env->active_tc.DSPControl = dsp; 3693b53371edSJia Liu } 3694b53371edSJia Liu 3695084d0497SRichard Henderson void helper_wrdsp(target_ulong rs, target_ulong mask_num, CPUMIPSState *env) 3696084d0497SRichard Henderson { 3697084d0497SRichard Henderson return cpu_wrdsp(rs, mask_num, env); 3698084d0497SRichard Henderson } 3699084d0497SRichard Henderson 3700084d0497SRichard Henderson uint32_t cpu_rddsp(uint32_t mask_num, CPUMIPSState *env) 3701b53371edSJia Liu { 3702b53371edSJia Liu uint8_t mask[6]; 3703b53371edSJia Liu uint32_t ruler, i; 3704b53371edSJia Liu target_ulong temp; 3705b53371edSJia Liu target_ulong dsp; 3706b53371edSJia Liu 3707b53371edSJia Liu ruler = 0x01; 3708b53371edSJia Liu for (i = 0; i < 6; i++) { 3709084d0497SRichard Henderson mask[i] = (mask_num & ruler) >> i ; 3710b53371edSJia Liu ruler = ruler << 1; 3711b53371edSJia Liu } 3712b53371edSJia Liu 3713b53371edSJia Liu temp = 0x00; 3714b53371edSJia Liu dsp = env->active_tc.DSPControl; 3715b53371edSJia Liu 3716b53371edSJia Liu if (mask[0] == 1) { 3717b53371edSJia Liu #if defined(TARGET_MIPS64) 3718b53371edSJia Liu temp |= dsp & 0x7F; 3719b53371edSJia Liu #else 3720b53371edSJia Liu temp |= dsp & 0x3F; 3721b53371edSJia Liu #endif 3722b53371edSJia Liu } 3723b53371edSJia Liu 3724b53371edSJia Liu if (mask[1] == 1) { 3725b53371edSJia Liu temp |= dsp & 0x1F80; 3726b53371edSJia Liu } 3727b53371edSJia Liu 3728b53371edSJia Liu if (mask[2] == 1) { 3729b53371edSJia Liu temp |= dsp & 0x2000; 3730b53371edSJia Liu } 3731b53371edSJia Liu 3732b53371edSJia Liu if (mask[3] == 1) { 3733b53371edSJia Liu temp |= dsp & 0x00FF0000; 3734b53371edSJia Liu } 3735b53371edSJia Liu 3736b53371edSJia Liu if (mask[4] == 1) { 3737eec8972aSPetar Jovanovic #if defined(TARGET_MIPS64) 3738b53371edSJia Liu temp |= dsp & 0xFF000000; 3739eec8972aSPetar Jovanovic #else 3740eec8972aSPetar Jovanovic temp |= dsp & 0x0F000000; 3741eec8972aSPetar Jovanovic #endif 3742b53371edSJia Liu } 3743b53371edSJia Liu 3744b53371edSJia Liu if (mask[5] == 1) { 3745b53371edSJia Liu temp |= dsp & 0x4000; 3746b53371edSJia Liu } 3747b53371edSJia Liu 3748b53371edSJia Liu return temp; 3749b53371edSJia Liu } 3750b53371edSJia Liu 3751084d0497SRichard Henderson target_ulong helper_rddsp(target_ulong mask_num, CPUMIPSState *env) 3752084d0497SRichard Henderson { 3753084d0497SRichard Henderson return cpu_rddsp(mask_num, env); 3754084d0497SRichard Henderson } 3755084d0497SRichard Henderson 3756b53371edSJia Liu 3757461c08dfSJia Liu #undef MIPSDSP_LHI 3758461c08dfSJia Liu #undef MIPSDSP_LLO 3759461c08dfSJia Liu #undef MIPSDSP_HI 3760461c08dfSJia Liu #undef MIPSDSP_LO 3761461c08dfSJia Liu #undef MIPSDSP_Q3 3762461c08dfSJia Liu #undef MIPSDSP_Q2 3763461c08dfSJia Liu #undef MIPSDSP_Q1 3764461c08dfSJia Liu #undef MIPSDSP_Q0 3765461c08dfSJia Liu 3766461c08dfSJia Liu #undef MIPSDSP_SPLIT32_8 3767461c08dfSJia Liu #undef MIPSDSP_SPLIT32_16 3768461c08dfSJia Liu 3769461c08dfSJia Liu #undef MIPSDSP_RETURN32_8 3770461c08dfSJia Liu #undef MIPSDSP_RETURN32_16 3771461c08dfSJia Liu 3772461c08dfSJia Liu #ifdef TARGET_MIPS64 3773461c08dfSJia Liu #undef MIPSDSP_SPLIT64_16 3774461c08dfSJia Liu #undef MIPSDSP_SPLIT64_32 3775461c08dfSJia Liu #undef MIPSDSP_RETURN64_16 3776461c08dfSJia Liu #undef MIPSDSP_RETURN64_32 3777461c08dfSJia Liu #endif 3778