blob: f0759e70fb865b4d24370a46b58b37564e49f871 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/arch/arm/vfp/entry.S
3 *
4 * Copyright (C) 2004 ARM Limited.
5 * Written by Deep Blue Solutions Limited.
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.
Linus Torvalds1da177e2005-04-16 15:20:36 -070010 */
Catalin Marinas39ad04c2014-04-02 10:57:48 +010011#include <linux/init.h>
12#include <linux/linkage.h>
George G. Davisf2255be2009-04-01 20:27:18 +010013#include <asm/thread_info.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014#include <asm/vfpmacros.h>
Catalin Marinas39ad04c2014-04-02 10:57:48 +010015#include <asm/assembler.h>
16#include <asm/asm-offsets.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070017
Russell King15ac49b2012-07-30 19:42:10 +010018@ VFP entry point.
19@
20@ r0 = instruction opcode (32-bit ARM or two 16-bit Thumb)
21@ r2 = PC value to resume execution after successful emulation
22@ r9 = normal "successful" return address
23@ r10 = this threads thread_info structure
24@ lr = unrecognised instruction return address
25@ IRQs disabled.
26@
Catalin Marinas93ed3972008-08-28 11:22:32 +010027ENTRY(do_vfp)
Catalin Marinas0b1f68e2014-04-02 10:57:49 +010028 inc_preempt_count r10, r4
Russell King5d25ac02006-03-15 12:33:43 +000029 enable_irq
Linus Torvalds1da177e2005-04-16 15:20:36 -070030 ldr r4, .LCvfp
Catalin Marinasc6428462007-01-24 18:47:08 +010031 ldr r11, [r10, #TI_CPU] @ CPU number
Linus Torvalds1da177e2005-04-16 15:20:36 -070032 add r10, r10, #TI_VFPSTATE @ r10 = workspace
33 ldr pc, [r4] @ call VFP entry point
Catalin Marinas93ed3972008-08-28 11:22:32 +010034ENDPROC(do_vfp)
Linus Torvalds1da177e2005-04-16 15:20:36 -070035
Russell King5d4cae52007-06-10 12:22:20 +010036ENTRY(vfp_null_entry)
Catalin Marinas0b1f68e2014-04-02 10:57:49 +010037 dec_preempt_count_ti r10, r4
Russell King5d4cae52007-06-10 12:22:20 +010038 mov pc, lr
39ENDPROC(vfp_null_entry)
40
Catalin Marinas88987ef2009-07-24 12:32:52 +010041 .align 2
Linus Torvalds1da177e2005-04-16 15:20:36 -070042.LCvfp:
43 .word vfp_vector
44
45@ This code is called if the VFP does not exist. It needs to flag the
46@ failure to the VFP initialisation code.
47
48 __INIT
Catalin Marinas93ed3972008-08-28 11:22:32 +010049ENTRY(vfp_testing_entry)
Catalin Marinas0b1f68e2014-04-02 10:57:49 +010050 dec_preempt_count_ti r10, r4
Linus Torvalds1da177e2005-04-16 15:20:36 -070051 ldr r0, VFP_arch_address
Will Deaconf27d6e12013-05-16 19:38:51 +010052 str r0, [r0] @ set to non-zero value
Linus Torvalds1da177e2005-04-16 15:20:36 -070053 mov pc, r9 @ we have handled the fault
Catalin Marinas93ed3972008-08-28 11:22:32 +010054ENDPROC(vfp_testing_entry)
Linus Torvalds1da177e2005-04-16 15:20:36 -070055
Catalin Marinas88987ef2009-07-24 12:32:52 +010056 .align 2
Linus Torvalds1da177e2005-04-16 15:20:36 -070057VFP_arch_address:
58 .word VFP_arch
59
60 __FINIT