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

嵌入式Linux

开发平台:

Unix_Linux

  1. /* $Id: viking.S,v 1.18 2000/07/16 21:48:52 anton Exp $
  2.  * viking.S: High speed Viking cache/mmu operations
  3.  *
  4.  * Copyright (C) 1997  Eddie C. Dost  (ecd@skynet.be)
  5.  * Copyright (C) 1997,1998,1999  Jakub Jelinek  (jj@ultra.linux.cz)
  6.  * Copyright (C) 1999  Pavel Semerad  (semerad@ss1000.ms.mff.cuni.cz)
  7.  */
  8. #include <linux/config.h>
  9. #include <asm/ptrace.h>
  10. #include <asm/psr.h>
  11. #include <asm/asi.h>
  12. #include <asm/mxcc.h>
  13. #include <asm/page.h>
  14. #include <asm/pgtsrmmu.h>
  15. #include <asm/viking.h>
  16. #include <asm/cprefix.h>
  17. #include <asm/btfixup.h>
  18. #ifdef CONFIG_SMP
  19. .data
  20. .align 4
  21. sun4dsmp_flush_tlb_spin:
  22. .word 0
  23. #endif
  24. .text
  25. .align 4
  26. .globl viking_flush_cache_all, viking_flush_cache_mm
  27. .globl viking_flush_cache_range, viking_flush_cache_page
  28. .globl viking_flush_page, viking_mxcc_flush_page
  29. .globl viking_flush_page_for_dma, viking_flush_page_to_ram
  30. .globl viking_flush_sig_insns
  31. .globl viking_flush_tlb_all, viking_flush_tlb_mm
  32. .globl viking_flush_tlb_range, viking_flush_tlb_page
  33. viking_flush_page:
  34. sethi %hi(PAGE_OFFSET), %g2
  35. sub %o0, %g2, %g3
  36. srl %g3, 12, %g1 ! ppage >> 12
  37. clr %o1 ! set counter, 0 - 127
  38. sethi %hi(PAGE_OFFSET + PAGE_SIZE - 0x80000000), %o3
  39. sethi %hi(0x80000000), %o4
  40. sethi %hi(VIKING_PTAG_VALID), %o5
  41. sethi %hi(2*PAGE_SIZE), %o0
  42. sethi %hi(PAGE_SIZE), %g7
  43. clr %o2 ! block counter, 0 - 3
  44. 5:
  45. sll %o1, 5, %g4
  46. or %g4, %o4, %g4 ! 0x80000000 | (set << 5)
  47. sll %o2, 26, %g5 ! block << 26
  48. 6:
  49. or %g5, %g4, %g5
  50. ldda [%g5] ASI_M_DATAC_TAG, %g2
  51. cmp %g3, %g1 ! ptag == ppage?
  52. bne 7f
  53.  inc %o2
  54. andcc %g2, %o5, %g0 ! ptag VALID?
  55. be 7f
  56.  add %g4, %o3, %g2 ! (PAGE_OFFSET + PAGE_SIZE) | (set << 5)
  57. ld [%g2], %g3
  58. ld [%g2 + %g7], %g3
  59. add %g2, %o0, %g2
  60. ld [%g2], %g3
  61. ld [%g2 + %g7], %g3
  62. add %g2, %o0, %g2
  63. ld [%g2], %g3
  64. ld [%g2 + %g7], %g3
  65. add %g2, %o0, %g2
  66. ld [%g2], %g3
  67. b 8f
  68.  ld [%g2 + %g7], %g3
  69. 7:
  70. cmp %o2, 3
  71. ble 6b
  72.  sll %o2, 26, %g5 ! block << 26
  73. 8: inc %o1
  74. cmp %o1, 0x7f
  75. ble 5b
  76.  clr %o2
  77. 9: retl
  78.  nop
  79. viking_mxcc_flush_page:
  80. sethi %hi(PAGE_OFFSET), %g2
  81. sub %o0, %g2, %g3
  82. sub %g3, -PAGE_SIZE, %g3 ! ppage + PAGE_SIZE
  83. sethi %hi(MXCC_SRCSTREAM), %o3 ! assume %hi(MXCC_SRCSTREAM) == %hi(MXCC_DESTSTREAM)
  84. mov 0x10, %g2 ! set cacheable bit
  85. or %o3, %lo(MXCC_SRCSTREAM), %o2
  86. or %o3, %lo(MXCC_DESSTREAM), %o3
  87. sub %g3, MXCC_STREAM_SIZE, %g3
  88. 6:
  89. stda %g2, [%o2] ASI_M_MXCC
  90. stda %g2, [%o3] ASI_M_MXCC
  91. andncc %g3, PAGE_MASK, %g0
  92. bne 6b
  93.  sub %g3, MXCC_STREAM_SIZE, %g3
  94. 9: retl
  95.  nop
  96. viking_flush_cache_page:
  97. #ifndef CONFIG_SMP
  98. ld [%o0 + 0x0], %o0 /* XXX vma->vm_mm, GROSS XXX */
  99. #endif
  100. viking_flush_cache_mm:
  101. viking_flush_cache_range:
  102. #ifndef CONFIG_SMP
  103. ld [%o0 + AOFF_mm_context], %g1
  104. cmp %g1, -1
  105. bne viking_flush_cache_all
  106.  nop
  107. b,a viking_flush_cache_out
  108. #endif
  109. viking_flush_cache_all:
  110. WINDOW_FLUSH(%g4, %g5)
  111. viking_flush_cache_out:
  112. retl
  113.  nop
  114. viking_flush_tlb_all:
  115. mov 0x400, %g1
  116. retl
  117.  sta %g0, [%g1] ASI_M_FLUSH_PROBE
  118. viking_flush_tlb_mm:
  119. mov SRMMU_CTX_REG, %g1
  120. ld [%o0 + AOFF_mm_context], %o1
  121. lda [%g1] ASI_M_MMUREGS, %g5
  122. #ifndef CONFIG_SMP
  123. cmp %o1, -1
  124. be 1f
  125. #endif
  126. mov 0x300, %g2
  127. sta %o1, [%g1] ASI_M_MMUREGS
  128. sta %g0, [%g2] ASI_M_FLUSH_PROBE
  129. retl
  130.  sta %g5, [%g1] ASI_M_MMUREGS
  131. #ifndef CONFIG_SMP
  132. 1: retl
  133.  nop
  134. #endif
  135. viking_flush_tlb_range:
  136. mov SRMMU_CTX_REG, %g1
  137. ld [%o0 + AOFF_mm_context], %o3
  138. lda [%g1] ASI_M_MMUREGS, %g5
  139. #ifndef CONFIG_SMP
  140. cmp %o3, -1
  141. be 2f
  142. #endif
  143. sethi %hi(~((1 << SRMMU_PGDIR_SHIFT) - 1)), %o4
  144. sta %o3, [%g1] ASI_M_MMUREGS
  145. and %o1, %o4, %o1
  146. add %o1, 0x200, %o1
  147. sta %g0, [%o1] ASI_M_FLUSH_PROBE
  148. 1: sub %o1, %o4, %o1
  149. cmp %o1, %o2
  150. blu,a 1b
  151.  sta %g0, [%o1] ASI_M_FLUSH_PROBE
  152. retl
  153.  sta %g5, [%g1] ASI_M_MMUREGS
  154. #ifndef CONFIG_SMP
  155. 2: retl
  156.  nop
  157. #endif
  158. viking_flush_tlb_page:
  159. ld [%o0 + 0x00], %o0 /* XXX vma->vm_mm GROSS XXX */
  160. mov SRMMU_CTX_REG, %g1
  161. ld [%o0 + AOFF_mm_context], %o3
  162. lda [%g1] ASI_M_MMUREGS, %g5
  163. #ifndef CONFIG_SMP
  164. cmp %o3, -1
  165. be 1f
  166. #endif
  167. and %o1, PAGE_MASK, %o1
  168. sta %o3, [%g1] ASI_M_MMUREGS
  169. sta %g0, [%o1] ASI_M_FLUSH_PROBE
  170. retl
  171.  sta %g5, [%g1] ASI_M_MMUREGS
  172. #ifndef CONFIG_SMP
  173. 1: retl
  174.  nop
  175. #endif
  176. viking_flush_page_to_ram:
  177. viking_flush_page_for_dma:
  178. viking_flush_sig_insns:
  179. retl
  180.  nop
  181. #ifdef CONFIG_SMP
  182. .globl sun4dsmp_flush_tlb_all, sun4dsmp_flush_tlb_mm
  183. .globl sun4dsmp_flush_tlb_range, sun4dsmp_flush_tlb_page
  184. sun4dsmp_flush_tlb_all:
  185. sethi %hi(sun4dsmp_flush_tlb_spin), %g3
  186. 1: ldstub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
  187. tst %g5
  188. bne 2f
  189.  mov 0x400, %g1
  190. sta %g0, [%g1] ASI_M_FLUSH_PROBE
  191. retl
  192.  stb %g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
  193. 2: tst %g5
  194. bne,a 2b
  195.  ldub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
  196. b,a 1b
  197. sun4dsmp_flush_tlb_mm:
  198. sethi %hi(sun4dsmp_flush_tlb_spin), %g3
  199. 1: ldstub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
  200. tst %g5
  201. bne 2f
  202.  mov SRMMU_CTX_REG, %g1
  203. ld [%o0 + AOFF_mm_context], %o1
  204. lda [%g1] ASI_M_MMUREGS, %g5
  205. mov 0x300, %g2
  206. sta %o1, [%g1] ASI_M_MMUREGS
  207. sta %g0, [%g2] ASI_M_FLUSH_PROBE
  208. sta %g5, [%g1] ASI_M_MMUREGS
  209. retl
  210.  stb %g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
  211. 2: tst %g5
  212. bne,a 2b
  213.  ldub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
  214. b,a 1b
  215. sun4dsmp_flush_tlb_range:
  216. sethi %hi(sun4dsmp_flush_tlb_spin), %g3
  217. 1: ldstub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
  218. tst %g5
  219. bne 3f
  220.  mov SRMMU_CTX_REG, %g1
  221. ld [%o0 + AOFF_mm_context], %o3
  222. lda [%g1] ASI_M_MMUREGS, %g5
  223. sethi %hi(~((1 << SRMMU_PGDIR_SHIFT) - 1)), %o4
  224. sta %o3, [%g1] ASI_M_MMUREGS
  225. and %o1, %o4, %o1
  226. add %o1, 0x200, %o1
  227. sta %g0, [%o1] ASI_M_FLUSH_PROBE
  228. 2: sub %o1, %o4, %o1
  229. cmp %o1, %o2
  230. blu,a 2b
  231.  sta %g0, [%o1] ASI_M_FLUSH_PROBE
  232. sta %g5, [%g1] ASI_M_MMUREGS
  233. retl
  234.  stb %g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
  235. 3: tst %g5
  236. bne,a 3b
  237.  ldub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
  238. b,a 1b
  239. sun4dsmp_flush_tlb_page:
  240. sethi %hi(sun4dsmp_flush_tlb_spin), %g3
  241. 1: ldstub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
  242. tst %g5
  243. bne 2f
  244.  mov SRMMU_CTX_REG, %g1
  245. ld [%o0 + 0x00], %o0 /* XXX vma->vm_mm GROSS XXX */
  246. ld [%o0 + AOFF_mm_context], %o3
  247. lda [%g1] ASI_M_MMUREGS, %g5
  248. and %o1, PAGE_MASK, %o1
  249. sta %o3, [%g1] ASI_M_MMUREGS
  250. sta %g0, [%o1] ASI_M_FLUSH_PROBE
  251. sta %g5, [%g1] ASI_M_MMUREGS
  252. retl
  253.  stb %g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
  254. 2: tst %g5
  255. bne,a 2b
  256.  ldub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
  257. b,a 1b
  258.  nop
  259. #endif