2005-04-17 05:20:36 +07:00
|
|
|
/*
|
|
|
|
* 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
|
|
|
|
*/
|
2009-04-02 02:27:18 +07:00
|
|
|
#include <asm/thread_info.h>
|
2005-04-17 05:20:36 +07:00
|
|
|
#include <asm/vfpmacros.h>
|
2009-04-02 02:27:18 +07:00
|
|
|
#include "../kernel/entry-header.S"
|
2005-04-17 05:20:36 +07:00
|
|
|
|
2008-08-28 17:22:32 +07:00
|
|
|
ENTRY(do_vfp)
|
2009-04-02 02:27:18 +07:00
|
|
|
#ifdef CONFIG_PREEMPT
|
|
|
|
ldr r4, [r10, #TI_PREEMPT] @ get preempt count
|
|
|
|
add r11, r4, #1 @ increment it
|
|
|
|
str r11, [r10, #TI_PREEMPT]
|
|
|
|
#endif
|
2006-03-15 19:33:43 +07:00
|
|
|
enable_irq
|
2005-04-17 05:20:36 +07:00
|
|
|
ldr r4, .LCvfp
|
2007-01-25 00:47:08 +07:00
|
|
|
ldr r11, [r10, #TI_CPU] @ CPU number
|
2005-04-17 05:20:36 +07:00
|
|
|
add r10, r10, #TI_VFPSTATE @ r10 = workspace
|
|
|
|
ldr pc, [r4] @ call VFP entry point
|
2008-08-28 17:22:32 +07:00
|
|
|
ENDPROC(do_vfp)
|
2005-04-17 05:20:36 +07:00
|
|
|
|
2007-06-10 18:22:20 +07:00
|
|
|
ENTRY(vfp_null_entry)
|
2009-04-02 02:27:18 +07:00
|
|
|
#ifdef CONFIG_PREEMPT
|
|
|
|
get_thread_info r10
|
|
|
|
ldr r4, [r10, #TI_PREEMPT] @ get preempt count
|
|
|
|
sub r11, r4, #1 @ decrement it
|
|
|
|
str r11, [r10, #TI_PREEMPT]
|
|
|
|
#endif
|
2007-06-10 18:22:20 +07:00
|
|
|
mov pc, lr
|
|
|
|
ENDPROC(vfp_null_entry)
|
|
|
|
|
2009-07-24 18:32:52 +07:00
|
|
|
.align 2
|
2005-04-17 05:20:36 +07:00
|
|
|
.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
|
2008-08-28 17:22:32 +07:00
|
|
|
ENTRY(vfp_testing_entry)
|
2009-04-02 02:27:18 +07:00
|
|
|
#ifdef CONFIG_PREEMPT
|
|
|
|
get_thread_info r10
|
|
|
|
ldr r4, [r10, #TI_PREEMPT] @ get preempt count
|
|
|
|
sub r11, r4, #1 @ decrement it
|
|
|
|
str r11, [r10, #TI_PREEMPT]
|
|
|
|
#endif
|
2005-04-17 05:20:36 +07:00
|
|
|
ldr r0, VFP_arch_address
|
|
|
|
str r5, [r0] @ known non-zero value
|
|
|
|
mov pc, r9 @ we have handled the fault
|
2008-08-28 17:22:32 +07:00
|
|
|
ENDPROC(vfp_testing_entry)
|
2005-04-17 05:20:36 +07:00
|
|
|
|
2009-07-24 18:32:52 +07:00
|
|
|
.align 2
|
2005-04-17 05:20:36 +07:00
|
|
|
VFP_arch_address:
|
|
|
|
.word VFP_arch
|
|
|
|
|
|
|
|
__FINIT
|