xref: /qemu/target/mips/tcg/dsp_helper.c (revision b1ca31d7ce648a10e3513bb4b5e7f89a8702aec7)
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