xref: /qemu/target/mips/tcg/dsp_helper.c (revision c0f5f9ce86ddca0a7d7ca60012059a5a18aa9c07)
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 discard;
686235eb015SJia Liu 
68729851ee7SPetar Jovanovic     if (s != 0) {
68829851ee7SPetar Jovanovic         discard = a >> (8 - s);
689235eb015SJia Liu 
690235eb015SJia Liu         if (discard != 0x00) {
691235eb015SJia Liu             set_DSPControl_overflow_flag(1, 22, env);
692235eb015SJia Liu         }
693235eb015SJia Liu     }
69429851ee7SPetar Jovanovic     return a << s;
695235eb015SJia Liu }
696235eb015SJia Liu 
697235eb015SJia Liu static inline uint16_t mipsdsp_lshift16(uint16_t a, uint8_t s,
698235eb015SJia Liu                                         CPUMIPSState *env)
699235eb015SJia Liu {
700235eb015SJia Liu     uint16_t discard;
701235eb015SJia Liu 
70229851ee7SPetar Jovanovic     if (s != 0) {
70329851ee7SPetar Jovanovic         discard = (int16_t)a >> (15 - s);
704235eb015SJia Liu 
705235eb015SJia Liu         if ((discard != 0x0000) && (discard != 0xFFFF)) {
706235eb015SJia Liu             set_DSPControl_overflow_flag(1, 22, env);
707235eb015SJia Liu         }
708235eb015SJia Liu     }
70929851ee7SPetar Jovanovic     return a << s;
710235eb015SJia Liu }
711235eb015SJia Liu 
712235eb015SJia Liu 
713235eb015SJia Liu static inline uint32_t mipsdsp_lshift32(uint32_t a, uint8_t s,
714235eb015SJia Liu                                         CPUMIPSState *env)
715235eb015SJia Liu {
716235eb015SJia Liu     uint32_t discard;
717235eb015SJia Liu 
718235eb015SJia Liu     if (s == 0) {
719235eb015SJia Liu         return a;
720235eb015SJia Liu     } else {
721235eb015SJia Liu         discard = (int32_t)a >> (31 - (s - 1));
722235eb015SJia Liu 
723235eb015SJia Liu         if ((discard != 0x00000000) && (discard != 0xFFFFFFFF)) {
724235eb015SJia Liu             set_DSPControl_overflow_flag(1, 22, env);
725235eb015SJia Liu         }
726235eb015SJia Liu         return a << s;
727235eb015SJia Liu     }
728235eb015SJia Liu }
729235eb015SJia Liu 
730235eb015SJia Liu static inline uint16_t mipsdsp_sat16_lshift(uint16_t a, uint8_t s,
731235eb015SJia Liu                                             CPUMIPSState *env)
732235eb015SJia Liu {
733235eb015SJia Liu     uint8_t  sign;
734235eb015SJia Liu     uint16_t discard;
735235eb015SJia Liu 
736235eb015SJia Liu     if (s == 0) {
737235eb015SJia Liu         return a;
738235eb015SJia Liu     } else {
739235eb015SJia Liu         sign = (a >> 15) & 0x01;
740235eb015SJia Liu         if (sign != 0) {
741235eb015SJia Liu             discard = (((0x01 << (16 - s)) - 1) << s) |
742235eb015SJia Liu                       ((a >> (14 - (s - 1))) & ((0x01 << s) - 1));
743235eb015SJia Liu         } else {
744235eb015SJia Liu             discard = a >> (14 - (s - 1));
745235eb015SJia Liu         }
746235eb015SJia Liu 
747235eb015SJia Liu         if ((discard != 0x0000) && (discard != 0xFFFF)) {
748235eb015SJia Liu             set_DSPControl_overflow_flag(1, 22, env);
749235eb015SJia Liu             return (sign == 0) ? 0x7FFF : 0x8000;
750235eb015SJia Liu         } else {
751235eb015SJia Liu             return a << s;
752235eb015SJia Liu         }
753235eb015SJia Liu     }
754235eb015SJia Liu }
755235eb015SJia Liu 
756235eb015SJia Liu static inline uint32_t mipsdsp_sat32_lshift(uint32_t a, uint8_t s,
757235eb015SJia Liu                                             CPUMIPSState *env)
758235eb015SJia Liu {
759235eb015SJia Liu     uint8_t  sign;
760235eb015SJia Liu     uint32_t discard;
761235eb015SJia Liu 
762235eb015SJia Liu     if (s == 0) {
763235eb015SJia Liu         return a;
764235eb015SJia Liu     } else {
765235eb015SJia Liu         sign = (a >> 31) & 0x01;
766235eb015SJia Liu         if (sign != 0) {
767235eb015SJia Liu             discard = (((0x01 << (32 - s)) - 1) << s) |
768235eb015SJia Liu                       ((a >> (30 - (s - 1))) & ((0x01 << s) - 1));
769235eb015SJia Liu         } else {
770235eb015SJia Liu             discard = a >> (30 - (s - 1));
771235eb015SJia Liu         }
772235eb015SJia Liu 
773235eb015SJia Liu         if ((discard != 0x00000000) && (discard != 0xFFFFFFFF)) {
774235eb015SJia Liu             set_DSPControl_overflow_flag(1, 22, env);
775235eb015SJia Liu             return (sign == 0) ? 0x7FFFFFFF : 0x80000000;
776235eb015SJia Liu         } else {
777235eb015SJia Liu             return a << s;
778235eb015SJia Liu         }
779235eb015SJia Liu     }
780235eb015SJia Liu }
781235eb015SJia Liu 
782235eb015SJia Liu static inline uint8_t mipsdsp_rnd8_rashift(uint8_t a, uint8_t s)
783235eb015SJia Liu {
784235eb015SJia Liu     uint32_t temp;
785235eb015SJia Liu 
786235eb015SJia Liu     if (s == 0) {
787235eb015SJia Liu         temp = (uint32_t)a << 1;
788235eb015SJia Liu     } else {
789235eb015SJia Liu         temp = (int32_t)(int8_t)a >> (s - 1);
790235eb015SJia Liu     }
791235eb015SJia Liu 
792235eb015SJia Liu     return (temp + 1) >> 1;
793235eb015SJia Liu }
794235eb015SJia Liu 
795235eb015SJia Liu static inline uint16_t mipsdsp_rnd16_rashift(uint16_t a, uint8_t s)
796235eb015SJia Liu {
797235eb015SJia Liu     uint32_t temp;
798235eb015SJia Liu 
799235eb015SJia Liu     if (s == 0) {
800235eb015SJia Liu         temp = (uint32_t)a << 1;
801235eb015SJia Liu     } else {
802235eb015SJia Liu         temp = (int32_t)(int16_t)a >> (s - 1);
803235eb015SJia Liu     }
804235eb015SJia Liu 
805235eb015SJia Liu     return (temp + 1) >> 1;
806235eb015SJia Liu }
807235eb015SJia Liu 
808235eb015SJia Liu static inline uint32_t mipsdsp_rnd32_rashift(uint32_t a, uint8_t s)
809235eb015SJia Liu {
810235eb015SJia Liu     int64_t temp;
811235eb015SJia Liu 
812235eb015SJia Liu     if (s == 0) {
813235eb015SJia Liu         temp = (uint64_t)a << 1;
814235eb015SJia Liu     } else {
815235eb015SJia Liu         temp = (int64_t)(int32_t)a >> (s - 1);
816235eb015SJia Liu     }
817235eb015SJia Liu     temp += 1;
818235eb015SJia Liu 
819235eb015SJia Liu     return (temp >> 1) & 0xFFFFFFFFull;
820235eb015SJia Liu }
821235eb015SJia Liu 
822235eb015SJia Liu static inline uint16_t mipsdsp_sub_i16(int16_t a, int16_t b, CPUMIPSState *env)
823235eb015SJia Liu {
824235eb015SJia Liu     int16_t  temp;
825235eb015SJia Liu 
826235eb015SJia Liu     temp = a - b;
82720c334a7SPetar Jovanovic     if (MIPSDSP_OVERFLOW_SUB(a, b, temp, 0x8000)) {
828235eb015SJia Liu         set_DSPControl_overflow_flag(1, 20, env);
829235eb015SJia Liu     }
830235eb015SJia Liu 
831235eb015SJia Liu     return temp;
832235eb015SJia Liu }
833235eb015SJia Liu 
834235eb015SJia Liu static inline uint16_t mipsdsp_sat16_sub(int16_t a, int16_t b,
835235eb015SJia Liu                                          CPUMIPSState *env)
836235eb015SJia Liu {
837235eb015SJia Liu     int16_t  temp;
838235eb015SJia Liu 
839235eb015SJia Liu     temp = a - b;
84020c334a7SPetar Jovanovic     if (MIPSDSP_OVERFLOW_SUB(a, b, temp, 0x8000)) {
84120c334a7SPetar Jovanovic         if (a >= 0) {
842235eb015SJia Liu             temp = 0x7FFF;
843235eb015SJia Liu         } else {
844235eb015SJia Liu             temp = 0x8000;
845235eb015SJia Liu         }
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 uint32_t mipsdsp_sat32_sub(int32_t a, int32_t b,
853235eb015SJia Liu                                          CPUMIPSState *env)
854235eb015SJia Liu {
855235eb015SJia Liu     int32_t  temp;
856235eb015SJia Liu 
857235eb015SJia Liu     temp = a - b;
85820c334a7SPetar Jovanovic     if (MIPSDSP_OVERFLOW_SUB(a, b, temp, 0x80000000)) {
85920c334a7SPetar Jovanovic         if (a >= 0) {
860235eb015SJia Liu             temp = 0x7FFFFFFF;
861235eb015SJia Liu         } else {
862235eb015SJia Liu             temp = 0x80000000;
863235eb015SJia Liu         }
864235eb015SJia Liu         set_DSPControl_overflow_flag(1, 20, env);
865235eb015SJia Liu     }
866235eb015SJia Liu 
867235eb015SJia Liu     return temp & 0xFFFFFFFFull;
868235eb015SJia Liu }
869235eb015SJia Liu 
870235eb015SJia Liu static inline uint16_t mipsdsp_rshift1_sub_q16(int16_t a, int16_t b)
871235eb015SJia Liu {
872235eb015SJia Liu     int32_t  temp;
873235eb015SJia Liu 
874235eb015SJia Liu     temp = (int32_t)a - (int32_t)b;
875235eb015SJia Liu 
876235eb015SJia Liu     return (temp >> 1) & 0x0000FFFF;
877235eb015SJia Liu }
878235eb015SJia Liu 
879235eb015SJia Liu static inline uint16_t mipsdsp_rrshift1_sub_q16(int16_t a, int16_t b)
880235eb015SJia Liu {
881235eb015SJia Liu     int32_t  temp;
882235eb015SJia Liu 
883235eb015SJia Liu     temp = (int32_t)a - (int32_t)b;
884235eb015SJia Liu     temp += 1;
885235eb015SJia Liu 
886235eb015SJia Liu     return (temp >> 1) & 0x0000FFFF;
887235eb015SJia Liu }
888235eb015SJia Liu 
889235eb015SJia Liu static inline uint32_t mipsdsp_rshift1_sub_q32(int32_t a, int32_t b)
890235eb015SJia Liu {
891235eb015SJia Liu     int64_t  temp;
892235eb015SJia Liu 
893235eb015SJia Liu     temp = (int64_t)a - (int64_t)b;
894235eb015SJia Liu 
895235eb015SJia Liu     return (temp >> 1) & 0xFFFFFFFFull;
896235eb015SJia Liu }
897235eb015SJia Liu 
898235eb015SJia Liu static inline uint32_t mipsdsp_rrshift1_sub_q32(int32_t a, int32_t b)
899235eb015SJia Liu {
900235eb015SJia Liu     int64_t  temp;
901235eb015SJia Liu 
902235eb015SJia Liu     temp = (int64_t)a - (int64_t)b;
903235eb015SJia Liu     temp += 1;
904235eb015SJia Liu 
905235eb015SJia Liu     return (temp >> 1) & 0xFFFFFFFFull;
906235eb015SJia Liu }
907235eb015SJia Liu 
908235eb015SJia Liu static inline uint16_t mipsdsp_sub_u16_u16(uint16_t a, uint16_t b,
909235eb015SJia Liu                                            CPUMIPSState *env)
910235eb015SJia Liu {
911235eb015SJia Liu     uint8_t  temp16;
912235eb015SJia Liu     uint32_t temp;
913235eb015SJia Liu 
914235eb015SJia Liu     temp = (uint32_t)a - (uint32_t)b;
915235eb015SJia Liu     temp16 = (temp >> 16) & 0x01;
916235eb015SJia Liu     if (temp16 == 1) {
917235eb015SJia Liu         set_DSPControl_overflow_flag(1, 20, env);
918235eb015SJia Liu     }
919235eb015SJia Liu     return temp & 0x0000FFFF;
920235eb015SJia Liu }
921235eb015SJia Liu 
922235eb015SJia Liu static inline uint16_t mipsdsp_satu16_sub_u16_u16(uint16_t a, uint16_t b,
923235eb015SJia Liu                                                   CPUMIPSState *env)
924235eb015SJia Liu {
925235eb015SJia Liu     uint8_t  temp16;
926235eb015SJia Liu     uint32_t temp;
927235eb015SJia Liu 
928235eb015SJia Liu     temp   = (uint32_t)a - (uint32_t)b;
929235eb015SJia Liu     temp16 = (temp >> 16) & 0x01;
930235eb015SJia Liu 
931235eb015SJia Liu     if (temp16 == 1) {
932235eb015SJia Liu         temp = 0x0000;
933235eb015SJia Liu         set_DSPControl_overflow_flag(1, 20, env);
934235eb015SJia Liu     }
935235eb015SJia Liu 
936235eb015SJia Liu     return temp & 0x0000FFFF;
937235eb015SJia Liu }
938235eb015SJia Liu 
939235eb015SJia Liu static inline uint8_t mipsdsp_sub_u8(uint8_t a, uint8_t b, CPUMIPSState *env)
940235eb015SJia Liu {
941235eb015SJia Liu     uint8_t  temp8;
942235eb015SJia Liu     uint16_t temp;
943235eb015SJia Liu 
944235eb015SJia Liu     temp = (uint16_t)a - (uint16_t)b;
945235eb015SJia Liu     temp8 = (temp >> 8) & 0x01;
946235eb015SJia Liu     if (temp8 == 1) {
947235eb015SJia Liu         set_DSPControl_overflow_flag(1, 20, env);
948235eb015SJia Liu     }
949235eb015SJia Liu 
950235eb015SJia Liu     return temp & 0x00FF;
951235eb015SJia Liu }
952235eb015SJia Liu 
953235eb015SJia Liu static inline uint8_t mipsdsp_satu8_sub(uint8_t a, uint8_t b, CPUMIPSState *env)
954235eb015SJia Liu {
955235eb015SJia Liu     uint8_t  temp8;
956235eb015SJia Liu     uint16_t temp;
957235eb015SJia Liu 
958235eb015SJia Liu     temp = (uint16_t)a - (uint16_t)b;
959235eb015SJia Liu     temp8 = (temp >> 8) & 0x01;
960235eb015SJia Liu     if (temp8 == 1) {
961235eb015SJia Liu         temp = 0x00;
962235eb015SJia Liu         set_DSPControl_overflow_flag(1, 20, env);
963235eb015SJia Liu     }
964235eb015SJia Liu 
965235eb015SJia Liu     return temp & 0x00FF;
966235eb015SJia Liu }
967235eb015SJia Liu 
968235eb015SJia Liu static inline uint32_t mipsdsp_sub32(int32_t a, int32_t b, CPUMIPSState *env)
969235eb015SJia Liu {
970235eb015SJia Liu     int32_t temp;
971235eb015SJia Liu 
972235eb015SJia Liu     temp = a - b;
97320c334a7SPetar Jovanovic     if (MIPSDSP_OVERFLOW_SUB(a, b, temp, 0x80000000)) {
974235eb015SJia Liu         set_DSPControl_overflow_flag(1, 20, env);
975235eb015SJia Liu     }
976235eb015SJia Liu 
977235eb015SJia Liu     return temp;
978235eb015SJia Liu }
979235eb015SJia Liu 
980235eb015SJia Liu static inline int32_t mipsdsp_add_i32(int32_t a, int32_t b, CPUMIPSState *env)
981235eb015SJia Liu {
982235eb015SJia Liu     int32_t temp;
983235eb015SJia Liu 
984235eb015SJia Liu     temp = a + b;
985235eb015SJia Liu 
98620c334a7SPetar Jovanovic     if (MIPSDSP_OVERFLOW_ADD(a, b, temp, 0x80000000)) {
987235eb015SJia Liu         set_DSPControl_overflow_flag(1, 20, env);
988235eb015SJia Liu     }
989235eb015SJia Liu 
990235eb015SJia Liu     return temp;
991235eb015SJia Liu }
992235eb015SJia Liu 
993235eb015SJia Liu static inline int32_t mipsdsp_cmp_eq(int32_t a, int32_t b)
994235eb015SJia Liu {
995235eb015SJia Liu     return a == b;
996235eb015SJia Liu }
997235eb015SJia Liu 
998235eb015SJia Liu static inline int32_t mipsdsp_cmp_le(int32_t a, int32_t b)
999235eb015SJia Liu {
1000235eb015SJia Liu     return a <= b;
1001235eb015SJia Liu }
1002235eb015SJia Liu 
1003235eb015SJia Liu static inline int32_t mipsdsp_cmp_lt(int32_t a, int32_t b)
1004235eb015SJia Liu {
1005235eb015SJia Liu     return a < b;
1006235eb015SJia Liu }
1007235eb015SJia Liu 
1008235eb015SJia Liu static inline int32_t mipsdsp_cmpu_eq(uint32_t a, uint32_t b)
1009235eb015SJia Liu {
1010235eb015SJia Liu     return a == b;
1011235eb015SJia Liu }
1012235eb015SJia Liu 
1013235eb015SJia Liu static inline int32_t mipsdsp_cmpu_le(uint32_t a, uint32_t b)
1014235eb015SJia Liu {
1015235eb015SJia Liu     return a <= b;
1016235eb015SJia Liu }
1017235eb015SJia Liu 
1018235eb015SJia Liu static inline int32_t mipsdsp_cmpu_lt(uint32_t a, uint32_t b)
1019235eb015SJia Liu {
1020235eb015SJia Liu     return a < b;
1021235eb015SJia Liu }
1022235eb015SJia Liu /*** MIPS DSP internal functions end ***/
1023461c08dfSJia Liu 
1024461c08dfSJia Liu #define MIPSDSP_LHI 0xFFFFFFFF00000000ull
1025461c08dfSJia Liu #define MIPSDSP_LLO 0x00000000FFFFFFFFull
1026461c08dfSJia Liu #define MIPSDSP_HI  0xFFFF0000
1027461c08dfSJia Liu #define MIPSDSP_LO  0x0000FFFF
1028461c08dfSJia Liu #define MIPSDSP_Q3  0xFF000000
1029461c08dfSJia Liu #define MIPSDSP_Q2  0x00FF0000
1030461c08dfSJia Liu #define MIPSDSP_Q1  0x0000FF00
1031461c08dfSJia Liu #define MIPSDSP_Q0  0x000000FF
1032461c08dfSJia Liu 
1033461c08dfSJia Liu #define MIPSDSP_SPLIT32_8(num, a, b, c, d)  \
1034461c08dfSJia Liu     do {                                    \
1035461c08dfSJia Liu         a = (num >> 24) & MIPSDSP_Q0;       \
1036461c08dfSJia Liu         b = (num >> 16) & MIPSDSP_Q0;       \
1037461c08dfSJia Liu         c = (num >> 8) & MIPSDSP_Q0;        \
1038461c08dfSJia Liu         d = num & MIPSDSP_Q0;               \
1039461c08dfSJia Liu     } while (0)
1040461c08dfSJia Liu 
1041461c08dfSJia Liu #define MIPSDSP_SPLIT32_16(num, a, b)       \
1042461c08dfSJia Liu     do {                                    \
1043461c08dfSJia Liu         a = (num >> 16) & MIPSDSP_LO;       \
1044461c08dfSJia Liu         b = num & MIPSDSP_LO;               \
1045461c08dfSJia Liu     } while (0)
1046461c08dfSJia Liu 
1047461c08dfSJia Liu #define MIPSDSP_RETURN32_8(a, b, c, d)  ((target_long)(int32_t) \
1048461c08dfSJia Liu                                          (((uint32_t)a << 24) | \
1049461c08dfSJia Liu                                          (((uint32_t)b << 16) | \
1050461c08dfSJia Liu                                          (((uint32_t)c << 8) |  \
1051461c08dfSJia Liu                                           ((uint32_t)d & 0xFF)))))
1052461c08dfSJia Liu #define MIPSDSP_RETURN32_16(a, b)       ((target_long)(int32_t) \
1053461c08dfSJia Liu                                          (((uint32_t)a << 16) | \
1054461c08dfSJia Liu                                           ((uint32_t)b & 0xFFFF)))
1055461c08dfSJia Liu 
1056461c08dfSJia Liu #ifdef TARGET_MIPS64
1057461c08dfSJia Liu #define MIPSDSP_SPLIT64_16(num, a, b, c, d)  \
1058461c08dfSJia Liu     do {                                     \
1059461c08dfSJia Liu         a = (num >> 48) & MIPSDSP_LO;        \
1060461c08dfSJia Liu         b = (num >> 32) & MIPSDSP_LO;        \
1061461c08dfSJia Liu         c = (num >> 16) & MIPSDSP_LO;        \
1062461c08dfSJia Liu         d = num & MIPSDSP_LO;                \
1063461c08dfSJia Liu     } while (0)
1064461c08dfSJia Liu 
1065461c08dfSJia Liu #define MIPSDSP_SPLIT64_32(num, a, b)       \
1066461c08dfSJia Liu     do {                                    \
1067461c08dfSJia Liu         a = (num >> 32) & MIPSDSP_LLO;      \
1068461c08dfSJia Liu         b = num & MIPSDSP_LLO;              \
1069461c08dfSJia Liu     } while (0)
1070461c08dfSJia Liu 
1071461c08dfSJia Liu #define MIPSDSP_RETURN64_16(a, b, c, d) (((uint64_t)a << 48) | \
1072461c08dfSJia Liu                                          ((uint64_t)b << 32) | \
1073461c08dfSJia Liu                                          ((uint64_t)c << 16) | \
1074461c08dfSJia Liu                                          (uint64_t)d)
1075461c08dfSJia Liu #define MIPSDSP_RETURN64_32(a, b)       (((uint64_t)a << 32) | (uint64_t)b)
1076461c08dfSJia Liu #endif
1077461c08dfSJia Liu 
1078461c08dfSJia Liu /** DSP Arithmetic Sub-class insns **/
107975d012acSAurelien Jarno #define MIPSDSP32_UNOP_ENV(name, func, element)                            \
108075d012acSAurelien Jarno target_ulong helper_##name(target_ulong rt, CPUMIPSState *env)             \
108175d012acSAurelien Jarno {                                                                          \
108275d012acSAurelien Jarno     DSP32Value dt;                                                         \
108375d012acSAurelien Jarno     unsigned int i, n;                                                     \
108475d012acSAurelien Jarno                                                                            \
108575d012acSAurelien Jarno     n = sizeof(DSP32Value) / sizeof(dt.element[0]);                        \
108675d012acSAurelien Jarno     dt.sw[0] = rt;                                                         \
108775d012acSAurelien Jarno                                                                            \
108875d012acSAurelien Jarno     for (i = 0; i < n; i++) {                                              \
108975d012acSAurelien Jarno         dt.element[i] = mipsdsp_##func(dt.element[i], env);                \
109075d012acSAurelien Jarno     }                                                                      \
109175d012acSAurelien Jarno                                                                            \
109275d012acSAurelien Jarno     return (target_long)dt.sw[0];                                          \
109375d012acSAurelien Jarno }
109475d012acSAurelien Jarno MIPSDSP32_UNOP_ENV(absq_s_ph, sat_abs16, sh)
109575d012acSAurelien Jarno MIPSDSP32_UNOP_ENV(absq_s_qb, sat_abs8, sb)
109675d012acSAurelien Jarno MIPSDSP32_UNOP_ENV(absq_s_w, sat_abs32, sw)
109775d012acSAurelien Jarno #undef MIPSDSP32_UNOP_ENV
109875d012acSAurelien Jarno 
109975d012acSAurelien Jarno #if defined(TARGET_MIPS64)
110075d012acSAurelien Jarno #define MIPSDSP64_UNOP_ENV(name, func, element)                            \
110175d012acSAurelien Jarno target_ulong helper_##name(target_ulong rt, CPUMIPSState *env)             \
110275d012acSAurelien Jarno {                                                                          \
110375d012acSAurelien Jarno     DSP64Value dt;                                                         \
110475d012acSAurelien Jarno     unsigned int i, n;                                                     \
110575d012acSAurelien Jarno                                                                            \
110675d012acSAurelien Jarno     n = sizeof(DSP64Value) / sizeof(dt.element[0]);                        \
110775d012acSAurelien Jarno     dt.sl[0] = rt;                                                         \
110875d012acSAurelien Jarno                                                                            \
110975d012acSAurelien Jarno     for (i = 0; i < n; i++) {                                              \
111075d012acSAurelien Jarno         dt.element[i] = mipsdsp_##func(dt.element[i], env);                \
111175d012acSAurelien Jarno     }                                                                      \
111275d012acSAurelien Jarno                                                                            \
111375d012acSAurelien Jarno     return dt.sl[0];                                                       \
111475d012acSAurelien Jarno }
111575d012acSAurelien Jarno MIPSDSP64_UNOP_ENV(absq_s_ob, sat_abs8, sb)
111675d012acSAurelien Jarno MIPSDSP64_UNOP_ENV(absq_s_qh, sat_abs16, sh)
111775d012acSAurelien Jarno MIPSDSP64_UNOP_ENV(absq_s_pw, sat_abs32, sw)
111875d012acSAurelien Jarno #undef MIPSDSP64_UNOP_ENV
111975d012acSAurelien Jarno #endif
112075d012acSAurelien Jarno 
11216de0e6c1SAurelien Jarno #define MIPSDSP32_BINOP(name, func, element)                               \
11226de0e6c1SAurelien Jarno target_ulong helper_##name(target_ulong rs, target_ulong rt)               \
1123461c08dfSJia Liu {                                                                          \
11246de0e6c1SAurelien Jarno     DSP32Value ds, dt;                                                     \
11256de0e6c1SAurelien Jarno     unsigned int i, n;                                                     \
1126461c08dfSJia Liu                                                                            \
11276de0e6c1SAurelien Jarno     n = sizeof(DSP32Value) / sizeof(ds.element[0]);                        \
11286de0e6c1SAurelien Jarno     ds.sw[0] = rs;                                                         \
11296de0e6c1SAurelien Jarno     dt.sw[0] = rt;                                                         \
1130461c08dfSJia Liu                                                                            \
11316de0e6c1SAurelien Jarno     for (i = 0; i < n; i++) {                                              \
11326de0e6c1SAurelien Jarno         ds.element[i] = mipsdsp_##func(ds.element[i], dt.element[i]);      \
11336de0e6c1SAurelien Jarno     }                                                                      \
1134461c08dfSJia Liu                                                                            \
11356de0e6c1SAurelien Jarno     return (target_long)ds.sw[0];                                          \
1136461c08dfSJia Liu }
11376de0e6c1SAurelien Jarno MIPSDSP32_BINOP(addqh_ph, rshift1_add_q16, sh);
11386de0e6c1SAurelien Jarno MIPSDSP32_BINOP(addqh_r_ph, rrshift1_add_q16, sh);
11396de0e6c1SAurelien Jarno MIPSDSP32_BINOP(addqh_r_w, rrshift1_add_q32, sw);
11406de0e6c1SAurelien Jarno MIPSDSP32_BINOP(addqh_w, rshift1_add_q32, sw);
11416de0e6c1SAurelien Jarno MIPSDSP32_BINOP(adduh_qb, rshift1_add_u8, ub);
11426de0e6c1SAurelien Jarno MIPSDSP32_BINOP(adduh_r_qb, rrshift1_add_u8, ub);
11436de0e6c1SAurelien Jarno MIPSDSP32_BINOP(subqh_ph, rshift1_sub_q16, sh);
11446de0e6c1SAurelien Jarno MIPSDSP32_BINOP(subqh_r_ph, rrshift1_sub_q16, sh);
11456de0e6c1SAurelien Jarno MIPSDSP32_BINOP(subqh_r_w, rrshift1_sub_q32, sw);
11466de0e6c1SAurelien Jarno MIPSDSP32_BINOP(subqh_w, rshift1_sub_q32, sw);
11476de0e6c1SAurelien Jarno #undef MIPSDSP32_BINOP
1148461c08dfSJia Liu 
11496de0e6c1SAurelien Jarno #define MIPSDSP32_BINOP_ENV(name, func, element)                           \
11506de0e6c1SAurelien Jarno target_ulong helper_##name(target_ulong rs, target_ulong rt,               \
1151461c08dfSJia Liu                            CPUMIPSState *env)                              \
1152461c08dfSJia Liu {                                                                          \
11536de0e6c1SAurelien Jarno     DSP32Value ds, dt;                                                     \
11546de0e6c1SAurelien Jarno     unsigned int i, n;                                                     \
1155461c08dfSJia Liu                                                                            \
11566de0e6c1SAurelien Jarno     n = sizeof(DSP32Value) / sizeof(ds.element[0]);                        \
11576de0e6c1SAurelien Jarno     ds.sw[0] = rs;                                                         \
11586de0e6c1SAurelien Jarno     dt.sw[0] = rt;                                                         \
1159461c08dfSJia Liu                                                                            \
11606de0e6c1SAurelien Jarno     for (i = 0 ; i < n ; i++) {                                            \
11616de0e6c1SAurelien Jarno         ds.element[i] = mipsdsp_##func(ds.element[i], dt.element[i], env); \
11626de0e6c1SAurelien Jarno     }                                                                      \
1163461c08dfSJia Liu                                                                            \
11646de0e6c1SAurelien Jarno     return (target_long)ds.sw[0];                                          \
1165461c08dfSJia Liu }
11666de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addq_ph, add_i16, sh)
11676de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addq_s_ph, sat_add_i16, sh)
11686de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addq_s_w, sat_add_i32, sw);
11696de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addu_ph, add_u16, sh)
11706de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addu_qb, add_u8, ub);
11716de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addu_s_ph, sat_add_u16, sh)
11726de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(addu_s_qb, sat_add_u8, ub);
11736de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subq_ph, sub_i16, sh);
11746de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subq_s_ph, sat16_sub, sh);
11756de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subq_s_w, sat32_sub, sw);
11766de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subu_ph, sub_u16_u16, sh);
11776de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subu_qb, sub_u8, ub);
11786de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subu_s_ph, satu16_sub_u16_u16, sh);
11796de0e6c1SAurelien Jarno MIPSDSP32_BINOP_ENV(subu_s_qb, satu8_sub, ub);
11806de0e6c1SAurelien Jarno #undef MIPSDSP32_BINOP_ENV
1181461c08dfSJia Liu 
1182461c08dfSJia Liu #ifdef TARGET_MIPS64
11836de0e6c1SAurelien Jarno #define MIPSDSP64_BINOP(name, func, element)                               \
11846de0e6c1SAurelien Jarno target_ulong helper_##name(target_ulong rs, target_ulong rt)               \
11856de0e6c1SAurelien Jarno {                                                                          \
11866de0e6c1SAurelien Jarno     DSP64Value ds, dt;                                                     \
11876de0e6c1SAurelien Jarno     unsigned int i, n;                                                     \
11886de0e6c1SAurelien Jarno                                                                            \
11896de0e6c1SAurelien Jarno     n = sizeof(DSP64Value) / sizeof(ds.element[0]);                        \
11906de0e6c1SAurelien Jarno     ds.sl[0] = rs;                                                         \
11916de0e6c1SAurelien Jarno     dt.sl[0] = rt;                                                         \
11926de0e6c1SAurelien Jarno                                                                            \
11936de0e6c1SAurelien Jarno     for (i = 0 ; i < n ; i++) {                                            \
11946de0e6c1SAurelien Jarno         ds.element[i] = mipsdsp_##func(ds.element[i], dt.element[i]);      \
11956de0e6c1SAurelien Jarno     }                                                                      \
11966de0e6c1SAurelien Jarno                                                                            \
11976de0e6c1SAurelien Jarno     return ds.sl[0];                                                       \
11986de0e6c1SAurelien Jarno }
11996de0e6c1SAurelien Jarno MIPSDSP64_BINOP(adduh_ob, rshift1_add_u8, ub);
12006de0e6c1SAurelien Jarno MIPSDSP64_BINOP(adduh_r_ob, rrshift1_add_u8, ub);
12016de0e6c1SAurelien Jarno MIPSDSP64_BINOP(subuh_ob, rshift1_sub_u8, ub);
12026de0e6c1SAurelien Jarno MIPSDSP64_BINOP(subuh_r_ob, rrshift1_sub_u8, ub);
12036de0e6c1SAurelien Jarno #undef MIPSDSP64_BINOP
12046de0e6c1SAurelien Jarno 
12056de0e6c1SAurelien Jarno #define MIPSDSP64_BINOP_ENV(name, func, element)                           \
12066de0e6c1SAurelien Jarno target_ulong helper_##name(target_ulong rs, target_ulong rt,               \
1207461c08dfSJia Liu                            CPUMIPSState *env)                              \
1208461c08dfSJia Liu {                                                                          \
12096de0e6c1SAurelien Jarno     DSP64Value ds, dt;                                                     \
12106de0e6c1SAurelien Jarno     unsigned int i, n;                                                     \
1211461c08dfSJia Liu                                                                            \
12126de0e6c1SAurelien Jarno     n = sizeof(DSP64Value) / sizeof(ds.element[0]);                        \
12136de0e6c1SAurelien Jarno     ds.sl[0] = rs;                                                         \
12146de0e6c1SAurelien Jarno     dt.sl[0] = rt;                                                         \
1215461c08dfSJia Liu                                                                            \
12166de0e6c1SAurelien Jarno     for (i = 0 ; i < n ; i++) {                                            \
12176de0e6c1SAurelien Jarno         ds.element[i] = mipsdsp_##func(ds.element[i], dt.element[i], env); \
12186de0e6c1SAurelien Jarno     }                                                                      \
1219461c08dfSJia Liu                                                                            \
12206de0e6c1SAurelien Jarno     return ds.sl[0];                                                       \
1221461c08dfSJia Liu }
12226de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addq_pw, add_i32, sw);
12236de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addq_qh, add_i16, sh);
12246de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addq_s_pw, sat_add_i32, sw);
12256de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addq_s_qh, sat_add_i16, sh);
12266de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addu_ob, add_u8, uh);
12276de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addu_qh, add_u16, uh);
12286de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addu_s_ob, sat_add_u8, uh);
12296de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(addu_s_qh, sat_add_u16, uh);
12306de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subq_pw, sub32, sw);
12316de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subq_qh, sub_i16, sh);
12326de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subq_s_pw, sat32_sub, sw);
12336de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subq_s_qh, sat16_sub, sh);
12346de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subu_ob, sub_u8, uh);
12356de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subu_qh, sub_u16_u16, uh);
12366de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subu_s_ob, satu8_sub, uh);
12376de0e6c1SAurelien Jarno MIPSDSP64_BINOP_ENV(subu_s_qh, satu16_sub_u16_u16, uh);
12386de0e6c1SAurelien Jarno #undef MIPSDSP64_BINOP_ENV
1239461c08dfSJia Liu 
1240461c08dfSJia Liu #endif
1241461c08dfSJia Liu 
1242461c08dfSJia Liu #define SUBUH_QB(name, var) \
1243461c08dfSJia Liu target_ulong helper_##name##_qb(target_ulong rs, target_ulong rt) \
1244461c08dfSJia Liu {                                                                 \
1245461c08dfSJia Liu     uint8_t rs3, rs2, rs1, rs0;                                   \
1246461c08dfSJia Liu     uint8_t rt3, rt2, rt1, rt0;                                   \
1247461c08dfSJia Liu     uint8_t tempD, tempC, tempB, tempA;                           \
1248461c08dfSJia Liu                                                                   \
1249461c08dfSJia Liu     MIPSDSP_SPLIT32_8(rs, rs3, rs2, rs1, rs0);                    \
1250461c08dfSJia Liu     MIPSDSP_SPLIT32_8(rt, rt3, rt2, rt1, rt0);                    \
1251461c08dfSJia Liu                                                                   \
1252461c08dfSJia Liu     tempD = ((uint16_t)rs3 - (uint16_t)rt3 + var) >> 1;           \
1253461c08dfSJia Liu     tempC = ((uint16_t)rs2 - (uint16_t)rt2 + var) >> 1;           \
1254461c08dfSJia Liu     tempB = ((uint16_t)rs1 - (uint16_t)rt1 + var) >> 1;           \
1255461c08dfSJia Liu     tempA = ((uint16_t)rs0 - (uint16_t)rt0 + var) >> 1;           \
1256461c08dfSJia Liu                                                                   \
1257461c08dfSJia Liu     return ((uint32_t)tempD << 24) | ((uint32_t)tempC << 16) |    \
1258461c08dfSJia Liu         ((uint32_t)tempB << 8) | ((uint32_t)tempA);               \
1259461c08dfSJia Liu }
1260461c08dfSJia Liu 
1261461c08dfSJia Liu SUBUH_QB(subuh, 0);
1262461c08dfSJia Liu SUBUH_QB(subuh_r, 1);
1263461c08dfSJia Liu 
1264461c08dfSJia Liu #undef SUBUH_QB
1265461c08dfSJia Liu 
1266461c08dfSJia Liu target_ulong helper_addsc(target_ulong rs, target_ulong rt, CPUMIPSState *env)
1267461c08dfSJia Liu {
1268461c08dfSJia Liu     uint64_t temp, tempRs, tempRt;
1269461c08dfSJia Liu     int32_t flag;
1270461c08dfSJia Liu 
1271461c08dfSJia Liu     tempRs = (uint64_t)rs & MIPSDSP_LLO;
1272461c08dfSJia Liu     tempRt = (uint64_t)rt & MIPSDSP_LLO;
1273461c08dfSJia Liu 
1274461c08dfSJia Liu     temp = tempRs + tempRt;
1275461c08dfSJia Liu     flag = (temp & 0x0100000000ull) >> 32;
1276461c08dfSJia Liu     set_DSPControl_carryflag(flag, env);
1277461c08dfSJia Liu 
1278461c08dfSJia Liu     return (target_long)(int32_t)(temp & MIPSDSP_LLO);
1279461c08dfSJia Liu }
1280461c08dfSJia Liu 
1281461c08dfSJia Liu target_ulong helper_addwc(target_ulong rs, target_ulong rt, CPUMIPSState *env)
1282461c08dfSJia Liu {
1283461c08dfSJia Liu     uint32_t rd;
1284461c08dfSJia Liu     int32_t temp32, temp31;
1285461c08dfSJia Liu     int64_t tempL;
1286461c08dfSJia Liu 
1287461c08dfSJia Liu     tempL = (int64_t)(int32_t)rs + (int64_t)(int32_t)rt +
1288461c08dfSJia Liu         get_DSPControl_carryflag(env);
1289461c08dfSJia Liu     temp31 = (tempL >> 31) & 0x01;
1290461c08dfSJia Liu     temp32 = (tempL >> 32) & 0x01;
1291461c08dfSJia Liu 
1292461c08dfSJia Liu     if (temp31 != temp32) {
1293461c08dfSJia Liu         set_DSPControl_overflow_flag(1, 20, env);
1294461c08dfSJia Liu     }
1295461c08dfSJia Liu 
1296461c08dfSJia Liu     rd = tempL & MIPSDSP_LLO;
1297461c08dfSJia Liu 
1298461c08dfSJia Liu     return (target_long)(int32_t)rd;
1299461c08dfSJia Liu }
1300461c08dfSJia Liu 
1301461c08dfSJia Liu target_ulong helper_modsub(target_ulong rs, target_ulong rt)
1302461c08dfSJia Liu {
1303461c08dfSJia Liu     int32_t decr;
1304461c08dfSJia Liu     uint16_t lastindex;
1305461c08dfSJia Liu     target_ulong rd;
1306461c08dfSJia Liu 
1307461c08dfSJia Liu     decr = rt & MIPSDSP_Q0;
1308461c08dfSJia Liu     lastindex = (rt >> 8) & MIPSDSP_LO;
1309461c08dfSJia Liu 
1310461c08dfSJia Liu     if ((rs & MIPSDSP_LLO) == 0x00000000) {
1311461c08dfSJia Liu         rd = (target_ulong)lastindex;
1312461c08dfSJia Liu     } else {
1313461c08dfSJia Liu         rd = rs - decr;
1314461c08dfSJia Liu     }
1315461c08dfSJia Liu 
1316461c08dfSJia Liu     return rd;
1317461c08dfSJia Liu }
1318461c08dfSJia Liu 
1319461c08dfSJia Liu target_ulong helper_raddu_w_qb(target_ulong rs)
1320461c08dfSJia Liu {
13210a16c79cSAurelien Jarno     target_ulong ret = 0;
13220a16c79cSAurelien Jarno     DSP32Value ds;
13230a16c79cSAurelien Jarno     unsigned int i;
1324461c08dfSJia Liu 
13250a16c79cSAurelien Jarno     ds.uw[0] = rs;
13260a16c79cSAurelien Jarno     for (i = 0; i < 4; i++) {
13270a16c79cSAurelien Jarno         ret += ds.ub[i];
13280a16c79cSAurelien Jarno     }
13290a16c79cSAurelien Jarno     return ret;
1330461c08dfSJia Liu }
1331461c08dfSJia Liu 
1332461c08dfSJia Liu #if defined(TARGET_MIPS64)
1333461c08dfSJia Liu target_ulong helper_raddu_l_ob(target_ulong rs)
1334461c08dfSJia Liu {
13350a16c79cSAurelien Jarno     target_ulong ret = 0;
13360a16c79cSAurelien Jarno     DSP64Value ds;
13370a16c79cSAurelien Jarno     unsigned int i;
1338461c08dfSJia Liu 
13390a16c79cSAurelien Jarno     ds.ul[0] = rs;
1340461c08dfSJia Liu     for (i = 0; i < 8; i++) {
13410a16c79cSAurelien Jarno         ret += ds.ub[i];
1342461c08dfSJia Liu     }
13430a16c79cSAurelien Jarno     return ret;
1344461c08dfSJia Liu }
1345461c08dfSJia Liu #endif
1346461c08dfSJia Liu 
1347461c08dfSJia Liu #define PRECR_QB_PH(name, a, b)\
1348461c08dfSJia Liu target_ulong helper_##name##_qb_ph(target_ulong rs, target_ulong rt) \
1349461c08dfSJia Liu {                                                                    \
1350461c08dfSJia Liu     uint8_t tempD, tempC, tempB, tempA;                              \
1351461c08dfSJia Liu                                                                      \
1352461c08dfSJia Liu     tempD = (rs >> a) & MIPSDSP_Q0;                                  \
1353461c08dfSJia Liu     tempC = (rs >> b) & MIPSDSP_Q0;                                  \
1354461c08dfSJia Liu     tempB = (rt >> a) & MIPSDSP_Q0;                                  \
1355461c08dfSJia Liu     tempA = (rt >> b) & MIPSDSP_Q0;                                  \
1356461c08dfSJia Liu                                                                      \
1357461c08dfSJia Liu     return MIPSDSP_RETURN32_8(tempD, tempC, tempB, tempA);           \
1358461c08dfSJia Liu }
1359461c08dfSJia Liu 
1360461c08dfSJia Liu PRECR_QB_PH(precr, 16, 0);
1361461c08dfSJia Liu PRECR_QB_PH(precrq, 24, 8);
1362461c08dfSJia Liu 
1363461c08dfSJia Liu #undef PRECR_QB_OH
1364461c08dfSJia Liu 
1365461c08dfSJia Liu target_ulong helper_precr_sra_ph_w(uint32_t sa, target_ulong rs,
1366461c08dfSJia Liu                                    target_ulong rt)
1367461c08dfSJia Liu {
1368461c08dfSJia Liu     uint16_t tempB, tempA;
1369461c08dfSJia Liu 
1370461c08dfSJia Liu     tempB = ((int32_t)rt >> sa) & MIPSDSP_LO;
1371461c08dfSJia Liu     tempA = ((int32_t)rs >> sa) & MIPSDSP_LO;
1372461c08dfSJia Liu 
1373461c08dfSJia Liu     return MIPSDSP_RETURN32_16(tempB, tempA);
1374461c08dfSJia Liu }
1375461c08dfSJia Liu 
1376461c08dfSJia Liu target_ulong helper_precr_sra_r_ph_w(uint32_t sa,
1377461c08dfSJia Liu                                      target_ulong rs, target_ulong rt)
1378461c08dfSJia Liu {
1379461c08dfSJia Liu     uint64_t tempB, tempA;
1380461c08dfSJia Liu 
1381461c08dfSJia Liu     /* If sa = 0, then (sa - 1) = -1 will case shift error, so we need else. */
1382461c08dfSJia Liu     if (sa == 0) {
1383461c08dfSJia Liu         tempB = (rt & MIPSDSP_LO) << 1;
1384461c08dfSJia Liu         tempA = (rs & MIPSDSP_LO) << 1;
1385461c08dfSJia Liu     } else {
1386461c08dfSJia Liu         tempB = ((int32_t)rt >> (sa - 1)) + 1;
1387461c08dfSJia Liu         tempA = ((int32_t)rs >> (sa - 1)) + 1;
1388461c08dfSJia Liu     }
1389461c08dfSJia Liu     rt = (((tempB >> 1) & MIPSDSP_LO) << 16) | ((tempA >> 1) & MIPSDSP_LO);
1390461c08dfSJia Liu 
1391461c08dfSJia Liu     return (target_long)(int32_t)rt;
1392461c08dfSJia Liu }
1393461c08dfSJia Liu 
1394461c08dfSJia Liu target_ulong helper_precrq_ph_w(target_ulong rs, target_ulong rt)
1395461c08dfSJia Liu {
1396461c08dfSJia Liu     uint16_t tempB, tempA;
1397461c08dfSJia Liu 
1398461c08dfSJia Liu     tempB = (rs & MIPSDSP_HI) >> 16;
1399461c08dfSJia Liu     tempA = (rt & MIPSDSP_HI) >> 16;
1400461c08dfSJia Liu 
1401461c08dfSJia Liu     return MIPSDSP_RETURN32_16(tempB, tempA);
1402461c08dfSJia Liu }
1403461c08dfSJia Liu 
1404461c08dfSJia Liu target_ulong helper_precrq_rs_ph_w(target_ulong rs, target_ulong rt,
1405461c08dfSJia Liu                                    CPUMIPSState *env)
1406461c08dfSJia Liu {
1407461c08dfSJia Liu     uint16_t tempB, tempA;
1408461c08dfSJia Liu 
1409461c08dfSJia Liu     tempB = mipsdsp_trunc16_sat16_round(rs, env);
1410461c08dfSJia Liu     tempA = mipsdsp_trunc16_sat16_round(rt, env);
1411461c08dfSJia Liu 
1412461c08dfSJia Liu     return MIPSDSP_RETURN32_16(tempB, tempA);
1413461c08dfSJia Liu }
1414461c08dfSJia Liu 
1415461c08dfSJia Liu #if defined(TARGET_MIPS64)
1416461c08dfSJia Liu target_ulong helper_precr_ob_qh(target_ulong rs, target_ulong rt)
1417461c08dfSJia Liu {
1418461c08dfSJia Liu     uint8_t rs6, rs4, rs2, rs0;
1419461c08dfSJia Liu     uint8_t rt6, rt4, rt2, rt0;
1420461c08dfSJia Liu     uint64_t temp;
1421461c08dfSJia Liu 
1422461c08dfSJia Liu     rs6 = (rs >> 48) & MIPSDSP_Q0;
1423461c08dfSJia Liu     rs4 = (rs >> 32) & MIPSDSP_Q0;
1424461c08dfSJia Liu     rs2 = (rs >> 16) & MIPSDSP_Q0;
1425461c08dfSJia Liu     rs0 = rs & MIPSDSP_Q0;
1426461c08dfSJia Liu     rt6 = (rt >> 48) & MIPSDSP_Q0;
1427461c08dfSJia Liu     rt4 = (rt >> 32) & MIPSDSP_Q0;
1428461c08dfSJia Liu     rt2 = (rt >> 16) & MIPSDSP_Q0;
1429461c08dfSJia Liu     rt0 = rt & MIPSDSP_Q0;
1430461c08dfSJia Liu 
1431461c08dfSJia Liu     temp = ((uint64_t)rs6 << 56) | ((uint64_t)rs4 << 48) |
1432461c08dfSJia Liu            ((uint64_t)rs2 << 40) | ((uint64_t)rs0 << 32) |
1433461c08dfSJia Liu            ((uint64_t)rt6 << 24) | ((uint64_t)rt4 << 16) |
1434461c08dfSJia Liu            ((uint64_t)rt2 << 8) | (uint64_t)rt0;
1435461c08dfSJia Liu 
1436461c08dfSJia Liu     return temp;
1437461c08dfSJia Liu }
1438461c08dfSJia Liu 
1439461c08dfSJia Liu #define PRECR_QH_PW(name, var) \
1440461c08dfSJia Liu target_ulong helper_precr_##name##_qh_pw(target_ulong rs, target_ulong rt, \
1441461c08dfSJia Liu                                     uint32_t sa)                      \
1442461c08dfSJia Liu {                                                                     \
1443461c08dfSJia Liu     uint16_t rs3, rs2, rs1, rs0;                                      \
1444461c08dfSJia Liu     uint16_t rt3, rt2, rt1, rt0;                                      \
1445461c08dfSJia Liu     uint16_t tempD, tempC, tempB, tempA;                              \
1446461c08dfSJia Liu                                                                       \
1447461c08dfSJia Liu     MIPSDSP_SPLIT64_16(rs, rs3, rs2, rs1, rs0);                       \
1448461c08dfSJia Liu     MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0);                       \
1449461c08dfSJia Liu                                                                       \
1450461c08dfSJia Liu     /* When sa = 0, we use rt2, rt0, rs2, rs0;                        \
1451461c08dfSJia Liu      * when sa != 0, we use rt3, rt1, rs3, rs1. */                    \
1452461c08dfSJia Liu     if (sa == 0) {                                                    \
1453461c08dfSJia Liu         tempD = rt2 << var;                                           \
1454461c08dfSJia Liu         tempC = rt0 << var;                                           \
1455461c08dfSJia Liu         tempB = rs2 << var;                                           \
1456461c08dfSJia Liu         tempA = rs0 << var;                                           \
1457461c08dfSJia Liu     } else {                                                          \
1458461c08dfSJia Liu         tempD = (((int16_t)rt3 >> sa) + var) >> var;                  \
1459461c08dfSJia Liu         tempC = (((int16_t)rt1 >> sa) + var) >> var;                  \
1460461c08dfSJia Liu         tempB = (((int16_t)rs3 >> sa) + var) >> var;                  \
1461461c08dfSJia Liu         tempA = (((int16_t)rs1 >> sa) + var) >> var;                  \
1462461c08dfSJia Liu     }                                                                 \
1463461c08dfSJia Liu                                                                       \
1464461c08dfSJia Liu     return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA);           \
1465461c08dfSJia Liu }
1466461c08dfSJia Liu 
1467461c08dfSJia Liu PRECR_QH_PW(sra, 0);
1468461c08dfSJia Liu PRECR_QH_PW(sra_r, 1);
1469461c08dfSJia Liu 
1470461c08dfSJia Liu #undef PRECR_QH_PW
1471461c08dfSJia Liu 
1472461c08dfSJia Liu target_ulong helper_precrq_ob_qh(target_ulong rs, target_ulong rt)
1473461c08dfSJia Liu {
1474461c08dfSJia Liu     uint8_t rs6, rs4, rs2, rs0;
1475461c08dfSJia Liu     uint8_t rt6, rt4, rt2, rt0;
1476461c08dfSJia Liu     uint64_t temp;
1477461c08dfSJia Liu 
1478461c08dfSJia Liu     rs6 = (rs >> 56) & MIPSDSP_Q0;
1479461c08dfSJia Liu     rs4 = (rs >> 40) & MIPSDSP_Q0;
1480461c08dfSJia Liu     rs2 = (rs >> 24) & MIPSDSP_Q0;
1481461c08dfSJia Liu     rs0 = (rs >> 8) & MIPSDSP_Q0;
1482461c08dfSJia Liu     rt6 = (rt >> 56) & MIPSDSP_Q0;
1483461c08dfSJia Liu     rt4 = (rt >> 40) & MIPSDSP_Q0;
1484461c08dfSJia Liu     rt2 = (rt >> 24) & MIPSDSP_Q0;
1485461c08dfSJia Liu     rt0 = (rt >> 8) & MIPSDSP_Q0;
1486461c08dfSJia Liu 
1487461c08dfSJia Liu     temp = ((uint64_t)rs6 << 56) | ((uint64_t)rs4 << 48) |
1488461c08dfSJia Liu            ((uint64_t)rs2 << 40) | ((uint64_t)rs0 << 32) |
1489461c08dfSJia Liu            ((uint64_t)rt6 << 24) | ((uint64_t)rt4 << 16) |
1490461c08dfSJia Liu            ((uint64_t)rt2 << 8) | (uint64_t)rt0;
1491461c08dfSJia Liu 
1492461c08dfSJia Liu     return temp;
1493461c08dfSJia Liu }
1494461c08dfSJia Liu 
1495461c08dfSJia Liu target_ulong helper_precrq_qh_pw(target_ulong rs, target_ulong rt)
1496461c08dfSJia Liu {
1497461c08dfSJia Liu     uint16_t tempD, tempC, tempB, tempA;
1498461c08dfSJia Liu 
1499461c08dfSJia Liu     tempD = (rs >> 48) & MIPSDSP_LO;
1500461c08dfSJia Liu     tempC = (rs >> 16) & MIPSDSP_LO;
1501461c08dfSJia Liu     tempB = (rt >> 48) & MIPSDSP_LO;
1502461c08dfSJia Liu     tempA = (rt >> 16) & MIPSDSP_LO;
1503461c08dfSJia Liu 
1504461c08dfSJia Liu     return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA);
1505461c08dfSJia Liu }
1506461c08dfSJia Liu 
1507461c08dfSJia Liu target_ulong helper_precrq_rs_qh_pw(target_ulong rs, target_ulong rt,
1508461c08dfSJia Liu                                     CPUMIPSState *env)
1509461c08dfSJia Liu {
1510461c08dfSJia Liu     uint32_t rs2, rs0;
1511461c08dfSJia Liu     uint32_t rt2, rt0;
1512461c08dfSJia Liu     uint16_t tempD, tempC, tempB, tempA;
1513461c08dfSJia Liu 
1514461c08dfSJia Liu     rs2 = (rs >> 32) & MIPSDSP_LLO;
1515461c08dfSJia Liu     rs0 = rs & MIPSDSP_LLO;
1516461c08dfSJia Liu     rt2 = (rt >> 32) & MIPSDSP_LLO;
1517461c08dfSJia Liu     rt0 = rt & MIPSDSP_LLO;
1518461c08dfSJia Liu 
1519461c08dfSJia Liu     tempD = mipsdsp_trunc16_sat16_round(rs2, env);
1520461c08dfSJia Liu     tempC = mipsdsp_trunc16_sat16_round(rs0, env);
1521461c08dfSJia Liu     tempB = mipsdsp_trunc16_sat16_round(rt2, env);
1522461c08dfSJia Liu     tempA = mipsdsp_trunc16_sat16_round(rt0, env);
1523461c08dfSJia Liu 
1524461c08dfSJia Liu     return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA);
1525461c08dfSJia Liu }
1526461c08dfSJia Liu 
1527461c08dfSJia Liu target_ulong helper_precrq_pw_l(target_ulong rs, target_ulong rt)
1528461c08dfSJia Liu {
1529461c08dfSJia Liu     uint32_t tempB, tempA;
1530461c08dfSJia Liu 
1531461c08dfSJia Liu     tempB = (rs >> 32) & MIPSDSP_LLO;
1532461c08dfSJia Liu     tempA = (rt >> 32) & MIPSDSP_LLO;
1533461c08dfSJia Liu 
1534461c08dfSJia Liu     return MIPSDSP_RETURN64_32(tempB, tempA);
1535461c08dfSJia Liu }
1536461c08dfSJia Liu #endif
1537461c08dfSJia Liu 
1538461c08dfSJia Liu target_ulong helper_precrqu_s_qb_ph(target_ulong rs, target_ulong rt,
1539461c08dfSJia Liu                                     CPUMIPSState *env)
1540461c08dfSJia Liu {
1541461c08dfSJia Liu     uint8_t  tempD, tempC, tempB, tempA;
1542461c08dfSJia Liu     uint16_t rsh, rsl, rth, rtl;
1543461c08dfSJia Liu 
1544461c08dfSJia Liu     rsh = (rs & MIPSDSP_HI) >> 16;
1545461c08dfSJia Liu     rsl =  rs & MIPSDSP_LO;
1546461c08dfSJia Liu     rth = (rt & MIPSDSP_HI) >> 16;
1547461c08dfSJia Liu     rtl =  rt & MIPSDSP_LO;
1548461c08dfSJia Liu 
1549461c08dfSJia Liu     tempD = mipsdsp_sat8_reduce_precision(rsh, env);
1550461c08dfSJia Liu     tempC = mipsdsp_sat8_reduce_precision(rsl, env);
1551461c08dfSJia Liu     tempB = mipsdsp_sat8_reduce_precision(rth, env);
1552461c08dfSJia Liu     tempA = mipsdsp_sat8_reduce_precision(rtl, env);
1553461c08dfSJia Liu 
1554461c08dfSJia Liu     return MIPSDSP_RETURN32_8(tempD, tempC, tempB, tempA);
1555461c08dfSJia Liu }
1556461c08dfSJia Liu 
1557461c08dfSJia Liu #if defined(TARGET_MIPS64)
1558461c08dfSJia Liu target_ulong helper_precrqu_s_ob_qh(target_ulong rs, target_ulong rt,
1559461c08dfSJia Liu                                     CPUMIPSState *env)
1560461c08dfSJia Liu {
1561461c08dfSJia Liu     int i;
1562461c08dfSJia Liu     uint16_t rs3, rs2, rs1, rs0;
1563461c08dfSJia Liu     uint16_t rt3, rt2, rt1, rt0;
1564461c08dfSJia Liu     uint8_t temp[8];
1565461c08dfSJia Liu     uint64_t result;
1566461c08dfSJia Liu 
1567461c08dfSJia Liu     result = 0;
1568461c08dfSJia Liu 
1569461c08dfSJia Liu     MIPSDSP_SPLIT64_16(rs, rs3, rs2, rs1, rs0);
1570461c08dfSJia Liu     MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0);
1571461c08dfSJia Liu 
1572461c08dfSJia Liu     temp[7] = mipsdsp_sat8_reduce_precision(rs3, env);
1573461c08dfSJia Liu     temp[6] = mipsdsp_sat8_reduce_precision(rs2, env);
1574461c08dfSJia Liu     temp[5] = mipsdsp_sat8_reduce_precision(rs1, env);
1575461c08dfSJia Liu     temp[4] = mipsdsp_sat8_reduce_precision(rs0, env);
1576461c08dfSJia Liu     temp[3] = mipsdsp_sat8_reduce_precision(rt3, env);
1577461c08dfSJia Liu     temp[2] = mipsdsp_sat8_reduce_precision(rt2, env);
1578461c08dfSJia Liu     temp[1] = mipsdsp_sat8_reduce_precision(rt1, env);
1579461c08dfSJia Liu     temp[0] = mipsdsp_sat8_reduce_precision(rt0, env);
1580461c08dfSJia Liu 
1581461c08dfSJia Liu     for (i = 0; i < 8; i++) {
1582461c08dfSJia Liu         result |= (uint64_t)temp[i] << (8 * i);
1583461c08dfSJia Liu     }
1584461c08dfSJia Liu 
1585461c08dfSJia Liu     return result;
1586461c08dfSJia Liu }
1587461c08dfSJia Liu 
1588461c08dfSJia Liu #define PRECEQ_PW(name, a, b) \
1589461c08dfSJia Liu target_ulong helper_preceq_pw_##name(target_ulong rt) \
1590461c08dfSJia Liu {                                                       \
1591461c08dfSJia Liu     uint16_t tempB, tempA;                              \
1592461c08dfSJia Liu     uint32_t tempBI, tempAI;                            \
1593461c08dfSJia Liu                                                         \
1594461c08dfSJia Liu     tempB = (rt >> a) & MIPSDSP_LO;                     \
1595461c08dfSJia Liu     tempA = (rt >> b) & MIPSDSP_LO;                     \
1596461c08dfSJia Liu                                                         \
1597461c08dfSJia Liu     tempBI = (uint32_t)tempB << 16;                     \
1598461c08dfSJia Liu     tempAI = (uint32_t)tempA << 16;                     \
1599461c08dfSJia Liu                                                         \
1600461c08dfSJia Liu     return MIPSDSP_RETURN64_32(tempBI, tempAI);         \
1601461c08dfSJia Liu }
1602461c08dfSJia Liu 
1603461c08dfSJia Liu PRECEQ_PW(qhl, 48, 32);
1604461c08dfSJia Liu PRECEQ_PW(qhr, 16, 0);
1605461c08dfSJia Liu PRECEQ_PW(qhla, 48, 16);
1606461c08dfSJia Liu PRECEQ_PW(qhra, 32, 0);
1607461c08dfSJia Liu 
1608461c08dfSJia Liu #undef PRECEQ_PW
1609461c08dfSJia Liu 
1610461c08dfSJia Liu #endif
1611461c08dfSJia Liu 
1612461c08dfSJia Liu #define PRECEQU_PH(name, a, b) \
1613461c08dfSJia Liu target_ulong helper_precequ_ph_##name(target_ulong rt) \
1614461c08dfSJia Liu {                                                        \
1615461c08dfSJia Liu     uint16_t tempB, tempA;                               \
1616461c08dfSJia Liu                                                          \
1617461c08dfSJia Liu     tempB = (rt >> a) & MIPSDSP_Q0;                      \
1618461c08dfSJia Liu     tempA = (rt >> b) & MIPSDSP_Q0;                      \
1619461c08dfSJia Liu                                                          \
1620461c08dfSJia Liu     tempB = tempB << 7;                                  \
1621461c08dfSJia Liu     tempA = tempA << 7;                                  \
1622461c08dfSJia Liu                                                          \
1623461c08dfSJia Liu     return MIPSDSP_RETURN32_16(tempB, tempA);            \
1624461c08dfSJia Liu }
1625461c08dfSJia Liu 
1626461c08dfSJia Liu PRECEQU_PH(qbl, 24, 16);
1627461c08dfSJia Liu PRECEQU_PH(qbr, 8, 0);
1628461c08dfSJia Liu PRECEQU_PH(qbla, 24, 8);
1629461c08dfSJia Liu PRECEQU_PH(qbra, 16, 0);
1630461c08dfSJia Liu 
1631461c08dfSJia Liu #undef PRECEQU_PH
1632461c08dfSJia Liu 
1633461c08dfSJia Liu #if defined(TARGET_MIPS64)
1634461c08dfSJia Liu #define PRECEQU_QH(name, a, b, c, d) \
1635461c08dfSJia Liu target_ulong helper_precequ_qh_##name(target_ulong rt)       \
1636461c08dfSJia Liu {                                                            \
1637461c08dfSJia Liu     uint16_t tempD, tempC, tempB, tempA;                     \
1638461c08dfSJia Liu                                                              \
1639461c08dfSJia Liu     tempD = (rt >> a) & MIPSDSP_Q0;                          \
1640461c08dfSJia Liu     tempC = (rt >> b) & MIPSDSP_Q0;                          \
1641461c08dfSJia Liu     tempB = (rt >> c) & MIPSDSP_Q0;                          \
1642461c08dfSJia Liu     tempA = (rt >> d) & MIPSDSP_Q0;                          \
1643461c08dfSJia Liu                                                              \
1644461c08dfSJia Liu     tempD = tempD << 7;                                      \
1645461c08dfSJia Liu     tempC = tempC << 7;                                      \
1646461c08dfSJia Liu     tempB = tempB << 7;                                      \
1647461c08dfSJia Liu     tempA = tempA << 7;                                      \
1648461c08dfSJia Liu                                                              \
1649461c08dfSJia Liu     return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA);  \
1650461c08dfSJia Liu }
1651461c08dfSJia Liu 
1652461c08dfSJia Liu PRECEQU_QH(obl, 56, 48, 40, 32);
1653461c08dfSJia Liu PRECEQU_QH(obr, 24, 16, 8, 0);
1654461c08dfSJia Liu PRECEQU_QH(obla, 56, 40, 24, 8);
1655461c08dfSJia Liu PRECEQU_QH(obra, 48, 32, 16, 0);
1656461c08dfSJia Liu 
1657461c08dfSJia Liu #undef PRECEQU_QH
1658461c08dfSJia Liu 
1659461c08dfSJia Liu #endif
1660461c08dfSJia Liu 
1661461c08dfSJia Liu #define PRECEU_PH(name, a, b) \
1662461c08dfSJia Liu target_ulong helper_preceu_ph_##name(target_ulong rt) \
1663461c08dfSJia Liu {                                                     \
1664461c08dfSJia Liu     uint16_t tempB, tempA;                            \
1665461c08dfSJia Liu                                                       \
1666461c08dfSJia Liu     tempB = (rt >> a) & MIPSDSP_Q0;                   \
1667461c08dfSJia Liu     tempA = (rt >> b) & MIPSDSP_Q0;                   \
1668461c08dfSJia Liu                                                       \
1669461c08dfSJia Liu     return MIPSDSP_RETURN32_16(tempB, tempA);         \
1670461c08dfSJia Liu }
1671461c08dfSJia Liu 
1672461c08dfSJia Liu PRECEU_PH(qbl, 24, 16);
1673461c08dfSJia Liu PRECEU_PH(qbr, 8, 0);
1674461c08dfSJia Liu PRECEU_PH(qbla, 24, 8);
1675461c08dfSJia Liu PRECEU_PH(qbra, 16, 0);
1676461c08dfSJia Liu 
1677461c08dfSJia Liu #undef PRECEU_PH
1678461c08dfSJia Liu 
1679461c08dfSJia Liu #if defined(TARGET_MIPS64)
1680461c08dfSJia Liu #define PRECEU_QH(name, a, b, c, d) \
1681461c08dfSJia Liu target_ulong helper_preceu_qh_##name(target_ulong rt)        \
1682461c08dfSJia Liu {                                                            \
1683461c08dfSJia Liu     uint16_t tempD, tempC, tempB, tempA;                     \
1684461c08dfSJia Liu                                                              \
1685461c08dfSJia Liu     tempD = (rt >> a) & MIPSDSP_Q0;                          \
1686461c08dfSJia Liu     tempC = (rt >> b) & MIPSDSP_Q0;                          \
1687461c08dfSJia Liu     tempB = (rt >> c) & MIPSDSP_Q0;                          \
1688461c08dfSJia Liu     tempA = (rt >> d) & MIPSDSP_Q0;                          \
1689461c08dfSJia Liu                                                              \
1690461c08dfSJia Liu     return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA);  \
1691461c08dfSJia Liu }
1692461c08dfSJia Liu 
1693461c08dfSJia Liu PRECEU_QH(obl, 56, 48, 40, 32);
1694461c08dfSJia Liu PRECEU_QH(obr, 24, 16, 8, 0);
1695461c08dfSJia Liu PRECEU_QH(obla, 56, 40, 24, 8);
1696461c08dfSJia Liu PRECEU_QH(obra, 48, 32, 16, 0);
1697461c08dfSJia Liu 
1698461c08dfSJia Liu #undef PRECEU_QH
1699461c08dfSJia Liu 
1700461c08dfSJia Liu #endif
1701461c08dfSJia Liu 
170277c5fa8bSJia Liu /** DSP GPR-Based Shift Sub-class insns **/
170377c5fa8bSJia Liu #define SHIFT_QB(name, func) \
170477c5fa8bSJia Liu target_ulong helper_##name##_qb(target_ulong sa, target_ulong rt) \
170577c5fa8bSJia Liu {                                                                    \
170677c5fa8bSJia Liu     uint8_t rt3, rt2, rt1, rt0;                                      \
170777c5fa8bSJia Liu                                                                      \
170877c5fa8bSJia Liu     sa = sa & 0x07;                                                  \
170977c5fa8bSJia Liu                                                                      \
171077c5fa8bSJia Liu     MIPSDSP_SPLIT32_8(rt, rt3, rt2, rt1, rt0);                       \
171177c5fa8bSJia Liu                                                                      \
171277c5fa8bSJia Liu     rt3 = mipsdsp_##func(rt3, sa);                                   \
171377c5fa8bSJia Liu     rt2 = mipsdsp_##func(rt2, sa);                                   \
171477c5fa8bSJia Liu     rt1 = mipsdsp_##func(rt1, sa);                                   \
171577c5fa8bSJia Liu     rt0 = mipsdsp_##func(rt0, sa);                                   \
171677c5fa8bSJia Liu                                                                      \
171777c5fa8bSJia Liu     return MIPSDSP_RETURN32_8(rt3, rt2, rt1, rt0);                   \
171877c5fa8bSJia Liu }
171977c5fa8bSJia Liu 
172077c5fa8bSJia Liu #define SHIFT_QB_ENV(name, func) \
172177c5fa8bSJia Liu target_ulong helper_##name##_qb(target_ulong sa, target_ulong rt,\
172277c5fa8bSJia Liu                                 CPUMIPSState *env) \
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, env);                              \
173177c5fa8bSJia Liu     rt2 = mipsdsp_##func(rt2, sa, env);                              \
173277c5fa8bSJia Liu     rt1 = mipsdsp_##func(rt1, sa, env);                              \
173377c5fa8bSJia Liu     rt0 = mipsdsp_##func(rt0, sa, env);                              \
173477c5fa8bSJia Liu                                                                      \
173577c5fa8bSJia Liu     return MIPSDSP_RETURN32_8(rt3, rt2, rt1, rt0);                   \
173677c5fa8bSJia Liu }
173777c5fa8bSJia Liu 
173877c5fa8bSJia Liu SHIFT_QB_ENV(shll, lshift8);
173977c5fa8bSJia Liu SHIFT_QB(shrl, rshift_u8);
174077c5fa8bSJia Liu 
174177c5fa8bSJia Liu SHIFT_QB(shra, rashift8);
174277c5fa8bSJia Liu SHIFT_QB(shra_r, rnd8_rashift);
174377c5fa8bSJia Liu 
174477c5fa8bSJia Liu #undef SHIFT_QB
174577c5fa8bSJia Liu #undef SHIFT_QB_ENV
174677c5fa8bSJia Liu 
174777c5fa8bSJia Liu #if defined(TARGET_MIPS64)
174877c5fa8bSJia Liu #define SHIFT_OB(name, func) \
174977c5fa8bSJia Liu target_ulong helper_##name##_ob(target_ulong rt, target_ulong sa) \
175077c5fa8bSJia Liu {                                                                        \
175177c5fa8bSJia Liu     int i;                                                               \
175277c5fa8bSJia Liu     uint8_t rt_t[8];                                                     \
175377c5fa8bSJia Liu     uint64_t temp;                                                       \
175477c5fa8bSJia Liu                                                                          \
175577c5fa8bSJia Liu     sa = sa & 0x07;                                                      \
175677c5fa8bSJia Liu     temp = 0;                                                            \
175777c5fa8bSJia Liu                                                                          \
175877c5fa8bSJia Liu     for (i = 0; i < 8; i++) {                                            \
175977c5fa8bSJia Liu         rt_t[i] = (rt >> (8 * i)) & MIPSDSP_Q0;                          \
176077c5fa8bSJia Liu         rt_t[i] = mipsdsp_##func(rt_t[i], sa);                           \
176177c5fa8bSJia Liu         temp |= (uint64_t)rt_t[i] << (8 * i);                            \
176277c5fa8bSJia Liu     }                                                                    \
176377c5fa8bSJia Liu                                                                          \
176477c5fa8bSJia Liu     return temp;                                                         \
176577c5fa8bSJia Liu }
176677c5fa8bSJia Liu 
176777c5fa8bSJia Liu #define SHIFT_OB_ENV(name, func) \
176877c5fa8bSJia Liu target_ulong helper_##name##_ob(target_ulong rt, target_ulong sa, \
176977c5fa8bSJia Liu                                 CPUMIPSState *env)                       \
177077c5fa8bSJia Liu {                                                                        \
177177c5fa8bSJia Liu     int i;                                                               \
177277c5fa8bSJia Liu     uint8_t rt_t[8];                                                     \
177377c5fa8bSJia Liu     uint64_t temp;                                                       \
177477c5fa8bSJia Liu                                                                          \
177577c5fa8bSJia Liu     sa = sa & 0x07;                                                      \
177677c5fa8bSJia Liu     temp = 0;                                                            \
177777c5fa8bSJia Liu                                                                          \
177877c5fa8bSJia Liu     for (i = 0; i < 8; i++) {                                            \
177977c5fa8bSJia Liu         rt_t[i] = (rt >> (8 * i)) & MIPSDSP_Q0;                          \
178077c5fa8bSJia Liu         rt_t[i] = mipsdsp_##func(rt_t[i], sa, env);                      \
178177c5fa8bSJia Liu         temp |= (uint64_t)rt_t[i] << (8 * i);                            \
178277c5fa8bSJia Liu     }                                                                    \
178377c5fa8bSJia Liu                                                                          \
178477c5fa8bSJia Liu     return temp;                                                         \
178577c5fa8bSJia Liu }
178677c5fa8bSJia Liu 
178777c5fa8bSJia Liu SHIFT_OB_ENV(shll, lshift8);
178877c5fa8bSJia Liu SHIFT_OB(shrl, rshift_u8);
178977c5fa8bSJia Liu 
179077c5fa8bSJia Liu SHIFT_OB(shra, rashift8);
179177c5fa8bSJia Liu SHIFT_OB(shra_r, rnd8_rashift);
179277c5fa8bSJia Liu 
179377c5fa8bSJia Liu #undef SHIFT_OB
179477c5fa8bSJia Liu #undef SHIFT_OB_ENV
179577c5fa8bSJia Liu 
179677c5fa8bSJia Liu #endif
179777c5fa8bSJia Liu 
179877c5fa8bSJia Liu #define SHIFT_PH(name, func) \
179977c5fa8bSJia Liu target_ulong helper_##name##_ph(target_ulong sa, target_ulong rt, \
180077c5fa8bSJia Liu                                 CPUMIPSState *env)                \
180177c5fa8bSJia Liu {                                                                 \
180277c5fa8bSJia Liu     uint16_t rth, rtl;                                            \
180377c5fa8bSJia Liu                                                                   \
180477c5fa8bSJia Liu     sa = sa & 0x0F;                                               \
180577c5fa8bSJia Liu                                                                   \
180677c5fa8bSJia Liu     MIPSDSP_SPLIT32_16(rt, rth, rtl);                             \
180777c5fa8bSJia Liu                                                                   \
180877c5fa8bSJia Liu     rth = mipsdsp_##func(rth, sa, env);                           \
180977c5fa8bSJia Liu     rtl = mipsdsp_##func(rtl, sa, env);                           \
181077c5fa8bSJia Liu                                                                   \
181177c5fa8bSJia Liu     return MIPSDSP_RETURN32_16(rth, rtl);                         \
181277c5fa8bSJia Liu }
181377c5fa8bSJia Liu 
181477c5fa8bSJia Liu SHIFT_PH(shll, lshift16);
181577c5fa8bSJia Liu SHIFT_PH(shll_s, sat16_lshift);
181677c5fa8bSJia Liu 
181777c5fa8bSJia Liu #undef SHIFT_PH
181877c5fa8bSJia Liu 
181977c5fa8bSJia Liu #if defined(TARGET_MIPS64)
182077c5fa8bSJia Liu #define SHIFT_QH(name, func) \
182177c5fa8bSJia Liu target_ulong helper_##name##_qh(target_ulong rt, target_ulong sa) \
182277c5fa8bSJia Liu {                                                                 \
182377c5fa8bSJia Liu     uint16_t rt3, rt2, rt1, rt0;                                  \
182477c5fa8bSJia Liu                                                                   \
182577c5fa8bSJia Liu     sa = sa & 0x0F;                                               \
182677c5fa8bSJia Liu                                                                   \
182777c5fa8bSJia Liu     MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0);                   \
182877c5fa8bSJia Liu                                                                   \
182977c5fa8bSJia Liu     rt3 = mipsdsp_##func(rt3, sa);                                \
183077c5fa8bSJia Liu     rt2 = mipsdsp_##func(rt2, sa);                                \
183177c5fa8bSJia Liu     rt1 = mipsdsp_##func(rt1, sa);                                \
183277c5fa8bSJia Liu     rt0 = mipsdsp_##func(rt0, sa);                                \
183377c5fa8bSJia Liu                                                                   \
183477c5fa8bSJia Liu     return MIPSDSP_RETURN64_16(rt3, rt2, rt1, rt0);               \
183577c5fa8bSJia Liu }
183677c5fa8bSJia Liu 
183777c5fa8bSJia Liu #define SHIFT_QH_ENV(name, func) \
183877c5fa8bSJia Liu target_ulong helper_##name##_qh(target_ulong rt, target_ulong sa, \
183977c5fa8bSJia Liu                                 CPUMIPSState *env)                \
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, env);                           \
184877c5fa8bSJia Liu     rt2 = mipsdsp_##func(rt2, sa, env);                           \
184977c5fa8bSJia Liu     rt1 = mipsdsp_##func(rt1, sa, env);                           \
185077c5fa8bSJia Liu     rt0 = mipsdsp_##func(rt0, sa, env);                           \
185177c5fa8bSJia Liu                                                                   \
185277c5fa8bSJia Liu     return MIPSDSP_RETURN64_16(rt3, rt2, rt1, rt0);               \
185377c5fa8bSJia Liu }
185477c5fa8bSJia Liu 
185577c5fa8bSJia Liu SHIFT_QH_ENV(shll, lshift16);
185677c5fa8bSJia Liu SHIFT_QH_ENV(shll_s, sat16_lshift);
185777c5fa8bSJia Liu 
185877c5fa8bSJia Liu SHIFT_QH(shrl, rshift_u16);
185977c5fa8bSJia Liu SHIFT_QH(shra, rashift16);
186077c5fa8bSJia Liu SHIFT_QH(shra_r, rnd16_rashift);
186177c5fa8bSJia Liu 
186277c5fa8bSJia Liu #undef SHIFT_QH
186377c5fa8bSJia Liu #undef SHIFT_QH_ENV
186477c5fa8bSJia Liu 
186577c5fa8bSJia Liu #endif
186677c5fa8bSJia Liu 
186777c5fa8bSJia Liu #define SHIFT_W(name, func) \
186877c5fa8bSJia Liu target_ulong helper_##name##_w(target_ulong sa, target_ulong rt) \
186977c5fa8bSJia Liu {                                                                       \
187077c5fa8bSJia Liu     uint32_t temp;                                                      \
187177c5fa8bSJia Liu                                                                         \
187277c5fa8bSJia Liu     sa = sa & 0x1F;                                                     \
187377c5fa8bSJia Liu     temp = mipsdsp_##func(rt, sa);                                      \
187477c5fa8bSJia Liu                                                                         \
187577c5fa8bSJia Liu     return (target_long)(int32_t)temp;                                  \
187677c5fa8bSJia Liu }
187777c5fa8bSJia Liu 
187877c5fa8bSJia Liu #define SHIFT_W_ENV(name, func) \
187977c5fa8bSJia Liu target_ulong helper_##name##_w(target_ulong sa, target_ulong rt, \
188077c5fa8bSJia Liu                                CPUMIPSState *env) \
188177c5fa8bSJia Liu {                                                                       \
188277c5fa8bSJia Liu     uint32_t temp;                                                      \
188377c5fa8bSJia Liu                                                                         \
188477c5fa8bSJia Liu     sa = sa & 0x1F;                                                     \
188577c5fa8bSJia Liu     temp = mipsdsp_##func(rt, sa, env);                                 \
188677c5fa8bSJia Liu                                                                         \
188777c5fa8bSJia Liu     return (target_long)(int32_t)temp;                                  \
188877c5fa8bSJia Liu }
188977c5fa8bSJia Liu 
189077c5fa8bSJia Liu SHIFT_W_ENV(shll_s, sat32_lshift);
189177c5fa8bSJia Liu SHIFT_W(shra_r, rnd32_rashift);
189277c5fa8bSJia Liu 
189377c5fa8bSJia Liu #undef SHIFT_W
189477c5fa8bSJia Liu #undef SHIFT_W_ENV
189577c5fa8bSJia Liu 
189677c5fa8bSJia Liu #if defined(TARGET_MIPS64)
189777c5fa8bSJia Liu #define SHIFT_PW(name, func) \
189877c5fa8bSJia Liu target_ulong helper_##name##_pw(target_ulong rt, target_ulong sa) \
189977c5fa8bSJia Liu {                                                                 \
190077c5fa8bSJia Liu     uint32_t rt1, rt0;                                            \
190177c5fa8bSJia Liu                                                                   \
190277c5fa8bSJia Liu     sa = sa & 0x1F;                                               \
190377c5fa8bSJia Liu     MIPSDSP_SPLIT64_32(rt, rt1, rt0);                             \
190477c5fa8bSJia Liu                                                                   \
190577c5fa8bSJia Liu     rt1 = mipsdsp_##func(rt1, sa);                                \
190677c5fa8bSJia Liu     rt0 = mipsdsp_##func(rt0, sa);                                \
190777c5fa8bSJia Liu                                                                   \
190877c5fa8bSJia Liu     return MIPSDSP_RETURN64_32(rt1, rt0);                         \
190977c5fa8bSJia Liu }
191077c5fa8bSJia Liu 
191177c5fa8bSJia Liu #define SHIFT_PW_ENV(name, func) \
191277c5fa8bSJia Liu target_ulong helper_##name##_pw(target_ulong rt, target_ulong sa, \
191377c5fa8bSJia Liu                                 CPUMIPSState *env)                \
191477c5fa8bSJia Liu {                                                                 \
191577c5fa8bSJia Liu     uint32_t rt1, rt0;                                            \
191677c5fa8bSJia Liu                                                                   \
191777c5fa8bSJia Liu     sa = sa & 0x1F;                                               \
191877c5fa8bSJia Liu     MIPSDSP_SPLIT64_32(rt, rt1, rt0);                             \
191977c5fa8bSJia Liu                                                                   \
192077c5fa8bSJia Liu     rt1 = mipsdsp_##func(rt1, sa, env);                           \
192177c5fa8bSJia Liu     rt0 = mipsdsp_##func(rt0, sa, env);                           \
192277c5fa8bSJia Liu                                                                   \
192377c5fa8bSJia Liu     return MIPSDSP_RETURN64_32(rt1, rt0);                         \
192477c5fa8bSJia Liu }
192577c5fa8bSJia Liu 
192677c5fa8bSJia Liu SHIFT_PW_ENV(shll, lshift32);
192777c5fa8bSJia Liu SHIFT_PW_ENV(shll_s, sat32_lshift);
192877c5fa8bSJia Liu 
192977c5fa8bSJia Liu SHIFT_PW(shra, rashift32);
193077c5fa8bSJia Liu SHIFT_PW(shra_r, rnd32_rashift);
193177c5fa8bSJia Liu 
193277c5fa8bSJia Liu #undef SHIFT_PW
193377c5fa8bSJia Liu #undef SHIFT_PW_ENV
193477c5fa8bSJia Liu 
193577c5fa8bSJia Liu #endif
193677c5fa8bSJia Liu 
193777c5fa8bSJia Liu #define SHIFT_PH(name, func) \
193877c5fa8bSJia Liu target_ulong helper_##name##_ph(target_ulong sa, target_ulong rt) \
193977c5fa8bSJia Liu {                                                                    \
194077c5fa8bSJia Liu     uint16_t rth, rtl;                                               \
194177c5fa8bSJia Liu                                                                      \
194277c5fa8bSJia Liu     sa = sa & 0x0F;                                                  \
194377c5fa8bSJia Liu                                                                      \
194477c5fa8bSJia Liu     MIPSDSP_SPLIT32_16(rt, rth, rtl);                                \
194577c5fa8bSJia Liu                                                                      \
194677c5fa8bSJia Liu     rth = mipsdsp_##func(rth, sa);                                   \
194777c5fa8bSJia Liu     rtl = mipsdsp_##func(rtl, sa);                                   \
194877c5fa8bSJia Liu                                                                      \
194977c5fa8bSJia Liu     return MIPSDSP_RETURN32_16(rth, rtl);                            \
195077c5fa8bSJia Liu }
195177c5fa8bSJia Liu 
195277c5fa8bSJia Liu SHIFT_PH(shrl, rshift_u16);
195377c5fa8bSJia Liu SHIFT_PH(shra, rashift16);
195477c5fa8bSJia Liu SHIFT_PH(shra_r, rnd16_rashift);
195577c5fa8bSJia Liu 
195677c5fa8bSJia Liu #undef SHIFT_PH
195777c5fa8bSJia Liu 
1958a22260aeSJia Liu /** DSP Multiply Sub-class insns **/
1959a22260aeSJia Liu /* Return value made up by two 16bits value.
1960a22260aeSJia Liu  * FIXME give the macro a better name.
1961a22260aeSJia Liu  */
1962a22260aeSJia Liu #define MUL_RETURN32_16_PH(name, func, \
1963a22260aeSJia Liu                            rsmov1, rsmov2, rsfilter, \
1964a22260aeSJia Liu                            rtmov1, rtmov2, rtfilter) \
1965a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt, \
1966a22260aeSJia Liu                            CPUMIPSState *env)                \
1967a22260aeSJia Liu {                                                            \
1968a22260aeSJia Liu     uint16_t rsB, rsA, rtB, rtA;                             \
1969a22260aeSJia Liu                                                              \
1970a22260aeSJia Liu     rsB = (rs >> rsmov1) & rsfilter;                         \
1971a22260aeSJia Liu     rsA = (rs >> rsmov2) & rsfilter;                         \
1972a22260aeSJia Liu     rtB = (rt >> rtmov1) & rtfilter;                         \
1973a22260aeSJia Liu     rtA = (rt >> rtmov2) & rtfilter;                         \
1974a22260aeSJia Liu                                                              \
1975a22260aeSJia Liu     rsB = mipsdsp_##func(rsB, rtB, env);                     \
1976a22260aeSJia Liu     rsA = mipsdsp_##func(rsA, rtA, env);                     \
1977a22260aeSJia Liu                                                              \
1978a22260aeSJia Liu     return MIPSDSP_RETURN32_16(rsB, rsA);                    \
1979a22260aeSJia Liu }
1980a22260aeSJia Liu 
1981a22260aeSJia Liu MUL_RETURN32_16_PH(muleu_s_ph_qbl, mul_u8_u16, \
1982a22260aeSJia Liu                       24, 16, MIPSDSP_Q0, \
1983a22260aeSJia Liu                       16, 0, MIPSDSP_LO);
1984a22260aeSJia Liu MUL_RETURN32_16_PH(muleu_s_ph_qbr, mul_u8_u16, \
1985a22260aeSJia Liu                       8, 0, MIPSDSP_Q0, \
1986a22260aeSJia Liu                       16, 0, MIPSDSP_LO);
1987a22260aeSJia Liu MUL_RETURN32_16_PH(mulq_rs_ph, rndq15_mul_q15_q15, \
1988a22260aeSJia Liu                       16, 0, MIPSDSP_LO, \
1989a22260aeSJia Liu                       16, 0, MIPSDSP_LO);
1990a22260aeSJia Liu MUL_RETURN32_16_PH(mul_ph, mul_i16_i16, \
1991a22260aeSJia Liu                       16, 0, MIPSDSP_LO, \
1992a22260aeSJia Liu                       16, 0, MIPSDSP_LO);
1993a22260aeSJia Liu MUL_RETURN32_16_PH(mul_s_ph, sat16_mul_i16_i16, \
1994a22260aeSJia Liu                       16, 0, MIPSDSP_LO, \
1995a22260aeSJia Liu                       16, 0, MIPSDSP_LO);
1996a22260aeSJia Liu MUL_RETURN32_16_PH(mulq_s_ph, sat16_mul_q15_q15, \
1997a22260aeSJia Liu                       16, 0, MIPSDSP_LO, \
1998a22260aeSJia Liu                       16, 0, MIPSDSP_LO);
1999a22260aeSJia Liu 
2000a22260aeSJia Liu #undef MUL_RETURN32_16_PH
2001a22260aeSJia Liu 
2002a22260aeSJia Liu #define MUL_RETURN32_32_ph(name, func, movbits) \
2003a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt, \
2004a22260aeSJia Liu                                   CPUMIPSState *env)         \
2005a22260aeSJia Liu {                                                            \
2006a22260aeSJia Liu     int16_t rsh, rth;                                        \
2007a22260aeSJia Liu     int32_t temp;                                            \
2008a22260aeSJia Liu                                                              \
2009a22260aeSJia Liu     rsh = (rs >> movbits) & MIPSDSP_LO;                      \
2010a22260aeSJia Liu     rth = (rt >> movbits) & MIPSDSP_LO;                      \
2011a22260aeSJia Liu     temp = mipsdsp_##func(rsh, rth, env);                    \
2012a22260aeSJia Liu                                                              \
2013a22260aeSJia Liu     return (target_long)(int32_t)temp;                       \
2014a22260aeSJia Liu }
2015a22260aeSJia Liu 
2016a22260aeSJia Liu MUL_RETURN32_32_ph(muleq_s_w_phl, mul_q15_q15_overflowflag21, 16);
2017a22260aeSJia Liu MUL_RETURN32_32_ph(muleq_s_w_phr, mul_q15_q15_overflowflag21, 0);
2018a22260aeSJia Liu 
2019a22260aeSJia Liu #undef MUL_RETURN32_32_ph
2020a22260aeSJia Liu 
2021a22260aeSJia Liu #define MUL_VOID_PH(name, use_ac_env) \
2022a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt,        \
2023a22260aeSJia Liu                           CPUMIPSState *env)                             \
2024a22260aeSJia Liu {                                                                        \
2025a22260aeSJia Liu     int16_t rsh, rsl, rth, rtl;                                          \
2026a22260aeSJia Liu     int32_t tempB, tempA;                                                \
2027a22260aeSJia Liu     int64_t acc, dotp;                                                   \
2028a22260aeSJia Liu                                                                          \
2029a22260aeSJia Liu     MIPSDSP_SPLIT32_16(rs, rsh, rsl);                                    \
2030a22260aeSJia Liu     MIPSDSP_SPLIT32_16(rt, rth, rtl);                                    \
2031a22260aeSJia Liu                                                                          \
2032a22260aeSJia Liu     if (use_ac_env == 1) {                                               \
2033a22260aeSJia Liu         tempB = mipsdsp_mul_q15_q15(ac, rsh, rth, env);                  \
2034a22260aeSJia Liu         tempA = mipsdsp_mul_q15_q15(ac, rsl, rtl, env);                  \
2035a22260aeSJia Liu     } else {                                                             \
2036a22260aeSJia Liu         tempB = mipsdsp_mul_u16_u16(rsh, rth);                           \
2037a22260aeSJia Liu         tempA = mipsdsp_mul_u16_u16(rsl, rtl);                           \
2038a22260aeSJia Liu     }                                                                    \
2039a22260aeSJia Liu                                                                          \
2040a22260aeSJia Liu     dotp = (int64_t)tempB - (int64_t)tempA;                              \
2041a22260aeSJia Liu     acc = ((uint64_t)env->active_tc.HI[ac] << 32) |                      \
2042a22260aeSJia Liu           ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO);               \
2043a22260aeSJia Liu     dotp = dotp + acc;                                                   \
2044a22260aeSJia Liu     env->active_tc.HI[ac] = (target_long)(int32_t)                       \
2045a22260aeSJia Liu                             ((dotp & MIPSDSP_LHI) >> 32);                \
2046a22260aeSJia Liu     env->active_tc.LO[ac] = (target_long)(int32_t)(dotp & MIPSDSP_LLO);  \
2047a22260aeSJia Liu }
2048a22260aeSJia Liu 
2049a22260aeSJia Liu MUL_VOID_PH(mulsaq_s_w_ph, 1);
2050a22260aeSJia Liu MUL_VOID_PH(mulsa_w_ph, 0);
2051a22260aeSJia Liu 
2052a22260aeSJia Liu #undef MUL_VOID_PH
2053a22260aeSJia Liu 
2054a22260aeSJia Liu #if defined(TARGET_MIPS64)
2055a22260aeSJia Liu #define MUL_RETURN64_16_QH(name, func, \
2056a22260aeSJia Liu                            rsmov1, rsmov2, rsmov3, rsmov4, rsfilter, \
2057a22260aeSJia Liu                            rtmov1, rtmov2, rtmov3, rtmov4, rtfilter) \
2058a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt,         \
2059a22260aeSJia Liu                            CPUMIPSState *env)                        \
2060a22260aeSJia Liu {                                                                    \
2061a22260aeSJia Liu     uint16_t rs3, rs2, rs1, rs0;                                     \
2062a22260aeSJia Liu     uint16_t rt3, rt2, rt1, rt0;                                     \
2063a22260aeSJia Liu     uint16_t tempD, tempC, tempB, tempA;                             \
2064a22260aeSJia Liu                                                                      \
2065a22260aeSJia Liu     rs3 = (rs >> rsmov1) & rsfilter;                                 \
2066a22260aeSJia Liu     rs2 = (rs >> rsmov2) & rsfilter;                                 \
2067a22260aeSJia Liu     rs1 = (rs >> rsmov3) & rsfilter;                                 \
2068a22260aeSJia Liu     rs0 = (rs >> rsmov4) & rsfilter;                                 \
2069a22260aeSJia Liu     rt3 = (rt >> rtmov1) & rtfilter;                                 \
2070a22260aeSJia Liu     rt2 = (rt >> rtmov2) & rtfilter;                                 \
2071a22260aeSJia Liu     rt1 = (rt >> rtmov3) & rtfilter;                                 \
2072a22260aeSJia Liu     rt0 = (rt >> rtmov4) & rtfilter;                                 \
2073a22260aeSJia Liu                                                                      \
2074a22260aeSJia Liu     tempD = mipsdsp_##func(rs3, rt3, env);                           \
2075a22260aeSJia Liu     tempC = mipsdsp_##func(rs2, rt2, env);                           \
2076a22260aeSJia Liu     tempB = mipsdsp_##func(rs1, rt1, env);                           \
2077a22260aeSJia Liu     tempA = mipsdsp_##func(rs0, rt0, env);                           \
2078a22260aeSJia Liu                                                                      \
2079a22260aeSJia Liu     return MIPSDSP_RETURN64_16(tempD, tempC, tempB, tempA);          \
2080a22260aeSJia Liu }
2081a22260aeSJia Liu 
2082a22260aeSJia Liu MUL_RETURN64_16_QH(muleu_s_qh_obl, mul_u8_u16, \
2083a22260aeSJia Liu                    56, 48, 40, 32, MIPSDSP_Q0, \
2084a22260aeSJia Liu                    48, 32, 16, 0, MIPSDSP_LO);
2085a22260aeSJia Liu MUL_RETURN64_16_QH(muleu_s_qh_obr, mul_u8_u16, \
2086a22260aeSJia Liu                    24, 16, 8, 0, MIPSDSP_Q0, \
2087a22260aeSJia Liu                    48, 32, 16, 0, MIPSDSP_LO);
2088a22260aeSJia Liu MUL_RETURN64_16_QH(mulq_rs_qh, rndq15_mul_q15_q15, \
2089a22260aeSJia Liu                    48, 32, 16, 0, MIPSDSP_LO, \
2090a22260aeSJia Liu                    48, 32, 16, 0, MIPSDSP_LO);
2091a22260aeSJia Liu 
2092a22260aeSJia Liu #undef MUL_RETURN64_16_QH
2093a22260aeSJia Liu 
2094a22260aeSJia Liu #define MUL_RETURN64_32_QH(name, \
2095a22260aeSJia Liu                            rsmov1, rsmov2, \
2096a22260aeSJia Liu                            rtmov1, rtmov2) \
2097a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt, \
2098a22260aeSJia Liu                            CPUMIPSState *env)                \
2099a22260aeSJia Liu {                                                            \
2100a22260aeSJia Liu     uint16_t rsB, rsA;                                       \
2101a22260aeSJia Liu     uint16_t rtB, rtA;                                       \
2102a22260aeSJia Liu     uint32_t tempB, tempA;                                   \
2103a22260aeSJia Liu                                                              \
2104a22260aeSJia Liu     rsB = (rs >> rsmov1) & MIPSDSP_LO;                       \
2105a22260aeSJia Liu     rsA = (rs >> rsmov2) & MIPSDSP_LO;                       \
2106a22260aeSJia Liu     rtB = (rt >> rtmov1) & MIPSDSP_LO;                       \
2107a22260aeSJia Liu     rtA = (rt >> rtmov2) & MIPSDSP_LO;                       \
2108a22260aeSJia Liu                                                              \
2109a22260aeSJia Liu     tempB = mipsdsp_mul_q15_q15(5, rsB, rtB, env);           \
2110a22260aeSJia Liu     tempA = mipsdsp_mul_q15_q15(5, rsA, rtA, env);           \
2111a22260aeSJia Liu                                                              \
2112a22260aeSJia Liu     return ((uint64_t)tempB << 32) | (uint64_t)tempA;        \
2113a22260aeSJia Liu }
2114a22260aeSJia Liu 
2115a22260aeSJia Liu MUL_RETURN64_32_QH(muleq_s_pw_qhl, 48, 32, 48, 32);
2116a22260aeSJia Liu MUL_RETURN64_32_QH(muleq_s_pw_qhr, 16, 0, 16, 0);
2117a22260aeSJia Liu 
2118a22260aeSJia Liu #undef MUL_RETURN64_32_QH
2119a22260aeSJia Liu 
2120a22260aeSJia Liu void helper_mulsaq_s_w_qh(target_ulong rs, target_ulong rt, uint32_t ac,
2121a22260aeSJia Liu                           CPUMIPSState *env)
2122a22260aeSJia Liu {
2123a22260aeSJia Liu     int16_t rs3, rs2, rs1, rs0;
2124a22260aeSJia Liu     int16_t rt3, rt2, rt1, rt0;
2125a22260aeSJia Liu     int32_t tempD, tempC, tempB, tempA;
2126a22260aeSJia Liu     int64_t acc[2];
2127a22260aeSJia Liu     int64_t temp[2];
2128a22260aeSJia Liu     int64_t temp_sum;
2129a22260aeSJia Liu 
2130a22260aeSJia Liu     MIPSDSP_SPLIT64_16(rs, rs3, rs2, rs1, rs0);
2131a22260aeSJia Liu     MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0);
2132a22260aeSJia Liu 
2133a22260aeSJia Liu     tempD = mipsdsp_mul_q15_q15(ac, rs3, rt3, env);
2134a22260aeSJia Liu     tempC = mipsdsp_mul_q15_q15(ac, rs2, rt2, env);
2135a22260aeSJia Liu     tempB = mipsdsp_mul_q15_q15(ac, rs1, rt1, env);
2136a22260aeSJia Liu     tempA = mipsdsp_mul_q15_q15(ac, rs0, rt0, env);
2137a22260aeSJia Liu 
2138a22260aeSJia Liu     temp[0] = ((int32_t)tempD - (int32_t)tempC) +
2139a22260aeSJia Liu               ((int32_t)tempB - (int32_t)tempA);
2140a22260aeSJia Liu     temp[0] = (int64_t)(temp[0] << 30) >> 30;
2141a22260aeSJia Liu     if (((temp[0] >> 33) & 0x01) == 0) {
2142a22260aeSJia Liu         temp[1] = 0x00;
2143a22260aeSJia Liu     } else {
2144a22260aeSJia Liu         temp[1] = ~0ull;
2145a22260aeSJia Liu     }
2146a22260aeSJia Liu 
2147a22260aeSJia Liu     acc[0] = env->active_tc.LO[ac];
2148a22260aeSJia Liu     acc[1] = env->active_tc.HI[ac];
2149a22260aeSJia Liu 
2150a22260aeSJia Liu     temp_sum = acc[0] + temp[0];
2151a22260aeSJia Liu     if (((uint64_t)temp_sum < (uint64_t)acc[0]) &&
2152a22260aeSJia Liu        ((uint64_t)temp_sum < (uint64_t)temp[0])) {
2153a22260aeSJia Liu         acc[1] += 1;
2154a22260aeSJia Liu     }
2155a22260aeSJia Liu     acc[0] = temp_sum;
2156a22260aeSJia Liu     acc[1] += temp[1];
2157a22260aeSJia Liu 
2158a22260aeSJia Liu     env->active_tc.HI[ac] = acc[1];
2159a22260aeSJia Liu     env->active_tc.LO[ac] = acc[0];
2160a22260aeSJia Liu }
2161a22260aeSJia Liu #endif
2162a22260aeSJia Liu 
2163a22260aeSJia Liu #define DP_QB(name, func, is_add, rsmov1, rsmov2, rtmov1, rtmov2) \
2164a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt,        \
2165a22260aeSJia Liu                    CPUMIPSState *env)                                    \
2166a22260aeSJia Liu {                                                                        \
2167a22260aeSJia Liu     uint8_t rs3, rs2;                                                    \
2168a22260aeSJia Liu     uint8_t rt3, rt2;                                                    \
2169a22260aeSJia Liu     uint16_t tempB, tempA;                                               \
2170a22260aeSJia Liu     uint64_t tempC, dotp;                                                \
2171a22260aeSJia Liu                                                                          \
2172a22260aeSJia Liu     rs3 = (rs >> rsmov1) & MIPSDSP_Q0;                                   \
2173a22260aeSJia Liu     rs2 = (rs >> rsmov2) & MIPSDSP_Q0;                                   \
2174a22260aeSJia Liu     rt3 = (rt >> rtmov1) & MIPSDSP_Q0;                                   \
2175a22260aeSJia Liu     rt2 = (rt >> rtmov2) & MIPSDSP_Q0;                                   \
2176a22260aeSJia Liu     tempB = mipsdsp_##func(rs3, rt3);                                    \
2177a22260aeSJia Liu     tempA = mipsdsp_##func(rs2, rt2);                                    \
2178a22260aeSJia Liu     dotp = (int64_t)tempB + (int64_t)tempA;                              \
2179a22260aeSJia Liu     if (is_add) {                                                        \
2180a22260aeSJia Liu         tempC = (((uint64_t)env->active_tc.HI[ac] << 32) |               \
2181a22260aeSJia Liu                  ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO))        \
2182a22260aeSJia Liu             + dotp;                                                      \
2183a22260aeSJia Liu     } else {                                                             \
2184a22260aeSJia Liu         tempC = (((uint64_t)env->active_tc.HI[ac] << 32) |               \
2185a22260aeSJia Liu                  ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO))        \
2186a22260aeSJia Liu             - dotp;                                                      \
2187a22260aeSJia Liu     }                                                                    \
2188a22260aeSJia Liu                                                                          \
2189a22260aeSJia Liu     env->active_tc.HI[ac] = (target_long)(int32_t)                       \
2190a22260aeSJia Liu                             ((tempC & MIPSDSP_LHI) >> 32);               \
2191a22260aeSJia Liu     env->active_tc.LO[ac] = (target_long)(int32_t)(tempC & MIPSDSP_LLO); \
2192a22260aeSJia Liu }
2193a22260aeSJia Liu 
2194a22260aeSJia Liu DP_QB(dpau_h_qbl, mul_u8_u8, 1, 24, 16, 24, 16);
2195a22260aeSJia Liu DP_QB(dpau_h_qbr, mul_u8_u8, 1, 8, 0, 8, 0);
2196a22260aeSJia Liu DP_QB(dpsu_h_qbl, mul_u8_u8, 0, 24, 16, 24, 16);
2197a22260aeSJia Liu DP_QB(dpsu_h_qbr, mul_u8_u8, 0, 8, 0, 8, 0);
2198a22260aeSJia Liu 
2199a22260aeSJia Liu #undef DP_QB
2200a22260aeSJia Liu 
2201a22260aeSJia Liu #if defined(TARGET_MIPS64)
2202a22260aeSJia Liu #define DP_OB(name, add_sub, \
2203a22260aeSJia Liu               rsmov1, rsmov2, rsmov3, rsmov4, \
2204a22260aeSJia Liu               rtmov1, rtmov2, rtmov3, rtmov4) \
2205a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac,       \
2206a22260aeSJia Liu                        CPUMIPSState *env)                               \
2207a22260aeSJia Liu {                                                                       \
2208a22260aeSJia Liu     uint8_t rsD, rsC, rsB, rsA;                                         \
2209a22260aeSJia Liu     uint8_t rtD, rtC, rtB, rtA;                                         \
2210a22260aeSJia Liu     uint16_t tempD, tempC, tempB, tempA;                                \
2211a22260aeSJia Liu     uint64_t temp[2];                                                   \
2212a22260aeSJia Liu     uint64_t acc[2];                                                    \
2213a22260aeSJia Liu     uint64_t temp_sum;                                                  \
2214a22260aeSJia Liu                                                                         \
2215a22260aeSJia Liu     temp[0] = 0;                                                        \
2216a22260aeSJia Liu     temp[1] = 0;                                                        \
2217a22260aeSJia Liu                                                                         \
2218a22260aeSJia Liu     rsD = (rs >> rsmov1) & MIPSDSP_Q0;                                  \
2219a22260aeSJia Liu     rsC = (rs >> rsmov2) & MIPSDSP_Q0;                                  \
2220a22260aeSJia Liu     rsB = (rs >> rsmov3) & MIPSDSP_Q0;                                  \
2221a22260aeSJia Liu     rsA = (rs >> rsmov4) & MIPSDSP_Q0;                                  \
2222a22260aeSJia Liu     rtD = (rt >> rtmov1) & MIPSDSP_Q0;                                  \
2223a22260aeSJia Liu     rtC = (rt >> rtmov2) & MIPSDSP_Q0;                                  \
2224a22260aeSJia Liu     rtB = (rt >> rtmov3) & MIPSDSP_Q0;                                  \
2225a22260aeSJia Liu     rtA = (rt >> rtmov4) & MIPSDSP_Q0;                                  \
2226a22260aeSJia Liu                                                                         \
2227a22260aeSJia Liu     tempD = mipsdsp_mul_u8_u8(rsD, rtD);                                \
2228a22260aeSJia Liu     tempC = mipsdsp_mul_u8_u8(rsC, rtC);                                \
2229a22260aeSJia Liu     tempB = mipsdsp_mul_u8_u8(rsB, rtB);                                \
2230a22260aeSJia Liu     tempA = mipsdsp_mul_u8_u8(rsA, rtA);                                \
2231a22260aeSJia Liu                                                                         \
2232a22260aeSJia Liu     temp[0] = (uint64_t)tempD + (uint64_t)tempC +                       \
2233a22260aeSJia Liu       (uint64_t)tempB + (uint64_t)tempA;                                \
2234a22260aeSJia Liu                                                                         \
2235a22260aeSJia Liu     acc[0] = env->active_tc.LO[ac];                                     \
2236a22260aeSJia Liu     acc[1] = env->active_tc.HI[ac];                                     \
2237a22260aeSJia Liu                                                                         \
2238a22260aeSJia Liu     if (add_sub) {                                                      \
2239a22260aeSJia Liu         temp_sum = acc[0] + temp[0];                                    \
2240a22260aeSJia Liu         if (((uint64_t)temp_sum < (uint64_t)acc[0]) &&                  \
2241a22260aeSJia Liu             ((uint64_t)temp_sum < (uint64_t)temp[0])) {                 \
2242a22260aeSJia Liu             acc[1] += 1;                                                \
2243a22260aeSJia Liu         }                                                               \
2244a22260aeSJia Liu         temp[0] = temp_sum;                                             \
2245a22260aeSJia Liu         temp[1] = acc[1] + temp[1];                                     \
2246a22260aeSJia Liu     } else {                                                            \
2247a22260aeSJia Liu         temp_sum = acc[0] - temp[0];                                    \
2248a22260aeSJia Liu         if ((uint64_t)temp_sum > (uint64_t)acc[0]) {                    \
2249a22260aeSJia Liu             acc[1] -= 1;                                                \
2250a22260aeSJia Liu         }                                                               \
2251a22260aeSJia Liu         temp[0] = temp_sum;                                             \
2252a22260aeSJia Liu         temp[1] = acc[1] - temp[1];                                     \
2253a22260aeSJia Liu     }                                                                   \
2254a22260aeSJia Liu                                                                         \
2255a22260aeSJia Liu     env->active_tc.HI[ac] = temp[1];                                    \
2256a22260aeSJia Liu     env->active_tc.LO[ac] = temp[0];                                    \
2257a22260aeSJia Liu }
2258a22260aeSJia Liu 
2259a22260aeSJia Liu DP_OB(dpau_h_obl, 1, 56, 48, 40, 32, 56, 48, 40, 32);
2260a22260aeSJia Liu DP_OB(dpau_h_obr, 1, 24, 16, 8, 0, 24, 16, 8, 0);
2261a22260aeSJia Liu DP_OB(dpsu_h_obl, 0, 56, 48, 40, 32, 56, 48, 40, 32);
2262a22260aeSJia Liu DP_OB(dpsu_h_obr, 0, 24, 16, 8, 0, 24, 16, 8, 0);
2263a22260aeSJia Liu 
2264a22260aeSJia Liu #undef DP_OB
2265a22260aeSJia Liu #endif
2266a22260aeSJia Liu 
2267a22260aeSJia Liu #define DP_NOFUNC_PH(name, is_add, rsmov1, rsmov2, rtmov1, rtmov2)             \
2268a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt,              \
2269a22260aeSJia Liu                    CPUMIPSState *env)                                          \
2270a22260aeSJia Liu {                                                                              \
2271da1a4cefSPetar Jovanovic     int16_t rsB, rsA, rtB, rtA;                                                \
2272a22260aeSJia Liu     int32_t  tempA, tempB;                                                     \
2273a22260aeSJia Liu     int64_t  acc;                                                              \
2274a22260aeSJia Liu                                                                                \
2275a22260aeSJia Liu     rsB = (rs >> rsmov1) & MIPSDSP_LO;                                         \
2276a22260aeSJia Liu     rsA = (rs >> rsmov2) & MIPSDSP_LO;                                         \
2277a22260aeSJia Liu     rtB = (rt >> rtmov1) & MIPSDSP_LO;                                         \
2278a22260aeSJia Liu     rtA = (rt >> rtmov2) & MIPSDSP_LO;                                         \
2279a22260aeSJia Liu                                                                                \
2280a22260aeSJia Liu     tempB = (int32_t)rsB * (int32_t)rtB;                                       \
2281a22260aeSJia Liu     tempA = (int32_t)rsA * (int32_t)rtA;                                       \
2282a22260aeSJia Liu                                                                                \
2283a22260aeSJia Liu     acc = ((uint64_t)env->active_tc.HI[ac] << 32) |                            \
2284a22260aeSJia Liu           ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO);                     \
2285a22260aeSJia Liu                                                                                \
2286a22260aeSJia Liu     if (is_add) {                                                              \
2287a22260aeSJia Liu         acc = acc + ((int64_t)tempB + (int64_t)tempA);                         \
2288a22260aeSJia Liu     } else {                                                                   \
2289a22260aeSJia Liu         acc = acc - ((int64_t)tempB + (int64_t)tempA);                         \
2290a22260aeSJia Liu     }                                                                          \
2291a22260aeSJia Liu                                                                                \
2292a22260aeSJia Liu     env->active_tc.HI[ac] = (target_long)(int32_t)((acc & MIPSDSP_LHI) >> 32); \
2293a22260aeSJia Liu     env->active_tc.LO[ac] = (target_long)(int32_t)(acc & MIPSDSP_LLO);         \
2294a22260aeSJia Liu }
2295a22260aeSJia Liu 
2296a22260aeSJia Liu DP_NOFUNC_PH(dpa_w_ph, 1, 16, 0, 16, 0);
2297a22260aeSJia Liu DP_NOFUNC_PH(dpax_w_ph, 1, 16, 0, 0, 16);
2298a22260aeSJia Liu DP_NOFUNC_PH(dps_w_ph, 0, 16, 0, 16, 0);
2299a22260aeSJia Liu DP_NOFUNC_PH(dpsx_w_ph, 0, 16, 0, 0, 16);
2300a22260aeSJia Liu #undef DP_NOFUNC_PH
2301a22260aeSJia Liu 
2302a22260aeSJia Liu #define DP_HASFUNC_PH(name, is_add, rsmov1, rsmov2, rtmov1, rtmov2) \
2303a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt,   \
2304a22260aeSJia Liu                    CPUMIPSState *env)                      \
2305a22260aeSJia Liu {                                                          \
2306a22260aeSJia Liu     int16_t rsB, rsA, rtB, rtA;                            \
2307a22260aeSJia Liu     int32_t tempB, tempA;                                  \
2308a22260aeSJia Liu     int64_t acc, dotp;                                     \
2309a22260aeSJia Liu                                                            \
2310a22260aeSJia Liu     rsB = (rs >> rsmov1) & MIPSDSP_LO;                     \
2311a22260aeSJia Liu     rsA = (rs >> rsmov2) & MIPSDSP_LO;                     \
2312a22260aeSJia Liu     rtB = (rt >> rtmov1) & MIPSDSP_LO;                     \
2313a22260aeSJia Liu     rtA = (rt >> rtmov2) & MIPSDSP_LO;                     \
2314a22260aeSJia Liu                                                            \
2315a22260aeSJia Liu     tempB = mipsdsp_mul_q15_q15(ac, rsB, rtB, env);        \
2316a22260aeSJia Liu     tempA = mipsdsp_mul_q15_q15(ac, rsA, rtA, env);        \
2317a22260aeSJia Liu                                                            \
2318a22260aeSJia Liu     dotp = (int64_t)tempB + (int64_t)tempA;                \
2319a22260aeSJia Liu     acc = ((uint64_t)env->active_tc.HI[ac] << 32) |        \
2320a22260aeSJia Liu           ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO); \
2321a22260aeSJia Liu                                                            \
2322a22260aeSJia Liu     if (is_add) {                                          \
2323a22260aeSJia Liu         acc = acc + dotp;                                  \
2324a22260aeSJia Liu     } else {                                               \
2325a22260aeSJia Liu         acc = acc - dotp;                                  \
2326a22260aeSJia Liu     }                                                      \
2327a22260aeSJia Liu                                                            \
2328a22260aeSJia Liu     env->active_tc.HI[ac] = (target_long)(int32_t)         \
2329a22260aeSJia Liu         ((acc & MIPSDSP_LHI) >> 32);                       \
2330a22260aeSJia Liu     env->active_tc.LO[ac] = (target_long)(int32_t)         \
2331a22260aeSJia Liu         (acc & MIPSDSP_LLO);                               \
2332a22260aeSJia Liu }
2333a22260aeSJia Liu 
2334a22260aeSJia Liu DP_HASFUNC_PH(dpaq_s_w_ph, 1, 16, 0, 16, 0);
2335a22260aeSJia Liu DP_HASFUNC_PH(dpaqx_s_w_ph, 1, 16, 0, 0, 16);
2336a22260aeSJia Liu DP_HASFUNC_PH(dpsq_s_w_ph, 0, 16, 0, 16, 0);
2337a22260aeSJia Liu DP_HASFUNC_PH(dpsqx_s_w_ph, 0, 16, 0, 0, 16);
2338a22260aeSJia Liu 
2339a22260aeSJia Liu #undef DP_HASFUNC_PH
2340a22260aeSJia Liu 
2341a22260aeSJia Liu #define DP_128OPERATION_PH(name, is_add) \
2342a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \
2343a22260aeSJia Liu                           CPUMIPSState *env)                             \
2344a22260aeSJia Liu {                                                                        \
2345a22260aeSJia Liu     int16_t rsh, rsl, rth, rtl;                                          \
2346a22260aeSJia Liu     int32_t tempB, tempA, tempC62_31, tempC63;                           \
2347a22260aeSJia Liu     int64_t acc, dotp, tempC;                                            \
2348a22260aeSJia Liu                                                                          \
2349a22260aeSJia Liu     MIPSDSP_SPLIT32_16(rs, rsh, rsl);                                    \
2350a22260aeSJia Liu     MIPSDSP_SPLIT32_16(rt, rth, rtl);                                    \
2351a22260aeSJia Liu                                                                          \
2352a22260aeSJia Liu     tempB = mipsdsp_mul_q15_q15(ac, rsh, rtl, env);                      \
2353a22260aeSJia Liu     tempA = mipsdsp_mul_q15_q15(ac, rsl, rth, env);                      \
2354a22260aeSJia Liu                                                                          \
2355a22260aeSJia Liu     dotp = (int64_t)tempB + (int64_t)tempA;                              \
2356a22260aeSJia Liu     acc = ((uint64_t)env->active_tc.HI[ac] << 32) |                      \
2357a22260aeSJia Liu           ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO);               \
2358a22260aeSJia Liu     if (is_add) {                                                        \
2359a22260aeSJia Liu         tempC = acc + dotp;                                              \
2360a22260aeSJia Liu     } else {                                                             \
2361a22260aeSJia Liu         tempC = acc - dotp;                                              \
2362a22260aeSJia Liu     }                                                                    \
2363a22260aeSJia Liu     tempC63 = (tempC >> 63) & 0x01;                                      \
2364a22260aeSJia Liu     tempC62_31 = (tempC >> 31) & 0xFFFFFFFF;                             \
2365a22260aeSJia Liu                                                                          \
2366a22260aeSJia Liu     if ((tempC63 == 0) && (tempC62_31 != 0x00000000)) {                  \
2367a22260aeSJia Liu         tempC = 0x7FFFFFFF;                                              \
2368a22260aeSJia Liu         set_DSPControl_overflow_flag(1, 16 + ac, env);                   \
2369a22260aeSJia Liu     }                                                                    \
2370a22260aeSJia Liu                                                                          \
2371a22260aeSJia Liu     if ((tempC63 == 1) && (tempC62_31 != 0xFFFFFFFF)) {                  \
2372a22260aeSJia Liu         tempC = (int64_t)(int32_t)0x80000000;                            \
2373a22260aeSJia Liu         set_DSPControl_overflow_flag(1, 16 + ac, env);                   \
2374a22260aeSJia Liu     }                                                                    \
2375a22260aeSJia Liu                                                                          \
2376a22260aeSJia Liu     env->active_tc.HI[ac] = (target_long)(int32_t)                       \
2377a22260aeSJia Liu         ((tempC & MIPSDSP_LHI) >> 32);                                   \
2378a22260aeSJia Liu     env->active_tc.LO[ac] = (target_long)(int32_t)                       \
2379a22260aeSJia Liu         (tempC & MIPSDSP_LLO);                                           \
2380a22260aeSJia Liu }
2381a22260aeSJia Liu 
2382a22260aeSJia Liu DP_128OPERATION_PH(dpaqx_sa_w_ph, 1);
2383a22260aeSJia Liu DP_128OPERATION_PH(dpsqx_sa_w_ph, 0);
2384a22260aeSJia Liu 
2385a22260aeSJia Liu #undef DP_128OPERATION_HP
2386a22260aeSJia Liu 
2387a22260aeSJia Liu #if defined(TARGET_MIPS64)
2388a22260aeSJia Liu #define DP_QH(name, is_add, use_ac_env) \
2389a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac,    \
2390a22260aeSJia Liu                    CPUMIPSState *env)                                \
2391a22260aeSJia Liu {                                                                    \
2392a22260aeSJia Liu     int32_t rs3, rs2, rs1, rs0;                                      \
2393a22260aeSJia Liu     int32_t rt3, rt2, rt1, rt0;                                      \
2394a22260aeSJia Liu     int32_t tempD, tempC, tempB, tempA;                              \
2395a22260aeSJia Liu     int64_t acc[2];                                                  \
2396a22260aeSJia Liu     int64_t temp[2];                                                 \
2397a22260aeSJia Liu     int64_t temp_sum;                                                \
2398a22260aeSJia Liu                                                                      \
2399a22260aeSJia Liu     MIPSDSP_SPLIT64_16(rs, rs3, rs2, rs1, rs0);                      \
2400a22260aeSJia Liu     MIPSDSP_SPLIT64_16(rt, rt3, rt2, rt1, rt0);                      \
2401a22260aeSJia Liu                                                                      \
2402a22260aeSJia Liu     if (use_ac_env) {                                                \
2403a22260aeSJia Liu         tempD = mipsdsp_mul_q15_q15(ac, rs3, rt3, env);              \
2404a22260aeSJia Liu         tempC = mipsdsp_mul_q15_q15(ac, rs2, rt2, env);              \
2405a22260aeSJia Liu         tempB = mipsdsp_mul_q15_q15(ac, rs1, rt1, env);              \
2406a22260aeSJia Liu         tempA = mipsdsp_mul_q15_q15(ac, rs0, rt0, env);              \
2407a22260aeSJia Liu     } else {                                                         \
2408a22260aeSJia Liu         tempD = mipsdsp_mul_u16_u16(rs3, rt3);                       \
2409a22260aeSJia Liu         tempC = mipsdsp_mul_u16_u16(rs2, rt2);                       \
2410a22260aeSJia Liu         tempB = mipsdsp_mul_u16_u16(rs1, rt1);                       \
2411a22260aeSJia Liu         tempA = mipsdsp_mul_u16_u16(rs0, rt0);                       \
2412a22260aeSJia Liu     }                                                                \
2413a22260aeSJia Liu                                                                      \
2414a22260aeSJia Liu     temp[0] = (int64_t)tempD + (int64_t)tempC +                      \
2415a22260aeSJia Liu               (int64_t)tempB + (int64_t)tempA;                       \
2416a22260aeSJia Liu                                                                      \
2417a22260aeSJia Liu     if (temp[0] >= 0) {                                              \
2418a22260aeSJia Liu         temp[1] = 0;                                                 \
2419a22260aeSJia Liu     } else {                                                         \
2420a22260aeSJia Liu         temp[1] = ~0ull;                                             \
2421a22260aeSJia Liu     }                                                                \
2422a22260aeSJia Liu                                                                      \
2423a22260aeSJia Liu     acc[1] = env->active_tc.HI[ac];                                  \
2424a22260aeSJia Liu     acc[0] = env->active_tc.LO[ac];                                  \
2425a22260aeSJia Liu                                                                      \
2426a22260aeSJia Liu     if (is_add) {                                                    \
2427a22260aeSJia Liu         temp_sum = acc[0] + temp[0];                                 \
2428a22260aeSJia Liu         if (((uint64_t)temp_sum < (uint64_t)acc[0]) &&               \
2429a22260aeSJia Liu             ((uint64_t)temp_sum < (uint64_t)temp[0])) {              \
2430a22260aeSJia Liu             acc[1] = acc[1] + 1;                                     \
2431a22260aeSJia Liu         }                                                            \
2432a22260aeSJia Liu         temp[0] = temp_sum;                                          \
2433a22260aeSJia Liu         temp[1] = acc[1] + temp[1];                                  \
2434a22260aeSJia Liu     } else {                                                         \
2435a22260aeSJia Liu         temp_sum = acc[0] - temp[0];                                 \
2436a22260aeSJia Liu         if ((uint64_t)temp_sum > (uint64_t)acc[0]) {                 \
2437a22260aeSJia Liu             acc[1] = acc[1] - 1;                                     \
2438a22260aeSJia Liu         }                                                            \
2439a22260aeSJia Liu         temp[0] = temp_sum;                                          \
2440a22260aeSJia Liu         temp[1] = acc[1] - temp[1];                                  \
2441a22260aeSJia Liu     }                                                                \
2442a22260aeSJia Liu                                                                      \
2443a22260aeSJia Liu     env->active_tc.HI[ac] = temp[1];                                 \
2444a22260aeSJia Liu     env->active_tc.LO[ac] = temp[0];                                 \
2445a22260aeSJia Liu }
2446a22260aeSJia Liu 
2447a22260aeSJia Liu DP_QH(dpa_w_qh, 1, 0);
2448a22260aeSJia Liu DP_QH(dpaq_s_w_qh, 1, 1);
2449a22260aeSJia Liu DP_QH(dps_w_qh, 0, 0);
2450a22260aeSJia Liu DP_QH(dpsq_s_w_qh, 0, 1);
2451a22260aeSJia Liu 
2452a22260aeSJia Liu #undef DP_QH
2453a22260aeSJia Liu 
2454a22260aeSJia Liu #endif
2455a22260aeSJia Liu 
2456a22260aeSJia Liu #define DP_L_W(name, is_add) \
2457a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt,      \
2458a22260aeSJia Liu                    CPUMIPSState *env)                                  \
2459a22260aeSJia Liu {                                                                      \
2460a22260aeSJia Liu     int32_t temp63;                                                    \
2461a22260aeSJia Liu     int64_t dotp, acc;                                                 \
2462a22260aeSJia Liu     uint64_t temp;                                                     \
246320c334a7SPetar Jovanovic     bool overflow;                                                     \
2464a22260aeSJia Liu                                                                        \
2465a22260aeSJia Liu     dotp = mipsdsp_mul_q31_q31(ac, rs, rt, env);                       \
2466a22260aeSJia Liu     acc = ((uint64_t)env->active_tc.HI[ac] << 32) |                    \
2467a22260aeSJia Liu           ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO);             \
246820c334a7SPetar Jovanovic     if (is_add) {                                                      \
246920c334a7SPetar Jovanovic         temp = acc + dotp;                                             \
247020c334a7SPetar Jovanovic         overflow = MIPSDSP_OVERFLOW_ADD((uint64_t)acc, (uint64_t)dotp, \
247120c334a7SPetar Jovanovic                                         temp, (0x01ull << 63));        \
247220c334a7SPetar Jovanovic     } else {                                                           \
247320c334a7SPetar Jovanovic         temp = acc - dotp;                                             \
247420c334a7SPetar Jovanovic         overflow = MIPSDSP_OVERFLOW_SUB((uint64_t)acc, (uint64_t)dotp, \
247520c334a7SPetar Jovanovic                                         temp, (0x01ull << 63));        \
2476a22260aeSJia Liu     }                                                                  \
2477a22260aeSJia Liu                                                                        \
247820c334a7SPetar Jovanovic     if (overflow) {                                                    \
2479a22260aeSJia Liu         temp63 = (temp >> 63) & 0x01;                                  \
2480a22260aeSJia Liu         if (temp63 == 1) {                                             \
2481a22260aeSJia Liu             temp = (0x01ull << 63) - 1;                                \
2482a22260aeSJia Liu         } else {                                                       \
2483a22260aeSJia Liu             temp = 0x01ull << 63;                                      \
2484a22260aeSJia Liu         }                                                              \
2485a22260aeSJia Liu                                                                        \
2486a22260aeSJia Liu         set_DSPControl_overflow_flag(1, 16 + ac, env);                 \
2487a22260aeSJia Liu     }                                                                  \
2488a22260aeSJia Liu                                                                        \
2489a22260aeSJia Liu     env->active_tc.HI[ac] = (target_long)(int32_t)                     \
2490a22260aeSJia Liu         ((temp & MIPSDSP_LHI) >> 32);                                  \
2491a22260aeSJia Liu     env->active_tc.LO[ac] = (target_long)(int32_t)                     \
2492a22260aeSJia Liu         (temp & MIPSDSP_LLO);                                          \
2493a22260aeSJia Liu }
2494a22260aeSJia Liu 
2495a22260aeSJia Liu DP_L_W(dpaq_sa_l_w, 1);
2496a22260aeSJia Liu DP_L_W(dpsq_sa_l_w, 0);
2497a22260aeSJia Liu 
2498a22260aeSJia Liu #undef DP_L_W
2499a22260aeSJia Liu 
2500a22260aeSJia Liu #if defined(TARGET_MIPS64)
2501a22260aeSJia Liu #define DP_L_PW(name, func) \
2502a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \
2503a22260aeSJia Liu                    CPUMIPSState *env)                             \
2504a22260aeSJia Liu {                                                                 \
2505a22260aeSJia Liu     int32_t rs1, rs0;                                             \
2506a22260aeSJia Liu     int32_t rt1, rt0;                                             \
2507a22260aeSJia Liu     int64_t tempB[2], tempA[2];                                   \
2508a22260aeSJia Liu     int64_t temp[2];                                              \
2509a22260aeSJia Liu     int64_t acc[2];                                               \
2510a22260aeSJia Liu     int64_t temp_sum;                                             \
2511a22260aeSJia Liu                                                                   \
2512a22260aeSJia Liu     temp[0] = 0;                                                  \
2513a22260aeSJia Liu     temp[1] = 0;                                                  \
2514a22260aeSJia Liu                                                                   \
2515a22260aeSJia Liu     MIPSDSP_SPLIT64_32(rs, rs1, rs0);                             \
2516a22260aeSJia Liu     MIPSDSP_SPLIT64_32(rt, rt1, rt0);                             \
2517a22260aeSJia Liu                                                                   \
2518a22260aeSJia Liu     tempB[0] = mipsdsp_mul_q31_q31(ac, rs1, rt1, env);            \
2519a22260aeSJia Liu     tempA[0] = mipsdsp_mul_q31_q31(ac, rs0, rt0, env);            \
2520a22260aeSJia Liu                                                                   \
2521a22260aeSJia Liu     if (tempB[0] >= 0) {                                          \
2522a22260aeSJia Liu         tempB[1] = 0x00;                                          \
2523a22260aeSJia Liu     } else {                                                      \
2524a22260aeSJia Liu         tempB[1] = ~0ull;                                         \
2525a22260aeSJia Liu     }                                                             \
2526a22260aeSJia Liu                                                                   \
2527a22260aeSJia Liu     if (tempA[0] >= 0) {                                          \
2528a22260aeSJia Liu         tempA[1] = 0x00;                                          \
2529a22260aeSJia Liu     } else {                                                      \
2530a22260aeSJia Liu         tempA[1] = ~0ull;                                         \
2531a22260aeSJia Liu     }                                                             \
2532a22260aeSJia Liu                                                                   \
2533a22260aeSJia Liu     temp_sum = tempB[0] + tempA[0];                               \
2534a22260aeSJia Liu     if (((uint64_t)temp_sum < (uint64_t)tempB[0]) &&              \
2535a22260aeSJia Liu         ((uint64_t)temp_sum < (uint64_t)tempA[0])) {              \
2536a22260aeSJia Liu         temp[1] += 1;                                             \
2537a22260aeSJia Liu     }                                                             \
2538a22260aeSJia Liu     temp[0] = temp_sum;                                           \
2539a22260aeSJia Liu     temp[1] += tempB[1] + tempA[1];                               \
2540a22260aeSJia Liu                                                                   \
2541a22260aeSJia Liu     mipsdsp_##func(acc, ac, temp, env);                           \
2542a22260aeSJia Liu                                                                   \
2543a22260aeSJia Liu     env->active_tc.HI[ac] = acc[1];                               \
2544a22260aeSJia Liu     env->active_tc.LO[ac] = acc[0];                               \
2545a22260aeSJia Liu }
2546a22260aeSJia Liu 
2547a22260aeSJia Liu DP_L_PW(dpaq_sa_l_pw, sat64_acc_add_q63);
2548a22260aeSJia Liu DP_L_PW(dpsq_sa_l_pw, sat64_acc_sub_q63);
2549a22260aeSJia Liu 
2550a22260aeSJia Liu #undef DP_L_PW
2551a22260aeSJia Liu 
2552a22260aeSJia Liu void helper_mulsaq_s_l_pw(target_ulong rs, target_ulong rt, uint32_t ac,
2553a22260aeSJia Liu                           CPUMIPSState *env)
2554a22260aeSJia Liu {
2555a22260aeSJia Liu     int32_t rs1, rs0;
2556a22260aeSJia Liu     int32_t rt1, rt0;
2557a22260aeSJia Liu     int64_t tempB[2], tempA[2];
2558a22260aeSJia Liu     int64_t temp[2];
2559a22260aeSJia Liu     int64_t acc[2];
2560a22260aeSJia Liu     int64_t temp_sum;
2561a22260aeSJia Liu 
2562a22260aeSJia Liu     rs1 = (rs >> 32) & MIPSDSP_LLO;
2563a22260aeSJia Liu     rs0 = rs & MIPSDSP_LLO;
2564a22260aeSJia Liu     rt1 = (rt >> 32) & MIPSDSP_LLO;
2565a22260aeSJia Liu     rt0 = rt & MIPSDSP_LLO;
2566a22260aeSJia Liu 
2567a22260aeSJia Liu     tempB[0] = mipsdsp_mul_q31_q31(ac, rs1, rt1, env);
2568a22260aeSJia Liu     tempA[0] = mipsdsp_mul_q31_q31(ac, rs0, rt0, env);
2569a22260aeSJia Liu 
2570a22260aeSJia Liu     if (tempB[0] >= 0) {
2571a22260aeSJia Liu         tempB[1] = 0x00;
2572a22260aeSJia Liu     } else {
2573a22260aeSJia Liu         tempB[1] = ~0ull;
2574a22260aeSJia Liu     }
2575a22260aeSJia Liu 
2576a22260aeSJia Liu     if (tempA[0] >= 0) {
2577a22260aeSJia Liu         tempA[1] = 0x00;
2578a22260aeSJia Liu     } else {
2579a22260aeSJia Liu         tempA[1] = ~0ull;
2580a22260aeSJia Liu     }
2581a22260aeSJia Liu 
2582a22260aeSJia Liu     acc[0] = env->active_tc.LO[ac];
2583a22260aeSJia Liu     acc[1] = env->active_tc.HI[ac];
2584a22260aeSJia Liu 
2585a22260aeSJia Liu     temp_sum = tempB[0] - tempA[0];
2586a22260aeSJia Liu     if ((uint64_t)temp_sum > (uint64_t)tempB[0]) {
2587a22260aeSJia Liu         tempB[1] -= 1;
2588a22260aeSJia Liu     }
2589a22260aeSJia Liu     temp[0] = temp_sum;
2590a22260aeSJia Liu     temp[1] = tempB[1] - tempA[1];
2591a22260aeSJia Liu 
2592a22260aeSJia Liu     if ((temp[1] & 0x01) == 0) {
2593a22260aeSJia Liu         temp[1] = 0x00;
2594a22260aeSJia Liu     } else {
2595a22260aeSJia Liu         temp[1] = ~0ull;
2596a22260aeSJia Liu     }
2597a22260aeSJia Liu 
2598a22260aeSJia Liu     temp_sum = acc[0] + temp[0];
2599a22260aeSJia Liu     if (((uint64_t)temp_sum < (uint64_t)acc[0]) &&
2600a22260aeSJia Liu        ((uint64_t)temp_sum < (uint64_t)temp[0])) {
2601a22260aeSJia Liu         acc[1] += 1;
2602a22260aeSJia Liu     }
2603a22260aeSJia Liu     acc[0] = temp_sum;
2604a22260aeSJia Liu     acc[1] += temp[1];
2605a22260aeSJia Liu 
2606a22260aeSJia Liu     env->active_tc.HI[ac] = acc[1];
2607a22260aeSJia Liu     env->active_tc.LO[ac] = acc[0];
2608a22260aeSJia Liu }
2609a22260aeSJia Liu #endif
2610a22260aeSJia Liu 
2611a22260aeSJia Liu #define MAQ_S_W(name, mov) \
2612a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt, \
2613a22260aeSJia Liu                    CPUMIPSState *env)                             \
2614a22260aeSJia Liu {                                                                 \
2615a22260aeSJia Liu     int16_t rsh, rth;                                             \
2616a22260aeSJia Liu     int32_t tempA;                                                \
2617a22260aeSJia Liu     int64_t tempL, acc;                                           \
2618a22260aeSJia Liu                                                                   \
2619a22260aeSJia Liu     rsh = (rs >> mov) & MIPSDSP_LO;                               \
2620a22260aeSJia Liu     rth = (rt >> mov) & MIPSDSP_LO;                               \
2621a22260aeSJia Liu     tempA  = mipsdsp_mul_q15_q15(ac, rsh, rth, env);              \
2622a22260aeSJia Liu     acc = ((uint64_t)env->active_tc.HI[ac] << 32) |               \
2623a22260aeSJia Liu           ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO);        \
2624a22260aeSJia Liu     tempL  = (int64_t)tempA + acc;                                \
2625a22260aeSJia Liu     env->active_tc.HI[ac] = (target_long)(int32_t)                \
2626a22260aeSJia Liu         ((tempL & MIPSDSP_LHI) >> 32);                            \
2627a22260aeSJia Liu     env->active_tc.LO[ac] = (target_long)(int32_t)                \
2628a22260aeSJia Liu         (tempL & MIPSDSP_LLO);                                    \
2629a22260aeSJia Liu }
2630a22260aeSJia Liu 
2631a22260aeSJia Liu MAQ_S_W(maq_s_w_phl, 16);
2632a22260aeSJia Liu MAQ_S_W(maq_s_w_phr, 0);
2633a22260aeSJia Liu 
2634a22260aeSJia Liu #undef MAQ_S_W
2635a22260aeSJia Liu 
2636a22260aeSJia Liu #define MAQ_SA_W(name, mov) \
2637a22260aeSJia Liu void helper_##name(uint32_t ac, target_ulong rs, target_ulong rt,        \
2638a22260aeSJia Liu                    CPUMIPSState *env)                                    \
2639a22260aeSJia Liu {                                                                        \
2640a22260aeSJia Liu     int16_t rsh, rth;                                                    \
2641a22260aeSJia Liu     int32_t tempA;                                                       \
2642a22260aeSJia Liu                                                                          \
2643a22260aeSJia Liu     rsh = (rs >> mov) & MIPSDSP_LO;                                      \
2644a22260aeSJia Liu     rth = (rt >> mov) & MIPSDSP_LO;                                      \
2645a22260aeSJia Liu     tempA = mipsdsp_mul_q15_q15(ac, rsh, rth, env);                      \
2646a22260aeSJia Liu     tempA = mipsdsp_sat32_acc_q31(ac, tempA, env);                       \
2647a22260aeSJia Liu                                                                          \
2648a22260aeSJia Liu     env->active_tc.HI[ac] = (target_long)(int32_t)(((int64_t)tempA &     \
2649a22260aeSJia Liu                                                     MIPSDSP_LHI) >> 32); \
2650a22260aeSJia Liu     env->active_tc.LO[ac] = (target_long)(int32_t)((int64_t)tempA &      \
2651a22260aeSJia Liu                                                    MIPSDSP_LLO);         \
2652a22260aeSJia Liu }
2653a22260aeSJia Liu 
2654a22260aeSJia Liu MAQ_SA_W(maq_sa_w_phl, 16);
2655a22260aeSJia Liu MAQ_SA_W(maq_sa_w_phr, 0);
2656a22260aeSJia Liu 
2657a22260aeSJia Liu #undef MAQ_SA_W
2658a22260aeSJia Liu 
2659a22260aeSJia Liu #define MULQ_W(name, addvar) \
2660a22260aeSJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt,   \
2661a22260aeSJia Liu                            CPUMIPSState *env)                  \
2662a22260aeSJia Liu {                                                              \
2663a345481bSPetar Jovanovic     int32_t rs_t, rt_t;                                        \
2664a22260aeSJia Liu     int32_t tempI;                                             \
2665a22260aeSJia Liu     int64_t tempL;                                             \
2666a22260aeSJia Liu                                                                \
2667a22260aeSJia Liu     rs_t = rs & MIPSDSP_LLO;                                   \
2668a22260aeSJia Liu     rt_t = rt & MIPSDSP_LLO;                                   \
2669a22260aeSJia Liu                                                                \
2670a22260aeSJia Liu     if ((rs_t == 0x80000000) && (rt_t == 0x80000000)) {        \
2671a22260aeSJia Liu         tempL = 0x7FFFFFFF00000000ull;                         \
2672a22260aeSJia Liu         set_DSPControl_overflow_flag(1, 21, env);              \
2673a22260aeSJia Liu     } else {                                                   \
2674a22260aeSJia Liu         tempL  = ((int64_t)rs_t * (int64_t)rt_t) << 1;         \
2675a22260aeSJia Liu         tempL += addvar;                                       \
2676a22260aeSJia Liu     }                                                          \
2677a22260aeSJia Liu     tempI = (tempL & MIPSDSP_LHI) >> 32;                       \
2678a22260aeSJia Liu                                                                \
2679a22260aeSJia Liu     return (target_long)(int32_t)tempI;                        \
2680a22260aeSJia Liu }
2681a22260aeSJia Liu 
2682a22260aeSJia Liu MULQ_W(mulq_s_w, 0);
2683a22260aeSJia Liu MULQ_W(mulq_rs_w, 0x80000000ull);
2684a22260aeSJia Liu 
2685a22260aeSJia Liu #undef MULQ_W
2686a22260aeSJia Liu 
2687a22260aeSJia Liu #if defined(TARGET_MIPS64)
2688a22260aeSJia Liu 
2689a22260aeSJia Liu #define MAQ_S_W_QH(name, mov) \
2690a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \
2691a22260aeSJia Liu                    CPUMIPSState *env)                             \
2692a22260aeSJia Liu {                                                                 \
2693a22260aeSJia Liu     int16_t rs_t, rt_t;                                           \
2694a22260aeSJia Liu     int32_t temp_mul;                                             \
2695a22260aeSJia Liu     int64_t temp[2];                                              \
2696a22260aeSJia Liu     int64_t acc[2];                                               \
2697a22260aeSJia Liu     int64_t temp_sum;                                             \
2698a22260aeSJia Liu                                                                   \
2699a22260aeSJia Liu     temp[0] = 0;                                                  \
2700a22260aeSJia Liu     temp[1] = 0;                                                  \
2701a22260aeSJia Liu                                                                   \
2702a22260aeSJia Liu     rs_t = (rs >> mov) & MIPSDSP_LO;                              \
2703a22260aeSJia Liu     rt_t = (rt >> mov) & MIPSDSP_LO;                              \
2704a22260aeSJia Liu     temp_mul = mipsdsp_mul_q15_q15(ac, rs_t, rt_t, env);          \
2705a22260aeSJia Liu                                                                   \
2706a22260aeSJia Liu     temp[0] = (int64_t)temp_mul;                                  \
2707a22260aeSJia Liu     if (temp[0] >= 0) {                                           \
2708a22260aeSJia Liu         temp[1] = 0x00;                                           \
2709a22260aeSJia Liu     } else {                                                      \
2710a22260aeSJia Liu         temp[1] = ~0ull;                                          \
2711a22260aeSJia Liu     }                                                             \
2712a22260aeSJia Liu                                                                   \
2713a22260aeSJia Liu     acc[0] = env->active_tc.LO[ac];                               \
2714a22260aeSJia Liu     acc[1] = env->active_tc.HI[ac];                               \
2715a22260aeSJia Liu                                                                   \
2716a22260aeSJia Liu     temp_sum = acc[0] + temp[0];                                  \
2717a22260aeSJia Liu     if (((uint64_t)temp_sum < (uint64_t)acc[0]) &&                \
2718a22260aeSJia Liu         ((uint64_t)temp_sum < (uint64_t)temp[0])) {               \
2719a22260aeSJia Liu         acc[1] += 1;                                              \
2720a22260aeSJia Liu     }                                                             \
2721a22260aeSJia Liu     acc[0] = temp_sum;                                            \
2722a22260aeSJia Liu     acc[1] += temp[1];                                            \
2723a22260aeSJia Liu                                                                   \
2724a22260aeSJia Liu     env->active_tc.HI[ac] = acc[1];                               \
2725a22260aeSJia Liu     env->active_tc.LO[ac] = acc[0];                               \
2726a22260aeSJia Liu }
2727a22260aeSJia Liu 
2728a22260aeSJia Liu MAQ_S_W_QH(maq_s_w_qhll, 48);
2729a22260aeSJia Liu MAQ_S_W_QH(maq_s_w_qhlr, 32);
2730a22260aeSJia Liu MAQ_S_W_QH(maq_s_w_qhrl, 16);
2731a22260aeSJia Liu MAQ_S_W_QH(maq_s_w_qhrr, 0);
2732a22260aeSJia Liu 
2733a22260aeSJia Liu #undef MAQ_S_W_QH
2734a22260aeSJia Liu 
2735a22260aeSJia Liu #define MAQ_SA_W(name, mov) \
2736a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \
2737a22260aeSJia Liu                    CPUMIPSState *env)                             \
2738a22260aeSJia Liu {                                                                 \
2739a22260aeSJia Liu     int16_t rs_t, rt_t;                                           \
2740a22260aeSJia Liu     int32_t temp;                                                 \
2741a22260aeSJia Liu     int64_t acc[2];                                               \
2742a22260aeSJia Liu                                                                   \
2743a22260aeSJia Liu     rs_t = (rs >> mov) & MIPSDSP_LO;                              \
2744a22260aeSJia Liu     rt_t = (rt >> mov) & MIPSDSP_LO;                              \
2745a22260aeSJia Liu     temp = mipsdsp_mul_q15_q15(ac, rs_t, rt_t, env);              \
2746a22260aeSJia Liu     temp = mipsdsp_sat32_acc_q31(ac, temp, env);                  \
2747a22260aeSJia Liu                                                                   \
2748a22260aeSJia Liu     acc[0] = (int64_t)(int32_t)temp;                              \
2749a22260aeSJia Liu     if (acc[0] >= 0) {                                            \
2750a22260aeSJia Liu         acc[1] = 0x00;                                            \
2751a22260aeSJia Liu     } else {                                                      \
2752a22260aeSJia Liu         acc[1] = ~0ull;                                           \
2753a22260aeSJia Liu     }                                                             \
2754a22260aeSJia Liu                                                                   \
2755a22260aeSJia Liu     env->active_tc.HI[ac] = acc[1];                               \
2756a22260aeSJia Liu     env->active_tc.LO[ac] = acc[0];                               \
2757a22260aeSJia Liu }
2758a22260aeSJia Liu 
2759a22260aeSJia Liu MAQ_SA_W(maq_sa_w_qhll, 48);
2760a22260aeSJia Liu MAQ_SA_W(maq_sa_w_qhlr, 32);
2761a22260aeSJia Liu MAQ_SA_W(maq_sa_w_qhrl, 16);
2762a22260aeSJia Liu MAQ_SA_W(maq_sa_w_qhrr, 0);
2763a22260aeSJia Liu 
2764a22260aeSJia Liu #undef MAQ_SA_W
2765a22260aeSJia Liu 
2766a22260aeSJia Liu #define MAQ_S_L_PW(name, mov) \
2767a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac, \
2768a22260aeSJia Liu                    CPUMIPSState *env)                             \
2769a22260aeSJia Liu {                                                                 \
2770a22260aeSJia Liu     int32_t rs_t, rt_t;                                           \
2771a22260aeSJia Liu     int64_t temp[2];                                              \
2772a22260aeSJia Liu     int64_t acc[2];                                               \
2773a22260aeSJia Liu     int64_t temp_sum;                                             \
2774a22260aeSJia Liu                                                                   \
2775a22260aeSJia Liu     temp[0] = 0;                                                  \
2776a22260aeSJia Liu     temp[1] = 0;                                                  \
2777a22260aeSJia Liu                                                                   \
2778a22260aeSJia Liu     rs_t = (rs >> mov) & MIPSDSP_LLO;                             \
2779a22260aeSJia Liu     rt_t = (rt >> mov) & MIPSDSP_LLO;                             \
2780a22260aeSJia Liu                                                                   \
2781a22260aeSJia Liu     temp[0] = mipsdsp_mul_q31_q31(ac, rs_t, rt_t, env);           \
2782a22260aeSJia Liu     if (temp[0] >= 0) {                                           \
2783a22260aeSJia Liu         temp[1] = 0x00;                                           \
2784a22260aeSJia Liu     } else {                                                      \
2785a22260aeSJia Liu         temp[1] = ~0ull;                                          \
2786a22260aeSJia Liu     }                                                             \
2787a22260aeSJia Liu                                                                   \
2788a22260aeSJia Liu     acc[0] = env->active_tc.LO[ac];                               \
2789a22260aeSJia Liu     acc[1] = env->active_tc.HI[ac];                               \
2790a22260aeSJia Liu                                                                   \
2791a22260aeSJia Liu     temp_sum = acc[0] + temp[0];                                  \
2792a22260aeSJia Liu     if (((uint64_t)temp_sum < (uint64_t)acc[0]) &&                \
2793a22260aeSJia Liu         ((uint64_t)temp_sum < (uint64_t)temp[0])) {               \
2794a22260aeSJia Liu         acc[1] += 1;                                              \
2795a22260aeSJia Liu     }                                                             \
2796a22260aeSJia Liu     acc[0] = temp_sum;                                            \
2797a22260aeSJia Liu     acc[1] += temp[1];                                            \
2798a22260aeSJia Liu                                                                   \
2799a22260aeSJia Liu     env->active_tc.HI[ac] = acc[1];                               \
2800a22260aeSJia Liu     env->active_tc.LO[ac] = acc[0];                               \
2801a22260aeSJia Liu }
2802a22260aeSJia Liu 
2803a22260aeSJia Liu MAQ_S_L_PW(maq_s_l_pwl, 32);
2804a22260aeSJia Liu MAQ_S_L_PW(maq_s_l_pwr, 0);
2805a22260aeSJia Liu 
2806a22260aeSJia Liu #undef MAQ_S_L_PW
2807a22260aeSJia Liu 
2808a22260aeSJia Liu #define DM_OPERATE(name, func, is_add, sigext) \
2809a22260aeSJia Liu void helper_##name(target_ulong rs, target_ulong rt, uint32_t ac,    \
2810a22260aeSJia Liu                   CPUMIPSState *env)                                 \
2811a22260aeSJia Liu {                                                                    \
2812a22260aeSJia Liu     int32_t rs1, rs0;                                                \
2813a22260aeSJia Liu     int32_t rt1, rt0;                                                \
2814a22260aeSJia Liu     int64_t tempBL[2], tempAL[2];                                    \
2815a22260aeSJia Liu     int64_t acc[2];                                                  \
2816a22260aeSJia Liu     int64_t temp[2];                                                 \
2817a22260aeSJia Liu     int64_t temp_sum;                                                \
2818a22260aeSJia Liu                                                                      \
2819a22260aeSJia Liu     temp[0] = 0x00;                                                  \
2820a22260aeSJia Liu     temp[1] = 0x00;                                                  \
2821a22260aeSJia Liu                                                                      \
2822a22260aeSJia Liu     MIPSDSP_SPLIT64_32(rs, rs1, rs0);                                \
2823a22260aeSJia Liu     MIPSDSP_SPLIT64_32(rt, rt1, rt0);                                \
2824a22260aeSJia Liu                                                                      \
2825a22260aeSJia Liu     if (sigext) {                                                    \
2826a22260aeSJia Liu         tempBL[0] = (int64_t)mipsdsp_##func(rs1, rt1);               \
2827a22260aeSJia Liu         tempAL[0] = (int64_t)mipsdsp_##func(rs0, rt0);               \
2828a22260aeSJia Liu                                                                      \
2829a22260aeSJia Liu         if (tempBL[0] >= 0) {                                        \
2830a22260aeSJia Liu             tempBL[1] = 0x0;                                         \
2831a22260aeSJia Liu         } else {                                                     \
2832a22260aeSJia Liu             tempBL[1] = ~0ull;                                       \
2833a22260aeSJia Liu         }                                                            \
2834a22260aeSJia Liu                                                                      \
2835a22260aeSJia Liu         if (tempAL[0] >= 0) {                                        \
2836a22260aeSJia Liu             tempAL[1] = 0x0;                                         \
2837a22260aeSJia Liu         } else {                                                     \
2838a22260aeSJia Liu             tempAL[1] = ~0ull;                                       \
2839a22260aeSJia Liu         }                                                            \
2840a22260aeSJia Liu     } else {                                                         \
2841a22260aeSJia Liu         tempBL[0] = mipsdsp_##func(rs1, rt1);                        \
2842a22260aeSJia Liu         tempAL[0] = mipsdsp_##func(rs0, rt0);                        \
2843a22260aeSJia Liu         tempBL[1] = 0;                                               \
2844a22260aeSJia Liu         tempAL[1] = 0;                                               \
2845a22260aeSJia Liu     }                                                                \
2846a22260aeSJia Liu                                                                      \
2847a22260aeSJia Liu     acc[1] = env->active_tc.HI[ac];                                  \
2848a22260aeSJia Liu     acc[0] = env->active_tc.LO[ac];                                  \
2849a22260aeSJia Liu                                                                      \
2850a22260aeSJia Liu     temp_sum = tempBL[0] + tempAL[0];                                \
2851a22260aeSJia Liu     if (((uint64_t)temp_sum < (uint64_t)tempBL[0]) &&                \
2852a22260aeSJia Liu         ((uint64_t)temp_sum < (uint64_t)tempAL[0])) {                \
2853a22260aeSJia Liu         temp[1] += 1;                                                \
2854a22260aeSJia Liu     }                                                                \
2855a22260aeSJia Liu     temp[0] = temp_sum;                                              \
2856a22260aeSJia Liu     temp[1] += tempBL[1] + tempAL[1];                                \
2857a22260aeSJia Liu                                                                      \
2858a22260aeSJia Liu     if (is_add) {                                                    \
2859a22260aeSJia Liu         temp_sum = acc[0] + temp[0];                                 \
2860a22260aeSJia Liu         if (((uint64_t)temp_sum < (uint64_t)acc[0]) &&               \
2861a22260aeSJia Liu             ((uint64_t)temp_sum < (uint64_t)temp[0])) {              \
2862a22260aeSJia Liu             acc[1] += 1;                                             \
2863a22260aeSJia Liu         }                                                            \
2864a22260aeSJia Liu         temp[0] = temp_sum;                                          \
2865a22260aeSJia Liu         temp[1] = acc[1] + temp[1];                                  \
2866a22260aeSJia Liu     } else {                                                         \
2867a22260aeSJia Liu         temp_sum = acc[0] - temp[0];                                 \
2868a22260aeSJia Liu         if ((uint64_t)temp_sum > (uint64_t)acc[0]) {                 \
2869a22260aeSJia Liu             acc[1] -= 1;                                             \
2870a22260aeSJia Liu         }                                                            \
2871a22260aeSJia Liu         temp[0] = temp_sum;                                          \
2872a22260aeSJia Liu         temp[1] = acc[1] - temp[1];                                  \
2873a22260aeSJia Liu     }                                                                \
2874a22260aeSJia Liu                                                                      \
2875a22260aeSJia Liu     env->active_tc.HI[ac] = temp[1];                                 \
2876a22260aeSJia Liu     env->active_tc.LO[ac] = temp[0];                                 \
2877a22260aeSJia Liu }
2878a22260aeSJia Liu 
2879a22260aeSJia Liu DM_OPERATE(dmadd, mul_i32_i32, 1, 1);
2880a22260aeSJia Liu DM_OPERATE(dmaddu, mul_u32_u32, 1, 0);
2881a22260aeSJia Liu DM_OPERATE(dmsub, mul_i32_i32, 0, 1);
2882a22260aeSJia Liu DM_OPERATE(dmsubu, mul_u32_u32, 0, 0);
2883a22260aeSJia Liu #undef DM_OPERATE
2884a22260aeSJia Liu #endif
2885a22260aeSJia Liu 
28861cb6686cSJia Liu /** DSP Bit/Manipulation Sub-class insns **/
28871cb6686cSJia Liu target_ulong helper_bitrev(target_ulong rt)
28881cb6686cSJia Liu {
28891cb6686cSJia Liu     int32_t temp;
28901cb6686cSJia Liu     uint32_t rd;
28911cb6686cSJia Liu     int i;
28921cb6686cSJia Liu 
28931cb6686cSJia Liu     temp = rt & MIPSDSP_LO;
28941cb6686cSJia Liu     rd = 0;
28951cb6686cSJia Liu     for (i = 0; i < 16; i++) {
28961cb6686cSJia Liu         rd = (rd << 1) | (temp & 1);
28971cb6686cSJia Liu         temp = temp >> 1;
28981cb6686cSJia Liu     }
28991cb6686cSJia Liu 
29001cb6686cSJia Liu     return (target_ulong)rd;
29011cb6686cSJia Liu }
29021cb6686cSJia Liu 
29031cb6686cSJia Liu #define BIT_INSV(name, posfilter, sizefilter, ret_type)         \
29041cb6686cSJia Liu target_ulong helper_##name(CPUMIPSState *env, target_ulong rs,  \
29051cb6686cSJia Liu                            target_ulong rt)                     \
29061cb6686cSJia Liu {                                                               \
29071cb6686cSJia Liu     uint32_t pos, size, msb, lsb;                               \
29081cb6686cSJia Liu     target_ulong filter;                                        \
29091cb6686cSJia Liu     target_ulong temp, temprs, temprt;                          \
29101cb6686cSJia Liu     target_ulong dspc;                                          \
29111cb6686cSJia Liu                                                                 \
29121cb6686cSJia Liu     dspc = env->active_tc.DSPControl;                           \
29131cb6686cSJia Liu                                                                 \
29141cb6686cSJia Liu     pos  = dspc & posfilter;                                    \
29151cb6686cSJia Liu     size = (dspc >> 7) & sizefilter;                            \
29161cb6686cSJia Liu                                                                 \
29171cb6686cSJia Liu     msb  = pos + size - 1;                                      \
29181cb6686cSJia Liu     lsb  = pos;                                                 \
29191cb6686cSJia Liu                                                                 \
29201cb6686cSJia Liu     if (lsb > msb || (msb > TARGET_LONG_BITS)) {                \
29211cb6686cSJia Liu         return rt;                                              \
29221cb6686cSJia Liu     }                                                           \
29231cb6686cSJia Liu                                                                 \
2924c0f5f9ceSPetar Jovanovic     filter = ((int64_t)0x01 << size) - 1;                       \
29251cb6686cSJia Liu     filter = filter << pos;                                     \
292634f5606eSPetar Jovanovic     temprs = (rs << pos) & filter;                              \
29271cb6686cSJia Liu     temprt = rt & ~filter;                                      \
29281cb6686cSJia Liu     temp = temprs | temprt;                                     \
29291cb6686cSJia Liu                                                                 \
29301cb6686cSJia Liu     return (target_long)(ret_type)temp;                         \
29311cb6686cSJia Liu }
29321cb6686cSJia Liu 
2933c0f5f9ceSPetar Jovanovic BIT_INSV(insv, 0x1F, 0x3F, int32_t);
29341cb6686cSJia Liu #ifdef TARGET_MIPS64
29351cb6686cSJia Liu BIT_INSV(dinsv, 0x7F, 0x3F, target_long);
29361cb6686cSJia Liu #endif
29371cb6686cSJia Liu 
29381cb6686cSJia Liu #undef BIT_INSV
29391cb6686cSJia Liu 
29401cb6686cSJia Liu 
294126690560SJia Liu /** DSP Compare-Pick Sub-class insns **/
294226690560SJia Liu #define CMP_HAS_RET(name, func, split_num, filter, bit_size) \
294326690560SJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt) \
294426690560SJia Liu {                                                       \
294526690560SJia Liu     uint32_t rs_t, rt_t;                                \
294626690560SJia Liu     uint8_t cc;                                         \
294726690560SJia Liu     uint32_t temp = 0;                                  \
294826690560SJia Liu     int i;                                              \
294926690560SJia Liu                                                         \
295026690560SJia Liu     for (i = 0; i < split_num; i++) {                   \
295126690560SJia Liu         rs_t = (rs >> (bit_size * i)) & filter;         \
295226690560SJia Liu         rt_t = (rt >> (bit_size * i)) & filter;         \
295326690560SJia Liu         cc = mipsdsp_##func(rs_t, rt_t);                \
295426690560SJia Liu         temp |= cc << i;                                \
295526690560SJia Liu     }                                                   \
295626690560SJia Liu                                                         \
295726690560SJia Liu     return (target_ulong)temp;                          \
295826690560SJia Liu }
295926690560SJia Liu 
296026690560SJia Liu CMP_HAS_RET(cmpgu_eq_qb, cmpu_eq, 4, MIPSDSP_Q0, 8);
296126690560SJia Liu CMP_HAS_RET(cmpgu_lt_qb, cmpu_lt, 4, MIPSDSP_Q0, 8);
296226690560SJia Liu CMP_HAS_RET(cmpgu_le_qb, cmpu_le, 4, MIPSDSP_Q0, 8);
296326690560SJia Liu 
296426690560SJia Liu #ifdef TARGET_MIPS64
296526690560SJia Liu CMP_HAS_RET(cmpgu_eq_ob, cmpu_eq, 8, MIPSDSP_Q0, 8);
296626690560SJia Liu CMP_HAS_RET(cmpgu_lt_ob, cmpu_lt, 8, MIPSDSP_Q0, 8);
296726690560SJia Liu CMP_HAS_RET(cmpgu_le_ob, cmpu_le, 8, MIPSDSP_Q0, 8);
296826690560SJia Liu #endif
296926690560SJia Liu 
297026690560SJia Liu #undef CMP_HAS_RET
297126690560SJia Liu 
297226690560SJia Liu 
297326690560SJia Liu #define CMP_NO_RET(name, func, split_num, filter, bit_size) \
297426690560SJia Liu void helper_##name(target_ulong rs, target_ulong rt,        \
297526690560SJia Liu                             CPUMIPSState *env)              \
297626690560SJia Liu {                                                           \
297726690560SJia Liu     int##bit_size##_t rs_t, rt_t;                           \
297826690560SJia Liu     int##bit_size##_t flag = 0;                             \
297926690560SJia Liu     int##bit_size##_t cc;                                   \
298026690560SJia Liu     int i;                                                  \
298126690560SJia Liu                                                             \
298226690560SJia Liu     for (i = 0; i < split_num; i++) {                       \
298326690560SJia Liu         rs_t = (rs >> (bit_size * i)) & filter;             \
298426690560SJia Liu         rt_t = (rt >> (bit_size * i)) & filter;             \
298526690560SJia Liu                                                             \
298626690560SJia Liu         cc = mipsdsp_##func((int32_t)rs_t, (int32_t)rt_t);  \
298726690560SJia Liu         flag |= cc << i;                                    \
298826690560SJia Liu     }                                                       \
298926690560SJia Liu                                                             \
299026690560SJia Liu     set_DSPControl_24(flag, split_num, env);                \
299126690560SJia Liu }
299226690560SJia Liu 
299326690560SJia Liu CMP_NO_RET(cmpu_eq_qb, cmpu_eq, 4, MIPSDSP_Q0, 8);
299426690560SJia Liu CMP_NO_RET(cmpu_lt_qb, cmpu_lt, 4, MIPSDSP_Q0, 8);
299526690560SJia Liu CMP_NO_RET(cmpu_le_qb, cmpu_le, 4, MIPSDSP_Q0, 8);
299626690560SJia Liu 
299726690560SJia Liu CMP_NO_RET(cmp_eq_ph, cmp_eq, 2, MIPSDSP_LO, 16);
299826690560SJia Liu CMP_NO_RET(cmp_lt_ph, cmp_lt, 2, MIPSDSP_LO, 16);
299926690560SJia Liu CMP_NO_RET(cmp_le_ph, cmp_le, 2, MIPSDSP_LO, 16);
300026690560SJia Liu 
300126690560SJia Liu #ifdef TARGET_MIPS64
300226690560SJia Liu CMP_NO_RET(cmpu_eq_ob, cmpu_eq, 8, MIPSDSP_Q0, 8);
300326690560SJia Liu CMP_NO_RET(cmpu_lt_ob, cmpu_lt, 8, MIPSDSP_Q0, 8);
300426690560SJia Liu CMP_NO_RET(cmpu_le_ob, cmpu_le, 8, MIPSDSP_Q0, 8);
300526690560SJia Liu 
300626690560SJia Liu CMP_NO_RET(cmp_eq_qh, cmp_eq, 4, MIPSDSP_LO, 16);
300726690560SJia Liu CMP_NO_RET(cmp_lt_qh, cmp_lt, 4, MIPSDSP_LO, 16);
300826690560SJia Liu CMP_NO_RET(cmp_le_qh, cmp_le, 4, MIPSDSP_LO, 16);
300926690560SJia Liu 
301026690560SJia Liu CMP_NO_RET(cmp_eq_pw, cmp_eq, 2, MIPSDSP_LLO, 32);
301126690560SJia Liu CMP_NO_RET(cmp_lt_pw, cmp_lt, 2, MIPSDSP_LLO, 32);
301226690560SJia Liu CMP_NO_RET(cmp_le_pw, cmp_le, 2, MIPSDSP_LLO, 32);
301326690560SJia Liu #endif
301426690560SJia Liu #undef CMP_NO_RET
301526690560SJia Liu 
301626690560SJia Liu #if defined(TARGET_MIPS64)
301726690560SJia Liu 
301826690560SJia Liu #define CMPGDU_OB(name) \
301926690560SJia Liu target_ulong helper_cmpgdu_##name##_ob(target_ulong rs, target_ulong rt, \
302026690560SJia Liu                                        CPUMIPSState *env)  \
302126690560SJia Liu {                                                     \
302226690560SJia Liu     int i;                                            \
302326690560SJia Liu     uint8_t rs_t, rt_t;                               \
302426690560SJia Liu     uint32_t cond;                                    \
302526690560SJia Liu                                                       \
302626690560SJia Liu     cond = 0;                                         \
302726690560SJia Liu                                                       \
302826690560SJia Liu     for (i = 0; i < 8; i++) {                         \
302926690560SJia Liu         rs_t = (rs >> (8 * i)) & MIPSDSP_Q0;          \
303026690560SJia Liu         rt_t = (rt >> (8 * i)) & MIPSDSP_Q0;          \
303126690560SJia Liu                                                       \
303226690560SJia Liu         if (mipsdsp_cmpu_##name(rs_t, rt_t)) {        \
303326690560SJia Liu             cond |= 0x01 << i;                        \
303426690560SJia Liu         }                                             \
303526690560SJia Liu     }                                                 \
303626690560SJia Liu                                                       \
303726690560SJia Liu     set_DSPControl_24(cond, 8, env);                  \
303826690560SJia Liu                                                       \
303926690560SJia Liu     return (uint64_t)cond;                            \
304026690560SJia Liu }
304126690560SJia Liu 
304226690560SJia Liu CMPGDU_OB(eq)
304326690560SJia Liu CMPGDU_OB(lt)
304426690560SJia Liu CMPGDU_OB(le)
304526690560SJia Liu #undef CMPGDU_OB
304626690560SJia Liu #endif
304726690560SJia Liu 
304826690560SJia Liu #define PICK_INSN(name, split_num, filter, bit_size, ret32bit) \
304926690560SJia Liu target_ulong helper_##name(target_ulong rs, target_ulong rt,   \
305026690560SJia Liu                             CPUMIPSState *env)                 \
305126690560SJia Liu {                                                              \
305226690560SJia Liu     uint32_t rs_t, rt_t;                                       \
305326690560SJia Liu     uint32_t cc;                                               \
305426690560SJia Liu     target_ulong dsp;                                          \
305526690560SJia Liu     int i;                                                     \
305626690560SJia Liu     target_ulong result = 0;                                   \
305726690560SJia Liu                                                                \
305826690560SJia Liu     dsp = env->active_tc.DSPControl;                           \
305926690560SJia Liu     for (i = 0; i < split_num; i++) {                          \
306026690560SJia Liu         rs_t = (rs >> (bit_size * i)) & filter;                \
306126690560SJia Liu         rt_t = (rt >> (bit_size * i)) & filter;                \
306226690560SJia Liu         cc = (dsp >> (24 + i)) & 0x01;                         \
306326690560SJia Liu         cc = cc == 1 ? rs_t : rt_t;                            \
306426690560SJia Liu                                                                \
306526690560SJia Liu         result |= (target_ulong)cc << (bit_size * i);          \
306626690560SJia Liu     }                                                          \
306726690560SJia Liu                                                                \
306826690560SJia Liu     if (ret32bit) {                                            \
306926690560SJia Liu         result = (target_long)(int32_t)(result & MIPSDSP_LLO); \
307026690560SJia Liu     }                                                          \
307126690560SJia Liu                                                                \
307226690560SJia Liu     return result;                                             \
307326690560SJia Liu }
307426690560SJia Liu 
307526690560SJia Liu PICK_INSN(pick_qb, 4, MIPSDSP_Q0, 8, 1);
307626690560SJia Liu PICK_INSN(pick_ph, 2, MIPSDSP_LO, 16, 1);
307726690560SJia Liu 
307826690560SJia Liu #ifdef TARGET_MIPS64
307926690560SJia Liu PICK_INSN(pick_ob, 8, MIPSDSP_Q0, 8, 0);
308026690560SJia Liu PICK_INSN(pick_qh, 4, MIPSDSP_LO, 16, 0);
308126690560SJia Liu PICK_INSN(pick_pw, 2, MIPSDSP_LLO, 32, 0);
308226690560SJia Liu #endif
308326690560SJia Liu #undef PICK_INSN
308426690560SJia Liu 
308526690560SJia Liu target_ulong helper_packrl_ph(target_ulong rs, target_ulong rt)
308626690560SJia Liu {
308726690560SJia Liu     uint32_t rsl, rth;
308826690560SJia Liu 
308926690560SJia Liu     rsl =  rs & MIPSDSP_LO;
309026690560SJia Liu     rth = (rt & MIPSDSP_HI) >> 16;
309126690560SJia Liu 
309226690560SJia Liu     return (target_long)(int32_t)((rsl << 16) | rth);
309326690560SJia Liu }
309426690560SJia Liu 
309526690560SJia Liu #if defined(TARGET_MIPS64)
309626690560SJia Liu target_ulong helper_packrl_pw(target_ulong rs, target_ulong rt)
309726690560SJia Liu {
309826690560SJia Liu     uint32_t rs0, rt1;
309926690560SJia Liu 
310026690560SJia Liu     rs0 = rs & MIPSDSP_LLO;
310126690560SJia Liu     rt1 = (rt >> 32) & MIPSDSP_LLO;
310226690560SJia Liu 
310326690560SJia Liu     return ((uint64_t)rs0 << 32) | (uint64_t)rt1;
310426690560SJia Liu }
310526690560SJia Liu #endif
310626690560SJia Liu 
3107b53371edSJia Liu /** DSP Accumulator and DSPControl Access Sub-class insns **/
3108b53371edSJia Liu target_ulong helper_extr_w(target_ulong ac, target_ulong shift,
3109b53371edSJia Liu                            CPUMIPSState *env)
3110b53371edSJia Liu {
3111b53371edSJia Liu     int32_t tempI;
3112b53371edSJia Liu     int64_t tempDL[2];
3113b53371edSJia Liu 
3114b8abbbe8SPetar Jovanovic     shift = shift & 0x1F;
3115b53371edSJia Liu 
3116b53371edSJia Liu     mipsdsp_rndrashift_short_acc(tempDL, ac, shift, env);
3117b53371edSJia Liu     if ((tempDL[1] != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) &&
3118b53371edSJia Liu         (tempDL[1] != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) {
3119b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3120b53371edSJia Liu     }
3121b53371edSJia Liu 
3122b53371edSJia Liu     tempI = (tempDL[0] >> 1) & MIPSDSP_LLO;
3123b53371edSJia Liu 
3124b53371edSJia Liu     tempDL[0] += 1;
3125b53371edSJia Liu     if (tempDL[0] == 0) {
3126b53371edSJia Liu         tempDL[1] += 1;
3127b53371edSJia Liu     }
3128b53371edSJia Liu 
31298b758d05SPetar Jovanovic     if (((tempDL[1] & 0x01) != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) &&
31308b758d05SPetar Jovanovic         ((tempDL[1] & 0x01) != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) {
3131b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3132b53371edSJia Liu     }
3133b53371edSJia Liu 
3134b53371edSJia Liu     return (target_long)tempI;
3135b53371edSJia Liu }
3136b53371edSJia Liu 
3137b53371edSJia Liu target_ulong helper_extr_r_w(target_ulong ac, target_ulong shift,
3138b53371edSJia Liu                              CPUMIPSState *env)
3139b53371edSJia Liu {
3140b53371edSJia Liu     int64_t tempDL[2];
3141b53371edSJia Liu 
3142b8abbbe8SPetar Jovanovic     shift = shift & 0x1F;
3143b53371edSJia Liu 
3144b53371edSJia Liu     mipsdsp_rndrashift_short_acc(tempDL, ac, shift, env);
3145b53371edSJia Liu     if ((tempDL[1] != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) &&
3146b53371edSJia Liu         (tempDL[1] != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) {
3147b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3148b53371edSJia Liu     }
3149b53371edSJia Liu 
3150b53371edSJia Liu     tempDL[0] += 1;
3151b53371edSJia Liu     if (tempDL[0] == 0) {
3152b53371edSJia Liu         tempDL[1] += 1;
3153b53371edSJia Liu     }
3154b53371edSJia Liu 
31558b758d05SPetar Jovanovic     if (((tempDL[1] & 0x01) != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) &&
31568b758d05SPetar Jovanovic         ((tempDL[1] & 0x01) != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) {
3157b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3158b53371edSJia Liu     }
3159b53371edSJia Liu 
3160b53371edSJia Liu     return (target_long)(int32_t)(tempDL[0] >> 1);
3161b53371edSJia Liu }
3162b53371edSJia Liu 
3163b53371edSJia Liu target_ulong helper_extr_rs_w(target_ulong ac, target_ulong shift,
3164b53371edSJia Liu                               CPUMIPSState *env)
3165b53371edSJia Liu {
3166b53371edSJia Liu     int32_t tempI, temp64;
3167b53371edSJia Liu     int64_t tempDL[2];
3168b53371edSJia Liu 
3169b8abbbe8SPetar Jovanovic     shift = shift & 0x1F;
3170b53371edSJia Liu 
3171b53371edSJia Liu     mipsdsp_rndrashift_short_acc(tempDL, ac, shift, env);
3172b53371edSJia Liu     if ((tempDL[1] != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) &&
3173b53371edSJia Liu         (tempDL[1] != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) {
3174b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3175b53371edSJia Liu     }
3176b53371edSJia Liu     tempDL[0] += 1;
3177b53371edSJia Liu     if (tempDL[0] == 0) {
3178b53371edSJia Liu         tempDL[1] += 1;
3179b53371edSJia Liu     }
3180b53371edSJia Liu     tempI = tempDL[0] >> 1;
3181b53371edSJia Liu 
31828b758d05SPetar Jovanovic     if (((tempDL[1] & 0x01) != 0 || (tempDL[0] & MIPSDSP_LHI) != 0) &&
31838b758d05SPetar Jovanovic         ((tempDL[1] & 0x01) != 1 || (tempDL[0] & MIPSDSP_LHI) != MIPSDSP_LHI)) {
31848b758d05SPetar Jovanovic         temp64 = tempDL[1] & 0x01;
3185b53371edSJia Liu         if (temp64 == 0) {
3186b53371edSJia Liu             tempI = 0x7FFFFFFF;
3187b53371edSJia Liu         } else {
3188b53371edSJia Liu             tempI = 0x80000000;
3189b53371edSJia Liu         }
3190b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3191b53371edSJia Liu     }
3192b53371edSJia Liu 
3193b53371edSJia Liu     return (target_long)tempI;
3194b53371edSJia Liu }
3195b53371edSJia Liu 
3196b53371edSJia Liu #if defined(TARGET_MIPS64)
3197b53371edSJia Liu target_ulong helper_dextr_w(target_ulong ac, target_ulong shift,
3198b53371edSJia Liu                             CPUMIPSState *env)
3199b53371edSJia Liu {
3200b53371edSJia Liu     uint64_t temp[3];
3201b53371edSJia Liu 
3202b53371edSJia Liu     shift = shift & 0x3F;
3203b53371edSJia Liu 
3204b53371edSJia Liu     mipsdsp_rndrashift_acc(temp, ac, shift, env);
3205b53371edSJia Liu 
3206b53371edSJia Liu     return (int64_t)(int32_t)(temp[0] >> 1);
3207b53371edSJia Liu }
3208b53371edSJia Liu 
3209b53371edSJia Liu target_ulong helper_dextr_r_w(target_ulong ac, target_ulong shift,
3210b53371edSJia Liu                               CPUMIPSState *env)
3211b53371edSJia Liu {
3212b53371edSJia Liu     uint64_t temp[3];
3213b53371edSJia Liu     uint32_t temp128;
3214b53371edSJia Liu 
3215b53371edSJia Liu     shift = shift & 0x3F;
3216b53371edSJia Liu     mipsdsp_rndrashift_acc(temp, ac, shift, env);
3217b53371edSJia Liu 
3218b53371edSJia Liu     temp[0] += 1;
3219b53371edSJia Liu     if (temp[0] == 0) {
3220b53371edSJia Liu         temp[1] += 1;
3221b53371edSJia Liu         if (temp[1] == 0) {
3222b53371edSJia Liu             temp[2] += 1;
3223b53371edSJia Liu         }
3224b53371edSJia Liu     }
3225b53371edSJia Liu 
3226b53371edSJia Liu     temp128 = temp[2] & 0x01;
3227b53371edSJia Liu 
3228b53371edSJia Liu     if ((temp128 != 0 || temp[1] != 0) &&
3229b53371edSJia Liu        (temp128 != 1 || temp[1] != ~0ull)) {
3230b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3231b53371edSJia Liu     }
3232b53371edSJia Liu 
3233b53371edSJia Liu     return (int64_t)(int32_t)(temp[0] >> 1);
3234b53371edSJia Liu }
3235b53371edSJia Liu 
3236b53371edSJia Liu target_ulong helper_dextr_rs_w(target_ulong ac, target_ulong shift,
3237b53371edSJia Liu                                CPUMIPSState *env)
3238b53371edSJia Liu {
3239b53371edSJia Liu     uint64_t temp[3];
3240b53371edSJia Liu     uint32_t temp128;
3241b53371edSJia Liu 
3242b53371edSJia Liu     shift = shift & 0x3F;
3243b53371edSJia Liu     mipsdsp_rndrashift_acc(temp, ac, shift, env);
3244b53371edSJia Liu 
3245b53371edSJia Liu     temp[0] += 1;
3246b53371edSJia Liu     if (temp[0] == 0) {
3247b53371edSJia Liu         temp[1] += 1;
3248b53371edSJia Liu         if (temp[1] == 0) {
3249b53371edSJia Liu             temp[2] += 1;
3250b53371edSJia Liu         }
3251b53371edSJia Liu     }
3252b53371edSJia Liu 
3253b53371edSJia Liu     temp128 = temp[2] & 0x01;
3254b53371edSJia Liu 
3255b53371edSJia Liu     if ((temp128 != 0 || temp[1] != 0) &&
3256b53371edSJia Liu        (temp128 != 1 || temp[1] != ~0ull)) {
3257b53371edSJia Liu         if (temp128 == 0) {
3258b53371edSJia Liu             temp[0] = 0x0FFFFFFFF;
3259b53371edSJia Liu         } else {
32601cfd981fSBlue Swirl             temp[0] = 0x0100000000ULL;
3261b53371edSJia Liu         }
3262b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3263b53371edSJia Liu     }
3264b53371edSJia Liu 
3265b53371edSJia Liu     return (int64_t)(int32_t)(temp[0] >> 1);
3266b53371edSJia Liu }
3267b53371edSJia Liu 
3268b53371edSJia Liu target_ulong helper_dextr_l(target_ulong ac, target_ulong shift,
3269b53371edSJia Liu                             CPUMIPSState *env)
3270b53371edSJia Liu {
3271b53371edSJia Liu     uint64_t temp[3];
3272b53371edSJia Liu     target_ulong result;
3273b53371edSJia Liu 
3274b53371edSJia Liu     shift = shift & 0x3F;
3275b53371edSJia Liu 
3276b53371edSJia Liu     mipsdsp_rndrashift_acc(temp, ac, shift, env);
3277b53371edSJia Liu     result = (temp[1] << 63) | (temp[0] >> 1);
3278b53371edSJia Liu 
3279b53371edSJia Liu     return result;
3280b53371edSJia Liu }
3281b53371edSJia Liu 
3282b53371edSJia Liu target_ulong helper_dextr_r_l(target_ulong ac, target_ulong shift,
3283b53371edSJia Liu                               CPUMIPSState *env)
3284b53371edSJia Liu {
3285b53371edSJia Liu     uint64_t temp[3];
3286b53371edSJia Liu     uint32_t temp128;
3287b53371edSJia Liu     target_ulong result;
3288b53371edSJia Liu 
3289b53371edSJia Liu     shift = shift & 0x3F;
3290b53371edSJia Liu     mipsdsp_rndrashift_acc(temp, ac, shift, env);
3291b53371edSJia Liu 
3292b53371edSJia Liu     temp[0] += 1;
3293b53371edSJia Liu     if (temp[0] == 0) {
3294b53371edSJia Liu         temp[1] += 1;
3295b53371edSJia Liu         if (temp[1] == 0) {
3296b53371edSJia Liu             temp[2] += 1;
3297b53371edSJia Liu         }
3298b53371edSJia Liu     }
3299b53371edSJia Liu 
3300b53371edSJia Liu     temp128 = temp[2] & 0x01;
3301b53371edSJia Liu 
3302b53371edSJia Liu     if ((temp128 != 0 || temp[1] != 0) &&
3303b53371edSJia Liu        (temp128 != 1 || temp[1] != ~0ull)) {
3304b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3305b53371edSJia Liu     }
3306b53371edSJia Liu 
3307b53371edSJia Liu     result = (temp[1] << 63) | (temp[0] >> 1);
3308b53371edSJia Liu 
3309b53371edSJia Liu     return result;
3310b53371edSJia Liu }
3311b53371edSJia Liu 
3312b53371edSJia Liu target_ulong helper_dextr_rs_l(target_ulong ac, target_ulong shift,
3313b53371edSJia Liu                                CPUMIPSState *env)
3314b53371edSJia Liu {
3315b53371edSJia Liu     uint64_t temp[3];
3316b53371edSJia Liu     uint32_t temp128;
3317b53371edSJia Liu     target_ulong result;
3318b53371edSJia Liu 
3319b53371edSJia Liu     shift = shift & 0x3F;
3320b53371edSJia Liu     mipsdsp_rndrashift_acc(temp, ac, shift, env);
3321b53371edSJia Liu 
3322b53371edSJia Liu     temp[0] += 1;
3323b53371edSJia Liu     if (temp[0] == 0) {
3324b53371edSJia Liu         temp[1] += 1;
3325b53371edSJia Liu         if (temp[1] == 0) {
3326b53371edSJia Liu             temp[2] += 1;
3327b53371edSJia Liu         }
3328b53371edSJia Liu     }
3329b53371edSJia Liu 
3330b53371edSJia Liu     temp128 = temp[2] & 0x01;
3331b53371edSJia Liu 
3332b53371edSJia Liu     if ((temp128 != 0 || temp[1] != 0) &&
3333b53371edSJia Liu        (temp128 != 1 || temp[1] != ~0ull)) {
3334b53371edSJia Liu         if (temp128 == 0) {
3335b53371edSJia Liu             temp[1] &= ~0x00ull - 1;
3336b53371edSJia Liu             temp[0] |= ~0x00ull - 1;
3337b53371edSJia Liu         } else {
3338b53371edSJia Liu             temp[1] |= 0x01;
3339b53371edSJia Liu             temp[0] &= 0x01;
3340b53371edSJia Liu         }
3341b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3342b53371edSJia Liu     }
3343b53371edSJia Liu     result = (temp[1] << 63) | (temp[0] >> 1);
3344b53371edSJia Liu 
3345b53371edSJia Liu     return result;
3346b53371edSJia Liu }
3347b53371edSJia Liu #endif
3348b53371edSJia Liu 
3349b53371edSJia Liu target_ulong helper_extr_s_h(target_ulong ac, target_ulong shift,
3350b53371edSJia Liu                              CPUMIPSState *env)
3351b53371edSJia Liu {
3352b8abbbe8SPetar Jovanovic     int64_t temp, acc;
3353b53371edSJia Liu 
3354b8abbbe8SPetar Jovanovic     shift = shift & 0x1F;
3355b53371edSJia Liu 
3356b8abbbe8SPetar Jovanovic     acc = ((int64_t)env->active_tc.HI[ac] << 32) |
3357b8abbbe8SPetar Jovanovic           ((int64_t)env->active_tc.LO[ac] & 0xFFFFFFFF);
3358b8abbbe8SPetar Jovanovic 
3359b8abbbe8SPetar Jovanovic     temp = acc >> shift;
3360b8abbbe8SPetar Jovanovic 
3361b53371edSJia Liu     if (temp > (int64_t)0x7FFF) {
3362b53371edSJia Liu         temp = 0x00007FFF;
3363b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
33641cfd981fSBlue Swirl     } else if (temp < (int64_t)0xFFFFFFFFFFFF8000ULL) {
3365b53371edSJia Liu         temp = 0xFFFF8000;
3366b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3367b53371edSJia Liu     }
3368b53371edSJia Liu 
3369b53371edSJia Liu     return (target_long)(int32_t)(temp & 0xFFFFFFFF);
3370b53371edSJia Liu }
3371b53371edSJia Liu 
3372b53371edSJia Liu 
3373b53371edSJia Liu #if defined(TARGET_MIPS64)
3374b53371edSJia Liu target_ulong helper_dextr_s_h(target_ulong ac, target_ulong shift,
3375b53371edSJia Liu                               CPUMIPSState *env)
3376b53371edSJia Liu {
3377b53371edSJia Liu     int64_t temp[2];
3378b53371edSJia Liu     uint32_t temp127;
3379b53371edSJia Liu 
3380b53371edSJia Liu     shift = shift & 0x1F;
3381b53371edSJia Liu 
3382b53371edSJia Liu     mipsdsp_rashift_acc((uint64_t *)temp, ac, shift, env);
3383b53371edSJia Liu 
3384b53371edSJia Liu     temp127 = (temp[1] >> 63) & 0x01;
3385b53371edSJia Liu 
3386b53371edSJia Liu     if ((temp127 == 0) && (temp[1] > 0 || temp[0] > 32767)) {
3387b53371edSJia Liu         temp[0] &= 0xFFFF0000;
3388b53371edSJia Liu         temp[0] |= 0x00007FFF;
3389b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3390b53371edSJia Liu     } else if ((temp127 == 1) &&
3391b53371edSJia Liu             (temp[1] < 0xFFFFFFFFFFFFFFFFll
3392b53371edSJia Liu              || temp[0] < 0xFFFFFFFFFFFF1000ll)) {
3393b53371edSJia Liu         temp[0] &= 0xFFFF0000;
3394b53371edSJia Liu         temp[0] |= 0x00008000;
3395b53371edSJia Liu         set_DSPControl_overflow_flag(1, 23, env);
3396b53371edSJia Liu     }
3397b53371edSJia Liu 
3398b53371edSJia Liu     return (int64_t)(int16_t)(temp[0] & MIPSDSP_LO);
3399b53371edSJia Liu }
3400b53371edSJia Liu 
3401b53371edSJia Liu #endif
3402b53371edSJia Liu 
3403b53371edSJia Liu target_ulong helper_extp(target_ulong ac, target_ulong size, CPUMIPSState *env)
3404b53371edSJia Liu {
3405b53371edSJia Liu     int32_t start_pos;
3406b53371edSJia Liu     int sub;
3407b53371edSJia Liu     uint32_t temp;
3408b53371edSJia Liu     uint64_t acc;
3409b53371edSJia Liu 
3410b53371edSJia Liu     size = size & 0x1F;
3411b53371edSJia Liu 
3412b53371edSJia Liu     temp = 0;
3413b53371edSJia Liu     start_pos = get_DSPControl_pos(env);
3414b53371edSJia Liu     sub = start_pos - (size + 1);
3415b53371edSJia Liu     if (sub >= -1) {
3416b53371edSJia Liu         acc = ((uint64_t)env->active_tc.HI[ac] << 32) |
3417b53371edSJia Liu               ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO);
3418b53371edSJia Liu         temp = (acc >> (start_pos - size)) &
3419b53371edSJia Liu                (((uint32_t)0x01 << (size + 1)) - 1);
3420b53371edSJia Liu         set_DSPControl_efi(0, env);
3421b53371edSJia Liu     } else {
3422b53371edSJia Liu         set_DSPControl_efi(1, env);
3423b53371edSJia Liu     }
3424b53371edSJia Liu 
3425b53371edSJia Liu     return (target_ulong)temp;
3426b53371edSJia Liu }
3427b53371edSJia Liu 
3428b53371edSJia Liu target_ulong helper_extpdp(target_ulong ac, target_ulong size,
3429b53371edSJia Liu                            CPUMIPSState *env)
3430b53371edSJia Liu {
3431b53371edSJia Liu     int32_t start_pos;
3432b53371edSJia Liu     int sub;
3433b53371edSJia Liu     uint32_t temp;
3434b53371edSJia Liu     uint64_t acc;
3435b53371edSJia Liu 
3436b53371edSJia Liu     size = size & 0x1F;
3437b53371edSJia Liu     temp = 0;
3438b53371edSJia Liu     start_pos = get_DSPControl_pos(env);
3439b53371edSJia Liu     sub = start_pos - (size + 1);
3440b53371edSJia Liu     if (sub >= -1) {
3441b53371edSJia Liu         acc  = ((uint64_t)env->active_tc.HI[ac] << 32) |
3442b53371edSJia Liu                ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO);
3443b53371edSJia Liu         temp = (acc >> (start_pos - size)) &
3444b53371edSJia Liu                (((uint32_t)0x01 << (size + 1)) - 1);
3445b53371edSJia Liu 
3446b53371edSJia Liu         set_DSPControl_pos(start_pos - (size + 1), env);
3447b53371edSJia Liu         set_DSPControl_efi(0, env);
3448b53371edSJia Liu     } else {
3449b53371edSJia Liu         set_DSPControl_efi(1, env);
3450b53371edSJia Liu     }
3451b53371edSJia Liu 
3452b53371edSJia Liu     return (target_ulong)temp;
3453b53371edSJia Liu }
3454b53371edSJia Liu 
3455b53371edSJia Liu 
3456b53371edSJia Liu #if defined(TARGET_MIPS64)
3457b53371edSJia Liu target_ulong helper_dextp(target_ulong ac, target_ulong size, CPUMIPSState *env)
3458b53371edSJia Liu {
3459b53371edSJia Liu     int start_pos;
3460b53371edSJia Liu     int len;
3461b53371edSJia Liu     int sub;
3462b53371edSJia Liu     uint64_t tempB, tempA;
3463b53371edSJia Liu     uint64_t temp;
3464b53371edSJia Liu 
3465b53371edSJia Liu     temp = 0;
3466b53371edSJia Liu 
3467b53371edSJia Liu     size = size & 0x3F;
3468b53371edSJia Liu     start_pos = get_DSPControl_pos(env);
3469b53371edSJia Liu     len = start_pos - size;
3470b53371edSJia Liu     tempB = env->active_tc.HI[ac];
3471b53371edSJia Liu     tempA = env->active_tc.LO[ac];
3472b53371edSJia Liu 
3473b53371edSJia Liu     sub = start_pos - (size + 1);
3474b53371edSJia Liu 
3475b53371edSJia Liu     if (sub >= -1) {
3476b53371edSJia Liu         temp = (tempB << (64 - len)) | (tempA >> len);
3477b53371edSJia Liu         temp = temp & ((0x01 << (size + 1)) - 1);
3478b53371edSJia Liu         set_DSPControl_efi(0, env);
3479b53371edSJia Liu     } else {
3480b53371edSJia Liu         set_DSPControl_efi(1, env);
3481b53371edSJia Liu     }
3482b53371edSJia Liu 
3483b53371edSJia Liu     return temp;
3484b53371edSJia Liu }
3485b53371edSJia Liu 
3486b53371edSJia Liu target_ulong helper_dextpdp(target_ulong ac, target_ulong size,
3487b53371edSJia Liu                             CPUMIPSState *env)
3488b53371edSJia Liu {
3489b53371edSJia Liu     int start_pos;
3490b53371edSJia Liu     int len;
3491b53371edSJia Liu     int sub;
3492b53371edSJia Liu     uint64_t tempB, tempA;
3493b53371edSJia Liu     uint64_t temp;
3494b53371edSJia Liu 
3495b53371edSJia Liu     temp = 0;
3496b53371edSJia Liu     size = size & 0x3F;
3497b53371edSJia Liu     start_pos = get_DSPControl_pos(env);
3498b53371edSJia Liu     len = start_pos - size;
3499b53371edSJia Liu     tempB = env->active_tc.HI[ac];
3500b53371edSJia Liu     tempA = env->active_tc.LO[ac];
3501b53371edSJia Liu 
3502b53371edSJia Liu     sub = start_pos - (size + 1);
3503b53371edSJia Liu 
3504b53371edSJia Liu     if (sub >= -1) {
3505b53371edSJia Liu         temp = (tempB << (64 - len)) | (tempA >> len);
3506b53371edSJia Liu         temp = temp & ((0x01 << (size + 1)) - 1);
3507b53371edSJia Liu         set_DSPControl_pos(sub, env);
3508b53371edSJia Liu         set_DSPControl_efi(0, env);
3509b53371edSJia Liu     } else {
3510b53371edSJia Liu         set_DSPControl_efi(1, env);
3511b53371edSJia Liu     }
3512b53371edSJia Liu 
3513b53371edSJia Liu     return temp;
3514b53371edSJia Liu }
3515b53371edSJia Liu 
3516b53371edSJia Liu #endif
3517b53371edSJia Liu 
3518b53371edSJia Liu void helper_shilo(target_ulong ac, target_ulong rs, CPUMIPSState *env)
3519b53371edSJia Liu {
3520b53371edSJia Liu     int8_t  rs5_0;
3521b53371edSJia Liu     uint64_t temp, acc;
3522b53371edSJia Liu 
3523b53371edSJia Liu     rs5_0 = rs & 0x3F;
3524b53371edSJia Liu     rs5_0 = (int8_t)(rs5_0 << 2) >> 2;
352519e6c50dSPetar Jovanovic 
352619e6c50dSPetar Jovanovic     if (unlikely(rs5_0 == 0)) {
352719e6c50dSPetar Jovanovic         return;
352819e6c50dSPetar Jovanovic     }
352919e6c50dSPetar Jovanovic 
3530b53371edSJia Liu     acc   = (((uint64_t)env->active_tc.HI[ac] << 32) & MIPSDSP_LHI) |
3531b53371edSJia Liu             ((uint64_t)env->active_tc.LO[ac] & MIPSDSP_LLO);
353219e6c50dSPetar Jovanovic 
3533b53371edSJia Liu     if (rs5_0 > 0) {
3534b53371edSJia Liu         temp = acc >> rs5_0;
3535b53371edSJia Liu     } else {
353619e6c50dSPetar Jovanovic         temp = acc << -rs5_0;
3537b53371edSJia Liu     }
3538b53371edSJia Liu 
3539b53371edSJia Liu     env->active_tc.HI[ac] = (target_ulong)(int32_t)((temp & MIPSDSP_LHI) >> 32);
3540b53371edSJia Liu     env->active_tc.LO[ac] = (target_ulong)(int32_t)(temp & MIPSDSP_LLO);
3541b53371edSJia Liu }
3542b53371edSJia Liu 
3543b53371edSJia Liu #if defined(TARGET_MIPS64)
3544b53371edSJia Liu void helper_dshilo(target_ulong shift, target_ulong ac, CPUMIPSState *env)
3545b53371edSJia Liu {
3546b53371edSJia Liu     int8_t shift_t;
3547b53371edSJia Liu     uint64_t tempB, tempA;
3548b53371edSJia Liu 
3549b53371edSJia Liu     shift_t = (int8_t)(shift << 1) >> 1;
3550b53371edSJia Liu 
3551b53371edSJia Liu     tempB = env->active_tc.HI[ac];
3552b53371edSJia Liu     tempA = env->active_tc.LO[ac];
3553b53371edSJia Liu 
3554b53371edSJia Liu     if (shift_t != 0) {
3555b53371edSJia Liu         if (shift_t >= 0) {
3556b53371edSJia Liu             tempA = (tempB << (64 - shift_t)) | (tempA >> shift_t);
3557b53371edSJia Liu             tempB = tempB >> shift_t;
3558b53371edSJia Liu         } else {
3559b53371edSJia Liu             shift_t = -shift_t;
3560b53371edSJia Liu             tempB = (tempB << shift_t) | (tempA >> (64 - shift_t));
3561b53371edSJia Liu             tempA = tempA << shift_t;
3562b53371edSJia Liu         }
3563b53371edSJia Liu     }
3564b53371edSJia Liu 
3565b53371edSJia Liu     env->active_tc.HI[ac] = tempB;
3566b53371edSJia Liu     env->active_tc.LO[ac] = tempA;
3567b53371edSJia Liu }
3568b53371edSJia Liu 
3569b53371edSJia Liu #endif
3570b53371edSJia Liu void helper_mthlip(target_ulong ac, target_ulong rs, CPUMIPSState *env)
3571b53371edSJia Liu {
3572b53371edSJia Liu     int32_t tempA, tempB, pos;
3573b53371edSJia Liu 
3574b53371edSJia Liu     tempA = rs;
3575b53371edSJia Liu     tempB = env->active_tc.LO[ac];
3576b53371edSJia Liu     env->active_tc.HI[ac] = (target_long)tempB;
3577b53371edSJia Liu     env->active_tc.LO[ac] = (target_long)tempA;
3578b53371edSJia Liu     pos = get_DSPControl_pos(env);
3579b53371edSJia Liu 
3580b53371edSJia Liu     if (pos > 32) {
3581b53371edSJia Liu         return;
3582b53371edSJia Liu     } else {
3583b53371edSJia Liu         set_DSPControl_pos(pos + 32, env);
3584b53371edSJia Liu     }
3585b53371edSJia Liu }
3586b53371edSJia Liu 
3587b53371edSJia Liu #if defined(TARGET_MIPS64)
3588b53371edSJia Liu void helper_dmthlip(target_ulong rs, target_ulong ac, CPUMIPSState *env)
3589b53371edSJia Liu {
3590b53371edSJia Liu     uint8_t ac_t;
3591b53371edSJia Liu     uint8_t pos;
3592b53371edSJia Liu     uint64_t tempB, tempA;
3593b53371edSJia Liu 
3594b53371edSJia Liu     ac_t = ac & 0x3;
3595b53371edSJia Liu 
3596b53371edSJia Liu     tempA = rs;
3597b53371edSJia Liu     tempB = env->active_tc.LO[ac_t];
3598b53371edSJia Liu 
3599b53371edSJia Liu     env->active_tc.HI[ac_t] = tempB;
3600b53371edSJia Liu     env->active_tc.LO[ac_t] = tempA;
3601b53371edSJia Liu 
3602b53371edSJia Liu     pos = get_DSPControl_pos(env);
3603b53371edSJia Liu 
3604b53371edSJia Liu     if (pos <= 64) {
3605b53371edSJia Liu         pos = pos + 64;
3606b53371edSJia Liu         set_DSPControl_pos(pos, env);
3607b53371edSJia Liu     }
3608b53371edSJia Liu }
3609b53371edSJia Liu #endif
3610b53371edSJia Liu 
3611084d0497SRichard Henderson void cpu_wrdsp(uint32_t rs, uint32_t mask_num, CPUMIPSState *env)
3612b53371edSJia Liu {
3613b53371edSJia Liu     uint8_t  mask[6];
3614b53371edSJia Liu     uint8_t  i;
3615b53371edSJia Liu     uint32_t newbits, overwrite;
3616b53371edSJia Liu     target_ulong dsp;
3617b53371edSJia Liu 
3618b53371edSJia Liu     newbits   = 0x00;
3619b53371edSJia Liu     overwrite = 0xFFFFFFFF;
3620b53371edSJia Liu     dsp = env->active_tc.DSPControl;
3621b53371edSJia Liu 
3622b53371edSJia Liu     for (i = 0; i < 6; i++) {
3623b53371edSJia Liu         mask[i] = (mask_num >> i) & 0x01;
3624b53371edSJia Liu     }
3625b53371edSJia Liu 
3626b53371edSJia Liu     if (mask[0] == 1) {
3627b53371edSJia Liu #if defined(TARGET_MIPS64)
3628b53371edSJia Liu         overwrite &= 0xFFFFFF80;
3629b53371edSJia Liu         newbits   &= 0xFFFFFF80;
3630b53371edSJia Liu         newbits   |= 0x0000007F & rs;
3631b53371edSJia Liu #else
3632b53371edSJia Liu         overwrite &= 0xFFFFFFC0;
3633b53371edSJia Liu         newbits   &= 0xFFFFFFC0;
3634b53371edSJia Liu         newbits   |= 0x0000003F & rs;
3635b53371edSJia Liu #endif
3636b53371edSJia Liu     }
3637b53371edSJia Liu 
3638b53371edSJia Liu     if (mask[1] == 1) {
3639b53371edSJia Liu         overwrite &= 0xFFFFE07F;
3640b53371edSJia Liu         newbits   &= 0xFFFFE07F;
3641b53371edSJia Liu         newbits   |= 0x00001F80 & rs;
3642b53371edSJia Liu     }
3643b53371edSJia Liu 
3644b53371edSJia Liu     if (mask[2] == 1) {
3645b53371edSJia Liu         overwrite &= 0xFFFFDFFF;
3646b53371edSJia Liu         newbits   &= 0xFFFFDFFF;
3647b53371edSJia Liu         newbits   |= 0x00002000 & rs;
3648b53371edSJia Liu     }
3649b53371edSJia Liu 
3650b53371edSJia Liu     if (mask[3] == 1) {
3651b53371edSJia Liu         overwrite &= 0xFF00FFFF;
3652b53371edSJia Liu         newbits   &= 0xFF00FFFF;
3653b53371edSJia Liu         newbits   |= 0x00FF0000 & rs;
3654b53371edSJia Liu     }
3655b53371edSJia Liu 
3656b53371edSJia Liu     if (mask[4] == 1) {
3657b53371edSJia Liu         overwrite &= 0x00FFFFFF;
3658b53371edSJia Liu         newbits   &= 0x00FFFFFF;
3659eec8972aSPetar Jovanovic #if defined(TARGET_MIPS64)
3660b53371edSJia Liu         newbits   |= 0xFF000000 & rs;
3661eec8972aSPetar Jovanovic #else
3662eec8972aSPetar Jovanovic         newbits   |= 0x0F000000 & rs;
3663eec8972aSPetar Jovanovic #endif
3664b53371edSJia Liu     }
3665b53371edSJia Liu 
3666b53371edSJia Liu     if (mask[5] == 1) {
3667b53371edSJia Liu         overwrite &= 0xFFFFBFFF;
3668b53371edSJia Liu         newbits   &= 0xFFFFBFFF;
3669b53371edSJia Liu         newbits   |= 0x00004000 & rs;
3670b53371edSJia Liu     }
3671b53371edSJia Liu 
3672b53371edSJia Liu     dsp = dsp & overwrite;
3673b53371edSJia Liu     dsp = dsp | newbits;
3674b53371edSJia Liu     env->active_tc.DSPControl = dsp;
3675b53371edSJia Liu }
3676b53371edSJia Liu 
3677084d0497SRichard Henderson void helper_wrdsp(target_ulong rs, target_ulong mask_num, CPUMIPSState *env)
3678084d0497SRichard Henderson {
3679084d0497SRichard Henderson     return cpu_wrdsp(rs, mask_num, env);
3680084d0497SRichard Henderson }
3681084d0497SRichard Henderson 
3682084d0497SRichard Henderson uint32_t cpu_rddsp(uint32_t mask_num, CPUMIPSState *env)
3683b53371edSJia Liu {
3684b53371edSJia Liu     uint8_t  mask[6];
3685b53371edSJia Liu     uint32_t ruler, i;
3686b53371edSJia Liu     target_ulong temp;
3687b53371edSJia Liu     target_ulong dsp;
3688b53371edSJia Liu 
3689b53371edSJia Liu     ruler = 0x01;
3690b53371edSJia Liu     for (i = 0; i < 6; i++) {
3691084d0497SRichard Henderson         mask[i] = (mask_num & ruler) >> i ;
3692b53371edSJia Liu         ruler = ruler << 1;
3693b53371edSJia Liu     }
3694b53371edSJia Liu 
3695b53371edSJia Liu     temp  = 0x00;
3696b53371edSJia Liu     dsp = env->active_tc.DSPControl;
3697b53371edSJia Liu 
3698b53371edSJia Liu     if (mask[0] == 1) {
3699b53371edSJia Liu #if defined(TARGET_MIPS64)
3700b53371edSJia Liu         temp |= dsp & 0x7F;
3701b53371edSJia Liu #else
3702b53371edSJia Liu         temp |= dsp & 0x3F;
3703b53371edSJia Liu #endif
3704b53371edSJia Liu     }
3705b53371edSJia Liu 
3706b53371edSJia Liu     if (mask[1] == 1) {
3707b53371edSJia Liu         temp |= dsp & 0x1F80;
3708b53371edSJia Liu     }
3709b53371edSJia Liu 
3710b53371edSJia Liu     if (mask[2] == 1) {
3711b53371edSJia Liu         temp |= dsp & 0x2000;
3712b53371edSJia Liu     }
3713b53371edSJia Liu 
3714b53371edSJia Liu     if (mask[3] == 1) {
3715b53371edSJia Liu         temp |= dsp & 0x00FF0000;
3716b53371edSJia Liu     }
3717b53371edSJia Liu 
3718b53371edSJia Liu     if (mask[4] == 1) {
3719eec8972aSPetar Jovanovic #if defined(TARGET_MIPS64)
3720b53371edSJia Liu         temp |= dsp & 0xFF000000;
3721eec8972aSPetar Jovanovic #else
3722eec8972aSPetar Jovanovic         temp |= dsp & 0x0F000000;
3723eec8972aSPetar Jovanovic #endif
3724b53371edSJia Liu     }
3725b53371edSJia Liu 
3726b53371edSJia Liu     if (mask[5] == 1) {
3727b53371edSJia Liu         temp |= dsp & 0x4000;
3728b53371edSJia Liu     }
3729b53371edSJia Liu 
3730b53371edSJia Liu     return temp;
3731b53371edSJia Liu }
3732b53371edSJia Liu 
3733084d0497SRichard Henderson target_ulong helper_rddsp(target_ulong mask_num, CPUMIPSState *env)
3734084d0497SRichard Henderson {
3735084d0497SRichard Henderson     return cpu_rddsp(mask_num, env);
3736084d0497SRichard Henderson }
3737084d0497SRichard Henderson 
3738b53371edSJia Liu 
3739461c08dfSJia Liu #undef MIPSDSP_LHI
3740461c08dfSJia Liu #undef MIPSDSP_LLO
3741461c08dfSJia Liu #undef MIPSDSP_HI
3742461c08dfSJia Liu #undef MIPSDSP_LO
3743461c08dfSJia Liu #undef MIPSDSP_Q3
3744461c08dfSJia Liu #undef MIPSDSP_Q2
3745461c08dfSJia Liu #undef MIPSDSP_Q1
3746461c08dfSJia Liu #undef MIPSDSP_Q0
3747461c08dfSJia Liu 
3748461c08dfSJia Liu #undef MIPSDSP_SPLIT32_8
3749461c08dfSJia Liu #undef MIPSDSP_SPLIT32_16
3750461c08dfSJia Liu 
3751461c08dfSJia Liu #undef MIPSDSP_RETURN32_8
3752461c08dfSJia Liu #undef MIPSDSP_RETURN32_16
3753461c08dfSJia Liu 
3754461c08dfSJia Liu #ifdef TARGET_MIPS64
3755461c08dfSJia Liu #undef MIPSDSP_SPLIT64_16
3756461c08dfSJia Liu #undef MIPSDSP_SPLIT64_32
3757461c08dfSJia Liu #undef MIPSDSP_RETURN64_16
3758461c08dfSJia Liu #undef MIPSDSP_RETURN64_32
3759461c08dfSJia Liu #endif
3760