开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > VxWorks > 查看源码
fpsqrt32.s
资源名称：vxwork_src.rar　[点击查看]
上传用户：nvosite88
上传日期：2007-01-17
资源大小：4983k
文件大小：8k
源码类别：

VxWorks

开发平台：

C/C++

fpsqrt32.s：源码内容
  1. /* fpsqrt32.s - VxWorks conversion from Microtek tools to Sun native */
  3. /* Copyright 1984-1992 Wind River Systems, Inc. */
  5. /*
  6. modification history
  7. --------------------
  8. 01b,13nov92,jwt  added workaround for sqrt(-0.0) until USS patch.
  9. 01a,06aug92,jwt  converted.
  10. */
  12. /*
  13. ! ! ! ! !
  14. ! SPARClite Floating Point Library
  15. !
  16. ! Copyright (C) 1992 By
  17. ! United States Software Corporation
  18. ! 14215 N.W. Science Park Drive
  19. ! Portland, Oregon 97229
  20. !
  21. ! This software is furnished under a license and may be used
  22. ! and copied only in accordance with the terms of such license
  23. ! and with the inclusion of the above copyright notice.
  24. ! This software or any other copies thereof may not be provided
  25. ! or otherwise made available to any other person.  No title to
  26. ! and ownership of the software is hereby transferred.
  27. !
  28. ! The information in this software is subject to change without 
  29. ! notice and should not be construed as a commitment by United
  30. ! States Software Corporation.
  31. !
  32. ! First Release: V1.02 March 26 1992
  33. ! ! ! ! !
  35. .macro scan,p1,p2,p3
  36. .word 0x81602000 | (&p3<<25) | (&p1<<14) | p2
  37. .endm
  38. .macro umul,p1,p2,p3
  39. .word 0x80500000 | (&p3<<25) | (&p1<<14) | &p2
  40. .endm
  41. .macro divscc,p1,p2,p3
  42. .word 0x80e80000 | (&p3<<25) | (&p1<<14) | &p2
  43. .endm
  44. */
  46. #include "arch/sparc/ussSun4.h"
  48. .text
  49. .align 4
  51. .global _fpexsqrt
  52. _fpexsqrt:
  53. save %sp,-96,%sp
  55. subcc   %i0,0,%i0
  56. be      Azer           
  57. andcc   %i1,1,%l3
  58. be      i1       
  59. NOP
  60. sethi   %hi(0x67f21800),%i5
  61. umul %i0,%i5,%i5
  62. rd %y,%i5
  63. sethi   %hi(0x4d134800),%l3
  64. add     %i5,%l3,%i5
  65. srl     %i0,1,%i0
  66. ba      e1       
  67. add     %i1,1,%i1
  68. i1: sethi   %hi(0x93000000),%i5
  69. umul %i0,%i5,%i5
  70. rd %y,%i5
  71. sethi   %hi(0x6cfffc00),%l3
  72. add     %i5,%l3,%i5
  73. e1: sra     %i1,1,%i3
  74. add     %i3,0x3f,%i3
  76. srl     %i0,1,%i0
  78. wr %i0,0,%y
  79. or %g0,0x0,%l0
  80. orcc %g0,0,%g0
  81. #if 0
  82. divscc %l0,%i5,%l0
  83. divscc %l0,%i5,%l0
  84. divscc %l0,%i5,%l0
  85. divscc %l0,%i5,%l0
  86. divscc %l0,%i5,%l0
  87. divscc %l0,%i5,%l0
  88. divscc %l0,%i5,%l0
  89. divscc %l0,%i5,%l0
  90. divscc %l0,%i5,%l0
  91. divscc %l0,%i5,%l0
  92. divscc %l0,%i5,%l0
  93. divscc %l0,%i5,%l0
  94. divscc %l0,%i5,%l0
  95. divscc %l0,%i5,%l0
  96. divscc %l0,%i5,%l0
  97. divscc %l0,%i5,%l0
  98. divscc %l0,%i5,%l0
  99. divscc %l0,%i5,%l0
  100. divscc %l0,%i5,%l0
  101. divscc %l0,%i5,%l0
  102. divscc %l0,%i5,%l0
  103. divscc %l0,%i5,%l0
  104. divscc %l0,%i5,%l0
  105. divscc %l0,%i5,%l0
  106. divscc %l0,%i5,%l0
  107. divscc %l0,%i5,%l0
  108. divscc %l0,%i5,%l0
  109. divscc %l0,%i5,%l0
  110. divscc %l0,%i5,%l0
  111. divscc %l0,%i5,%l0
  112. divscc %l0,%i5,%l0
  113. divscc %l0,%i5,%l0
  114. #else
  115. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  116. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  117. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  118. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  119. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  120. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  121. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  122. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  123. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  124. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  125. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  126. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  127. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  128. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  129. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  130. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  131. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  132. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  133. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  134. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  135. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  136. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  137. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  138. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  139. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  140. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  141. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  142. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  143. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  144. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  145. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  146. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  147. #endif
  149. srl     %i5,1,%i5
  150. addcc   %i5,%l0,%i5
  151. subx    %i5,0,%i5
  153. wr %i0,0,%y
  154. or %g0,0x0,%l0
  155. orcc %g0,0,%g0
  156. #if 0
  157. divscc %l0,%i5,%l0
  158. divscc %l0,%i5,%l0
  159. divscc %l0,%i5,%l0
  160. divscc %l0,%i5,%l0
  161. divscc %l0,%i5,%l0
  162. divscc %l0,%i5,%l0
  163. divscc %l0,%i5,%l0
  164. divscc %l0,%i5,%l0
  165. divscc %l0,%i5,%l0
  166. divscc %l0,%i5,%l0
  167. divscc %l0,%i5,%l0
  168. divscc %l0,%i5,%l0
  169. divscc %l0,%i5,%l0
  170. divscc %l0,%i5,%l0
  171. divscc %l0,%i5,%l0
  172. divscc %l0,%i5,%l0
  173. divscc %l0,%i5,%l0
  174. divscc %l0,%i5,%l0
  175. divscc %l0,%i5,%l0
  176. divscc %l0,%i5,%l0
  177. divscc %l0,%i5,%l0
  178. divscc %l0,%i5,%l0
  179. divscc %l0,%i5,%l0
  180. divscc %l0,%i5,%l0
  181. divscc %l0,%i5,%l0
  182. divscc %l0,%i5,%l0
  183. divscc %l0,%i5,%l0
  184. divscc %l0,%i5,%l0
  185. divscc %l0,%i5,%l0
  186. divscc %l0,%i5,%l0
  187. divscc %l0,%i5,%l0
  188. divscc %l0,%i5,%l0
  189. #else
  190. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  191. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  192. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  193. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  194. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  195. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  196. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  197. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  198. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  199. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  200. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  201. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  202. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  203. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  204. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  205. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  206. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  207. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  208. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  209. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  210. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  211. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  212. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  213. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  214. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  215. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  216. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  217. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  218. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  219. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  220. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  221. DIVSCC | (lo0 << 14) | in5 | (lo0 << 25)
  222. #endif
  224. srl     %i5,1,%i5
  225. addcc   %i5,%l0,%i5
  226. subx    %i5,0,%i5
  228. or      %g0,%i5,%i2
  230. Aret: or      %g0,%i2,%i0
  231. or      %g0,%i3,%i1
  232. or      %g0,%i4,%i2
  234. A999: jmpl %i7+8,%g0
  235. restore %g0,0,%g0
  237. Azer: or      %g0,0,%i3
  238. ba      Aret     
  239. or      %g0,%i3,%i2
  241. .global _fpsqrt
  242. _fpsqrt:
  243. .global _sqrtf
  244. _sqrtf:
  245. save %sp,-96,%sp
  247. /* Test for negative zero */
  249. set 0xFF800000,%l0 /* sign (31) and exponent (30-23) */
  250. and %l0,%i0,%l0
  251. set 0x80000000,%l1 /* negative zero */
  252. cmp %l0,%l1
  253. bne sqrtNonZero
  254. nop
  256. ret /* return value = -0.0 */
  257. restore
  259. sqrtNonZero:
  261. srl     %i0,23,%i4
  262. sll     %i0,8,%i3
  263. sethi   %hi(0x80000000),%l3
  264. or      %i3,%l3,%i3
  265. sub     %i4,1,%l3
  266. subcc   %l3,0xfe,%g0
  267. bcc     Bspec          
  269. Blab1: or      %g0,%i3,%o0
  270. call    _fpexsqrt
  271. or      %g0,%i4,%o1
  272. or      %g0,%o0,%l0
  273. or      %g0,%o1,%l1
  274. or      %g0,%o2,%l2
  276. andcc   %i4,1,%l3
  277. bne,a i2               
  278. srl     %i3,1,%i3
  279. i2:
  280. umul %l0,%l0,%i2
  281. rd %y,%i1
  282. sub     %i1,%i3,%i1
  283. orcc    %i1,%i2,%l3
  284. be      Bret           
  285. subcc   %i1,0,%i1
  286. bneg    Bloo1    
  287. NOP
  289. Bloo2: sub     %l0,1,%l0
  290. addcc   %i2,1,%i2
  291. addx    %i1,0,%i1
  292. subcc   %i2,%l0,%i2
  293. subx    %i1,0,%i1
  294. subcc   %i2,%l0,%i2
  295. subxcc  %i1,0,%i1
  296. bpos    Bloo2    
  297. NOP
  298. ba,a    Bret     
  300. Bloo1: addcc   %l0,1,%l0
  301. bcs     Blab3    
  302. NOP
  303. addcc   %i2,%l0,%i2
  304. addx    %i1,0,%i1
  305. addcc   %i2,%l0,%i2
  306. addx    %i1,0,%i1
  307. addcc   %i2,1,%i2
  308. addxcc  %i1,0,%i1
  309. bneg    Bloo1    
  310. NOP
  312. Blab3: sub     %l0,1,%l0
  314. Bret: addcc   %l0,0x80,%l0
  315. addx    %l1,0,%l1
  316. sll     %l0,1,%i0
  317. srl     %i0,9,%i0
  318. sll     %l1,23,%l3
  319. or      %i0,%l3,%i0
  321. B999: jmpl %i7+8,%g0
  322. restore %g0,0,%g0
  324. Bspec: subcc   %i0,0,%i0
  325. bneg    Bnan           
  326. subcc   %i4,0,%i4
  327. bne     i4       
  328. NOP
  329. addcc   %i3,%i3,%i3
  330. be      i5       
  331. NOP
  332. /* scan %i3,0,%i1 */
  333. SCAN | (in3 << 14) | 0 | (in1 << 25)
  334. sll %i3,%i1,%i3
  335. subcc %i4,%i1,%i4
  336. ba,a    Blab1    
  337. i5: ba      B999     
  338. or      %g0,0,%i0
  339. i4: addcc   %i3,%i3,%l3
  340. bne     Bnan     
  341. NOP
  342. ba,a    B999     
  344. Bnan: ba      B999     
  345. sethi   %hi(0xffc00000),%i0
  347. ! .end