Debian Codegraph @

src/libmpg123/synth_neon_s32.S

raw
1 /*
2 synth_neon_s32: ARM NEON optimized synth (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 B0 r1
13 #define SAMPLES r2
14
15 /*
16 int synth_1to1_s32_neon_asm(real *window, real *b0, int *samples, int bo1);
17 return value: number of clipped samples (0)
18 */
19
20 #ifndef _M_ARM
21 .code 32
22 #endif
23 #ifndef __APPLE__
24 .fpu neon
25 #endif
26
27 .text
28 GLOBAL_SYMBOL ASM_NAME(INT123_synth_1to1_s32_neon_asm)
29 #ifdef __ELF__
30 .type ASM_NAME(INT123_synth_1to1_s32_neon_asm), %function
31 #endif
32 ALIGN4
33 ASM_NAME(INT123_synth_1to1_s32_neon_asm):
34 push {r4-r6, lr}
35 vpush {q4-q7}
36 mov r6, sp
37 sub sp, sp, #16
38 mov r5, sp
39 and r5, r5, #0xf
40 sub sp, sp, r5
41
42 add WINDOW, WINDOW, #64
43 sub WINDOW, WINDOW, r3, lsl #2
44
45 mov r3, #4
46 mov r4, #128
47 mov r5, #64
48 1:
49 vld1.32 {q0,q1}, [WINDOW], r4
50 vld1.32 {q2,q3}, [WINDOW], r4
51 vld1.32 {q4,q5}, [WINDOW], r4
52 vld1.32 {q6,q7}, [WINDOW]
53 sub WINDOW, WINDOW, #352
54 vld1.32 {q8,q9}, [B0, :128], r5
55 vld1.32 {q10,q11}, [B0, :128], r5
56 vld1.32 {q12,q13}, [B0, :128], r5
57 vld1.32 {q14,q15}, [B0, :128]
58 vswp q1, q4
59 vswp q3, q6
60 sub B0, B0, #160
61 vmul.f32 q0, q0, q8
62 vmul.f32 q2, q2, q10
63 vmul.f32 q1, q1, q12
64 vmul.f32 q3, q3, q14
65 vmla.f32 q0, q4, q9
66 vmla.f32 q2, q6, q11
67 vmla.f32 q1, q5, q13
68 vmla.f32 q3, q7, q15
69 vld1.32 {q4,q5}, [WINDOW], r4
70 vld1.32 {q6,q7}, [WINDOW], r4
71 vld1.32 {q8,q9}, [WINDOW], r4
72 vld1.32 {q10,q11}, [B0, :128], r5
73 vld1.32 {q12,q13}, [B0, :128], r5
74 vld1.32 {q14,q15}, [B0, :128], r5
75 vswp q5, q6
76 vswp q11, q12
77 vmla.f32 q0, q4, q10
78 vmla.f32 q2, q5, q11
79 vmla.f32 q1, q8, q14
80 vld1.32 {q4,q5}, [WINDOW]
81 vld1.32 {q10,q11}, [B0, :128]!
82 add WINDOW, WINDOW, #96
83 vmla.f32 q3, q4, q10
84 vmla.f32 q0, q6, q12
85 vmla.f32 q2, q7, q13
86 vmla.f32 q1, q9, q15
87 vmla.f32 q3, q5, q11
88 vmvn.i32 q5, #0xb9000000
89 vpadd.f32 d0, d0, d1
90 vpadd.f32 d4, d4, d5
91 vpadd.f32 d2, d2, d3
92 vpadd.f32 d6, d6, d7
93 vld1.32 {q6}, [sp, :128]
94 vpadd.f32 d0, d0, d4
95 vpadd.f32 d1, d2, d6
96
97 vcvt.s32.f32 q3, q0, #16
98 vacgt.f32 q5, q0, q5
99 vld2.32 {q1,q2}, [SAMPLES]
100 vshr.u32 q5, q5, #31
101 vmov q1, q3
102 vst2.32 {q1,q2}, [SAMPLES]!
103 vadd.i32 q5, q5, q6
104 vst1.32 {q5}, [sp, :128]
105
106 subs r3, r3, #1
107 bne 1b
108
109 mov r3, #4
110 mov r5, #-64
111 1:
112 vld1.32 {q0,q1}, [WINDOW], r4
113 vld1.32 {q2,q3}, [WINDOW], r4
114 vld1.32 {q4,q5}, [WINDOW], r4
115 vld1.32 {q6,q7}, [WINDOW]
116 sub WINDOW, WINDOW, #352
117 vld1.32 {q8,q9}, [B0, :128], r5
118 vld1.32 {q10,q11}, [B0, :128], r5
119 vld1.32 {q12,q13}, [B0, :128], r5
120 vld1.32 {q14,q15}, [B0, :128]
121 vswp q1, q4
122 vswp q3, q6
123 add B0, B0, #224
124 vmul.f32 q0, q0, q8
125 vmul.f32 q2, q2, q10
126 vmul.f32 q1, q1, q12
127 vmul.f32 q3, q3, q14
128 vmla.f32 q0, q4, q9
129 vmla.f32 q2, q6, q11
130 vmla.f32 q1, q5, q13
131 vmla.f32 q3, q7, q15
132 vld1.32 {q4,q5}, [WINDOW], r4
133 vld1.32 {q6,q7}, [WINDOW], r4
134 vld1.32 {q8,q9}, [WINDOW], r4
135 vld1.32 {q10,q11}, [B0, :128], r5
136 vld1.32 {q12,q13}, [B0, :128], r5
137 vld1.32 {q14,q15}, [B0, :128], r5
138 vswp q5, q6
139 vswp q11, q12
140 vmla.f32 q0, q4, q10
141 vmla.f32 q2, q5, q11
142 vmla.f32 q1, q8, q14
143 vld1.32 {q4,q5}, [WINDOW]
144 vld1.32 {q10,q11}, [B0, :128]
145 add WINDOW, WINDOW, #96
146 sub B0, B0, #96
147 vmla.f32 q3, q4, q10
148 vmla.f32 q0, q6, q12
149 vmla.f32 q2, q7, q13
150 vmla.f32 q1, q9, q15
151 vmla.f32 q3, q5, q11
152 vmvn.i32 q5, #0xb9000000
153 vpadd.f32 d0, d0, d1
154 vpadd.f32 d4, d4, d5
155 vpadd.f32 d2, d2, d3
156 vpadd.f32 d6, d6, d7
157 vld1.32 {q6}, [sp, :128]
158 vpadd.f32 d0, d0, d4
159 vpadd.f32 d1, d2, d6
160
161 vcvt.s32.f32 q3, q0, #16
162 vacgt.f32 q5, q0, q5
163 vld2.32 {q1,q2}, [SAMPLES]
164 vshr.u32 q5, q5, #31
165 vmov q1, q3
166 vst2.32 {q1,q2}, [SAMPLES]!
167 vadd.i32 q5, q5, q6
168 vst1.32 {q5}, [sp, :128]
169
170 subs r3, r3, #1
171 bne 1b
172
173 vld1.32 {q0}, [sp, :128]
174 vpadd.i32 d0, d0, d1
175 vpadd.i32 d0, d0, d0
176 vmov.32 r0, d0[0]
177
178 mov sp, r6
179 vpop {q4-q7}
180 pop {r4-r6, pc}
181
182 NONEXEC_STACK