xref: /qemu/target/arm/tcg/mve_helper.c (revision d54deb2a)
1a3ef070eSClaudio Fontana /*
2a3ef070eSClaudio Fontana  * M-profile MVE Operations
3a3ef070eSClaudio Fontana  *
4a3ef070eSClaudio Fontana  * Copyright (c) 2021 Linaro, Ltd.
5a3ef070eSClaudio Fontana  *
6a3ef070eSClaudio Fontana  * This library is free software; you can redistribute it and/or
7a3ef070eSClaudio Fontana  * modify it under the terms of the GNU Lesser General Public
8a3ef070eSClaudio Fontana  * License as published by the Free Software Foundation; either
9a3ef070eSClaudio Fontana  * version 2.1 of the License, or (at your option) any later version.
10a3ef070eSClaudio Fontana  *
11a3ef070eSClaudio Fontana  * This library is distributed in the hope that it will be useful,
12a3ef070eSClaudio Fontana  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13a3ef070eSClaudio Fontana  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14a3ef070eSClaudio Fontana  * Lesser General Public License for more details.
15a3ef070eSClaudio Fontana  *
16a3ef070eSClaudio Fontana  * You should have received a copy of the GNU Lesser General Public
17a3ef070eSClaudio Fontana  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
18a3ef070eSClaudio Fontana  */
19a3ef070eSClaudio Fontana 
20a3ef070eSClaudio Fontana #include "qemu/osdep.h"
21a3ef070eSClaudio Fontana #include "cpu.h"
22a3ef070eSClaudio Fontana #include "internals.h"
23a3ef070eSClaudio Fontana #include "vec_internal.h"
24a3ef070eSClaudio Fontana #include "exec/helper-proto.h"
25a3ef070eSClaudio Fontana #include "exec/cpu_ldst.h"
26a3ef070eSClaudio Fontana #include "exec/exec-all.h"
27a3ef070eSClaudio Fontana #include "tcg/tcg.h"
28a3ef070eSClaudio Fontana #include "fpu/softfloat.h"
298e3da4c7SRichard Henderson #include "crypto/clmul.h"
30a3ef070eSClaudio Fontana 
mve_eci_mask(CPUARMState * env)31a3ef070eSClaudio Fontana static uint16_t mve_eci_mask(CPUARMState *env)
32a3ef070eSClaudio Fontana {
33a3ef070eSClaudio Fontana     /*
34a3ef070eSClaudio Fontana      * Return the mask of which elements in the MVE vector correspond
35a3ef070eSClaudio Fontana      * to beats being executed. The mask has 1 bits for executed lanes
36a3ef070eSClaudio Fontana      * and 0 bits where ECI says this beat was already executed.
37a3ef070eSClaudio Fontana      */
38a3ef070eSClaudio Fontana     int eci;
39a3ef070eSClaudio Fontana 
40a3ef070eSClaudio Fontana     if ((env->condexec_bits & 0xf) != 0) {
41a3ef070eSClaudio Fontana         return 0xffff;
42a3ef070eSClaudio Fontana     }
43a3ef070eSClaudio Fontana 
44a3ef070eSClaudio Fontana     eci = env->condexec_bits >> 4;
45a3ef070eSClaudio Fontana     switch (eci) {
46a3ef070eSClaudio Fontana     case ECI_NONE:
47a3ef070eSClaudio Fontana         return 0xffff;
48a3ef070eSClaudio Fontana     case ECI_A0:
49a3ef070eSClaudio Fontana         return 0xfff0;
50a3ef070eSClaudio Fontana     case ECI_A0A1:
51a3ef070eSClaudio Fontana         return 0xff00;
52a3ef070eSClaudio Fontana     case ECI_A0A1A2:
53a3ef070eSClaudio Fontana     case ECI_A0A1A2B0:
54a3ef070eSClaudio Fontana         return 0xf000;
55a3ef070eSClaudio Fontana     default:
56a3ef070eSClaudio Fontana         g_assert_not_reached();
57a3ef070eSClaudio Fontana     }
58a3ef070eSClaudio Fontana }
59a3ef070eSClaudio Fontana 
mve_element_mask(CPUARMState * env)60a3ef070eSClaudio Fontana static uint16_t mve_element_mask(CPUARMState *env)
61a3ef070eSClaudio Fontana {
62a3ef070eSClaudio Fontana     /*
63a3ef070eSClaudio Fontana      * Return the mask of which elements in the MVE vector should be
64a3ef070eSClaudio Fontana      * updated. This is a combination of multiple things:
65a3ef070eSClaudio Fontana      *  (1) by default, we update every lane in the vector
66a3ef070eSClaudio Fontana      *  (2) VPT predication stores its state in the VPR register;
67a3ef070eSClaudio Fontana      *  (3) low-overhead-branch tail predication will mask out part
68a3ef070eSClaudio Fontana      *      the vector on the final iteration of the loop
69a3ef070eSClaudio Fontana      *  (4) if EPSR.ECI is set then we must execute only some beats
70a3ef070eSClaudio Fontana      *      of the insn
71a3ef070eSClaudio Fontana      * We combine all these into a 16-bit result with the same semantics
72a3ef070eSClaudio Fontana      * as VPR.P0: 0 to mask the lane, 1 if it is active.
73a3ef070eSClaudio Fontana      * 8-bit vector ops will look at all bits of the result;
74a3ef070eSClaudio Fontana      * 16-bit ops will look at bits 0, 2, 4, ...;
75a3ef070eSClaudio Fontana      * 32-bit ops will look at bits 0, 4, 8 and 12.
76a3ef070eSClaudio Fontana      * Compare pseudocode GetCurInstrBeat(), though that only returns
77a3ef070eSClaudio Fontana      * the 4-bit slice of the mask corresponding to a single beat.
78a3ef070eSClaudio Fontana      */
79a3ef070eSClaudio Fontana     uint16_t mask = FIELD_EX32(env->v7m.vpr, V7M_VPR, P0);
80a3ef070eSClaudio Fontana 
81a3ef070eSClaudio Fontana     if (!(env->v7m.vpr & R_V7M_VPR_MASK01_MASK)) {
82a3ef070eSClaudio Fontana         mask |= 0xff;
83a3ef070eSClaudio Fontana     }
84a3ef070eSClaudio Fontana     if (!(env->v7m.vpr & R_V7M_VPR_MASK23_MASK)) {
85a3ef070eSClaudio Fontana         mask |= 0xff00;
86a3ef070eSClaudio Fontana     }
87a3ef070eSClaudio Fontana 
88a3ef070eSClaudio Fontana     if (env->v7m.ltpsize < 4 &&
89a3ef070eSClaudio Fontana         env->regs[14] <= (1 << (4 - env->v7m.ltpsize))) {
90a3ef070eSClaudio Fontana         /*
91a3ef070eSClaudio Fontana          * Tail predication active, and this is the last loop iteration.
92a3ef070eSClaudio Fontana          * The element size is (1 << ltpsize), and we only want to process
93a3ef070eSClaudio Fontana          * loopcount elements, so we want to retain the least significant
94a3ef070eSClaudio Fontana          * (loopcount * esize) predicate bits and zero out bits above that.
95a3ef070eSClaudio Fontana          */
96a3ef070eSClaudio Fontana         int masklen = env->regs[14] << env->v7m.ltpsize;
97a3ef070eSClaudio Fontana         assert(masklen <= 16);
98a3ef070eSClaudio Fontana         uint16_t ltpmask = masklen ? MAKE_64BIT_MASK(0, masklen) : 0;
99a3ef070eSClaudio Fontana         mask &= ltpmask;
100a3ef070eSClaudio Fontana     }
101a3ef070eSClaudio Fontana 
102a3ef070eSClaudio Fontana     /*
103a3ef070eSClaudio Fontana      * ECI bits indicate which beats are already executed;
104a3ef070eSClaudio Fontana      * we handle this by effectively predicating them out.
105a3ef070eSClaudio Fontana      */
106a3ef070eSClaudio Fontana     mask &= mve_eci_mask(env);
107a3ef070eSClaudio Fontana     return mask;
108a3ef070eSClaudio Fontana }
109a3ef070eSClaudio Fontana 
mve_advance_vpt(CPUARMState * env)110a3ef070eSClaudio Fontana static void mve_advance_vpt(CPUARMState *env)
111a3ef070eSClaudio Fontana {
112a3ef070eSClaudio Fontana     /* Advance the VPT and ECI state if necessary */
113a3ef070eSClaudio Fontana     uint32_t vpr = env->v7m.vpr;
114a3ef070eSClaudio Fontana     unsigned mask01, mask23;
115a3ef070eSClaudio Fontana     uint16_t inv_mask;
116a3ef070eSClaudio Fontana     uint16_t eci_mask = mve_eci_mask(env);
117a3ef070eSClaudio Fontana 
118a3ef070eSClaudio Fontana     if ((env->condexec_bits & 0xf) == 0) {
119a3ef070eSClaudio Fontana         env->condexec_bits = (env->condexec_bits == (ECI_A0A1A2B0 << 4)) ?
120a3ef070eSClaudio Fontana             (ECI_A0 << 4) : (ECI_NONE << 4);
121a3ef070eSClaudio Fontana     }
122a3ef070eSClaudio Fontana 
123a3ef070eSClaudio Fontana     if (!(vpr & (R_V7M_VPR_MASK01_MASK | R_V7M_VPR_MASK23_MASK))) {
124a3ef070eSClaudio Fontana         /* VPT not enabled, nothing to do */
125a3ef070eSClaudio Fontana         return;
126a3ef070eSClaudio Fontana     }
127a3ef070eSClaudio Fontana 
128a3ef070eSClaudio Fontana     /* Invert P0 bits if needed, but only for beats we actually executed */
129a3ef070eSClaudio Fontana     mask01 = FIELD_EX32(vpr, V7M_VPR, MASK01);
130a3ef070eSClaudio Fontana     mask23 = FIELD_EX32(vpr, V7M_VPR, MASK23);
131a3ef070eSClaudio Fontana     /* Start by assuming we invert all bits corresponding to executed beats */
132a3ef070eSClaudio Fontana     inv_mask = eci_mask;
133a3ef070eSClaudio Fontana     if (mask01 <= 8) {
134a3ef070eSClaudio Fontana         /* MASK01 says don't invert low half of P0 */
135a3ef070eSClaudio Fontana         inv_mask &= ~0xff;
136a3ef070eSClaudio Fontana     }
137a3ef070eSClaudio Fontana     if (mask23 <= 8) {
138a3ef070eSClaudio Fontana         /* MASK23 says don't invert high half of P0 */
139a3ef070eSClaudio Fontana         inv_mask &= ~0xff00;
140a3ef070eSClaudio Fontana     }
141a3ef070eSClaudio Fontana     vpr ^= inv_mask;
142a3ef070eSClaudio Fontana     /* Only update MASK01 if beat 1 executed */
143a3ef070eSClaudio Fontana     if (eci_mask & 0xf0) {
144a3ef070eSClaudio Fontana         vpr = FIELD_DP32(vpr, V7M_VPR, MASK01, mask01 << 1);
145a3ef070eSClaudio Fontana     }
146a3ef070eSClaudio Fontana     /* Beat 3 always executes, so update MASK23 */
147a3ef070eSClaudio Fontana     vpr = FIELD_DP32(vpr, V7M_VPR, MASK23, mask23 << 1);
148a3ef070eSClaudio Fontana     env->v7m.vpr = vpr;
149a3ef070eSClaudio Fontana }
150a3ef070eSClaudio Fontana 
151a3ef070eSClaudio Fontana /* For loads, predicated lanes are zeroed instead of keeping their old values */
152a3ef070eSClaudio Fontana #define DO_VLDR(OP, MSIZE, LDTYPE, ESIZE, TYPE)                         \
153a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, uint32_t addr)    \
154a3ef070eSClaudio Fontana     {                                                                   \
155a3ef070eSClaudio Fontana         TYPE *d = vd;                                                   \
156a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
157a3ef070eSClaudio Fontana         uint16_t eci_mask = mve_eci_mask(env);                          \
158a3ef070eSClaudio Fontana         unsigned b, e;                                                  \
159a3ef070eSClaudio Fontana         /*                                                              \
160a3ef070eSClaudio Fontana          * R_SXTM allows the dest reg to become UNKNOWN for abandoned   \
161a3ef070eSClaudio Fontana          * beats so we don't care if we update part of the dest and     \
162a3ef070eSClaudio Fontana          * then take an exception.                                      \
163a3ef070eSClaudio Fontana          */                                                             \
164a3ef070eSClaudio Fontana         for (b = 0, e = 0; b < 16; b += ESIZE, e++) {                   \
165a3ef070eSClaudio Fontana             if (eci_mask & (1 << b)) {                                  \
166a3ef070eSClaudio Fontana                 d[H##ESIZE(e)] = (mask & (1 << b)) ?                    \
167a3ef070eSClaudio Fontana                     cpu_##LDTYPE##_data_ra(env, addr, GETPC()) : 0;     \
168a3ef070eSClaudio Fontana             }                                                           \
169a3ef070eSClaudio Fontana             addr += MSIZE;                                              \
170a3ef070eSClaudio Fontana         }                                                               \
171a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
172a3ef070eSClaudio Fontana     }
173a3ef070eSClaudio Fontana 
174a3ef070eSClaudio Fontana #define DO_VSTR(OP, MSIZE, STTYPE, ESIZE, TYPE)                         \
175a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, uint32_t addr)    \
176a3ef070eSClaudio Fontana     {                                                                   \
177a3ef070eSClaudio Fontana         TYPE *d = vd;                                                   \
178a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
179a3ef070eSClaudio Fontana         unsigned b, e;                                                  \
180a3ef070eSClaudio Fontana         for (b = 0, e = 0; b < 16; b += ESIZE, e++) {                   \
181a3ef070eSClaudio Fontana             if (mask & (1 << b)) {                                      \
182a3ef070eSClaudio Fontana                 cpu_##STTYPE##_data_ra(env, addr, d[H##ESIZE(e)], GETPC()); \
183a3ef070eSClaudio Fontana             }                                                           \
184a3ef070eSClaudio Fontana             addr += MSIZE;                                              \
185a3ef070eSClaudio Fontana         }                                                               \
186a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
187a3ef070eSClaudio Fontana     }
188a3ef070eSClaudio Fontana 
189a3ef070eSClaudio Fontana DO_VLDR(vldrb, 1, ldub, 1, uint8_t)
190a3ef070eSClaudio Fontana DO_VLDR(vldrh, 2, lduw, 2, uint16_t)
191a3ef070eSClaudio Fontana DO_VLDR(vldrw, 4, ldl, 4, uint32_t)
192a3ef070eSClaudio Fontana 
193a3ef070eSClaudio Fontana DO_VSTR(vstrb, 1, stb, 1, uint8_t)
194a3ef070eSClaudio Fontana DO_VSTR(vstrh, 2, stw, 2, uint16_t)
195a3ef070eSClaudio Fontana DO_VSTR(vstrw, 4, stl, 4, uint32_t)
196a3ef070eSClaudio Fontana 
197a3ef070eSClaudio Fontana DO_VLDR(vldrb_sh, 1, ldsb, 2, int16_t)
198a3ef070eSClaudio Fontana DO_VLDR(vldrb_sw, 1, ldsb, 4, int32_t)
199a3ef070eSClaudio Fontana DO_VLDR(vldrb_uh, 1, ldub, 2, uint16_t)
200a3ef070eSClaudio Fontana DO_VLDR(vldrb_uw, 1, ldub, 4, uint32_t)
201a3ef070eSClaudio Fontana DO_VLDR(vldrh_sw, 2, ldsw, 4, int32_t)
202a3ef070eSClaudio Fontana DO_VLDR(vldrh_uw, 2, lduw, 4, uint32_t)
203a3ef070eSClaudio Fontana 
204a3ef070eSClaudio Fontana DO_VSTR(vstrb_h, 1, stb, 2, int16_t)
205a3ef070eSClaudio Fontana DO_VSTR(vstrb_w, 1, stb, 4, int32_t)
206a3ef070eSClaudio Fontana DO_VSTR(vstrh_w, 2, stw, 4, int32_t)
207a3ef070eSClaudio Fontana 
208a3ef070eSClaudio Fontana #undef DO_VLDR
209a3ef070eSClaudio Fontana #undef DO_VSTR
210a3ef070eSClaudio Fontana 
211a3ef070eSClaudio Fontana /*
212a3ef070eSClaudio Fontana  * Gather loads/scatter stores. Here each element of Qm specifies
213a3ef070eSClaudio Fontana  * an offset to use from the base register Rm. In the _os_ versions
214a3ef070eSClaudio Fontana  * that offset is scaled by the element size.
215a3ef070eSClaudio Fontana  * For loads, predicated lanes are zeroed instead of retaining
216a3ef070eSClaudio Fontana  * their previous values.
217a3ef070eSClaudio Fontana  */
218a3ef070eSClaudio Fontana #define DO_VLDR_SG(OP, LDTYPE, ESIZE, TYPE, OFFTYPE, ADDRFN, WB)        \
219a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, void *vm,         \
220a3ef070eSClaudio Fontana                           uint32_t base)                                \
221a3ef070eSClaudio Fontana     {                                                                   \
222a3ef070eSClaudio Fontana         TYPE *d = vd;                                                   \
223a3ef070eSClaudio Fontana         OFFTYPE *m = vm;                                                \
224a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
225a3ef070eSClaudio Fontana         uint16_t eci_mask = mve_eci_mask(env);                          \
226a3ef070eSClaudio Fontana         unsigned e;                                                     \
227a3ef070eSClaudio Fontana         uint32_t addr;                                                  \
228a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE, eci_mask >>= ESIZE) { \
229a3ef070eSClaudio Fontana             if (!(eci_mask & 1)) {                                      \
230a3ef070eSClaudio Fontana                 continue;                                               \
231a3ef070eSClaudio Fontana             }                                                           \
232a3ef070eSClaudio Fontana             addr = ADDRFN(base, m[H##ESIZE(e)]);                        \
233a3ef070eSClaudio Fontana             d[H##ESIZE(e)] = (mask & 1) ?                               \
234a3ef070eSClaudio Fontana                 cpu_##LDTYPE##_data_ra(env, addr, GETPC()) : 0;         \
235a3ef070eSClaudio Fontana             if (WB) {                                                   \
236a3ef070eSClaudio Fontana                 m[H##ESIZE(e)] = addr;                                  \
237a3ef070eSClaudio Fontana             }                                                           \
238a3ef070eSClaudio Fontana         }                                                               \
239a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
240a3ef070eSClaudio Fontana     }
241a3ef070eSClaudio Fontana 
242a3ef070eSClaudio Fontana /* We know here TYPE is unsigned so always the same as the offset type */
243a3ef070eSClaudio Fontana #define DO_VSTR_SG(OP, STTYPE, ESIZE, TYPE, ADDRFN, WB)                 \
244a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, void *vm,         \
245a3ef070eSClaudio Fontana                           uint32_t base)                                \
246a3ef070eSClaudio Fontana     {                                                                   \
247a3ef070eSClaudio Fontana         TYPE *d = vd;                                                   \
248a3ef070eSClaudio Fontana         TYPE *m = vm;                                                   \
249a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
250a3ef070eSClaudio Fontana         uint16_t eci_mask = mve_eci_mask(env);                          \
251a3ef070eSClaudio Fontana         unsigned e;                                                     \
252a3ef070eSClaudio Fontana         uint32_t addr;                                                  \
253a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE, eci_mask >>= ESIZE) { \
254a3ef070eSClaudio Fontana             if (!(eci_mask & 1)) {                                      \
255a3ef070eSClaudio Fontana                 continue;                                               \
256a3ef070eSClaudio Fontana             }                                                           \
257a3ef070eSClaudio Fontana             addr = ADDRFN(base, m[H##ESIZE(e)]);                        \
258a3ef070eSClaudio Fontana             if (mask & 1) {                                             \
259a3ef070eSClaudio Fontana                 cpu_##STTYPE##_data_ra(env, addr, d[H##ESIZE(e)], GETPC()); \
260a3ef070eSClaudio Fontana             }                                                           \
261a3ef070eSClaudio Fontana             if (WB) {                                                   \
262a3ef070eSClaudio Fontana                 m[H##ESIZE(e)] = addr;                                  \
263a3ef070eSClaudio Fontana             }                                                           \
264a3ef070eSClaudio Fontana         }                                                               \
265a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
266a3ef070eSClaudio Fontana     }
267a3ef070eSClaudio Fontana 
268a3ef070eSClaudio Fontana /*
269a3ef070eSClaudio Fontana  * 64-bit accesses are slightly different: they are done as two 32-bit
270a3ef070eSClaudio Fontana  * accesses, controlled by the predicate mask for the relevant beat,
271a3ef070eSClaudio Fontana  * and with a single 32-bit offset in the first of the two Qm elements.
272a3ef070eSClaudio Fontana  * Note that for QEMU our IMPDEF AIRCR.ENDIANNESS is always 0 (little).
273a3ef070eSClaudio Fontana  * Address writeback happens on the odd beats and updates the address
274a3ef070eSClaudio Fontana  * stored in the even-beat element.
275a3ef070eSClaudio Fontana  */
276a3ef070eSClaudio Fontana #define DO_VLDR64_SG(OP, ADDRFN, WB)                                    \
277a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, void *vm,         \
278a3ef070eSClaudio Fontana                           uint32_t base)                                \
279a3ef070eSClaudio Fontana     {                                                                   \
280a3ef070eSClaudio Fontana         uint32_t *d = vd;                                               \
281a3ef070eSClaudio Fontana         uint32_t *m = vm;                                               \
282a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
283a3ef070eSClaudio Fontana         uint16_t eci_mask = mve_eci_mask(env);                          \
284a3ef070eSClaudio Fontana         unsigned e;                                                     \
285a3ef070eSClaudio Fontana         uint32_t addr;                                                  \
286a3ef070eSClaudio Fontana         for (e = 0; e < 16 / 4; e++, mask >>= 4, eci_mask >>= 4) {      \
287a3ef070eSClaudio Fontana             if (!(eci_mask & 1)) {                                      \
288a3ef070eSClaudio Fontana                 continue;                                               \
289a3ef070eSClaudio Fontana             }                                                           \
290a3ef070eSClaudio Fontana             addr = ADDRFN(base, m[H4(e & ~1)]);                         \
291a3ef070eSClaudio Fontana             addr += 4 * (e & 1);                                        \
292a3ef070eSClaudio Fontana             d[H4(e)] = (mask & 1) ? cpu_ldl_data_ra(env, addr, GETPC()) : 0; \
293a3ef070eSClaudio Fontana             if (WB && (e & 1)) {                                        \
294a3ef070eSClaudio Fontana                 m[H4(e & ~1)] = addr - 4;                               \
295a3ef070eSClaudio Fontana             }                                                           \
296a3ef070eSClaudio Fontana         }                                                               \
297a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
298a3ef070eSClaudio Fontana     }
299a3ef070eSClaudio Fontana 
300a3ef070eSClaudio Fontana #define DO_VSTR64_SG(OP, ADDRFN, WB)                                    \
301a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, void *vm,         \
302a3ef070eSClaudio Fontana                           uint32_t base)                                \
303a3ef070eSClaudio Fontana     {                                                                   \
304a3ef070eSClaudio Fontana         uint32_t *d = vd;                                               \
305a3ef070eSClaudio Fontana         uint32_t *m = vm;                                               \
306a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
307a3ef070eSClaudio Fontana         uint16_t eci_mask = mve_eci_mask(env);                          \
308a3ef070eSClaudio Fontana         unsigned e;                                                     \
309a3ef070eSClaudio Fontana         uint32_t addr;                                                  \
310a3ef070eSClaudio Fontana         for (e = 0; e < 16 / 4; e++, mask >>= 4, eci_mask >>= 4) {      \
311a3ef070eSClaudio Fontana             if (!(eci_mask & 1)) {                                      \
312a3ef070eSClaudio Fontana                 continue;                                               \
313a3ef070eSClaudio Fontana             }                                                           \
314a3ef070eSClaudio Fontana             addr = ADDRFN(base, m[H4(e & ~1)]);                         \
315a3ef070eSClaudio Fontana             addr += 4 * (e & 1);                                        \
316a3ef070eSClaudio Fontana             if (mask & 1) {                                             \
317a3ef070eSClaudio Fontana                 cpu_stl_data_ra(env, addr, d[H4(e)], GETPC());          \
318a3ef070eSClaudio Fontana             }                                                           \
319a3ef070eSClaudio Fontana             if (WB && (e & 1)) {                                        \
320a3ef070eSClaudio Fontana                 m[H4(e & ~1)] = addr - 4;                               \
321a3ef070eSClaudio Fontana             }                                                           \
322a3ef070eSClaudio Fontana         }                                                               \
323a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
324a3ef070eSClaudio Fontana     }
325a3ef070eSClaudio Fontana 
326a3ef070eSClaudio Fontana #define ADDR_ADD(BASE, OFFSET) ((BASE) + (OFFSET))
327a3ef070eSClaudio Fontana #define ADDR_ADD_OSH(BASE, OFFSET) ((BASE) + ((OFFSET) << 1))
328a3ef070eSClaudio Fontana #define ADDR_ADD_OSW(BASE, OFFSET) ((BASE) + ((OFFSET) << 2))
329a3ef070eSClaudio Fontana #define ADDR_ADD_OSD(BASE, OFFSET) ((BASE) + ((OFFSET) << 3))
330a3ef070eSClaudio Fontana 
331a3ef070eSClaudio Fontana DO_VLDR_SG(vldrb_sg_sh, ldsb, 2, int16_t, uint16_t, ADDR_ADD, false)
332a3ef070eSClaudio Fontana DO_VLDR_SG(vldrb_sg_sw, ldsb, 4, int32_t, uint32_t, ADDR_ADD, false)
333a3ef070eSClaudio Fontana DO_VLDR_SG(vldrh_sg_sw, ldsw, 4, int32_t, uint32_t, ADDR_ADD, false)
334a3ef070eSClaudio Fontana 
335a3ef070eSClaudio Fontana DO_VLDR_SG(vldrb_sg_ub, ldub, 1, uint8_t, uint8_t, ADDR_ADD, false)
336a3ef070eSClaudio Fontana DO_VLDR_SG(vldrb_sg_uh, ldub, 2, uint16_t, uint16_t, ADDR_ADD, false)
337a3ef070eSClaudio Fontana DO_VLDR_SG(vldrb_sg_uw, ldub, 4, uint32_t, uint32_t, ADDR_ADD, false)
338a3ef070eSClaudio Fontana DO_VLDR_SG(vldrh_sg_uh, lduw, 2, uint16_t, uint16_t, ADDR_ADD, false)
339a3ef070eSClaudio Fontana DO_VLDR_SG(vldrh_sg_uw, lduw, 4, uint32_t, uint32_t, ADDR_ADD, false)
340a3ef070eSClaudio Fontana DO_VLDR_SG(vldrw_sg_uw, ldl, 4, uint32_t, uint32_t, ADDR_ADD, false)
DO_VLDR64_SG(vldrd_sg_ud,ADDR_ADD,false)341a3ef070eSClaudio Fontana DO_VLDR64_SG(vldrd_sg_ud, ADDR_ADD, false)
342a3ef070eSClaudio Fontana 
343a3ef070eSClaudio Fontana DO_VLDR_SG(vldrh_sg_os_sw, ldsw, 4, int32_t, uint32_t, ADDR_ADD_OSH, false)
344a3ef070eSClaudio Fontana DO_VLDR_SG(vldrh_sg_os_uh, lduw, 2, uint16_t, uint16_t, ADDR_ADD_OSH, false)
345a3ef070eSClaudio Fontana DO_VLDR_SG(vldrh_sg_os_uw, lduw, 4, uint32_t, uint32_t, ADDR_ADD_OSH, false)
346a3ef070eSClaudio Fontana DO_VLDR_SG(vldrw_sg_os_uw, ldl, 4, uint32_t, uint32_t, ADDR_ADD_OSW, false)
347a3ef070eSClaudio Fontana DO_VLDR64_SG(vldrd_sg_os_ud, ADDR_ADD_OSD, false)
348a3ef070eSClaudio Fontana 
349a3ef070eSClaudio Fontana DO_VSTR_SG(vstrb_sg_ub, stb, 1, uint8_t, ADDR_ADD, false)
350a3ef070eSClaudio Fontana DO_VSTR_SG(vstrb_sg_uh, stb, 2, uint16_t, ADDR_ADD, false)
351a3ef070eSClaudio Fontana DO_VSTR_SG(vstrb_sg_uw, stb, 4, uint32_t, ADDR_ADD, false)
352a3ef070eSClaudio Fontana DO_VSTR_SG(vstrh_sg_uh, stw, 2, uint16_t, ADDR_ADD, false)
353a3ef070eSClaudio Fontana DO_VSTR_SG(vstrh_sg_uw, stw, 4, uint32_t, ADDR_ADD, false)
354a3ef070eSClaudio Fontana DO_VSTR_SG(vstrw_sg_uw, stl, 4, uint32_t, ADDR_ADD, false)
355a3ef070eSClaudio Fontana DO_VSTR64_SG(vstrd_sg_ud, ADDR_ADD, false)
356a3ef070eSClaudio Fontana 
357a3ef070eSClaudio Fontana DO_VSTR_SG(vstrh_sg_os_uh, stw, 2, uint16_t, ADDR_ADD_OSH, false)
358a3ef070eSClaudio Fontana DO_VSTR_SG(vstrh_sg_os_uw, stw, 4, uint32_t, ADDR_ADD_OSH, false)
359a3ef070eSClaudio Fontana DO_VSTR_SG(vstrw_sg_os_uw, stl, 4, uint32_t, ADDR_ADD_OSW, false)
360a3ef070eSClaudio Fontana DO_VSTR64_SG(vstrd_sg_os_ud, ADDR_ADD_OSD, false)
361a3ef070eSClaudio Fontana 
362a3ef070eSClaudio Fontana DO_VLDR_SG(vldrw_sg_wb_uw, ldl, 4, uint32_t, uint32_t, ADDR_ADD, true)
363a3ef070eSClaudio Fontana DO_VLDR64_SG(vldrd_sg_wb_ud, ADDR_ADD, true)
364a3ef070eSClaudio Fontana DO_VSTR_SG(vstrw_sg_wb_uw, stl, 4, uint32_t, ADDR_ADD, true)
365a3ef070eSClaudio Fontana DO_VSTR64_SG(vstrd_sg_wb_ud, ADDR_ADD, true)
366a3ef070eSClaudio Fontana 
367a3ef070eSClaudio Fontana /*
368a3ef070eSClaudio Fontana  * Deinterleaving loads/interleaving stores.
369a3ef070eSClaudio Fontana  *
370a3ef070eSClaudio Fontana  * For these helpers we are passed the index of the first Qreg
371a3ef070eSClaudio Fontana  * (VLD2/VST2 will also access Qn+1, VLD4/VST4 access Qn .. Qn+3)
372a3ef070eSClaudio Fontana  * and the value of the base address register Rn.
373a3ef070eSClaudio Fontana  * The helpers are specialized for pattern and element size, so
374a3ef070eSClaudio Fontana  * for instance vld42h is VLD4 with pattern 2, element size MO_16.
375a3ef070eSClaudio Fontana  *
376a3ef070eSClaudio Fontana  * These insns are beatwise but not predicated, so we must honour ECI,
377a3ef070eSClaudio Fontana  * but need not look at mve_element_mask().
378a3ef070eSClaudio Fontana  *
379a3ef070eSClaudio Fontana  * The pseudocode implements these insns with multiple memory accesses
380a3ef070eSClaudio Fontana  * of the element size, but rules R_VVVG and R_FXDM permit us to make
381a3ef070eSClaudio Fontana  * one 32-bit memory access per beat.
382a3ef070eSClaudio Fontana  */
383a3ef070eSClaudio Fontana #define DO_VLD4B(OP, O1, O2, O3, O4)                                    \
384a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
385a3ef070eSClaudio Fontana                           uint32_t base)                                \
386a3ef070eSClaudio Fontana     {                                                                   \
387a3ef070eSClaudio Fontana         int beat, e;                                                    \
388a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
389a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
390a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
391a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
392a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
393a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
394a3ef070eSClaudio Fontana                 continue;                                               \
395a3ef070eSClaudio Fontana             }                                                           \
396a3ef070eSClaudio Fontana             addr = base + off[beat] * 4;                                \
397a3ef070eSClaudio Fontana             data = cpu_ldl_le_data_ra(env, addr, GETPC());              \
398a3ef070eSClaudio Fontana             for (e = 0; e < 4; e++, data >>= 8) {                       \
399a3ef070eSClaudio Fontana                 uint8_t *qd = (uint8_t *)aa32_vfp_qreg(env, qnidx + e); \
400a3ef070eSClaudio Fontana                 qd[H1(off[beat])] = data;                               \
401a3ef070eSClaudio Fontana             }                                                           \
402a3ef070eSClaudio Fontana         }                                                               \
403a3ef070eSClaudio Fontana     }
404a3ef070eSClaudio Fontana 
405a3ef070eSClaudio Fontana #define DO_VLD4H(OP, O1, O2)                                            \
406a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
407a3ef070eSClaudio Fontana                           uint32_t base)                                \
408a3ef070eSClaudio Fontana     {                                                                   \
409a3ef070eSClaudio Fontana         int beat;                                                       \
410a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
411a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O1, O2, O2 };               \
412a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
413a3ef070eSClaudio Fontana         int y; /* y counts 0 2 0 2 */                                   \
414a3ef070eSClaudio Fontana         uint16_t *qd;                                                   \
415a3ef070eSClaudio Fontana         for (beat = 0, y = 0; beat < 4; beat++, mask >>= 4, y ^= 2) {   \
416a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
417a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
418a3ef070eSClaudio Fontana                 continue;                                               \
419a3ef070eSClaudio Fontana             }                                                           \
420a3ef070eSClaudio Fontana             addr = base + off[beat] * 8 + (beat & 1) * 4;               \
421a3ef070eSClaudio Fontana             data = cpu_ldl_le_data_ra(env, addr, GETPC());              \
422a3ef070eSClaudio Fontana             qd = (uint16_t *)aa32_vfp_qreg(env, qnidx + y);             \
423a3ef070eSClaudio Fontana             qd[H2(off[beat])] = data;                                   \
424a3ef070eSClaudio Fontana             data >>= 16;                                                \
425a3ef070eSClaudio Fontana             qd = (uint16_t *)aa32_vfp_qreg(env, qnidx + y + 1);         \
426a3ef070eSClaudio Fontana             qd[H2(off[beat])] = data;                                   \
427a3ef070eSClaudio Fontana         }                                                               \
428a3ef070eSClaudio Fontana     }
429a3ef070eSClaudio Fontana 
430a3ef070eSClaudio Fontana #define DO_VLD4W(OP, O1, O2, O3, O4)                                    \
431a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
432a3ef070eSClaudio Fontana                           uint32_t base)                                \
433a3ef070eSClaudio Fontana     {                                                                   \
434a3ef070eSClaudio Fontana         int beat;                                                       \
435a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
436a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
437a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
438a3ef070eSClaudio Fontana         uint32_t *qd;                                                   \
439a3ef070eSClaudio Fontana         int y;                                                          \
440a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
441a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
442a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
443a3ef070eSClaudio Fontana                 continue;                                               \
444a3ef070eSClaudio Fontana             }                                                           \
445a3ef070eSClaudio Fontana             addr = base + off[beat] * 4;                                \
446a3ef070eSClaudio Fontana             data = cpu_ldl_le_data_ra(env, addr, GETPC());              \
447a3ef070eSClaudio Fontana             y = (beat + (O1 & 2)) & 3;                                  \
448a3ef070eSClaudio Fontana             qd = (uint32_t *)aa32_vfp_qreg(env, qnidx + y);             \
449a3ef070eSClaudio Fontana             qd[H4(off[beat] >> 2)] = data;                              \
450a3ef070eSClaudio Fontana         }                                                               \
451a3ef070eSClaudio Fontana     }
452a3ef070eSClaudio Fontana 
453a3ef070eSClaudio Fontana DO_VLD4B(vld40b, 0, 1, 10, 11)
454a3ef070eSClaudio Fontana DO_VLD4B(vld41b, 2, 3, 12, 13)
455a3ef070eSClaudio Fontana DO_VLD4B(vld42b, 4, 5, 14, 15)
456a3ef070eSClaudio Fontana DO_VLD4B(vld43b, 6, 7, 8, 9)
457a3ef070eSClaudio Fontana 
458a3ef070eSClaudio Fontana DO_VLD4H(vld40h, 0, 5)
459a3ef070eSClaudio Fontana DO_VLD4H(vld41h, 1, 6)
460a3ef070eSClaudio Fontana DO_VLD4H(vld42h, 2, 7)
461a3ef070eSClaudio Fontana DO_VLD4H(vld43h, 3, 4)
462a3ef070eSClaudio Fontana 
463a3ef070eSClaudio Fontana DO_VLD4W(vld40w, 0, 1, 10, 11)
464a3ef070eSClaudio Fontana DO_VLD4W(vld41w, 2, 3, 12, 13)
465a3ef070eSClaudio Fontana DO_VLD4W(vld42w, 4, 5, 14, 15)
466a3ef070eSClaudio Fontana DO_VLD4W(vld43w, 6, 7, 8, 9)
467a3ef070eSClaudio Fontana 
468a3ef070eSClaudio Fontana #define DO_VLD2B(OP, O1, O2, O3, O4)                                    \
469a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
470a3ef070eSClaudio Fontana                           uint32_t base)                                \
471a3ef070eSClaudio Fontana     {                                                                   \
472a3ef070eSClaudio Fontana         int beat, e;                                                    \
473a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
474a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
475a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
476a3ef070eSClaudio Fontana         uint8_t *qd;                                                    \
477a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
478a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
479a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
480a3ef070eSClaudio Fontana                 continue;                                               \
481a3ef070eSClaudio Fontana             }                                                           \
482a3ef070eSClaudio Fontana             addr = base + off[beat] * 2;                                \
483a3ef070eSClaudio Fontana             data = cpu_ldl_le_data_ra(env, addr, GETPC());              \
484a3ef070eSClaudio Fontana             for (e = 0; e < 4; e++, data >>= 8) {                       \
485a3ef070eSClaudio Fontana                 qd = (uint8_t *)aa32_vfp_qreg(env, qnidx + (e & 1));    \
486a3ef070eSClaudio Fontana                 qd[H1(off[beat] + (e >> 1))] = data;                    \
487a3ef070eSClaudio Fontana             }                                                           \
488a3ef070eSClaudio Fontana         }                                                               \
489a3ef070eSClaudio Fontana     }
490a3ef070eSClaudio Fontana 
491a3ef070eSClaudio Fontana #define DO_VLD2H(OP, O1, O2, O3, O4)                                    \
492a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
493a3ef070eSClaudio Fontana                           uint32_t base)                                \
494a3ef070eSClaudio Fontana     {                                                                   \
495a3ef070eSClaudio Fontana         int beat;                                                       \
496a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
497a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
498a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
499a3ef070eSClaudio Fontana         int e;                                                          \
500a3ef070eSClaudio Fontana         uint16_t *qd;                                                   \
501a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
502a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
503a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
504a3ef070eSClaudio Fontana                 continue;                                               \
505a3ef070eSClaudio Fontana             }                                                           \
506a3ef070eSClaudio Fontana             addr = base + off[beat] * 4;                                \
507a3ef070eSClaudio Fontana             data = cpu_ldl_le_data_ra(env, addr, GETPC());              \
508a3ef070eSClaudio Fontana             for (e = 0; e < 2; e++, data >>= 16) {                      \
509a3ef070eSClaudio Fontana                 qd = (uint16_t *)aa32_vfp_qreg(env, qnidx + e);         \
510a3ef070eSClaudio Fontana                 qd[H2(off[beat])] = data;                               \
511a3ef070eSClaudio Fontana             }                                                           \
512a3ef070eSClaudio Fontana         }                                                               \
513a3ef070eSClaudio Fontana     }
514a3ef070eSClaudio Fontana 
515a3ef070eSClaudio Fontana #define DO_VLD2W(OP, O1, O2, O3, O4)                                    \
516a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
517a3ef070eSClaudio Fontana                           uint32_t base)                                \
518a3ef070eSClaudio Fontana     {                                                                   \
519a3ef070eSClaudio Fontana         int beat;                                                       \
520a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
521a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
522a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
523a3ef070eSClaudio Fontana         uint32_t *qd;                                                   \
524a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
525a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
526a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
527a3ef070eSClaudio Fontana                 continue;                                               \
528a3ef070eSClaudio Fontana             }                                                           \
529a3ef070eSClaudio Fontana             addr = base + off[beat];                                    \
530a3ef070eSClaudio Fontana             data = cpu_ldl_le_data_ra(env, addr, GETPC());              \
531a3ef070eSClaudio Fontana             qd = (uint32_t *)aa32_vfp_qreg(env, qnidx + (beat & 1));    \
532a3ef070eSClaudio Fontana             qd[H4(off[beat] >> 3)] = data;                              \
533a3ef070eSClaudio Fontana         }                                                               \
534a3ef070eSClaudio Fontana     }
535a3ef070eSClaudio Fontana 
536a3ef070eSClaudio Fontana DO_VLD2B(vld20b, 0, 2, 12, 14)
537a3ef070eSClaudio Fontana DO_VLD2B(vld21b, 4, 6, 8, 10)
538a3ef070eSClaudio Fontana 
539a3ef070eSClaudio Fontana DO_VLD2H(vld20h, 0, 1, 6, 7)
540a3ef070eSClaudio Fontana DO_VLD2H(vld21h, 2, 3, 4, 5)
541a3ef070eSClaudio Fontana 
542a3ef070eSClaudio Fontana DO_VLD2W(vld20w, 0, 4, 24, 28)
543a3ef070eSClaudio Fontana DO_VLD2W(vld21w, 8, 12, 16, 20)
544a3ef070eSClaudio Fontana 
545a3ef070eSClaudio Fontana #define DO_VST4B(OP, O1, O2, O3, O4)                                    \
546a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
547a3ef070eSClaudio Fontana                           uint32_t base)                                \
548a3ef070eSClaudio Fontana     {                                                                   \
549a3ef070eSClaudio Fontana         int beat, e;                                                    \
550a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
551a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
552a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
553a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
554a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
555a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
556a3ef070eSClaudio Fontana                 continue;                                               \
557a3ef070eSClaudio Fontana             }                                                           \
558a3ef070eSClaudio Fontana             addr = base + off[beat] * 4;                                \
559a3ef070eSClaudio Fontana             data = 0;                                                   \
560a3ef070eSClaudio Fontana             for (e = 3; e >= 0; e--) {                                  \
561a3ef070eSClaudio Fontana                 uint8_t *qd = (uint8_t *)aa32_vfp_qreg(env, qnidx + e); \
562a3ef070eSClaudio Fontana                 data = (data << 8) | qd[H1(off[beat])];                 \
563a3ef070eSClaudio Fontana             }                                                           \
564a3ef070eSClaudio Fontana             cpu_stl_le_data_ra(env, addr, data, GETPC());               \
565a3ef070eSClaudio Fontana         }                                                               \
566a3ef070eSClaudio Fontana     }
567a3ef070eSClaudio Fontana 
568a3ef070eSClaudio Fontana #define DO_VST4H(OP, O1, O2)                                            \
569a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
570a3ef070eSClaudio Fontana                           uint32_t base)                                \
571a3ef070eSClaudio Fontana     {                                                                   \
572a3ef070eSClaudio Fontana         int beat;                                                       \
573a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
574a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O1, O2, O2 };               \
575a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
576a3ef070eSClaudio Fontana         int y; /* y counts 0 2 0 2 */                                   \
577a3ef070eSClaudio Fontana         uint16_t *qd;                                                   \
578a3ef070eSClaudio Fontana         for (beat = 0, y = 0; beat < 4; beat++, mask >>= 4, y ^= 2) {   \
579a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
580a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
581a3ef070eSClaudio Fontana                 continue;                                               \
582a3ef070eSClaudio Fontana             }                                                           \
583a3ef070eSClaudio Fontana             addr = base + off[beat] * 8 + (beat & 1) * 4;               \
584a3ef070eSClaudio Fontana             qd = (uint16_t *)aa32_vfp_qreg(env, qnidx + y);             \
585a3ef070eSClaudio Fontana             data = qd[H2(off[beat])];                                   \
586a3ef070eSClaudio Fontana             qd = (uint16_t *)aa32_vfp_qreg(env, qnidx + y + 1);         \
587a3ef070eSClaudio Fontana             data |= qd[H2(off[beat])] << 16;                            \
588a3ef070eSClaudio Fontana             cpu_stl_le_data_ra(env, addr, data, GETPC());               \
589a3ef070eSClaudio Fontana         }                                                               \
590a3ef070eSClaudio Fontana     }
591a3ef070eSClaudio Fontana 
592a3ef070eSClaudio Fontana #define DO_VST4W(OP, O1, O2, O3, O4)                                    \
593a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
594a3ef070eSClaudio Fontana                           uint32_t base)                                \
595a3ef070eSClaudio Fontana     {                                                                   \
596a3ef070eSClaudio Fontana         int beat;                                                       \
597a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
598a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
599a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
600a3ef070eSClaudio Fontana         uint32_t *qd;                                                   \
601a3ef070eSClaudio Fontana         int y;                                                          \
602a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
603a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
604a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
605a3ef070eSClaudio Fontana                 continue;                                               \
606a3ef070eSClaudio Fontana             }                                                           \
607a3ef070eSClaudio Fontana             addr = base + off[beat] * 4;                                \
608a3ef070eSClaudio Fontana             y = (beat + (O1 & 2)) & 3;                                  \
609a3ef070eSClaudio Fontana             qd = (uint32_t *)aa32_vfp_qreg(env, qnidx + y);             \
610a3ef070eSClaudio Fontana             data = qd[H4(off[beat] >> 2)];                              \
611a3ef070eSClaudio Fontana             cpu_stl_le_data_ra(env, addr, data, GETPC());               \
612a3ef070eSClaudio Fontana         }                                                               \
613a3ef070eSClaudio Fontana     }
614a3ef070eSClaudio Fontana 
615a3ef070eSClaudio Fontana DO_VST4B(vst40b, 0, 1, 10, 11)
616a3ef070eSClaudio Fontana DO_VST4B(vst41b, 2, 3, 12, 13)
617a3ef070eSClaudio Fontana DO_VST4B(vst42b, 4, 5, 14, 15)
618a3ef070eSClaudio Fontana DO_VST4B(vst43b, 6, 7, 8, 9)
619a3ef070eSClaudio Fontana 
620a3ef070eSClaudio Fontana DO_VST4H(vst40h, 0, 5)
621a3ef070eSClaudio Fontana DO_VST4H(vst41h, 1, 6)
622a3ef070eSClaudio Fontana DO_VST4H(vst42h, 2, 7)
623a3ef070eSClaudio Fontana DO_VST4H(vst43h, 3, 4)
624a3ef070eSClaudio Fontana 
625a3ef070eSClaudio Fontana DO_VST4W(vst40w, 0, 1, 10, 11)
626a3ef070eSClaudio Fontana DO_VST4W(vst41w, 2, 3, 12, 13)
627a3ef070eSClaudio Fontana DO_VST4W(vst42w, 4, 5, 14, 15)
628a3ef070eSClaudio Fontana DO_VST4W(vst43w, 6, 7, 8, 9)
629a3ef070eSClaudio Fontana 
630a3ef070eSClaudio Fontana #define DO_VST2B(OP, O1, O2, O3, O4)                                    \
631a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
632a3ef070eSClaudio Fontana                           uint32_t base)                                \
633a3ef070eSClaudio Fontana     {                                                                   \
634a3ef070eSClaudio Fontana         int beat, e;                                                    \
635a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
636a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
637a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
638a3ef070eSClaudio Fontana         uint8_t *qd;                                                    \
639a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
640a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
641a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
642a3ef070eSClaudio Fontana                 continue;                                               \
643a3ef070eSClaudio Fontana             }                                                           \
644a3ef070eSClaudio Fontana             addr = base + off[beat] * 2;                                \
645a3ef070eSClaudio Fontana             data = 0;                                                   \
646a3ef070eSClaudio Fontana             for (e = 3; e >= 0; e--) {                                  \
647a3ef070eSClaudio Fontana                 qd = (uint8_t *)aa32_vfp_qreg(env, qnidx + (e & 1));    \
648a3ef070eSClaudio Fontana                 data = (data << 8) | qd[H1(off[beat] + (e >> 1))];      \
649a3ef070eSClaudio Fontana             }                                                           \
650a3ef070eSClaudio Fontana             cpu_stl_le_data_ra(env, addr, data, GETPC());               \
651a3ef070eSClaudio Fontana         }                                                               \
652a3ef070eSClaudio Fontana     }
653a3ef070eSClaudio Fontana 
654a3ef070eSClaudio Fontana #define DO_VST2H(OP, O1, O2, O3, O4)                                    \
655a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
656a3ef070eSClaudio Fontana                           uint32_t base)                                \
657a3ef070eSClaudio Fontana     {                                                                   \
658a3ef070eSClaudio Fontana         int beat;                                                       \
659a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
660a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
661a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
662a3ef070eSClaudio Fontana         int e;                                                          \
663a3ef070eSClaudio Fontana         uint16_t *qd;                                                   \
664a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
665a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
666a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
667a3ef070eSClaudio Fontana                 continue;                                               \
668a3ef070eSClaudio Fontana             }                                                           \
669a3ef070eSClaudio Fontana             addr = base + off[beat] * 4;                                \
670a3ef070eSClaudio Fontana             data = 0;                                                   \
671a3ef070eSClaudio Fontana             for (e = 1; e >= 0; e--) {                                  \
672a3ef070eSClaudio Fontana                 qd = (uint16_t *)aa32_vfp_qreg(env, qnidx + e);         \
673a3ef070eSClaudio Fontana                 data = (data << 16) | qd[H2(off[beat])];                \
674a3ef070eSClaudio Fontana             }                                                           \
675a3ef070eSClaudio Fontana             cpu_stl_le_data_ra(env, addr, data, GETPC());               \
676a3ef070eSClaudio Fontana         }                                                               \
677a3ef070eSClaudio Fontana     }
678a3ef070eSClaudio Fontana 
679a3ef070eSClaudio Fontana #define DO_VST2W(OP, O1, O2, O3, O4)                                    \
680a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, uint32_t qnidx,             \
681a3ef070eSClaudio Fontana                           uint32_t base)                                \
682a3ef070eSClaudio Fontana     {                                                                   \
683a3ef070eSClaudio Fontana         int beat;                                                       \
684a3ef070eSClaudio Fontana         uint16_t mask = mve_eci_mask(env);                              \
685a3ef070eSClaudio Fontana         static const uint8_t off[4] = { O1, O2, O3, O4 };               \
686a3ef070eSClaudio Fontana         uint32_t addr, data;                                            \
687a3ef070eSClaudio Fontana         uint32_t *qd;                                                   \
688a3ef070eSClaudio Fontana         for (beat = 0; beat < 4; beat++, mask >>= 4) {                  \
689a3ef070eSClaudio Fontana             if ((mask & 1) == 0) {                                      \
690a3ef070eSClaudio Fontana                 /* ECI says skip this beat */                           \
691a3ef070eSClaudio Fontana                 continue;                                               \
692a3ef070eSClaudio Fontana             }                                                           \
693a3ef070eSClaudio Fontana             addr = base + off[beat];                                    \
694a3ef070eSClaudio Fontana             qd = (uint32_t *)aa32_vfp_qreg(env, qnidx + (beat & 1));    \
695a3ef070eSClaudio Fontana             data = qd[H4(off[beat] >> 3)];                              \
696a3ef070eSClaudio Fontana             cpu_stl_le_data_ra(env, addr, data, GETPC());               \
697a3ef070eSClaudio Fontana         }                                                               \
698a3ef070eSClaudio Fontana     }
699a3ef070eSClaudio Fontana 
700a3ef070eSClaudio Fontana DO_VST2B(vst20b, 0, 2, 12, 14)
701a3ef070eSClaudio Fontana DO_VST2B(vst21b, 4, 6, 8, 10)
702a3ef070eSClaudio Fontana 
703a3ef070eSClaudio Fontana DO_VST2H(vst20h, 0, 1, 6, 7)
704a3ef070eSClaudio Fontana DO_VST2H(vst21h, 2, 3, 4, 5)
705a3ef070eSClaudio Fontana 
706a3ef070eSClaudio Fontana DO_VST2W(vst20w, 0, 4, 24, 28)
707a3ef070eSClaudio Fontana DO_VST2W(vst21w, 8, 12, 16, 20)
708a3ef070eSClaudio Fontana 
709a3ef070eSClaudio Fontana /*
710a3ef070eSClaudio Fontana  * The mergemask(D, R, M) macro performs the operation "*D = R" but
711a3ef070eSClaudio Fontana  * storing only the bytes which correspond to 1 bits in M,
712a3ef070eSClaudio Fontana  * leaving other bytes in *D unchanged. We use _Generic
713a3ef070eSClaudio Fontana  * to select the correct implementation based on the type of D.
714a3ef070eSClaudio Fontana  */
715a3ef070eSClaudio Fontana 
716a3ef070eSClaudio Fontana static void mergemask_ub(uint8_t *d, uint8_t r, uint16_t mask)
717a3ef070eSClaudio Fontana {
718a3ef070eSClaudio Fontana     if (mask & 1) {
719a3ef070eSClaudio Fontana         *d = r;
720a3ef070eSClaudio Fontana     }
721a3ef070eSClaudio Fontana }
722a3ef070eSClaudio Fontana 
mergemask_sb(int8_t * d,int8_t r,uint16_t mask)723a3ef070eSClaudio Fontana static void mergemask_sb(int8_t *d, int8_t r, uint16_t mask)
724a3ef070eSClaudio Fontana {
725a3ef070eSClaudio Fontana     mergemask_ub((uint8_t *)d, r, mask);
726a3ef070eSClaudio Fontana }
727a3ef070eSClaudio Fontana 
mergemask_uh(uint16_t * d,uint16_t r,uint16_t mask)728a3ef070eSClaudio Fontana static void mergemask_uh(uint16_t *d, uint16_t r, uint16_t mask)
729a3ef070eSClaudio Fontana {
730a3ef070eSClaudio Fontana     uint16_t bmask = expand_pred_b(mask);
731a3ef070eSClaudio Fontana     *d = (*d & ~bmask) | (r & bmask);
732a3ef070eSClaudio Fontana }
733a3ef070eSClaudio Fontana 
mergemask_sh(int16_t * d,int16_t r,uint16_t mask)734a3ef070eSClaudio Fontana static void mergemask_sh(int16_t *d, int16_t r, uint16_t mask)
735a3ef070eSClaudio Fontana {
736a3ef070eSClaudio Fontana     mergemask_uh((uint16_t *)d, r, mask);
737a3ef070eSClaudio Fontana }
738a3ef070eSClaudio Fontana 
mergemask_uw(uint32_t * d,uint32_t r,uint16_t mask)739a3ef070eSClaudio Fontana static void mergemask_uw(uint32_t *d, uint32_t r, uint16_t mask)
740a3ef070eSClaudio Fontana {
741a3ef070eSClaudio Fontana     uint32_t bmask = expand_pred_b(mask);
742a3ef070eSClaudio Fontana     *d = (*d & ~bmask) | (r & bmask);
743a3ef070eSClaudio Fontana }
744a3ef070eSClaudio Fontana 
mergemask_sw(int32_t * d,int32_t r,uint16_t mask)745a3ef070eSClaudio Fontana static void mergemask_sw(int32_t *d, int32_t r, uint16_t mask)
746a3ef070eSClaudio Fontana {
747a3ef070eSClaudio Fontana     mergemask_uw((uint32_t *)d, r, mask);
748a3ef070eSClaudio Fontana }
749a3ef070eSClaudio Fontana 
mergemask_uq(uint64_t * d,uint64_t r,uint16_t mask)750a3ef070eSClaudio Fontana static void mergemask_uq(uint64_t *d, uint64_t r, uint16_t mask)
751a3ef070eSClaudio Fontana {
752a3ef070eSClaudio Fontana     uint64_t bmask = expand_pred_b(mask);
753a3ef070eSClaudio Fontana     *d = (*d & ~bmask) | (r & bmask);
754a3ef070eSClaudio Fontana }
755a3ef070eSClaudio Fontana 
mergemask_sq(int64_t * d,int64_t r,uint16_t mask)756a3ef070eSClaudio Fontana static void mergemask_sq(int64_t *d, int64_t r, uint16_t mask)
757a3ef070eSClaudio Fontana {
758a3ef070eSClaudio Fontana     mergemask_uq((uint64_t *)d, r, mask);
759a3ef070eSClaudio Fontana }
760a3ef070eSClaudio Fontana 
761a3ef070eSClaudio Fontana #define mergemask(D, R, M)                      \
762a3ef070eSClaudio Fontana     _Generic(D,                                 \
763a3ef070eSClaudio Fontana              uint8_t *: mergemask_ub,           \
764a3ef070eSClaudio Fontana              int8_t *:  mergemask_sb,           \
765a3ef070eSClaudio Fontana              uint16_t *: mergemask_uh,          \
766a3ef070eSClaudio Fontana              int16_t *:  mergemask_sh,          \
767a3ef070eSClaudio Fontana              uint32_t *: mergemask_uw,          \
768a3ef070eSClaudio Fontana              int32_t *:  mergemask_sw,          \
769a3ef070eSClaudio Fontana              uint64_t *: mergemask_uq,          \
770a3ef070eSClaudio Fontana              int64_t *:  mergemask_sq)(D, R, M)
771a3ef070eSClaudio Fontana 
HELPER(mve_vdup)772a3ef070eSClaudio Fontana void HELPER(mve_vdup)(CPUARMState *env, void *vd, uint32_t val)
773a3ef070eSClaudio Fontana {
774a3ef070eSClaudio Fontana     /*
775a3ef070eSClaudio Fontana      * The generated code already replicated an 8 or 16 bit constant
776a3ef070eSClaudio Fontana      * into the 32-bit value, so we only need to write the 32-bit
777a3ef070eSClaudio Fontana      * value to all elements of the Qreg, allowing for predication.
778a3ef070eSClaudio Fontana      */
779a3ef070eSClaudio Fontana     uint32_t *d = vd;
780a3ef070eSClaudio Fontana     uint16_t mask = mve_element_mask(env);
781a3ef070eSClaudio Fontana     unsigned e;
782a3ef070eSClaudio Fontana     for (e = 0; e < 16 / 4; e++, mask >>= 4) {
783a3ef070eSClaudio Fontana         mergemask(&d[H4(e)], val, mask);
784a3ef070eSClaudio Fontana     }
785a3ef070eSClaudio Fontana     mve_advance_vpt(env);
786a3ef070eSClaudio Fontana }
787a3ef070eSClaudio Fontana 
788a3ef070eSClaudio Fontana #define DO_1OP(OP, ESIZE, TYPE, FN)                                     \
789a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, void *vm)         \
790a3ef070eSClaudio Fontana     {                                                                   \
791a3ef070eSClaudio Fontana         TYPE *d = vd, *m = vm;                                          \
792a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
793a3ef070eSClaudio Fontana         unsigned e;                                                     \
794a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
795a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], FN(m[H##ESIZE(e)]), mask);       \
796a3ef070eSClaudio Fontana         }                                                               \
797a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
798a3ef070eSClaudio Fontana     }
799a3ef070eSClaudio Fontana 
800a3ef070eSClaudio Fontana #define DO_CLS_B(N)   (clrsb32(N) - 24)
801a3ef070eSClaudio Fontana #define DO_CLS_H(N)   (clrsb32(N) - 16)
802a3ef070eSClaudio Fontana 
803a3ef070eSClaudio Fontana DO_1OP(vclsb, 1, int8_t, DO_CLS_B)
804a3ef070eSClaudio Fontana DO_1OP(vclsh, 2, int16_t, DO_CLS_H)
805a3ef070eSClaudio Fontana DO_1OP(vclsw, 4, int32_t, clrsb32)
806a3ef070eSClaudio Fontana 
807a3ef070eSClaudio Fontana #define DO_CLZ_B(N)   (clz32(N) - 24)
808a3ef070eSClaudio Fontana #define DO_CLZ_H(N)   (clz32(N) - 16)
809a3ef070eSClaudio Fontana 
810a3ef070eSClaudio Fontana DO_1OP(vclzb, 1, uint8_t, DO_CLZ_B)
811a3ef070eSClaudio Fontana DO_1OP(vclzh, 2, uint16_t, DO_CLZ_H)
812a3ef070eSClaudio Fontana DO_1OP(vclzw, 4, uint32_t, clz32)
813a3ef070eSClaudio Fontana 
814a3ef070eSClaudio Fontana DO_1OP(vrev16b, 2, uint16_t, bswap16)
815a3ef070eSClaudio Fontana DO_1OP(vrev32b, 4, uint32_t, bswap32)
816a3ef070eSClaudio Fontana DO_1OP(vrev32h, 4, uint32_t, hswap32)
817a3ef070eSClaudio Fontana DO_1OP(vrev64b, 8, uint64_t, bswap64)
818a3ef070eSClaudio Fontana DO_1OP(vrev64h, 8, uint64_t, hswap64)
819a3ef070eSClaudio Fontana DO_1OP(vrev64w, 8, uint64_t, wswap64)
820a3ef070eSClaudio Fontana 
821a3ef070eSClaudio Fontana #define DO_NOT(N) (~(N))
822a3ef070eSClaudio Fontana 
823a3ef070eSClaudio Fontana DO_1OP(vmvn, 8, uint64_t, DO_NOT)
824a3ef070eSClaudio Fontana 
825a3ef070eSClaudio Fontana #define DO_ABS(N) ((N) < 0 ? -(N) : (N))
826a3ef070eSClaudio Fontana #define DO_FABSH(N)  ((N) & dup_const(MO_16, 0x7fff))
827a3ef070eSClaudio Fontana #define DO_FABSS(N)  ((N) & dup_const(MO_32, 0x7fffffff))
828a3ef070eSClaudio Fontana 
829a3ef070eSClaudio Fontana DO_1OP(vabsb, 1, int8_t, DO_ABS)
830a3ef070eSClaudio Fontana DO_1OP(vabsh, 2, int16_t, DO_ABS)
831a3ef070eSClaudio Fontana DO_1OP(vabsw, 4, int32_t, DO_ABS)
832a3ef070eSClaudio Fontana 
833a3ef070eSClaudio Fontana /* We can do these 64 bits at a time */
834a3ef070eSClaudio Fontana DO_1OP(vfabsh, 8, uint64_t, DO_FABSH)
835a3ef070eSClaudio Fontana DO_1OP(vfabss, 8, uint64_t, DO_FABSS)
836a3ef070eSClaudio Fontana 
837a3ef070eSClaudio Fontana #define DO_NEG(N)    (-(N))
838a3ef070eSClaudio Fontana #define DO_FNEGH(N) ((N) ^ dup_const(MO_16, 0x8000))
839a3ef070eSClaudio Fontana #define DO_FNEGS(N) ((N) ^ dup_const(MO_32, 0x80000000))
840a3ef070eSClaudio Fontana 
841a3ef070eSClaudio Fontana DO_1OP(vnegb, 1, int8_t, DO_NEG)
842a3ef070eSClaudio Fontana DO_1OP(vnegh, 2, int16_t, DO_NEG)
843a3ef070eSClaudio Fontana DO_1OP(vnegw, 4, int32_t, DO_NEG)
844a3ef070eSClaudio Fontana 
845a3ef070eSClaudio Fontana /* We can do these 64 bits at a time */
846a3ef070eSClaudio Fontana DO_1OP(vfnegh, 8, uint64_t, DO_FNEGH)
847a3ef070eSClaudio Fontana DO_1OP(vfnegs, 8, uint64_t, DO_FNEGS)
848a3ef070eSClaudio Fontana 
849a3ef070eSClaudio Fontana /*
850a3ef070eSClaudio Fontana  * 1 operand immediates: Vda is destination and possibly also one source.
851a3ef070eSClaudio Fontana  * All these insns work at 64-bit widths.
852a3ef070eSClaudio Fontana  */
853a3ef070eSClaudio Fontana #define DO_1OP_IMM(OP, FN)                                              \
854a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vda, uint64_t imm)    \
855a3ef070eSClaudio Fontana     {                                                                   \
856a3ef070eSClaudio Fontana         uint64_t *da = vda;                                             \
857a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
858a3ef070eSClaudio Fontana         unsigned e;                                                     \
859a3ef070eSClaudio Fontana         for (e = 0; e < 16 / 8; e++, mask >>= 8) {                      \
860a3ef070eSClaudio Fontana             mergemask(&da[H8(e)], FN(da[H8(e)], imm), mask);            \
861a3ef070eSClaudio Fontana         }                                                               \
862a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
863a3ef070eSClaudio Fontana     }
864a3ef070eSClaudio Fontana 
865a3ef070eSClaudio Fontana #define DO_MOVI(N, I) (I)
866a3ef070eSClaudio Fontana #define DO_ANDI(N, I) ((N) & (I))
867a3ef070eSClaudio Fontana #define DO_ORRI(N, I) ((N) | (I))
868a3ef070eSClaudio Fontana 
DO_1OP_IMM(vmovi,DO_MOVI)869a3ef070eSClaudio Fontana DO_1OP_IMM(vmovi, DO_MOVI)
870a3ef070eSClaudio Fontana DO_1OP_IMM(vandi, DO_ANDI)
871a3ef070eSClaudio Fontana DO_1OP_IMM(vorri, DO_ORRI)
872a3ef070eSClaudio Fontana 
873a3ef070eSClaudio Fontana #define DO_2OP(OP, ESIZE, TYPE, FN)                                     \
874a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env,                       \
875a3ef070eSClaudio Fontana                                 void *vd, void *vn, void *vm)           \
876a3ef070eSClaudio Fontana     {                                                                   \
877a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn, *m = vm;                                 \
878a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
879a3ef070eSClaudio Fontana         unsigned e;                                                     \
880a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
881a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)],                                  \
882a3ef070eSClaudio Fontana                       FN(n[H##ESIZE(e)], m[H##ESIZE(e)]), mask);        \
883a3ef070eSClaudio Fontana         }                                                               \
884a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
885a3ef070eSClaudio Fontana     }
886a3ef070eSClaudio Fontana 
887a3ef070eSClaudio Fontana /* provide unsigned 2-op helpers for all sizes */
888a3ef070eSClaudio Fontana #define DO_2OP_U(OP, FN)                        \
889a3ef070eSClaudio Fontana     DO_2OP(OP##b, 1, uint8_t, FN)               \
890a3ef070eSClaudio Fontana     DO_2OP(OP##h, 2, uint16_t, FN)              \
891a3ef070eSClaudio Fontana     DO_2OP(OP##w, 4, uint32_t, FN)
892a3ef070eSClaudio Fontana 
893a3ef070eSClaudio Fontana /* provide signed 2-op helpers for all sizes */
894a3ef070eSClaudio Fontana #define DO_2OP_S(OP, FN)                        \
895a3ef070eSClaudio Fontana     DO_2OP(OP##b, 1, int8_t, FN)                \
896a3ef070eSClaudio Fontana     DO_2OP(OP##h, 2, int16_t, FN)               \
897a3ef070eSClaudio Fontana     DO_2OP(OP##w, 4, int32_t, FN)
898a3ef070eSClaudio Fontana 
899a3ef070eSClaudio Fontana /*
900a3ef070eSClaudio Fontana  * "Long" operations where two half-sized inputs (taken from either the
901a3ef070eSClaudio Fontana  * top or the bottom of the input vector) produce a double-width result.
902a3ef070eSClaudio Fontana  * Here ESIZE, TYPE are for the input, and LESIZE, LTYPE for the output.
903a3ef070eSClaudio Fontana  */
904a3ef070eSClaudio Fontana #define DO_2OP_L(OP, TOP, ESIZE, TYPE, LESIZE, LTYPE, FN)               \
905a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn, void *vm) \
906a3ef070eSClaudio Fontana     {                                                                   \
907a3ef070eSClaudio Fontana         LTYPE *d = vd;                                                  \
908a3ef070eSClaudio Fontana         TYPE *n = vn, *m = vm;                                          \
909a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
910a3ef070eSClaudio Fontana         unsigned le;                                                    \
911a3ef070eSClaudio Fontana         for (le = 0; le < 16 / LESIZE; le++, mask >>= LESIZE) {         \
912a3ef070eSClaudio Fontana             LTYPE r = FN((LTYPE)n[H##ESIZE(le * 2 + TOP)],              \
913a3ef070eSClaudio Fontana                          m[H##ESIZE(le * 2 + TOP)]);                    \
914a3ef070eSClaudio Fontana             mergemask(&d[H##LESIZE(le)], r, mask);                      \
915a3ef070eSClaudio Fontana         }                                                               \
916a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
917a3ef070eSClaudio Fontana     }
918a3ef070eSClaudio Fontana 
919a3ef070eSClaudio Fontana #define DO_2OP_SAT(OP, ESIZE, TYPE, FN)                                 \
920a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn, void *vm) \
921a3ef070eSClaudio Fontana     {                                                                   \
922a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn, *m = vm;                                 \
923a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
924a3ef070eSClaudio Fontana         unsigned e;                                                     \
925a3ef070eSClaudio Fontana         bool qc = false;                                                \
926a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
927a3ef070eSClaudio Fontana             bool sat = false;                                           \
928d54deb2aSPhilippe Mathieu-Daudé             TYPE r_ = FN(n[H##ESIZE(e)], m[H##ESIZE(e)], &sat);         \
929d54deb2aSPhilippe Mathieu-Daudé             mergemask(&d[H##ESIZE(e)], r_, mask);                       \
930a3ef070eSClaudio Fontana             qc |= sat & mask & 1;                                       \
931a3ef070eSClaudio Fontana         }                                                               \
932a3ef070eSClaudio Fontana         if (qc) {                                                       \
933a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                        \
934a3ef070eSClaudio Fontana         }                                                               \
935a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
936a3ef070eSClaudio Fontana     }
937a3ef070eSClaudio Fontana 
938a3ef070eSClaudio Fontana /* provide unsigned 2-op helpers for all sizes */
939a3ef070eSClaudio Fontana #define DO_2OP_SAT_U(OP, FN)                    \
940a3ef070eSClaudio Fontana     DO_2OP_SAT(OP##b, 1, uint8_t, FN)           \
941a3ef070eSClaudio Fontana     DO_2OP_SAT(OP##h, 2, uint16_t, FN)          \
942a3ef070eSClaudio Fontana     DO_2OP_SAT(OP##w, 4, uint32_t, FN)
943a3ef070eSClaudio Fontana 
944a3ef070eSClaudio Fontana /* provide signed 2-op helpers for all sizes */
945a3ef070eSClaudio Fontana #define DO_2OP_SAT_S(OP, FN)                    \
946a3ef070eSClaudio Fontana     DO_2OP_SAT(OP##b, 1, int8_t, FN)            \
947a3ef070eSClaudio Fontana     DO_2OP_SAT(OP##h, 2, int16_t, FN)           \
948a3ef070eSClaudio Fontana     DO_2OP_SAT(OP##w, 4, int32_t, FN)
949a3ef070eSClaudio Fontana 
950a3ef070eSClaudio Fontana #define DO_AND(N, M)  ((N) & (M))
951a3ef070eSClaudio Fontana #define DO_BIC(N, M)  ((N) & ~(M))
952a3ef070eSClaudio Fontana #define DO_ORR(N, M)  ((N) | (M))
953a3ef070eSClaudio Fontana #define DO_ORN(N, M)  ((N) | ~(M))
954a3ef070eSClaudio Fontana #define DO_EOR(N, M)  ((N) ^ (M))
955a3ef070eSClaudio Fontana 
956a3ef070eSClaudio Fontana DO_2OP(vand, 8, uint64_t, DO_AND)
957a3ef070eSClaudio Fontana DO_2OP(vbic, 8, uint64_t, DO_BIC)
958a3ef070eSClaudio Fontana DO_2OP(vorr, 8, uint64_t, DO_ORR)
959a3ef070eSClaudio Fontana DO_2OP(vorn, 8, uint64_t, DO_ORN)
960a3ef070eSClaudio Fontana DO_2OP(veor, 8, uint64_t, DO_EOR)
961a3ef070eSClaudio Fontana 
962a3ef070eSClaudio Fontana #define DO_ADD(N, M) ((N) + (M))
963a3ef070eSClaudio Fontana #define DO_SUB(N, M) ((N) - (M))
964a3ef070eSClaudio Fontana #define DO_MUL(N, M) ((N) * (M))
965a3ef070eSClaudio Fontana 
966a3ef070eSClaudio Fontana DO_2OP_U(vadd, DO_ADD)
967a3ef070eSClaudio Fontana DO_2OP_U(vsub, DO_SUB)
968a3ef070eSClaudio Fontana DO_2OP_U(vmul, DO_MUL)
969a3ef070eSClaudio Fontana 
970a3ef070eSClaudio Fontana DO_2OP_L(vmullbsb, 0, 1, int8_t, 2, int16_t, DO_MUL)
971a3ef070eSClaudio Fontana DO_2OP_L(vmullbsh, 0, 2, int16_t, 4, int32_t, DO_MUL)
972a3ef070eSClaudio Fontana DO_2OP_L(vmullbsw, 0, 4, int32_t, 8, int64_t, DO_MUL)
973a3ef070eSClaudio Fontana DO_2OP_L(vmullbub, 0, 1, uint8_t, 2, uint16_t, DO_MUL)
974a3ef070eSClaudio Fontana DO_2OP_L(vmullbuh, 0, 2, uint16_t, 4, uint32_t, DO_MUL)
975a3ef070eSClaudio Fontana DO_2OP_L(vmullbuw, 0, 4, uint32_t, 8, uint64_t, DO_MUL)
976a3ef070eSClaudio Fontana 
977a3ef070eSClaudio Fontana DO_2OP_L(vmulltsb, 1, 1, int8_t, 2, int16_t, DO_MUL)
978a3ef070eSClaudio Fontana DO_2OP_L(vmulltsh, 1, 2, int16_t, 4, int32_t, DO_MUL)
979a3ef070eSClaudio Fontana DO_2OP_L(vmulltsw, 1, 4, int32_t, 8, int64_t, DO_MUL)
980a3ef070eSClaudio Fontana DO_2OP_L(vmulltub, 1, 1, uint8_t, 2, uint16_t, DO_MUL)
981a3ef070eSClaudio Fontana DO_2OP_L(vmulltuh, 1, 2, uint16_t, 4, uint32_t, DO_MUL)
982a3ef070eSClaudio Fontana DO_2OP_L(vmulltuw, 1, 4, uint32_t, 8, uint64_t, DO_MUL)
983a3ef070eSClaudio Fontana 
984a3ef070eSClaudio Fontana /*
985a3ef070eSClaudio Fontana  * Polynomial multiply. We can always do this generating 64 bits
986a3ef070eSClaudio Fontana  * of the result at a time, so we don't need to use DO_2OP_L.
987a3ef070eSClaudio Fontana  */
9888e3da4c7SRichard Henderson DO_2OP(vmullpbh, 8, uint64_t, clmul_8x4_even)
9898e3da4c7SRichard Henderson DO_2OP(vmullpth, 8, uint64_t, clmul_8x4_odd)
990c6f0dcb1SRichard Henderson DO_2OP(vmullpbw, 8, uint64_t, clmul_16x2_even)
991c6f0dcb1SRichard Henderson DO_2OP(vmullptw, 8, uint64_t, clmul_16x2_odd)
992a3ef070eSClaudio Fontana 
993a3ef070eSClaudio Fontana /*
994a3ef070eSClaudio Fontana  * Because the computation type is at least twice as large as required,
995a3ef070eSClaudio Fontana  * these work for both signed and unsigned source types.
996a3ef070eSClaudio Fontana  */
997a3ef070eSClaudio Fontana static inline uint8_t do_mulh_b(int32_t n, int32_t m)
998a3ef070eSClaudio Fontana {
999a3ef070eSClaudio Fontana     return (n * m) >> 8;
1000a3ef070eSClaudio Fontana }
1001a3ef070eSClaudio Fontana 
do_mulh_h(int32_t n,int32_t m)1002a3ef070eSClaudio Fontana static inline uint16_t do_mulh_h(int32_t n, int32_t m)
1003a3ef070eSClaudio Fontana {
1004a3ef070eSClaudio Fontana     return (n * m) >> 16;
1005a3ef070eSClaudio Fontana }
1006a3ef070eSClaudio Fontana 
do_mulh_w(int64_t n,int64_t m)1007a3ef070eSClaudio Fontana static inline uint32_t do_mulh_w(int64_t n, int64_t m)
1008a3ef070eSClaudio Fontana {
1009a3ef070eSClaudio Fontana     return (n * m) >> 32;
1010a3ef070eSClaudio Fontana }
1011a3ef070eSClaudio Fontana 
do_rmulh_b(int32_t n,int32_t m)1012a3ef070eSClaudio Fontana static inline uint8_t do_rmulh_b(int32_t n, int32_t m)
1013a3ef070eSClaudio Fontana {
1014a3ef070eSClaudio Fontana     return (n * m + (1U << 7)) >> 8;
1015a3ef070eSClaudio Fontana }
1016a3ef070eSClaudio Fontana 
do_rmulh_h(int32_t n,int32_t m)1017a3ef070eSClaudio Fontana static inline uint16_t do_rmulh_h(int32_t n, int32_t m)
1018a3ef070eSClaudio Fontana {
1019a3ef070eSClaudio Fontana     return (n * m + (1U << 15)) >> 16;
1020a3ef070eSClaudio Fontana }
1021a3ef070eSClaudio Fontana 
do_rmulh_w(int64_t n,int64_t m)1022a3ef070eSClaudio Fontana static inline uint32_t do_rmulh_w(int64_t n, int64_t m)
1023a3ef070eSClaudio Fontana {
1024a3ef070eSClaudio Fontana     return (n * m + (1U << 31)) >> 32;
1025a3ef070eSClaudio Fontana }
1026a3ef070eSClaudio Fontana 
1027a3ef070eSClaudio Fontana DO_2OP(vmulhsb, 1, int8_t, do_mulh_b)
1028a3ef070eSClaudio Fontana DO_2OP(vmulhsh, 2, int16_t, do_mulh_h)
1029a3ef070eSClaudio Fontana DO_2OP(vmulhsw, 4, int32_t, do_mulh_w)
1030a3ef070eSClaudio Fontana DO_2OP(vmulhub, 1, uint8_t, do_mulh_b)
1031a3ef070eSClaudio Fontana DO_2OP(vmulhuh, 2, uint16_t, do_mulh_h)
1032a3ef070eSClaudio Fontana DO_2OP(vmulhuw, 4, uint32_t, do_mulh_w)
1033a3ef070eSClaudio Fontana 
1034a3ef070eSClaudio Fontana DO_2OP(vrmulhsb, 1, int8_t, do_rmulh_b)
1035a3ef070eSClaudio Fontana DO_2OP(vrmulhsh, 2, int16_t, do_rmulh_h)
1036a3ef070eSClaudio Fontana DO_2OP(vrmulhsw, 4, int32_t, do_rmulh_w)
1037a3ef070eSClaudio Fontana DO_2OP(vrmulhub, 1, uint8_t, do_rmulh_b)
1038a3ef070eSClaudio Fontana DO_2OP(vrmulhuh, 2, uint16_t, do_rmulh_h)
1039a3ef070eSClaudio Fontana DO_2OP(vrmulhuw, 4, uint32_t, do_rmulh_w)
1040a3ef070eSClaudio Fontana 
1041a3ef070eSClaudio Fontana #define DO_MAX(N, M)  ((N) >= (M) ? (N) : (M))
1042a3ef070eSClaudio Fontana #define DO_MIN(N, M)  ((N) >= (M) ? (M) : (N))
1043a3ef070eSClaudio Fontana 
DO_2OP_S(vmaxs,DO_MAX)1044a3ef070eSClaudio Fontana DO_2OP_S(vmaxs, DO_MAX)
1045a3ef070eSClaudio Fontana DO_2OP_U(vmaxu, DO_MAX)
1046a3ef070eSClaudio Fontana DO_2OP_S(vmins, DO_MIN)
1047a3ef070eSClaudio Fontana DO_2OP_U(vminu, DO_MIN)
1048a3ef070eSClaudio Fontana 
1049a3ef070eSClaudio Fontana #define DO_ABD(N, M)  ((N) >= (M) ? (N) - (M) : (M) - (N))
1050a3ef070eSClaudio Fontana 
1051a3ef070eSClaudio Fontana DO_2OP_S(vabds, DO_ABD)
1052a3ef070eSClaudio Fontana DO_2OP_U(vabdu, DO_ABD)
1053a3ef070eSClaudio Fontana 
1054a3ef070eSClaudio Fontana static inline uint32_t do_vhadd_u(uint32_t n, uint32_t m)
1055a3ef070eSClaudio Fontana {
1056a3ef070eSClaudio Fontana     return ((uint64_t)n + m) >> 1;
1057a3ef070eSClaudio Fontana }
1058a3ef070eSClaudio Fontana 
do_vhadd_s(int32_t n,int32_t m)1059a3ef070eSClaudio Fontana static inline int32_t do_vhadd_s(int32_t n, int32_t m)
1060a3ef070eSClaudio Fontana {
1061a3ef070eSClaudio Fontana     return ((int64_t)n + m) >> 1;
1062a3ef070eSClaudio Fontana }
1063a3ef070eSClaudio Fontana 
do_vhsub_u(uint32_t n,uint32_t m)1064a3ef070eSClaudio Fontana static inline uint32_t do_vhsub_u(uint32_t n, uint32_t m)
1065a3ef070eSClaudio Fontana {
1066a3ef070eSClaudio Fontana     return ((uint64_t)n - m) >> 1;
1067a3ef070eSClaudio Fontana }
1068a3ef070eSClaudio Fontana 
do_vhsub_s(int32_t n,int32_t m)1069a3ef070eSClaudio Fontana static inline int32_t do_vhsub_s(int32_t n, int32_t m)
1070a3ef070eSClaudio Fontana {
1071a3ef070eSClaudio Fontana     return ((int64_t)n - m) >> 1;
1072a3ef070eSClaudio Fontana }
1073a3ef070eSClaudio Fontana 
DO_2OP_S(vhadds,do_vhadd_s)1074a3ef070eSClaudio Fontana DO_2OP_S(vhadds, do_vhadd_s)
1075a3ef070eSClaudio Fontana DO_2OP_U(vhaddu, do_vhadd_u)
1076a3ef070eSClaudio Fontana DO_2OP_S(vhsubs, do_vhsub_s)
1077a3ef070eSClaudio Fontana DO_2OP_U(vhsubu, do_vhsub_u)
1078a3ef070eSClaudio Fontana 
1079a3ef070eSClaudio Fontana #define DO_VSHLS(N, M) do_sqrshl_bhs(N, (int8_t)(M), sizeof(N) * 8, false, NULL)
1080a3ef070eSClaudio Fontana #define DO_VSHLU(N, M) do_uqrshl_bhs(N, (int8_t)(M), sizeof(N) * 8, false, NULL)
1081a3ef070eSClaudio Fontana #define DO_VRSHLS(N, M) do_sqrshl_bhs(N, (int8_t)(M), sizeof(N) * 8, true, NULL)
1082a3ef070eSClaudio Fontana #define DO_VRSHLU(N, M) do_uqrshl_bhs(N, (int8_t)(M), sizeof(N) * 8, true, NULL)
1083a3ef070eSClaudio Fontana 
1084a3ef070eSClaudio Fontana DO_2OP_S(vshls, DO_VSHLS)
1085a3ef070eSClaudio Fontana DO_2OP_U(vshlu, DO_VSHLU)
1086a3ef070eSClaudio Fontana DO_2OP_S(vrshls, DO_VRSHLS)
1087a3ef070eSClaudio Fontana DO_2OP_U(vrshlu, DO_VRSHLU)
1088a3ef070eSClaudio Fontana 
1089a3ef070eSClaudio Fontana #define DO_RHADD_S(N, M) (((int64_t)(N) + (M) + 1) >> 1)
1090a3ef070eSClaudio Fontana #define DO_RHADD_U(N, M) (((uint64_t)(N) + (M) + 1) >> 1)
1091a3ef070eSClaudio Fontana 
1092a3ef070eSClaudio Fontana DO_2OP_S(vrhadds, DO_RHADD_S)
1093a3ef070eSClaudio Fontana DO_2OP_U(vrhaddu, DO_RHADD_U)
1094a3ef070eSClaudio Fontana 
1095a3ef070eSClaudio Fontana static void do_vadc(CPUARMState *env, uint32_t *d, uint32_t *n, uint32_t *m,
1096a3ef070eSClaudio Fontana                     uint32_t inv, uint32_t carry_in, bool update_flags)
1097a3ef070eSClaudio Fontana {
1098a3ef070eSClaudio Fontana     uint16_t mask = mve_element_mask(env);
1099a3ef070eSClaudio Fontana     unsigned e;
1100a3ef070eSClaudio Fontana 
1101a3ef070eSClaudio Fontana     /* If any additions trigger, we will update flags. */
1102a3ef070eSClaudio Fontana     if (mask & 0x1111) {
1103a3ef070eSClaudio Fontana         update_flags = true;
1104a3ef070eSClaudio Fontana     }
1105a3ef070eSClaudio Fontana 
1106a3ef070eSClaudio Fontana     for (e = 0; e < 16 / 4; e++, mask >>= 4) {
1107a3ef070eSClaudio Fontana         uint64_t r = carry_in;
1108a3ef070eSClaudio Fontana         r += n[H4(e)];
1109a3ef070eSClaudio Fontana         r += m[H4(e)] ^ inv;
1110a3ef070eSClaudio Fontana         if (mask & 1) {
1111a3ef070eSClaudio Fontana             carry_in = r >> 32;
1112a3ef070eSClaudio Fontana         }
1113a3ef070eSClaudio Fontana         mergemask(&d[H4(e)], r, mask);
1114a3ef070eSClaudio Fontana     }
1115a3ef070eSClaudio Fontana 
1116a3ef070eSClaudio Fontana     if (update_flags) {
1117a3ef070eSClaudio Fontana         /* Store C, clear NZV. */
1118a3ef070eSClaudio Fontana         env->vfp.xregs[ARM_VFP_FPSCR] &= ~FPCR_NZCV_MASK;
1119a3ef070eSClaudio Fontana         env->vfp.xregs[ARM_VFP_FPSCR] |= carry_in * FPCR_C;
1120a3ef070eSClaudio Fontana     }
1121a3ef070eSClaudio Fontana     mve_advance_vpt(env);
1122a3ef070eSClaudio Fontana }
1123a3ef070eSClaudio Fontana 
HELPER(mve_vadc)1124a3ef070eSClaudio Fontana void HELPER(mve_vadc)(CPUARMState *env, void *vd, void *vn, void *vm)
1125a3ef070eSClaudio Fontana {
1126a3ef070eSClaudio Fontana     bool carry_in = env->vfp.xregs[ARM_VFP_FPSCR] & FPCR_C;
1127a3ef070eSClaudio Fontana     do_vadc(env, vd, vn, vm, 0, carry_in, false);
1128a3ef070eSClaudio Fontana }
1129a3ef070eSClaudio Fontana 
HELPER(mve_vsbc)1130a3ef070eSClaudio Fontana void HELPER(mve_vsbc)(CPUARMState *env, void *vd, void *vn, void *vm)
1131a3ef070eSClaudio Fontana {
1132a3ef070eSClaudio Fontana     bool carry_in = env->vfp.xregs[ARM_VFP_FPSCR] & FPCR_C;
1133a3ef070eSClaudio Fontana     do_vadc(env, vd, vn, vm, -1, carry_in, false);
1134a3ef070eSClaudio Fontana }
1135a3ef070eSClaudio Fontana 
1136a3ef070eSClaudio Fontana 
HELPER(mve_vadci)1137a3ef070eSClaudio Fontana void HELPER(mve_vadci)(CPUARMState *env, void *vd, void *vn, void *vm)
1138a3ef070eSClaudio Fontana {
1139a3ef070eSClaudio Fontana     do_vadc(env, vd, vn, vm, 0, 0, true);
1140a3ef070eSClaudio Fontana }
1141a3ef070eSClaudio Fontana 
HELPER(mve_vsbci)1142a3ef070eSClaudio Fontana void HELPER(mve_vsbci)(CPUARMState *env, void *vd, void *vn, void *vm)
1143a3ef070eSClaudio Fontana {
1144a3ef070eSClaudio Fontana     do_vadc(env, vd, vn, vm, -1, 1, true);
1145a3ef070eSClaudio Fontana }
1146a3ef070eSClaudio Fontana 
1147a3ef070eSClaudio Fontana #define DO_VCADD(OP, ESIZE, TYPE, FN0, FN1)                             \
1148a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn, void *vm) \
1149a3ef070eSClaudio Fontana     {                                                                   \
1150a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn, *m = vm;                                 \
1151a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1152a3ef070eSClaudio Fontana         unsigned e;                                                     \
1153a3ef070eSClaudio Fontana         TYPE r[16 / ESIZE];                                             \
1154a3ef070eSClaudio Fontana         /* Calculate all results first to avoid overwriting inputs */   \
1155a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++) {                              \
1156a3ef070eSClaudio Fontana             if (!(e & 1)) {                                             \
1157a3ef070eSClaudio Fontana                 r[e] = FN0(n[H##ESIZE(e)], m[H##ESIZE(e + 1)]);         \
1158a3ef070eSClaudio Fontana             } else {                                                    \
1159a3ef070eSClaudio Fontana                 r[e] = FN1(n[H##ESIZE(e)], m[H##ESIZE(e - 1)]);         \
1160a3ef070eSClaudio Fontana             }                                                           \
1161a3ef070eSClaudio Fontana         }                                                               \
1162a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
1163a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r[e], mask);                     \
1164a3ef070eSClaudio Fontana         }                                                               \
1165a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1166a3ef070eSClaudio Fontana     }
1167a3ef070eSClaudio Fontana 
1168a3ef070eSClaudio Fontana #define DO_VCADD_ALL(OP, FN0, FN1)              \
1169a3ef070eSClaudio Fontana     DO_VCADD(OP##b, 1, int8_t, FN0, FN1)        \
1170a3ef070eSClaudio Fontana     DO_VCADD(OP##h, 2, int16_t, FN0, FN1)       \
1171a3ef070eSClaudio Fontana     DO_VCADD(OP##w, 4, int32_t, FN0, FN1)
1172a3ef070eSClaudio Fontana 
DO_VCADD_ALL(vcadd90,DO_SUB,DO_ADD)1173a3ef070eSClaudio Fontana DO_VCADD_ALL(vcadd90, DO_SUB, DO_ADD)
1174a3ef070eSClaudio Fontana DO_VCADD_ALL(vcadd270, DO_ADD, DO_SUB)
1175a3ef070eSClaudio Fontana DO_VCADD_ALL(vhcadd90, do_vhsub_s, do_vhadd_s)
1176a3ef070eSClaudio Fontana DO_VCADD_ALL(vhcadd270, do_vhadd_s, do_vhsub_s)
1177a3ef070eSClaudio Fontana 
1178a3ef070eSClaudio Fontana static inline int32_t do_sat_bhw(int64_t val, int64_t min, int64_t max, bool *s)
1179a3ef070eSClaudio Fontana {
1180a3ef070eSClaudio Fontana     if (val > max) {
1181a3ef070eSClaudio Fontana         *s = true;
1182a3ef070eSClaudio Fontana         return max;
1183a3ef070eSClaudio Fontana     } else if (val < min) {
1184a3ef070eSClaudio Fontana         *s = true;
1185a3ef070eSClaudio Fontana         return min;
1186a3ef070eSClaudio Fontana     }
1187a3ef070eSClaudio Fontana     return val;
1188a3ef070eSClaudio Fontana }
1189a3ef070eSClaudio Fontana 
1190a3ef070eSClaudio Fontana #define DO_SQADD_B(n, m, s) do_sat_bhw((int64_t)n + m, INT8_MIN, INT8_MAX, s)
1191a3ef070eSClaudio Fontana #define DO_SQADD_H(n, m, s) do_sat_bhw((int64_t)n + m, INT16_MIN, INT16_MAX, s)
1192a3ef070eSClaudio Fontana #define DO_SQADD_W(n, m, s) do_sat_bhw((int64_t)n + m, INT32_MIN, INT32_MAX, s)
1193a3ef070eSClaudio Fontana 
1194a3ef070eSClaudio Fontana #define DO_UQADD_B(n, m, s) do_sat_bhw((int64_t)n + m, 0, UINT8_MAX, s)
1195a3ef070eSClaudio Fontana #define DO_UQADD_H(n, m, s) do_sat_bhw((int64_t)n + m, 0, UINT16_MAX, s)
1196a3ef070eSClaudio Fontana #define DO_UQADD_W(n, m, s) do_sat_bhw((int64_t)n + m, 0, UINT32_MAX, s)
1197a3ef070eSClaudio Fontana 
1198a3ef070eSClaudio Fontana #define DO_SQSUB_B(n, m, s) do_sat_bhw((int64_t)n - m, INT8_MIN, INT8_MAX, s)
1199a3ef070eSClaudio Fontana #define DO_SQSUB_H(n, m, s) do_sat_bhw((int64_t)n - m, INT16_MIN, INT16_MAX, s)
1200a3ef070eSClaudio Fontana #define DO_SQSUB_W(n, m, s) do_sat_bhw((int64_t)n - m, INT32_MIN, INT32_MAX, s)
1201a3ef070eSClaudio Fontana 
1202a3ef070eSClaudio Fontana #define DO_UQSUB_B(n, m, s) do_sat_bhw((int64_t)n - m, 0, UINT8_MAX, s)
1203a3ef070eSClaudio Fontana #define DO_UQSUB_H(n, m, s) do_sat_bhw((int64_t)n - m, 0, UINT16_MAX, s)
1204a3ef070eSClaudio Fontana #define DO_UQSUB_W(n, m, s) do_sat_bhw((int64_t)n - m, 0, UINT32_MAX, s)
1205a3ef070eSClaudio Fontana 
1206a3ef070eSClaudio Fontana /*
1207a3ef070eSClaudio Fontana  * For QDMULH and QRDMULH we simplify "double and shift by esize" into
1208a3ef070eSClaudio Fontana  * "shift by esize-1", adjusting the QRDMULH rounding constant to match.
1209a3ef070eSClaudio Fontana  */
1210a3ef070eSClaudio Fontana #define DO_QDMULH_B(n, m, s) do_sat_bhw(((int64_t)n * m) >> 7, \
1211a3ef070eSClaudio Fontana                                         INT8_MIN, INT8_MAX, s)
1212a3ef070eSClaudio Fontana #define DO_QDMULH_H(n, m, s) do_sat_bhw(((int64_t)n * m) >> 15, \
1213a3ef070eSClaudio Fontana                                         INT16_MIN, INT16_MAX, s)
1214a3ef070eSClaudio Fontana #define DO_QDMULH_W(n, m, s) do_sat_bhw(((int64_t)n * m) >> 31, \
1215a3ef070eSClaudio Fontana                                         INT32_MIN, INT32_MAX, s)
1216a3ef070eSClaudio Fontana 
1217a3ef070eSClaudio Fontana #define DO_QRDMULH_B(n, m, s) do_sat_bhw(((int64_t)n * m + (1 << 6)) >> 7, \
1218a3ef070eSClaudio Fontana                                          INT8_MIN, INT8_MAX, s)
1219a3ef070eSClaudio Fontana #define DO_QRDMULH_H(n, m, s) do_sat_bhw(((int64_t)n * m + (1 << 14)) >> 15, \
1220a3ef070eSClaudio Fontana                                          INT16_MIN, INT16_MAX, s)
1221a3ef070eSClaudio Fontana #define DO_QRDMULH_W(n, m, s) do_sat_bhw(((int64_t)n * m + (1 << 30)) >> 31, \
1222a3ef070eSClaudio Fontana                                          INT32_MIN, INT32_MAX, s)
1223a3ef070eSClaudio Fontana 
1224a3ef070eSClaudio Fontana DO_2OP_SAT(vqdmulhb, 1, int8_t, DO_QDMULH_B)
1225a3ef070eSClaudio Fontana DO_2OP_SAT(vqdmulhh, 2, int16_t, DO_QDMULH_H)
1226a3ef070eSClaudio Fontana DO_2OP_SAT(vqdmulhw, 4, int32_t, DO_QDMULH_W)
1227a3ef070eSClaudio Fontana 
1228a3ef070eSClaudio Fontana DO_2OP_SAT(vqrdmulhb, 1, int8_t, DO_QRDMULH_B)
1229a3ef070eSClaudio Fontana DO_2OP_SAT(vqrdmulhh, 2, int16_t, DO_QRDMULH_H)
1230a3ef070eSClaudio Fontana DO_2OP_SAT(vqrdmulhw, 4, int32_t, DO_QRDMULH_W)
1231a3ef070eSClaudio Fontana 
1232a3ef070eSClaudio Fontana DO_2OP_SAT(vqaddub, 1, uint8_t, DO_UQADD_B)
1233a3ef070eSClaudio Fontana DO_2OP_SAT(vqadduh, 2, uint16_t, DO_UQADD_H)
1234a3ef070eSClaudio Fontana DO_2OP_SAT(vqadduw, 4, uint32_t, DO_UQADD_W)
1235a3ef070eSClaudio Fontana DO_2OP_SAT(vqaddsb, 1, int8_t, DO_SQADD_B)
1236a3ef070eSClaudio Fontana DO_2OP_SAT(vqaddsh, 2, int16_t, DO_SQADD_H)
1237a3ef070eSClaudio Fontana DO_2OP_SAT(vqaddsw, 4, int32_t, DO_SQADD_W)
1238a3ef070eSClaudio Fontana 
1239a3ef070eSClaudio Fontana DO_2OP_SAT(vqsubub, 1, uint8_t, DO_UQSUB_B)
1240a3ef070eSClaudio Fontana DO_2OP_SAT(vqsubuh, 2, uint16_t, DO_UQSUB_H)
1241a3ef070eSClaudio Fontana DO_2OP_SAT(vqsubuw, 4, uint32_t, DO_UQSUB_W)
1242a3ef070eSClaudio Fontana DO_2OP_SAT(vqsubsb, 1, int8_t, DO_SQSUB_B)
1243a3ef070eSClaudio Fontana DO_2OP_SAT(vqsubsh, 2, int16_t, DO_SQSUB_H)
1244a3ef070eSClaudio Fontana DO_2OP_SAT(vqsubsw, 4, int32_t, DO_SQSUB_W)
1245a3ef070eSClaudio Fontana 
1246a3ef070eSClaudio Fontana /*
1247a3ef070eSClaudio Fontana  * This wrapper fixes up the impedance mismatch between do_sqrshl_bhs()
1248a3ef070eSClaudio Fontana  * and friends wanting a uint32_t* sat and our needing a bool*.
1249a3ef070eSClaudio Fontana  */
1250a3ef070eSClaudio Fontana #define WRAP_QRSHL_HELPER(FN, N, M, ROUND, satp)                        \
1251a3ef070eSClaudio Fontana     ({                                                                  \
1252a3ef070eSClaudio Fontana         uint32_t su32 = 0;                                              \
1253d54deb2aSPhilippe Mathieu-Daudé         typeof(N) qrshl_ret = FN(N, (int8_t)(M), sizeof(N) * 8, ROUND, &su32); \
1254a3ef070eSClaudio Fontana         if (su32) {                                                     \
1255a3ef070eSClaudio Fontana             *satp = true;                                               \
1256a3ef070eSClaudio Fontana         }                                                               \
1257d54deb2aSPhilippe Mathieu-Daudé         qrshl_ret;                                                      \
1258a3ef070eSClaudio Fontana     })
1259a3ef070eSClaudio Fontana 
1260a3ef070eSClaudio Fontana #define DO_SQSHL_OP(N, M, satp) \
1261a3ef070eSClaudio Fontana     WRAP_QRSHL_HELPER(do_sqrshl_bhs, N, M, false, satp)
1262a3ef070eSClaudio Fontana #define DO_UQSHL_OP(N, M, satp) \
1263a3ef070eSClaudio Fontana     WRAP_QRSHL_HELPER(do_uqrshl_bhs, N, M, false, satp)
1264a3ef070eSClaudio Fontana #define DO_SQRSHL_OP(N, M, satp) \
1265a3ef070eSClaudio Fontana     WRAP_QRSHL_HELPER(do_sqrshl_bhs, N, M, true, satp)
1266a3ef070eSClaudio Fontana #define DO_UQRSHL_OP(N, M, satp) \
1267a3ef070eSClaudio Fontana     WRAP_QRSHL_HELPER(do_uqrshl_bhs, N, M, true, satp)
1268a3ef070eSClaudio Fontana #define DO_SUQSHL_OP(N, M, satp) \
1269a3ef070eSClaudio Fontana     WRAP_QRSHL_HELPER(do_suqrshl_bhs, N, M, false, satp)
1270a3ef070eSClaudio Fontana 
DO_2OP_SAT_S(vqshls,DO_SQSHL_OP)1271a3ef070eSClaudio Fontana DO_2OP_SAT_S(vqshls, DO_SQSHL_OP)
1272a3ef070eSClaudio Fontana DO_2OP_SAT_U(vqshlu, DO_UQSHL_OP)
1273a3ef070eSClaudio Fontana DO_2OP_SAT_S(vqrshls, DO_SQRSHL_OP)
1274a3ef070eSClaudio Fontana DO_2OP_SAT_U(vqrshlu, DO_UQRSHL_OP)
1275a3ef070eSClaudio Fontana 
1276a3ef070eSClaudio Fontana /*
1277a3ef070eSClaudio Fontana  * Multiply add dual returning high half
1278a3ef070eSClaudio Fontana  * The 'FN' here takes four inputs A, B, C, D, a 0/1 indicator of
1279a3ef070eSClaudio Fontana  * whether to add the rounding constant, and the pointer to the
1280a3ef070eSClaudio Fontana  * saturation flag, and should do "(A * B + C * D) * 2 + rounding constant",
1281a3ef070eSClaudio Fontana  * saturate to twice the input size and return the high half; or
1282a3ef070eSClaudio Fontana  * (A * B - C * D) etc for VQDMLSDH.
1283a3ef070eSClaudio Fontana  */
1284a3ef070eSClaudio Fontana #define DO_VQDMLADH_OP(OP, ESIZE, TYPE, XCHG, ROUND, FN)                \
1285a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn,   \
1286a3ef070eSClaudio Fontana                                 void *vm)                               \
1287a3ef070eSClaudio Fontana     {                                                                   \
1288a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn, *m = vm;                                 \
1289a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1290a3ef070eSClaudio Fontana         unsigned e;                                                     \
1291a3ef070eSClaudio Fontana         bool qc = false;                                                \
1292a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
1293a3ef070eSClaudio Fontana             bool sat = false;                                           \
1294a3ef070eSClaudio Fontana             if ((e & 1) == XCHG) {                                      \
1295d54deb2aSPhilippe Mathieu-Daudé                 TYPE vqdmladh_ret = FN(n[H##ESIZE(e)],                  \
1296a3ef070eSClaudio Fontana                             m[H##ESIZE(e - XCHG)],                      \
1297a3ef070eSClaudio Fontana                             n[H##ESIZE(e + (1 - 2 * XCHG))],            \
1298a3ef070eSClaudio Fontana                             m[H##ESIZE(e + (1 - XCHG))],                \
1299a3ef070eSClaudio Fontana                             ROUND, &sat);                               \
1300d54deb2aSPhilippe Mathieu-Daudé                 mergemask(&d[H##ESIZE(e)], vqdmladh_ret, mask);         \
1301a3ef070eSClaudio Fontana                 qc |= sat & mask & 1;                                   \
1302a3ef070eSClaudio Fontana             }                                                           \
1303a3ef070eSClaudio Fontana         }                                                               \
1304a3ef070eSClaudio Fontana         if (qc) {                                                       \
1305a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                        \
1306a3ef070eSClaudio Fontana         }                                                               \
1307a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1308a3ef070eSClaudio Fontana     }
1309a3ef070eSClaudio Fontana 
1310a3ef070eSClaudio Fontana static int8_t do_vqdmladh_b(int8_t a, int8_t b, int8_t c, int8_t d,
1311a3ef070eSClaudio Fontana                             int round, bool *sat)
1312a3ef070eSClaudio Fontana {
1313a3ef070eSClaudio Fontana     int64_t r = ((int64_t)a * b + (int64_t)c * d) * 2 + (round << 7);
1314a3ef070eSClaudio Fontana     return do_sat_bhw(r, INT16_MIN, INT16_MAX, sat) >> 8;
1315a3ef070eSClaudio Fontana }
1316a3ef070eSClaudio Fontana 
do_vqdmladh_h(int16_t a,int16_t b,int16_t c,int16_t d,int round,bool * sat)1317a3ef070eSClaudio Fontana static int16_t do_vqdmladh_h(int16_t a, int16_t b, int16_t c, int16_t d,
1318a3ef070eSClaudio Fontana                              int round, bool *sat)
1319a3ef070eSClaudio Fontana {
1320a3ef070eSClaudio Fontana     int64_t r = ((int64_t)a * b + (int64_t)c * d) * 2 + (round << 15);
1321a3ef070eSClaudio Fontana     return do_sat_bhw(r, INT32_MIN, INT32_MAX, sat) >> 16;
1322a3ef070eSClaudio Fontana }
1323a3ef070eSClaudio Fontana 
do_vqdmladh_w(int32_t a,int32_t b,int32_t c,int32_t d,int round,bool * sat)1324a3ef070eSClaudio Fontana static int32_t do_vqdmladh_w(int32_t a, int32_t b, int32_t c, int32_t d,
1325a3ef070eSClaudio Fontana                              int round, bool *sat)
1326a3ef070eSClaudio Fontana {
1327a3ef070eSClaudio Fontana     int64_t m1 = (int64_t)a * b;
1328a3ef070eSClaudio Fontana     int64_t m2 = (int64_t)c * d;
1329a3ef070eSClaudio Fontana     int64_t r;
1330a3ef070eSClaudio Fontana     /*
1331a3ef070eSClaudio Fontana      * Architecturally we should do the entire add, double, round
1332a3ef070eSClaudio Fontana      * and then check for saturation. We do three saturating adds,
1333a3ef070eSClaudio Fontana      * but we need to be careful about the order. If the first
1334a3ef070eSClaudio Fontana      * m1 + m2 saturates then it's impossible for the *2+rc to
1335a3ef070eSClaudio Fontana      * bring it back into the non-saturated range. However, if
1336a3ef070eSClaudio Fontana      * m1 + m2 is negative then it's possible that doing the doubling
1337a3ef070eSClaudio Fontana      * would take the intermediate result below INT64_MAX and the
1338a3ef070eSClaudio Fontana      * addition of the rounding constant then brings it back in range.
1339a3ef070eSClaudio Fontana      * So we add half the rounding constant before doubling rather
1340a3ef070eSClaudio Fontana      * than adding the rounding constant after the doubling.
1341a3ef070eSClaudio Fontana      */
1342a3ef070eSClaudio Fontana     if (sadd64_overflow(m1, m2, &r) ||
1343a3ef070eSClaudio Fontana         sadd64_overflow(r, (round << 30), &r) ||
1344a3ef070eSClaudio Fontana         sadd64_overflow(r, r, &r)) {
1345a3ef070eSClaudio Fontana         *sat = true;
1346a3ef070eSClaudio Fontana         return r < 0 ? INT32_MAX : INT32_MIN;
1347a3ef070eSClaudio Fontana     }
1348a3ef070eSClaudio Fontana     return r >> 32;
1349a3ef070eSClaudio Fontana }
1350a3ef070eSClaudio Fontana 
do_vqdmlsdh_b(int8_t a,int8_t b,int8_t c,int8_t d,int round,bool * sat)1351a3ef070eSClaudio Fontana static int8_t do_vqdmlsdh_b(int8_t a, int8_t b, int8_t c, int8_t d,
1352a3ef070eSClaudio Fontana                             int round, bool *sat)
1353a3ef070eSClaudio Fontana {
1354a3ef070eSClaudio Fontana     int64_t r = ((int64_t)a * b - (int64_t)c * d) * 2 + (round << 7);
1355a3ef070eSClaudio Fontana     return do_sat_bhw(r, INT16_MIN, INT16_MAX, sat) >> 8;
1356a3ef070eSClaudio Fontana }
1357a3ef070eSClaudio Fontana 
do_vqdmlsdh_h(int16_t a,int16_t b,int16_t c,int16_t d,int round,bool * sat)1358a3ef070eSClaudio Fontana static int16_t do_vqdmlsdh_h(int16_t a, int16_t b, int16_t c, int16_t d,
1359a3ef070eSClaudio Fontana                              int round, bool *sat)
1360a3ef070eSClaudio Fontana {
1361a3ef070eSClaudio Fontana     int64_t r = ((int64_t)a * b - (int64_t)c * d) * 2 + (round << 15);
1362a3ef070eSClaudio Fontana     return do_sat_bhw(r, INT32_MIN, INT32_MAX, sat) >> 16;
1363a3ef070eSClaudio Fontana }
1364a3ef070eSClaudio Fontana 
do_vqdmlsdh_w(int32_t a,int32_t b,int32_t c,int32_t d,int round,bool * sat)1365a3ef070eSClaudio Fontana static int32_t do_vqdmlsdh_w(int32_t a, int32_t b, int32_t c, int32_t d,
1366a3ef070eSClaudio Fontana                              int round, bool *sat)
1367a3ef070eSClaudio Fontana {
1368a3ef070eSClaudio Fontana     int64_t m1 = (int64_t)a * b;
1369a3ef070eSClaudio Fontana     int64_t m2 = (int64_t)c * d;
1370a3ef070eSClaudio Fontana     int64_t r;
1371a3ef070eSClaudio Fontana     /* The same ordering issue as in do_vqdmladh_w applies here too */
1372a3ef070eSClaudio Fontana     if (ssub64_overflow(m1, m2, &r) ||
1373a3ef070eSClaudio Fontana         sadd64_overflow(r, (round << 30), &r) ||
1374a3ef070eSClaudio Fontana         sadd64_overflow(r, r, &r)) {
1375a3ef070eSClaudio Fontana         *sat = true;
1376a3ef070eSClaudio Fontana         return r < 0 ? INT32_MAX : INT32_MIN;
1377a3ef070eSClaudio Fontana     }
1378a3ef070eSClaudio Fontana     return r >> 32;
1379a3ef070eSClaudio Fontana }
1380a3ef070eSClaudio Fontana 
1381a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmladhb, 1, int8_t, 0, 0, do_vqdmladh_b)
1382a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmladhh, 2, int16_t, 0, 0, do_vqdmladh_h)
1383a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmladhw, 4, int32_t, 0, 0, do_vqdmladh_w)
1384a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmladhxb, 1, int8_t, 1, 0, do_vqdmladh_b)
1385a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmladhxh, 2, int16_t, 1, 0, do_vqdmladh_h)
1386a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmladhxw, 4, int32_t, 1, 0, do_vqdmladh_w)
1387a3ef070eSClaudio Fontana 
1388a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmladhb, 1, int8_t, 0, 1, do_vqdmladh_b)
1389a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmladhh, 2, int16_t, 0, 1, do_vqdmladh_h)
1390a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmladhw, 4, int32_t, 0, 1, do_vqdmladh_w)
1391a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmladhxb, 1, int8_t, 1, 1, do_vqdmladh_b)
1392a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmladhxh, 2, int16_t, 1, 1, do_vqdmladh_h)
1393a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmladhxw, 4, int32_t, 1, 1, do_vqdmladh_w)
1394a3ef070eSClaudio Fontana 
1395a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmlsdhb, 1, int8_t, 0, 0, do_vqdmlsdh_b)
1396a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmlsdhh, 2, int16_t, 0, 0, do_vqdmlsdh_h)
1397a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmlsdhw, 4, int32_t, 0, 0, do_vqdmlsdh_w)
1398a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmlsdhxb, 1, int8_t, 1, 0, do_vqdmlsdh_b)
1399a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmlsdhxh, 2, int16_t, 1, 0, do_vqdmlsdh_h)
1400a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqdmlsdhxw, 4, int32_t, 1, 0, do_vqdmlsdh_w)
1401a3ef070eSClaudio Fontana 
1402a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmlsdhb, 1, int8_t, 0, 1, do_vqdmlsdh_b)
1403a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmlsdhh, 2, int16_t, 0, 1, do_vqdmlsdh_h)
1404a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmlsdhw, 4, int32_t, 0, 1, do_vqdmlsdh_w)
1405a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmlsdhxb, 1, int8_t, 1, 1, do_vqdmlsdh_b)
1406a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmlsdhxh, 2, int16_t, 1, 1, do_vqdmlsdh_h)
1407a3ef070eSClaudio Fontana DO_VQDMLADH_OP(vqrdmlsdhxw, 4, int32_t, 1, 1, do_vqdmlsdh_w)
1408a3ef070eSClaudio Fontana 
1409a3ef070eSClaudio Fontana #define DO_2OP_SCALAR(OP, ESIZE, TYPE, FN)                              \
1410a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn,   \
1411a3ef070eSClaudio Fontana                                 uint32_t rm)                            \
1412a3ef070eSClaudio Fontana     {                                                                   \
1413a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn;                                          \
1414a3ef070eSClaudio Fontana         TYPE m = rm;                                                    \
1415a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1416a3ef070eSClaudio Fontana         unsigned e;                                                     \
1417a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
1418a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], FN(n[H##ESIZE(e)], m), mask);    \
1419a3ef070eSClaudio Fontana         }                                                               \
1420a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1421a3ef070eSClaudio Fontana     }
1422a3ef070eSClaudio Fontana 
1423a3ef070eSClaudio Fontana #define DO_2OP_SAT_SCALAR(OP, ESIZE, TYPE, FN)                          \
1424a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn,   \
1425a3ef070eSClaudio Fontana                                 uint32_t rm)                            \
1426a3ef070eSClaudio Fontana     {                                                                   \
1427a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn;                                          \
1428a3ef070eSClaudio Fontana         TYPE m = rm;                                                    \
1429a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1430a3ef070eSClaudio Fontana         unsigned e;                                                     \
1431a3ef070eSClaudio Fontana         bool qc = false;                                                \
1432a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
1433a3ef070eSClaudio Fontana             bool sat = false;                                           \
1434a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], FN(n[H##ESIZE(e)], m, &sat),     \
1435a3ef070eSClaudio Fontana                       mask);                                            \
1436a3ef070eSClaudio Fontana             qc |= sat & mask & 1;                                       \
1437a3ef070eSClaudio Fontana         }                                                               \
1438a3ef070eSClaudio Fontana         if (qc) {                                                       \
1439a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                        \
1440a3ef070eSClaudio Fontana         }                                                               \
1441a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1442a3ef070eSClaudio Fontana     }
1443a3ef070eSClaudio Fontana 
1444a3ef070eSClaudio Fontana /* "accumulating" version where FN takes d as well as n and m */
1445a3ef070eSClaudio Fontana #define DO_2OP_ACC_SCALAR(OP, ESIZE, TYPE, FN)                          \
1446a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn,   \
1447a3ef070eSClaudio Fontana                                 uint32_t rm)                            \
1448a3ef070eSClaudio Fontana     {                                                                   \
1449a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn;                                          \
1450a3ef070eSClaudio Fontana         TYPE m = rm;                                                    \
1451a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1452a3ef070eSClaudio Fontana         unsigned e;                                                     \
1453a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
1454a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)],                                  \
1455a3ef070eSClaudio Fontana                       FN(d[H##ESIZE(e)], n[H##ESIZE(e)], m), mask);     \
1456a3ef070eSClaudio Fontana         }                                                               \
1457a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1458a3ef070eSClaudio Fontana     }
1459a3ef070eSClaudio Fontana 
1460a3ef070eSClaudio Fontana #define DO_2OP_SAT_ACC_SCALAR(OP, ESIZE, TYPE, FN)                      \
1461a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn,   \
1462a3ef070eSClaudio Fontana                                 uint32_t rm)                            \
1463a3ef070eSClaudio Fontana     {                                                                   \
1464a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn;                                          \
1465a3ef070eSClaudio Fontana         TYPE m = rm;                                                    \
1466a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1467a3ef070eSClaudio Fontana         unsigned e;                                                     \
1468a3ef070eSClaudio Fontana         bool qc = false;                                                \
1469a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
1470a3ef070eSClaudio Fontana             bool sat = false;                                           \
1471a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)],                                  \
1472a3ef070eSClaudio Fontana                       FN(d[H##ESIZE(e)], n[H##ESIZE(e)], m, &sat),      \
1473a3ef070eSClaudio Fontana                       mask);                                            \
1474a3ef070eSClaudio Fontana             qc |= sat & mask & 1;                                       \
1475a3ef070eSClaudio Fontana         }                                                               \
1476a3ef070eSClaudio Fontana         if (qc) {                                                       \
1477a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                        \
1478a3ef070eSClaudio Fontana         }                                                               \
1479a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1480a3ef070eSClaudio Fontana     }
1481a3ef070eSClaudio Fontana 
1482a3ef070eSClaudio Fontana /* provide unsigned 2-op scalar helpers for all sizes */
1483a3ef070eSClaudio Fontana #define DO_2OP_SCALAR_U(OP, FN)                 \
1484a3ef070eSClaudio Fontana     DO_2OP_SCALAR(OP##b, 1, uint8_t, FN)        \
1485a3ef070eSClaudio Fontana     DO_2OP_SCALAR(OP##h, 2, uint16_t, FN)       \
1486a3ef070eSClaudio Fontana     DO_2OP_SCALAR(OP##w, 4, uint32_t, FN)
1487a3ef070eSClaudio Fontana #define DO_2OP_SCALAR_S(OP, FN)                 \
1488a3ef070eSClaudio Fontana     DO_2OP_SCALAR(OP##b, 1, int8_t, FN)         \
1489a3ef070eSClaudio Fontana     DO_2OP_SCALAR(OP##h, 2, int16_t, FN)        \
1490a3ef070eSClaudio Fontana     DO_2OP_SCALAR(OP##w, 4, int32_t, FN)
1491a3ef070eSClaudio Fontana 
1492a3ef070eSClaudio Fontana #define DO_2OP_ACC_SCALAR_U(OP, FN)             \
1493a3ef070eSClaudio Fontana     DO_2OP_ACC_SCALAR(OP##b, 1, uint8_t, FN)    \
1494a3ef070eSClaudio Fontana     DO_2OP_ACC_SCALAR(OP##h, 2, uint16_t, FN)   \
1495a3ef070eSClaudio Fontana     DO_2OP_ACC_SCALAR(OP##w, 4, uint32_t, FN)
1496a3ef070eSClaudio Fontana 
DO_2OP_SCALAR_U(vadd_scalar,DO_ADD)1497a3ef070eSClaudio Fontana DO_2OP_SCALAR_U(vadd_scalar, DO_ADD)
1498a3ef070eSClaudio Fontana DO_2OP_SCALAR_U(vsub_scalar, DO_SUB)
1499a3ef070eSClaudio Fontana DO_2OP_SCALAR_U(vmul_scalar, DO_MUL)
1500a3ef070eSClaudio Fontana DO_2OP_SCALAR_S(vhadds_scalar, do_vhadd_s)
1501a3ef070eSClaudio Fontana DO_2OP_SCALAR_U(vhaddu_scalar, do_vhadd_u)
1502a3ef070eSClaudio Fontana DO_2OP_SCALAR_S(vhsubs_scalar, do_vhsub_s)
1503a3ef070eSClaudio Fontana DO_2OP_SCALAR_U(vhsubu_scalar, do_vhsub_u)
1504a3ef070eSClaudio Fontana 
1505a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqaddu_scalarb, 1, uint8_t, DO_UQADD_B)
1506a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqaddu_scalarh, 2, uint16_t, DO_UQADD_H)
1507a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqaddu_scalarw, 4, uint32_t, DO_UQADD_W)
1508a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqadds_scalarb, 1, int8_t, DO_SQADD_B)
1509a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqadds_scalarh, 2, int16_t, DO_SQADD_H)
1510a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqadds_scalarw, 4, int32_t, DO_SQADD_W)
1511a3ef070eSClaudio Fontana 
1512a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqsubu_scalarb, 1, uint8_t, DO_UQSUB_B)
1513a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqsubu_scalarh, 2, uint16_t, DO_UQSUB_H)
1514a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqsubu_scalarw, 4, uint32_t, DO_UQSUB_W)
1515a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqsubs_scalarb, 1, int8_t, DO_SQSUB_B)
1516a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqsubs_scalarh, 2, int16_t, DO_SQSUB_H)
1517a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqsubs_scalarw, 4, int32_t, DO_SQSUB_W)
1518a3ef070eSClaudio Fontana 
1519a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqdmulh_scalarb, 1, int8_t, DO_QDMULH_B)
1520a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqdmulh_scalarh, 2, int16_t, DO_QDMULH_H)
1521a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqdmulh_scalarw, 4, int32_t, DO_QDMULH_W)
1522a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqrdmulh_scalarb, 1, int8_t, DO_QRDMULH_B)
1523a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqrdmulh_scalarh, 2, int16_t, DO_QRDMULH_H)
1524a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR(vqrdmulh_scalarw, 4, int32_t, DO_QRDMULH_W)
1525a3ef070eSClaudio Fontana 
1526a3ef070eSClaudio Fontana static int8_t do_vqdmlah_b(int8_t a, int8_t b, int8_t c, int round, bool *sat)
1527a3ef070eSClaudio Fontana {
1528a3ef070eSClaudio Fontana     int64_t r = (int64_t)a * b * 2 + ((int64_t)c << 8) + (round << 7);
1529a3ef070eSClaudio Fontana     return do_sat_bhw(r, INT16_MIN, INT16_MAX, sat) >> 8;
1530a3ef070eSClaudio Fontana }
1531a3ef070eSClaudio Fontana 
do_vqdmlah_h(int16_t a,int16_t b,int16_t c,int round,bool * sat)1532a3ef070eSClaudio Fontana static int16_t do_vqdmlah_h(int16_t a, int16_t b, int16_t c,
1533a3ef070eSClaudio Fontana                            int round, bool *sat)
1534a3ef070eSClaudio Fontana {
1535a3ef070eSClaudio Fontana     int64_t r = (int64_t)a * b * 2 + ((int64_t)c << 16) + (round << 15);
1536a3ef070eSClaudio Fontana     return do_sat_bhw(r, INT32_MIN, INT32_MAX, sat) >> 16;
1537a3ef070eSClaudio Fontana }
1538a3ef070eSClaudio Fontana 
do_vqdmlah_w(int32_t a,int32_t b,int32_t c,int round,bool * sat)1539a3ef070eSClaudio Fontana static int32_t do_vqdmlah_w(int32_t a, int32_t b, int32_t c,
1540a3ef070eSClaudio Fontana                             int round, bool *sat)
1541a3ef070eSClaudio Fontana {
1542a3ef070eSClaudio Fontana     /*
1543a3ef070eSClaudio Fontana      * Architecturally we should do the entire add, double, round
1544a3ef070eSClaudio Fontana      * and then check for saturation. We do three saturating adds,
1545a3ef070eSClaudio Fontana      * but we need to be careful about the order. If the first
1546a3ef070eSClaudio Fontana      * m1 + m2 saturates then it's impossible for the *2+rc to
1547a3ef070eSClaudio Fontana      * bring it back into the non-saturated range. However, if
1548a3ef070eSClaudio Fontana      * m1 + m2 is negative then it's possible that doing the doubling
1549a3ef070eSClaudio Fontana      * would take the intermediate result below INT64_MAX and the
1550a3ef070eSClaudio Fontana      * addition of the rounding constant then brings it back in range.
1551a3ef070eSClaudio Fontana      * So we add half the rounding constant and half the "c << esize"
1552a3ef070eSClaudio Fontana      * before doubling rather than adding the rounding constant after
1553a3ef070eSClaudio Fontana      * the doubling.
1554a3ef070eSClaudio Fontana      */
1555a3ef070eSClaudio Fontana     int64_t m1 = (int64_t)a * b;
1556a3ef070eSClaudio Fontana     int64_t m2 = (int64_t)c << 31;
1557a3ef070eSClaudio Fontana     int64_t r;
1558a3ef070eSClaudio Fontana     if (sadd64_overflow(m1, m2, &r) ||
1559a3ef070eSClaudio Fontana         sadd64_overflow(r, (round << 30), &r) ||
1560a3ef070eSClaudio Fontana         sadd64_overflow(r, r, &r)) {
1561a3ef070eSClaudio Fontana         *sat = true;
1562a3ef070eSClaudio Fontana         return r < 0 ? INT32_MAX : INT32_MIN;
1563a3ef070eSClaudio Fontana     }
1564a3ef070eSClaudio Fontana     return r >> 32;
1565a3ef070eSClaudio Fontana }
1566a3ef070eSClaudio Fontana 
1567a3ef070eSClaudio Fontana /*
1568a3ef070eSClaudio Fontana  * The *MLAH insns are vector * scalar + vector;
1569a3ef070eSClaudio Fontana  * the *MLASH insns are vector * vector + scalar
1570a3ef070eSClaudio Fontana  */
1571a3ef070eSClaudio Fontana #define DO_VQDMLAH_B(D, N, M, S) do_vqdmlah_b(N, M, D, 0, S)
1572a3ef070eSClaudio Fontana #define DO_VQDMLAH_H(D, N, M, S) do_vqdmlah_h(N, M, D, 0, S)
1573a3ef070eSClaudio Fontana #define DO_VQDMLAH_W(D, N, M, S) do_vqdmlah_w(N, M, D, 0, S)
1574a3ef070eSClaudio Fontana #define DO_VQRDMLAH_B(D, N, M, S) do_vqdmlah_b(N, M, D, 1, S)
1575a3ef070eSClaudio Fontana #define DO_VQRDMLAH_H(D, N, M, S) do_vqdmlah_h(N, M, D, 1, S)
1576a3ef070eSClaudio Fontana #define DO_VQRDMLAH_W(D, N, M, S) do_vqdmlah_w(N, M, D, 1, S)
1577a3ef070eSClaudio Fontana 
1578a3ef070eSClaudio Fontana #define DO_VQDMLASH_B(D, N, M, S) do_vqdmlah_b(N, D, M, 0, S)
1579a3ef070eSClaudio Fontana #define DO_VQDMLASH_H(D, N, M, S) do_vqdmlah_h(N, D, M, 0, S)
1580a3ef070eSClaudio Fontana #define DO_VQDMLASH_W(D, N, M, S) do_vqdmlah_w(N, D, M, 0, S)
1581a3ef070eSClaudio Fontana #define DO_VQRDMLASH_B(D, N, M, S) do_vqdmlah_b(N, D, M, 1, S)
1582a3ef070eSClaudio Fontana #define DO_VQRDMLASH_H(D, N, M, S) do_vqdmlah_h(N, D, M, 1, S)
1583a3ef070eSClaudio Fontana #define DO_VQRDMLASH_W(D, N, M, S) do_vqdmlah_w(N, D, M, 1, S)
1584a3ef070eSClaudio Fontana 
1585a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqdmlahb, 1, int8_t, DO_VQDMLAH_B)
1586a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqdmlahh, 2, int16_t, DO_VQDMLAH_H)
1587a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqdmlahw, 4, int32_t, DO_VQDMLAH_W)
1588a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqrdmlahb, 1, int8_t, DO_VQRDMLAH_B)
1589a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqrdmlahh, 2, int16_t, DO_VQRDMLAH_H)
1590a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqrdmlahw, 4, int32_t, DO_VQRDMLAH_W)
1591a3ef070eSClaudio Fontana 
1592a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqdmlashb, 1, int8_t, DO_VQDMLASH_B)
1593a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqdmlashh, 2, int16_t, DO_VQDMLASH_H)
1594a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqdmlashw, 4, int32_t, DO_VQDMLASH_W)
1595a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqrdmlashb, 1, int8_t, DO_VQRDMLASH_B)
1596a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqrdmlashh, 2, int16_t, DO_VQRDMLASH_H)
1597a3ef070eSClaudio Fontana DO_2OP_SAT_ACC_SCALAR(vqrdmlashw, 4, int32_t, DO_VQRDMLASH_W)
1598a3ef070eSClaudio Fontana 
1599a3ef070eSClaudio Fontana /* Vector by scalar plus vector */
1600a3ef070eSClaudio Fontana #define DO_VMLA(D, N, M) ((N) * (M) + (D))
1601a3ef070eSClaudio Fontana 
DO_2OP_ACC_SCALAR_U(vmla,DO_VMLA)1602a3ef070eSClaudio Fontana DO_2OP_ACC_SCALAR_U(vmla, DO_VMLA)
1603a3ef070eSClaudio Fontana 
1604a3ef070eSClaudio Fontana /* Vector by vector plus scalar */
1605a3ef070eSClaudio Fontana #define DO_VMLAS(D, N, M) ((N) * (D) + (M))
1606a3ef070eSClaudio Fontana 
1607a3ef070eSClaudio Fontana DO_2OP_ACC_SCALAR_U(vmlas, DO_VMLAS)
1608a3ef070eSClaudio Fontana 
1609a3ef070eSClaudio Fontana /*
1610a3ef070eSClaudio Fontana  * Long saturating scalar ops. As with DO_2OP_L, TYPE and H are for the
1611a3ef070eSClaudio Fontana  * input (smaller) type and LESIZE, LTYPE, LH for the output (long) type.
1612a3ef070eSClaudio Fontana  * SATMASK specifies which bits of the predicate mask matter for determining
1613a3ef070eSClaudio Fontana  * whether to propagate a saturation indication into FPSCR.QC -- for
1614a3ef070eSClaudio Fontana  * the 16x16->32 case we must check only the bit corresponding to the T or B
1615a3ef070eSClaudio Fontana  * half that we used, but for the 32x32->64 case we propagate if the mask
1616a3ef070eSClaudio Fontana  * bit is set for either half.
1617a3ef070eSClaudio Fontana  */
1618a3ef070eSClaudio Fontana #define DO_2OP_SAT_SCALAR_L(OP, TOP, ESIZE, TYPE, LESIZE, LTYPE, FN, SATMASK) \
1619a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn,   \
1620a3ef070eSClaudio Fontana                                 uint32_t rm)                            \
1621a3ef070eSClaudio Fontana     {                                                                   \
1622a3ef070eSClaudio Fontana         LTYPE *d = vd;                                                  \
1623a3ef070eSClaudio Fontana         TYPE *n = vn;                                                   \
1624a3ef070eSClaudio Fontana         TYPE m = rm;                                                    \
1625a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1626a3ef070eSClaudio Fontana         unsigned le;                                                    \
1627a3ef070eSClaudio Fontana         bool qc = false;                                                \
1628a3ef070eSClaudio Fontana         for (le = 0; le < 16 / LESIZE; le++, mask >>= LESIZE) {         \
1629a3ef070eSClaudio Fontana             bool sat = false;                                           \
1630a3ef070eSClaudio Fontana             LTYPE r = FN((LTYPE)n[H##ESIZE(le * 2 + TOP)], m, &sat);    \
1631a3ef070eSClaudio Fontana             mergemask(&d[H##LESIZE(le)], r, mask);                      \
1632a3ef070eSClaudio Fontana             qc |= sat && (mask & SATMASK);                              \
1633a3ef070eSClaudio Fontana         }                                                               \
1634a3ef070eSClaudio Fontana         if (qc) {                                                       \
1635a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                        \
1636a3ef070eSClaudio Fontana         }                                                               \
1637a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1638a3ef070eSClaudio Fontana     }
1639a3ef070eSClaudio Fontana 
1640a3ef070eSClaudio Fontana static inline int32_t do_qdmullh(int16_t n, int16_t m, bool *sat)
1641a3ef070eSClaudio Fontana {
1642a3ef070eSClaudio Fontana     int64_t r = ((int64_t)n * m) * 2;
1643a3ef070eSClaudio Fontana     return do_sat_bhw(r, INT32_MIN, INT32_MAX, sat);
1644a3ef070eSClaudio Fontana }
1645a3ef070eSClaudio Fontana 
do_qdmullw(int32_t n,int32_t m,bool * sat)1646a3ef070eSClaudio Fontana static inline int64_t do_qdmullw(int32_t n, int32_t m, bool *sat)
1647a3ef070eSClaudio Fontana {
1648a3ef070eSClaudio Fontana     /* The multiply can't overflow, but the doubling might */
1649a3ef070eSClaudio Fontana     int64_t r = (int64_t)n * m;
1650a3ef070eSClaudio Fontana     if (r > INT64_MAX / 2) {
1651a3ef070eSClaudio Fontana         *sat = true;
1652a3ef070eSClaudio Fontana         return INT64_MAX;
1653a3ef070eSClaudio Fontana     } else if (r < INT64_MIN / 2) {
1654a3ef070eSClaudio Fontana         *sat = true;
1655a3ef070eSClaudio Fontana         return INT64_MIN;
1656a3ef070eSClaudio Fontana     } else {
1657a3ef070eSClaudio Fontana         return r * 2;
1658a3ef070eSClaudio Fontana     }
1659a3ef070eSClaudio Fontana }
1660a3ef070eSClaudio Fontana 
1661a3ef070eSClaudio Fontana #define SATMASK16B 1
1662a3ef070eSClaudio Fontana #define SATMASK16T (1 << 2)
1663a3ef070eSClaudio Fontana #define SATMASK32 ((1 << 4) | 1)
1664a3ef070eSClaudio Fontana 
1665a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR_L(vqdmullb_scalarh, 0, 2, int16_t, 4, int32_t, \
1666a3ef070eSClaudio Fontana                     do_qdmullh, SATMASK16B)
1667a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR_L(vqdmullb_scalarw, 0, 4, int32_t, 8, int64_t, \
1668a3ef070eSClaudio Fontana                     do_qdmullw, SATMASK32)
1669a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR_L(vqdmullt_scalarh, 1, 2, int16_t, 4, int32_t, \
1670a3ef070eSClaudio Fontana                     do_qdmullh, SATMASK16T)
1671a3ef070eSClaudio Fontana DO_2OP_SAT_SCALAR_L(vqdmullt_scalarw, 1, 4, int32_t, 8, int64_t, \
1672a3ef070eSClaudio Fontana                     do_qdmullw, SATMASK32)
1673a3ef070eSClaudio Fontana 
1674a3ef070eSClaudio Fontana /*
1675a3ef070eSClaudio Fontana  * Long saturating ops
1676a3ef070eSClaudio Fontana  */
1677a3ef070eSClaudio Fontana #define DO_2OP_SAT_L(OP, TOP, ESIZE, TYPE, LESIZE, LTYPE, FN, SATMASK)  \
1678a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vn,   \
1679a3ef070eSClaudio Fontana                                 void *vm)                               \
1680a3ef070eSClaudio Fontana     {                                                                   \
1681a3ef070eSClaudio Fontana         LTYPE *d = vd;                                                  \
1682a3ef070eSClaudio Fontana         TYPE *n = vn, *m = vm;                                          \
1683a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1684a3ef070eSClaudio Fontana         unsigned le;                                                    \
1685a3ef070eSClaudio Fontana         bool qc = false;                                                \
1686a3ef070eSClaudio Fontana         for (le = 0; le < 16 / LESIZE; le++, mask >>= LESIZE) {         \
1687a3ef070eSClaudio Fontana             bool sat = false;                                           \
1688a3ef070eSClaudio Fontana             LTYPE op1 = n[H##ESIZE(le * 2 + TOP)];                      \
1689a3ef070eSClaudio Fontana             LTYPE op2 = m[H##ESIZE(le * 2 + TOP)];                      \
1690a3ef070eSClaudio Fontana             mergemask(&d[H##LESIZE(le)], FN(op1, op2, &sat), mask);     \
1691a3ef070eSClaudio Fontana             qc |= sat && (mask & SATMASK);                              \
1692a3ef070eSClaudio Fontana         }                                                               \
1693a3ef070eSClaudio Fontana         if (qc) {                                                       \
1694a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                        \
1695a3ef070eSClaudio Fontana         }                                                               \
1696a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1697a3ef070eSClaudio Fontana     }
1698a3ef070eSClaudio Fontana 
1699a3ef070eSClaudio Fontana DO_2OP_SAT_L(vqdmullbh, 0, 2, int16_t, 4, int32_t, do_qdmullh, SATMASK16B)
1700a3ef070eSClaudio Fontana DO_2OP_SAT_L(vqdmullbw, 0, 4, int32_t, 8, int64_t, do_qdmullw, SATMASK32)
1701a3ef070eSClaudio Fontana DO_2OP_SAT_L(vqdmullth, 1, 2, int16_t, 4, int32_t, do_qdmullh, SATMASK16T)
1702a3ef070eSClaudio Fontana DO_2OP_SAT_L(vqdmulltw, 1, 4, int32_t, 8, int64_t, do_qdmullw, SATMASK32)
1703a3ef070eSClaudio Fontana 
do_vbrsrb(uint32_t n,uint32_t m)1704a3ef070eSClaudio Fontana static inline uint32_t do_vbrsrb(uint32_t n, uint32_t m)
1705a3ef070eSClaudio Fontana {
1706a3ef070eSClaudio Fontana     m &= 0xff;
1707a3ef070eSClaudio Fontana     if (m == 0) {
1708a3ef070eSClaudio Fontana         return 0;
1709a3ef070eSClaudio Fontana     }
1710a3ef070eSClaudio Fontana     n = revbit8(n);
1711a3ef070eSClaudio Fontana     if (m < 8) {
1712a3ef070eSClaudio Fontana         n >>= 8 - m;
1713a3ef070eSClaudio Fontana     }
1714a3ef070eSClaudio Fontana     return n;
1715a3ef070eSClaudio Fontana }
1716a3ef070eSClaudio Fontana 
do_vbrsrh(uint32_t n,uint32_t m)1717a3ef070eSClaudio Fontana static inline uint32_t do_vbrsrh(uint32_t n, uint32_t m)
1718a3ef070eSClaudio Fontana {
1719a3ef070eSClaudio Fontana     m &= 0xff;
1720a3ef070eSClaudio Fontana     if (m == 0) {
1721a3ef070eSClaudio Fontana         return 0;
1722a3ef070eSClaudio Fontana     }
1723a3ef070eSClaudio Fontana     n = revbit16(n);
1724a3ef070eSClaudio Fontana     if (m < 16) {
1725a3ef070eSClaudio Fontana         n >>= 16 - m;
1726a3ef070eSClaudio Fontana     }
1727a3ef070eSClaudio Fontana     return n;
1728a3ef070eSClaudio Fontana }
1729a3ef070eSClaudio Fontana 
do_vbrsrw(uint32_t n,uint32_t m)1730a3ef070eSClaudio Fontana static inline uint32_t do_vbrsrw(uint32_t n, uint32_t m)
1731a3ef070eSClaudio Fontana {
1732a3ef070eSClaudio Fontana     m &= 0xff;
1733a3ef070eSClaudio Fontana     if (m == 0) {
1734a3ef070eSClaudio Fontana         return 0;
1735a3ef070eSClaudio Fontana     }
1736a3ef070eSClaudio Fontana     n = revbit32(n);
1737a3ef070eSClaudio Fontana     if (m < 32) {
1738a3ef070eSClaudio Fontana         n >>= 32 - m;
1739a3ef070eSClaudio Fontana     }
1740a3ef070eSClaudio Fontana     return n;
1741a3ef070eSClaudio Fontana }
1742a3ef070eSClaudio Fontana 
1743a3ef070eSClaudio Fontana DO_2OP_SCALAR(vbrsrb, 1, uint8_t, do_vbrsrb)
1744a3ef070eSClaudio Fontana DO_2OP_SCALAR(vbrsrh, 2, uint16_t, do_vbrsrh)
1745a3ef070eSClaudio Fontana DO_2OP_SCALAR(vbrsrw, 4, uint32_t, do_vbrsrw)
1746a3ef070eSClaudio Fontana 
1747a3ef070eSClaudio Fontana /*
1748a3ef070eSClaudio Fontana  * Multiply add long dual accumulate ops.
1749a3ef070eSClaudio Fontana  */
1750a3ef070eSClaudio Fontana #define DO_LDAV(OP, ESIZE, TYPE, XCHG, EVENACC, ODDACC)                 \
1751a3ef070eSClaudio Fontana     uint64_t HELPER(glue(mve_, OP))(CPUARMState *env, void *vn,         \
1752a3ef070eSClaudio Fontana                                     void *vm, uint64_t a)               \
1753a3ef070eSClaudio Fontana     {                                                                   \
1754a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1755a3ef070eSClaudio Fontana         unsigned e;                                                     \
1756a3ef070eSClaudio Fontana         TYPE *n = vn, *m = vm;                                          \
1757a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
1758a3ef070eSClaudio Fontana             if (mask & 1) {                                             \
1759a3ef070eSClaudio Fontana                 if (e & 1) {                                            \
1760a3ef070eSClaudio Fontana                     a ODDACC                                            \
1761a3ef070eSClaudio Fontana                         (int64_t)n[H##ESIZE(e - 1 * XCHG)] * m[H##ESIZE(e)]; \
1762a3ef070eSClaudio Fontana                 } else {                                                \
1763a3ef070eSClaudio Fontana                     a EVENACC                                           \
1764a3ef070eSClaudio Fontana                         (int64_t)n[H##ESIZE(e + 1 * XCHG)] * m[H##ESIZE(e)]; \
1765a3ef070eSClaudio Fontana                 }                                                       \
1766a3ef070eSClaudio Fontana             }                                                           \
1767a3ef070eSClaudio Fontana         }                                                               \
1768a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1769a3ef070eSClaudio Fontana         return a;                                                       \
1770a3ef070eSClaudio Fontana     }
1771a3ef070eSClaudio Fontana 
1772a3ef070eSClaudio Fontana DO_LDAV(vmlaldavsh, 2, int16_t, false, +=, +=)
1773a3ef070eSClaudio Fontana DO_LDAV(vmlaldavxsh, 2, int16_t, true, +=, +=)
1774a3ef070eSClaudio Fontana DO_LDAV(vmlaldavsw, 4, int32_t, false, +=, +=)
1775a3ef070eSClaudio Fontana DO_LDAV(vmlaldavxsw, 4, int32_t, true, +=, +=)
1776a3ef070eSClaudio Fontana 
1777a3ef070eSClaudio Fontana DO_LDAV(vmlaldavuh, 2, uint16_t, false, +=, +=)
1778a3ef070eSClaudio Fontana DO_LDAV(vmlaldavuw, 4, uint32_t, false, +=, +=)
1779a3ef070eSClaudio Fontana 
1780a3ef070eSClaudio Fontana DO_LDAV(vmlsldavsh, 2, int16_t, false, +=, -=)
1781a3ef070eSClaudio Fontana DO_LDAV(vmlsldavxsh, 2, int16_t, true, +=, -=)
1782a3ef070eSClaudio Fontana DO_LDAV(vmlsldavsw, 4, int32_t, false, +=, -=)
1783a3ef070eSClaudio Fontana DO_LDAV(vmlsldavxsw, 4, int32_t, true, +=, -=)
1784a3ef070eSClaudio Fontana 
1785a3ef070eSClaudio Fontana /*
1786a3ef070eSClaudio Fontana  * Multiply add dual accumulate ops
1787a3ef070eSClaudio Fontana  */
1788a3ef070eSClaudio Fontana #define DO_DAV(OP, ESIZE, TYPE, XCHG, EVENACC, ODDACC) \
1789a3ef070eSClaudio Fontana     uint32_t HELPER(glue(mve_, OP))(CPUARMState *env, void *vn,         \
1790a3ef070eSClaudio Fontana                                     void *vm, uint32_t a)               \
1791a3ef070eSClaudio Fontana     {                                                                   \
1792a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1793a3ef070eSClaudio Fontana         unsigned e;                                                     \
1794a3ef070eSClaudio Fontana         TYPE *n = vn, *m = vm;                                          \
1795a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
1796a3ef070eSClaudio Fontana             if (mask & 1) {                                             \
1797a3ef070eSClaudio Fontana                 if (e & 1) {                                            \
1798a3ef070eSClaudio Fontana                     a ODDACC                                            \
1799a3ef070eSClaudio Fontana                         n[H##ESIZE(e - 1 * XCHG)] * m[H##ESIZE(e)];     \
1800a3ef070eSClaudio Fontana                 } else {                                                \
1801a3ef070eSClaudio Fontana                     a EVENACC                                           \
1802a3ef070eSClaudio Fontana                         n[H##ESIZE(e + 1 * XCHG)] * m[H##ESIZE(e)];     \
1803a3ef070eSClaudio Fontana                 }                                                       \
1804a3ef070eSClaudio Fontana             }                                                           \
1805a3ef070eSClaudio Fontana         }                                                               \
1806a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1807a3ef070eSClaudio Fontana         return a;                                                       \
1808a3ef070eSClaudio Fontana     }
1809a3ef070eSClaudio Fontana 
1810a3ef070eSClaudio Fontana #define DO_DAV_S(INSN, XCHG, EVENACC, ODDACC)           \
1811a3ef070eSClaudio Fontana     DO_DAV(INSN##b, 1, int8_t, XCHG, EVENACC, ODDACC)   \
1812a3ef070eSClaudio Fontana     DO_DAV(INSN##h, 2, int16_t, XCHG, EVENACC, ODDACC)  \
1813a3ef070eSClaudio Fontana     DO_DAV(INSN##w, 4, int32_t, XCHG, EVENACC, ODDACC)
1814a3ef070eSClaudio Fontana 
1815a3ef070eSClaudio Fontana #define DO_DAV_U(INSN, XCHG, EVENACC, ODDACC)           \
1816a3ef070eSClaudio Fontana     DO_DAV(INSN##b, 1, uint8_t, XCHG, EVENACC, ODDACC)  \
1817a3ef070eSClaudio Fontana     DO_DAV(INSN##h, 2, uint16_t, XCHG, EVENACC, ODDACC) \
1818a3ef070eSClaudio Fontana     DO_DAV(INSN##w, 4, uint32_t, XCHG, EVENACC, ODDACC)
1819a3ef070eSClaudio Fontana 
1820a3ef070eSClaudio Fontana DO_DAV_S(vmladavs, false, +=, +=)
1821a3ef070eSClaudio Fontana DO_DAV_U(vmladavu, false, +=, +=)
1822a3ef070eSClaudio Fontana DO_DAV_S(vmlsdav, false, +=, -=)
1823a3ef070eSClaudio Fontana DO_DAV_S(vmladavsx, true, +=, +=)
1824a3ef070eSClaudio Fontana DO_DAV_S(vmlsdavx, true, +=, -=)
1825a3ef070eSClaudio Fontana 
1826a3ef070eSClaudio Fontana /*
1827a3ef070eSClaudio Fontana  * Rounding multiply add long dual accumulate high. In the pseudocode
1828a3ef070eSClaudio Fontana  * this is implemented with a 72-bit internal accumulator value of which
1829a3ef070eSClaudio Fontana  * the top 64 bits are returned. We optimize this to avoid having to
1830a3ef070eSClaudio Fontana  * use 128-bit arithmetic -- we can do this because the 74-bit accumulator
1831a3ef070eSClaudio Fontana  * is squashed back into 64-bits after each beat.
1832a3ef070eSClaudio Fontana  */
1833a3ef070eSClaudio Fontana #define DO_LDAVH(OP, TYPE, LTYPE, XCHG, SUB)                            \
1834a3ef070eSClaudio Fontana     uint64_t HELPER(glue(mve_, OP))(CPUARMState *env, void *vn,         \
1835a3ef070eSClaudio Fontana                                     void *vm, uint64_t a)               \
1836a3ef070eSClaudio Fontana     {                                                                   \
1837a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
1838a3ef070eSClaudio Fontana         unsigned e;                                                     \
1839a3ef070eSClaudio Fontana         TYPE *n = vn, *m = vm;                                          \
1840a3ef070eSClaudio Fontana         for (e = 0; e < 16 / 4; e++, mask >>= 4) {                      \
1841a3ef070eSClaudio Fontana             if (mask & 1) {                                             \
1842a3ef070eSClaudio Fontana                 LTYPE mul;                                              \
1843a3ef070eSClaudio Fontana                 if (e & 1) {                                            \
1844a3ef070eSClaudio Fontana                     mul = (LTYPE)n[H4(e - 1 * XCHG)] * m[H4(e)];        \
1845a3ef070eSClaudio Fontana                     if (SUB) {                                          \
1846a3ef070eSClaudio Fontana                         mul = -mul;                                     \
1847a3ef070eSClaudio Fontana                     }                                                   \
1848a3ef070eSClaudio Fontana                 } else {                                                \
1849a3ef070eSClaudio Fontana                     mul = (LTYPE)n[H4(e + 1 * XCHG)] * m[H4(e)];        \
1850a3ef070eSClaudio Fontana                 }                                                       \
1851a3ef070eSClaudio Fontana                 mul = (mul >> 8) + ((mul >> 7) & 1);                    \
1852a3ef070eSClaudio Fontana                 a += mul;                                               \
1853a3ef070eSClaudio Fontana             }                                                           \
1854a3ef070eSClaudio Fontana         }                                                               \
1855a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
1856a3ef070eSClaudio Fontana         return a;                                                       \
1857a3ef070eSClaudio Fontana     }
1858a3ef070eSClaudio Fontana 
DO_LDAVH(vrmlaldavhsw,int32_t,int64_t,false,false)1859a3ef070eSClaudio Fontana DO_LDAVH(vrmlaldavhsw, int32_t, int64_t, false, false)
1860a3ef070eSClaudio Fontana DO_LDAVH(vrmlaldavhxsw, int32_t, int64_t, true, false)
1861a3ef070eSClaudio Fontana 
1862a3ef070eSClaudio Fontana DO_LDAVH(vrmlaldavhuw, uint32_t, uint64_t, false, false)
1863a3ef070eSClaudio Fontana 
1864a3ef070eSClaudio Fontana DO_LDAVH(vrmlsldavhsw, int32_t, int64_t, false, true)
1865a3ef070eSClaudio Fontana DO_LDAVH(vrmlsldavhxsw, int32_t, int64_t, true, true)
1866a3ef070eSClaudio Fontana 
1867a3ef070eSClaudio Fontana /* Vector add across vector */
1868a3ef070eSClaudio Fontana #define DO_VADDV(OP, ESIZE, TYPE)                               \
1869a3ef070eSClaudio Fontana     uint32_t HELPER(glue(mve_, OP))(CPUARMState *env, void *vm, \
1870a3ef070eSClaudio Fontana                                     uint32_t ra)                \
1871a3ef070eSClaudio Fontana     {                                                           \
1872a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
1873a3ef070eSClaudio Fontana         unsigned e;                                             \
1874a3ef070eSClaudio Fontana         TYPE *m = vm;                                           \
1875a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {      \
1876a3ef070eSClaudio Fontana             if (mask & 1) {                                     \
1877a3ef070eSClaudio Fontana                 ra += m[H##ESIZE(e)];                           \
1878a3ef070eSClaudio Fontana             }                                                   \
1879a3ef070eSClaudio Fontana         }                                                       \
1880a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
1881a3ef070eSClaudio Fontana         return ra;                                              \
1882a3ef070eSClaudio Fontana     }                                                           \
1883a3ef070eSClaudio Fontana 
1884a3ef070eSClaudio Fontana DO_VADDV(vaddvsb, 1, int8_t)
1885a3ef070eSClaudio Fontana DO_VADDV(vaddvsh, 2, int16_t)
1886a3ef070eSClaudio Fontana DO_VADDV(vaddvsw, 4, int32_t)
1887a3ef070eSClaudio Fontana DO_VADDV(vaddvub, 1, uint8_t)
1888a3ef070eSClaudio Fontana DO_VADDV(vaddvuh, 2, uint16_t)
1889a3ef070eSClaudio Fontana DO_VADDV(vaddvuw, 4, uint32_t)
1890a3ef070eSClaudio Fontana 
1891a3ef070eSClaudio Fontana /*
1892a3ef070eSClaudio Fontana  * Vector max/min across vector. Unlike VADDV, we must
1893a3ef070eSClaudio Fontana  * read ra as the element size, not its full width.
1894a3ef070eSClaudio Fontana  * We work with int64_t internally for simplicity.
1895a3ef070eSClaudio Fontana  */
1896a3ef070eSClaudio Fontana #define DO_VMAXMINV(OP, ESIZE, TYPE, RATYPE, FN)                \
1897a3ef070eSClaudio Fontana     uint32_t HELPER(glue(mve_, OP))(CPUARMState *env, void *vm, \
1898a3ef070eSClaudio Fontana                                     uint32_t ra_in)             \
1899a3ef070eSClaudio Fontana     {                                                           \
1900a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
1901a3ef070eSClaudio Fontana         unsigned e;                                             \
1902a3ef070eSClaudio Fontana         TYPE *m = vm;                                           \
1903a3ef070eSClaudio Fontana         int64_t ra = (RATYPE)ra_in;                             \
1904a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {      \
1905a3ef070eSClaudio Fontana             if (mask & 1) {                                     \
1906a3ef070eSClaudio Fontana                 ra = FN(ra, m[H##ESIZE(e)]);                    \
1907a3ef070eSClaudio Fontana             }                                                   \
1908a3ef070eSClaudio Fontana         }                                                       \
1909a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
1910a3ef070eSClaudio Fontana         return ra;                                              \
1911a3ef070eSClaudio Fontana     }                                                           \
1912a3ef070eSClaudio Fontana 
1913a3ef070eSClaudio Fontana #define DO_VMAXMINV_U(INSN, FN)                         \
1914a3ef070eSClaudio Fontana     DO_VMAXMINV(INSN##b, 1, uint8_t, uint8_t, FN)       \
1915a3ef070eSClaudio Fontana     DO_VMAXMINV(INSN##h, 2, uint16_t, uint16_t, FN)     \
1916a3ef070eSClaudio Fontana     DO_VMAXMINV(INSN##w, 4, uint32_t, uint32_t, FN)
1917a3ef070eSClaudio Fontana #define DO_VMAXMINV_S(INSN, FN)                         \
1918a3ef070eSClaudio Fontana     DO_VMAXMINV(INSN##b, 1, int8_t, int8_t, FN)         \
1919a3ef070eSClaudio Fontana     DO_VMAXMINV(INSN##h, 2, int16_t, int16_t, FN)       \
1920a3ef070eSClaudio Fontana     DO_VMAXMINV(INSN##w, 4, int32_t, int32_t, FN)
1921a3ef070eSClaudio Fontana 
1922a3ef070eSClaudio Fontana /*
1923a3ef070eSClaudio Fontana  * Helpers for max and min of absolute values across vector:
1924a3ef070eSClaudio Fontana  * note that we only take the absolute value of 'm', not 'n'
1925a3ef070eSClaudio Fontana  */
1926a3ef070eSClaudio Fontana static int64_t do_maxa(int64_t n, int64_t m)
1927a3ef070eSClaudio Fontana {
1928a3ef070eSClaudio Fontana     if (m < 0) {
1929a3ef070eSClaudio Fontana         m = -m;
1930a3ef070eSClaudio Fontana     }
1931a3ef070eSClaudio Fontana     return MAX(n, m);
1932a3ef070eSClaudio Fontana }
1933a3ef070eSClaudio Fontana 
do_mina(int64_t n,int64_t m)1934a3ef070eSClaudio Fontana static int64_t do_mina(int64_t n, int64_t m)
1935a3ef070eSClaudio Fontana {
1936a3ef070eSClaudio Fontana     if (m < 0) {
1937a3ef070eSClaudio Fontana         m = -m;
1938a3ef070eSClaudio Fontana     }
1939a3ef070eSClaudio Fontana     return MIN(n, m);
1940a3ef070eSClaudio Fontana }
1941a3ef070eSClaudio Fontana 
DO_VMAXMINV_S(vmaxvs,DO_MAX)1942a3ef070eSClaudio Fontana DO_VMAXMINV_S(vmaxvs, DO_MAX)
1943a3ef070eSClaudio Fontana DO_VMAXMINV_U(vmaxvu, DO_MAX)
1944a3ef070eSClaudio Fontana DO_VMAXMINV_S(vminvs, DO_MIN)
1945a3ef070eSClaudio Fontana DO_VMAXMINV_U(vminvu, DO_MIN)
1946a3ef070eSClaudio Fontana /*
1947a3ef070eSClaudio Fontana  * VMAXAV, VMINAV treat the general purpose input as unsigned
1948a3ef070eSClaudio Fontana  * and the vector elements as signed.
1949a3ef070eSClaudio Fontana  */
1950a3ef070eSClaudio Fontana DO_VMAXMINV(vmaxavb, 1, int8_t, uint8_t, do_maxa)
1951a3ef070eSClaudio Fontana DO_VMAXMINV(vmaxavh, 2, int16_t, uint16_t, do_maxa)
1952a3ef070eSClaudio Fontana DO_VMAXMINV(vmaxavw, 4, int32_t, uint32_t, do_maxa)
1953a3ef070eSClaudio Fontana DO_VMAXMINV(vminavb, 1, int8_t, uint8_t, do_mina)
1954a3ef070eSClaudio Fontana DO_VMAXMINV(vminavh, 2, int16_t, uint16_t, do_mina)
1955a3ef070eSClaudio Fontana DO_VMAXMINV(vminavw, 4, int32_t, uint32_t, do_mina)
1956a3ef070eSClaudio Fontana 
1957a3ef070eSClaudio Fontana #define DO_VABAV(OP, ESIZE, TYPE)                               \
1958a3ef070eSClaudio Fontana     uint32_t HELPER(glue(mve_, OP))(CPUARMState *env, void *vn, \
1959a3ef070eSClaudio Fontana                                     void *vm, uint32_t ra)      \
1960a3ef070eSClaudio Fontana     {                                                           \
1961a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
1962a3ef070eSClaudio Fontana         unsigned e;                                             \
1963a3ef070eSClaudio Fontana         TYPE *m = vm, *n = vn;                                  \
1964a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {      \
1965a3ef070eSClaudio Fontana             if (mask & 1) {                                     \
1966a3ef070eSClaudio Fontana                 int64_t n0 = n[H##ESIZE(e)];                    \
1967a3ef070eSClaudio Fontana                 int64_t m0 = m[H##ESIZE(e)];                    \
1968a3ef070eSClaudio Fontana                 uint32_t r = n0 >= m0 ? (n0 - m0) : (m0 - n0);  \
1969a3ef070eSClaudio Fontana                 ra += r;                                        \
1970a3ef070eSClaudio Fontana             }                                                   \
1971a3ef070eSClaudio Fontana         }                                                       \
1972a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
1973a3ef070eSClaudio Fontana         return ra;                                              \
1974a3ef070eSClaudio Fontana     }
1975a3ef070eSClaudio Fontana 
1976a3ef070eSClaudio Fontana DO_VABAV(vabavsb, 1, int8_t)
1977a3ef070eSClaudio Fontana DO_VABAV(vabavsh, 2, int16_t)
1978a3ef070eSClaudio Fontana DO_VABAV(vabavsw, 4, int32_t)
1979a3ef070eSClaudio Fontana DO_VABAV(vabavub, 1, uint8_t)
1980a3ef070eSClaudio Fontana DO_VABAV(vabavuh, 2, uint16_t)
1981a3ef070eSClaudio Fontana DO_VABAV(vabavuw, 4, uint32_t)
1982a3ef070eSClaudio Fontana 
1983a3ef070eSClaudio Fontana #define DO_VADDLV(OP, TYPE, LTYPE)                              \
1984a3ef070eSClaudio Fontana     uint64_t HELPER(glue(mve_, OP))(CPUARMState *env, void *vm, \
1985a3ef070eSClaudio Fontana                                     uint64_t ra)                \
1986a3ef070eSClaudio Fontana     {                                                           \
1987a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
1988a3ef070eSClaudio Fontana         unsigned e;                                             \
1989a3ef070eSClaudio Fontana         TYPE *m = vm;                                           \
1990a3ef070eSClaudio Fontana         for (e = 0; e < 16 / 4; e++, mask >>= 4) {              \
1991a3ef070eSClaudio Fontana             if (mask & 1) {                                     \
1992a3ef070eSClaudio Fontana                 ra += (LTYPE)m[H4(e)];                          \
1993a3ef070eSClaudio Fontana             }                                                   \
1994a3ef070eSClaudio Fontana         }                                                       \
1995a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
1996a3ef070eSClaudio Fontana         return ra;                                              \
1997a3ef070eSClaudio Fontana     }                                                           \
1998a3ef070eSClaudio Fontana 
1999a3ef070eSClaudio Fontana DO_VADDLV(vaddlv_s, int32_t, int64_t)
2000a3ef070eSClaudio Fontana DO_VADDLV(vaddlv_u, uint32_t, uint64_t)
2001a3ef070eSClaudio Fontana 
2002a3ef070eSClaudio Fontana /* Shifts by immediate */
2003a3ef070eSClaudio Fontana #define DO_2SHIFT(OP, ESIZE, TYPE, FN)                          \
2004a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd,     \
2005a3ef070eSClaudio Fontana                                 void *vm, uint32_t shift)       \
2006a3ef070eSClaudio Fontana     {                                                           \
2007a3ef070eSClaudio Fontana         TYPE *d = vd, *m = vm;                                  \
2008a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
2009a3ef070eSClaudio Fontana         unsigned e;                                             \
2010a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {      \
2011a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)],                          \
2012a3ef070eSClaudio Fontana                       FN(m[H##ESIZE(e)], shift), mask);         \
2013a3ef070eSClaudio Fontana         }                                                       \
2014a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
2015a3ef070eSClaudio Fontana     }
2016a3ef070eSClaudio Fontana 
2017a3ef070eSClaudio Fontana #define DO_2SHIFT_SAT(OP, ESIZE, TYPE, FN)                      \
2018a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd,     \
2019a3ef070eSClaudio Fontana                                 void *vm, uint32_t shift)       \
2020a3ef070eSClaudio Fontana     {                                                           \
2021a3ef070eSClaudio Fontana         TYPE *d = vd, *m = vm;                                  \
2022a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
2023a3ef070eSClaudio Fontana         unsigned e;                                             \
2024a3ef070eSClaudio Fontana         bool qc = false;                                        \
2025a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {      \
2026a3ef070eSClaudio Fontana             bool sat = false;                                   \
2027a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)],                          \
2028a3ef070eSClaudio Fontana                       FN(m[H##ESIZE(e)], shift, &sat), mask);   \
2029a3ef070eSClaudio Fontana             qc |= sat & mask & 1;                               \
2030a3ef070eSClaudio Fontana         }                                                       \
2031a3ef070eSClaudio Fontana         if (qc) {                                               \
2032a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                \
2033a3ef070eSClaudio Fontana         }                                                       \
2034a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
2035a3ef070eSClaudio Fontana     }
2036a3ef070eSClaudio Fontana 
2037a3ef070eSClaudio Fontana /* provide unsigned 2-op shift helpers for all sizes */
2038a3ef070eSClaudio Fontana #define DO_2SHIFT_U(OP, FN)                     \
2039a3ef070eSClaudio Fontana     DO_2SHIFT(OP##b, 1, uint8_t, FN)            \
2040a3ef070eSClaudio Fontana     DO_2SHIFT(OP##h, 2, uint16_t, FN)           \
2041a3ef070eSClaudio Fontana     DO_2SHIFT(OP##w, 4, uint32_t, FN)
2042a3ef070eSClaudio Fontana #define DO_2SHIFT_S(OP, FN)                     \
2043a3ef070eSClaudio Fontana     DO_2SHIFT(OP##b, 1, int8_t, FN)             \
2044a3ef070eSClaudio Fontana     DO_2SHIFT(OP##h, 2, int16_t, FN)            \
2045a3ef070eSClaudio Fontana     DO_2SHIFT(OP##w, 4, int32_t, FN)
2046a3ef070eSClaudio Fontana 
2047a3ef070eSClaudio Fontana #define DO_2SHIFT_SAT_U(OP, FN)                 \
2048a3ef070eSClaudio Fontana     DO_2SHIFT_SAT(OP##b, 1, uint8_t, FN)        \
2049a3ef070eSClaudio Fontana     DO_2SHIFT_SAT(OP##h, 2, uint16_t, FN)       \
2050a3ef070eSClaudio Fontana     DO_2SHIFT_SAT(OP##w, 4, uint32_t, FN)
2051a3ef070eSClaudio Fontana #define DO_2SHIFT_SAT_S(OP, FN)                 \
2052a3ef070eSClaudio Fontana     DO_2SHIFT_SAT(OP##b, 1, int8_t, FN)         \
2053a3ef070eSClaudio Fontana     DO_2SHIFT_SAT(OP##h, 2, int16_t, FN)        \
2054a3ef070eSClaudio Fontana     DO_2SHIFT_SAT(OP##w, 4, int32_t, FN)
2055a3ef070eSClaudio Fontana 
2056a3ef070eSClaudio Fontana DO_2SHIFT_U(vshli_u, DO_VSHLU)
2057a3ef070eSClaudio Fontana DO_2SHIFT_S(vshli_s, DO_VSHLS)
2058a3ef070eSClaudio Fontana DO_2SHIFT_SAT_U(vqshli_u, DO_UQSHL_OP)
2059a3ef070eSClaudio Fontana DO_2SHIFT_SAT_S(vqshli_s, DO_SQSHL_OP)
2060a3ef070eSClaudio Fontana DO_2SHIFT_SAT_S(vqshlui_s, DO_SUQSHL_OP)
2061a3ef070eSClaudio Fontana DO_2SHIFT_U(vrshli_u, DO_VRSHLU)
2062a3ef070eSClaudio Fontana DO_2SHIFT_S(vrshli_s, DO_VRSHLS)
2063a3ef070eSClaudio Fontana DO_2SHIFT_SAT_U(vqrshli_u, DO_UQRSHL_OP)
2064a3ef070eSClaudio Fontana DO_2SHIFT_SAT_S(vqrshli_s, DO_SQRSHL_OP)
2065a3ef070eSClaudio Fontana 
2066a3ef070eSClaudio Fontana /* Shift-and-insert; we always work with 64 bits at a time */
2067a3ef070eSClaudio Fontana #define DO_2SHIFT_INSERT(OP, ESIZE, SHIFTFN, MASKFN)                    \
2068a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd,             \
2069a3ef070eSClaudio Fontana                                 void *vm, uint32_t shift)               \
2070a3ef070eSClaudio Fontana     {                                                                   \
2071a3ef070eSClaudio Fontana         uint64_t *d = vd, *m = vm;                                      \
2072a3ef070eSClaudio Fontana         uint16_t mask;                                                  \
2073a3ef070eSClaudio Fontana         uint64_t shiftmask;                                             \
2074a3ef070eSClaudio Fontana         unsigned e;                                                     \
2075a3ef070eSClaudio Fontana         if (shift == ESIZE * 8) {                                       \
2076a3ef070eSClaudio Fontana             /*                                                          \
2077a3ef070eSClaudio Fontana              * Only VSRI can shift by <dt>; it should mean "don't       \
2078a3ef070eSClaudio Fontana              * update the destination". The generic logic can't handle  \
2079a3ef070eSClaudio Fontana              * this because it would try to shift by an out-of-range    \
2080a3ef070eSClaudio Fontana              * amount, so special case it here.                         \
2081a3ef070eSClaudio Fontana              */                                                         \
2082a3ef070eSClaudio Fontana             goto done;                                                  \
2083a3ef070eSClaudio Fontana         }                                                               \
2084a3ef070eSClaudio Fontana         assert(shift < ESIZE * 8);                                      \
2085a3ef070eSClaudio Fontana         mask = mve_element_mask(env);                                   \
2086a3ef070eSClaudio Fontana         /* ESIZE / 2 gives the MO_* value if ESIZE is in [1,2,4] */     \
2087a3ef070eSClaudio Fontana         shiftmask = dup_const(ESIZE / 2, MASKFN(ESIZE * 8, shift));     \
2088a3ef070eSClaudio Fontana         for (e = 0; e < 16 / 8; e++, mask >>= 8) {                      \
2089a3ef070eSClaudio Fontana             uint64_t r = (SHIFTFN(m[H8(e)], shift) & shiftmask) |       \
2090a3ef070eSClaudio Fontana                 (d[H8(e)] & ~shiftmask);                                \
2091a3ef070eSClaudio Fontana             mergemask(&d[H8(e)], r, mask);                              \
2092a3ef070eSClaudio Fontana         }                                                               \
2093a3ef070eSClaudio Fontana done:                                                                   \
2094a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2095a3ef070eSClaudio Fontana     }
2096a3ef070eSClaudio Fontana 
2097a3ef070eSClaudio Fontana #define DO_SHL(N, SHIFT) ((N) << (SHIFT))
2098a3ef070eSClaudio Fontana #define DO_SHR(N, SHIFT) ((N) >> (SHIFT))
2099a3ef070eSClaudio Fontana #define SHL_MASK(EBITS, SHIFT) MAKE_64BIT_MASK((SHIFT), (EBITS) - (SHIFT))
2100a3ef070eSClaudio Fontana #define SHR_MASK(EBITS, SHIFT) MAKE_64BIT_MASK(0, (EBITS) - (SHIFT))
2101a3ef070eSClaudio Fontana 
2102a3ef070eSClaudio Fontana DO_2SHIFT_INSERT(vsrib, 1, DO_SHR, SHR_MASK)
2103a3ef070eSClaudio Fontana DO_2SHIFT_INSERT(vsrih, 2, DO_SHR, SHR_MASK)
2104a3ef070eSClaudio Fontana DO_2SHIFT_INSERT(vsriw, 4, DO_SHR, SHR_MASK)
2105a3ef070eSClaudio Fontana DO_2SHIFT_INSERT(vslib, 1, DO_SHL, SHL_MASK)
2106a3ef070eSClaudio Fontana DO_2SHIFT_INSERT(vslih, 2, DO_SHL, SHL_MASK)
2107a3ef070eSClaudio Fontana DO_2SHIFT_INSERT(vsliw, 4, DO_SHL, SHL_MASK)
2108a3ef070eSClaudio Fontana 
2109a3ef070eSClaudio Fontana /*
2110a3ef070eSClaudio Fontana  * Long shifts taking half-sized inputs from top or bottom of the input
2111a3ef070eSClaudio Fontana  * vector and producing a double-width result. ESIZE, TYPE are for
2112a3ef070eSClaudio Fontana  * the input, and LESIZE, LTYPE for the output.
2113a3ef070eSClaudio Fontana  * Unlike the normal shift helpers, we do not handle negative shift counts,
2114a3ef070eSClaudio Fontana  * because the long shift is strictly left-only.
2115a3ef070eSClaudio Fontana  */
2116a3ef070eSClaudio Fontana #define DO_VSHLL(OP, TOP, ESIZE, TYPE, LESIZE, LTYPE)                   \
2117a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd,             \
2118a3ef070eSClaudio Fontana                                 void *vm, uint32_t shift)               \
2119a3ef070eSClaudio Fontana     {                                                                   \
2120a3ef070eSClaudio Fontana         LTYPE *d = vd;                                                  \
2121a3ef070eSClaudio Fontana         TYPE *m = vm;                                                   \
2122a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2123a3ef070eSClaudio Fontana         unsigned le;                                                    \
2124a3ef070eSClaudio Fontana         assert(shift <= 16);                                            \
2125a3ef070eSClaudio Fontana         for (le = 0; le < 16 / LESIZE; le++, mask >>= LESIZE) {         \
2126a3ef070eSClaudio Fontana             LTYPE r = (LTYPE)m[H##ESIZE(le * 2 + TOP)] << shift;        \
2127a3ef070eSClaudio Fontana             mergemask(&d[H##LESIZE(le)], r, mask);                      \
2128a3ef070eSClaudio Fontana         }                                                               \
2129a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2130a3ef070eSClaudio Fontana     }
2131a3ef070eSClaudio Fontana 
2132a3ef070eSClaudio Fontana #define DO_VSHLL_ALL(OP, TOP)                                \
2133a3ef070eSClaudio Fontana     DO_VSHLL(OP##sb, TOP, 1, int8_t, 2, int16_t)             \
2134a3ef070eSClaudio Fontana     DO_VSHLL(OP##ub, TOP, 1, uint8_t, 2, uint16_t)           \
2135a3ef070eSClaudio Fontana     DO_VSHLL(OP##sh, TOP, 2, int16_t, 4, int32_t)            \
2136a3ef070eSClaudio Fontana     DO_VSHLL(OP##uh, TOP, 2, uint16_t, 4, uint32_t)          \
2137a3ef070eSClaudio Fontana 
2138a3ef070eSClaudio Fontana DO_VSHLL_ALL(vshllb, false)
2139a3ef070eSClaudio Fontana DO_VSHLL_ALL(vshllt, true)
2140a3ef070eSClaudio Fontana 
2141a3ef070eSClaudio Fontana /*
2142a3ef070eSClaudio Fontana  * Narrowing right shifts, taking a double sized input, shifting it
2143a3ef070eSClaudio Fontana  * and putting the result in either the top or bottom half of the output.
2144a3ef070eSClaudio Fontana  * ESIZE, TYPE are the output, and LESIZE, LTYPE the input.
2145a3ef070eSClaudio Fontana  */
2146a3ef070eSClaudio Fontana #define DO_VSHRN(OP, TOP, ESIZE, TYPE, LESIZE, LTYPE, FN)       \
2147a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd,     \
2148a3ef070eSClaudio Fontana                                 void *vm, uint32_t shift)       \
2149a3ef070eSClaudio Fontana     {                                                           \
2150a3ef070eSClaudio Fontana         LTYPE *m = vm;                                          \
2151a3ef070eSClaudio Fontana         TYPE *d = vd;                                           \
2152a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
2153a3ef070eSClaudio Fontana         unsigned le;                                            \
2154a3ef070eSClaudio Fontana         mask >>= ESIZE * TOP;                                   \
2155a3ef070eSClaudio Fontana         for (le = 0; le < 16 / LESIZE; le++, mask >>= LESIZE) { \
2156a3ef070eSClaudio Fontana             TYPE r = FN(m[H##LESIZE(le)], shift);               \
2157a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(le * 2 + TOP)], r, mask);     \
2158a3ef070eSClaudio Fontana         }                                                       \
2159a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
2160a3ef070eSClaudio Fontana     }
2161a3ef070eSClaudio Fontana 
2162a3ef070eSClaudio Fontana #define DO_VSHRN_ALL(OP, FN)                                    \
2163a3ef070eSClaudio Fontana     DO_VSHRN(OP##bb, false, 1, uint8_t, 2, uint16_t, FN)        \
2164a3ef070eSClaudio Fontana     DO_VSHRN(OP##bh, false, 2, uint16_t, 4, uint32_t, FN)       \
2165a3ef070eSClaudio Fontana     DO_VSHRN(OP##tb, true, 1, uint8_t, 2, uint16_t, FN)         \
2166a3ef070eSClaudio Fontana     DO_VSHRN(OP##th, true, 2, uint16_t, 4, uint32_t, FN)
2167a3ef070eSClaudio Fontana 
2168a3ef070eSClaudio Fontana static inline uint64_t do_urshr(uint64_t x, unsigned sh)
2169a3ef070eSClaudio Fontana {
2170a3ef070eSClaudio Fontana     if (likely(sh < 64)) {
2171a3ef070eSClaudio Fontana         return (x >> sh) + ((x >> (sh - 1)) & 1);
2172a3ef070eSClaudio Fontana     } else if (sh == 64) {
2173a3ef070eSClaudio Fontana         return x >> 63;
2174a3ef070eSClaudio Fontana     } else {
2175a3ef070eSClaudio Fontana         return 0;
2176a3ef070eSClaudio Fontana     }
2177a3ef070eSClaudio Fontana }
2178a3ef070eSClaudio Fontana 
do_srshr(int64_t x,unsigned sh)2179a3ef070eSClaudio Fontana static inline int64_t do_srshr(int64_t x, unsigned sh)
2180a3ef070eSClaudio Fontana {
2181a3ef070eSClaudio Fontana     if (likely(sh < 64)) {
2182a3ef070eSClaudio Fontana         return (x >> sh) + ((x >> (sh - 1)) & 1);
2183a3ef070eSClaudio Fontana     } else {
2184a3ef070eSClaudio Fontana         /* Rounding the sign bit always produces 0. */
2185a3ef070eSClaudio Fontana         return 0;
2186a3ef070eSClaudio Fontana     }
2187a3ef070eSClaudio Fontana }
2188a3ef070eSClaudio Fontana 
DO_VSHRN_ALL(vshrn,DO_SHR)2189a3ef070eSClaudio Fontana DO_VSHRN_ALL(vshrn, DO_SHR)
2190a3ef070eSClaudio Fontana DO_VSHRN_ALL(vrshrn, do_urshr)
2191a3ef070eSClaudio Fontana 
2192a3ef070eSClaudio Fontana static inline int32_t do_sat_bhs(int64_t val, int64_t min, int64_t max,
2193a3ef070eSClaudio Fontana                                  bool *satp)
2194a3ef070eSClaudio Fontana {
2195a3ef070eSClaudio Fontana     if (val > max) {
2196a3ef070eSClaudio Fontana         *satp = true;
2197a3ef070eSClaudio Fontana         return max;
2198a3ef070eSClaudio Fontana     } else if (val < min) {
2199a3ef070eSClaudio Fontana         *satp = true;
2200a3ef070eSClaudio Fontana         return min;
2201a3ef070eSClaudio Fontana     } else {
2202a3ef070eSClaudio Fontana         return val;
2203a3ef070eSClaudio Fontana     }
2204a3ef070eSClaudio Fontana }
2205a3ef070eSClaudio Fontana 
2206a3ef070eSClaudio Fontana /* Saturating narrowing right shifts */
2207a3ef070eSClaudio Fontana #define DO_VSHRN_SAT(OP, TOP, ESIZE, TYPE, LESIZE, LTYPE, FN)   \
2208a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd,     \
2209a3ef070eSClaudio Fontana                                 void *vm, uint32_t shift)       \
2210a3ef070eSClaudio Fontana     {                                                           \
2211a3ef070eSClaudio Fontana         LTYPE *m = vm;                                          \
2212a3ef070eSClaudio Fontana         TYPE *d = vd;                                           \
2213a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
2214a3ef070eSClaudio Fontana         bool qc = false;                                        \
2215a3ef070eSClaudio Fontana         unsigned le;                                            \
2216a3ef070eSClaudio Fontana         mask >>= ESIZE * TOP;                                   \
2217a3ef070eSClaudio Fontana         for (le = 0; le < 16 / LESIZE; le++, mask >>= LESIZE) { \
2218a3ef070eSClaudio Fontana             bool sat = false;                                   \
2219a3ef070eSClaudio Fontana             TYPE r = FN(m[H##LESIZE(le)], shift, &sat);         \
2220a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(le * 2 + TOP)], r, mask);     \
2221a3ef070eSClaudio Fontana             qc |= sat & mask & 1;                               \
2222a3ef070eSClaudio Fontana         }                                                       \
2223a3ef070eSClaudio Fontana         if (qc) {                                               \
2224a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                \
2225a3ef070eSClaudio Fontana         }                                                       \
2226a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
2227a3ef070eSClaudio Fontana     }
2228a3ef070eSClaudio Fontana 
2229a3ef070eSClaudio Fontana #define DO_VSHRN_SAT_UB(BOP, TOP, FN)                           \
2230a3ef070eSClaudio Fontana     DO_VSHRN_SAT(BOP, false, 1, uint8_t, 2, uint16_t, FN)       \
2231a3ef070eSClaudio Fontana     DO_VSHRN_SAT(TOP, true, 1, uint8_t, 2, uint16_t, FN)
2232a3ef070eSClaudio Fontana 
2233a3ef070eSClaudio Fontana #define DO_VSHRN_SAT_UH(BOP, TOP, FN)                           \
2234a3ef070eSClaudio Fontana     DO_VSHRN_SAT(BOP, false, 2, uint16_t, 4, uint32_t, FN)      \
2235a3ef070eSClaudio Fontana     DO_VSHRN_SAT(TOP, true, 2, uint16_t, 4, uint32_t, FN)
2236a3ef070eSClaudio Fontana 
2237a3ef070eSClaudio Fontana #define DO_VSHRN_SAT_SB(BOP, TOP, FN)                           \
2238a3ef070eSClaudio Fontana     DO_VSHRN_SAT(BOP, false, 1, int8_t, 2, int16_t, FN)         \
2239a3ef070eSClaudio Fontana     DO_VSHRN_SAT(TOP, true, 1, int8_t, 2, int16_t, FN)
2240a3ef070eSClaudio Fontana 
2241a3ef070eSClaudio Fontana #define DO_VSHRN_SAT_SH(BOP, TOP, FN)                           \
2242a3ef070eSClaudio Fontana     DO_VSHRN_SAT(BOP, false, 2, int16_t, 4, int32_t, FN)        \
2243a3ef070eSClaudio Fontana     DO_VSHRN_SAT(TOP, true, 2, int16_t, 4, int32_t, FN)
2244a3ef070eSClaudio Fontana 
2245a3ef070eSClaudio Fontana #define DO_SHRN_SB(N, M, SATP)                                  \
2246a3ef070eSClaudio Fontana     do_sat_bhs((int64_t)(N) >> (M), INT8_MIN, INT8_MAX, SATP)
2247a3ef070eSClaudio Fontana #define DO_SHRN_UB(N, M, SATP)                                  \
2248a3ef070eSClaudio Fontana     do_sat_bhs((uint64_t)(N) >> (M), 0, UINT8_MAX, SATP)
2249a3ef070eSClaudio Fontana #define DO_SHRUN_B(N, M, SATP)                                  \
2250a3ef070eSClaudio Fontana     do_sat_bhs((int64_t)(N) >> (M), 0, UINT8_MAX, SATP)
2251a3ef070eSClaudio Fontana 
2252a3ef070eSClaudio Fontana #define DO_SHRN_SH(N, M, SATP)                                  \
2253a3ef070eSClaudio Fontana     do_sat_bhs((int64_t)(N) >> (M), INT16_MIN, INT16_MAX, SATP)
2254a3ef070eSClaudio Fontana #define DO_SHRN_UH(N, M, SATP)                                  \
2255a3ef070eSClaudio Fontana     do_sat_bhs((uint64_t)(N) >> (M), 0, UINT16_MAX, SATP)
2256a3ef070eSClaudio Fontana #define DO_SHRUN_H(N, M, SATP)                                  \
2257a3ef070eSClaudio Fontana     do_sat_bhs((int64_t)(N) >> (M), 0, UINT16_MAX, SATP)
2258a3ef070eSClaudio Fontana 
2259a3ef070eSClaudio Fontana #define DO_RSHRN_SB(N, M, SATP)                                 \
2260a3ef070eSClaudio Fontana     do_sat_bhs(do_srshr(N, M), INT8_MIN, INT8_MAX, SATP)
2261a3ef070eSClaudio Fontana #define DO_RSHRN_UB(N, M, SATP)                                 \
2262a3ef070eSClaudio Fontana     do_sat_bhs(do_urshr(N, M), 0, UINT8_MAX, SATP)
2263a3ef070eSClaudio Fontana #define DO_RSHRUN_B(N, M, SATP)                                 \
2264a3ef070eSClaudio Fontana     do_sat_bhs(do_srshr(N, M), 0, UINT8_MAX, SATP)
2265a3ef070eSClaudio Fontana 
2266a3ef070eSClaudio Fontana #define DO_RSHRN_SH(N, M, SATP)                                 \
2267a3ef070eSClaudio Fontana     do_sat_bhs(do_srshr(N, M), INT16_MIN, INT16_MAX, SATP)
2268a3ef070eSClaudio Fontana #define DO_RSHRN_UH(N, M, SATP)                                 \
2269a3ef070eSClaudio Fontana     do_sat_bhs(do_urshr(N, M), 0, UINT16_MAX, SATP)
2270a3ef070eSClaudio Fontana #define DO_RSHRUN_H(N, M, SATP)                                 \
2271a3ef070eSClaudio Fontana     do_sat_bhs(do_srshr(N, M), 0, UINT16_MAX, SATP)
2272a3ef070eSClaudio Fontana 
DO_VSHRN_SAT_SB(vqshrnb_sb,vqshrnt_sb,DO_SHRN_SB)2273a3ef070eSClaudio Fontana DO_VSHRN_SAT_SB(vqshrnb_sb, vqshrnt_sb, DO_SHRN_SB)
2274a3ef070eSClaudio Fontana DO_VSHRN_SAT_SH(vqshrnb_sh, vqshrnt_sh, DO_SHRN_SH)
2275a3ef070eSClaudio Fontana DO_VSHRN_SAT_UB(vqshrnb_ub, vqshrnt_ub, DO_SHRN_UB)
2276a3ef070eSClaudio Fontana DO_VSHRN_SAT_UH(vqshrnb_uh, vqshrnt_uh, DO_SHRN_UH)
2277a3ef070eSClaudio Fontana DO_VSHRN_SAT_SB(vqshrunbb, vqshruntb, DO_SHRUN_B)
2278a3ef070eSClaudio Fontana DO_VSHRN_SAT_SH(vqshrunbh, vqshrunth, DO_SHRUN_H)
2279a3ef070eSClaudio Fontana 
2280a3ef070eSClaudio Fontana DO_VSHRN_SAT_SB(vqrshrnb_sb, vqrshrnt_sb, DO_RSHRN_SB)
2281a3ef070eSClaudio Fontana DO_VSHRN_SAT_SH(vqrshrnb_sh, vqrshrnt_sh, DO_RSHRN_SH)
2282a3ef070eSClaudio Fontana DO_VSHRN_SAT_UB(vqrshrnb_ub, vqrshrnt_ub, DO_RSHRN_UB)
2283a3ef070eSClaudio Fontana DO_VSHRN_SAT_UH(vqrshrnb_uh, vqrshrnt_uh, DO_RSHRN_UH)
2284a3ef070eSClaudio Fontana DO_VSHRN_SAT_SB(vqrshrunbb, vqrshruntb, DO_RSHRUN_B)
2285a3ef070eSClaudio Fontana DO_VSHRN_SAT_SH(vqrshrunbh, vqrshrunth, DO_RSHRUN_H)
2286a3ef070eSClaudio Fontana 
2287a3ef070eSClaudio Fontana #define DO_VMOVN(OP, TOP, ESIZE, TYPE, LESIZE, LTYPE)                   \
2288a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, void *vm)         \
2289a3ef070eSClaudio Fontana     {                                                                   \
2290a3ef070eSClaudio Fontana         LTYPE *m = vm;                                                  \
2291a3ef070eSClaudio Fontana         TYPE *d = vd;                                                   \
2292a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2293a3ef070eSClaudio Fontana         unsigned le;                                                    \
2294a3ef070eSClaudio Fontana         mask >>= ESIZE * TOP;                                           \
2295a3ef070eSClaudio Fontana         for (le = 0; le < 16 / LESIZE; le++, mask >>= LESIZE) {         \
2296a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(le * 2 + TOP)],                       \
2297a3ef070eSClaudio Fontana                       m[H##LESIZE(le)], mask);                          \
2298a3ef070eSClaudio Fontana         }                                                               \
2299a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2300a3ef070eSClaudio Fontana     }
2301a3ef070eSClaudio Fontana 
2302a3ef070eSClaudio Fontana DO_VMOVN(vmovnbb, false, 1, uint8_t, 2, uint16_t)
2303a3ef070eSClaudio Fontana DO_VMOVN(vmovnbh, false, 2, uint16_t, 4, uint32_t)
2304a3ef070eSClaudio Fontana DO_VMOVN(vmovntb, true, 1, uint8_t, 2, uint16_t)
2305a3ef070eSClaudio Fontana DO_VMOVN(vmovnth, true, 2, uint16_t, 4, uint32_t)
2306a3ef070eSClaudio Fontana 
2307a3ef070eSClaudio Fontana #define DO_VMOVN_SAT(OP, TOP, ESIZE, TYPE, LESIZE, LTYPE, FN)           \
2308a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, void *vm)         \
2309a3ef070eSClaudio Fontana     {                                                                   \
2310a3ef070eSClaudio Fontana         LTYPE *m = vm;                                                  \
2311a3ef070eSClaudio Fontana         TYPE *d = vd;                                                   \
2312a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2313a3ef070eSClaudio Fontana         bool qc = false;                                                \
2314a3ef070eSClaudio Fontana         unsigned le;                                                    \
2315a3ef070eSClaudio Fontana         mask >>= ESIZE * TOP;                                           \
2316a3ef070eSClaudio Fontana         for (le = 0; le < 16 / LESIZE; le++, mask >>= LESIZE) {         \
2317a3ef070eSClaudio Fontana             bool sat = false;                                           \
2318a3ef070eSClaudio Fontana             TYPE r = FN(m[H##LESIZE(le)], &sat);                        \
2319a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(le * 2 + TOP)], r, mask);             \
2320a3ef070eSClaudio Fontana             qc |= sat & mask & 1;                                       \
2321a3ef070eSClaudio Fontana         }                                                               \
2322a3ef070eSClaudio Fontana         if (qc) {                                                       \
2323a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                        \
2324a3ef070eSClaudio Fontana         }                                                               \
2325a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2326a3ef070eSClaudio Fontana     }
2327a3ef070eSClaudio Fontana 
2328a3ef070eSClaudio Fontana #define DO_VMOVN_SAT_UB(BOP, TOP, FN)                           \
2329a3ef070eSClaudio Fontana     DO_VMOVN_SAT(BOP, false, 1, uint8_t, 2, uint16_t, FN)       \
2330a3ef070eSClaudio Fontana     DO_VMOVN_SAT(TOP, true, 1, uint8_t, 2, uint16_t, FN)
2331a3ef070eSClaudio Fontana 
2332a3ef070eSClaudio Fontana #define DO_VMOVN_SAT_UH(BOP, TOP, FN)                           \
2333a3ef070eSClaudio Fontana     DO_VMOVN_SAT(BOP, false, 2, uint16_t, 4, uint32_t, FN)      \
2334a3ef070eSClaudio Fontana     DO_VMOVN_SAT(TOP, true, 2, uint16_t, 4, uint32_t, FN)
2335a3ef070eSClaudio Fontana 
2336a3ef070eSClaudio Fontana #define DO_VMOVN_SAT_SB(BOP, TOP, FN)                           \
2337a3ef070eSClaudio Fontana     DO_VMOVN_SAT(BOP, false, 1, int8_t, 2, int16_t, FN)         \
2338a3ef070eSClaudio Fontana     DO_VMOVN_SAT(TOP, true, 1, int8_t, 2, int16_t, FN)
2339a3ef070eSClaudio Fontana 
2340a3ef070eSClaudio Fontana #define DO_VMOVN_SAT_SH(BOP, TOP, FN)                           \
2341a3ef070eSClaudio Fontana     DO_VMOVN_SAT(BOP, false, 2, int16_t, 4, int32_t, FN)        \
2342a3ef070eSClaudio Fontana     DO_VMOVN_SAT(TOP, true, 2, int16_t, 4, int32_t, FN)
2343a3ef070eSClaudio Fontana 
2344a3ef070eSClaudio Fontana #define DO_VQMOVN_SB(N, SATP)                           \
2345a3ef070eSClaudio Fontana     do_sat_bhs((int64_t)(N), INT8_MIN, INT8_MAX, SATP)
2346a3ef070eSClaudio Fontana #define DO_VQMOVN_UB(N, SATP)                           \
2347a3ef070eSClaudio Fontana     do_sat_bhs((uint64_t)(N), 0, UINT8_MAX, SATP)
2348a3ef070eSClaudio Fontana #define DO_VQMOVUN_B(N, SATP)                           \
2349a3ef070eSClaudio Fontana     do_sat_bhs((int64_t)(N), 0, UINT8_MAX, SATP)
2350a3ef070eSClaudio Fontana 
2351a3ef070eSClaudio Fontana #define DO_VQMOVN_SH(N, SATP)                           \
2352a3ef070eSClaudio Fontana     do_sat_bhs((int64_t)(N), INT16_MIN, INT16_MAX, SATP)
2353a3ef070eSClaudio Fontana #define DO_VQMOVN_UH(N, SATP)                           \
2354a3ef070eSClaudio Fontana     do_sat_bhs((uint64_t)(N), 0, UINT16_MAX, SATP)
2355a3ef070eSClaudio Fontana #define DO_VQMOVUN_H(N, SATP)                           \
2356a3ef070eSClaudio Fontana     do_sat_bhs((int64_t)(N), 0, UINT16_MAX, SATP)
2357a3ef070eSClaudio Fontana 
2358a3ef070eSClaudio Fontana DO_VMOVN_SAT_SB(vqmovnbsb, vqmovntsb, DO_VQMOVN_SB)
2359a3ef070eSClaudio Fontana DO_VMOVN_SAT_SH(vqmovnbsh, vqmovntsh, DO_VQMOVN_SH)
2360a3ef070eSClaudio Fontana DO_VMOVN_SAT_UB(vqmovnbub, vqmovntub, DO_VQMOVN_UB)
2361a3ef070eSClaudio Fontana DO_VMOVN_SAT_UH(vqmovnbuh, vqmovntuh, DO_VQMOVN_UH)
2362a3ef070eSClaudio Fontana DO_VMOVN_SAT_SB(vqmovunbb, vqmovuntb, DO_VQMOVUN_B)
2363a3ef070eSClaudio Fontana DO_VMOVN_SAT_SH(vqmovunbh, vqmovunth, DO_VQMOVUN_H)
2364a3ef070eSClaudio Fontana 
2365a3ef070eSClaudio Fontana uint32_t HELPER(mve_vshlc)(CPUARMState *env, void *vd, uint32_t rdm,
2366a3ef070eSClaudio Fontana                            uint32_t shift)
2367a3ef070eSClaudio Fontana {
2368a3ef070eSClaudio Fontana     uint32_t *d = vd;
2369a3ef070eSClaudio Fontana     uint16_t mask = mve_element_mask(env);
2370a3ef070eSClaudio Fontana     unsigned e;
2371a3ef070eSClaudio Fontana     uint32_t r;
2372a3ef070eSClaudio Fontana 
2373a3ef070eSClaudio Fontana     /*
2374a3ef070eSClaudio Fontana      * For each 32-bit element, we shift it left, bringing in the
2375a3ef070eSClaudio Fontana      * low 'shift' bits of rdm at the bottom. Bits shifted out at
2376a3ef070eSClaudio Fontana      * the top become the new rdm, if the predicate mask permits.
2377a3ef070eSClaudio Fontana      * The final rdm value is returned to update the register.
2378a3ef070eSClaudio Fontana      * shift == 0 here means "shift by 32 bits".
2379a3ef070eSClaudio Fontana      */
2380a3ef070eSClaudio Fontana     if (shift == 0) {
2381a3ef070eSClaudio Fontana         for (e = 0; e < 16 / 4; e++, mask >>= 4) {
2382a3ef070eSClaudio Fontana             r = rdm;
2383a3ef070eSClaudio Fontana             if (mask & 1) {
2384a3ef070eSClaudio Fontana                 rdm = d[H4(e)];
2385a3ef070eSClaudio Fontana             }
2386a3ef070eSClaudio Fontana             mergemask(&d[H4(e)], r, mask);
2387a3ef070eSClaudio Fontana         }
2388a3ef070eSClaudio Fontana     } else {
2389a3ef070eSClaudio Fontana         uint32_t shiftmask = MAKE_64BIT_MASK(0, shift);
2390a3ef070eSClaudio Fontana 
2391a3ef070eSClaudio Fontana         for (e = 0; e < 16 / 4; e++, mask >>= 4) {
2392a3ef070eSClaudio Fontana             r = (d[H4(e)] << shift) | (rdm & shiftmask);
2393a3ef070eSClaudio Fontana             if (mask & 1) {
2394a3ef070eSClaudio Fontana                 rdm = d[H4(e)] >> (32 - shift);
2395a3ef070eSClaudio Fontana             }
2396a3ef070eSClaudio Fontana             mergemask(&d[H4(e)], r, mask);
2397a3ef070eSClaudio Fontana         }
2398a3ef070eSClaudio Fontana     }
2399a3ef070eSClaudio Fontana     mve_advance_vpt(env);
2400a3ef070eSClaudio Fontana     return rdm;
2401a3ef070eSClaudio Fontana }
2402a3ef070eSClaudio Fontana 
HELPER(mve_sshrl)2403a3ef070eSClaudio Fontana uint64_t HELPER(mve_sshrl)(CPUARMState *env, uint64_t n, uint32_t shift)
2404a3ef070eSClaudio Fontana {
2405a3ef070eSClaudio Fontana     return do_sqrshl_d(n, -(int8_t)shift, false, NULL);
2406a3ef070eSClaudio Fontana }
2407a3ef070eSClaudio Fontana 
HELPER(mve_ushll)2408a3ef070eSClaudio Fontana uint64_t HELPER(mve_ushll)(CPUARMState *env, uint64_t n, uint32_t shift)
2409a3ef070eSClaudio Fontana {
2410a3ef070eSClaudio Fontana     return do_uqrshl_d(n, (int8_t)shift, false, NULL);
2411a3ef070eSClaudio Fontana }
2412a3ef070eSClaudio Fontana 
HELPER(mve_sqshll)2413a3ef070eSClaudio Fontana uint64_t HELPER(mve_sqshll)(CPUARMState *env, uint64_t n, uint32_t shift)
2414a3ef070eSClaudio Fontana {
2415a3ef070eSClaudio Fontana     return do_sqrshl_d(n, (int8_t)shift, false, &env->QF);
2416a3ef070eSClaudio Fontana }
2417a3ef070eSClaudio Fontana 
HELPER(mve_uqshll)2418a3ef070eSClaudio Fontana uint64_t HELPER(mve_uqshll)(CPUARMState *env, uint64_t n, uint32_t shift)
2419a3ef070eSClaudio Fontana {
2420a3ef070eSClaudio Fontana     return do_uqrshl_d(n, (int8_t)shift, false, &env->QF);
2421a3ef070eSClaudio Fontana }
2422a3ef070eSClaudio Fontana 
HELPER(mve_sqrshrl)2423a3ef070eSClaudio Fontana uint64_t HELPER(mve_sqrshrl)(CPUARMState *env, uint64_t n, uint32_t shift)
2424a3ef070eSClaudio Fontana {
2425a3ef070eSClaudio Fontana     return do_sqrshl_d(n, -(int8_t)shift, true, &env->QF);
2426a3ef070eSClaudio Fontana }
2427a3ef070eSClaudio Fontana 
HELPER(mve_uqrshll)2428a3ef070eSClaudio Fontana uint64_t HELPER(mve_uqrshll)(CPUARMState *env, uint64_t n, uint32_t shift)
2429a3ef070eSClaudio Fontana {
2430a3ef070eSClaudio Fontana     return do_uqrshl_d(n, (int8_t)shift, true, &env->QF);
2431a3ef070eSClaudio Fontana }
2432a3ef070eSClaudio Fontana 
2433a3ef070eSClaudio Fontana /* Operate on 64-bit values, but saturate at 48 bits */
do_sqrshl48_d(int64_t src,int64_t shift,bool round,uint32_t * sat)2434a3ef070eSClaudio Fontana static inline int64_t do_sqrshl48_d(int64_t src, int64_t shift,
2435a3ef070eSClaudio Fontana                                     bool round, uint32_t *sat)
2436a3ef070eSClaudio Fontana {
2437a3ef070eSClaudio Fontana     int64_t val, extval;
2438a3ef070eSClaudio Fontana 
2439a3ef070eSClaudio Fontana     if (shift <= -48) {
2440a3ef070eSClaudio Fontana         /* Rounding the sign bit always produces 0. */
2441a3ef070eSClaudio Fontana         if (round) {
2442a3ef070eSClaudio Fontana             return 0;
2443a3ef070eSClaudio Fontana         }
2444a3ef070eSClaudio Fontana         return src >> 63;
2445a3ef070eSClaudio Fontana     } else if (shift < 0) {
2446a3ef070eSClaudio Fontana         if (round) {
2447a3ef070eSClaudio Fontana             src >>= -shift - 1;
2448a3ef070eSClaudio Fontana             val = (src >> 1) + (src & 1);
2449a3ef070eSClaudio Fontana         } else {
2450a3ef070eSClaudio Fontana             val = src >> -shift;
2451a3ef070eSClaudio Fontana         }
2452a3ef070eSClaudio Fontana         extval = sextract64(val, 0, 48);
2453a3ef070eSClaudio Fontana         if (!sat || val == extval) {
2454a3ef070eSClaudio Fontana             return extval;
2455a3ef070eSClaudio Fontana         }
2456a3ef070eSClaudio Fontana     } else if (shift < 48) {
2457d54deb2aSPhilippe Mathieu-Daudé         extval = sextract64(src << shift, 0, 48);
2458a3ef070eSClaudio Fontana         if (!sat || src == (extval >> shift)) {
2459a3ef070eSClaudio Fontana             return extval;
2460a3ef070eSClaudio Fontana         }
2461a3ef070eSClaudio Fontana     } else if (!sat || src == 0) {
2462a3ef070eSClaudio Fontana         return 0;
2463a3ef070eSClaudio Fontana     }
2464a3ef070eSClaudio Fontana 
2465a3ef070eSClaudio Fontana     *sat = 1;
2466a3ef070eSClaudio Fontana     return src >= 0 ? MAKE_64BIT_MASK(0, 47) : MAKE_64BIT_MASK(47, 17);
2467a3ef070eSClaudio Fontana }
2468a3ef070eSClaudio Fontana 
2469a3ef070eSClaudio Fontana /* Operate on 64-bit values, but saturate at 48 bits */
do_uqrshl48_d(uint64_t src,int64_t shift,bool round,uint32_t * sat)2470a3ef070eSClaudio Fontana static inline uint64_t do_uqrshl48_d(uint64_t src, int64_t shift,
2471a3ef070eSClaudio Fontana                                      bool round, uint32_t *sat)
2472a3ef070eSClaudio Fontana {
2473a3ef070eSClaudio Fontana     uint64_t val, extval;
2474a3ef070eSClaudio Fontana 
2475a3ef070eSClaudio Fontana     if (shift <= -(48 + round)) {
2476a3ef070eSClaudio Fontana         return 0;
2477a3ef070eSClaudio Fontana     } else if (shift < 0) {
2478a3ef070eSClaudio Fontana         if (round) {
2479a3ef070eSClaudio Fontana             val = src >> (-shift - 1);
2480a3ef070eSClaudio Fontana             val = (val >> 1) + (val & 1);
2481a3ef070eSClaudio Fontana         } else {
2482a3ef070eSClaudio Fontana             val = src >> -shift;
2483a3ef070eSClaudio Fontana         }
2484a3ef070eSClaudio Fontana         extval = extract64(val, 0, 48);
2485a3ef070eSClaudio Fontana         if (!sat || val == extval) {
2486a3ef070eSClaudio Fontana             return extval;
2487a3ef070eSClaudio Fontana         }
2488a3ef070eSClaudio Fontana     } else if (shift < 48) {
2489d54deb2aSPhilippe Mathieu-Daudé         extval = extract64(src << shift, 0, 48);
2490a3ef070eSClaudio Fontana         if (!sat || src == (extval >> shift)) {
2491a3ef070eSClaudio Fontana             return extval;
2492a3ef070eSClaudio Fontana         }
2493a3ef070eSClaudio Fontana     } else if (!sat || src == 0) {
2494a3ef070eSClaudio Fontana         return 0;
2495a3ef070eSClaudio Fontana     }
2496a3ef070eSClaudio Fontana 
2497a3ef070eSClaudio Fontana     *sat = 1;
2498a3ef070eSClaudio Fontana     return MAKE_64BIT_MASK(0, 48);
2499a3ef070eSClaudio Fontana }
2500a3ef070eSClaudio Fontana 
HELPER(mve_sqrshrl48)2501a3ef070eSClaudio Fontana uint64_t HELPER(mve_sqrshrl48)(CPUARMState *env, uint64_t n, uint32_t shift)
2502a3ef070eSClaudio Fontana {
2503a3ef070eSClaudio Fontana     return do_sqrshl48_d(n, -(int8_t)shift, true, &env->QF);
2504a3ef070eSClaudio Fontana }
2505a3ef070eSClaudio Fontana 
HELPER(mve_uqrshll48)2506a3ef070eSClaudio Fontana uint64_t HELPER(mve_uqrshll48)(CPUARMState *env, uint64_t n, uint32_t shift)
2507a3ef070eSClaudio Fontana {
2508a3ef070eSClaudio Fontana     return do_uqrshl48_d(n, (int8_t)shift, true, &env->QF);
2509a3ef070eSClaudio Fontana }
2510a3ef070eSClaudio Fontana 
HELPER(mve_uqshl)2511a3ef070eSClaudio Fontana uint32_t HELPER(mve_uqshl)(CPUARMState *env, uint32_t n, uint32_t shift)
2512a3ef070eSClaudio Fontana {
2513a3ef070eSClaudio Fontana     return do_uqrshl_bhs(n, (int8_t)shift, 32, false, &env->QF);
2514a3ef070eSClaudio Fontana }
2515a3ef070eSClaudio Fontana 
HELPER(mve_sqshl)2516a3ef070eSClaudio Fontana uint32_t HELPER(mve_sqshl)(CPUARMState *env, uint32_t n, uint32_t shift)
2517a3ef070eSClaudio Fontana {
2518a3ef070eSClaudio Fontana     return do_sqrshl_bhs(n, (int8_t)shift, 32, false, &env->QF);
2519a3ef070eSClaudio Fontana }
2520a3ef070eSClaudio Fontana 
HELPER(mve_uqrshl)2521a3ef070eSClaudio Fontana uint32_t HELPER(mve_uqrshl)(CPUARMState *env, uint32_t n, uint32_t shift)
2522a3ef070eSClaudio Fontana {
2523a3ef070eSClaudio Fontana     return do_uqrshl_bhs(n, (int8_t)shift, 32, true, &env->QF);
2524a3ef070eSClaudio Fontana }
2525a3ef070eSClaudio Fontana 
HELPER(mve_sqrshr)2526a3ef070eSClaudio Fontana uint32_t HELPER(mve_sqrshr)(CPUARMState *env, uint32_t n, uint32_t shift)
2527a3ef070eSClaudio Fontana {
2528a3ef070eSClaudio Fontana     return do_sqrshl_bhs(n, -(int8_t)shift, 32, true, &env->QF);
2529a3ef070eSClaudio Fontana }
2530a3ef070eSClaudio Fontana 
2531a3ef070eSClaudio Fontana #define DO_VIDUP(OP, ESIZE, TYPE, FN)                           \
2532a3ef070eSClaudio Fontana     uint32_t HELPER(mve_##OP)(CPUARMState *env, void *vd,       \
2533a3ef070eSClaudio Fontana                            uint32_t offset, uint32_t imm)       \
2534a3ef070eSClaudio Fontana     {                                                           \
2535a3ef070eSClaudio Fontana         TYPE *d = vd;                                           \
2536a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
2537a3ef070eSClaudio Fontana         unsigned e;                                             \
2538a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {      \
2539a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], offset, mask);           \
2540a3ef070eSClaudio Fontana             offset = FN(offset, imm);                           \
2541a3ef070eSClaudio Fontana         }                                                       \
2542a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
2543a3ef070eSClaudio Fontana         return offset;                                          \
2544a3ef070eSClaudio Fontana     }
2545a3ef070eSClaudio Fontana 
2546a3ef070eSClaudio Fontana #define DO_VIWDUP(OP, ESIZE, TYPE, FN)                          \
2547a3ef070eSClaudio Fontana     uint32_t HELPER(mve_##OP)(CPUARMState *env, void *vd,       \
2548a3ef070eSClaudio Fontana                               uint32_t offset, uint32_t wrap,   \
2549a3ef070eSClaudio Fontana                               uint32_t imm)                     \
2550a3ef070eSClaudio Fontana     {                                                           \
2551a3ef070eSClaudio Fontana         TYPE *d = vd;                                           \
2552a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
2553a3ef070eSClaudio Fontana         unsigned e;                                             \
2554a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {      \
2555a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], offset, mask);           \
2556a3ef070eSClaudio Fontana             offset = FN(offset, wrap, imm);                     \
2557a3ef070eSClaudio Fontana         }                                                       \
2558a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
2559a3ef070eSClaudio Fontana         return offset;                                          \
2560a3ef070eSClaudio Fontana     }
2561a3ef070eSClaudio Fontana 
2562a3ef070eSClaudio Fontana #define DO_VIDUP_ALL(OP, FN)                    \
2563a3ef070eSClaudio Fontana     DO_VIDUP(OP##b, 1, int8_t, FN)              \
2564a3ef070eSClaudio Fontana     DO_VIDUP(OP##h, 2, int16_t, FN)             \
2565a3ef070eSClaudio Fontana     DO_VIDUP(OP##w, 4, int32_t, FN)
2566a3ef070eSClaudio Fontana 
2567a3ef070eSClaudio Fontana #define DO_VIWDUP_ALL(OP, FN)                   \
2568a3ef070eSClaudio Fontana     DO_VIWDUP(OP##b, 1, int8_t, FN)             \
2569a3ef070eSClaudio Fontana     DO_VIWDUP(OP##h, 2, int16_t, FN)            \
2570a3ef070eSClaudio Fontana     DO_VIWDUP(OP##w, 4, int32_t, FN)
2571a3ef070eSClaudio Fontana 
do_add_wrap(uint32_t offset,uint32_t wrap,uint32_t imm)2572a3ef070eSClaudio Fontana static uint32_t do_add_wrap(uint32_t offset, uint32_t wrap, uint32_t imm)
2573a3ef070eSClaudio Fontana {
2574a3ef070eSClaudio Fontana     offset += imm;
2575a3ef070eSClaudio Fontana     if (offset == wrap) {
2576a3ef070eSClaudio Fontana         offset = 0;
2577a3ef070eSClaudio Fontana     }
2578a3ef070eSClaudio Fontana     return offset;
2579a3ef070eSClaudio Fontana }
2580a3ef070eSClaudio Fontana 
do_sub_wrap(uint32_t offset,uint32_t wrap,uint32_t imm)2581a3ef070eSClaudio Fontana static uint32_t do_sub_wrap(uint32_t offset, uint32_t wrap, uint32_t imm)
2582a3ef070eSClaudio Fontana {
2583a3ef070eSClaudio Fontana     if (offset == 0) {
2584a3ef070eSClaudio Fontana         offset = wrap;
2585a3ef070eSClaudio Fontana     }
2586a3ef070eSClaudio Fontana     offset -= imm;
2587a3ef070eSClaudio Fontana     return offset;
2588a3ef070eSClaudio Fontana }
2589a3ef070eSClaudio Fontana 
DO_VIDUP_ALL(vidup,DO_ADD)2590a3ef070eSClaudio Fontana DO_VIDUP_ALL(vidup, DO_ADD)
2591a3ef070eSClaudio Fontana DO_VIWDUP_ALL(viwdup, do_add_wrap)
2592a3ef070eSClaudio Fontana DO_VIWDUP_ALL(vdwdup, do_sub_wrap)
2593a3ef070eSClaudio Fontana 
2594a3ef070eSClaudio Fontana /*
2595a3ef070eSClaudio Fontana  * Vector comparison.
2596a3ef070eSClaudio Fontana  * P0 bits for non-executed beats (where eci_mask is 0) are unchanged.
2597a3ef070eSClaudio Fontana  * P0 bits for predicated lanes in executed beats (where mask is 0) are 0.
2598a3ef070eSClaudio Fontana  * P0 bits otherwise are updated with the results of the comparisons.
2599a3ef070eSClaudio Fontana  * We must also keep unchanged the MASK fields at the top of v7m.vpr.
2600a3ef070eSClaudio Fontana  */
2601a3ef070eSClaudio Fontana #define DO_VCMP(OP, ESIZE, TYPE, FN)                                    \
2602a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vn, void *vm)   \
2603a3ef070eSClaudio Fontana     {                                                                   \
2604a3ef070eSClaudio Fontana         TYPE *n = vn, *m = vm;                                          \
2605a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2606a3ef070eSClaudio Fontana         uint16_t eci_mask = mve_eci_mask(env);                          \
2607a3ef070eSClaudio Fontana         uint16_t beatpred = 0;                                          \
2608a3ef070eSClaudio Fontana         uint16_t emask = MAKE_64BIT_MASK(0, ESIZE);                     \
2609a3ef070eSClaudio Fontana         unsigned e;                                                     \
2610a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++) {                              \
2611a3ef070eSClaudio Fontana             bool r = FN(n[H##ESIZE(e)], m[H##ESIZE(e)]);                \
2612a3ef070eSClaudio Fontana             /* Comparison sets 0/1 bits for each byte in the element */ \
2613a3ef070eSClaudio Fontana             beatpred |= r * emask;                                      \
2614a3ef070eSClaudio Fontana             emask <<= ESIZE;                                            \
2615a3ef070eSClaudio Fontana         }                                                               \
2616a3ef070eSClaudio Fontana         beatpred &= mask;                                               \
2617a3ef070eSClaudio Fontana         env->v7m.vpr = (env->v7m.vpr & ~(uint32_t)eci_mask) |           \
2618a3ef070eSClaudio Fontana             (beatpred & eci_mask);                                      \
2619a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2620a3ef070eSClaudio Fontana     }
2621a3ef070eSClaudio Fontana 
2622a3ef070eSClaudio Fontana #define DO_VCMP_SCALAR(OP, ESIZE, TYPE, FN)                             \
2623a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vn,             \
2624a3ef070eSClaudio Fontana                                 uint32_t rm)                            \
2625a3ef070eSClaudio Fontana     {                                                                   \
2626a3ef070eSClaudio Fontana         TYPE *n = vn;                                                   \
2627a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2628a3ef070eSClaudio Fontana         uint16_t eci_mask = mve_eci_mask(env);                          \
2629a3ef070eSClaudio Fontana         uint16_t beatpred = 0;                                          \
2630a3ef070eSClaudio Fontana         uint16_t emask = MAKE_64BIT_MASK(0, ESIZE);                     \
2631a3ef070eSClaudio Fontana         unsigned e;                                                     \
2632a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++) {                              \
2633a3ef070eSClaudio Fontana             bool r = FN(n[H##ESIZE(e)], (TYPE)rm);                      \
2634a3ef070eSClaudio Fontana             /* Comparison sets 0/1 bits for each byte in the element */ \
2635a3ef070eSClaudio Fontana             beatpred |= r * emask;                                      \
2636a3ef070eSClaudio Fontana             emask <<= ESIZE;                                            \
2637a3ef070eSClaudio Fontana         }                                                               \
2638a3ef070eSClaudio Fontana         beatpred &= mask;                                               \
2639a3ef070eSClaudio Fontana         env->v7m.vpr = (env->v7m.vpr & ~(uint32_t)eci_mask) |           \
2640a3ef070eSClaudio Fontana             (beatpred & eci_mask);                                      \
2641a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2642a3ef070eSClaudio Fontana     }
2643a3ef070eSClaudio Fontana 
2644a3ef070eSClaudio Fontana #define DO_VCMP_S(OP, FN)                               \
2645a3ef070eSClaudio Fontana     DO_VCMP(OP##b, 1, int8_t, FN)                       \
2646a3ef070eSClaudio Fontana     DO_VCMP(OP##h, 2, int16_t, FN)                      \
2647a3ef070eSClaudio Fontana     DO_VCMP(OP##w, 4, int32_t, FN)                      \
2648a3ef070eSClaudio Fontana     DO_VCMP_SCALAR(OP##_scalarb, 1, int8_t, FN)         \
2649a3ef070eSClaudio Fontana     DO_VCMP_SCALAR(OP##_scalarh, 2, int16_t, FN)        \
2650a3ef070eSClaudio Fontana     DO_VCMP_SCALAR(OP##_scalarw, 4, int32_t, FN)
2651a3ef070eSClaudio Fontana 
2652a3ef070eSClaudio Fontana #define DO_VCMP_U(OP, FN)                               \
2653a3ef070eSClaudio Fontana     DO_VCMP(OP##b, 1, uint8_t, FN)                      \
2654a3ef070eSClaudio Fontana     DO_VCMP(OP##h, 2, uint16_t, FN)                     \
2655a3ef070eSClaudio Fontana     DO_VCMP(OP##w, 4, uint32_t, FN)                     \
2656a3ef070eSClaudio Fontana     DO_VCMP_SCALAR(OP##_scalarb, 1, uint8_t, FN)        \
2657a3ef070eSClaudio Fontana     DO_VCMP_SCALAR(OP##_scalarh, 2, uint16_t, FN)       \
2658a3ef070eSClaudio Fontana     DO_VCMP_SCALAR(OP##_scalarw, 4, uint32_t, FN)
2659a3ef070eSClaudio Fontana 
2660a3ef070eSClaudio Fontana #define DO_EQ(N, M) ((N) == (M))
2661a3ef070eSClaudio Fontana #define DO_NE(N, M) ((N) != (M))
2662a3ef070eSClaudio Fontana #define DO_EQ(N, M) ((N) == (M))
2663a3ef070eSClaudio Fontana #define DO_EQ(N, M) ((N) == (M))
2664a3ef070eSClaudio Fontana #define DO_GE(N, M) ((N) >= (M))
2665a3ef070eSClaudio Fontana #define DO_LT(N, M) ((N) < (M))
2666a3ef070eSClaudio Fontana #define DO_GT(N, M) ((N) > (M))
2667a3ef070eSClaudio Fontana #define DO_LE(N, M) ((N) <= (M))
2668a3ef070eSClaudio Fontana 
2669a3ef070eSClaudio Fontana DO_VCMP_U(vcmpeq, DO_EQ)
2670a3ef070eSClaudio Fontana DO_VCMP_U(vcmpne, DO_NE)
2671a3ef070eSClaudio Fontana DO_VCMP_U(vcmpcs, DO_GE)
2672a3ef070eSClaudio Fontana DO_VCMP_U(vcmphi, DO_GT)
2673a3ef070eSClaudio Fontana DO_VCMP_S(vcmpge, DO_GE)
2674a3ef070eSClaudio Fontana DO_VCMP_S(vcmplt, DO_LT)
2675a3ef070eSClaudio Fontana DO_VCMP_S(vcmpgt, DO_GT)
2676a3ef070eSClaudio Fontana DO_VCMP_S(vcmple, DO_LE)
2677a3ef070eSClaudio Fontana 
2678a3ef070eSClaudio Fontana void HELPER(mve_vpsel)(CPUARMState *env, void *vd, void *vn, void *vm)
2679a3ef070eSClaudio Fontana {
2680a3ef070eSClaudio Fontana     /*
2681a3ef070eSClaudio Fontana      * Qd[n] = VPR.P0[n] ? Qn[n] : Qm[n]
2682a3ef070eSClaudio Fontana      * but note that whether bytes are written to Qd is still subject
2683a3ef070eSClaudio Fontana      * to (all forms of) predication in the usual way.
2684a3ef070eSClaudio Fontana      */
2685a3ef070eSClaudio Fontana     uint64_t *d = vd, *n = vn, *m = vm;
2686a3ef070eSClaudio Fontana     uint16_t mask = mve_element_mask(env);
2687a3ef070eSClaudio Fontana     uint16_t p0 = FIELD_EX32(env->v7m.vpr, V7M_VPR, P0);
2688a3ef070eSClaudio Fontana     unsigned e;
2689a3ef070eSClaudio Fontana     for (e = 0; e < 16 / 8; e++, mask >>= 8, p0 >>= 8) {
2690a3ef070eSClaudio Fontana         uint64_t r = m[H8(e)];
2691a3ef070eSClaudio Fontana         mergemask(&r, n[H8(e)], p0);
2692a3ef070eSClaudio Fontana         mergemask(&d[H8(e)], r, mask);
2693a3ef070eSClaudio Fontana     }
2694a3ef070eSClaudio Fontana     mve_advance_vpt(env);
2695a3ef070eSClaudio Fontana }
2696a3ef070eSClaudio Fontana 
HELPER(mve_vpnot)2697a3ef070eSClaudio Fontana void HELPER(mve_vpnot)(CPUARMState *env)
2698a3ef070eSClaudio Fontana {
2699a3ef070eSClaudio Fontana     /*
2700a3ef070eSClaudio Fontana      * P0 bits for unexecuted beats (where eci_mask is 0) are unchanged.
2701a3ef070eSClaudio Fontana      * P0 bits for predicated lanes in executed bits (where mask is 0) are 0.
2702a3ef070eSClaudio Fontana      * P0 bits otherwise are inverted.
2703a3ef070eSClaudio Fontana      * (This is the same logic as VCMP.)
2704a3ef070eSClaudio Fontana      * This insn is itself subject to predication and to beat-wise execution,
2705a3ef070eSClaudio Fontana      * and after it executes VPT state advances in the usual way.
2706a3ef070eSClaudio Fontana      */
2707a3ef070eSClaudio Fontana     uint16_t mask = mve_element_mask(env);
2708a3ef070eSClaudio Fontana     uint16_t eci_mask = mve_eci_mask(env);
2709a3ef070eSClaudio Fontana     uint16_t beatpred = ~env->v7m.vpr & mask;
2710a3ef070eSClaudio Fontana     env->v7m.vpr = (env->v7m.vpr & ~(uint32_t)eci_mask) | (beatpred & eci_mask);
2711a3ef070eSClaudio Fontana     mve_advance_vpt(env);
2712a3ef070eSClaudio Fontana }
2713a3ef070eSClaudio Fontana 
2714a3ef070eSClaudio Fontana /*
2715a3ef070eSClaudio Fontana  * VCTP: P0 unexecuted bits unchanged, predicated bits zeroed,
2716a3ef070eSClaudio Fontana  * otherwise set according to value of Rn. The calculation of
2717a3ef070eSClaudio Fontana  * newmask here works in the same way as the calculation of the
2718a3ef070eSClaudio Fontana  * ltpmask in mve_element_mask(), but we have pre-calculated
2719a3ef070eSClaudio Fontana  * the masklen in the generated code.
2720a3ef070eSClaudio Fontana  */
HELPER(mve_vctp)2721a3ef070eSClaudio Fontana void HELPER(mve_vctp)(CPUARMState *env, uint32_t masklen)
2722a3ef070eSClaudio Fontana {
2723a3ef070eSClaudio Fontana     uint16_t mask = mve_element_mask(env);
2724a3ef070eSClaudio Fontana     uint16_t eci_mask = mve_eci_mask(env);
2725a3ef070eSClaudio Fontana     uint16_t newmask;
2726a3ef070eSClaudio Fontana 
2727a3ef070eSClaudio Fontana     assert(masklen <= 16);
2728a3ef070eSClaudio Fontana     newmask = masklen ? MAKE_64BIT_MASK(0, masklen) : 0;
2729a3ef070eSClaudio Fontana     newmask &= mask;
2730a3ef070eSClaudio Fontana     env->v7m.vpr = (env->v7m.vpr & ~(uint32_t)eci_mask) | (newmask & eci_mask);
2731a3ef070eSClaudio Fontana     mve_advance_vpt(env);
2732a3ef070eSClaudio Fontana }
2733a3ef070eSClaudio Fontana 
2734a3ef070eSClaudio Fontana #define DO_1OP_SAT(OP, ESIZE, TYPE, FN)                                 \
2735a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, void *vm)         \
2736a3ef070eSClaudio Fontana     {                                                                   \
2737a3ef070eSClaudio Fontana         TYPE *d = vd, *m = vm;                                          \
2738a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2739a3ef070eSClaudio Fontana         unsigned e;                                                     \
2740a3ef070eSClaudio Fontana         bool qc = false;                                                \
2741a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
2742a3ef070eSClaudio Fontana             bool sat = false;                                           \
2743a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], FN(m[H##ESIZE(e)], &sat), mask); \
2744a3ef070eSClaudio Fontana             qc |= sat & mask & 1;                                       \
2745a3ef070eSClaudio Fontana         }                                                               \
2746a3ef070eSClaudio Fontana         if (qc) {                                                       \
2747a3ef070eSClaudio Fontana             env->vfp.qc[0] = qc;                                        \
2748a3ef070eSClaudio Fontana         }                                                               \
2749a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2750a3ef070eSClaudio Fontana     }
2751a3ef070eSClaudio Fontana 
2752a3ef070eSClaudio Fontana #define DO_VQABS_B(N, SATP) \
2753a3ef070eSClaudio Fontana     do_sat_bhs(DO_ABS((int64_t)N), INT8_MIN, INT8_MAX, SATP)
2754a3ef070eSClaudio Fontana #define DO_VQABS_H(N, SATP) \
2755a3ef070eSClaudio Fontana     do_sat_bhs(DO_ABS((int64_t)N), INT16_MIN, INT16_MAX, SATP)
2756a3ef070eSClaudio Fontana #define DO_VQABS_W(N, SATP) \
2757a3ef070eSClaudio Fontana     do_sat_bhs(DO_ABS((int64_t)N), INT32_MIN, INT32_MAX, SATP)
2758a3ef070eSClaudio Fontana 
2759a3ef070eSClaudio Fontana #define DO_VQNEG_B(N, SATP) do_sat_bhs(-(int64_t)N, INT8_MIN, INT8_MAX, SATP)
2760a3ef070eSClaudio Fontana #define DO_VQNEG_H(N, SATP) do_sat_bhs(-(int64_t)N, INT16_MIN, INT16_MAX, SATP)
2761a3ef070eSClaudio Fontana #define DO_VQNEG_W(N, SATP) do_sat_bhs(-(int64_t)N, INT32_MIN, INT32_MAX, SATP)
2762a3ef070eSClaudio Fontana 
2763a3ef070eSClaudio Fontana DO_1OP_SAT(vqabsb, 1, int8_t, DO_VQABS_B)
2764a3ef070eSClaudio Fontana DO_1OP_SAT(vqabsh, 2, int16_t, DO_VQABS_H)
2765a3ef070eSClaudio Fontana DO_1OP_SAT(vqabsw, 4, int32_t, DO_VQABS_W)
2766a3ef070eSClaudio Fontana 
2767a3ef070eSClaudio Fontana DO_1OP_SAT(vqnegb, 1, int8_t, DO_VQNEG_B)
2768a3ef070eSClaudio Fontana DO_1OP_SAT(vqnegh, 2, int16_t, DO_VQNEG_H)
2769a3ef070eSClaudio Fontana DO_1OP_SAT(vqnegw, 4, int32_t, DO_VQNEG_W)
2770a3ef070eSClaudio Fontana 
2771a3ef070eSClaudio Fontana /*
2772a3ef070eSClaudio Fontana  * VMAXA, VMINA: vd is unsigned; vm is signed, and we take its
2773a3ef070eSClaudio Fontana  * absolute value; we then do an unsigned comparison.
2774a3ef070eSClaudio Fontana  */
2775a3ef070eSClaudio Fontana #define DO_VMAXMINA(OP, ESIZE, STYPE, UTYPE, FN)                        \
2776a3ef070eSClaudio Fontana     void HELPER(mve_##OP)(CPUARMState *env, void *vd, void *vm)         \
2777a3ef070eSClaudio Fontana     {                                                                   \
2778a3ef070eSClaudio Fontana         UTYPE *d = vd;                                                  \
2779a3ef070eSClaudio Fontana         STYPE *m = vm;                                                  \
2780a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2781a3ef070eSClaudio Fontana         unsigned e;                                                     \
2782a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
2783a3ef070eSClaudio Fontana             UTYPE r = DO_ABS(m[H##ESIZE(e)]);                           \
2784a3ef070eSClaudio Fontana             r = FN(d[H##ESIZE(e)], r);                                  \
2785a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r, mask);                        \
2786a3ef070eSClaudio Fontana         }                                                               \
2787a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2788a3ef070eSClaudio Fontana     }
2789a3ef070eSClaudio Fontana 
2790a3ef070eSClaudio Fontana DO_VMAXMINA(vmaxab, 1, int8_t, uint8_t, DO_MAX)
2791a3ef070eSClaudio Fontana DO_VMAXMINA(vmaxah, 2, int16_t, uint16_t, DO_MAX)
2792a3ef070eSClaudio Fontana DO_VMAXMINA(vmaxaw, 4, int32_t, uint32_t, DO_MAX)
2793a3ef070eSClaudio Fontana DO_VMAXMINA(vminab, 1, int8_t, uint8_t, DO_MIN)
2794a3ef070eSClaudio Fontana DO_VMAXMINA(vminah, 2, int16_t, uint16_t, DO_MIN)
2795a3ef070eSClaudio Fontana DO_VMAXMINA(vminaw, 4, int32_t, uint32_t, DO_MIN)
2796a3ef070eSClaudio Fontana 
2797a3ef070eSClaudio Fontana /*
2798a3ef070eSClaudio Fontana  * 2-operand floating point. Note that if an element is partially
2799a3ef070eSClaudio Fontana  * predicated we must do the FP operation to update the non-predicated
2800a3ef070eSClaudio Fontana  * bytes, but we must be careful to avoid updating the FP exception
2801a3ef070eSClaudio Fontana  * state unless byte 0 of the element was unpredicated.
2802a3ef070eSClaudio Fontana  */
2803a3ef070eSClaudio Fontana #define DO_2OP_FP(OP, ESIZE, TYPE, FN)                                  \
2804a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env,                       \
2805a3ef070eSClaudio Fontana                                 void *vd, void *vn, void *vm)           \
2806a3ef070eSClaudio Fontana     {                                                                   \
2807a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn, *m = vm;                                 \
2808a3ef070eSClaudio Fontana         TYPE r;                                                         \
2809a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2810a3ef070eSClaudio Fontana         unsigned e;                                                     \
2811a3ef070eSClaudio Fontana         float_status *fpst;                                             \
2812a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
2813a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
2814a3ef070eSClaudio Fontana             if ((mask & MAKE_64BIT_MASK(0, ESIZE)) == 0) {              \
2815a3ef070eSClaudio Fontana                 continue;                                               \
2816a3ef070eSClaudio Fontana             }                                                           \
2817a3ef070eSClaudio Fontana             fpst = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :    \
2818a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
2819a3ef070eSClaudio Fontana             if (!(mask & 1)) {                                          \
2820a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
2821a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
2822a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
2823a3ef070eSClaudio Fontana             }                                                           \
2824a3ef070eSClaudio Fontana             r = FN(n[H##ESIZE(e)], m[H##ESIZE(e)], fpst);               \
2825a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r, mask);                        \
2826a3ef070eSClaudio Fontana         }                                                               \
2827a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2828a3ef070eSClaudio Fontana     }
2829a3ef070eSClaudio Fontana 
2830a3ef070eSClaudio Fontana #define DO_2OP_FP_ALL(OP, FN)                  \
2831a3ef070eSClaudio Fontana     DO_2OP_FP(OP##h, 2, float16, float16_##FN) \
2832a3ef070eSClaudio Fontana     DO_2OP_FP(OP##s, 4, float32, float32_##FN)
2833a3ef070eSClaudio Fontana 
DO_2OP_FP_ALL(vfadd,add)2834a3ef070eSClaudio Fontana DO_2OP_FP_ALL(vfadd, add)
2835a3ef070eSClaudio Fontana DO_2OP_FP_ALL(vfsub, sub)
2836a3ef070eSClaudio Fontana DO_2OP_FP_ALL(vfmul, mul)
2837a3ef070eSClaudio Fontana 
2838a3ef070eSClaudio Fontana static inline float16 float16_abd(float16 a, float16 b, float_status *s)
2839a3ef070eSClaudio Fontana {
2840a3ef070eSClaudio Fontana     return float16_abs(float16_sub(a, b, s));
2841a3ef070eSClaudio Fontana }
2842a3ef070eSClaudio Fontana 
float32_abd(float32 a,float32 b,float_status * s)2843a3ef070eSClaudio Fontana static inline float32 float32_abd(float32 a, float32 b, float_status *s)
2844a3ef070eSClaudio Fontana {
2845a3ef070eSClaudio Fontana     return float32_abs(float32_sub(a, b, s));
2846a3ef070eSClaudio Fontana }
2847a3ef070eSClaudio Fontana 
DO_2OP_FP_ALL(vfabd,abd)2848a3ef070eSClaudio Fontana DO_2OP_FP_ALL(vfabd, abd)
2849a3ef070eSClaudio Fontana DO_2OP_FP_ALL(vmaxnm, maxnum)
2850a3ef070eSClaudio Fontana DO_2OP_FP_ALL(vminnm, minnum)
2851a3ef070eSClaudio Fontana 
2852a3ef070eSClaudio Fontana static inline float16 float16_maxnuma(float16 a, float16 b, float_status *s)
2853a3ef070eSClaudio Fontana {
2854a3ef070eSClaudio Fontana     return float16_maxnum(float16_abs(a), float16_abs(b), s);
2855a3ef070eSClaudio Fontana }
2856a3ef070eSClaudio Fontana 
float32_maxnuma(float32 a,float32 b,float_status * s)2857a3ef070eSClaudio Fontana static inline float32 float32_maxnuma(float32 a, float32 b, float_status *s)
2858a3ef070eSClaudio Fontana {
2859a3ef070eSClaudio Fontana     return float32_maxnum(float32_abs(a), float32_abs(b), s);
2860a3ef070eSClaudio Fontana }
2861a3ef070eSClaudio Fontana 
float16_minnuma(float16 a,float16 b,float_status * s)2862a3ef070eSClaudio Fontana static inline float16 float16_minnuma(float16 a, float16 b, float_status *s)
2863a3ef070eSClaudio Fontana {
2864a3ef070eSClaudio Fontana     return float16_minnum(float16_abs(a), float16_abs(b), s);
2865a3ef070eSClaudio Fontana }
2866a3ef070eSClaudio Fontana 
float32_minnuma(float32 a,float32 b,float_status * s)2867a3ef070eSClaudio Fontana static inline float32 float32_minnuma(float32 a, float32 b, float_status *s)
2868a3ef070eSClaudio Fontana {
2869a3ef070eSClaudio Fontana     return float32_minnum(float32_abs(a), float32_abs(b), s);
2870a3ef070eSClaudio Fontana }
2871a3ef070eSClaudio Fontana 
DO_2OP_FP_ALL(vmaxnma,maxnuma)2872a3ef070eSClaudio Fontana DO_2OP_FP_ALL(vmaxnma, maxnuma)
2873a3ef070eSClaudio Fontana DO_2OP_FP_ALL(vminnma, minnuma)
2874a3ef070eSClaudio Fontana 
2875a3ef070eSClaudio Fontana #define DO_VCADD_FP(OP, ESIZE, TYPE, FN0, FN1)                          \
2876a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env,                       \
2877a3ef070eSClaudio Fontana                                 void *vd, void *vn, void *vm)           \
2878a3ef070eSClaudio Fontana     {                                                                   \
2879a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn, *m = vm;                                 \
2880a3ef070eSClaudio Fontana         TYPE r[16 / ESIZE];                                             \
2881a3ef070eSClaudio Fontana         uint16_t tm, mask = mve_element_mask(env);                      \
2882a3ef070eSClaudio Fontana         unsigned e;                                                     \
2883a3ef070eSClaudio Fontana         float_status *fpst;                                             \
2884a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
2885a3ef070eSClaudio Fontana         /* Calculate all results first to avoid overwriting inputs */   \
2886a3ef070eSClaudio Fontana         for (e = 0, tm = mask; e < 16 / ESIZE; e++, tm >>= ESIZE) {     \
2887a3ef070eSClaudio Fontana             if ((tm & MAKE_64BIT_MASK(0, ESIZE)) == 0) {                \
2888a3ef070eSClaudio Fontana                 r[e] = 0;                                               \
2889a3ef070eSClaudio Fontana                 continue;                                               \
2890a3ef070eSClaudio Fontana             }                                                           \
2891a3ef070eSClaudio Fontana             fpst = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :    \
2892a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
2893a3ef070eSClaudio Fontana             if (!(tm & 1)) {                                            \
2894a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
2895a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
2896a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
2897a3ef070eSClaudio Fontana             }                                                           \
2898a3ef070eSClaudio Fontana             if (!(e & 1)) {                                             \
2899a3ef070eSClaudio Fontana                 r[e] = FN0(n[H##ESIZE(e)], m[H##ESIZE(e + 1)], fpst);   \
2900a3ef070eSClaudio Fontana             } else {                                                    \
2901a3ef070eSClaudio Fontana                 r[e] = FN1(n[H##ESIZE(e)], m[H##ESIZE(e - 1)], fpst);   \
2902a3ef070eSClaudio Fontana             }                                                           \
2903a3ef070eSClaudio Fontana         }                                                               \
2904a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
2905a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r[e], mask);                     \
2906a3ef070eSClaudio Fontana         }                                                               \
2907a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2908a3ef070eSClaudio Fontana     }
2909a3ef070eSClaudio Fontana 
2910a3ef070eSClaudio Fontana DO_VCADD_FP(vfcadd90h, 2, float16, float16_sub, float16_add)
2911a3ef070eSClaudio Fontana DO_VCADD_FP(vfcadd90s, 4, float32, float32_sub, float32_add)
2912a3ef070eSClaudio Fontana DO_VCADD_FP(vfcadd270h, 2, float16, float16_add, float16_sub)
2913a3ef070eSClaudio Fontana DO_VCADD_FP(vfcadd270s, 4, float32, float32_add, float32_sub)
2914a3ef070eSClaudio Fontana 
2915a3ef070eSClaudio Fontana #define DO_VFMA(OP, ESIZE, TYPE, CHS)                                   \
2916a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env,                       \
2917a3ef070eSClaudio Fontana                                 void *vd, void *vn, void *vm)           \
2918a3ef070eSClaudio Fontana     {                                                                   \
2919a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn, *m = vm;                                 \
2920a3ef070eSClaudio Fontana         TYPE r;                                                         \
2921a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2922a3ef070eSClaudio Fontana         unsigned e;                                                     \
2923a3ef070eSClaudio Fontana         float_status *fpst;                                             \
2924a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
2925a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
2926a3ef070eSClaudio Fontana             if ((mask & MAKE_64BIT_MASK(0, ESIZE)) == 0) {              \
2927a3ef070eSClaudio Fontana                 continue;                                               \
2928a3ef070eSClaudio Fontana             }                                                           \
2929a3ef070eSClaudio Fontana             fpst = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :    \
2930a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
2931a3ef070eSClaudio Fontana             if (!(mask & 1)) {                                          \
2932a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
2933a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
2934a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
2935a3ef070eSClaudio Fontana             }                                                           \
2936a3ef070eSClaudio Fontana             r = n[H##ESIZE(e)];                                         \
2937a3ef070eSClaudio Fontana             if (CHS) {                                                  \
2938a3ef070eSClaudio Fontana                 r = TYPE##_chs(r);                                      \
2939a3ef070eSClaudio Fontana             }                                                           \
2940a3ef070eSClaudio Fontana             r = TYPE##_muladd(r, m[H##ESIZE(e)], d[H##ESIZE(e)],        \
2941a3ef070eSClaudio Fontana                               0, fpst);                                 \
2942a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r, mask);                        \
2943a3ef070eSClaudio Fontana         }                                                               \
2944a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
2945a3ef070eSClaudio Fontana     }
2946a3ef070eSClaudio Fontana 
2947a3ef070eSClaudio Fontana DO_VFMA(vfmah, 2, float16, false)
2948a3ef070eSClaudio Fontana DO_VFMA(vfmas, 4, float32, false)
2949a3ef070eSClaudio Fontana DO_VFMA(vfmsh, 2, float16, true)
2950a3ef070eSClaudio Fontana DO_VFMA(vfmss, 4, float32, true)
2951a3ef070eSClaudio Fontana 
2952a3ef070eSClaudio Fontana #define DO_VCMLA(OP, ESIZE, TYPE, ROT, FN)                              \
2953a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env,                       \
2954a3ef070eSClaudio Fontana                                 void *vd, void *vn, void *vm)           \
2955a3ef070eSClaudio Fontana     {                                                                   \
2956a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn, *m = vm;                                 \
2957a3ef070eSClaudio Fontana         TYPE r0, r1, e1, e2, e3, e4;                                    \
2958a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
2959a3ef070eSClaudio Fontana         unsigned e;                                                     \
2960a3ef070eSClaudio Fontana         float_status *fpst0, *fpst1;                                    \
2961a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
2962a3ef070eSClaudio Fontana         /* We loop through pairs of elements at a time */               \
2963a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e += 2, mask >>= ESIZE * 2) {       \
2964a3ef070eSClaudio Fontana             if ((mask & MAKE_64BIT_MASK(0, ESIZE * 2)) == 0) {          \
2965a3ef070eSClaudio Fontana                 continue;                                               \
2966a3ef070eSClaudio Fontana             }                                                           \
2967a3ef070eSClaudio Fontana             fpst0 = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :   \
2968a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
2969a3ef070eSClaudio Fontana             fpst1 = fpst0;                                              \
2970a3ef070eSClaudio Fontana             if (!(mask & 1)) {                                          \
2971a3ef070eSClaudio Fontana                 scratch_fpst = *fpst0;                                  \
2972a3ef070eSClaudio Fontana                 fpst0 = &scratch_fpst;                                  \
2973a3ef070eSClaudio Fontana             }                                                           \
2974a3ef070eSClaudio Fontana             if (!(mask & (1 << ESIZE))) {                               \
2975a3ef070eSClaudio Fontana                 scratch_fpst = *fpst1;                                  \
2976a3ef070eSClaudio Fontana                 fpst1 = &scratch_fpst;                                  \
2977a3ef070eSClaudio Fontana             }                                                           \
2978a3ef070eSClaudio Fontana             switch (ROT) {                                              \
2979a3ef070eSClaudio Fontana             case 0:                                                     \
2980a3ef070eSClaudio Fontana                 e1 = m[H##ESIZE(e)];                                    \
2981a3ef070eSClaudio Fontana                 e2 = n[H##ESIZE(e)];                                    \
2982a3ef070eSClaudio Fontana                 e3 = m[H##ESIZE(e + 1)];                                \
2983a3ef070eSClaudio Fontana                 e4 = n[H##ESIZE(e)];                                    \
2984a3ef070eSClaudio Fontana                 break;                                                  \
2985a3ef070eSClaudio Fontana             case 1:                                                     \
2986a3ef070eSClaudio Fontana                 e1 = TYPE##_chs(m[H##ESIZE(e + 1)]);                    \
2987a3ef070eSClaudio Fontana                 e2 = n[H##ESIZE(e + 1)];                                \
2988a3ef070eSClaudio Fontana                 e3 = m[H##ESIZE(e)];                                    \
2989a3ef070eSClaudio Fontana                 e4 = n[H##ESIZE(e + 1)];                                \
2990a3ef070eSClaudio Fontana                 break;                                                  \
2991a3ef070eSClaudio Fontana             case 2:                                                     \
2992a3ef070eSClaudio Fontana                 e1 = TYPE##_chs(m[H##ESIZE(e)]);                        \
2993a3ef070eSClaudio Fontana                 e2 = n[H##ESIZE(e)];                                    \
2994a3ef070eSClaudio Fontana                 e3 = TYPE##_chs(m[H##ESIZE(e + 1)]);                    \
2995a3ef070eSClaudio Fontana                 e4 = n[H##ESIZE(e)];                                    \
2996a3ef070eSClaudio Fontana                 break;                                                  \
2997a3ef070eSClaudio Fontana             case 3:                                                     \
2998a3ef070eSClaudio Fontana                 e1 = m[H##ESIZE(e + 1)];                                \
2999a3ef070eSClaudio Fontana                 e2 = n[H##ESIZE(e + 1)];                                \
3000a3ef070eSClaudio Fontana                 e3 = TYPE##_chs(m[H##ESIZE(e)]);                        \
3001a3ef070eSClaudio Fontana                 e4 = n[H##ESIZE(e + 1)];                                \
3002a3ef070eSClaudio Fontana                 break;                                                  \
3003a3ef070eSClaudio Fontana             default:                                                    \
3004a3ef070eSClaudio Fontana                 g_assert_not_reached();                                 \
3005a3ef070eSClaudio Fontana             }                                                           \
3006a3ef070eSClaudio Fontana             r0 = FN(e2, e1, d[H##ESIZE(e)], fpst0);                     \
3007a3ef070eSClaudio Fontana             r1 = FN(e4, e3, d[H##ESIZE(e + 1)], fpst1);                 \
3008a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r0, mask);                       \
3009a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e + 1)], r1, mask >> ESIZE);          \
3010a3ef070eSClaudio Fontana         }                                                               \
3011a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
3012a3ef070eSClaudio Fontana     }
3013a3ef070eSClaudio Fontana 
3014a3ef070eSClaudio Fontana #define DO_VCMULH(N, M, D, S) float16_mul(N, M, S)
3015a3ef070eSClaudio Fontana #define DO_VCMULS(N, M, D, S) float32_mul(N, M, S)
3016a3ef070eSClaudio Fontana 
3017a3ef070eSClaudio Fontana #define DO_VCMLAH(N, M, D, S) float16_muladd(N, M, D, 0, S)
3018a3ef070eSClaudio Fontana #define DO_VCMLAS(N, M, D, S) float32_muladd(N, M, D, 0, S)
3019a3ef070eSClaudio Fontana 
3020a3ef070eSClaudio Fontana DO_VCMLA(vcmul0h, 2, float16, 0, DO_VCMULH)
3021a3ef070eSClaudio Fontana DO_VCMLA(vcmul0s, 4, float32, 0, DO_VCMULS)
3022a3ef070eSClaudio Fontana DO_VCMLA(vcmul90h, 2, float16, 1, DO_VCMULH)
3023a3ef070eSClaudio Fontana DO_VCMLA(vcmul90s, 4, float32, 1, DO_VCMULS)
3024a3ef070eSClaudio Fontana DO_VCMLA(vcmul180h, 2, float16, 2, DO_VCMULH)
3025a3ef070eSClaudio Fontana DO_VCMLA(vcmul180s, 4, float32, 2, DO_VCMULS)
3026a3ef070eSClaudio Fontana DO_VCMLA(vcmul270h, 2, float16, 3, DO_VCMULH)
3027a3ef070eSClaudio Fontana DO_VCMLA(vcmul270s, 4, float32, 3, DO_VCMULS)
3028a3ef070eSClaudio Fontana 
3029a3ef070eSClaudio Fontana DO_VCMLA(vcmla0h, 2, float16, 0, DO_VCMLAH)
3030a3ef070eSClaudio Fontana DO_VCMLA(vcmla0s, 4, float32, 0, DO_VCMLAS)
3031a3ef070eSClaudio Fontana DO_VCMLA(vcmla90h, 2, float16, 1, DO_VCMLAH)
3032a3ef070eSClaudio Fontana DO_VCMLA(vcmla90s, 4, float32, 1, DO_VCMLAS)
3033a3ef070eSClaudio Fontana DO_VCMLA(vcmla180h, 2, float16, 2, DO_VCMLAH)
3034a3ef070eSClaudio Fontana DO_VCMLA(vcmla180s, 4, float32, 2, DO_VCMLAS)
3035a3ef070eSClaudio Fontana DO_VCMLA(vcmla270h, 2, float16, 3, DO_VCMLAH)
3036a3ef070eSClaudio Fontana DO_VCMLA(vcmla270s, 4, float32, 3, DO_VCMLAS)
3037a3ef070eSClaudio Fontana 
3038a3ef070eSClaudio Fontana #define DO_2OP_FP_SCALAR(OP, ESIZE, TYPE, FN)                           \
3039a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env,                       \
3040a3ef070eSClaudio Fontana                                 void *vd, void *vn, uint32_t rm)        \
3041a3ef070eSClaudio Fontana     {                                                                   \
3042a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn;                                          \
3043a3ef070eSClaudio Fontana         TYPE r, m = rm;                                                 \
3044a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
3045a3ef070eSClaudio Fontana         unsigned e;                                                     \
3046a3ef070eSClaudio Fontana         float_status *fpst;                                             \
3047a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
3048a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
3049a3ef070eSClaudio Fontana             if ((mask & MAKE_64BIT_MASK(0, ESIZE)) == 0) {              \
3050a3ef070eSClaudio Fontana                 continue;                                               \
3051a3ef070eSClaudio Fontana             }                                                           \
3052a3ef070eSClaudio Fontana             fpst = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :    \
3053a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
3054a3ef070eSClaudio Fontana             if (!(mask & 1)) {                                          \
3055a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
3056a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
3057a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
3058a3ef070eSClaudio Fontana             }                                                           \
3059a3ef070eSClaudio Fontana             r = FN(n[H##ESIZE(e)], m, fpst);                            \
3060a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r, mask);                        \
3061a3ef070eSClaudio Fontana         }                                                               \
3062a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
3063a3ef070eSClaudio Fontana     }
3064a3ef070eSClaudio Fontana 
3065a3ef070eSClaudio Fontana #define DO_2OP_FP_SCALAR_ALL(OP, FN)                    \
3066a3ef070eSClaudio Fontana     DO_2OP_FP_SCALAR(OP##h, 2, float16, float16_##FN)   \
3067a3ef070eSClaudio Fontana     DO_2OP_FP_SCALAR(OP##s, 4, float32, float32_##FN)
3068a3ef070eSClaudio Fontana 
3069a3ef070eSClaudio Fontana DO_2OP_FP_SCALAR_ALL(vfadd_scalar, add)
3070a3ef070eSClaudio Fontana DO_2OP_FP_SCALAR_ALL(vfsub_scalar, sub)
3071a3ef070eSClaudio Fontana DO_2OP_FP_SCALAR_ALL(vfmul_scalar, mul)
3072a3ef070eSClaudio Fontana 
3073a3ef070eSClaudio Fontana #define DO_2OP_FP_ACC_SCALAR(OP, ESIZE, TYPE, FN)                       \
3074a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env,                       \
3075a3ef070eSClaudio Fontana                                 void *vd, void *vn, uint32_t rm)        \
3076a3ef070eSClaudio Fontana     {                                                                   \
3077a3ef070eSClaudio Fontana         TYPE *d = vd, *n = vn;                                          \
3078a3ef070eSClaudio Fontana         TYPE r, m = rm;                                                 \
3079a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
3080a3ef070eSClaudio Fontana         unsigned e;                                                     \
3081a3ef070eSClaudio Fontana         float_status *fpst;                                             \
3082a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
3083a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
3084a3ef070eSClaudio Fontana             if ((mask & MAKE_64BIT_MASK(0, ESIZE)) == 0) {              \
3085a3ef070eSClaudio Fontana                 continue;                                               \
3086a3ef070eSClaudio Fontana             }                                                           \
3087a3ef070eSClaudio Fontana             fpst = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :    \
3088a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
3089a3ef070eSClaudio Fontana             if (!(mask & 1)) {                                          \
3090a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
3091a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
3092a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
3093a3ef070eSClaudio Fontana             }                                                           \
3094a3ef070eSClaudio Fontana             r = FN(n[H##ESIZE(e)], m, d[H##ESIZE(e)], 0, fpst);         \
3095a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r, mask);                        \
3096a3ef070eSClaudio Fontana         }                                                               \
3097a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
3098a3ef070eSClaudio Fontana     }
3099a3ef070eSClaudio Fontana 
3100a3ef070eSClaudio Fontana /* VFMAS is vector * vector + scalar, so swap op2 and op3 */
3101a3ef070eSClaudio Fontana #define DO_VFMAS_SCALARH(N, M, D, F, S) float16_muladd(N, D, M, F, S)
3102a3ef070eSClaudio Fontana #define DO_VFMAS_SCALARS(N, M, D, F, S) float32_muladd(N, D, M, F, S)
3103a3ef070eSClaudio Fontana 
3104a3ef070eSClaudio Fontana /* VFMA is vector * scalar + vector */
3105a3ef070eSClaudio Fontana DO_2OP_FP_ACC_SCALAR(vfma_scalarh, 2, float16, float16_muladd)
3106a3ef070eSClaudio Fontana DO_2OP_FP_ACC_SCALAR(vfma_scalars, 4, float32, float32_muladd)
3107a3ef070eSClaudio Fontana DO_2OP_FP_ACC_SCALAR(vfmas_scalarh, 2, float16, DO_VFMAS_SCALARH)
3108a3ef070eSClaudio Fontana DO_2OP_FP_ACC_SCALAR(vfmas_scalars, 4, float32, DO_VFMAS_SCALARS)
3109a3ef070eSClaudio Fontana 
3110a3ef070eSClaudio Fontana /* Floating point max/min across vector. */
3111a3ef070eSClaudio Fontana #define DO_FP_VMAXMINV(OP, ESIZE, TYPE, ABS, FN)                \
3112a3ef070eSClaudio Fontana     uint32_t HELPER(glue(mve_, OP))(CPUARMState *env, void *vm, \
3113a3ef070eSClaudio Fontana                                     uint32_t ra_in)             \
3114a3ef070eSClaudio Fontana     {                                                           \
3115a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                  \
3116a3ef070eSClaudio Fontana         unsigned e;                                             \
3117a3ef070eSClaudio Fontana         TYPE *m = vm;                                           \
3118a3ef070eSClaudio Fontana         TYPE ra = (TYPE)ra_in;                                  \
3119a3ef070eSClaudio Fontana         float_status *fpst = (ESIZE == 2) ?                     \
3120a3ef070eSClaudio Fontana             &env->vfp.standard_fp_status_f16 :                  \
3121a3ef070eSClaudio Fontana             &env->vfp.standard_fp_status;                       \
3122a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {      \
3123a3ef070eSClaudio Fontana             if (mask & 1) {                                     \
3124a3ef070eSClaudio Fontana                 TYPE v = m[H##ESIZE(e)];                        \
3125a3ef070eSClaudio Fontana                 if (TYPE##_is_signaling_nan(ra, fpst)) {        \
3126a3ef070eSClaudio Fontana                     ra = TYPE##_silence_nan(ra, fpst);          \
3127a3ef070eSClaudio Fontana                     float_raise(float_flag_invalid, fpst);      \
3128a3ef070eSClaudio Fontana                 }                                               \
3129a3ef070eSClaudio Fontana                 if (TYPE##_is_signaling_nan(v, fpst)) {         \
3130a3ef070eSClaudio Fontana                     v = TYPE##_silence_nan(v, fpst);            \
3131a3ef070eSClaudio Fontana                     float_raise(float_flag_invalid, fpst);      \
3132a3ef070eSClaudio Fontana                 }                                               \
3133a3ef070eSClaudio Fontana                 if (ABS) {                                      \
3134a3ef070eSClaudio Fontana                     v = TYPE##_abs(v);                          \
3135a3ef070eSClaudio Fontana                 }                                               \
3136a3ef070eSClaudio Fontana                 ra = FN(ra, v, fpst);                           \
3137a3ef070eSClaudio Fontana             }                                                   \
3138a3ef070eSClaudio Fontana         }                                                       \
3139a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                   \
3140a3ef070eSClaudio Fontana         return ra;                                              \
3141a3ef070eSClaudio Fontana     }                                                           \
3142a3ef070eSClaudio Fontana 
3143a3ef070eSClaudio Fontana #define NOP(X) (X)
3144a3ef070eSClaudio Fontana 
3145a3ef070eSClaudio Fontana DO_FP_VMAXMINV(vmaxnmvh, 2, float16, false, float16_maxnum)
3146a3ef070eSClaudio Fontana DO_FP_VMAXMINV(vmaxnmvs, 4, float32, false, float32_maxnum)
3147a3ef070eSClaudio Fontana DO_FP_VMAXMINV(vminnmvh, 2, float16, false, float16_minnum)
3148a3ef070eSClaudio Fontana DO_FP_VMAXMINV(vminnmvs, 4, float32, false, float32_minnum)
3149a3ef070eSClaudio Fontana DO_FP_VMAXMINV(vmaxnmavh, 2, float16, true, float16_maxnum)
3150a3ef070eSClaudio Fontana DO_FP_VMAXMINV(vmaxnmavs, 4, float32, true, float32_maxnum)
3151a3ef070eSClaudio Fontana DO_FP_VMAXMINV(vminnmavh, 2, float16, true, float16_minnum)
3152a3ef070eSClaudio Fontana DO_FP_VMAXMINV(vminnmavs, 4, float32, true, float32_minnum)
3153a3ef070eSClaudio Fontana 
3154a3ef070eSClaudio Fontana /* FP compares; note that all comparisons signal InvalidOp for QNaNs */
3155a3ef070eSClaudio Fontana #define DO_VCMP_FP(OP, ESIZE, TYPE, FN)                                 \
3156a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vn, void *vm)   \
3157a3ef070eSClaudio Fontana     {                                                                   \
3158a3ef070eSClaudio Fontana         TYPE *n = vn, *m = vm;                                          \
3159a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
3160a3ef070eSClaudio Fontana         uint16_t eci_mask = mve_eci_mask(env);                          \
3161a3ef070eSClaudio Fontana         uint16_t beatpred = 0;                                          \
3162a3ef070eSClaudio Fontana         uint16_t emask = MAKE_64BIT_MASK(0, ESIZE);                     \
3163a3ef070eSClaudio Fontana         unsigned e;                                                     \
3164a3ef070eSClaudio Fontana         float_status *fpst;                                             \
3165a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
3166a3ef070eSClaudio Fontana         bool r;                                                         \
3167a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, emask <<= ESIZE) {             \
3168a3ef070eSClaudio Fontana             if ((mask & emask) == 0) {                                  \
3169a3ef070eSClaudio Fontana                 continue;                                               \
3170a3ef070eSClaudio Fontana             }                                                           \
3171a3ef070eSClaudio Fontana             fpst = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :    \
3172a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
3173a3ef070eSClaudio Fontana             if (!(mask & (1 << (e * ESIZE)))) {                         \
3174a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
3175a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
3176a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
3177a3ef070eSClaudio Fontana             }                                                           \
3178a3ef070eSClaudio Fontana             r = FN(n[H##ESIZE(e)], m[H##ESIZE(e)], fpst);               \
3179a3ef070eSClaudio Fontana             /* Comparison sets 0/1 bits for each byte in the element */ \
3180a3ef070eSClaudio Fontana             beatpred |= r * emask;                                      \
3181a3ef070eSClaudio Fontana         }                                                               \
3182a3ef070eSClaudio Fontana         beatpred &= mask;                                               \
3183a3ef070eSClaudio Fontana         env->v7m.vpr = (env->v7m.vpr & ~(uint32_t)eci_mask) |           \
3184a3ef070eSClaudio Fontana             (beatpred & eci_mask);                                      \
3185a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
3186a3ef070eSClaudio Fontana     }
3187a3ef070eSClaudio Fontana 
3188a3ef070eSClaudio Fontana #define DO_VCMP_FP_SCALAR(OP, ESIZE, TYPE, FN)                          \
3189a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vn,             \
3190a3ef070eSClaudio Fontana                                 uint32_t rm)                            \
3191a3ef070eSClaudio Fontana     {                                                                   \
3192a3ef070eSClaudio Fontana         TYPE *n = vn;                                                   \
3193a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
3194a3ef070eSClaudio Fontana         uint16_t eci_mask = mve_eci_mask(env);                          \
3195a3ef070eSClaudio Fontana         uint16_t beatpred = 0;                                          \
3196a3ef070eSClaudio Fontana         uint16_t emask = MAKE_64BIT_MASK(0, ESIZE);                     \
3197a3ef070eSClaudio Fontana         unsigned e;                                                     \
3198a3ef070eSClaudio Fontana         float_status *fpst;                                             \
3199a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
3200a3ef070eSClaudio Fontana         bool r;                                                         \
3201a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, emask <<= ESIZE) {             \
3202a3ef070eSClaudio Fontana             if ((mask & emask) == 0) {                                  \
3203a3ef070eSClaudio Fontana                 continue;                                               \
3204a3ef070eSClaudio Fontana             }                                                           \
3205a3ef070eSClaudio Fontana             fpst = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :    \
3206a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
3207a3ef070eSClaudio Fontana             if (!(mask & (1 << (e * ESIZE)))) {                         \
3208a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
3209a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
3210a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
3211a3ef070eSClaudio Fontana             }                                                           \
3212a3ef070eSClaudio Fontana             r = FN(n[H##ESIZE(e)], (TYPE)rm, fpst);                     \
3213a3ef070eSClaudio Fontana             /* Comparison sets 0/1 bits for each byte in the element */ \
3214a3ef070eSClaudio Fontana             beatpred |= r * emask;                                      \
3215a3ef070eSClaudio Fontana         }                                                               \
3216a3ef070eSClaudio Fontana         beatpred &= mask;                                               \
3217a3ef070eSClaudio Fontana         env->v7m.vpr = (env->v7m.vpr & ~(uint32_t)eci_mask) |           \
3218a3ef070eSClaudio Fontana             (beatpred & eci_mask);                                      \
3219a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
3220a3ef070eSClaudio Fontana     }
3221a3ef070eSClaudio Fontana 
3222a3ef070eSClaudio Fontana #define DO_VCMP_FP_BOTH(VOP, SOP, ESIZE, TYPE, FN)      \
3223a3ef070eSClaudio Fontana     DO_VCMP_FP(VOP, ESIZE, TYPE, FN)                    \
3224a3ef070eSClaudio Fontana     DO_VCMP_FP_SCALAR(SOP, ESIZE, TYPE, FN)
3225a3ef070eSClaudio Fontana 
3226a3ef070eSClaudio Fontana /*
3227a3ef070eSClaudio Fontana  * Some care is needed here to get the correct result for the unordered case.
3228a3ef070eSClaudio Fontana  * Architecturally EQ, GE and GT are defined to be false for unordered, but
3229a3ef070eSClaudio Fontana  * the NE, LT and LE comparisons are defined as simple logical inverses of
3230a3ef070eSClaudio Fontana  * EQ, GE and GT and so they must return true for unordered. The softfloat
3231a3ef070eSClaudio Fontana  * comparison functions float*_{eq,le,lt} all return false for unordered.
3232a3ef070eSClaudio Fontana  */
3233a3ef070eSClaudio Fontana #define DO_GE16(X, Y, S) float16_le(Y, X, S)
3234a3ef070eSClaudio Fontana #define DO_GE32(X, Y, S) float32_le(Y, X, S)
3235a3ef070eSClaudio Fontana #define DO_GT16(X, Y, S) float16_lt(Y, X, S)
3236a3ef070eSClaudio Fontana #define DO_GT32(X, Y, S) float32_lt(Y, X, S)
3237a3ef070eSClaudio Fontana 
3238a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmpeqh, vfcmpeq_scalarh, 2, float16, float16_eq)
3239a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmpeqs, vfcmpeq_scalars, 4, float32, float32_eq)
3240a3ef070eSClaudio Fontana 
3241a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmpneh, vfcmpne_scalarh, 2, float16, !float16_eq)
3242a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmpnes, vfcmpne_scalars, 4, float32, !float32_eq)
3243a3ef070eSClaudio Fontana 
3244a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmpgeh, vfcmpge_scalarh, 2, float16, DO_GE16)
3245a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmpges, vfcmpge_scalars, 4, float32, DO_GE32)
3246a3ef070eSClaudio Fontana 
3247a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmplth, vfcmplt_scalarh, 2, float16, !DO_GE16)
3248a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmplts, vfcmplt_scalars, 4, float32, !DO_GE32)
3249a3ef070eSClaudio Fontana 
3250a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmpgth, vfcmpgt_scalarh, 2, float16, DO_GT16)
3251a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmpgts, vfcmpgt_scalars, 4, float32, DO_GT32)
3252a3ef070eSClaudio Fontana 
3253a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmpleh, vfcmple_scalarh, 2, float16, !DO_GT16)
3254a3ef070eSClaudio Fontana DO_VCMP_FP_BOTH(vfcmples, vfcmple_scalars, 4, float32, !DO_GT32)
3255a3ef070eSClaudio Fontana 
3256a3ef070eSClaudio Fontana #define DO_VCVT_FIXED(OP, ESIZE, TYPE, FN)                              \
3257a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vm,   \
3258a3ef070eSClaudio Fontana                                 uint32_t shift)                         \
3259a3ef070eSClaudio Fontana     {                                                                   \
3260a3ef070eSClaudio Fontana         TYPE *d = vd, *m = vm;                                          \
3261a3ef070eSClaudio Fontana         TYPE r;                                                         \
3262a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
3263a3ef070eSClaudio Fontana         unsigned e;                                                     \
3264a3ef070eSClaudio Fontana         float_status *fpst;                                             \
3265a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
3266a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
3267a3ef070eSClaudio Fontana             if ((mask & MAKE_64BIT_MASK(0, ESIZE)) == 0) {              \
3268a3ef070eSClaudio Fontana                 continue;                                               \
3269a3ef070eSClaudio Fontana             }                                                           \
3270a3ef070eSClaudio Fontana             fpst = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :    \
3271a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
3272a3ef070eSClaudio Fontana             if (!(mask & 1)) {                                          \
3273a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
3274a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
3275a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
3276a3ef070eSClaudio Fontana             }                                                           \
3277a3ef070eSClaudio Fontana             r = FN(m[H##ESIZE(e)], shift, fpst);                        \
3278a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r, mask);                        \
3279a3ef070eSClaudio Fontana         }                                                               \
3280a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
3281a3ef070eSClaudio Fontana     }
3282a3ef070eSClaudio Fontana 
3283a3ef070eSClaudio Fontana DO_VCVT_FIXED(vcvt_sh, 2, int16_t, helper_vfp_shtoh)
3284a3ef070eSClaudio Fontana DO_VCVT_FIXED(vcvt_uh, 2, uint16_t, helper_vfp_uhtoh)
3285a3ef070eSClaudio Fontana DO_VCVT_FIXED(vcvt_hs, 2, int16_t, helper_vfp_toshh_round_to_zero)
3286a3ef070eSClaudio Fontana DO_VCVT_FIXED(vcvt_hu, 2, uint16_t, helper_vfp_touhh_round_to_zero)
3287a3ef070eSClaudio Fontana DO_VCVT_FIXED(vcvt_sf, 4, int32_t, helper_vfp_sltos)
3288a3ef070eSClaudio Fontana DO_VCVT_FIXED(vcvt_uf, 4, uint32_t, helper_vfp_ultos)
3289a3ef070eSClaudio Fontana DO_VCVT_FIXED(vcvt_fs, 4, int32_t, helper_vfp_tosls_round_to_zero)
3290a3ef070eSClaudio Fontana DO_VCVT_FIXED(vcvt_fu, 4, uint32_t, helper_vfp_touls_round_to_zero)
3291a3ef070eSClaudio Fontana 
3292a3ef070eSClaudio Fontana /* VCVT with specified rmode */
3293a3ef070eSClaudio Fontana #define DO_VCVT_RMODE(OP, ESIZE, TYPE, FN)                              \
3294a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env,                       \
3295a3ef070eSClaudio Fontana                                 void *vd, void *vm, uint32_t rmode)     \
3296a3ef070eSClaudio Fontana     {                                                                   \
3297a3ef070eSClaudio Fontana         TYPE *d = vd, *m = vm;                                          \
3298a3ef070eSClaudio Fontana         TYPE r;                                                         \
3299a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
3300a3ef070eSClaudio Fontana         unsigned e;                                                     \
3301a3ef070eSClaudio Fontana         float_status *fpst;                                             \
3302a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
3303a3ef070eSClaudio Fontana         float_status *base_fpst = (ESIZE == 2) ?                        \
3304a3ef070eSClaudio Fontana             &env->vfp.standard_fp_status_f16 :                          \
3305a3ef070eSClaudio Fontana             &env->vfp.standard_fp_status;                               \
3306a3ef070eSClaudio Fontana         uint32_t prev_rmode = get_float_rounding_mode(base_fpst);       \
3307a3ef070eSClaudio Fontana         set_float_rounding_mode(rmode, base_fpst);                      \
3308a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
3309a3ef070eSClaudio Fontana             if ((mask & MAKE_64BIT_MASK(0, ESIZE)) == 0) {              \
3310a3ef070eSClaudio Fontana                 continue;                                               \
3311a3ef070eSClaudio Fontana             }                                                           \
3312a3ef070eSClaudio Fontana             fpst = base_fpst;                                           \
3313a3ef070eSClaudio Fontana             if (!(mask & 1)) {                                          \
3314a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
3315a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
3316a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
3317a3ef070eSClaudio Fontana             }                                                           \
3318a3ef070eSClaudio Fontana             r = FN(m[H##ESIZE(e)], 0, fpst);                            \
3319a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r, mask);                        \
3320a3ef070eSClaudio Fontana         }                                                               \
3321a3ef070eSClaudio Fontana         set_float_rounding_mode(prev_rmode, base_fpst);                 \
3322a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
3323a3ef070eSClaudio Fontana     }
3324a3ef070eSClaudio Fontana 
3325a3ef070eSClaudio Fontana DO_VCVT_RMODE(vcvt_rm_sh, 2, uint16_t, helper_vfp_toshh)
3326a3ef070eSClaudio Fontana DO_VCVT_RMODE(vcvt_rm_uh, 2, uint16_t, helper_vfp_touhh)
3327a3ef070eSClaudio Fontana DO_VCVT_RMODE(vcvt_rm_ss, 4, uint32_t, helper_vfp_tosls)
3328a3ef070eSClaudio Fontana DO_VCVT_RMODE(vcvt_rm_us, 4, uint32_t, helper_vfp_touls)
3329a3ef070eSClaudio Fontana 
3330a3ef070eSClaudio Fontana #define DO_VRINT_RM_H(M, F, S) helper_rinth(M, S)
3331a3ef070eSClaudio Fontana #define DO_VRINT_RM_S(M, F, S) helper_rints(M, S)
3332a3ef070eSClaudio Fontana 
3333a3ef070eSClaudio Fontana DO_VCVT_RMODE(vrint_rm_h, 2, uint16_t, DO_VRINT_RM_H)
3334a3ef070eSClaudio Fontana DO_VCVT_RMODE(vrint_rm_s, 4, uint32_t, DO_VRINT_RM_S)
3335a3ef070eSClaudio Fontana 
3336a3ef070eSClaudio Fontana /*
3337a3ef070eSClaudio Fontana  * VCVT between halfprec and singleprec. As usual for halfprec
3338a3ef070eSClaudio Fontana  * conversions, FZ16 is ignored and AHP is observed.
3339a3ef070eSClaudio Fontana  */
3340a3ef070eSClaudio Fontana static void do_vcvt_sh(CPUARMState *env, void *vd, void *vm, int top)
3341a3ef070eSClaudio Fontana {
3342a3ef070eSClaudio Fontana     uint16_t *d = vd;
3343a3ef070eSClaudio Fontana     uint32_t *m = vm;
3344a3ef070eSClaudio Fontana     uint16_t r;
3345a3ef070eSClaudio Fontana     uint16_t mask = mve_element_mask(env);
3346a3ef070eSClaudio Fontana     bool ieee = !(env->vfp.xregs[ARM_VFP_FPSCR] & FPCR_AHP);
3347a3ef070eSClaudio Fontana     unsigned e;
3348a3ef070eSClaudio Fontana     float_status *fpst;
3349a3ef070eSClaudio Fontana     float_status scratch_fpst;
3350a3ef070eSClaudio Fontana     float_status *base_fpst = &env->vfp.standard_fp_status;
3351a3ef070eSClaudio Fontana     bool old_fz = get_flush_to_zero(base_fpst);
3352a3ef070eSClaudio Fontana     set_flush_to_zero(false, base_fpst);
3353a3ef070eSClaudio Fontana     for (e = 0; e < 16 / 4; e++, mask >>= 4) {
3354a3ef070eSClaudio Fontana         if ((mask & MAKE_64BIT_MASK(0, 4)) == 0) {
3355a3ef070eSClaudio Fontana             continue;
3356a3ef070eSClaudio Fontana         }
3357a3ef070eSClaudio Fontana         fpst = base_fpst;
3358a3ef070eSClaudio Fontana         if (!(mask & 1)) {
3359a3ef070eSClaudio Fontana             /* We need the result but without updating flags */
3360a3ef070eSClaudio Fontana             scratch_fpst = *fpst;
3361a3ef070eSClaudio Fontana             fpst = &scratch_fpst;
3362a3ef070eSClaudio Fontana         }
3363a3ef070eSClaudio Fontana         r = float32_to_float16(m[H4(e)], ieee, fpst);
3364a3ef070eSClaudio Fontana         mergemask(&d[H2(e * 2 + top)], r, mask >> (top * 2));
3365a3ef070eSClaudio Fontana     }
3366a3ef070eSClaudio Fontana     set_flush_to_zero(old_fz, base_fpst);
3367a3ef070eSClaudio Fontana     mve_advance_vpt(env);
3368a3ef070eSClaudio Fontana }
3369a3ef070eSClaudio Fontana 
do_vcvt_hs(CPUARMState * env,void * vd,void * vm,int top)3370a3ef070eSClaudio Fontana static void do_vcvt_hs(CPUARMState *env, void *vd, void *vm, int top)
3371a3ef070eSClaudio Fontana {
3372a3ef070eSClaudio Fontana     uint32_t *d = vd;
3373a3ef070eSClaudio Fontana     uint16_t *m = vm;
3374a3ef070eSClaudio Fontana     uint32_t r;
3375a3ef070eSClaudio Fontana     uint16_t mask = mve_element_mask(env);
3376a3ef070eSClaudio Fontana     bool ieee = !(env->vfp.xregs[ARM_VFP_FPSCR] & FPCR_AHP);
3377a3ef070eSClaudio Fontana     unsigned e;
3378a3ef070eSClaudio Fontana     float_status *fpst;
3379a3ef070eSClaudio Fontana     float_status scratch_fpst;
3380a3ef070eSClaudio Fontana     float_status *base_fpst = &env->vfp.standard_fp_status;
3381a3ef070eSClaudio Fontana     bool old_fiz = get_flush_inputs_to_zero(base_fpst);
3382a3ef070eSClaudio Fontana     set_flush_inputs_to_zero(false, base_fpst);
3383a3ef070eSClaudio Fontana     for (e = 0; e < 16 / 4; e++, mask >>= 4) {
3384a3ef070eSClaudio Fontana         if ((mask & MAKE_64BIT_MASK(0, 4)) == 0) {
3385a3ef070eSClaudio Fontana             continue;
3386a3ef070eSClaudio Fontana         }
3387a3ef070eSClaudio Fontana         fpst = base_fpst;
3388a3ef070eSClaudio Fontana         if (!(mask & (1 << (top * 2)))) {
3389a3ef070eSClaudio Fontana             /* We need the result but without updating flags */
3390a3ef070eSClaudio Fontana             scratch_fpst = *fpst;
3391a3ef070eSClaudio Fontana             fpst = &scratch_fpst;
3392a3ef070eSClaudio Fontana         }
3393a3ef070eSClaudio Fontana         r = float16_to_float32(m[H2(e * 2 + top)], ieee, fpst);
3394a3ef070eSClaudio Fontana         mergemask(&d[H4(e)], r, mask);
3395a3ef070eSClaudio Fontana     }
3396a3ef070eSClaudio Fontana     set_flush_inputs_to_zero(old_fiz, base_fpst);
3397a3ef070eSClaudio Fontana     mve_advance_vpt(env);
3398a3ef070eSClaudio Fontana }
3399a3ef070eSClaudio Fontana 
HELPER(mve_vcvtb_sh)3400a3ef070eSClaudio Fontana void HELPER(mve_vcvtb_sh)(CPUARMState *env, void *vd, void *vm)
3401a3ef070eSClaudio Fontana {
3402a3ef070eSClaudio Fontana     do_vcvt_sh(env, vd, vm, 0);
3403a3ef070eSClaudio Fontana }
HELPER(mve_vcvtt_sh)3404a3ef070eSClaudio Fontana void HELPER(mve_vcvtt_sh)(CPUARMState *env, void *vd, void *vm)
3405a3ef070eSClaudio Fontana {
3406a3ef070eSClaudio Fontana     do_vcvt_sh(env, vd, vm, 1);
3407a3ef070eSClaudio Fontana }
HELPER(mve_vcvtb_hs)3408a3ef070eSClaudio Fontana void HELPER(mve_vcvtb_hs)(CPUARMState *env, void *vd, void *vm)
3409a3ef070eSClaudio Fontana {
3410a3ef070eSClaudio Fontana     do_vcvt_hs(env, vd, vm, 0);
3411a3ef070eSClaudio Fontana }
HELPER(mve_vcvtt_hs)3412a3ef070eSClaudio Fontana void HELPER(mve_vcvtt_hs)(CPUARMState *env, void *vd, void *vm)
3413a3ef070eSClaudio Fontana {
3414a3ef070eSClaudio Fontana     do_vcvt_hs(env, vd, vm, 1);
3415a3ef070eSClaudio Fontana }
3416a3ef070eSClaudio Fontana 
3417a3ef070eSClaudio Fontana #define DO_1OP_FP(OP, ESIZE, TYPE, FN)                                  \
3418a3ef070eSClaudio Fontana     void HELPER(glue(mve_, OP))(CPUARMState *env, void *vd, void *vm)   \
3419a3ef070eSClaudio Fontana     {                                                                   \
3420a3ef070eSClaudio Fontana         TYPE *d = vd, *m = vm;                                          \
3421a3ef070eSClaudio Fontana         TYPE r;                                                         \
3422a3ef070eSClaudio Fontana         uint16_t mask = mve_element_mask(env);                          \
3423a3ef070eSClaudio Fontana         unsigned e;                                                     \
3424a3ef070eSClaudio Fontana         float_status *fpst;                                             \
3425a3ef070eSClaudio Fontana         float_status scratch_fpst;                                      \
3426a3ef070eSClaudio Fontana         for (e = 0; e < 16 / ESIZE; e++, mask >>= ESIZE) {              \
3427a3ef070eSClaudio Fontana             if ((mask & MAKE_64BIT_MASK(0, ESIZE)) == 0) {              \
3428a3ef070eSClaudio Fontana                 continue;                                               \
3429a3ef070eSClaudio Fontana             }                                                           \
3430a3ef070eSClaudio Fontana             fpst = (ESIZE == 2) ? &env->vfp.standard_fp_status_f16 :    \
3431a3ef070eSClaudio Fontana                 &env->vfp.standard_fp_status;                           \
3432a3ef070eSClaudio Fontana             if (!(mask & 1)) {                                          \
3433a3ef070eSClaudio Fontana                 /* We need the result but without updating flags */     \
3434a3ef070eSClaudio Fontana                 scratch_fpst = *fpst;                                   \
3435a3ef070eSClaudio Fontana                 fpst = &scratch_fpst;                                   \
3436a3ef070eSClaudio Fontana             }                                                           \
3437a3ef070eSClaudio Fontana             r = FN(m[H##ESIZE(e)], fpst);                               \
3438a3ef070eSClaudio Fontana             mergemask(&d[H##ESIZE(e)], r, mask);                        \
3439a3ef070eSClaudio Fontana         }                                                               \
3440a3ef070eSClaudio Fontana         mve_advance_vpt(env);                                           \
3441a3ef070eSClaudio Fontana     }
3442a3ef070eSClaudio Fontana 
3443a3ef070eSClaudio Fontana DO_1OP_FP(vrintx_h, 2, float16, float16_round_to_int)
3444a3ef070eSClaudio Fontana DO_1OP_FP(vrintx_s, 4, float32, float32_round_to_int)
3445