1 files changed, 45 insertions, 0 deletions

diff --git a/arch/arm/vfp/entry.S b/arch/arm/vfp/entry.S
new file mode 100644
index 000000000000..e73c8deca592
--- /dev/null
+++ b/arch/arm/vfp/entry.S
@@ -0,0 +1,45 @@
+/*
+ *  linux/arch/arm/vfp/entry.S
+ *
+ *  Copyright (C) 2004 ARM Limited.
+ *  Written by Deep Blue Solutions Limited.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ * Basic entry code, called from the kernel's undefined instruction trap.
+ *  r0  = faulted instruction
+ *  r5  = faulted PC+4
+ *  r9  = successful return
+ *  r10 = thread_info structure
+ *  lr  = failure return
+ */
+#include <linux/linkage.h>
+#include <linux/init.h>
+#include <asm/constants.h>
+#include <asm/vfpmacros.h>
+
+        .globl  do_vfp
+do_vfp:
+        ldr     r4, .LCvfp
+        add     r10, r10, #TI_VFPSTATE  @ r10 = workspace
+        ldr     pc, [r4]                @ call VFP entry point
+
+.LCvfp:
+        .word   vfp_vector
+
+@ This code is called if the VFP does not exist. It needs to flag the
+@ failure to the VFP initialisation code.
+
+        __INIT
+        .globl  vfp_testing_entry
+vfp_testing_entry:
+        ldr     r0, VFP_arch_address
+        str     r5, [r0]                @ known non-zero value
+        mov     pc, r9                  @ we have handled the fault
+
+VFP_arch_address:
+        .word   VFP_arch
+
+        __FINIT