1 /* 2 * FP/SIMD state saving and restoring macros 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 .macro fpsimd_save state, tmpnr 21 stp q0, q1, [\state, #16 * 0] 22 stp q2, q3, [\state, #16 * 2] 23 stp q4, q5, [\state, #16 * 4] 24 stp q6, q7, [\state, #16 * 6] 25 stp q8, q9, [\state, #16 * 8] 26 stp q10, q11, [\state, #16 * 10] 27 stp q12, q13, [\state, #16 * 12] 28 stp q14, q15, [\state, #16 * 14] 29 stp q16, q17, [\state, #16 * 16] 30 stp q18, q19, [\state, #16 * 18] 31 stp q20, q21, [\state, #16 * 20] 32 stp q22, q23, [\state, #16 * 22] 33 stp q24, q25, [\state, #16 * 24] 34 stp q26, q27, [\state, #16 * 26] 35 stp q28, q29, [\state, #16 * 28] 36 stp q30, q31, [\state, #16 * 30]! 37 mrs x\tmpnr, fpsr 38 str w\tmpnr, [\state, #16 * 2] 39 mrs x\tmpnr, fpcr 40 str w\tmpnr, [\state, #16 * 2 + 4] 41 .endm 42 43 .macro fpsimd_restore_fpcr state, tmp 44 /* 45 * Writes to fpcr may be self-synchronising, so avoid restoring 46 * the register if it hasn't changed. 47 */ 48 mrs \tmp, fpcr 49 cmp \tmp, \state 50 b.eq 9999f 51 msr fpcr, \state 52 9999: 53 .endm 54 55 /* Clobbers \state */ 56 .macro fpsimd_restore state, tmpnr 57 ldp q0, q1, [\state, #16 * 0] 58 ldp q2, q3, [\state, #16 * 2] 59 ldp q4, q5, [\state, #16 * 4] 60 ldp q6, q7, [\state, #16 * 6] 61 ldp q8, q9, [\state, #16 * 8] 62 ldp q10, q11, [\state, #16 * 10] 63 ldp q12, q13, [\state, #16 * 12] 64 ldp q14, q15, [\state, #16 * 14] 65 ldp q16, q17, [\state, #16 * 16] 66 ldp q18, q19, [\state, #16 * 18] 67 ldp q20, q21, [\state, #16 * 20] 68 ldp q22, q23, [\state, #16 * 22] 69 ldp q24, q25, [\state, #16 * 24] 70 ldp q26, q27, [\state, #16 * 26] 71 ldp q28, q29, [\state, #16 * 28] 72 ldp q30, q31, [\state, #16 * 30]! 73 ldr w\tmpnr, [\state, #16 * 2] 74 msr fpsr, x\tmpnr 75 ldr w\tmpnr, [\state, #16 * 2 + 4] 76 fpsimd_restore_fpcr x\tmpnr, \state 77 .endm 78 79 .altmacro 80 .macro fpsimd_save_partial state, numnr, tmpnr1, tmpnr2 81 mrs x\tmpnr1, fpsr 82 str w\numnr, [\state, #8] 83 mrs x\tmpnr2, fpcr 84 stp w\tmpnr1, w\tmpnr2, [\state] 85 adr x\tmpnr1, 0f 86 add \state, \state, x\numnr, lsl #4 87 sub x\tmpnr1, x\tmpnr1, x\numnr, lsl #1 88 br x\tmpnr1 89 .irp qa, 30, 28, 26, 24, 22, 20, 18, 16, 14, 12, 10, 8, 6, 4, 2, 0 90 .irp qb, %(qa + 1) 91 stp q\qa, q\qb, [\state, # -16 * \qa - 16] 92 .endr 93 .endr 94 0: 95 .endm 96 97 .macro fpsimd_restore_partial state, tmpnr1, tmpnr2 98 ldp w\tmpnr1, w\tmpnr2, [\state] 99 msr fpsr, x\tmpnr1 100 fpsimd_restore_fpcr x\tmpnr2, x\tmpnr1 101 adr x\tmpnr1, 0f 102 ldr w\tmpnr2, [\state, #8] 103 add \state, \state, x\tmpnr2, lsl #4 104 sub x\tmpnr1, x\tmpnr1, x\tmpnr2, lsl #1 105 br x\tmpnr1 106 .irp qa, 30, 28, 26, 24, 22, 20, 18, 16, 14, 12, 10, 8, 6, 4, 2, 0 107 .irp qb, %(qa + 1) 108 ldp q\qa, q\qb, [\state, # -16 * \qa - 16] 109 .endr 110 .endr 111 0: 112 .endm 113