/*
|
* Copyright (C) 2006 Gilles Chanteperdrix <gilles.chanteperdrix@xenomai.org>.
|
*
|
* This library is free software; you can redistribute it and/or
|
* modify it under the terms of the GNU Lesser General Public
|
* License as published by the Free Software Foundation; either
|
* version 2 of the License, or (at your option) any later version.
|
*
|
* This library is distributed in the hope that it will be useful,
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
* Lesser General Public License for more details.
|
|
* You should have received a copy of the GNU Lesser General Public
|
* License along with this library; if not, write to the Free Software
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
|
*/
|
#ifndef _COBALT_ARM64_ASM_UAPI_FPTEST_H
|
#define _COBALT_ARM64_ASM_UAPI_FPTEST_H
|
|
#define __COBALT_HAVE_FPU 0x1
|
|
/*
|
* CAUTION: keep this code strictly inlined in macros: we don't want
|
* GCC to apply any callee-saved logic to fpsimd registers in
|
* fp_regs_set() before fp_regs_check() can verify their contents, but
|
* we still want GCC to know about the registers we have clobbered.
|
*/
|
|
#define fp_regs_set(__features, __val) \
|
do { \
|
unsigned long long __e[32]; \
|
unsigned int __i; \
|
\
|
if (__features & __COBALT_HAVE_FPU) { \
|
\
|
for (__i = 0; __i < 32; __i++) \
|
__e[__i] = (__val); \
|
\
|
__asm__ __volatile__("ldp d0, d1, [%0, #8 * 0] \n" \
|
"ldp d2, d3, [%0, #8 * 2] \n" \
|
"ldp d4, d5, [%0, #8 * 4]\n" \
|
"ldp d6, d7, [%0, #8 * 6]\n" \
|
"ldp d8, d9, [%0, #8 * 8]\n" \
|
"ldp d10, d11, [%0, #8 * 10]\n" \
|
"ldp d12, d13, [%0, #8 * 12]\n" \
|
"ldp d14, d15, [%0, #8 * 14]\n" \
|
"ldp d16, d17, [%0, #8 * 16]\n" \
|
"ldp d18, d19, [%0, #8 * 18]\n" \
|
"ldp d20, d21, [%0, #8 * 20]\n" \
|
"ldp d22, d23, [%0, #8 * 22]\n" \
|
"ldp d24, d25, [%0, #8 * 24]\n" \
|
"ldp d26, d27, [%0, #8 * 26]\n" \
|
"ldp d28, d29, [%0, #8 * 28]\n" \
|
"ldp d30, d31, [%0, #8 * 30]\n" \
|
: /* No outputs. */ \
|
: "r"(&__e[0]) \
|
: "d0", "d1", "d2", "d3", "d4", "d5", "d6", \
|
"d7", "d8", "d9", "d10", "d11", "d12", "d13", \
|
"d14", "d15", "d16", "d17", "d18", "d19", \
|
"d20", "d21", "d22", "d23", "d24", "d25", \
|
"d26", "d27", "d28", "d29", "d30", "d31", \
|
"memory"); \
|
} \
|
} while (0)
|
|
#define fp_regs_check(__features, __val, __report) \
|
({ \
|
unsigned int __result = (__val), __i; \
|
unsigned long long __e[32]; \
|
\
|
if (__features & __COBALT_HAVE_FPU) { \
|
\
|
__asm__ __volatile__("stp d0, d1, [%0, #8 * 0] \n" \
|
"stp d2, d3, [%0, #8 * 2] \n" \
|
"stp d4, d5, [%0, #8 * 4]\n" \
|
"stp d6, d7, [%0, #8 * 6]\n" \
|
"stp d8, d9, [%0, #8 * 8]\n" \
|
"stp d10, d11, [%0, #8 * 10]\n" \
|
"stp d12, d13, [%0, #8 * 12]\n" \
|
"stp d14, d15, [%0, #8 * 14]\n" \
|
"stp d16, d17, [%0, #8 * 16]\n" \
|
"stp d18, d19, [%0, #8 * 18]\n" \
|
"stp d20, d21, [%0, #8 * 20]\n" \
|
"stp d22, d23, [%0, #8 * 22]\n" \
|
"stp d24, d25, [%0, #8 * 24]\n" \
|
"stp d26, d27, [%0, #8 * 26]\n" \
|
"stp d28, d29, [%0, #8 * 28]\n" \
|
"stp d30, d31, [%0, #8 * 30]\n" \
|
: /* No outputs. */ \
|
: "r"(&__e[0]) \
|
: "memory"); \
|
\
|
for (__i = 0; __i < 32; __i++) \
|
if (__e[__i] != __val) { \
|
__report("d%d: %llu != %u\n", \
|
__i, __e[__i], __val); \
|
__result = __e[__i]; \
|
} \
|
} \
|
\
|
__result; \
|
})
|
|
#endif /* !_COBALT_ARM64_ASM_UAPI_FPTEST_H */
|
