Debian Codegraph @

src/libmpg123/synth_stereo_neon.S

raw
1 /*
2 synth_stereo_neon: ARM NEON optimized synth (stereo specific 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_asm(short *window, short *b0l, short *b0r, short *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_s_neon_asm)
30 #ifdef __ELF__
31 .type ASM_NAME(INT123_synth_1to1_s_neon_asm), %function
32 #endif
33 ALIGN4
34 ASM_NAME(INT123_synth_1to1_s_neon_asm):
35 push {r4-r6, lr}
36 vpush {q4-q7}
37
38 ldr r4, [sp, #80]
39 add WINDOW, WINDOW, #32
40 sub WINDOW, WINDOW, r4, lsl #1
41
42 mov r4, #4
43 mov r5, #64
44 1:
45 vld1.16 {d0-d3}, [WINDOW], r5
46 vld1.16 {d4-d7}, [WINDOW], r5
47 vld1.16 {d8-d11}, [B0L, :128]!
48 vld1.16 {d12-d15}, [B0R, :128]!
49 vld1.16 {d16-d19}, [B0L, :128]!
50 vld1.16 {d20-d23}, [B0R, :128]!
51
52 vmull.s16 q12, d0, d8
53 vmull.s16 q13, d0, d12
54 vmull.s16 q14, d4, d16
55 vmull.s16 q15, d4, d20
56 vmlal.s16 q12, d1, d9
57 vmlal.s16 q13, d1, d13
58 vmlal.s16 q14, d5, d17
59 vmlal.s16 q15, d5, d21
60 vmlal.s16 q12, d2, d10
61 vmlal.s16 q13, d2, d14
62 vmlal.s16 q14, d6, d18
63 vmlal.s16 q15, d6, d22
64 vmlal.s16 q12, d3, d11
65 vmlal.s16 q13, d3, d15
66 vmlal.s16 q14, d7, d19
67 vmlal.s16 q15, d7, d23
68 vpadd.i32 d24, d24, d25
69 vpadd.i32 d26, d26, d27
70 vpadd.i32 d28, d28, d29
71 vpadd.i32 d30, d30, d31
72 vpadd.i32 d24, d24, d26
73 vpadd.i32 d25, d28, d30
74 vqrshrn.s32 d0, q12, #13
75 vst1.16 {d0}, [SAMPLES]!
76
77 vld1.16 {d0-d3}, [WINDOW], r5
78 vld1.16 {d4-d7}, [WINDOW], r5
79 vld1.16 {d8-d11}, [B0L, :128]!
80 vld1.16 {d12-d15}, [B0R, :128]!
81 vld1.16 {d16-d19}, [B0L, :128]!
82 vld1.16 {d20-d23}, [B0R, :128]!
83
84 vmull.s16 q12, d0, d8
85 vmull.s16 q13, d0, d12
86 vmull.s16 q14, d4, d16
87 vmull.s16 q15, d4, d20
88 vmlal.s16 q12, d1, d9
89 vmlal.s16 q13, d1, d13
90 vmlal.s16 q14, d5, d17
91 vmlal.s16 q15, d5, d21
92 vmlal.s16 q12, d2, d10
93 vmlal.s16 q13, d2, d14
94 vmlal.s16 q14, d6, d18
95 vmlal.s16 q15, d6, d22
96 vmlal.s16 q12, d3, d11
97 vmlal.s16 q13, d3, d15
98 vmlal.s16 q14, d7, d19
99 vmlal.s16 q15, d7, d23
100 vpadd.i32 d24, d24, d25
101 vpadd.i32 d26, d26, d27
102 vpadd.i32 d28, d28, d29
103 vpadd.i32 d30, d30, d31
104 vpadd.i32 d24, d24, d26
105 vpadd.i32 d25, d28, d30
106 vqrshrn.s32 d0, q12, #13
107 vst1.16 {d0}, [SAMPLES]!
108
109 subs r4, r4, #1
110 bne 1b
111
112 mov r4, #4
113 mov r6, #-32
114 1:
115 vld1.16 {d0-d3}, [WINDOW], r5
116 vld1.16 {d4-d7}, [WINDOW], r5
117 vld1.16 {d8-d11}, [B0L, :128], r6
118 vld1.16 {d12-d15}, [B0R, :128], r6
119 vld1.16 {d16-d19}, [B0L, :128], r6
120 vld1.16 {d20-d23}, [B0R, :128], r6
121
122 vmull.s16 q12, d0, d8
123 vmull.s16 q13, d0, d12
124 vmull.s16 q14, d4, d16
125 vmull.s16 q15, d4, d20
126 vmlal.s16 q12, d1, d9
127 vmlal.s16 q13, d1, d13
128 vmlal.s16 q14, d5, d17
129 vmlal.s16 q15, d5, d21
130 vmlal.s16 q12, d2, d10
131 vmlal.s16 q13, d2, d14
132 vmlal.s16 q14, d6, d18
133 vmlal.s16 q15, d6, d22
134 vmlal.s16 q12, d3, d11
135 vmlal.s16 q13, d3, d15
136 vmlal.s16 q14, d7, d19
137 vmlal.s16 q15, d7, d23
138 vpadd.i32 d24, d24, d25
139 vpadd.i32 d26, d26, d27
140 vpadd.i32 d28, d28, d29
141 vpadd.i32 d30, d30, d31
142 vpadd.i32 d24, d24, d26
143 vpadd.i32 d25, d28, d30
144 vqrshrn.s32 d0, q12, #13
145 vst1.16 {d0}, [SAMPLES]!
146
147 vld1.16 {d0-d3}, [WINDOW], r5
148 vld1.16 {d4-d7}, [WINDOW], r5
149 vld1.16 {d8-d11}, [B0L, :128], r6
150 vld1.16 {d12-d15}, [B0R, :128], r6
151 vld1.16 {d16-d19}, [B0L, :128], r6
152 vld1.16 {d20-d23}, [B0R, :128], r6
153
154 vmull.s16 q12, d0, d8
155 vmull.s16 q13, d0, d12
156 vmull.s16 q14, d4, d16
157 vmull.s16 q15, d4, d20
158 vmlal.s16 q12, d1, d9
159 vmlal.s16 q13, d1, d13
160 vmlal.s16 q14, d5, d17
161 vmlal.s16 q15, d5, d21
162 vmlal.s16 q12, d2, d10
163 vmlal.s16 q13, d2, d14
164 vmlal.s16 q14, d6, d18
165 vmlal.s16 q15, d6, d22
166 vmlal.s16 q12, d3, d11
167 vmlal.s16 q13, d3, d15
168 vmlal.s16 q14, d7, d19
169 vmlal.s16 q15, d7, d23
170 vpadd.i32 d24, d24, d25
171 vpadd.i32 d26, d26, d27
172 vpadd.i32 d28, d28, d29
173 vpadd.i32 d30, d30, d31
174 vpadd.i32 d24, d24, d26
175 vpadd.i32 d25, d28, d30
176 vqrshrn.s32 d0, q12, #13
177 vst1.16 {d0}, [SAMPLES]!
178
179 subs r4, r4, #1
180 bne 1b
181
182 mov r0, #0
183
184 vpop {q4-q7}
185 pop {r4-r6, pc}
186
187 NONEXEC_STACK