hc
2024-05-14 bedbef8ad3e75a304af6361af235302bcc61d06b
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
/* SPDX-License-Identifier: GPL-2.0-only */
/*
 *  linux/arch/arm/vfp/vfpinstr.h
 *
 *  Copyright (C) 2004 ARM Limited.
 *  Written by Deep Blue Solutions Limited.
 *
 * VFP instruction masks.
 */
#define INST_CPRTDO(inst)    (((inst) & 0x0f000000) == 0x0e000000)
#define INST_CPRT(inst)        ((inst) & (1 << 4))
#define INST_CPRT_L(inst)    ((inst) & (1 << 20))
#define INST_CPRT_Rd(inst)    (((inst) & (15 << 12)) >> 12)
#define INST_CPRT_OP(inst)    (((inst) >> 21) & 7)
#define INST_CPNUM(inst)    ((inst) & 0xf00)
#define CPNUM(cp)        ((cp) << 8)
 
#define FOP_MASK    (0x00b00040)
#define FOP_FMAC    (0x00000000)
#define FOP_FNMAC    (0x00000040)
#define FOP_FMSC    (0x00100000)
#define FOP_FNMSC    (0x00100040)
#define FOP_FMUL    (0x00200000)
#define FOP_FNMUL    (0x00200040)
#define FOP_FADD    (0x00300000)
#define FOP_FSUB    (0x00300040)
#define FOP_FDIV    (0x00800000)
#define FOP_EXT        (0x00b00040)
 
#define FOP_TO_IDX(inst)    ((inst & 0x00b00000) >> 20 | (inst & (1 << 6)) >> 4)
 
#define FEXT_MASK    (0x000f0080)
#define FEXT_FCPY    (0x00000000)
#define FEXT_FABS    (0x00000080)
#define FEXT_FNEG    (0x00010000)
#define FEXT_FSQRT    (0x00010080)
#define FEXT_FCMP    (0x00040000)
#define FEXT_FCMPE    (0x00040080)
#define FEXT_FCMPZ    (0x00050000)
#define FEXT_FCMPEZ    (0x00050080)
#define FEXT_FCVT    (0x00070080)
#define FEXT_FUITO    (0x00080000)
#define FEXT_FSITO    (0x00080080)
#define FEXT_FTOUI    (0x000c0000)
#define FEXT_FTOUIZ    (0x000c0080)
#define FEXT_FTOSI    (0x000d0000)
#define FEXT_FTOSIZ    (0x000d0080)
 
#define FEXT_TO_IDX(inst)    ((inst & 0x000f0000) >> 15 | (inst & (1 << 7)) >> 7)
 
#define vfp_get_sd(inst)    ((inst & 0x0000f000) >> 11 | (inst & (1 << 22)) >> 22)
#define vfp_get_dd(inst)    ((inst & 0x0000f000) >> 12 | (inst & (1 << 22)) >> 18)
#define vfp_get_sm(inst)    ((inst & 0x0000000f) << 1 | (inst & (1 << 5)) >> 5)
#define vfp_get_dm(inst)    ((inst & 0x0000000f) | (inst & (1 << 5)) >> 1)
#define vfp_get_sn(inst)    ((inst & 0x000f0000) >> 15 | (inst & (1 << 7)) >> 7)
#define vfp_get_dn(inst)    ((inst & 0x000f0000) >> 16 | (inst & (1 << 7)) >> 3)
 
#define vfp_single(inst)    (((inst) & 0x0000f00) == 0xa00)
 
#define FPSCR_N    (1 << 31)
#define FPSCR_Z    (1 << 30)
#define FPSCR_C (1 << 29)
#define FPSCR_V    (1 << 28)
 
#ifdef CONFIG_AS_VFP_VMRS_FPINST
 
#define fmrx(_vfp_) ({            \
   u32 __v;            \
   asm(".fpu    vfpv2\n"    \
       "vmrs    %0, " #_vfp_    \
       : "=r" (__v) : : "cc");    \
   __v;                \
 })
 
#define fmxr(_vfp_,_var_)        \
   asm(".fpu    vfpv2\n"    \
       "vmsr    " #_vfp_ ", %0"    \
      : : "r" (_var_) : "cc")
 
#else
 
#define vfpreg(_vfp_) #_vfp_
 
#define fmrx(_vfp_) ({            \
   u32 __v;            \
   asm("mrc p10, 7, %0, " vfpreg(_vfp_) ", cr0, 0 @ fmrx    %0, " #_vfp_    \
       : "=r" (__v) : : "cc");    \
   __v;                \
 })
 
#define fmxr(_vfp_,_var_)        \
   asm("mcr p10, 7, %0, " vfpreg(_vfp_) ", cr0, 0 @ fmxr    " #_vfp_ ", %0"    \
      : : "r" (_var_) : "cc")
 
#endif
 
u32 vfp_single_cpdo(u32 inst, u32 fpscr);
u32 vfp_single_cprt(u32 inst, u32 fpscr, struct pt_regs *regs);
 
u32 vfp_double_cpdo(u32 inst, u32 fpscr);