Debian Codegraph @

src/libmpg123/synth_arm.S

raw
1 /*
2 synth_arm: ARM optimized synth
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 r12
16
17 /*
18 int synth_1to1_arm_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_asm)
27 #ifdef __ELF__
28 .type ASM_NAME(INT123_synth_1to1_arm_asm), %function
29 #endif
30 ASM_NAME(INT123_synth_1to1_arm_asm):
31 stmfd sp!, {r4, r5, r6, r7, r8, r9, r10, 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 r8, [WINDOW], #4
45 ldr r9, [B0], #4
46 mul r7, r5, r6
47 ldr r5, [WINDOW], #4
48 ldr r6, [B0], #4
49 mul r10, r8, r9
50 ldr r8, [WINDOW], #4
51 ldr r9, [B0], #4
52 mla r7, r5, r6, r7
53 ldr r5, [WINDOW], #4
54 ldr r6, [B0], #4
55 mla r10, r8, r9, r10
56 ldr r8, [WINDOW], #4
57 ldr r9, [B0], #4
58 mla r7, r5, r6, r7
59 ldr r5, [WINDOW], #4
60 ldr r6, [B0], #4
61 mla r10, r8, r9, r10
62 ldr r8, [WINDOW], #4
63 ldr r9, [B0], #4
64 mla r7, r5, r6, r7
65 ldr r5, [WINDOW], #4
66 ldr r6, [B0], #4
67 mla r10, r8, r9, r10
68 ldr r8, [WINDOW], #4
69 ldr r9, [B0], #4
70 mla r7, r5, r6, r7
71 ldr r5, [WINDOW], #4
72 ldr r6, [B0], #4
73 mla r10, r8, r9, r10
74 ldr r8, [WINDOW], #4
75 ldr r9, [B0], #4
76 mla r7, r5, r6, r7
77 ldr r5, [WINDOW], #4
78 ldr r6, [B0], #4
79 mla r10, r8, r9, r10
80 ldr r8, [WINDOW], #4
81 ldr r9, [B0], #4
82 mla r7, r5, r6, r7
83 ldr r5, [WINDOW], #4
84 ldr r6, [B0], #4
85 mla r10, r8, r9, r10
86 ldr r8, [WINDOW], #68
87 ldr r9, [B0], #4
88 mla r7, r5, r6, r7
89 ldr r5, [WINDOW], #4
90 ldr r6, [B0], #4
91 mla r10, r8, r9, r10
92
93 sub r7, r7, r10
94
95 cmp r7, REG_MAX
96 movgt r7, REG_MAX
97 addgt REG_CLIP, REG_CLIP, #1
98 cmp r7, #-1073741824
99 movlt r7, #-1073741824
100 addlt REG_CLIP, REG_CLIP, #1
101 movs r7, r7, asr #15
102 adc r7, r7, #0
103 strh r7, [SAMPLES], #4
104
105 subs r3, r3, #1
106 bne 1b
107
108 add WINDOW, WINDOW, #4
109 add B0, B0, #4
110
111 ldr r8, [WINDOW], #8
112 ldr r9, [B0], #8
113 mul r7, r5, r6
114 ldr r5, [WINDOW], #8
115 ldr r6, [B0], #8
116 mul r10, r8, r9
117 ldr r8, [WINDOW], #8
118 ldr r9, [B0], #8
119 mla r7, r5, r6, r7
120 ldr r5, [WINDOW], #8
121 ldr r6, [B0], #8
122 mla r10, r8, r9, r10
123 ldr r8, [WINDOW], #8
124 ldr r9, [B0], #8
125 mla r7, r5, r6, r7
126 ldr r5, [WINDOW], #8
127 ldr r6, [B0], #8
128 mla r10, r8, r9, r10
129 ldr r8, [WINDOW], #72
130 ldr r9, [B0], #-120
131 mla r7, r5, r6, r7
132 ldr r5, [WINDOW], #4
133 ldr r6, [B0], #4
134 mla r10, r8, r9, r10
135
136 add r7, r7, r10
137
138 cmp r7, REG_MAX
139 movgt r7, REG_MAX
140 addgt REG_CLIP, REG_CLIP, #1
141 cmp r7, #-1073741824
142 movlt r7, #-1073741824
143 addlt REG_CLIP, REG_CLIP, #1
144 movs r7, r7, asr #15
145 adc r7, r7, #0
146 strh r7, [SAMPLES], #4
147
148 mov r3, #14
149
150 1:
151 ldr r8, [WINDOW], #4
152 ldr r9, [B0], #4
153 mul r7, r5, r6
154 ldr r5, [WINDOW], #4
155 ldr r6, [B0], #4
156 mul r10, r8, r9
157 ldr r8, [WINDOW], #4
158 ldr r9, [B0], #4
159 mla r7, r5, r6, r7
160 ldr r5, [WINDOW], #4
161 ldr r6, [B0], #4
162 mla r10, r8, r9, r10
163 ldr r8, [WINDOW], #4
164 ldr r9, [B0], #4
165 mla r7, r5, r6, r7
166 ldr r5, [WINDOW], #4
167 ldr r6, [B0], #4
168 mla r10, r8, r9, r10
169 ldr r8, [WINDOW], #4
170 ldr r9, [B0], #4
171 mla r7, r5, r6, r7
172 ldr r5, [WINDOW], #4
173 ldr r6, [B0], #4
174 mla r10, r8, r9, r10
175 ldr r8, [WINDOW], #4
176 ldr r9, [B0], #4
177 mla r7, r5, r6, r7
178 ldr r5, [WINDOW], #4
179 ldr r6, [B0], #4
180 mla r10, r8, r9, r10
181 ldr r8, [WINDOW], #4
182 ldr r9, [B0], #4
183 mla r7, r5, r6, r7
184 ldr r5, [WINDOW], #4
185 ldr r6, [B0], #4
186 mla r10, r8, r9, r10
187 ldr r8, [WINDOW], #4
188 ldr r9, [B0], #4
189 mla r7, r5, r6, r7
190 ldr r5, [WINDOW], #4
191 ldr r6, [B0], #4
192 mla r10, r8, r9, r10
193 ldr r8, [WINDOW], #68
194 ldr r9, [B0], #-124
195 mla r7, r5, r6, r7
196 ldr r5, [WINDOW], #4
197 ldr r6, [B0], #4
198 mla r10, r8, r9, r10
199
200 add r7, r7, r10
201
202 cmp r7, REG_MAX
203 movgt r7, REG_MAX
204 addgt REG_CLIP, REG_CLIP, #1
205 cmp r7, #-1073741824
206 movlt r7, #-1073741824
207 addlt REG_CLIP, REG_CLIP, #1
208 movs r7, r7, asr #15
209 adc r7, r7, #0
210 strh r7, [SAMPLES], #4
211
212 subs r3, r3, #1
213 bne 1b
214
215 ldr r8, [WINDOW], #4
216 ldr r9, [B0], #4
217 mul r7, r5, r6
218 ldr r5, [WINDOW], #4
219 ldr r6, [B0], #4
220 mul r10, r8, r9
221 ldr r8, [WINDOW], #4
222 ldr r9, [B0], #4
223 mla r7, r5, r6, r7
224 ldr r5, [WINDOW], #4
225 ldr r6, [B0], #4
226 mla r10, r8, r9, r10
227 ldr r8, [WINDOW], #4
228 ldr r9, [B0], #4
229 mla r7, r5, r6, r7
230 ldr r5, [WINDOW], #4
231 ldr r6, [B0], #4
232 mla r10, r8, r9, r10
233 ldr r8, [WINDOW], #4
234 ldr r9, [B0], #4
235 mla r7, r5, r6, r7
236 ldr r5, [WINDOW], #4
237 ldr r6, [B0], #4
238 mla r10, r8, r9, r10
239 ldr r8, [WINDOW], #4
240 ldr r9, [B0], #4
241 mla r7, r5, r6, r7
242 ldr r5, [WINDOW], #4
243 ldr r6, [B0], #4
244 mla r10, r8, r9, r10
245 ldr r8, [WINDOW], #4
246 ldr r9, [B0], #4
247 mla r7, r5, r6, r7
248 ldr r5, [WINDOW], #4
249 ldr r6, [B0], #4
250 mla r10, r8, r9, r10
251 ldr r8, [WINDOW], #4
252 ldr r9, [B0], #4
253 mla r7, r5, r6, r7
254 ldr r5, [WINDOW], #4
255 ldr r6, [B0], #4
256 mla r10, r8, r9, r10
257 ldr r8, [WINDOW]
258 ldr r9, [B0]
259 mla r7, r5, r6, r7
260 mla r10, r8, r9, r10
261
262 add r7, r7, r10
263
264 cmp r7, REG_MAX
265 movgt r7, REG_MAX
266 addgt REG_CLIP, REG_CLIP, #1
267 cmp r7, #-1073741824
268 movlt r7, #-1073741824
269 addlt REG_CLIP, REG_CLIP, #1
270 movs r7, r7, asr #15
271 adc r7, r7, #0
272 strh r7, [SAMPLES]
273
274 mov r0, REG_CLIP
275
276 ldmfd sp!, {r4, r5, r6, r7, r8, r9, r10, pc}
277
278 NONEXEC_STACK