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