Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
Russell King | 4baa992 | 2008-08-02 10:55:55 +0100 | [diff] [blame] | 2 | * arch/arm/include/asm/vfpmacros.h |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 | * |
| 4 | * Assembler-only file containing VFP macros and register definitions. |
| 5 | */ |
Tony Lindgren | 5aaf254 | 2010-07-01 13:41:05 +0100 | [diff] [blame] | 6 | #include <asm/hwcap.h> |
| 7 | |
David Howells | a1ce392 | 2012-10-02 18:01:25 +0100 | [diff] [blame] | 8 | #include <asm/vfp.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 9 | |
| 10 | @ Macros to allow building with old toolkits (with no VFP support) |
| 11 | .macro VFPFMRX, rd, sysreg, cond |
| 12 | MRC\cond p10, 7, \rd, \sysreg, cr0, 0 @ FMRX \rd, \sysreg |
| 13 | .endm |
| 14 | |
| 15 | .macro VFPFMXR, sysreg, rd, cond |
| 16 | MCR\cond p10, 7, \rd, \sysreg, cr0, 0 @ FMXR \sysreg, \rd |
| 17 | .endm |
| 18 | |
| 19 | @ read all the working registers back into the VFP |
Catalin Marinas | 25ebee0 | 2007-09-25 15:22:24 +0100 | [diff] [blame] | 20 | .macro VFPFLDMIA, base, tmp |
Catalin Marinas | bb54a33 | 2006-04-10 21:32:42 +0100 | [diff] [blame] | 21 | #if __LINUX_ARM_ARCH__ < 6 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 | LDC p11, cr0, [\base],#33*4 @ FLDMIAX \base!, {d0-d15} |
Catalin Marinas | bb54a33 | 2006-04-10 21:32:42 +0100 | [diff] [blame] | 23 | #else |
| 24 | LDC p11, cr0, [\base],#32*4 @ FLDMIAD \base!, {d0-d15} |
| 25 | #endif |
Catalin Marinas | 25ebee0 | 2007-09-25 15:22:24 +0100 | [diff] [blame] | 26 | #ifdef CONFIG_VFPv3 |
Tony Lindgren | 5aaf254 | 2010-07-01 13:41:05 +0100 | [diff] [blame] | 27 | #if __LINUX_ARM_ARCH__ <= 6 |
| 28 | ldr \tmp, =elf_hwcap @ may not have MVFR regs |
| 29 | ldr \tmp, [\tmp, #0] |
Paul Walmsley | 39141dd | 2012-10-23 20:32:59 +0100 | [diff] [blame] | 30 | tst \tmp, #HWCAP_VFPD32 |
| 31 | ldcnel p11, cr0, [\base],#32*4 @ FLDMIAD \base!, {d16-d31} |
| 32 | addeq \base, \base, #32*4 @ step over unused register space |
Tony Lindgren | 5aaf254 | 2010-07-01 13:41:05 +0100 | [diff] [blame] | 33 | #else |
Catalin Marinas | 25ebee0 | 2007-09-25 15:22:24 +0100 | [diff] [blame] | 34 | VFPFMRX \tmp, MVFR0 @ Media and VFP Feature Register 0 |
| 35 | and \tmp, \tmp, #MVFR0_A_SIMD_MASK @ A_SIMD field |
| 36 | cmp \tmp, #2 @ 32 x 64bit registers? |
| 37 | ldceql p11, cr0, [\base],#32*4 @ FLDMIAD \base!, {d16-d31} |
| 38 | addne \base, \base, #32*4 @ step over unused register space |
| 39 | #endif |
Tony Lindgren | 5aaf254 | 2010-07-01 13:41:05 +0100 | [diff] [blame] | 40 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | .endm |
| 42 | |
| 43 | @ write all the working registers out of the VFP |
Catalin Marinas | 25ebee0 | 2007-09-25 15:22:24 +0100 | [diff] [blame] | 44 | .macro VFPFSTMIA, base, tmp |
Catalin Marinas | bb54a33 | 2006-04-10 21:32:42 +0100 | [diff] [blame] | 45 | #if __LINUX_ARM_ARCH__ < 6 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 | STC p11, cr0, [\base],#33*4 @ FSTMIAX \base!, {d0-d15} |
Catalin Marinas | bb54a33 | 2006-04-10 21:32:42 +0100 | [diff] [blame] | 47 | #else |
| 48 | STC p11, cr0, [\base],#32*4 @ FSTMIAD \base!, {d0-d15} |
| 49 | #endif |
Catalin Marinas | 25ebee0 | 2007-09-25 15:22:24 +0100 | [diff] [blame] | 50 | #ifdef CONFIG_VFPv3 |
Tony Lindgren | 5aaf254 | 2010-07-01 13:41:05 +0100 | [diff] [blame] | 51 | #if __LINUX_ARM_ARCH__ <= 6 |
| 52 | ldr \tmp, =elf_hwcap @ may not have MVFR regs |
| 53 | ldr \tmp, [\tmp, #0] |
Paul Walmsley | 39141dd | 2012-10-23 20:32:59 +0100 | [diff] [blame] | 54 | tst \tmp, #HWCAP_VFPD32 |
| 55 | stcnel p11, cr0, [\base],#32*4 @ FSTMIAD \base!, {d16-d31} |
| 56 | addeq \base, \base, #32*4 @ step over unused register space |
Tony Lindgren | 5aaf254 | 2010-07-01 13:41:05 +0100 | [diff] [blame] | 57 | #else |
Catalin Marinas | 25ebee0 | 2007-09-25 15:22:24 +0100 | [diff] [blame] | 58 | VFPFMRX \tmp, MVFR0 @ Media and VFP Feature Register 0 |
| 59 | and \tmp, \tmp, #MVFR0_A_SIMD_MASK @ A_SIMD field |
| 60 | cmp \tmp, #2 @ 32 x 64bit registers? |
| 61 | stceql p11, cr0, [\base],#32*4 @ FSTMIAD \base!, {d16-d31} |
| 62 | addne \base, \base, #32*4 @ step over unused register space |
| 63 | #endif |
Tony Lindgren | 5aaf254 | 2010-07-01 13:41:05 +0100 | [diff] [blame] | 64 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 65 | .endm |