Halaman utama Jelajahi Bantuan
Masuk
weimzh
/
amlogic-aml8726-mx-kernel
Liatin 1
Bintangi 0
Fork 0
Berkas Masalah 0 Tarik Permintaan 0 Wiki
Pohon: 16855b5ec0
Ranting Tag
amlogic-aml8...
/
arch
/
sparc
/
kernel
/
fpu_traps.S

fpu_traps.S 8.1 KB
Riwayat Mentahan

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385 
  1. 	/* This is trivial with the new code... */
    2. 

  2. 	.globl		do_fpdis
    3. 

  3. 	.type		do_fpdis,#function
    4. 

  4. do_fpdis:
    5. 

  5. 	sethi		%hi(TSTATE_PEF), %g4
    6. 

  6. 	rdpr		%tstate, %g5
    7. 

  7. 	andcc		%g5, %g4, %g0
    8. 

  8. 	be,pt		%xcc, 1f
    9. 

  9. 	 nop
    10. 

  10. 	rd		%fprs, %g5
    11. 

  11. 	andcc		%g5, FPRS_FEF, %g0
    12. 

  12. 	be,pt		%xcc, 1f
    13. 

  13. 	 nop
    14. 

  14. 

  15. 	/* Legal state when DCR_IFPOE is set in Cheetah %dcr. */
    16. 

  16. 	sethi		%hi(109f), %g7
    17. 

  17. 	ba,pt		%xcc, etrap
    18. 

  18. 109:	 or		%g7, %lo(109b), %g7
    19. 

  19. 	add		%g0, %g0, %g0
    20. 

  20. 	ba,a,pt		%xcc, rtrap
    21. 

  21. 

  22. 1:	TRAP_LOAD_THREAD_REG(%g6, %g1)
    23. 

  23. 	ldub		[%g6 + TI_FPSAVED], %g5
    24. 

  24. 	wr		%g0, FPRS_FEF, %fprs
    25. 

  25. 	andcc		%g5, FPRS_FEF, %g0
    26. 

  26. 	be,a,pt		%icc, 1f
    27. 

  27. 	 clr		%g7
    28. 

  28. 	ldx		[%g6 + TI_GSR], %g7
    29. 

  29. 1:	andcc		%g5, FPRS_DL, %g0
    30. 

  30. 	bne,pn		%icc, 2f
    31. 

  31. 	 fzero		%f0
    32. 

  32. 	andcc		%g5, FPRS_DU, %g0
    33. 

  33. 	bne,pn		%icc, 1f
    34. 

  34. 	 fzero		%f2
    35. 

  35. 	faddd		%f0, %f2, %f4
    36. 

  36. 	fmuld		%f0, %f2, %f6
    37. 

  37. 	faddd		%f0, %f2, %f8
    38. 

  38. 	fmuld		%f0, %f2, %f10
    39. 

  39. 	faddd		%f0, %f2, %f12
    40. 

  40. 	fmuld		%f0, %f2, %f14
    41. 

  41. 	faddd		%f0, %f2, %f16
    42. 

  42. 	fmuld		%f0, %f2, %f18
    43. 

  43. 	faddd		%f0, %f2, %f20
    44. 

  44. 	fmuld		%f0, %f2, %f22
    45. 

  45. 	faddd		%f0, %f2, %f24
    46. 

  46. 	fmuld		%f0, %f2, %f26
    47. 

  47. 	faddd		%f0, %f2, %f28
    48. 

  48. 	fmuld		%f0, %f2, %f30
    49. 

  49. 	faddd		%f0, %f2, %f32
    50. 

  50. 	fmuld		%f0, %f2, %f34
    51. 

  51. 	faddd		%f0, %f2, %f36
    52. 

  52. 	fmuld		%f0, %f2, %f38
    53. 

  53. 	faddd		%f0, %f2, %f40
    54. 

  54. 	fmuld		%f0, %f2, %f42
    55. 

  55. 	faddd		%f0, %f2, %f44
    56. 

  56. 	fmuld		%f0, %f2, %f46
    57. 

  57. 	faddd		%f0, %f2, %f48
    58. 

  58. 	fmuld		%f0, %f2, %f50
    59. 

  59. 	faddd		%f0, %f2, %f52
    60. 

  60. 	fmuld		%f0, %f2, %f54
    61. 

  61. 	faddd		%f0, %f2, %f56
    62. 

  62. 	fmuld		%f0, %f2, %f58
    63. 

  63. 	b,pt		%xcc, fpdis_exit2
    64. 

  64. 	 faddd		%f0, %f2, %f60
    65. 

  65. 1:	mov		SECONDARY_CONTEXT, %g3
    66. 

  66. 	add		%g6, TI_FPREGS + 0x80, %g1
    67. 

  67. 	faddd		%f0, %f2, %f4
    68. 

  68. 	fmuld		%f0, %f2, %f6
    69. 

  69. 

  70. 661:	ldxa		[%g3] ASI_DMMU, %g5
    71. 

  71. 	.section	.sun4v_1insn_patch, "ax"
    72. 

  72. 	.word		661b
    73. 

  73. 	ldxa		[%g3] ASI_MMU, %g5
    74. 

  74. 	.previous
    75. 

  75. 

  76. 	sethi		%hi(sparc64_kern_sec_context), %g2
    77. 

  77. 	ldx		[%g2 + %lo(sparc64_kern_sec_context)], %g2
    78. 

  78. 

  79. 661:	stxa		%g2, [%g3] ASI_DMMU
    80. 

  80. 	.section	.sun4v_1insn_patch, "ax"
    81. 

  81. 	.word		661b
    82. 

  82. 	stxa		%g2, [%g3] ASI_MMU
    83. 

  83. 	.previous
    84. 

  84. 

  85. 	membar		#Sync
    86. 

  86. 	add		%g6, TI_FPREGS + 0xc0, %g2
    87. 

  87. 	faddd		%f0, %f2, %f8
    88. 

  88. 	fmuld		%f0, %f2, %f10
    89. 

  89. 	membar		#Sync
    90. 

  90. 	ldda		[%g1] ASI_BLK_S, %f32
    91. 

  91. 	ldda		[%g2] ASI_BLK_S, %f48
    92. 

  92. 	membar		#Sync
    93. 

  93. 	faddd		%f0, %f2, %f12
    94. 

  94. 	fmuld		%f0, %f2, %f14
    95. 

  95. 	faddd		%f0, %f2, %f16
    96. 

  96. 	fmuld		%f0, %f2, %f18
    97. 

  97. 	faddd		%f0, %f2, %f20
    98. 

  98. 	fmuld		%f0, %f2, %f22
    99. 

  99. 	faddd		%f0, %f2, %f24
    100. 

  100. 	fmuld		%f0, %f2, %f26
    101. 

  101. 	faddd		%f0, %f2, %f28
    102. 

  102. 	fmuld		%f0, %f2, %f30
    103. 

  103. 	b,pt		%xcc, fpdis_exit
    104. 

  104. 	 nop
    105. 

  105. 2:	andcc		%g5, FPRS_DU, %g0
    106. 

  106. 	bne,pt		%icc, 3f
    107. 

  107. 	 fzero		%f32
    108. 

  108. 	mov		SECONDARY_CONTEXT, %g3
    109. 

  109. 	fzero		%f34
    110. 

  110. 

  111. 661:	ldxa		[%g3] ASI_DMMU, %g5
    112. 

  112. 	.section	.sun4v_1insn_patch, "ax"
    113. 

  113. 	.word		661b
    114. 

  114. 	ldxa		[%g3] ASI_MMU, %g5
    115. 

  115. 	.previous
    116. 

  116. 

  117. 	add		%g6, TI_FPREGS, %g1
    118. 

  118. 	sethi		%hi(sparc64_kern_sec_context), %g2
    119. 

  119. 	ldx		[%g2 + %lo(sparc64_kern_sec_context)], %g2
    120. 

  120. 

  121. 661:	stxa		%g2, [%g3] ASI_DMMU
    122. 

  122. 	.section	.sun4v_1insn_patch, "ax"
    123. 

  123. 	.word		661b
    124. 

  124. 	stxa		%g2, [%g3] ASI_MMU
    125. 

  125. 	.previous
    126. 

  126. 

  127. 	membar		#Sync
    128. 

  128. 	add		%g6, TI_FPREGS + 0x40, %g2
    129. 

  129. 	faddd		%f32, %f34, %f36
    130. 

  130. 	fmuld		%f32, %f34, %f38
    131. 

  131. 	membar		#Sync
    132. 

  132. 	ldda		[%g1] ASI_BLK_S, %f0
    133. 

  133. 	ldda		[%g2] ASI_BLK_S, %f16
    134. 

  134. 	membar		#Sync
    135. 

  135. 	faddd		%f32, %f34, %f40
    136. 

  136. 	fmuld		%f32, %f34, %f42
    137. 

  137. 	faddd		%f32, %f34, %f44
    138. 

  138. 	fmuld		%f32, %f34, %f46
    139. 

  139. 	faddd		%f32, %f34, %f48
    140. 

  140. 	fmuld		%f32, %f34, %f50
    141. 

  141. 	faddd		%f32, %f34, %f52
    142. 

  142. 	fmuld		%f32, %f34, %f54
    143. 

  143. 	faddd		%f32, %f34, %f56
    144. 

  144. 	fmuld		%f32, %f34, %f58
    145. 

  145. 	faddd		%f32, %f34, %f60
    146. 

  146. 	fmuld		%f32, %f34, %f62
    147. 

  147. 	ba,pt		%xcc, fpdis_exit
    148. 

  148. 	 nop
    149. 

  149. 3:	mov		SECONDARY_CONTEXT, %g3
    150. 

  150. 	add		%g6, TI_FPREGS, %g1
    151. 

  151. 

  152. 661:	ldxa		[%g3] ASI_DMMU, %g5
    153. 

  153. 	.section	.sun4v_1insn_patch, "ax"
    154. 

  154. 	.word		661b
    155. 

  155. 	ldxa		[%g3] ASI_MMU, %g5
    156. 

  156. 	.previous
    157. 

  157. 

  158. 	sethi		%hi(sparc64_kern_sec_context), %g2
    159. 

  159. 	ldx		[%g2 + %lo(sparc64_kern_sec_context)], %g2
    160. 

  160. 

  161. 661:	stxa		%g2, [%g3] ASI_DMMU
    162. 

  162. 	.section	.sun4v_1insn_patch, "ax"
    163. 

  163. 	.word		661b
    164. 

  164. 	stxa		%g2, [%g3] ASI_MMU
    165. 

  165. 	.previous
    166. 

  166. 

  167. 	membar		#Sync
    168. 

  168. 	mov		0x40, %g2
    169. 

  169. 	membar		#Sync
    170. 

  170. 	ldda		[%g1] ASI_BLK_S, %f0
    171. 

  171. 	ldda		[%g1 + %g2] ASI_BLK_S, %f16
    172. 

  172. 	add		%g1, 0x80, %g1
    173. 

  173. 	ldda		[%g1] ASI_BLK_S, %f32
    174. 

  174. 	ldda		[%g1 + %g2] ASI_BLK_S, %f48
    175. 

  175. 	membar		#Sync
    176. 

  176. fpdis_exit:
    177. 

  177. 

  178. 661:	stxa		%g5, [%g3] ASI_DMMU
    179. 

  179. 	.section	.sun4v_1insn_patch, "ax"
    180. 

  180. 	.word		661b
    181. 

  181. 	stxa		%g5, [%g3] ASI_MMU
    182. 

  182. 	.previous
    183. 

  183. 

  184. 	membar		#Sync
    185. 

  185. fpdis_exit2:
    186. 

  186. 	wr		%g7, 0, %gsr
    187. 

  187. 	ldx		[%g6 + TI_XFSR], %fsr
    188. 

  188. 	rdpr		%tstate, %g3
    189. 

  189. 	or		%g3, %g4, %g3		! anal...
    190. 

  190. 	wrpr		%g3, %tstate
    191. 

  191. 	wr		%g0, FPRS_FEF, %fprs	! clean DU/DL bits
    192. 

  192. 	retry
    193. 

  193. 	.size		do_fpdis,.-do_fpdis
    194. 

  194. 

  195. 	.align		32
    196. 

  196. 	.type		fp_other_bounce,#function
    197. 

  197. fp_other_bounce:
    198. 

  198. 	call		do_fpother
    199. 

  199. 	 add		%sp, PTREGS_OFF, %o0
    200. 

  200. 	ba,pt		%xcc, rtrap
    201. 

  201. 	 nop
    202. 

  202. 	.size		fp_other_bounce,.-fp_other_bounce
    203. 

  203. 

  204. 	.align		32
    205. 

  205. 	.globl		do_fpother_check_fitos
    206. 

  206. 	.type		do_fpother_check_fitos,#function
    207. 

  207. do_fpother_check_fitos:
    208. 

  208. 	TRAP_LOAD_THREAD_REG(%g6, %g1)
    209. 

  209. 	sethi		%hi(fp_other_bounce - 4), %g7
    210. 

  210. 	or		%g7, %lo(fp_other_bounce - 4), %g7
    211. 

  211. 

  212. 	/* NOTE: Need to preserve %g7 until we fully commit
    213. 

  213. 	 *       to the fitos fixup.
    214. 

  214. 	 */
    215. 

  215. 	stx		%fsr, [%g6 + TI_XFSR]
    216. 

  216. 	rdpr		%tstate, %g3
    217. 

  217. 	andcc		%g3, TSTATE_PRIV, %g0
    218. 

  218. 	bne,pn		%xcc, do_fptrap_after_fsr
    219. 

  219. 	 nop
    220. 

  220. 	ldx		[%g6 + TI_XFSR], %g3
    221. 

  221. 	srlx		%g3, 14, %g1
    222. 

  222. 	and		%g1, 7, %g1
    223. 

  223. 	cmp		%g1, 2			! Unfinished FP-OP
    224. 

  224. 	bne,pn		%xcc, do_fptrap_after_fsr
    225. 

  225. 	 sethi		%hi(1 << 23), %g1	! Inexact
    226. 

  226. 	andcc		%g3, %g1, %g0
    227. 

  227. 	bne,pn		%xcc, do_fptrap_after_fsr
    228. 

  228. 	 rdpr		%tpc, %g1
    229. 

  229. 	lduwa		[%g1] ASI_AIUP, %g3	! This cannot ever fail
    230. 

  230. #define FITOS_MASK	0xc1f83fe0
    231. 

  231. #define FITOS_COMPARE	0x81a01880
    232. 

  232. 	sethi		%hi(FITOS_MASK), %g1
    233. 

  233. 	or		%g1, %lo(FITOS_MASK), %g1
    234. 

  234. 	and		%g3, %g1, %g1
    235. 

  235. 	sethi		%hi(FITOS_COMPARE), %g2
    236. 

  236. 	or		%g2, %lo(FITOS_COMPARE), %g2
    237. 

  237. 	cmp		%g1, %g2
    238. 

  238. 	bne,pn		%xcc, do_fptrap_after_fsr
    239. 

  239. 	 nop
    240. 

  240. 	std		%f62, [%g6 + TI_FPREGS + (62 * 4)]
    241. 

  241. 	sethi		%hi(fitos_table_1), %g1
    242. 

  242. 	and		%g3, 0x1f, %g2
    243. 

  243. 	or		%g1, %lo(fitos_table_1),  %g1
    244. 

  244. 	sllx		%g2, 2, %g2
    245. 

  245. 	jmpl		%g1 + %g2, %g0
    246. 

  246. 	 ba,pt		%xcc, fitos_emul_continue
    247. 

  247. 

  248. fitos_table_1:
    249. 

  249. 	fitod		%f0, %f62
    250. 

  250. 	fitod		%f1, %f62
    251. 

  251. 	fitod		%f2, %f62
    252. 

  252. 	fitod		%f3, %f62
    253. 

  253. 	fitod		%f4, %f62
    254. 

  254. 	fitod		%f5, %f62
    255. 

  255. 	fitod		%f6, %f62
    256. 

  256. 	fitod		%f7, %f62
    257. 

  257. 	fitod		%f8, %f62
    258. 

  258. 	fitod		%f9, %f62
    259. 

  259. 	fitod		%f10, %f62
    260. 

  260. 	fitod		%f11, %f62
    261. 

  261. 	fitod		%f12, %f62
    262. 

  262. 	fitod		%f13, %f62
    263. 

  263. 	fitod		%f14, %f62
    264. 

  264. 	fitod		%f15, %f62
    265. 

  265. 	fitod		%f16, %f62
    266. 

  266. 	fitod		%f17, %f62
    267. 

  267. 	fitod		%f18, %f62
    268. 

  268. 	fitod		%f19, %f62
    269. 

  269. 	fitod		%f20, %f62
    270. 

  270. 	fitod		%f21, %f62
    271. 

  271. 	fitod		%f22, %f62
    272. 

  272. 	fitod		%f23, %f62
    273. 

  273. 	fitod		%f24, %f62
    274. 

  274. 	fitod		%f25, %f62
    275. 

  275. 	fitod		%f26, %f62
    276. 

  276. 	fitod		%f27, %f62
    277. 

  277. 	fitod		%f28, %f62
    278. 

  278. 	fitod		%f29, %f62
    279. 

  279. 	fitod		%f30, %f62
    280. 

  280. 	fitod		%f31, %f62
    281. 

  281. 

  282. fitos_emul_continue:
    283. 

  283. 	sethi		%hi(fitos_table_2), %g1
    284. 

  284. 	srl		%g3, 25, %g2
    285. 

  285. 	or		%g1, %lo(fitos_table_2), %g1
    286. 

  286. 	and		%g2, 0x1f, %g2
    287. 

  287. 	sllx		%g2, 2, %g2
    288. 

  288. 	jmpl		%g1 + %g2, %g0
    289. 

  289. 	 ba,pt		%xcc, fitos_emul_fini
    290. 

  290. 

  291. fitos_table_2:
    292. 

  292. 	fdtos		%f62, %f0
    293. 

  293. 	fdtos		%f62, %f1
    294. 

  294. 	fdtos		%f62, %f2
    295. 

  295. 	fdtos		%f62, %f3
    296. 

  296. 	fdtos		%f62, %f4
    297. 

  297. 	fdtos		%f62, %f5
    298. 

  298. 	fdtos		%f62, %f6
    299. 

  299. 	fdtos		%f62, %f7
    300. 

  300. 	fdtos		%f62, %f8
    301. 

  301. 	fdtos		%f62, %f9
    302. 

  302. 	fdtos		%f62, %f10
    303. 

  303. 	fdtos		%f62, %f11
    304. 

  304. 	fdtos		%f62, %f12
    305. 

  305. 	fdtos		%f62, %f13
    306. 

  306. 	fdtos		%f62, %f14
    307. 

  307. 	fdtos		%f62, %f15
    308. 

  308. 	fdtos		%f62, %f16
    309. 

  309. 	fdtos		%f62, %f17
    310. 

  310. 	fdtos		%f62, %f18
    311. 

  311. 	fdtos		%f62, %f19
    312. 

  312. 	fdtos		%f62, %f20
    313. 

  313. 	fdtos		%f62, %f21
    314. 

  314. 	fdtos		%f62, %f22
    315. 

  315. 	fdtos		%f62, %f23
    316. 

  316. 	fdtos		%f62, %f24
    317. 

  317. 	fdtos		%f62, %f25
    318. 

  318. 	fdtos		%f62, %f26
    319. 

  319. 	fdtos		%f62, %f27
    320. 

  320. 	fdtos		%f62, %f28
    321. 

  321. 	fdtos		%f62, %f29
    322. 

  322. 	fdtos		%f62, %f30
    323. 

  323. 	fdtos		%f62, %f31
    324. 

  324. 

  325. fitos_emul_fini:
    326. 

  326. 	ldd		[%g6 + TI_FPREGS + (62 * 4)], %f62
    327. 

  327. 	done
    328. 

  328. 	.size		do_fpother_check_fitos,.-do_fpother_check_fitos
    329. 

  329. 

  330. 	.align		32
    331. 

  331. 	.globl		do_fptrap
    332. 

  332. 	.type		do_fptrap,#function
    333. 

  333. do_fptrap:
    334. 

  334. 	TRAP_LOAD_THREAD_REG(%g6, %g1)
    335. 

  335. 	stx		%fsr, [%g6 + TI_XFSR]
    336. 

  336. do_fptrap_after_fsr:
    337. 

  337. 	ldub		[%g6 + TI_FPSAVED], %g3
    338. 

  338. 	rd		%fprs, %g1
    339. 

  339. 	or		%g3, %g1, %g3
    340. 

  340. 	stb		%g3, [%g6 + TI_FPSAVED]
    341. 

  341. 	rd		%gsr, %g3
    342. 

  342. 	stx		%g3, [%g6 + TI_GSR]
    343. 

  343. 	mov		SECONDARY_CONTEXT, %g3
    344. 

  344. 

  345. 661:	ldxa		[%g3] ASI_DMMU, %g5
    346. 

  346. 	.section	.sun4v_1insn_patch, "ax"
    347. 

  347. 	.word		661b
    348. 

  348. 	ldxa		[%g3] ASI_MMU, %g5
    349. 

  349. 	.previous
    350. 

  350. 

  351. 	sethi		%hi(sparc64_kern_sec_context), %g2
    352. 

  352. 	ldx		[%g2 + %lo(sparc64_kern_sec_context)], %g2
    353. 

  353. 

  354. 661:	stxa		%g2, [%g3] ASI_DMMU
    355. 

  355. 	.section	.sun4v_1insn_patch, "ax"
    356. 

  356. 	.word		661b
    357. 

  357. 	stxa		%g2, [%g3] ASI_MMU
    358. 

  358. 	.previous
    359. 

  359. 

  360. 	membar		#Sync
    361. 

  361. 	add		%g6, TI_FPREGS, %g2
    362. 

  362. 	andcc		%g1, FPRS_DL, %g0
    363. 

  363. 	be,pn		%icc, 4f
    364. 

  364. 	 mov		0x40, %g3
    365. 

  365. 	stda		%f0, [%g2] ASI_BLK_S
    366. 

  366. 	stda		%f16, [%g2 + %g3] ASI_BLK_S
    367. 

  367. 	andcc		%g1, FPRS_DU, %g0
    368. 

  368. 	be,pn		%icc, 5f
    369. 

  369. 4:       add		%g2, 128, %g2
    370. 

  370. 	stda		%f32, [%g2] ASI_BLK_S
    371. 

  371. 	stda		%f48, [%g2 + %g3] ASI_BLK_S
    372. 

  372. 5:	mov		SECONDARY_CONTEXT, %g1
    373. 

  373. 	membar		#Sync
    374. 

  374. 

  375. 661:	stxa		%g5, [%g1] ASI_DMMU
    376. 

  376. 	.section	.sun4v_1insn_patch, "ax"
    377. 

  377. 	.word		661b
    378. 

  378. 	stxa		%g5, [%g1] ASI_MMU
    379. 

  379. 	.previous
    380. 

  380. 

  381. 	membar		#Sync
    382. 

  382. 	ba,pt		%xcc, etrap
    383. 

  383. 	 wr		%g0, 0, %fprs
    384. 

  384. 	.size		do_fptrap,.-do_fptrap
    385. 

  385.