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