Debian Codegraph @

src/libmpg123/synth_arm_accurate.S

raw
1 /*
2 synth_arm_accurate: ARM optimized synth (ISO compliant 16bit output version)
3
4 copyright 1995-2009 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 B0 r1
13 #define SAMPLES r2
14 #define REG_CLIP r4
15 #define REG_MAX r14
16
17 /*
18 int synth_1to1_arm_accurate_asm(real *window, real *b0, short *samples, int bo1);
19 return value: number of clipped samples
20 */
21
22 .code 32
23
24 .text
25 ALIGN4
26 .globl ASM_NAME(INT123_synth_1to1_arm_accurate_asm)
27 #ifdef __ELF__
28 .type ASM_NAME(INT123_synth_1to1_arm_accurate_asm), %function
29 #endif
30 ASM_NAME(INT123_synth_1to1_arm_accurate_asm):
31 stmfd sp!, {r4, r5, r6, r7, r8, r9, r10, r11, lr}
32
33 add WINDOW, WINDOW, #64
34 sub WINDOW, WINDOW, r3, lsl #2
35 eor REG_CLIP, REG_CLIP, REG_CLIP
36 mov REG_MAX, #1073741824
37 sub REG_MAX, REG_MAX, #32768
38
39 mov r3, #16
40
41 ldr r5, [WINDOW], #4
42 ldr r6, [B0], #4
43 1:
44 ldr r9, [WINDOW], #4
45 ldr r10, [B0], #4
46 smull r8, r7, r5, r6
47 ldr r5, [WINDOW], #4
48 ldr r6, [B0], #4
49 smull r12, r11, r9, r10
50 ldr r9, [WINDOW], #4
51 ldr r10, [B0], #4
52 smlal r8, r7, r5, r6
53 ldr r5, [WINDOW], #4
54 ldr r6, [B0], #4
55 smlal r12, r11, r9, r10
56 ldr r9, [WINDOW], #4
57 ldr r10, [B0], #4
58 smlal r8, r7, r5, r6
59 ldr r5, [WINDOW], #4
60 ldr r6, [B0], #4
61 smlal r12, r11, r9, r10
62 ldr r9, [WINDOW], #4
63 ldr r10, [B0], #4
64 smlal r8, r7, r5, r6
65 ldr r5, [WINDOW], #4
66 ldr r6, [B0], #4
67 smlal r12, r11, r9, r10
68 ldr r9, [WINDOW], #4
69 ldr r10, [B0], #4
70 smlal r8, r7, r5, r6
71 ldr r5, [WINDOW], #4
72 ldr r6, [B0], #4
73 smlal r12, r11, r9, r10
74 ldr r9, [WINDOW], #4
75 ldr r10, [B0], #4
76 smlal r8, r7, r5, r6
77 ldr r5, [WINDOW], #4
78 ldr r6, [B0], #4
79 smlal r12, r11, r9, r10
80 ldr r9, [WINDOW], #4
81 ldr r10, [B0], #4
82 smlal r8, r7, r5, r6
83 ldr r5, [WINDOW], #4
84 ldr r6, [B0], #4
85 smlal r12, r11, r9, r10
86 ldr r9, [WINDOW], #68
87 ldr r10, [B0], #4
88 smlal r8, r7, r5, r6
89 ldr r5, [WINDOW], #4
90 ldr r6, [B0], #4
91 smlal r12, r11, r9, r10
92
93 mov r8, r8, lsr #24
94 mov r12, r12, lsr #24
95 orr r8, r8, r7, lsl #8
96 orr r12, r12, r11, lsl #8
97 sub r8, r8, r12
98
99 cmp r8, REG_MAX
100 movgt r8, REG_MAX
101 addgt REG_CLIP, REG_CLIP, #1
102 cmp r8, #-1073741824
103 movlt r8, #-1073741824
104 addlt REG_CLIP, REG_CLIP, #1
105 movs r8, r8, asr #15
106 adc r8, r8, #0
107 strh r8, [SAMPLES], #4
108
109 subs r3, r3, #1
110 bne 1b
111
112 add WINDOW, WINDOW, #4
113 add B0, B0, #4
114
115 ldr r9, [WINDOW], #8
116 ldr r10, [B0], #8
117 smull r8, r7, r5, r6
118 ldr r5, [WINDOW], #8
119 ldr r6, [B0], #8
120 smull r12, r11, r9, r10
121 ldr r9, [WINDOW], #8
122 ldr r10, [B0], #8
123 smlal r8, r7, r5, r6
124 ldr r5, [WINDOW], #8
125 ldr r6, [B0], #8
126 smlal r12, r11, r9, r10
127 ldr r9, [WINDOW], #8
128 ldr r10, [B0], #8
129 smlal r8, r7, r5, r6
130 ldr r5, [WINDOW], #8
131 ldr r6, [B0], #8
132 smlal r12, r11, r9, r10
133 ldr r9, [WINDOW], #72
134 ldr r10, [B0], #-120
135 smlal r8, r7, r5, r6
136 ldr r5, [WINDOW], #4
137 ldr r6, [B0], #4
138 smlal r12, r11, r9, r10
139
140 mov r8, r8, lsr #24
141 mov r12, r12, lsr #24
142 orr r8, r8, r7, lsl #8
143 orr r12, r12, r11, lsl #8
144 add r8, r8, r12
145
146 cmp r8, REG_MAX
147 movgt r8, REG_MAX
148 addgt REG_CLIP, REG_CLIP, #1
149 cmp r8, #-1073741824
150 movlt r8, #-1073741824
151 addlt REG_CLIP, REG_CLIP, #1
152 movs r8, r8, asr #15
153 adc r8, r8, #0
154 strh r8, [SAMPLES], #4
155
156 mov r3, #14
157
158 1:
159 ldr r9, [WINDOW], #4
160 ldr r10, [B0], #4
161 smull r8, r7, r5, r6
162 ldr r5, [WINDOW], #4
163 ldr r6, [B0], #4
164 smull r12, r11, r9, r10
165 ldr r9, [WINDOW], #4
166 ldr r10, [B0], #4
167 smlal r8, r7, r5, r6
168 ldr r5, [WINDOW], #4
169 ldr r6, [B0], #4
170 smlal r12, r11, r9, r10
171 ldr r9, [WINDOW], #4
172 ldr r10, [B0], #4
173 smlal r8, r7, r5, r6
174 ldr r5, [WINDOW], #4
175 ldr r6, [B0], #4
176 smlal r12, r11, r9, r10
177 ldr r9, [WINDOW], #4
178 ldr r10, [B0], #4
179 smlal r8, r7, r5, r6
180 ldr r5, [WINDOW], #4
181 ldr r6, [B0], #4
182 smlal r12, r11, r9, r10
183 ldr r9, [WINDOW], #4
184 ldr r10, [B0], #4
185 smlal r8, r7, r5, r6
186 ldr r5, [WINDOW], #4
187 ldr r6, [B0], #4
188 smlal r12, r11, r9, r10
189 ldr r9, [WINDOW], #4
190 ldr r10, [B0], #4
191 smlal r8, r7, r5, r6
192 ldr r5, [WINDOW], #4
193 ldr r6, [B0], #4
194 smlal r12, r11, r9, r10
195 ldr r9, [WINDOW], #4
196 ldr r10, [B0], #4
197 smlal r8, r7, r5, r6
198 ldr r5, [WINDOW], #4
199 ldr r6, [B0], #4
200 smlal r12, r11, r9, r10
201 ldr r9, [WINDOW], #68
202 ldr r10, [B0], #-124
203 smlal r8, r7, r5, r6
204 ldr r5, [WINDOW], #4
205 ldr r6, [B0], #4
206 smlal r12, r11, r9, r10
207
208 mov r8, r8, lsr #24
209 mov r12, r12, lsr #24
210 orr r8, r8, r7, lsl #8
211 orr r12, r12, r11, lsl #8
212 add r8, r8, r12
213
214 cmp r8, REG_MAX
215 movgt r8, REG_MAX
216 addgt REG_CLIP, REG_CLIP, #1
217 cmp r8, #-1073741824
218 movlt r8, #-1073741824
219 addlt REG_CLIP, REG_CLIP, #1
220 movs r8, r8, asr #15
221 adc r8, r8, #0
222 strh r8, [SAMPLES], #4
223
224 subs r3, r3, #1
225 bne 1b
226
227 ldr r9, [WINDOW], #4
228 ldr r10, [B0], #4
229 smull r8, r7, r5, r6
230 ldr r5, [WINDOW], #4
231 ldr r6, [B0], #4
232 smull r12, r11, r9, r10
233 ldr r9, [WINDOW], #4
234 ldr r10, [B0], #4
235 smlal r8, r7, r5, r6
236 ldr r5, [WINDOW], #4
237 ldr r6, [B0], #4
238 smlal r12, r11, r9, r10
239 ldr r9, [WINDOW], #4
240 ldr r10, [B0], #4
241 smlal r8, r7, r5, r6
242 ldr r5, [WINDOW], #4
243 ldr r6, [B0], #4
244 smlal r12, r11, r9, r10
245 ldr r9, [WINDOW], #4
246 ldr r10, [B0], #4
247 smlal r8, r7, r5, r6
248 ldr r5, [WINDOW], #4
249 ldr r6, [B0], #4
250 smlal r12, r11, r9, r10
251 ldr r9, [WINDOW], #4
252 ldr r10, [B0], #4
253 smlal r8, r7, r5, r6
254 ldr r5, [WINDOW], #4
255 ldr r6, [B0], #4
256 smlal r12, r11, r9, r10
257 ldr r9, [WINDOW], #4
258 ldr r10, [B0], #4
259 smlal r8, r7, r5, r6
260 ldr r5, [WINDOW], #4
261 ldr r6, [B0], #4
262 smlal r12, r11, r9, r10
263 ldr r9, [WINDOW], #4
264 ldr r10, [B0], #4
265 smlal r8, r7, r5, r6
266 ldr r5, [WINDOW], #4
267 ldr r6, [B0], #4
268 smlal r12, r11, r9, r10
269 ldr r9, [WINDOW], #68
270 ldr r10, [B0], #-124
271 smlal r8, r7, r5, r6
272 smlal r12, r11, r9, r10
273
274 mov r8, r8, lsr #24
275 mov r12, r12, lsr #24
276 orr r8, r8, r7, lsl #8
277 orr r12, r12, r11, lsl #8
278 add r8, r8, r12
279
280 cmp r8, REG_MAX
281 movgt r8, REG_MAX
282 addgt REG_CLIP, REG_CLIP, #1
283 cmp r8, #-1073741824
284 movlt r8, #-1073741824
285 addlt REG_CLIP, REG_CLIP, #1
286 movs r8, r8, asr #15
287 adc r8, r8, #0
288 strh r8, [SAMPLES]
289
290 mov r0, REG_CLIP
291
292 ldmfd sp!, {r4, r5, r6, r7, r8, r9, r10, r11, pc}
293
294 NONEXEC_STACK