First version
[3rdparty/ote_partner/tlk.git] / arch / arm / arm / neon / ops.S
1 /*
2  * Copyright (c) 2013, NVIDIA CORPORATION. All rights reserved
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining
5  * a copy of this software and associated documentation files
6  * (the "Software"), to deal in the Software without restriction,
7  * including without limitation the rights to use, copy, modify, merge,
8  * publish, distribute, sublicense, and/or sell copies of the Software,
9  * and to permit persons to whom the Software is furnished to do so,
10  * subject to the following conditions:
11  *
12  * The above copyright notice and this permission notice shall be
13  * included in all copies or substantial portions of the Software.
14  *
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
16  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
17  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
18  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
19  * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
20  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
21  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
22  */
23 #if ARM_WITH_NEON
24 #include <asm.h>
25
26 /* uint32_t arm_get_vfp_fpexc(void) */
27 FUNCTION(arm_get_vfp_fpexc)
28         mrc     p10, 7, r0, cr8, cr0, 0
29         bx      lr
30
31 /* void arm_set_vfp_fpexc(uint32_t val) */
32 FUNCTION(arm_set_vfp_fpexc)
33         mcr     p10, 7, r0, cr8, cr0, 0
34         bx      lr
35
36 /* uint32_t arm_get_vfp_fpscr(void) */
37 FUNCTION(arm_get_vfp_fpscr)
38         mrc     p10, 7, r0, cr1, cr0, 0
39         bx      lr
40
41 /* void arm_set_vfp_fpscr(uint32_t val) */
42 FUNCTION(arm_set_vfp_fpscr)
43         mcr     p10, 7, r0, cr1, cr0, 0
44         bx      lr
45
46 /* void arm_save_vfp_dregs(addr_t ctxbuf) */
47 FUNCTION(arm_save_vfp_dregs)
48         vstmia   r0!, {d0-d15}
49         mrc      p10, 7, r1, cr7, cr0, 0        @ vmrs r1, mvfr0
50         and      r1, r1, #15
51         cmp      r1, #2                         @ 32 x 64bit registers?
52         vstmiaeq r0!, {d16-d31}
53         bx      lr
54
55 /* void arm_restore_vfp_dregs(addr_t ctxbuf) */
56 FUNCTION(arm_restore_vfp_dregs)
57         vldmia   r0!, {d0-d15}
58         mrc      p10, 7, r1, cr7, cr0, 0        @ vmrs r1, mvfr0
59         and      r1, r1, #15
60         cmp      r1, #2                         @ 32 x 64bit registers?
61         vldmiaeq r0!, {d16-d31}
62         bx      lr
63 #endif