Merge branch 'omap-serial' of git://git.linaro.org/people/rmk/linux-arm
[~shefty/rdma-dev.git] / arch / arm64 / kernel / entry-fpsimd.S
1 /*
2  * FP/SIMD state saving and restoring
3  *
4  * Copyright (C) 2012 ARM Ltd.
5  * Author: Catalin Marinas <catalin.marinas@arm.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
18  */
19
20 #include <linux/linkage.h>
21
22 #include <asm/assembler.h>
23
24 /*
25  * Save the FP registers.
26  *
27  * x0 - pointer to struct fpsimd_state
28  */
29 ENTRY(fpsimd_save_state)
30         stp     q0, q1, [x0, #16 * 0]
31         stp     q2, q3, [x0, #16 * 2]
32         stp     q4, q5, [x0, #16 * 4]
33         stp     q6, q7, [x0, #16 * 6]
34         stp     q8, q9, [x0, #16 * 8]
35         stp     q10, q11, [x0, #16 * 10]
36         stp     q12, q13, [x0, #16 * 12]
37         stp     q14, q15, [x0, #16 * 14]
38         stp     q16, q17, [x0, #16 * 16]
39         stp     q18, q19, [x0, #16 * 18]
40         stp     q20, q21, [x0, #16 * 20]
41         stp     q22, q23, [x0, #16 * 22]
42         stp     q24, q25, [x0, #16 * 24]
43         stp     q26, q27, [x0, #16 * 26]
44         stp     q28, q29, [x0, #16 * 28]
45         stp     q30, q31, [x0, #16 * 30]!
46         mrs     x8, fpsr
47         str     w8, [x0, #16 * 2]
48         mrs     x8, fpcr
49         str     w8, [x0, #16 * 2 + 4]
50         ret
51 ENDPROC(fpsimd_save_state)
52
53 /*
54  * Load the FP registers.
55  *
56  * x0 - pointer to struct fpsimd_state
57  */
58 ENTRY(fpsimd_load_state)
59         ldp     q0, q1, [x0, #16 * 0]
60         ldp     q2, q3, [x0, #16 * 2]
61         ldp     q4, q5, [x0, #16 * 4]
62         ldp     q6, q7, [x0, #16 * 6]
63         ldp     q8, q9, [x0, #16 * 8]
64         ldp     q10, q11, [x0, #16 * 10]
65         ldp     q12, q13, [x0, #16 * 12]
66         ldp     q14, q15, [x0, #16 * 14]
67         ldp     q16, q17, [x0, #16 * 16]
68         ldp     q18, q19, [x0, #16 * 18]
69         ldp     q20, q21, [x0, #16 * 20]
70         ldp     q22, q23, [x0, #16 * 22]
71         ldp     q24, q25, [x0, #16 * 24]
72         ldp     q26, q27, [x0, #16 * 26]
73         ldp     q28, q29, [x0, #16 * 28]
74         ldp     q30, q31, [x0, #16 * 30]!
75         ldr     w8, [x0, #16 * 2]
76         ldr     w9, [x0, #16 * 2 + 4]
77         msr     fpsr, x8
78         msr     fpcr, x9
79         ret
80 ENDPROC(fpsimd_load_state)