Debian Codegraph @

src/libmpg123/synth_stereo_neon_accurate.S

raw
1 /*
2 synth_stereo_neon_accurate: ARM NEON optimized synth (stereo specific, MPEG compliant 16-bit output version)
3
4 copyright 1995-2010 by the mpg123 project - free software under the terms of the LGPL 2.1
5 see COPYING and AUTHORS files in distribution or http://mpg123.org
6 initially written by Taihei Monma
7 */
8
9 #include "mangle.h"
10
11 #define WINDOW r0
12 #define B0L r1
13 #define B0R r2
14 #define SAMPLES r3
15
16 /*
17 int synth_1to1_s_neon_accurate_asm(real *window, real *b0l, real *b0r, real *samples, int bo1);
18 return value: number of clipped samples
19 */
20
21 .code 32
22 #ifndef __APPLE__
23 .fpu neon
24 #endif
25
26 .text
27 .globl ASM_NAME(INT123_synth_1to1_s_neon_accurate_asm)
28 #ifdef __ELF__
29 .type ASM_NAME(INT123_synth_1to1_s_neon_accurate_asm), %function
30 #endif
31 ASM_NAME(INT123_synth_1to1_s_neon_accurate_asm):
32 push {r4-r7, lr}
33 vpush {q4-q7}
34 ldr r4, [sp, #84]
35 mov r7, sp
36 sub sp, sp, #16
37 bic sp, #0xff
38
39 add WINDOW, WINDOW, #64
40 sub WINDOW, WINDOW, r4, lsl #2
41
42 mov r4, #4
43 mov r5, #128
44 mov r6, #64
45 1:
46 vld1.32 {q0,q1}, [WINDOW], r5
47 vld1.32 {q2,q3}, [WINDOW]
48 vld1.32 {q4,q5}, [B0L, :128], r6
49 vld1.32 {q6,q7}, [B0R, :128], r6
50 vld1.32 {q8,q9}, [B0L, :128]
51 vld1.32 {q10,q11}, [B0R, :128]
52 vmul.f32 q12, q0, q4
53 vmul.f32 q13, q0, q6
54 vmul.f32 q14, q2, q8
55 vmul.f32 q15, q2, q10
56 vmla.f32 q12, q1, q5
57 vmla.f32 q13, q1, q7
58 vmla.f32 q14, q3, q9
59 vmla.f32 q15, q3, q11
60 sub WINDOW, WINDOW, #96
61 sub B0L, B0L, #32
62 sub B0R, B0R, #32
63 vld1.32 {q0,q1}, [WINDOW], r5
64 vld1.32 {q2,q3}, [WINDOW]
65 vld1.32 {q4,q5}, [B0L, :128], r6
66 vld1.32 {q6,q7}, [B0R, :128], r6
67 vld1.32 {q8,q9}, [B0L, :128]!
68 vld1.32 {q10,q11}, [B0R, :128]!
69 vmla.f32 q12, q0, q4
70 vmla.f32 q13, q0, q6
71 vmla.f32 q14, q2, q8
72 vmla.f32 q15, q2, q10
73 add WINDOW, WINDOW, #96
74 vmla.f32 q12, q1, q5
75 vmla.f32 q13, q1, q7
76 vmla.f32 q14, q3, q9
77 vmla.f32 q15, q3, q11
78
79 vld1.32 {q0,q1}, [WINDOW], r5
80 vld1.32 {q2,q3}, [WINDOW]
81 vld1.32 {q4,q5}, [B0L, :128], r6
82 vld1.32 {q6,q7}, [B0R, :128], r6
83 vld1.32 {q8,q9}, [B0L, :128]
84 vld1.32 {q10,q11}, [B0R, :128]
85 vpadd.f32 d24, d24, d25
86 vpadd.f32 d25, d26, d27
87 vpadd.f32 d26, d28, d29
88 vpadd.f32 d27, d30, d31
89 vmov.i32 q15, #0x4b000000
90 vmvn.i32 q14, #0xb9000000
91 vorr.i32 q15, #0x00400000
92 vpadd.f32 d24, d24, d25
93 vpadd.f32 d25, d26, d27
94 vacgt.f32 q14, q12, q14
95 vadd.f32 q13, q12, q15
96 vld1.32 {q15}, [sp, :128]
97 vshr.u32 q14, q14, #31
98 vshl.i32 q13, q13, #10
99 vadd.i32 q14, q14, q15
100 vqshrn.s32 d26, q13, #10
101 vst1.32 {q14}, [sp, :128]
102 vst1.16 {d26}, [SAMPLES]!
103 vmul.f32 q12, q0, q4
104 vmul.f32 q13, q0, q6
105 vmul.f32 q14, q2, q8
106 vmul.f32 q15, q2, q10
107 vmla.f32 q12, q1, q5
108 vmla.f32 q13, q1, q7
109 vmla.f32 q14, q3, q9
110 vmla.f32 q15, q3, q11
111 sub WINDOW, WINDOW, #96
112 sub B0L, B0L, #32
113 sub B0R, B0R, #32
114 vld1.32 {q0,q1}, [WINDOW], r5
115 vld1.32 {q2,q3}, [WINDOW]
116 vld1.32 {q4,q5}, [B0L, :128], r6
117 vld1.32 {q6,q7}, [B0R, :128], r6
118 vld1.32 {q8,q9}, [B0L, :128]!
119 vld1.32 {q10,q11}, [B0R, :128]!
120 vmla.f32 q12, q0, q4
121 vmla.f32 q13, q0, q6
122 vmla.f32 q14, q2, q8
123 vmla.f32 q15, q2, q10
124 add WINDOW, WINDOW, #96
125 vmla.f32 q12, q1, q5
126 vmla.f32 q13, q1, q7
127 vmla.f32 q14, q3, q9
128 vmla.f32 q15, q3, q11
129 vpadd.f32 d24, d24, d25
130 vpadd.f32 d25, d26, d27
131 vpadd.f32 d26, d28, d29
132 vpadd.f32 d27, d30, d31
133 vmov.i32 q15, #0x4b000000
134 vmvn.i32 q14, #0xb9000000
135 vorr.i32 q15, #0x00400000
136 vpadd.f32 d24, d24, d25
137 vpadd.f32 d25, d26, d27
138 vacgt.f32 q14, q12, q14
139 vadd.f32 q13, q12, q15
140 vld1.32 {q15}, [sp, :128]
141 vshr.u32 q14, q14, #31
142 vshl.i32 q13, q13, #10
143 vadd.i32 q14, q14, q15
144 vqshrn.s32 d26, q13, #10
145 vst1.32 {q14}, [sp, :128]
146 vst1.16 {d26}, [SAMPLES]!
147
148 subs r4, r4, #1
149 bne 1b
150
151 mov r4, #4
152 mov r6, #-64
153 1:
154 vld1.32 {q0,q1}, [WINDOW], r5
155 vld1.32 {q2,q3}, [WINDOW]
156 vld1.32 {q4,q5}, [B0L, :128], r6
157 vld1.32 {q6,q7}, [B0R, :128], r6
158 vld1.32 {q8,q9}, [B0L, :128]
159 vld1.32 {q10,q11}, [B0R, :128]
160 vmul.f32 q12, q0, q4
161 vmul.f32 q13, q0, q6
162 vmul.f32 q14, q2, q8
163 vmul.f32 q15, q2, q10
164 vmla.f32 q12, q1, q5
165 vmla.f32 q13, q1, q7
166 vmla.f32 q14, q3, q9
167 vmla.f32 q15, q3, q11
168 sub WINDOW, WINDOW, #96
169 add B0L, B0L, #96
170 add B0R, B0R, #96
171 vld1.32 {q0,q1}, [WINDOW], r5
172 vld1.32 {q2,q3}, [WINDOW]
173 vld1.32 {q4,q5}, [B0L, :128], r6
174 vld1.32 {q6,q7}, [B0R, :128], r6
175 vld1.32 {q8,q9}, [B0L, :128]
176 vld1.32 {q10,q11}, [B0R, :128]
177 vmla.f32 q12, q0, q4
178 vmla.f32 q13, q0, q6
179 vmla.f32 q14, q2, q8
180 vmla.f32 q15, q2, q10
181 add WINDOW, WINDOW, #96
182 sub B0L, B0L, #96
183 sub B0R, B0R, #96
184 vmla.f32 q12, q1, q5
185 vmla.f32 q13, q1, q7
186 vmla.f32 q14, q3, q9
187 vmla.f32 q15, q3, q11
188
189 vld1.32 {q0,q1}, [WINDOW], r5
190 vld1.32 {q2,q3}, [WINDOW]
191 vld1.32 {q4,q5}, [B0L, :128], r6
192 vld1.32 {q6,q7}, [B0R, :128], r6
193 vld1.32 {q8,q9}, [B0L, :128]
194 vld1.32 {q10,q11}, [B0R, :128]
195 vpadd.f32 d24, d24, d25
196 vpadd.f32 d25, d26, d27
197 vpadd.f32 d26, d28, d29
198 vpadd.f32 d27, d30, d31
199 vmov.i32 q15, #0x4b000000
200 vmvn.i32 q14, #0xb9000000
201 vorr.i32 q15, #0x00400000
202 vpadd.f32 d24, d24, d25
203 vpadd.f32 d25, d26, d27
204 vacgt.f32 q14, q12, q14
205 vadd.f32 q13, q12, q15
206 vld1.32 {q15}, [sp, :128]
207 vshr.u32 q14, q14, #31
208 vshl.i32 q13, q13, #10
209 vadd.i32 q14, q14, q15
210 vqshrn.s32 d26, q13, #10
211 vst1.32 {q14}, [sp, :128]
212 vst1.16 {d26}, [SAMPLES]!
213 vmul.f32 q12, q0, q4
214 vmul.f32 q13, q0, q6
215 vmul.f32 q14, q2, q8
216 vmul.f32 q15, q2, q10
217 vmla.f32 q12, q1, q5
218 vmla.f32 q13, q1, q7
219 vmla.f32 q14, q3, q9
220 vmla.f32 q15, q3, q11
221 sub WINDOW, WINDOW, #96
222 add B0L, B0L, #96
223 add B0R, B0R, #96
224 vld1.32 {q0,q1}, [WINDOW], r5
225 vld1.32 {q2,q3}, [WINDOW]
226 vld1.32 {q4,q5}, [B0L, :128], r6
227 vld1.32 {q6,q7}, [B0R, :128], r6
228 vld1.32 {q8,q9}, [B0L, :128]
229 vld1.32 {q10,q11}, [B0R, :128]
230 vmla.f32 q12, q0, q4
231 vmla.f32 q13, q0, q6
232 vmla.f32 q14, q2, q8
233 vmla.f32 q15, q2, q10
234 add WINDOW, WINDOW, #96
235 sub B0L, B0L, #96
236 sub B0R, B0R, #96
237 vmla.f32 q12, q1, q5
238 vmla.f32 q13, q1, q7
239 vmla.f32 q14, q3, q9
240 vmla.f32 q15, q3, q11
241 vpadd.f32 d24, d24, d25
242 vpadd.f32 d25, d26, d27
243 vpadd.f32 d26, d28, d29
244 vpadd.f32 d27, d30, d31
245 vmov.i32 q15, #0x4b000000
246 vmvn.i32 q14, #0xb9000000
247 vorr.i32 q15, #0x00400000
248 vpadd.f32 d24, d24, d25
249 vpadd.f32 d25, d26, d27
250 vacgt.f32 q14, q12, q14
251 vadd.f32 q13, q12, q15
252 vld1.32 {q15}, [sp, :128]
253 vshr.u32 q14, q14, #31
254 vshl.i32 q13, q13, #10
255 vadd.i32 q14, q14, q15
256 vqshrn.s32 d26, q13, #10
257 vst1.32 {q14}, [sp, :128]
258 vst1.16 {d26}, [SAMPLES]!
259
260 subs r4, r4, #1
261 bne 1b
262
263 vld1.32 {q0}, [sp, :128]
264 vpadd.i32 d0, d0, d1
265 vpadd.i32 d0, d0, d0
266 vmov.32 r0, d0[0]
267
268 mov sp, r7
269 vpop {q4-q7}
270 pop {r4-r7, pc}
271
272 NONEXEC_STACK