Debian Codegraph @

src/libmpg123/synth_stereo_neon_s32.S

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