1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
2 | /* |
3 | * FP/SIMD state saving and restoring |
4 | * |
5 | * Copyright (C) 2012 ARM Ltd. |
6 | * Author: Catalin Marinas <catalin.marinas@arm.com> |
7 | */ |
8 | |
9 | #include <linux/linkage.h> |
10 | |
11 | #include <asm/assembler.h> |
12 | #include <asm/fpsimdmacros.h> |
13 | |
14 | /* |
15 | * Save the FP registers. |
16 | * |
17 | * x0 - pointer to struct fpsimd_state |
18 | */ |
19 | SYM_FUNC_START(fpsimd_save_state) |
20 | fpsimd_save x0, 8 |
21 | ret |
22 | SYM_FUNC_END(fpsimd_save_state) |
23 | |
24 | /* |
25 | * Load the FP registers. |
26 | * |
27 | * x0 - pointer to struct fpsimd_state |
28 | */ |
29 | SYM_FUNC_START(fpsimd_load_state) |
30 | fpsimd_restore x0, 8 |
31 | ret |
32 | SYM_FUNC_END(fpsimd_load_state) |
33 | |
34 | #ifdef CONFIG_ARM64_SVE |
35 | |
36 | /* |
37 | * Save the SVE state |
38 | * |
39 | * x0 - pointer to buffer for state |
40 | * x1 - pointer to storage for FPSR |
41 | * x2 - Save FFR if non-zero |
42 | */ |
43 | SYM_FUNC_START(sve_save_state) |
44 | sve_save 0, x1, x2, 3 |
45 | ret |
46 | SYM_FUNC_END(sve_save_state) |
47 | |
48 | /* |
49 | * Load the SVE state |
50 | * |
51 | * x0 - pointer to buffer for state |
52 | * x1 - pointer to storage for FPSR |
53 | * x2 - Restore FFR if non-zero |
54 | */ |
55 | SYM_FUNC_START(sve_load_state) |
56 | sve_load 0, x1, x2, 4 |
57 | ret |
58 | SYM_FUNC_END(sve_load_state) |
59 | |
60 | SYM_FUNC_START(sve_get_vl) |
61 | _sve_rdvl 0, 1 |
62 | ret |
63 | SYM_FUNC_END(sve_get_vl) |
64 | |
65 | SYM_FUNC_START(sve_set_vq) |
66 | sve_load_vq x0, x1, x2 |
67 | ret |
68 | SYM_FUNC_END(sve_set_vq) |
69 | |
70 | /* |
71 | * Zero all SVE registers but the first 128-bits of each vector |
72 | * |
73 | * VQ must already be configured by caller, any further updates of VQ |
74 | * will need to ensure that the register state remains valid. |
75 | * |
76 | * x0 = include FFR? |
77 | * x1 = VQ - 1 |
78 | */ |
79 | SYM_FUNC_START(sve_flush_live) |
80 | cbz x1, 1f // A VQ-1 of 0 is 128 bits so no extra Z state |
81 | sve_flush_z |
82 | 1: sve_flush_p |
83 | tbz x0, #0, 2f |
84 | sve_flush_ffr |
85 | 2: ret |
86 | SYM_FUNC_END(sve_flush_live) |
87 | |
88 | #endif /* CONFIG_ARM64_SVE */ |
89 | |
90 | #ifdef CONFIG_ARM64_SME |
91 | |
92 | SYM_FUNC_START(sme_get_vl) |
93 | _sme_rdsvl 0, 1 |
94 | ret |
95 | SYM_FUNC_END(sme_get_vl) |
96 | |
97 | SYM_FUNC_START(sme_set_vq) |
98 | sme_load_vq x0, x1, x2 |
99 | ret |
100 | SYM_FUNC_END(sme_set_vq) |
101 | |
102 | /* |
103 | * Save the ZA and ZT state |
104 | * |
105 | * x0 - pointer to buffer for state |
106 | * x1 - number of ZT registers to save |
107 | */ |
108 | SYM_FUNC_START(sme_save_state) |
109 | _sme_rdsvl 2, 1 // x2 = VL/8 |
110 | sme_save_za 0, x2, 12 // Leaves x0 pointing to the end of ZA |
111 | |
112 | cbz x1, 1f |
113 | _str_zt 0 |
114 | 1: |
115 | ret |
116 | SYM_FUNC_END(sme_save_state) |
117 | |
118 | /* |
119 | * Load the ZA and ZT state |
120 | * |
121 | * x0 - pointer to buffer for state |
122 | * x1 - number of ZT registers to save |
123 | */ |
124 | SYM_FUNC_START(sme_load_state) |
125 | _sme_rdsvl 2, 1 // x2 = VL/8 |
126 | sme_load_za 0, x2, 12 // Leaves x0 pointing to the end of ZA |
127 | |
128 | cbz x1, 1f |
129 | _ldr_zt 0 |
130 | 1: |
131 | ret |
132 | SYM_FUNC_END(sme_load_state) |
133 | |
134 | #endif /* CONFIG_ARM64_SME */ |
135 | |