blob: 2e78760f3495d900abf3d4d855197dc5164196f1 [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
Catalin Marinas1417a6b2014-04-22 16:14:29 +010025@ IRQs enabled.
Russell King15ac49b2012-07-30 19:42:10 +010026@
Catalin Marinas93ed3972008-08-28 11:22:32 +010027ENTRY(do_vfp)
Catalin Marinas0b1f68e2014-04-02 10:57:49 +010028 inc_preempt_count r10, r4
Linus Torvalds1da177e2005-04-16 15:20:36 -070029 ldr r4, .LCvfp
Catalin Marinasc6428462007-01-24 18:47:08 +010030 ldr r11, [r10, #TI_CPU] @ CPU number
Linus Torvalds1da177e2005-04-16 15:20:36 -070031 add r10, r10, #TI_VFPSTATE @ r10 = workspace
32 ldr pc, [r4] @ call VFP entry point
Catalin Marinas93ed3972008-08-28 11:22:32 +010033ENDPROC(do_vfp)
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
Russell King5d4cae52007-06-10 12:22:20 +010035ENTRY(vfp_null_entry)
Catalin Marinas0b1f68e2014-04-02 10:57:49 +010036 dec_preempt_count_ti r10, r4
Russell King6ebbf2c2014-06-30 16:29:12 +010037 ret lr
Russell King5d4cae52007-06-10 12:22:20 +010038ENDPROC(vfp_null_entry)
39
Catalin Marinas88987ef2009-07-24 12:32:52 +010040 .align 2
Linus Torvalds1da177e2005-04-16 15:20:36 -070041.LCvfp:
42 .word vfp_vector
43
44@ This code is called if the VFP does not exist. It needs to flag the
45@ failure to the VFP initialisation code.
46
47 __INIT
Catalin Marinas93ed3972008-08-28 11:22:32 +010048ENTRY(vfp_testing_entry)
Catalin Marinas0b1f68e2014-04-02 10:57:49 +010049 dec_preempt_count_ti r10, r4
Linus Torvalds1da177e2005-04-16 15:20:36 -070050 ldr r0, VFP_arch_address
Will Deaconf27d6e12013-05-16 19:38:51 +010051 str r0, [r0] @ set to non-zero value
Russell King6ebbf2c2014-06-30 16:29:12 +010052 ret r9 @ we have handled the fault
Catalin Marinas93ed3972008-08-28 11:22:32 +010053ENDPROC(vfp_testing_entry)
Linus Torvalds1da177e2005-04-16 15:20:36 -070054
Catalin Marinas88987ef2009-07-24 12:32:52 +010055 .align 2
Linus Torvalds1da177e2005-04-16 15:20:36 -070056VFP_arch_address:
57 .word VFP_arch
58
59 __FINIT