You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

324 lines
14KB

  1. /*
  2. * AArch64 NEON optimised MDCT
  3. * Copyright (c) 2009 Mans Rullgard <mans@mansr.com>
  4. * Copyright (c) 2014 Janne Grunau <janne-libav@jannau.net>
  5. *
  6. * This file is part of Libav.
  7. *
  8. * Libav is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU Lesser General Public
  10. * License as published by the Free Software Foundation; either
  11. * version 2.1 of the License, or (at your option) any later version.
  12. *
  13. * Libav is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16. * Lesser General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU Lesser General Public
  19. * License along with Libav; if not, write to the Free Software
  20. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  21. */
  22. #include "libavutil/aarch64/asm.S"
  23. function ff_imdct_half_neon, export=1
  24. sub sp, sp, #32
  25. stp x19, x20, [sp]
  26. str x30, [sp, #16]
  27. mov x12, #1
  28. ldr w14, [x0, #28] // mdct_bits
  29. ldr x4, [x0, #32] // tcos
  30. ldr x3, [x0, #8] // revtab
  31. lsl x12, x12, x14 // n = 1 << nbits
  32. lsr x14, x12, #2 // n4 = n >> 2
  33. add x7, x2, x12, lsl #1
  34. mov x12, #-16
  35. sub x7, x7, #16
  36. ld2 {v16.2s,v17.2s}, [x7], x12 // d16=x,n1 d17=x,n0
  37. ld2 {v0.2s,v1.2s}, [x2], #16 // d0 =m0,x d1 =m1,x
  38. rev64 v17.2s, v17.2s
  39. ld2 {v2.2s,v3.2s}, [x4], #16 // d2=c0,c1 d3=s0,s2
  40. fmul v6.2s, v17.2s, v2.2s
  41. fmul v7.2s, v0.2s, v2.2s
  42. 1:
  43. subs x14, x14, #2
  44. ldr w6, [x3], #4
  45. fmul v4.2s, v0.2s, v3.2s
  46. fmul v5.2s, v17.2s, v3.2s
  47. fsub v4.2s, v6.2s, v4.2s
  48. fadd v5.2s, v5.2s, v7.2s
  49. ubfm x8, x6, #16, #31
  50. ubfm x6, x6, #0, #15
  51. add x8, x1, x8, lsl #3
  52. add x6, x1, x6, lsl #3
  53. b.eq 2f
  54. ld2 {v16.2s,v17.2s}, [x7], x12
  55. ld2 {v0.2s,v1.2s}, [x2], #16
  56. rev64 v17.2s, v17.2s
  57. ld2 {v2.2s,v3.2s}, [x4], #16 // d2=c0,c1 d3=s0,s2
  58. fmul v6.2s, v17.2s, v2.2s
  59. fmul v7.2s, v0.2s, v2.2s
  60. st2 {v4.s,v5.s}[0], [x6]
  61. st2 {v4.s,v5.s}[1], [x8]
  62. b 1b
  63. 2:
  64. st2 {v4.s,v5.s}[0], [x6]
  65. st2 {v4.s,v5.s}[1], [x8]
  66. mov x19, x0
  67. mov x20, x1
  68. bl X(ff_fft_calc_neon)
  69. mov x12, #1
  70. ldr w14, [x19, #28] // mdct_bits
  71. ldr x4, [x19, #32] // tcos
  72. lsl x12, x12, x14 // n = 1 << nbits
  73. lsr x14, x12, #3 // n8 = n >> 3
  74. add x4, x4, x14, lsl #3
  75. add x6, x20, x14, lsl #3
  76. sub x1, x4, #16
  77. sub x3, x6, #16
  78. mov x7, #-16
  79. mov x8, x6
  80. mov x0, x3
  81. ld2 {v0.2s,v1.2s}, [x3], x7 // d0 =i1,r1 d1 =i0,r0
  82. ld2 {v20.2s,v21.2s},[x6], #16 // d20=i2,r2 d21=i3,r3
  83. ld2 {v16.2s,v17.2s},[x1], x7 // d16=c1,c0 d18=s1,s0
  84. 3:
  85. subs x14, x14, #2
  86. fmul v7.2s, v0.2s, v17.2s
  87. ld2 {v18.2s,v19.2s},[x4], #16 // d17=c2,c3 d19=s2,s3
  88. fmul v4.2s, v1.2s, v17.2s
  89. fmul v6.2s, v21.2s, v19.2s
  90. fmul v5.2s, v20.2s, v19.2s
  91. fmul v22.2s, v1.2s, v16.2s
  92. fmul v23.2s, v21.2s, v18.2s
  93. fmul v24.2s, v0.2s, v16.2s
  94. fmul v25.2s, v20.2s, v18.2s
  95. fadd v7.2s, v7.2s, v22.2s
  96. fadd v5.2s, v5.2s, v23.2s
  97. fsub v4.2s, v4.2s, v24.2s
  98. fsub v6.2s, v6.2s, v25.2s
  99. b.eq 4f
  100. ld2 {v0.2s,v1.2s}, [x3], x7
  101. ld2 {v20.2s,v21.2s},[x6], #16
  102. ld2 {v16.2s,v17.2s},[x1], x7 // d16=c1,c0 d18=s1,s0
  103. rev64 v5.2s, v5.2s
  104. rev64 v7.2s, v7.2s
  105. st2 {v4.2s,v5.2s}, [x0], x7
  106. st2 {v6.2s,v7.2s}, [x8], #16
  107. b 3b
  108. 4:
  109. rev64 v5.2s, v5.2s
  110. rev64 v7.2s, v7.2s
  111. st2 {v4.2s,v5.2s}, [x0]
  112. st2 {v6.2s,v7.2s}, [x8]
  113. ldp x19, x20, [sp]
  114. ldr x30, [sp, #16]
  115. add sp, sp, #32
  116. ret
  117. endfunc
  118. function ff_imdct_calc_neon, export=1
  119. sub sp, sp, #32
  120. stp x19, x20, [sp]
  121. str x30, [sp, #16]
  122. ldr w3, [x0, #28] // mdct_bits
  123. mov x19, #1
  124. mov x20, x1
  125. lsl x19, x19, x3
  126. add x1, x1, x19
  127. bl X(ff_imdct_half_neon)
  128. add x0, x20, x19, lsl #2
  129. add x1, x20, x19, lsl #1
  130. sub x0, x0, #8
  131. sub x2, x1, #16
  132. mov x3, #-16
  133. mov x6, #-8
  134. 1:
  135. ld1 {v0.4s}, [x2], x3
  136. prfum pldl1keep, [x0, #-16]
  137. rev64 v0.4s, v0.4s
  138. ld1 {v2.2s,v3.2s}, [x1], #16
  139. fneg v4.4s, v0.4s
  140. prfum pldl1keep, [x2, #-16]
  141. rev64 v2.2s, v2.2s
  142. rev64 v3.2s, v3.2s
  143. ext v4.16b, v4.16b, v4.16b, #8
  144. st1 {v2.2s}, [x0], x6
  145. st1 {v3.2s}, [x0], x6
  146. st1 {v4.4s}, [x20], #16
  147. subs x19, x19, #16
  148. b.gt 1b
  149. ldp x19, x20, [sp], #16
  150. ldr x30, [sp], #16
  151. ret
  152. endfunc
  153. function ff_mdct_calc_neon, export=1
  154. sub sp, sp, #32
  155. stp x19, x20, [sp]
  156. str x30, [sp, #16]
  157. mov x12, #1
  158. ldr w14, [x0, #28] // mdct_bits
  159. ldr x4, [x0, #32] // tcos
  160. ldr x3, [x0, #8] // revtab
  161. lsl x14, x12, x14 // n = 1 << nbits
  162. add x7, x2, x14 // in4u
  163. sub x9, x7, #16 // in4d
  164. add x2, x7, x14, lsl #1 // in3u
  165. add x8, x9, x14, lsl #1 // in3d
  166. add x5, x4, x14, lsl #1
  167. sub x5, x5, #16
  168. sub x3, x3, #4
  169. mov x12, #-16
  170. lsr x13, x14, #1
  171. ld2 {v16.2s,v17.2s}, [x9], x12 // in0u0,in0u1 in4d1,in4d0
  172. ld2 {v18.2s,v19.2s}, [x8], x12 // in2u0,in2u1 in3d1,in3d0
  173. ld2 {v0.2s, v1.2s}, [x7], #16 // in4u0,in4u1 in2d1,in2d0
  174. rev64 v17.2s, v17.2s // in4d0,in4d1 in3d0,in3d1
  175. rev64 v19.2s, v19.2s // in4d0,in4d1 in3d0,in3d1
  176. ld2 {v2.2s, v3.2s}, [x2], #16 // in3u0,in3u1 in1d1,in1d0
  177. fsub v0.2s, v17.2s, v0.2s // in4d-in4u I
  178. ld2 {v20.2s,v21.2s}, [x4], #16 // c0,c1 s0,s1
  179. rev64 v1.2s, v1.2s // in2d0,in2d1 in1d0,in1d1
  180. rev64 v3.2s, v3.2s // in2d0,in2d1 in1d0,in1d1
  181. ld2 {v30.2s,v31.2s}, [x5], x12 // c2,c3 s2,s3
  182. fadd v2.2s, v2.2s, v19.2s // in3u+in3d -R
  183. fsub v16.2s, v16.2s, v1.2s // in0u-in2d R
  184. fadd v18.2s, v18.2s, v3.2s // in2u+in1d -I
  185. 1:
  186. fmul v7.2s, v0.2s, v21.2s // I*s
  187. ldr w10, [x3, x13]
  188. fmul v6.2s, v2.2s, v20.2s // -R*c
  189. ldr w6, [x3, #4]!
  190. fmul v4.2s, v2.2s, v21.2s // -R*s
  191. fmul v5.2s, v0.2s, v20.2s // I*c
  192. fmul v24.2s, v16.2s, v30.2s // R*c
  193. fmul v25.2s, v18.2s, v31.2s // -I*s
  194. fmul v22.2s, v16.2s, v31.2s // R*s
  195. fmul v23.2s, v18.2s, v30.2s // I*c
  196. subs x14, x14, #16
  197. subs x13, x13, #8
  198. fsub v6.2s, v6.2s, v7.2s // -R*c-I*s
  199. fadd v7.2s, v4.2s, v5.2s // -R*s+I*c
  200. fsub v24.2s, v25.2s, v24.2s // I*s-R*c
  201. fadd v25.2s, v22.2s, v23.2s // R*s-I*c
  202. b.eq 1f
  203. mov x12, #-16
  204. ld2 {v16.2s,v17.2s}, [x9], x12 // in0u0,in0u1 in4d1,in4d0
  205. ld2 {v18.2s,v19.2s}, [x8], x12 // in2u0,in2u1 in3d1,in3d0
  206. fneg v7.2s, v7.2s // R*s-I*c
  207. ld2 {v0.2s, v1.2s}, [x7], #16 // in4u0,in4u1 in2d1,in2d0
  208. rev64 v17.2s, v17.2s // in4d0,in4d1 in3d0,in3d1
  209. rev64 v19.2s, v19.2s // in4d0,in4d1 in3d0,in3d1
  210. ld2 {v2.2s, v3.2s}, [x2], #16 // in3u0,in3u1 in1d1,in1d0
  211. fsub v0.2s, v17.2s, v0.2s // in4d-in4u I
  212. ld2 {v20.2s,v21.2s}, [x4], #16 // c0,c1 s0,s1
  213. rev64 v1.2s, v1.2s // in2d0,in2d1 in1d0,in1d1
  214. rev64 v3.2s, v3.2s // in2d0,in2d1 in1d0,in1d1
  215. ld2 {v30.2s,v31.2s}, [x5], x12 // c2,c3 s2,s3
  216. fadd v2.2s, v2.2s, v19.2s // in3u+in3d -R
  217. fsub v16.2s, v16.2s, v1.2s // in0u-in2d R
  218. fadd v18.2s, v18.2s, v3.2s // in2u+in1d -I
  219. ubfm x12, x6, #16, #31
  220. ubfm x6, x6, #0, #15
  221. add x12, x1, x12, lsl #3
  222. add x6, x1, x6, lsl #3
  223. st2 {v6.s,v7.s}[0], [x6]
  224. st2 {v6.s,v7.s}[1], [x12]
  225. ubfm x6, x10, #16, #31
  226. ubfm x10, x10, #0, #15
  227. add x6 , x1, x6, lsl #3
  228. add x10, x1, x10, lsl #3
  229. st2 {v24.s,v25.s}[0], [x10]
  230. st2 {v24.s,v25.s}[1], [x6]
  231. b 1b
  232. 1:
  233. fneg v7.2s, v7.2s // R*s-I*c
  234. ubfm x12, x6, #16, #31
  235. ubfm x6, x6, #0, #15
  236. add x12, x1, x12, lsl #3
  237. add x6, x1, x6, lsl #3
  238. st2 {v6.s,v7.s}[0], [x6]
  239. st2 {v6.s,v7.s}[1], [x12]
  240. ubfm x6, x10, #16, #31
  241. ubfm x10, x10, #0, #15
  242. add x6 , x1, x6, lsl #3
  243. add x10, x1, x10, lsl #3
  244. st2 {v24.s,v25.s}[0], [x10]
  245. st2 {v24.s,v25.s}[1], [x6]
  246. mov x19, x0
  247. mov x20, x1
  248. bl X(ff_fft_calc_neon)
  249. mov x12, #1
  250. ldr w14, [x19, #28] // mdct_bits
  251. ldr x4, [x19, #32] // tcos
  252. lsl x12, x12, x14 // n = 1 << nbits
  253. lsr x14, x12, #3 // n8 = n >> 3
  254. add x4, x4, x14, lsl #3
  255. add x6, x20, x14, lsl #3
  256. sub x1, x4, #16
  257. sub x3, x6, #16
  258. mov x7, #-16
  259. mov x8, x6
  260. mov x0, x3
  261. ld2 {v0.2s,v1.2s}, [x3], x7 // d0 =r1,i1 d1 =r0,i0
  262. ld2 {v20.2s,v21.2s}, [x6], #16 // d20=r2,i2 d21=r3,i3
  263. ld2 {v16.2s,v17.2s}, [x1], x7 // c1,c0 s1,s0
  264. 1:
  265. subs x14, x14, #2
  266. fmul v7.2s, v0.2s, v17.2s // r1*s1,r0*s0
  267. ld2 {v18.2s,v19.2s}, [x4], #16 // c2,c3 s2,s3
  268. fmul v4.2s, v1.2s, v17.2s // i1*s1,i0*s0
  269. fmul v6.2s, v21.2s, v19.2s // i2*s2,i3*s3
  270. fmul v5.2s, v20.2s, v19.2s // r2*s2,r3*s3
  271. fmul v24.2s, v0.2s, v16.2s // r1*c1,r0*c0
  272. fmul v25.2s, v20.2s, v18.2s // r2*c2,r3*c3
  273. fmul v22.2s, v21.2s, v18.2s // i2*c2,i3*c3
  274. fmul v23.2s, v1.2s, v16.2s // i1*c1,i0*c0
  275. fadd v4.2s, v4.2s, v24.2s // i1*s1+r1*c1,i0*s0+r0*c0
  276. fadd v6.2s, v6.2s, v25.2s // i2*s2+r2*c2,i3*s3+r3*c3
  277. fsub v5.2s, v22.2s, v5.2s // i2*c2-r2*s2,i3*c3-r3*s3
  278. fsub v7.2s, v23.2s, v7.2s // i1*c1-r1*s1,i0*c0-r0*s0
  279. fneg v4.2s, v4.2s
  280. fneg v6.2s, v6.2s
  281. b.eq 1f
  282. ld2 {v0.2s, v1.2s}, [x3], x7
  283. ld2 {v20.2s,v21.2s}, [x6], #16
  284. ld2 {v16.2s,v17.2s}, [x1], x7 // c1,c0 s1,s0
  285. rev64 v5.2s, v5.2s
  286. rev64 v7.2s, v7.2s
  287. st2 {v4.2s,v5.2s}, [x0], x7
  288. st2 {v6.2s,v7.2s}, [x8], #16
  289. b 1b
  290. 1:
  291. rev64 v5.2s, v5.2s
  292. rev64 v7.2s, v7.2s
  293. st2 {v4.2s,v5.2s}, [x0]
  294. st2 {v6.2s,v7.2s}, [x8]
  295. ldp x19, x20, [sp], #16
  296. ldr x30, [sp], #16
  297. ret
  298. endfunc