entry.S
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:4k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.     NetWinder Floating Point Emulator
  3.     (c) Rebel.COM, 1998
  4.     (c) 1998, 1999 Philip Blundell
  5.     Direct questions, comments to Scott Bambrough <scottb@netwinder.org>
  6.     This program is free software; you can redistribute it and/or modify
  7.     it under the terms of the GNU General Public License as published by
  8.     the Free Software Foundation; either version 2 of the License, or
  9.     (at your option) any later version.
  10.     This program is distributed in the hope that it will be useful,
  11.     but WITHOUT ANY WARRANTY; without even the implied warranty of
  12.     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13.     GNU General Public License for more details.
  14.     You should have received a copy of the GNU General Public License
  15.     along with this program; if not, write to the Free Software
  16.     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  17. */
  18. /* This is the kernel's entry point into the floating point emulator.
  19. It is called from the kernel with code similar to this:
  20. adrsvc al, r9, ret_from_exception @ r9  = normal FP return
  21. adrsvc al, lr, fpundefinstr @ lr  = undefined instr return
  22. get_current_task r10
  23. mov r8, #1
  24. strb r8, [r10, #TSK_USED_MATH] @ set current->used_math
  25. add r10, r10, #TSS_FPESAVE @ r10 = workspace
  26. ldr r4, .LC2
  27. ldr pc, [r4] @ Call FP emulator entry point
  28. The kernel expects the emulator to return via one of two possible
  29. points of return it passes to the emulator.  The emulator, if
  30. successful in its emulation, jumps to ret_from_exception (passed in
  31. r9) and the kernel takes care of returning control from the trap to
  32. the user code.  If the emulator is unable to emulate the instruction,
  33. it returns via _fpundefinstr (passed via lr) and the kernel halts the
  34. user program with a core dump.
  35. On entry to the emulator r10 points to an area of private FP workspace
  36. reserved in the thread structure for this process.  This is where the
  37. emulator saves its registers across calls.  The first word of this area
  38. is used as a flag to detect the first time a process uses floating point,
  39. so that the emulator startup cost can be avoided for tasks that don't
  40. want it.
  41. This routine does three things:
  42. 1) The kernel has created a struct pt_regs on the stack and saved the
  43. user registers into it.  See inclue/asm-arm/proc/ptrace.h for details.
  44. 2) It calls EmulateAll to emulate a floating point instruction.
  45. EmulateAll returns 1 if the emulation was successful, or 0 if not.
  46. 3) If an instruction has been emulated successfully, it looks ahead at
  47. the next instruction.  If it is a floating point instruction, it
  48. executes the instruction, without returning to user space.  In this
  49. way it repeatedly looks ahead and executes floating point instructions
  50. until it encounters a non floating point instruction, at which time it
  51. returns via _fpreturn.
  52. This is done to reduce the effect of the trap overhead on each
  53. floating point instructions.  GCC attempts to group floating point
  54. instructions to allow the emulator to spread the cost of the trap over
  55. several floating point instructions.  */
  56. .globl nwfpe_enter
  57. nwfpe_enter:
  58.         mov r4, lr @ save the failure-return addresses
  59. mov sl, sp @ we access the registers via 'sl'
  60.         ldr r5, [sp, #60]   @ get contents of PC;
  61. sub r8, r5, #4
  62. .Lx2: ldrt r0, [r8] @ get actual instruction into r0
  63. emulate:
  64. bl EmulateAll @ emulate the instruction
  65.     cmp r0, #0 @ was emulation successful
  66.         moveq pc, r4 @ no, return failure
  67. next:
  68. .Lx1: ldrt r6, [r5], #4 @ get the next instruction and
  69. @ increment PC
  70. and   r2, r6, #0x0F000000 @ test for FP insns
  71.         teq   r2, #0x0C000000
  72.         teqne r2, #0x0D000000
  73.         teqne r2, #0x0E000000
  74.         movne pc, r9 @ return ok if not a fp insn
  75.         str r5, [sp, #60] @ update PC copy in regs
  76.         mov r0, r6 @ save a copy
  77.         ldr r1, [sp, #64] @ fetch the condition codes
  78.     bl  checkCondition @ check the condition
  79.     cmp r0, #0 @ r0 = 0 ==> condition failed
  80.         @ if condition code failed to match, next insn
  81.     beq next @ get the next instruction;
  82.         
  83.         mov r0, r6 @ prepare for EmulateAll()
  84.     b emulate @ if r0 != 0, goto EmulateAll
  85. @ We need to be prepared for the instructions at .Lx1 and .Lx2 
  86. @ to fault.  Emit the appropriate exception gunk to fix things up.
  87. @ ??? For some reason, faults can happen at .Lx2 even with a
  88. @ plain LDR instruction.  Weird, but it seems harmless.
  89. .section .fixup,"ax"
  90. .align 2
  91. .Lfix: mov pc, r9 @ let the user eat segfaults
  92. .previous
  93. .section __ex_table,"a"
  94. .align 3
  95. .long .Lx1, .Lfix
  96. .long .Lx2, .Lfix
  97. .previous