xref: /openbmc/linux/arch/s390/include/asm/fpu/internal.h (revision 2596e07a)
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 
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 
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 
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 
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 
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