1/*
2 * ARM NEON optimised MDCT
3 * Copyright (c) 2009 Mans Rullgard <mans@mansr.com>
4 *
5 * This file is part of FFmpeg.
6 *
7 * FFmpeg is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2.1 of the License, or (at your option) any later version.
11 *
12 * FFmpeg is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15 * Lesser General Public License for more details.
16 *
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with FFmpeg; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20 */
21
22#include "asm.S"
23
24        preserve8
25
26        .text
27
28#define ff_fft_calc_neon X(ff_fft_calc_neon)
29
30function ff_imdct_half_neon, export=1
31        push            {r4-r8,lr}
32
33        mov             r12, #1
34        ldr             lr,  [r0, #28]          @ mdct_bits
35        ldr             r4,  [r0, #32]          @ tcos
36        ldr             r3,  [r0, #8]           @ revtab
37        lsl             r12, r12, lr            @ n  = 1 << nbits
38        lsr             lr,  r12, #2            @ n4 = n >> 2
39        add             r7,  r2,  r12,  lsl #1
40        mov             r12, #-16
41        sub             r7,  r7,  #16
42
43        vld2.32         {d16-d17},[r7,:128],r12 @ d16=x,n1 d17=x,n0
44        vld2.32         {d0-d1},  [r2,:128]!    @ d0 =m0,x d1 =m1,x
45        vrev64.32       d17, d17
46        vld2.32         {d2,d3},  [r4,:128]!    @ d2=c0,c1 d3=s0,s2
47        vmul.f32        d6,  d17, d2
48        vmul.f32        d7,  d0,  d2
491:
50        subs            lr,  lr,  #2
51        ldr             r6,  [r3], #4
52        vmul.f32        d4,  d0,  d3
53        vmul.f32        d5,  d17, d3
54        vsub.f32        d4,  d6,  d4
55        vadd.f32        d5,  d5,  d7
56        uxth            r8,  r6,  ror #16
57        uxth            r6,  r6
58        add             r8,  r1,  r8,  lsl #3
59        add             r6,  r1,  r6,  lsl #3
60        beq             1f
61        vld2.32         {d16-d17},[r7,:128],r12
62        vld2.32         {d0-d1},  [r2,:128]!
63        vrev64.32       d17, d17
64        vld2.32         {d2,d3},  [r4,:128]!    @ d2=c0,c1 d3=s0,s2
65        vmul.f32        d6,  d17, d2
66        vmul.f32        d7,  d0,  d2
67        vst2.32         {d4[0],d5[0]}, [r6,:64]
68        vst2.32         {d4[1],d5[1]}, [r8,:64]
69        b               1b
701:
71        vst2.32         {d4[0],d5[0]}, [r6,:64]
72        vst2.32         {d4[1],d5[1]}, [r8,:64]
73
74        mov             r4,  r0
75        mov             r6,  r1
76        bl              ff_fft_calc_neon
77
78        mov             r12, #1
79        ldr             lr,  [r4, #28]          @ mdct_bits
80        ldr             r4,  [r4, #32]          @ tcos
81        lsl             r12, r12, lr            @ n  = 1 << nbits
82        lsr             lr,  r12, #3            @ n8 = n >> 3
83
84        add             r4,  r4,  lr,  lsl #3
85        add             r6,  r6,  lr,  lsl #3
86        sub             r1,  r4,  #16
87        sub             r3,  r6,  #16
88
89        mov             r7,  #-16
90        mov             r8,  r6
91        mov             r0,  r3
92
93        vld2.32         {d0-d1},  [r3,:128], r7 @ d0 =i1,r1 d1 =i0,r0
94        vld2.32         {d20-d21},[r6,:128]!    @ d20=i2,r2 d21=i3,r3
95        vld2.32         {d16,d18},[r1,:128], r7 @ d16=c1,c0 d18=s1,s0
961:
97        subs            lr,  lr,  #2
98        vmul.f32        d7,  d0,  d18
99        vld2.32         {d17,d19},[r4,:128]!    @ d17=c2,c3 d19=s2,s3
100        vmul.f32        d4,  d1,  d18
101        vmul.f32        d5,  d21, d19
102        vmul.f32        d6,  d20, d19
103        vmul.f32        d22, d1,  d16
104        vmul.f32        d23, d21, d17
105        vmul.f32        d24, d0,  d16
106        vmul.f32        d25, d20, d17
107        vadd.f32        d7,  d7,  d22
108        vadd.f32        d6,  d6,  d23
109        vsub.f32        d4,  d4,  d24
110        vsub.f32        d5,  d5,  d25
111        beq             1f
112        vld2.32         {d0-d1},  [r3,:128], r7
113        vld2.32         {d20-d21},[r6,:128]!
114        vld2.32         {d16,d18},[r1,:128], r7 @ d16=c1,c0 d18=s1,s0
115        vrev64.32       q3,  q3
116        vst2.32         {d4,d6},  [r0,:128], r7
117        vst2.32         {d5,d7},  [r8,:128]!
118        b               1b
1191:
120        vrev64.32       q3,  q3
121        vst2.32         {d4,d6},  [r0,:128]
122        vst2.32         {d5,d7},  [r8,:128]
123
124        pop             {r4-r8,pc}
125endfunc
126
127function ff_imdct_calc_neon, export=1
128        push            {r4-r6,lr}
129
130        ldr             r3,  [r0, #28]
131        mov             r4,  #1
132        mov             r5,  r1
133        lsl             r4,  r4,  r3
134        add             r1,  r1,  r4
135
136        bl              ff_imdct_half_neon
137
138        add             r0,  r5,  r4,  lsl #2
139        add             r1,  r5,  r4,  lsl #1
140        sub             r0,  r0,  #8
141        sub             r2,  r1,  #16
142        mov             r3,  #-16
143        mov             r6,  #-8
144        vmov.i32        d30, #1<<31
1451:
146        vld1.32         {d0-d1},  [r2,:128], r3
147        pld             [r0, #-16]
148        vrev64.32       q0,  q0
149        vld1.32         {d2-d3},  [r1,:128]!
150        veor            d4,  d1,  d30
151        pld             [r2, #-16]
152        vrev64.32       q1,  q1
153        veor            d5,  d0,  d30
154        vst1.32         {d2},     [r0,:64], r6
155        vst1.32         {d3},     [r0,:64], r6
156        vst1.32         {d4-d5},  [r5,:128]!
157        subs            r4,  r4,  #16
158        bgt             1b
159
160        pop             {r4-r6,pc}
161endfunc
162
163function ff_mdct_calc_neon, export=1
164        push            {r4-r10,lr}
165
166        mov             r12, #1
167        ldr             lr,  [r0, #28]          @ mdct_bits
168        ldr             r4,  [r0, #32]          @ tcos
169        ldr             r3,  [r0, #8]           @ revtab
170        lsl             lr,  r12, lr            @ n  = 1 << nbits
171        add             r7,  r2,  lr            @ in4u
172        sub             r9,  r7,  #16           @ in4d
173        add             r2,  r7,  lr,  lsl #1   @ in3u
174        add             r8,  r9,  lr,  lsl #1   @ in3d
175        add             r5,  r4,  lr,  lsl #1
176        sub             r5,  r5,  #16
177        sub             r3,  r3,  #4
178        mov             r12, #-16
179
180        vld2.32         {d16,d18},[r9,:128],r12 @ in0u0,in0u1 in4d1,in4d0
181        vld2.32         {d17,d19},[r8,:128],r12 @ in2u0,in2u1 in3d1,in3d0
182        vld2.32         {d0, d2}, [r7,:128]!    @ in4u0,in4u1 in2d1,in2d0
183        vrev64.32       q9,  q9                 @ in4d0,in4d1 in3d0,in3d1
184        vld2.32         {d1, d3}, [r2,:128]!    @ in3u0,in3u1 in1d1,in1d0
185        vsub.f32        d0,  d18, d0            @ in4d-in4u      I
186        vld2.32         {d20,d21},[r4,:128]!    @ c0,c1 s0,s1
187        vrev64.32       q1,  q1                 @ in2d0,in2d1 in1d0,in1d1
188        vld2.32         {d30,d31},[r5,:128],r12 @ c2,c3 s2,s3
189        vadd.f32        d1,  d1,  d19           @ in3u+in3d     -R
190        vsub.f32        d16, d16, d2            @ in0u-in2d      R
191        vadd.f32        d17, d17, d3            @ in2u+in1d     -I
1921:
193        vmul.f32        d7,  d0,  d21           @  I*s
194        ldr             r10, [r3, lr, lsr #1]
195        vmul.f32        d6,  d1,  d20           @ -R*c
196        ldr             r6,  [r3, #4]!
197        vmul.f32        d4,  d1,  d21           @ -R*s
198        vmul.f32        d5,  d0,  d20           @  I*c
199        vmul.f32        d24, d16, d30           @  R*c
200        vmul.f32        d25, d17, d31           @ -I*s
201        vmul.f32        d22, d16, d31           @  R*s
202        vmul.f32        d23, d17, d30           @  I*c
203        subs            lr,  lr,  #16
204        vsub.f32        d6,  d6,  d7            @ -R*c-I*s
205        vadd.f32        d7,  d4,  d5            @ -R*s+I*c
206        vsub.f32        d24, d25, d24           @ I*s-R*c
207        vadd.f32        d25, d22, d23           @ R*s-I*c
208        beq             1f
209        mov             r12, #-16
210        vld2.32         {d16,d18},[r9,:128],r12 @ in0u0,in0u1 in4d1,in4d0
211        vld2.32         {d17,d19},[r8,:128],r12 @ in2u0,in2u1 in3d1,in3d0
212        vneg.f32        d7,  d7                 @  R*s-I*c
213        vld2.32         {d0, d2}, [r7,:128]!    @ in4u0,in4u1 in2d1,in2d0
214        vrev64.32       q9,  q9                 @ in4d0,in4d1 in3d0,in3d1
215        vld2.32         {d1, d3}, [r2,:128]!    @ in3u0,in3u1 in1d1,in1d0
216        vsub.f32        d0,  d18, d0            @ in4d-in4u      I
217        vld2.32         {d20,d21},[r4,:128]!    @ c0,c1 s0,s1
218        vrev64.32       q1,  q1                 @ in2d0,in2d1 in1d0,in1d1
219        vld2.32         {d30,d31},[r5,:128],r12 @ c2,c3 s2,s3
220        vadd.f32        d1,  d1,  d19           @ in3u+in3d     -R
221        vsub.f32        d16, d16, d2            @ in0u-in2d      R
222        vadd.f32        d17, d17, d3            @ in2u+in1d     -I
223        uxth            r12, r6,  ror #16
224        uxth            r6,  r6
225        add             r12, r1,  r12, lsl #3
226        add             r6,  r1,  r6,  lsl #3
227        vst2.32         {d6[0],d7[0]}, [r6,:64]
228        vst2.32         {d6[1],d7[1]}, [r12,:64]
229        uxth            r6,  r10, ror #16
230        uxth            r10, r10
231        add             r6 , r1,  r6,  lsl #3
232        add             r10, r1,  r10, lsl #3
233        vst2.32         {d24[0],d25[0]},[r10,:64]
234        vst2.32         {d24[1],d25[1]},[r6,:64]
235        b               1b
2361:
237        vneg.f32        d7,  d7                 @  R*s-I*c
238        uxth            r12, r6,  ror #16
239        uxth            r6,  r6
240        add             r12, r1,  r12, lsl #3
241        add             r6,  r1,  r6,  lsl #3
242        vst2.32         {d6[0],d7[0]}, [r6,:64]
243        vst2.32         {d6[1],d7[1]}, [r12,:64]
244        uxth            r6,  r10, ror #16
245        uxth            r10, r10
246        add             r6 , r1,  r6,  lsl #3
247        add             r10, r1,  r10, lsl #3
248        vst2.32         {d24[0],d25[0]},[r10,:64]
249        vst2.32         {d24[1],d25[1]},[r6,:64]
250
251        mov             r4,  r0
252        mov             r6,  r1
253        bl              ff_fft_calc_neon
254
255        mov             r12, #1
256        ldr             lr,  [r4, #28]          @ mdct_bits
257        ldr             r4,  [r4, #32]          @ tcos
258        lsl             r12, r12, lr            @ n  = 1 << nbits
259        lsr             lr,  r12, #3            @ n8 = n >> 3
260
261        add             r4,  r4,  lr,  lsl #3
262        add             r6,  r6,  lr,  lsl #3
263        sub             r1,  r4,  #16
264        sub             r3,  r6,  #16
265
266        mov             r7,  #-16
267        mov             r8,  r6
268        mov             r0,  r3
269
270        vld2.32         {d0-d1},  [r3,:128], r7 @ d0 =r1,i1 d1 =r0,i0
271        vld2.32         {d20-d21},[r6,:128]!    @ d20=r2,i2 d21=r3,i3
272        vld2.32         {d16,d18},[r1,:128], r7 @ c1,c0 s1,s0
2731:
274        subs            lr,  lr,  #2
275        vmul.f32        d7,  d0,  d18           @ r1*s1,r0*s0
276        vld2.32         {d17,d19},[r4,:128]!    @ c2,c3 s2,s3
277        vmul.f32        d4,  d1,  d18           @ i1*s1,i0*s0
278        vmul.f32        d5,  d21, d19           @ i2*s2,i3*s3
279        vmul.f32        d6,  d20, d19           @ r2*s2,r3*s3
280        vmul.f32        d24, d0,  d16           @ r1*c1,r0*c0
281        vmul.f32        d25, d20, d17           @ r2*c2,r3*c3
282        vmul.f32        d22, d21, d17           @ i2*c2,i3*c3
283        vmul.f32        d23, d1,  d16           @ i1*c1,i0*c0
284        vadd.f32        d4,  d4,  d24           @ i1*s1+r1*c1,i0*s0+r0*c0
285        vadd.f32        d5,  d5,  d25           @ i2*s2+r2*c2,i3*s3+r3*c3
286        vsub.f32        d6,  d22, d6            @ i2*c2-r2*s2,i3*c3-r3*s3
287        vsub.f32        d7,  d23, d7            @ i1*c1-r1*s1,i0*c0-r0*s0
288        vneg.f32        q2,  q2
289        beq             1f
290        vld2.32         {d0-d1},  [r3,:128], r7
291        vld2.32         {d20-d21},[r6,:128]!
292        vld2.32         {d16,d18},[r1,:128], r7 @ c1,c0 s1,s0
293        vrev64.32       q3,  q3
294        vst2.32         {d4,d6},  [r0,:128], r7
295        vst2.32         {d5,d7},  [r8,:128]!
296        b               1b
2971:
298        vrev64.32       q3,  q3
299        vst2.32         {d4,d6},  [r0,:128]
300        vst2.32         {d5,d7},  [r8,:128]
301
302        pop             {r4-r10,pc}
303endfunc
304