xref: /openbmc/qemu/target/hppa/op_helper.c (revision 406d2aa2) 
1 /*
2  * Helpers for HPPA instructions.
3  *
4  * Copyright (c) 2016 Richard Henderson <rth@twiddle.net>
5  *
6  * This library is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * License as published by the Free Software Foundation; either
9  * version 2 of the License, or (at your option) any later version.
10  *
11  * This library is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
18  */
19 
20 #include "qemu/osdep.h"
21 #include "cpu.h"
22 #include "exec/exec-all.h"
23 #include "exec/helper-proto.h"
24 #include "exec/cpu_ldst.h"
25 
26 void QEMU_NORETURN HELPER(excp)(CPUHPPAState *env, int excp)
27 {
28     HPPACPU *cpu = hppa_env_get_cpu(env);
29     CPUState *cs = CPU(cpu);
30 
31     cs->exception_index = excp;
32     cpu_loop_exit(cs);
33 }
34 
35 static void QEMU_NORETURN dynexcp(CPUHPPAState *env, int excp, uintptr_t ra)
36 {
37     HPPACPU *cpu = hppa_env_get_cpu(env);
38     CPUState *cs = CPU(cpu);
39 
40     cs->exception_index = excp;
41     cpu_loop_exit_restore(cs, ra);
42 }
43 
44 void HELPER(tsv)(CPUHPPAState *env, target_ulong cond)
45 {
46     if (unlikely((target_long)cond < 0)) {
47         dynexcp(env, EXCP_SIGFPE, GETPC());
48     }
49 }
50 
51 void HELPER(tcond)(CPUHPPAState *env, target_ulong cond)
52 {
53     if (unlikely(cond)) {
54         dynexcp(env, EXCP_SIGFPE, GETPC());
55     }
56 }
57 
58 static void atomic_store_3(CPUHPPAState *env, target_ulong addr, uint32_t val,
59                            uint32_t mask, uintptr_t ra)
60 {
61     uint32_t old, new, cmp;
62 
63 #ifdef CONFIG_USER_ONLY
64     uint32_t *haddr = g2h(addr - 1);
65     old = *haddr;
66     while (1) {
67         new = (old & ~mask) | (val & mask);
68         cmp = atomic_cmpxchg(haddr, old, new);
69         if (cmp == old) {
70             return;
71         }
72         old = cmp;
73     }
74 #else
75 #error "Not implemented."
76 #endif
77 }
78 
79 static void do_stby_b(CPUHPPAState *env, target_ulong addr, target_ulong val,
80                       bool parallel)
81 {
82     uintptr_t ra = GETPC();
83 
84     switch (addr & 3) {
85     case 3:
86         cpu_stb_data_ra(env, addr, val, ra);
87         break;
88     case 2:
89         cpu_stw_data_ra(env, addr, val, ra);
90         break;
91     case 1:
92         /* The 3 byte store must appear atomic.  */
93         if (parallel) {
94             atomic_store_3(env, addr, val, 0x00ffffffu, ra);
95         } else {
96             cpu_stb_data_ra(env, addr, val >> 16, ra);
97             cpu_stw_data_ra(env, addr + 1, val, ra);
98         }
99         break;
100     default:
101         cpu_stl_data_ra(env, addr, val, ra);
102         break;
103     }
104 }
105 
106 void HELPER(stby_b)(CPUHPPAState *env, target_ulong addr, target_ulong val)
107 {
108     do_stby_b(env, addr, val, false);
109 }
110 
111 void HELPER(stby_b_parallel)(CPUHPPAState *env, target_ulong addr,
112                              target_ulong val)
113 {
114     do_stby_b(env, addr, val, true);
115 }
116 
117 static void do_stby_e(CPUHPPAState *env, target_ulong addr, target_ulong val,
118                       bool parallel)
119 {
120     uintptr_t ra = GETPC();
121 
122     switch (addr & 3) {
123     case 3:
124         /* The 3 byte store must appear atomic.  */
125         if (parallel) {
126             atomic_store_3(env, addr - 3, val, 0xffffff00u, ra);
127         } else {
128             cpu_stw_data_ra(env, addr - 3, val >> 16, ra);
129             cpu_stb_data_ra(env, addr - 1, val >> 8, ra);
130         }
131         break;
132     case 2:
133         cpu_stw_data_ra(env, addr - 2, val >> 16, ra);
134         break;
135     case 1:
136         cpu_stb_data_ra(env, addr - 1, val >> 24, ra);
137         break;
138     default:
139         /* Nothing is stored, but protection is checked and the
140            cacheline is marked dirty.  */
141 #ifndef CONFIG_USER_ONLY
142         probe_write(env, addr, cpu_mmu_index(env, 0), ra);
143 #endif
144         break;
145     }
146 }
147 
148 void HELPER(stby_e)(CPUHPPAState *env, target_ulong addr, target_ulong val)
149 {
150     do_stby_e(env, addr, val, false);
151 }
152 
153 void HELPER(stby_e_parallel)(CPUHPPAState *env, target_ulong addr,
154                              target_ulong val)
155 {
156     do_stby_e(env, addr, val, true);
157 }
158 
159 target_ulong HELPER(probe_r)(target_ulong addr)
160 {
161     return page_check_range(addr, 1, PAGE_READ);
162 }
163 
164 target_ulong HELPER(probe_w)(target_ulong addr)
165 {
166     return page_check_range(addr, 1, PAGE_WRITE);
167 }
168 
169 void HELPER(loaded_fr0)(CPUHPPAState *env)
170 {
171     uint32_t shadow = env->fr[0] >> 32;
172     int rm, d;
173 
174     env->fr0_shadow = shadow;
175 
176     switch (extract32(shadow, 9, 2)) {
177     default:
178         rm = float_round_nearest_even;
179         break;
180     case 1:
181         rm = float_round_to_zero;
182         break;
183     case 2:
184         rm = float_round_up;
185         break;
186     case 3:
187         rm = float_round_down;
188         break;
189     }
190     set_float_rounding_mode(rm, &env->fp_status);
191 
192     d = extract32(shadow, 5, 1);
193     set_flush_to_zero(d, &env->fp_status);
194     set_flush_inputs_to_zero(d, &env->fp_status);
195 }
196 
197 void cpu_hppa_loaded_fr0(CPUHPPAState *env)
198 {
199     helper_loaded_fr0(env);
200 }
201 
202 #define CONVERT_BIT(X, SRC, DST)        \
203     ((SRC) > (DST)                      \
204      ? (X) / ((SRC) / (DST)) & (DST)    \
205      : ((X) & (SRC)) * ((DST) / (SRC)))
206 
207 static void update_fr0_op(CPUHPPAState *env, uintptr_t ra)
208 {
209     uint32_t soft_exp = get_float_exception_flags(&env->fp_status);
210     uint32_t hard_exp = 0;
211     uint32_t shadow = env->fr0_shadow;
212 
213     if (likely(soft_exp == 0)) {
214         env->fr[0] = (uint64_t)shadow << 32;
215         return;
216     }
217     set_float_exception_flags(0, &env->fp_status);
218 
219     hard_exp |= CONVERT_BIT(soft_exp, float_flag_inexact,   1u << 0);
220     hard_exp |= CONVERT_BIT(soft_exp, float_flag_underflow, 1u << 1);
221     hard_exp |= CONVERT_BIT(soft_exp, float_flag_overflow,  1u << 2);
222     hard_exp |= CONVERT_BIT(soft_exp, float_flag_divbyzero, 1u << 3);
223     hard_exp |= CONVERT_BIT(soft_exp, float_flag_invalid,   1u << 4);
224     shadow |= hard_exp << (32 - 5);
225     env->fr0_shadow = shadow;
226     env->fr[0] = (uint64_t)shadow << 32;
227 
228     if (hard_exp & shadow) {
229         dynexcp(env, EXCP_SIGFPE, ra);
230     }
231 }
232 
233 float32 HELPER(fsqrt_s)(CPUHPPAState *env, float32 arg)
234 {
235     float32 ret = float32_sqrt(arg, &env->fp_status);
236     update_fr0_op(env, GETPC());
237     return ret;
238 }
239 
240 float32 HELPER(frnd_s)(CPUHPPAState *env, float32 arg)
241 {
242     float32 ret = float32_round_to_int(arg, &env->fp_status);
243     update_fr0_op(env, GETPC());
244     return ret;
245 }
246 
247 float32 HELPER(fadd_s)(CPUHPPAState *env, float32 a, float32 b)
248 {
249     float32 ret = float32_add(a, b, &env->fp_status);
250     update_fr0_op(env, GETPC());
251     return ret;
252 }
253 
254 float32 HELPER(fsub_s)(CPUHPPAState *env, float32 a, float32 b)
255 {
256     float32 ret = float32_sub(a, b, &env->fp_status);
257     update_fr0_op(env, GETPC());
258     return ret;
259 }
260 
261 float32 HELPER(fmpy_s)(CPUHPPAState *env, float32 a, float32 b)
262 {
263     float32 ret = float32_mul(a, b, &env->fp_status);
264     update_fr0_op(env, GETPC());
265     return ret;
266 }
267 
268 float32 HELPER(fdiv_s)(CPUHPPAState *env, float32 a, float32 b)
269 {
270     float32 ret = float32_div(a, b, &env->fp_status);
271     update_fr0_op(env, GETPC());
272     return ret;
273 }
274 
275 float64 HELPER(fsqrt_d)(CPUHPPAState *env, float64 arg)
276 {
277     float64 ret = float64_sqrt(arg, &env->fp_status);
278     update_fr0_op(env, GETPC());
279     return ret;
280 }
281 
282 float64 HELPER(frnd_d)(CPUHPPAState *env, float64 arg)
283 {
284     float64 ret = float64_round_to_int(arg, &env->fp_status);
285     update_fr0_op(env, GETPC());
286     return ret;
287 }
288 
289 float64 HELPER(fadd_d)(CPUHPPAState *env, float64 a, float64 b)
290 {
291     float64 ret = float64_add(a, b, &env->fp_status);
292     update_fr0_op(env, GETPC());
293     return ret;
294 }
295 
296 float64 HELPER(fsub_d)(CPUHPPAState *env, float64 a, float64 b)
297 {
298     float64 ret = float64_sub(a, b, &env->fp_status);
299     update_fr0_op(env, GETPC());
300     return ret;
301 }
302 
303 float64 HELPER(fmpy_d)(CPUHPPAState *env, float64 a, float64 b)
304 {
305     float64 ret = float64_mul(a, b, &env->fp_status);
306     update_fr0_op(env, GETPC());
307     return ret;
308 }
309 
310 float64 HELPER(fdiv_d)(CPUHPPAState *env, float64 a, float64 b)
311 {
312     float64 ret = float64_div(a, b, &env->fp_status);
313     update_fr0_op(env, GETPC());
314     return ret;
315 }
316 
317 float64 HELPER(fcnv_s_d)(CPUHPPAState *env, float32 arg)
318 {
319     float64 ret = float32_to_float64(arg, &env->fp_status);
320     ret = float64_maybe_silence_nan(ret, &env->fp_status);
321     update_fr0_op(env, GETPC());
322     return ret;
323 }
324 
325 float32 HELPER(fcnv_d_s)(CPUHPPAState *env, float64 arg)
326 {
327     float32 ret = float64_to_float32(arg, &env->fp_status);
328     ret = float32_maybe_silence_nan(ret, &env->fp_status);
329     update_fr0_op(env, GETPC());
330     return ret;
331 }
332 
333 float32 HELPER(fcnv_w_s)(CPUHPPAState *env, int32_t arg)
334 {
335     float32 ret = int32_to_float32(arg, &env->fp_status);
336     update_fr0_op(env, GETPC());
337     return ret;
338 }
339 
340 float32 HELPER(fcnv_dw_s)(CPUHPPAState *env, int64_t arg)
341 {
342     float32 ret = int64_to_float32(arg, &env->fp_status);
343     update_fr0_op(env, GETPC());
344     return ret;
345 }
346 
347 float64 HELPER(fcnv_w_d)(CPUHPPAState *env, int32_t arg)
348 {
349     float64 ret = int32_to_float64(arg, &env->fp_status);
350     update_fr0_op(env, GETPC());
351     return ret;
352 }
353 
354 float64 HELPER(fcnv_dw_d)(CPUHPPAState *env, int64_t arg)
355 {
356     float64 ret = int64_to_float64(arg, &env->fp_status);
357     update_fr0_op(env, GETPC());
358     return ret;
359 }
360 
361 int32_t HELPER(fcnv_s_w)(CPUHPPAState *env, float32 arg)
362 {
363     int32_t ret = float32_to_int32(arg, &env->fp_status);
364     update_fr0_op(env, GETPC());
365     return ret;
366 }
367 
368 int32_t HELPER(fcnv_d_w)(CPUHPPAState *env, float64 arg)
369 {
370     int32_t ret = float64_to_int32(arg, &env->fp_status);
371     update_fr0_op(env, GETPC());
372     return ret;
373 }
374 
375 int64_t HELPER(fcnv_s_dw)(CPUHPPAState *env, float32 arg)
376 {
377     int64_t ret = float32_to_int64(arg, &env->fp_status);
378     update_fr0_op(env, GETPC());
379     return ret;
380 }
381 
382 int64_t HELPER(fcnv_d_dw)(CPUHPPAState *env, float64 arg)
383 {
384     int64_t ret = float64_to_int64(arg, &env->fp_status);
385     update_fr0_op(env, GETPC());
386     return ret;
387 }
388 
389 int32_t HELPER(fcnv_t_s_w)(CPUHPPAState *env, float32 arg)
390 {
391     int32_t ret = float32_to_int32_round_to_zero(arg, &env->fp_status);
392     update_fr0_op(env, GETPC());
393     return ret;
394 }
395 
396 int32_t HELPER(fcnv_t_d_w)(CPUHPPAState *env, float64 arg)
397 {
398     int32_t ret = float64_to_int32_round_to_zero(arg, &env->fp_status);
399     update_fr0_op(env, GETPC());
400     return ret;
401 }
402 
403 int64_t HELPER(fcnv_t_s_dw)(CPUHPPAState *env, float32 arg)
404 {
405     int64_t ret = float32_to_int64_round_to_zero(arg, &env->fp_status);
406     update_fr0_op(env, GETPC());
407     return ret;
408 }
409 
410 int64_t HELPER(fcnv_t_d_dw)(CPUHPPAState *env, float64 arg)
411 {
412     int64_t ret = float64_to_int64_round_to_zero(arg, &env->fp_status);
413     update_fr0_op(env, GETPC());
414     return ret;
415 }
416 
417 float32 HELPER(fcnv_uw_s)(CPUHPPAState *env, uint32_t arg)
418 {
419     float32 ret = uint32_to_float32(arg, &env->fp_status);
420     update_fr0_op(env, GETPC());
421     return ret;
422 }
423 
424 float32 HELPER(fcnv_udw_s)(CPUHPPAState *env, uint64_t arg)
425 {
426     float32 ret = uint64_to_float32(arg, &env->fp_status);
427     update_fr0_op(env, GETPC());
428     return ret;
429 }
430 
431 float64 HELPER(fcnv_uw_d)(CPUHPPAState *env, uint32_t arg)
432 {
433     float64 ret = uint32_to_float64(arg, &env->fp_status);
434     update_fr0_op(env, GETPC());
435     return ret;
436 }
437 
438 float64 HELPER(fcnv_udw_d)(CPUHPPAState *env, uint64_t arg)
439 {
440     float64 ret = uint64_to_float64(arg, &env->fp_status);
441     update_fr0_op(env, GETPC());
442     return ret;
443 }
444 
445 uint32_t HELPER(fcnv_s_uw)(CPUHPPAState *env, float32 arg)
446 {
447     uint32_t ret = float32_to_uint32(arg, &env->fp_status);
448     update_fr0_op(env, GETPC());
449     return ret;
450 }
451 
452 uint32_t HELPER(fcnv_d_uw)(CPUHPPAState *env, float64 arg)
453 {
454     uint32_t ret = float64_to_uint32(arg, &env->fp_status);
455     update_fr0_op(env, GETPC());
456     return ret;
457 }
458 
459 uint64_t HELPER(fcnv_s_udw)(CPUHPPAState *env, float32 arg)
460 {
461     uint64_t ret = float32_to_uint64(arg, &env->fp_status);
462     update_fr0_op(env, GETPC());
463     return ret;
464 }
465 
466 uint64_t HELPER(fcnv_d_udw)(CPUHPPAState *env, float64 arg)
467 {
468     uint64_t ret = float64_to_uint64(arg, &env->fp_status);
469     update_fr0_op(env, GETPC());
470     return ret;
471 }
472 
473 uint32_t HELPER(fcnv_t_s_uw)(CPUHPPAState *env, float32 arg)
474 {
475     uint32_t ret = float32_to_uint32_round_to_zero(arg, &env->fp_status);
476     update_fr0_op(env, GETPC());
477     return ret;
478 }
479 
480 uint32_t HELPER(fcnv_t_d_uw)(CPUHPPAState *env, float64 arg)
481 {
482     uint32_t ret = float64_to_uint32_round_to_zero(arg, &env->fp_status);
483     update_fr0_op(env, GETPC());
484     return ret;
485 }
486 
487 uint64_t HELPER(fcnv_t_s_udw)(CPUHPPAState *env, float32 arg)
488 {
489     uint64_t ret = float32_to_uint64_round_to_zero(arg, &env->fp_status);
490     update_fr0_op(env, GETPC());
491     return ret;
492 }
493 
494 uint64_t HELPER(fcnv_t_d_udw)(CPUHPPAState *env, float64 arg)
495 {
496     uint64_t ret = float64_to_uint64_round_to_zero(arg, &env->fp_status);
497     update_fr0_op(env, GETPC());
498     return ret;
499 }
500 
501 static void update_fr0_cmp(CPUHPPAState *env, uint32_t y, uint32_t c, int r)
502 {
503     uint32_t shadow = env->fr0_shadow;
504 
505     switch (r) {
506     case float_relation_greater:
507         c = extract32(c, 4, 1);
508         break;
509     case float_relation_less:
510         c = extract32(c, 3, 1);
511         break;
512     case float_relation_equal:
513         c = extract32(c, 2, 1);
514         break;
515     case float_relation_unordered:
516         c = extract32(c, 1, 1);
517         break;
518     default:
519         g_assert_not_reached();
520     }
521 
522     if (y) {
523         /* targeted comparison */
524         /* set fpsr[ca[y - 1]] to current compare */
525         shadow = deposit32(shadow, 21 - (y - 1), 1, c);
526     } else {
527         /* queued comparison */
528         /* shift cq right by one place */
529         shadow = deposit32(shadow, 11, 10, extract32(shadow, 12, 10));
530         /* move fpsr[c] to fpsr[cq[0]] */
531         shadow = deposit32(shadow, 21, 1, extract32(shadow, 26, 1));
532         /* set fpsr[c] to current compare */
533         shadow = deposit32(shadow, 26, 1, c);
534     }
535 
536     env->fr0_shadow = shadow;
537     env->fr[0] = (uint64_t)shadow << 32;
538 }
539 
540 void HELPER(fcmp_s)(CPUHPPAState *env, float32 a, float32 b,
541                     uint32_t y, uint32_t c)
542 {
543     int r;
544     if (c & 1) {
545         r = float32_compare(a, b, &env->fp_status);
546     } else {
547         r = float32_compare_quiet(a, b, &env->fp_status);
548     }
549     update_fr0_op(env, GETPC());
550     update_fr0_cmp(env, y, c, r);
551 }
552 
553 void HELPER(fcmp_d)(CPUHPPAState *env, float64 a, float64 b,
554                     uint32_t y, uint32_t c)
555 {
556     int r;
557     if (c & 1) {
558         r = float64_compare(a, b, &env->fp_status);
559     } else {
560         r = float64_compare_quiet(a, b, &env->fp_status);
561     }
562     update_fr0_op(env, GETPC());
563     update_fr0_cmp(env, y, c, r);
564 }
565 
566 float32 HELPER(fmpyfadd_s)(CPUHPPAState *env, float32 a, float32 b, float32 c)
567 {
568     float32 ret = float32_muladd(a, b, c, 0, &env->fp_status);
569     update_fr0_op(env, GETPC());
570     return ret;
571 }
572 
573 float32 HELPER(fmpynfadd_s)(CPUHPPAState *env, float32 a, float32 b, float32 c)
574 {
575     float32 ret = float32_muladd(a, b, c, float_muladd_negate_product,
576                                  &env->fp_status);
577     update_fr0_op(env, GETPC());
578     return ret;
579 }
580 
581 float64 HELPER(fmpyfadd_d)(CPUHPPAState *env, float64 a, float64 b, float64 c)
582 {
583     float64 ret = float64_muladd(a, b, c, 0, &env->fp_status);
584     update_fr0_op(env, GETPC());
585     return ret;
586 }
587 
588 float64 HELPER(fmpynfadd_d)(CPUHPPAState *env, float64 a, float64 b, float64 c)
589 {
590     float64 ret = float64_muladd(a, b, c, float_muladd_negate_product,
591                                  &env->fp_status);
592     update_fr0_op(env, GETPC());
593     return ret;
594 }
595