xref: /optee_os/core/arch/arm/kernel/vfp_a64.S (revision 1bb929836182ecb96d2d9d268daa807c67596396)
1/* SPDX-License-Identifier: BSD-2-Clause */
2/*
3 * Copyright (c) 2015, Linaro Limited
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions are met:
8 *
9 * 1. Redistributions of source code must retain the above copyright notice,
10 * this list of conditions and the following disclaimer.
11 *
12 * 2. Redistributions in binary form must reproduce the above copyright notice,
13 * this list of conditions and the following disclaimer in the documentation
14 * and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
17 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
20 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 * POSSIBILITY OF SUCH DAMAGE.
27 */
28
29#include <asm.S>
30
31	.section .text.vfp_asm
32
33/* void vfp_save_extension_regs(struct vfp_reg regs[VFP_NUM_REGS]); */
34FUNC vfp_save_extension_regs , :
35	stp	q0, q1, [x0, #16 * 0]
36	stp	q2, q3, [x0, #16 * 2]
37	stp	q4, q5, [x0, #16 * 4]
38	stp	q6, q7, [x0, #16 * 6]
39	stp	q8, q9, [x0, #16 * 8]
40	stp	q10, q11, [x0, #16 * 10]
41	stp	q12, q13, [x0, #16 * 12]
42	stp	q14, q15, [x0, #16 * 14]
43	stp	q16, q17, [x0, #16 * 16]
44	stp	q18, q19, [x0, #16 * 18]
45	stp	q20, q21, [x0, #16 * 20]
46	stp	q22, q23, [x0, #16 * 22]
47	stp	q24, q25, [x0, #16 * 24]
48	stp	q26, q27, [x0, #16 * 26]
49	stp	q28, q29, [x0, #16 * 28]
50	stp	q30, q31, [x0, #16 * 30]
51	ret
52END_FUNC vfp_save_extension_regs
53
54/* void vfp_restore_extension_regs(struct vfp_reg regs[VFP_NUM_REGS]); */
55FUNC vfp_restore_extension_regs , :
56	ldp	q0, q1, [x0, #16 * 0]
57	ldp	q2, q3, [x0, #16 * 2]
58	ldp	q4, q5, [x0, #16 * 4]
59	ldp	q6, q7, [x0, #16 * 6]
60	ldp	q8, q9, [x0, #16 * 8]
61	ldp	q10, q11, [x0, #16 * 10]
62	ldp	q12, q13, [x0, #16 * 12]
63	ldp	q14, q15, [x0, #16 * 14]
64	ldp	q16, q17, [x0, #16 * 16]
65	ldp	q18, q19, [x0, #16 * 18]
66	ldp	q20, q21, [x0, #16 * 20]
67	ldp	q22, q23, [x0, #16 * 22]
68	ldp	q24, q25, [x0, #16 * 24]
69	ldp	q26, q27, [x0, #16 * 26]
70	ldp	q28, q29, [x0, #16 * 28]
71	ldp	q30, q31, [x0, #16 * 30]
72	ret
73END_FUNC vfp_restore_extension_regs
74