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

嵌入式Linux

开发平台:

Unix_Linux

  1. /* $Id: VISsave.S,v 1.5 2001/03/08 22:08:51 davem Exp $
  2.  * VISsave.S: Code for saving FPU register state for
  3.  *            VIS routines. One should not call this directly,
  4.  *            but use macros provided in <asm/visasm.h>.
  5.  *
  6.  * Copyright (C) 1998 Jakub Jelinek (jj@ultra.linux.cz)
  7.  */
  8. #include <asm/asi.h>
  9. #include <asm/page.h>
  10. #include <asm/ptrace.h>
  11. #include <asm/visasm.h>
  12. .text
  13. .globl VISenter, VISenterhalf
  14. /* On entry: %o5=current FPRS value, %g7 is callers address */
  15. /* May clobber %o5, %g1, %g2, %g3, %g7, %icc, %xcc */
  16. .align 32
  17. VISenter:
  18. ldub [%g6 + AOFF_task_thread + AOFF_thread_fpdepth], %g1
  19. brnz,a,pn %g1, 1f
  20.  cmp %g1, 1
  21. stb %g0, [%g6 + AOFF_task_thread + AOFF_thread_fpsaved]
  22. stx %fsr, [%g6 + AOFF_task_thread + AOFF_thread_xfsr]
  23. 9: jmpl %g7 + %g0, %g0
  24.  nop
  25. 1: bne,pn %icc, 2f
  26.  srl %g1, 1, %g1
  27. vis1: ldub [%g6 + AOFF_task_thread + AOFF_thread_fpsaved], %g3
  28. stx %fsr, [%g6 + AOFF_task_thread + AOFF_thread_xfsr]
  29. or %g3, %o5, %g3
  30. stb %g3, [%g6 + AOFF_task_thread + AOFF_thread_fpsaved]
  31. rd %gsr, %g3
  32. clr %g1
  33. ba,pt %xcc, 3f
  34.  stx %g3, [%g6 + AOFF_task_thread + AOFF_thread_gsr]
  35. 2: add %g6, %g1, %g3
  36. cmp %o5, FPRS_DU
  37. be,pn %icc, 6f
  38.  sll %g1, 3, %g1
  39. stb %o5, [%g3 + AOFF_task_thread + AOFF_thread_fpsaved]
  40. rd %gsr, %g2
  41. add %g6, %g1, %g3
  42. stx %g2, [%g3 + AOFF_task_thread + AOFF_thread_gsr]
  43. add %g6, %g1, %g2
  44. stx %fsr, [%g2 + AOFF_task_thread + AOFF_thread_xfsr]
  45. sll %g1, 5, %g1
  46. 3: andcc %o5, FPRS_DL|FPRS_DU, %g0
  47. be,pn %icc, 9b
  48.  add %g6, AOFF_task_fpregs, %g2
  49. andcc %o5, FPRS_DL, %g0
  50. membar #StoreStore | #LoadStore
  51. be,pn %icc, 4f
  52.  add %g6, AOFF_task_fpregs+0x40, %g3
  53. stda %f0, [%g2 + %g1] ASI_BLK_P
  54. stda %f16, [%g3 + %g1] ASI_BLK_P
  55. andcc %o5, FPRS_DU, %g0
  56. be,pn %icc, 5f
  57. 4:  add %g1, 128, %g1
  58. stda %f32, [%g2 + %g1] ASI_BLK_P
  59. stda %f48, [%g3 + %g1] ASI_BLK_P
  60. 5: membar #Sync
  61. jmpl %g7 + %g0, %g0
  62.  nop
  63. 6: ldub [%g3 + AOFF_task_thread + AOFF_thread_fpsaved], %o5
  64. or %o5, FPRS_DU, %o5
  65. add %g6, AOFF_task_fpregs+0x80, %g2
  66. stb %o5, [%g3 + AOFF_task_thread + AOFF_thread_fpsaved]
  67. sll %g1, 5, %g1
  68. add %g6, AOFF_task_fpregs+0xc0, %g3
  69. wr %g0, FPRS_FEF, %fprs
  70. membar #StoreStore | #LoadStore
  71. stda %f32, [%g2 + %g1] ASI_BLK_P
  72. stda %f48, [%g3 + %g1] ASI_BLK_P
  73. membar #Sync
  74. jmpl %g7 + %g0, %g0
  75.  nop
  76. .align 32
  77. VISenterhalf:
  78. ldub [%g6 + AOFF_task_thread + AOFF_thread_fpdepth], %g1
  79. brnz,a,pn %g1, 1f
  80.  cmp %g1, 1
  81. stb %g0, [%g6 + AOFF_task_thread + AOFF_thread_fpsaved]
  82. stx %fsr, [%g6 + AOFF_task_thread + AOFF_thread_xfsr]
  83. clr %o5
  84. jmpl %g7 + %g0, %g0
  85.  wr %g0, FPRS_FEF, %fprs
  86. 1: bne,pn %icc, 2f
  87.  srl %g1, 1, %g1
  88. ba,pt %xcc, vis1
  89.  sub %g7, 8, %g7
  90. 2: addcc %g6, %g1, %g3
  91. sll %g1, 3, %g1
  92. andn %o5, FPRS_DU, %g2
  93. stb %g2, [%g3 + AOFF_task_thread + AOFF_thread_fpsaved]
  94. rd %gsr, %g2
  95. add %g6, %g1, %g3
  96. stx %g2, [%g3 + AOFF_task_thread + AOFF_thread_gsr]
  97. add %g6, %g1, %g2
  98. stx %fsr, [%g2 + AOFF_task_thread + AOFF_thread_xfsr]
  99. sll %g1, 5, %g1
  100. 3: andcc %o5, FPRS_DL, %g0
  101. be,pn %icc, 4f
  102.  add %g6, AOFF_task_fpregs, %g2
  103. membar #StoreStore | #LoadStore
  104. add %g6, AOFF_task_fpregs+0x40, %g3
  105. stda %f0, [%g2 + %g1] ASI_BLK_P
  106. stda %f16, [%g3 + %g1] ASI_BLK_P
  107. membar #Sync
  108. 4: and %o5, FPRS_DU, %o5
  109. jmpl %g7 + %g0, %g0
  110.  wr %o5, FPRS_FEF, %fprs