entry.S 1.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748
  1. /*
  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.
  10. *
  11. * Basic entry code, called from the kernel's undefined instruction trap.
  12. * r0 = faulted instruction
  13. * r5 = faulted PC+4
  14. * r9 = successful return
  15. * r10 = thread_info structure
  16. * lr = failure return
  17. */
  18. #include <linux/linkage.h>
  19. #include <linux/init.h>
  20. #include <asm/asm-offsets.h>
  21. #include <asm/assembler.h>
  22. #include <asm/vfpmacros.h>
  23. .globl do_vfp
  24. do_vfp:
  25. enable_irq
  26. ldr r4, .LCvfp
  27. ldr r11, [r10, #TI_CPU] @ CPU number
  28. add r10, r10, #TI_VFPSTATE @ r10 = workspace
  29. ldr pc, [r4] @ call VFP entry point
  30. .LCvfp:
  31. .word vfp_vector
  32. @ This code is called if the VFP does not exist. It needs to flag the
  33. @ failure to the VFP initialisation code.
  34. __INIT
  35. .globl vfp_testing_entry
  36. vfp_testing_entry:
  37. ldr r0, VFP_arch_address
  38. str r5, [r0] @ known non-zero value
  39. mov pc, r9 @ we have handled the fault
  40. VFP_arch_address:
  41. .word VFP_arch
  42. __FINIT