]> git.proxmox.com Git - mirror_qemu.git/blob - target/hexagon/genptr.c
Hexagon (target/hexagon) Add overrides for callr
[mirror_qemu.git] / target / hexagon / genptr.c
1 /*
2 * Copyright(c) 2019-2023 Qualcomm Innovation Center, Inc. All Rights Reserved.
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, see <http://www.gnu.org/licenses/>.
16 */
17
18 #include "qemu/osdep.h"
19 #include "cpu.h"
20 #include "internal.h"
21 #include "tcg/tcg-op.h"
22 #include "tcg/tcg-op-gvec.h"
23 #include "insn.h"
24 #include "opcodes.h"
25 #include "translate.h"
26 #define QEMU_GENERATE /* Used internally by macros.h */
27 #include "macros.h"
28 #include "mmvec/macros.h"
29 #undef QEMU_GENERATE
30 #include "gen_tcg.h"
31 #include "gen_tcg_hvx.h"
32 #include "genptr.h"
33
34 TCGv gen_read_reg(TCGv result, int num)
35 {
36 tcg_gen_mov_tl(result, hex_gpr[num]);
37 return result;
38 }
39
40 TCGv gen_read_preg(TCGv pred, uint8_t num)
41 {
42 tcg_gen_mov_tl(pred, hex_pred[num]);
43 return pred;
44 }
45
46 #define IMMUTABLE (~0)
47
48 static const target_ulong reg_immut_masks[TOTAL_PER_THREAD_REGS] = {
49 [HEX_REG_USR] = 0xc13000c0,
50 [HEX_REG_PC] = IMMUTABLE,
51 [HEX_REG_GP] = 0x3f,
52 [HEX_REG_UPCYCLELO] = IMMUTABLE,
53 [HEX_REG_UPCYCLEHI] = IMMUTABLE,
54 [HEX_REG_UTIMERLO] = IMMUTABLE,
55 [HEX_REG_UTIMERHI] = IMMUTABLE,
56 };
57
58 static inline void gen_masked_reg_write(TCGv new_val, TCGv cur_val,
59 target_ulong reg_mask)
60 {
61 if (reg_mask) {
62 TCGv tmp = tcg_temp_new();
63
64 /* new_val = (new_val & ~reg_mask) | (cur_val & reg_mask) */
65 tcg_gen_andi_tl(new_val, new_val, ~reg_mask);
66 tcg_gen_andi_tl(tmp, cur_val, reg_mask);
67 tcg_gen_or_tl(new_val, new_val, tmp);
68 }
69 }
70
71 static inline void gen_log_predicated_reg_write(int rnum, TCGv val,
72 uint32_t slot)
73 {
74 TCGv zero = tcg_constant_tl(0);
75 TCGv slot_mask = tcg_temp_new();
76
77 tcg_gen_andi_tl(slot_mask, hex_slot_cancelled, 1 << slot);
78 tcg_gen_movcond_tl(TCG_COND_EQ, hex_new_value[rnum], slot_mask, zero,
79 val, hex_new_value[rnum]);
80 if (HEX_DEBUG) {
81 /*
82 * Do this so HELPER(debug_commit_end) will know
83 *
84 * Note that slot_mask indicates the value is not written
85 * (i.e., slot was cancelled), so we create a true/false value before
86 * or'ing with hex_reg_written[rnum].
87 */
88 tcg_gen_setcond_tl(TCG_COND_EQ, slot_mask, slot_mask, zero);
89 tcg_gen_or_tl(hex_reg_written[rnum], hex_reg_written[rnum], slot_mask);
90 }
91 }
92
93 void gen_log_reg_write(int rnum, TCGv val)
94 {
95 const target_ulong reg_mask = reg_immut_masks[rnum];
96
97 gen_masked_reg_write(val, hex_gpr[rnum], reg_mask);
98 tcg_gen_mov_tl(hex_new_value[rnum], val);
99 if (HEX_DEBUG) {
100 /* Do this so HELPER(debug_commit_end) will know */
101 tcg_gen_movi_tl(hex_reg_written[rnum], 1);
102 }
103 }
104
105 static void gen_log_predicated_reg_write_pair(int rnum, TCGv_i64 val,
106 uint32_t slot)
107 {
108 TCGv val32 = tcg_temp_new();
109 TCGv zero = tcg_constant_tl(0);
110 TCGv slot_mask = tcg_temp_new();
111
112 tcg_gen_andi_tl(slot_mask, hex_slot_cancelled, 1 << slot);
113 /* Low word */
114 tcg_gen_extrl_i64_i32(val32, val);
115 tcg_gen_movcond_tl(TCG_COND_EQ, hex_new_value[rnum],
116 slot_mask, zero,
117 val32, hex_new_value[rnum]);
118 /* High word */
119 tcg_gen_extrh_i64_i32(val32, val);
120 tcg_gen_movcond_tl(TCG_COND_EQ, hex_new_value[rnum + 1],
121 slot_mask, zero,
122 val32, hex_new_value[rnum + 1]);
123 if (HEX_DEBUG) {
124 /*
125 * Do this so HELPER(debug_commit_end) will know
126 *
127 * Note that slot_mask indicates the value is not written
128 * (i.e., slot was cancelled), so we create a true/false value before
129 * or'ing with hex_reg_written[rnum].
130 */
131 tcg_gen_setcond_tl(TCG_COND_EQ, slot_mask, slot_mask, zero);
132 tcg_gen_or_tl(hex_reg_written[rnum], hex_reg_written[rnum], slot_mask);
133 tcg_gen_or_tl(hex_reg_written[rnum + 1], hex_reg_written[rnum + 1],
134 slot_mask);
135 }
136 }
137
138 static void gen_log_reg_write_pair(int rnum, TCGv_i64 val)
139 {
140 const target_ulong reg_mask_low = reg_immut_masks[rnum];
141 const target_ulong reg_mask_high = reg_immut_masks[rnum + 1];
142 TCGv val32 = tcg_temp_new();
143
144 /* Low word */
145 tcg_gen_extrl_i64_i32(val32, val);
146 gen_masked_reg_write(val32, hex_gpr[rnum], reg_mask_low);
147 tcg_gen_mov_tl(hex_new_value[rnum], val32);
148 if (HEX_DEBUG) {
149 /* Do this so HELPER(debug_commit_end) will know */
150 tcg_gen_movi_tl(hex_reg_written[rnum], 1);
151 }
152
153 /* High word */
154 tcg_gen_extrh_i64_i32(val32, val);
155 gen_masked_reg_write(val32, hex_gpr[rnum + 1], reg_mask_high);
156 tcg_gen_mov_tl(hex_new_value[rnum + 1], val32);
157 if (HEX_DEBUG) {
158 /* Do this so HELPER(debug_commit_end) will know */
159 tcg_gen_movi_tl(hex_reg_written[rnum + 1], 1);
160 }
161 }
162
163 void gen_log_pred_write(DisasContext *ctx, int pnum, TCGv val)
164 {
165 TCGv base_val = tcg_temp_new();
166
167 tcg_gen_andi_tl(base_val, val, 0xff);
168
169 /*
170 * Section 6.1.3 of the Hexagon V67 Programmer's Reference Manual
171 *
172 * Multiple writes to the same preg are and'ed together
173 * If this is the first predicate write in the packet, do a
174 * straight assignment. Otherwise, do an and.
175 */
176 if (!test_bit(pnum, ctx->pregs_written)) {
177 tcg_gen_mov_tl(hex_new_pred_value[pnum], base_val);
178 } else {
179 tcg_gen_and_tl(hex_new_pred_value[pnum],
180 hex_new_pred_value[pnum], base_val);
181 }
182 tcg_gen_ori_tl(hex_pred_written, hex_pred_written, 1 << pnum);
183 }
184
185 static inline void gen_read_p3_0(TCGv control_reg)
186 {
187 tcg_gen_movi_tl(control_reg, 0);
188 for (int i = 0; i < NUM_PREGS; i++) {
189 tcg_gen_deposit_tl(control_reg, control_reg, hex_pred[i], i * 8, 8);
190 }
191 }
192
193 /*
194 * Certain control registers require special handling on read
195 * HEX_REG_P3_0_ALIASED aliased to the predicate registers
196 * -> concat the 4 predicate registers together
197 * HEX_REG_PC actual value stored in DisasContext
198 * -> assign from ctx->base.pc_next
199 * HEX_REG_QEMU_*_CNT changes in current TB in DisasContext
200 * -> add current TB changes to existing reg value
201 */
202 static inline void gen_read_ctrl_reg(DisasContext *ctx, const int reg_num,
203 TCGv dest)
204 {
205 if (reg_num == HEX_REG_P3_0_ALIASED) {
206 gen_read_p3_0(dest);
207 } else if (reg_num == HEX_REG_PC) {
208 tcg_gen_movi_tl(dest, ctx->base.pc_next);
209 } else if (reg_num == HEX_REG_QEMU_PKT_CNT) {
210 tcg_gen_addi_tl(dest, hex_gpr[HEX_REG_QEMU_PKT_CNT],
211 ctx->num_packets);
212 } else if (reg_num == HEX_REG_QEMU_INSN_CNT) {
213 tcg_gen_addi_tl(dest, hex_gpr[HEX_REG_QEMU_INSN_CNT],
214 ctx->num_insns);
215 } else if (reg_num == HEX_REG_QEMU_HVX_CNT) {
216 tcg_gen_addi_tl(dest, hex_gpr[HEX_REG_QEMU_HVX_CNT],
217 ctx->num_hvx_insns);
218 } else {
219 tcg_gen_mov_tl(dest, hex_gpr[reg_num]);
220 }
221 }
222
223 static inline void gen_read_ctrl_reg_pair(DisasContext *ctx, const int reg_num,
224 TCGv_i64 dest)
225 {
226 if (reg_num == HEX_REG_P3_0_ALIASED) {
227 TCGv p3_0 = tcg_temp_new();
228 gen_read_p3_0(p3_0);
229 tcg_gen_concat_i32_i64(dest, p3_0, hex_gpr[reg_num + 1]);
230 } else if (reg_num == HEX_REG_PC - 1) {
231 TCGv pc = tcg_constant_tl(ctx->base.pc_next);
232 tcg_gen_concat_i32_i64(dest, hex_gpr[reg_num], pc);
233 } else if (reg_num == HEX_REG_QEMU_PKT_CNT) {
234 TCGv pkt_cnt = tcg_temp_new();
235 TCGv insn_cnt = tcg_temp_new();
236 tcg_gen_addi_tl(pkt_cnt, hex_gpr[HEX_REG_QEMU_PKT_CNT],
237 ctx->num_packets);
238 tcg_gen_addi_tl(insn_cnt, hex_gpr[HEX_REG_QEMU_INSN_CNT],
239 ctx->num_insns);
240 tcg_gen_concat_i32_i64(dest, pkt_cnt, insn_cnt);
241 } else if (reg_num == HEX_REG_QEMU_HVX_CNT) {
242 TCGv hvx_cnt = tcg_temp_new();
243 tcg_gen_addi_tl(hvx_cnt, hex_gpr[HEX_REG_QEMU_HVX_CNT],
244 ctx->num_hvx_insns);
245 tcg_gen_concat_i32_i64(dest, hvx_cnt, hex_gpr[reg_num + 1]);
246 } else {
247 tcg_gen_concat_i32_i64(dest,
248 hex_gpr[reg_num],
249 hex_gpr[reg_num + 1]);
250 }
251 }
252
253 static void gen_write_p3_0(DisasContext *ctx, TCGv control_reg)
254 {
255 TCGv hex_p8 = tcg_temp_new();
256 for (int i = 0; i < NUM_PREGS; i++) {
257 tcg_gen_extract_tl(hex_p8, control_reg, i * 8, 8);
258 gen_log_pred_write(ctx, i, hex_p8);
259 ctx_log_pred_write(ctx, i);
260 }
261 }
262
263 /*
264 * Certain control registers require special handling on write
265 * HEX_REG_P3_0_ALIASED aliased to the predicate registers
266 * -> break the value across 4 predicate registers
267 * HEX_REG_QEMU_*_CNT changes in current TB in DisasContext
268 * -> clear the changes
269 */
270 static inline void gen_write_ctrl_reg(DisasContext *ctx, int reg_num,
271 TCGv val)
272 {
273 if (reg_num == HEX_REG_P3_0_ALIASED) {
274 gen_write_p3_0(ctx, val);
275 } else {
276 gen_log_reg_write(reg_num, val);
277 ctx_log_reg_write(ctx, reg_num);
278 if (reg_num == HEX_REG_QEMU_PKT_CNT) {
279 ctx->num_packets = 0;
280 }
281 if (reg_num == HEX_REG_QEMU_INSN_CNT) {
282 ctx->num_insns = 0;
283 }
284 if (reg_num == HEX_REG_QEMU_HVX_CNT) {
285 ctx->num_hvx_insns = 0;
286 }
287 }
288 }
289
290 static inline void gen_write_ctrl_reg_pair(DisasContext *ctx, int reg_num,
291 TCGv_i64 val)
292 {
293 if (reg_num == HEX_REG_P3_0_ALIASED) {
294 TCGv val32 = tcg_temp_new();
295 tcg_gen_extrl_i64_i32(val32, val);
296 gen_write_p3_0(ctx, val32);
297 tcg_gen_extrh_i64_i32(val32, val);
298 gen_log_reg_write(reg_num + 1, val32);
299 ctx_log_reg_write(ctx, reg_num + 1);
300 } else {
301 gen_log_reg_write_pair(reg_num, val);
302 ctx_log_reg_write_pair(ctx, reg_num);
303 if (reg_num == HEX_REG_QEMU_PKT_CNT) {
304 ctx->num_packets = 0;
305 ctx->num_insns = 0;
306 }
307 if (reg_num == HEX_REG_QEMU_HVX_CNT) {
308 ctx->num_hvx_insns = 0;
309 }
310 }
311 }
312
313 TCGv gen_get_byte(TCGv result, int N, TCGv src, bool sign)
314 {
315 if (sign) {
316 tcg_gen_sextract_tl(result, src, N * 8, 8);
317 } else {
318 tcg_gen_extract_tl(result, src, N * 8, 8);
319 }
320 return result;
321 }
322
323 TCGv gen_get_byte_i64(TCGv result, int N, TCGv_i64 src, bool sign)
324 {
325 TCGv_i64 res64 = tcg_temp_new_i64();
326 if (sign) {
327 tcg_gen_sextract_i64(res64, src, N * 8, 8);
328 } else {
329 tcg_gen_extract_i64(res64, src, N * 8, 8);
330 }
331 tcg_gen_extrl_i64_i32(result, res64);
332
333 return result;
334 }
335
336 TCGv gen_get_half(TCGv result, int N, TCGv src, bool sign)
337 {
338 if (sign) {
339 tcg_gen_sextract_tl(result, src, N * 16, 16);
340 } else {
341 tcg_gen_extract_tl(result, src, N * 16, 16);
342 }
343 return result;
344 }
345
346 void gen_set_half(int N, TCGv result, TCGv src)
347 {
348 tcg_gen_deposit_tl(result, result, src, N * 16, 16);
349 }
350
351 void gen_set_half_i64(int N, TCGv_i64 result, TCGv src)
352 {
353 TCGv_i64 src64 = tcg_temp_new_i64();
354 tcg_gen_extu_i32_i64(src64, src);
355 tcg_gen_deposit_i64(result, result, src64, N * 16, 16);
356 }
357
358 void gen_set_byte_i64(int N, TCGv_i64 result, TCGv src)
359 {
360 TCGv_i64 src64 = tcg_temp_new_i64();
361 tcg_gen_extu_i32_i64(src64, src);
362 tcg_gen_deposit_i64(result, result, src64, N * 8, 8);
363 }
364
365 static inline void gen_load_locked4u(TCGv dest, TCGv vaddr, int mem_index)
366 {
367 tcg_gen_qemu_ld32u(dest, vaddr, mem_index);
368 tcg_gen_mov_tl(hex_llsc_addr, vaddr);
369 tcg_gen_mov_tl(hex_llsc_val, dest);
370 }
371
372 static inline void gen_load_locked8u(TCGv_i64 dest, TCGv vaddr, int mem_index)
373 {
374 tcg_gen_qemu_ld64(dest, vaddr, mem_index);
375 tcg_gen_mov_tl(hex_llsc_addr, vaddr);
376 tcg_gen_mov_i64(hex_llsc_val_i64, dest);
377 }
378
379 static inline void gen_store_conditional4(DisasContext *ctx,
380 TCGv pred, TCGv vaddr, TCGv src)
381 {
382 TCGLabel *fail = gen_new_label();
383 TCGLabel *done = gen_new_label();
384 TCGv one, zero, tmp;
385
386 tcg_gen_brcond_tl(TCG_COND_NE, vaddr, hex_llsc_addr, fail);
387
388 one = tcg_constant_tl(0xff);
389 zero = tcg_constant_tl(0);
390 tmp = tcg_temp_new();
391 tcg_gen_atomic_cmpxchg_tl(tmp, hex_llsc_addr, hex_llsc_val, src,
392 ctx->mem_idx, MO_32);
393 tcg_gen_movcond_tl(TCG_COND_EQ, pred, tmp, hex_llsc_val,
394 one, zero);
395 tcg_gen_br(done);
396
397 gen_set_label(fail);
398 tcg_gen_movi_tl(pred, 0);
399
400 gen_set_label(done);
401 tcg_gen_movi_tl(hex_llsc_addr, ~0);
402 }
403
404 static inline void gen_store_conditional8(DisasContext *ctx,
405 TCGv pred, TCGv vaddr, TCGv_i64 src)
406 {
407 TCGLabel *fail = gen_new_label();
408 TCGLabel *done = gen_new_label();
409 TCGv_i64 one, zero, tmp;
410
411 tcg_gen_brcond_tl(TCG_COND_NE, vaddr, hex_llsc_addr, fail);
412
413 one = tcg_constant_i64(0xff);
414 zero = tcg_constant_i64(0);
415 tmp = tcg_temp_new_i64();
416 tcg_gen_atomic_cmpxchg_i64(tmp, hex_llsc_addr, hex_llsc_val_i64, src,
417 ctx->mem_idx, MO_64);
418 tcg_gen_movcond_i64(TCG_COND_EQ, tmp, tmp, hex_llsc_val_i64,
419 one, zero);
420 tcg_gen_extrl_i64_i32(pred, tmp);
421 tcg_gen_br(done);
422
423 gen_set_label(fail);
424 tcg_gen_movi_tl(pred, 0);
425
426 gen_set_label(done);
427 tcg_gen_movi_tl(hex_llsc_addr, ~0);
428 }
429
430 void gen_store32(TCGv vaddr, TCGv src, int width, uint32_t slot)
431 {
432 tcg_gen_mov_tl(hex_store_addr[slot], vaddr);
433 tcg_gen_movi_tl(hex_store_width[slot], width);
434 tcg_gen_mov_tl(hex_store_val32[slot], src);
435 }
436
437 void gen_store1(TCGv_env cpu_env, TCGv vaddr, TCGv src, uint32_t slot)
438 {
439 gen_store32(vaddr, src, 1, slot);
440 }
441
442 void gen_store1i(TCGv_env cpu_env, TCGv vaddr, int32_t src, uint32_t slot)
443 {
444 TCGv tmp = tcg_constant_tl(src);
445 gen_store1(cpu_env, vaddr, tmp, slot);
446 }
447
448 void gen_store2(TCGv_env cpu_env, TCGv vaddr, TCGv src, uint32_t slot)
449 {
450 gen_store32(vaddr, src, 2, slot);
451 }
452
453 void gen_store2i(TCGv_env cpu_env, TCGv vaddr, int32_t src, uint32_t slot)
454 {
455 TCGv tmp = tcg_constant_tl(src);
456 gen_store2(cpu_env, vaddr, tmp, slot);
457 }
458
459 void gen_store4(TCGv_env cpu_env, TCGv vaddr, TCGv src, uint32_t slot)
460 {
461 gen_store32(vaddr, src, 4, slot);
462 }
463
464 void gen_store4i(TCGv_env cpu_env, TCGv vaddr, int32_t src, uint32_t slot)
465 {
466 TCGv tmp = tcg_constant_tl(src);
467 gen_store4(cpu_env, vaddr, tmp, slot);
468 }
469
470 void gen_store8(TCGv_env cpu_env, TCGv vaddr, TCGv_i64 src, uint32_t slot)
471 {
472 tcg_gen_mov_tl(hex_store_addr[slot], vaddr);
473 tcg_gen_movi_tl(hex_store_width[slot], 8);
474 tcg_gen_mov_i64(hex_store_val64[slot], src);
475 }
476
477 void gen_store8i(TCGv_env cpu_env, TCGv vaddr, int64_t src, uint32_t slot)
478 {
479 TCGv_i64 tmp = tcg_constant_i64(src);
480 gen_store8(cpu_env, vaddr, tmp, slot);
481 }
482
483 TCGv gen_8bitsof(TCGv result, TCGv value)
484 {
485 TCGv zero = tcg_constant_tl(0);
486 TCGv ones = tcg_constant_tl(0xff);
487 tcg_gen_movcond_tl(TCG_COND_NE, result, value, zero, ones, zero);
488
489 return result;
490 }
491
492 static void gen_write_new_pc_addr(DisasContext *ctx, TCGv addr,
493 TCGCond cond, TCGv pred)
494 {
495 TCGLabel *pred_false = NULL;
496 if (cond != TCG_COND_ALWAYS) {
497 pred_false = gen_new_label();
498 tcg_gen_brcondi_tl(cond, pred, 0, pred_false);
499 }
500
501 if (ctx->pkt->pkt_has_multi_cof) {
502 /* If there are multiple branches in a packet, ignore the second one */
503 tcg_gen_movcond_tl(TCG_COND_NE, hex_gpr[HEX_REG_PC],
504 hex_branch_taken, tcg_constant_tl(0),
505 hex_gpr[HEX_REG_PC], addr);
506 tcg_gen_movi_tl(hex_branch_taken, 1);
507 } else {
508 tcg_gen_mov_tl(hex_gpr[HEX_REG_PC], addr);
509 }
510
511 if (cond != TCG_COND_ALWAYS) {
512 gen_set_label(pred_false);
513 }
514 }
515
516 static void gen_write_new_pc_pcrel(DisasContext *ctx, int pc_off,
517 TCGCond cond, TCGv pred)
518 {
519 target_ulong dest = ctx->pkt->pc + pc_off;
520 if (ctx->pkt->pkt_has_multi_cof) {
521 gen_write_new_pc_addr(ctx, tcg_constant_tl(dest), cond, pred);
522 } else {
523 /* Defer this jump to the end of the TB */
524 ctx->branch_cond = TCG_COND_ALWAYS;
525 if (pred != NULL) {
526 ctx->branch_cond = cond;
527 tcg_gen_mov_tl(hex_branch_taken, pred);
528 }
529 ctx->branch_dest = dest;
530 }
531 }
532
533 void gen_set_usr_field(int field, TCGv val)
534 {
535 tcg_gen_deposit_tl(hex_new_value[HEX_REG_USR], hex_new_value[HEX_REG_USR],
536 val,
537 reg_field_info[field].offset,
538 reg_field_info[field].width);
539 }
540
541 void gen_set_usr_fieldi(int field, int x)
542 {
543 if (reg_field_info[field].width == 1) {
544 target_ulong bit = 1 << reg_field_info[field].offset;
545 if ((x & 1) == 1) {
546 tcg_gen_ori_tl(hex_new_value[HEX_REG_USR],
547 hex_new_value[HEX_REG_USR],
548 bit);
549 } else {
550 tcg_gen_andi_tl(hex_new_value[HEX_REG_USR],
551 hex_new_value[HEX_REG_USR],
552 ~bit);
553 }
554 } else {
555 TCGv val = tcg_constant_tl(x);
556 gen_set_usr_field(field, val);
557 }
558 }
559
560 static void gen_compare(TCGCond cond, TCGv res, TCGv arg1, TCGv arg2)
561 {
562 TCGv one = tcg_constant_tl(0xff);
563 TCGv zero = tcg_constant_tl(0);
564
565 tcg_gen_movcond_tl(cond, res, arg1, arg2, one, zero);
566 }
567
568 static void gen_cond_jumpr(DisasContext *ctx, TCGv dst_pc,
569 TCGCond cond, TCGv pred)
570 {
571 gen_write_new_pc_addr(ctx, dst_pc, cond, pred);
572 }
573
574 static void gen_cond_jumpr31(DisasContext *ctx, TCGCond cond, TCGv pred)
575 {
576 TCGv LSB = tcg_temp_new();
577 tcg_gen_andi_tl(LSB, pred, 1);
578 gen_cond_jumpr(ctx, hex_gpr[HEX_REG_LR], cond, LSB);
579 }
580
581 static void gen_cond_jump(DisasContext *ctx, TCGCond cond, TCGv pred,
582 int pc_off)
583 {
584 gen_write_new_pc_pcrel(ctx, pc_off, cond, pred);
585 }
586
587 static void gen_cmpnd_cmp_jmp(DisasContext *ctx,
588 int pnum, TCGCond cond1, TCGv arg1, TCGv arg2,
589 TCGCond cond2, int pc_off)
590 {
591 if (ctx->insn->part1) {
592 TCGv pred = tcg_temp_new();
593 gen_compare(cond1, pred, arg1, arg2);
594 gen_log_pred_write(ctx, pnum, pred);
595 } else {
596 TCGv pred = tcg_temp_new();
597 tcg_gen_mov_tl(pred, hex_new_pred_value[pnum]);
598 gen_cond_jump(ctx, cond2, pred, pc_off);
599 }
600 }
601
602 static void gen_cmpnd_cmp_jmp_t(DisasContext *ctx,
603 int pnum, TCGCond cond, TCGv arg1, TCGv arg2,
604 int pc_off)
605 {
606 gen_cmpnd_cmp_jmp(ctx, pnum, cond, arg1, arg2, TCG_COND_EQ, pc_off);
607 }
608
609 static void gen_cmpnd_cmp_jmp_f(DisasContext *ctx,
610 int pnum, TCGCond cond, TCGv arg1, TCGv arg2,
611 int pc_off)
612 {
613 gen_cmpnd_cmp_jmp(ctx, pnum, cond, arg1, arg2, TCG_COND_NE, pc_off);
614 }
615
616 static void gen_cmpnd_cmpi_jmp_t(DisasContext *ctx,
617 int pnum, TCGCond cond, TCGv arg1, int arg2,
618 int pc_off)
619 {
620 TCGv tmp = tcg_constant_tl(arg2);
621 gen_cmpnd_cmp_jmp(ctx, pnum, cond, arg1, tmp, TCG_COND_EQ, pc_off);
622 }
623
624 static void gen_cmpnd_cmpi_jmp_f(DisasContext *ctx,
625 int pnum, TCGCond cond, TCGv arg1, int arg2,
626 int pc_off)
627 {
628 TCGv tmp = tcg_constant_tl(arg2);
629 gen_cmpnd_cmp_jmp(ctx, pnum, cond, arg1, tmp, TCG_COND_NE, pc_off);
630 }
631
632 static void gen_cmpnd_cmp_n1_jmp_t(DisasContext *ctx, int pnum, TCGCond cond,
633 TCGv arg, int pc_off)
634 {
635 gen_cmpnd_cmpi_jmp_t(ctx, pnum, cond, arg, -1, pc_off);
636 }
637
638 static void gen_cmpnd_cmp_n1_jmp_f(DisasContext *ctx, int pnum, TCGCond cond,
639 TCGv arg, int pc_off)
640 {
641 gen_cmpnd_cmpi_jmp_f(ctx, pnum, cond, arg, -1, pc_off);
642 }
643
644 static void gen_cmpnd_tstbit0_jmp(DisasContext *ctx,
645 int pnum, TCGv arg, TCGCond cond, int pc_off)
646 {
647 if (ctx->insn->part1) {
648 TCGv pred = tcg_temp_new();
649 tcg_gen_andi_tl(pred, arg, 1);
650 gen_8bitsof(pred, pred);
651 gen_log_pred_write(ctx, pnum, pred);
652 } else {
653 TCGv pred = tcg_temp_new();
654 tcg_gen_mov_tl(pred, hex_new_pred_value[pnum]);
655 gen_cond_jump(ctx, cond, pred, pc_off);
656 }
657 }
658
659 static void gen_testbit0_jumpnv(DisasContext *ctx,
660 TCGv arg, TCGCond cond, int pc_off)
661 {
662 TCGv pred = tcg_temp_new();
663 tcg_gen_andi_tl(pred, arg, 1);
664 gen_cond_jump(ctx, cond, pred, pc_off);
665 }
666
667 static void gen_jump(DisasContext *ctx, int pc_off)
668 {
669 gen_write_new_pc_pcrel(ctx, pc_off, TCG_COND_ALWAYS, NULL);
670 }
671
672 static void gen_jumpr(DisasContext *ctx, TCGv new_pc)
673 {
674 gen_write_new_pc_addr(ctx, new_pc, TCG_COND_ALWAYS, NULL);
675 }
676
677 static void gen_call(DisasContext *ctx, int pc_off)
678 {
679 TCGv next_PC =
680 tcg_constant_tl(ctx->pkt->pc + ctx->pkt->encod_pkt_size_in_bytes);
681 gen_log_reg_write(HEX_REG_LR, next_PC);
682 gen_write_new_pc_pcrel(ctx, pc_off, TCG_COND_ALWAYS, NULL);
683 }
684
685 static void gen_callr(DisasContext *ctx, TCGv new_pc)
686 {
687 TCGv next_PC = tcg_constant_tl(ctx->next_PC);
688 gen_log_reg_write(HEX_REG_LR, next_PC);
689 gen_write_new_pc_addr(ctx, new_pc, TCG_COND_ALWAYS, NULL);
690 }
691
692 static void gen_cond_call(DisasContext *ctx, TCGv pred,
693 TCGCond cond, int pc_off)
694 {
695 TCGv next_PC;
696 TCGv lsb = tcg_temp_new();
697 TCGLabel *skip = gen_new_label();
698 tcg_gen_andi_tl(lsb, pred, 1);
699 gen_write_new_pc_pcrel(ctx, pc_off, cond, lsb);
700 tcg_gen_brcondi_tl(cond, lsb, 0, skip);
701 next_PC =
702 tcg_constant_tl(ctx->pkt->pc + ctx->pkt->encod_pkt_size_in_bytes);
703 gen_log_reg_write(HEX_REG_LR, next_PC);
704 gen_set_label(skip);
705 }
706
707 static void gen_cond_callr(DisasContext *ctx,
708 TCGCond cond, TCGv pred, TCGv new_pc)
709 {
710 TCGv lsb = tcg_temp_new();
711 TCGLabel *skip = gen_new_label();
712 tcg_gen_andi_tl(lsb, pred, 1);
713 tcg_gen_brcondi_tl(cond, lsb, 0, skip);
714 gen_callr(ctx, new_pc);
715 gen_set_label(skip);
716 }
717
718 static void gen_endloop0(DisasContext *ctx)
719 {
720 TCGv lpcfg = tcg_temp_new();
721
722 GET_USR_FIELD(USR_LPCFG, lpcfg);
723
724 /*
725 * if (lpcfg == 1) {
726 * hex_new_pred_value[3] = 0xff;
727 * hex_pred_written |= 1 << 3;
728 * }
729 */
730 TCGLabel *label1 = gen_new_label();
731 tcg_gen_brcondi_tl(TCG_COND_NE, lpcfg, 1, label1);
732 {
733 tcg_gen_movi_tl(hex_new_pred_value[3], 0xff);
734 tcg_gen_ori_tl(hex_pred_written, hex_pred_written, 1 << 3);
735 }
736 gen_set_label(label1);
737
738 /*
739 * if (lpcfg) {
740 * SET_USR_FIELD(USR_LPCFG, lpcfg - 1);
741 * }
742 */
743 TCGLabel *label2 = gen_new_label();
744 tcg_gen_brcondi_tl(TCG_COND_EQ, lpcfg, 0, label2);
745 {
746 tcg_gen_subi_tl(lpcfg, lpcfg, 1);
747 SET_USR_FIELD(USR_LPCFG, lpcfg);
748 }
749 gen_set_label(label2);
750
751 /*
752 * If we're in a tight loop, we'll do this at the end of the TB to take
753 * advantage of direct block chaining.
754 */
755 if (!ctx->is_tight_loop) {
756 /*
757 * if (hex_gpr[HEX_REG_LC0] > 1) {
758 * PC = hex_gpr[HEX_REG_SA0];
759 * hex_new_value[HEX_REG_LC0] = hex_gpr[HEX_REG_LC0] - 1;
760 * }
761 */
762 TCGLabel *label3 = gen_new_label();
763 tcg_gen_brcondi_tl(TCG_COND_LEU, hex_gpr[HEX_REG_LC0], 1, label3);
764 {
765 gen_jumpr(ctx, hex_gpr[HEX_REG_SA0]);
766 tcg_gen_subi_tl(hex_new_value[HEX_REG_LC0],
767 hex_gpr[HEX_REG_LC0], 1);
768 }
769 gen_set_label(label3);
770 }
771 }
772
773 static void gen_cmp_jumpnv(DisasContext *ctx,
774 TCGCond cond, TCGv val, TCGv src, int pc_off)
775 {
776 TCGv pred = tcg_temp_new();
777 tcg_gen_setcond_tl(cond, pred, val, src);
778 gen_cond_jump(ctx, TCG_COND_EQ, pred, pc_off);
779 }
780
781 static void gen_cmpi_jumpnv(DisasContext *ctx,
782 TCGCond cond, TCGv val, int src, int pc_off)
783 {
784 TCGv pred = tcg_temp_new();
785 tcg_gen_setcondi_tl(cond, pred, val, src);
786 gen_cond_jump(ctx, TCG_COND_EQ, pred, pc_off);
787 }
788
789 /* Shift left with saturation */
790 static void gen_shl_sat(TCGv dst, TCGv src, TCGv shift_amt)
791 {
792 TCGv sh32 = tcg_temp_new();
793 TCGv dst_sar = tcg_temp_new();
794 TCGv ovf = tcg_temp_new();
795 TCGv satval = tcg_temp_new();
796 TCGv min = tcg_constant_tl(0x80000000);
797 TCGv max = tcg_constant_tl(0x7fffffff);
798
799 /*
800 * Possible values for shift_amt are 0 .. 64
801 * We need special handling for values above 31
802 *
803 * sh32 = shift & 31;
804 * dst = sh32 == shift ? src : 0;
805 * dst <<= sh32;
806 * dst_sar = dst >> sh32;
807 * satval = src < 0 ? min : max;
808 * if (dst_asr != src) {
809 * usr.OVF |= 1;
810 * dst = satval;
811 * }
812 */
813
814 tcg_gen_andi_tl(sh32, shift_amt, 31);
815 tcg_gen_movcond_tl(TCG_COND_EQ, dst, sh32, shift_amt,
816 src, tcg_constant_tl(0));
817 tcg_gen_shl_tl(dst, dst, sh32);
818 tcg_gen_sar_tl(dst_sar, dst, sh32);
819 tcg_gen_movcond_tl(TCG_COND_LT, satval, src, tcg_constant_tl(0), min, max);
820
821 tcg_gen_setcond_tl(TCG_COND_NE, ovf, dst_sar, src);
822 tcg_gen_shli_tl(ovf, ovf, reg_field_info[USR_OVF].offset);
823 tcg_gen_or_tl(hex_new_value[HEX_REG_USR], hex_new_value[HEX_REG_USR], ovf);
824
825 tcg_gen_movcond_tl(TCG_COND_EQ, dst, dst_sar, src, dst, satval);
826 }
827
828 static void gen_sar(TCGv dst, TCGv src, TCGv shift_amt)
829 {
830 /*
831 * Shift arithmetic right
832 * Robust when shift_amt is >31 bits
833 */
834 TCGv tmp = tcg_temp_new();
835 tcg_gen_umin_tl(tmp, shift_amt, tcg_constant_tl(31));
836 tcg_gen_sar_tl(dst, src, tmp);
837 }
838
839 /* Bidirectional shift right with saturation */
840 static void gen_asr_r_r_sat(TCGv RdV, TCGv RsV, TCGv RtV)
841 {
842 TCGv shift_amt = tcg_temp_new();
843 TCGLabel *positive = gen_new_label();
844 TCGLabel *done = gen_new_label();
845
846 tcg_gen_sextract_i32(shift_amt, RtV, 0, 7);
847 tcg_gen_brcondi_tl(TCG_COND_GE, shift_amt, 0, positive);
848
849 /* Negative shift amount => shift left */
850 tcg_gen_neg_tl(shift_amt, shift_amt);
851 gen_shl_sat(RdV, RsV, shift_amt);
852 tcg_gen_br(done);
853
854 gen_set_label(positive);
855 /* Positive shift amount => shift right */
856 gen_sar(RdV, RsV, shift_amt);
857
858 gen_set_label(done);
859 }
860
861 /* Bidirectional shift left with saturation */
862 static void gen_asl_r_r_sat(TCGv RdV, TCGv RsV, TCGv RtV)
863 {
864 TCGv shift_amt = tcg_temp_new();
865 TCGLabel *positive = gen_new_label();
866 TCGLabel *done = gen_new_label();
867
868 tcg_gen_sextract_i32(shift_amt, RtV, 0, 7);
869 tcg_gen_brcondi_tl(TCG_COND_GE, shift_amt, 0, positive);
870
871 /* Negative shift amount => shift right */
872 tcg_gen_neg_tl(shift_amt, shift_amt);
873 gen_sar(RdV, RsV, shift_amt);
874 tcg_gen_br(done);
875
876 gen_set_label(positive);
877 /* Positive shift amount => shift left */
878 gen_shl_sat(RdV, RsV, shift_amt);
879
880 gen_set_label(done);
881 }
882
883 static intptr_t vreg_src_off(DisasContext *ctx, int num)
884 {
885 intptr_t offset = offsetof(CPUHexagonState, VRegs[num]);
886
887 if (test_bit(num, ctx->vregs_select)) {
888 offset = ctx_future_vreg_off(ctx, num, 1, false);
889 }
890 if (test_bit(num, ctx->vregs_updated_tmp)) {
891 offset = ctx_tmp_vreg_off(ctx, num, 1, false);
892 }
893 return offset;
894 }
895
896 static void gen_log_vreg_write(DisasContext *ctx, intptr_t srcoff, int num,
897 VRegWriteType type, int slot_num,
898 bool is_predicated)
899 {
900 TCGLabel *label_end = NULL;
901 intptr_t dstoff;
902
903 if (is_predicated) {
904 TCGv cancelled = tcg_temp_new();
905 label_end = gen_new_label();
906
907 /* Don't do anything if the slot was cancelled */
908 tcg_gen_extract_tl(cancelled, hex_slot_cancelled, slot_num, 1);
909 tcg_gen_brcondi_tl(TCG_COND_NE, cancelled, 0, label_end);
910 }
911
912 if (type != EXT_TMP) {
913 dstoff = ctx_future_vreg_off(ctx, num, 1, true);
914 tcg_gen_gvec_mov(MO_64, dstoff, srcoff,
915 sizeof(MMVector), sizeof(MMVector));
916 tcg_gen_ori_tl(hex_VRegs_updated, hex_VRegs_updated, 1 << num);
917 } else {
918 dstoff = ctx_tmp_vreg_off(ctx, num, 1, false);
919 tcg_gen_gvec_mov(MO_64, dstoff, srcoff,
920 sizeof(MMVector), sizeof(MMVector));
921 }
922
923 if (is_predicated) {
924 gen_set_label(label_end);
925 }
926 }
927
928 static void gen_log_vreg_write_pair(DisasContext *ctx, intptr_t srcoff, int num,
929 VRegWriteType type, int slot_num,
930 bool is_predicated)
931 {
932 gen_log_vreg_write(ctx, srcoff, num ^ 0, type, slot_num, is_predicated);
933 srcoff += sizeof(MMVector);
934 gen_log_vreg_write(ctx, srcoff, num ^ 1, type, slot_num, is_predicated);
935 }
936
937 static void gen_log_qreg_write(intptr_t srcoff, int num, int vnew,
938 int slot_num, bool is_predicated)
939 {
940 TCGLabel *label_end = NULL;
941 intptr_t dstoff;
942
943 if (is_predicated) {
944 TCGv cancelled = tcg_temp_new();
945 label_end = gen_new_label();
946
947 /* Don't do anything if the slot was cancelled */
948 tcg_gen_extract_tl(cancelled, hex_slot_cancelled, slot_num, 1);
949 tcg_gen_brcondi_tl(TCG_COND_NE, cancelled, 0, label_end);
950 }
951
952 dstoff = offsetof(CPUHexagonState, future_QRegs[num]);
953 tcg_gen_gvec_mov(MO_64, dstoff, srcoff, sizeof(MMQReg), sizeof(MMQReg));
954
955 if (is_predicated) {
956 tcg_gen_ori_tl(hex_QRegs_updated, hex_QRegs_updated, 1 << num);
957 gen_set_label(label_end);
958 }
959 }
960
961 static void gen_vreg_load(DisasContext *ctx, intptr_t dstoff, TCGv src,
962 bool aligned)
963 {
964 TCGv_i64 tmp = tcg_temp_new_i64();
965 if (aligned) {
966 tcg_gen_andi_tl(src, src, ~((int32_t)sizeof(MMVector) - 1));
967 }
968 for (int i = 0; i < sizeof(MMVector) / 8; i++) {
969 tcg_gen_qemu_ld64(tmp, src, ctx->mem_idx);
970 tcg_gen_addi_tl(src, src, 8);
971 tcg_gen_st_i64(tmp, cpu_env, dstoff + i * 8);
972 }
973 }
974
975 static void gen_vreg_store(DisasContext *ctx, TCGv EA, intptr_t srcoff,
976 int slot, bool aligned)
977 {
978 intptr_t dstoff = offsetof(CPUHexagonState, vstore[slot].data);
979 intptr_t maskoff = offsetof(CPUHexagonState, vstore[slot].mask);
980
981 if (is_gather_store_insn(ctx)) {
982 TCGv sl = tcg_constant_tl(slot);
983 gen_helper_gather_store(cpu_env, EA, sl);
984 return;
985 }
986
987 tcg_gen_movi_tl(hex_vstore_pending[slot], 1);
988 if (aligned) {
989 tcg_gen_andi_tl(hex_vstore_addr[slot], EA,
990 ~((int32_t)sizeof(MMVector) - 1));
991 } else {
992 tcg_gen_mov_tl(hex_vstore_addr[slot], EA);
993 }
994 tcg_gen_movi_tl(hex_vstore_size[slot], sizeof(MMVector));
995
996 /* Copy the data to the vstore buffer */
997 tcg_gen_gvec_mov(MO_64, dstoff, srcoff, sizeof(MMVector), sizeof(MMVector));
998 /* Set the mask to all 1's */
999 tcg_gen_gvec_dup_imm(MO_64, maskoff, sizeof(MMQReg), sizeof(MMQReg), ~0LL);
1000 }
1001
1002 static void gen_vreg_masked_store(DisasContext *ctx, TCGv EA, intptr_t srcoff,
1003 intptr_t bitsoff, int slot, bool invert)
1004 {
1005 intptr_t dstoff = offsetof(CPUHexagonState, vstore[slot].data);
1006 intptr_t maskoff = offsetof(CPUHexagonState, vstore[slot].mask);
1007
1008 tcg_gen_movi_tl(hex_vstore_pending[slot], 1);
1009 tcg_gen_andi_tl(hex_vstore_addr[slot], EA,
1010 ~((int32_t)sizeof(MMVector) - 1));
1011 tcg_gen_movi_tl(hex_vstore_size[slot], sizeof(MMVector));
1012
1013 /* Copy the data to the vstore buffer */
1014 tcg_gen_gvec_mov(MO_64, dstoff, srcoff, sizeof(MMVector), sizeof(MMVector));
1015 /* Copy the mask */
1016 tcg_gen_gvec_mov(MO_64, maskoff, bitsoff, sizeof(MMQReg), sizeof(MMQReg));
1017 if (invert) {
1018 tcg_gen_gvec_not(MO_64, maskoff, maskoff,
1019 sizeof(MMQReg), sizeof(MMQReg));
1020 }
1021 }
1022
1023 static void vec_to_qvec(size_t size, intptr_t dstoff, intptr_t srcoff)
1024 {
1025 TCGv_i64 tmp = tcg_temp_new_i64();
1026 TCGv_i64 word = tcg_temp_new_i64();
1027 TCGv_i64 bits = tcg_temp_new_i64();
1028 TCGv_i64 mask = tcg_temp_new_i64();
1029 TCGv_i64 zero = tcg_constant_i64(0);
1030 TCGv_i64 ones = tcg_constant_i64(~0);
1031
1032 for (int i = 0; i < sizeof(MMVector) / 8; i++) {
1033 tcg_gen_ld_i64(tmp, cpu_env, srcoff + i * 8);
1034 tcg_gen_movi_i64(mask, 0);
1035
1036 for (int j = 0; j < 8; j += size) {
1037 tcg_gen_extract_i64(word, tmp, j * 8, size * 8);
1038 tcg_gen_movcond_i64(TCG_COND_NE, bits, word, zero, ones, zero);
1039 tcg_gen_deposit_i64(mask, mask, bits, j, size);
1040 }
1041
1042 tcg_gen_st8_i64(mask, cpu_env, dstoff + i);
1043 }
1044 }
1045
1046 void probe_noshuf_load(TCGv va, int s, int mi)
1047 {
1048 TCGv size = tcg_constant_tl(s);
1049 TCGv mem_idx = tcg_constant_tl(mi);
1050 gen_helper_probe_noshuf_load(cpu_env, va, size, mem_idx);
1051 }
1052
1053 /*
1054 * Note: Since this function might branch, `val` is
1055 * required to be a `tcg_temp_local`.
1056 */
1057 void gen_set_usr_field_if(int field, TCGv val)
1058 {
1059 /* Sets the USR field if `val` is non-zero */
1060 if (reg_field_info[field].width == 1) {
1061 TCGv tmp = tcg_temp_new();
1062 tcg_gen_extract_tl(tmp, val, 0, reg_field_info[field].width);
1063 tcg_gen_shli_tl(tmp, tmp, reg_field_info[field].offset);
1064 tcg_gen_or_tl(hex_new_value[HEX_REG_USR],
1065 hex_new_value[HEX_REG_USR],
1066 tmp);
1067 } else {
1068 TCGLabel *skip_label = gen_new_label();
1069 tcg_gen_brcondi_tl(TCG_COND_EQ, val, 0, skip_label);
1070 gen_set_usr_field(field, val);
1071 gen_set_label(skip_label);
1072 }
1073 }
1074
1075 void gen_sat_i32(TCGv dest, TCGv source, int width)
1076 {
1077 TCGv max_val = tcg_constant_tl((1 << (width - 1)) - 1);
1078 TCGv min_val = tcg_constant_tl(-(1 << (width - 1)));
1079 tcg_gen_smin_tl(dest, source, max_val);
1080 tcg_gen_smax_tl(dest, dest, min_val);
1081 }
1082
1083 void gen_sat_i32_ovfl(TCGv ovfl, TCGv dest, TCGv source, int width)
1084 {
1085 gen_sat_i32(dest, source, width);
1086 tcg_gen_setcond_tl(TCG_COND_NE, ovfl, source, dest);
1087 }
1088
1089 void gen_satu_i32(TCGv dest, TCGv source, int width)
1090 {
1091 TCGv max_val = tcg_constant_tl((1 << width) - 1);
1092 TCGv zero = tcg_constant_tl(0);
1093 tcg_gen_movcond_tl(TCG_COND_GTU, dest, source, max_val, max_val, source);
1094 tcg_gen_movcond_tl(TCG_COND_LT, dest, source, zero, zero, dest);
1095 }
1096
1097 void gen_satu_i32_ovfl(TCGv ovfl, TCGv dest, TCGv source, int width)
1098 {
1099 gen_satu_i32(dest, source, width);
1100 tcg_gen_setcond_tl(TCG_COND_NE, ovfl, source, dest);
1101 }
1102
1103 void gen_sat_i64(TCGv_i64 dest, TCGv_i64 source, int width)
1104 {
1105 TCGv_i64 max_val = tcg_constant_i64((1LL << (width - 1)) - 1LL);
1106 TCGv_i64 min_val = tcg_constant_i64(-(1LL << (width - 1)));
1107 tcg_gen_smin_i64(dest, source, max_val);
1108 tcg_gen_smax_i64(dest, dest, min_val);
1109 }
1110
1111 void gen_sat_i64_ovfl(TCGv ovfl, TCGv_i64 dest, TCGv_i64 source, int width)
1112 {
1113 TCGv_i64 ovfl_64;
1114 gen_sat_i64(dest, source, width);
1115 ovfl_64 = tcg_temp_new_i64();
1116 tcg_gen_setcond_i64(TCG_COND_NE, ovfl_64, dest, source);
1117 tcg_gen_trunc_i64_tl(ovfl, ovfl_64);
1118 }
1119
1120 void gen_satu_i64(TCGv_i64 dest, TCGv_i64 source, int width)
1121 {
1122 TCGv_i64 max_val = tcg_constant_i64((1LL << width) - 1LL);
1123 TCGv_i64 zero = tcg_constant_i64(0);
1124 tcg_gen_movcond_i64(TCG_COND_GTU, dest, source, max_val, max_val, source);
1125 tcg_gen_movcond_i64(TCG_COND_LT, dest, source, zero, zero, dest);
1126 }
1127
1128 void gen_satu_i64_ovfl(TCGv ovfl, TCGv_i64 dest, TCGv_i64 source, int width)
1129 {
1130 TCGv_i64 ovfl_64;
1131 gen_satu_i64(dest, source, width);
1132 ovfl_64 = tcg_temp_new_i64();
1133 tcg_gen_setcond_i64(TCG_COND_NE, ovfl_64, dest, source);
1134 tcg_gen_trunc_i64_tl(ovfl, ovfl_64);
1135 }
1136
1137 /* Implements the fADDSAT64 macro in TCG */
1138 void gen_add_sat_i64(TCGv_i64 ret, TCGv_i64 a, TCGv_i64 b)
1139 {
1140 TCGv_i64 sum = tcg_temp_new_i64();
1141 TCGv_i64 xor = tcg_temp_new_i64();
1142 TCGv_i64 cond1 = tcg_temp_new_i64();
1143 TCGv_i64 cond2 = tcg_temp_new_i64();
1144 TCGv_i64 cond3 = tcg_temp_new_i64();
1145 TCGv_i64 mask = tcg_constant_i64(0x8000000000000000ULL);
1146 TCGv_i64 max_pos = tcg_constant_i64(0x7FFFFFFFFFFFFFFFLL);
1147 TCGv_i64 max_neg = tcg_constant_i64(0x8000000000000000LL);
1148 TCGv_i64 zero = tcg_constant_i64(0);
1149 TCGLabel *no_ovfl_label = gen_new_label();
1150 TCGLabel *ovfl_label = gen_new_label();
1151 TCGLabel *ret_label = gen_new_label();
1152
1153 tcg_gen_add_i64(sum, a, b);
1154 tcg_gen_xor_i64(xor, a, b);
1155
1156 /* if (xor & mask) */
1157 tcg_gen_and_i64(cond1, xor, mask);
1158 tcg_gen_brcondi_i64(TCG_COND_NE, cond1, 0, no_ovfl_label);
1159
1160 /* else if ((a ^ sum) & mask) */
1161 tcg_gen_xor_i64(cond2, a, sum);
1162 tcg_gen_and_i64(cond2, cond2, mask);
1163 tcg_gen_brcondi_i64(TCG_COND_NE, cond2, 0, ovfl_label);
1164 /* fallthrough to no_ovfl_label branch */
1165
1166 /* if branch */
1167 gen_set_label(no_ovfl_label);
1168 tcg_gen_mov_i64(ret, sum);
1169 tcg_gen_br(ret_label);
1170
1171 /* else if branch */
1172 gen_set_label(ovfl_label);
1173 tcg_gen_and_i64(cond3, sum, mask);
1174 tcg_gen_movcond_i64(TCG_COND_NE, ret, cond3, zero, max_pos, max_neg);
1175 SET_USR_FIELD(USR_OVF, 1);
1176
1177 gen_set_label(ret_label);
1178 }
1179
1180 #include "tcg_funcs_generated.c.inc"
1181 #include "tcg_func_table_generated.c.inc"