1*4882a593Smuzhiyun /* SPDX-License-Identifier: GPL-2.0 */
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * FPU state and register content conversion primitives
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright IBM Corp. 2015
6*4882a593Smuzhiyun * Author(s): Hendrik Brueckner <brueckner@linux.vnet.ibm.com>
7*4882a593Smuzhiyun */
8*4882a593Smuzhiyun
9*4882a593Smuzhiyun #ifndef _ASM_S390_FPU_INTERNAL_H
10*4882a593Smuzhiyun #define _ASM_S390_FPU_INTERNAL_H
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include <linux/string.h>
13*4882a593Smuzhiyun #include <asm/ctl_reg.h>
14*4882a593Smuzhiyun #include <asm/fpu/types.h>
15*4882a593Smuzhiyun
save_vx_regs(__vector128 * vxrs)16*4882a593Smuzhiyun static inline void save_vx_regs(__vector128 *vxrs)
17*4882a593Smuzhiyun {
18*4882a593Smuzhiyun asm volatile(
19*4882a593Smuzhiyun " la 1,%0\n"
20*4882a593Smuzhiyun " .word 0xe70f,0x1000,0x003e\n" /* vstm 0,15,0(1) */
21*4882a593Smuzhiyun " .word 0xe70f,0x1100,0x0c3e\n" /* vstm 16,31,256(1) */
22*4882a593Smuzhiyun : "=Q" (*(struct vx_array *) vxrs) : : "1");
23*4882a593Smuzhiyun }
24*4882a593Smuzhiyun
convert_vx_to_fp(freg_t * fprs,__vector128 * vxrs)25*4882a593Smuzhiyun static inline void convert_vx_to_fp(freg_t *fprs, __vector128 *vxrs)
26*4882a593Smuzhiyun {
27*4882a593Smuzhiyun int i;
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun for (i = 0; i < __NUM_FPRS; i++)
30*4882a593Smuzhiyun fprs[i] = *(freg_t *)(vxrs + i);
31*4882a593Smuzhiyun }
32*4882a593Smuzhiyun
convert_fp_to_vx(__vector128 * vxrs,freg_t * fprs)33*4882a593Smuzhiyun static inline void convert_fp_to_vx(__vector128 *vxrs, freg_t *fprs)
34*4882a593Smuzhiyun {
35*4882a593Smuzhiyun int i;
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun for (i = 0; i < __NUM_FPRS; i++)
38*4882a593Smuzhiyun *(freg_t *)(vxrs + i) = fprs[i];
39*4882a593Smuzhiyun }
40*4882a593Smuzhiyun
fpregs_store(_s390_fp_regs * fpregs,struct fpu * fpu)41*4882a593Smuzhiyun static inline void fpregs_store(_s390_fp_regs *fpregs, struct fpu *fpu)
42*4882a593Smuzhiyun {
43*4882a593Smuzhiyun fpregs->pad = 0;
44*4882a593Smuzhiyun fpregs->fpc = fpu->fpc;
45*4882a593Smuzhiyun if (MACHINE_HAS_VX)
46*4882a593Smuzhiyun convert_vx_to_fp((freg_t *)&fpregs->fprs, fpu->vxrs);
47*4882a593Smuzhiyun else
48*4882a593Smuzhiyun memcpy((freg_t *)&fpregs->fprs, fpu->fprs,
49*4882a593Smuzhiyun sizeof(fpregs->fprs));
50*4882a593Smuzhiyun }
51*4882a593Smuzhiyun
fpregs_load(_s390_fp_regs * fpregs,struct fpu * fpu)52*4882a593Smuzhiyun static inline void fpregs_load(_s390_fp_regs *fpregs, struct fpu *fpu)
53*4882a593Smuzhiyun {
54*4882a593Smuzhiyun fpu->fpc = fpregs->fpc;
55*4882a593Smuzhiyun if (MACHINE_HAS_VX)
56*4882a593Smuzhiyun convert_fp_to_vx(fpu->vxrs, (freg_t *)&fpregs->fprs);
57*4882a593Smuzhiyun else
58*4882a593Smuzhiyun memcpy(fpu->fprs, (freg_t *)&fpregs->fprs,
59*4882a593Smuzhiyun sizeof(fpregs->fprs));
60*4882a593Smuzhiyun }
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun #endif /* _ASM_S390_FPU_INTERNAL_H */
63