Debian Codegraph @

src/libmpg123/synth_neon_accurate.S

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