arch/s390/include/asm/fpu/internal.h

   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 */