Debian Codegraph @

src/libmpg123/synth_neon_float.S

raw
1 /*
2 synth_neon_float: ARM NEON optimized synth (float 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_asm(real *window, real *b0, real *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_real_neon_asm)
29 #ifdef __ELF__
30 .type ASM_NAME(INT123_synth_1to1_real_neon_asm), %function
31 #endif
32 ALIGN4
33 ASM_NAME(INT123_synth_1to1_real_neon_asm):
34 push {r4-r5, lr}
35 vpush {q4-q7}
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 vld2.32 {q4,q5}, [SAMPLES]
84 vpadd.f32 d0, d0, d1
85 vpadd.f32 d4, d4, d5
86 vpadd.f32 d2, d2, d3
87 vpadd.f32 d6, d6, d7
88 vpadd.f32 d0, d0, d4
89 vpadd.f32 d1, d2, d6
90
91 vmov.i32 q1, #0x38000000
92 vmul.f32 q4, q0, q1
93 vst2.32 {q4,q5}, [SAMPLES]!
94
95 subs r3, r3, #1
96 bne 1b
97
98 mov r3, #4
99 mov r5, #-64
100 1:
101 vld1.32 {q0,q1}, [WINDOW], r4
102 vld1.32 {q2,q3}, [WINDOW], r4
103 vld1.32 {q4,q5}, [WINDOW], r4
104 vld1.32 {q6,q7}, [WINDOW]
105 sub WINDOW, WINDOW, #352
106 vld1.32 {q8,q9}, [B0, :128], r5
107 vld1.32 {q10,q11}, [B0, :128], r5
108 vld1.32 {q12,q13}, [B0, :128], r5
109 vld1.32 {q14,q15}, [B0, :128]
110 vswp q1, q4
111 vswp q3, q6
112 add B0, B0, #224
113 vmul.f32 q0, q0, q8
114 vmul.f32 q2, q2, q10
115 vmul.f32 q1, q1, q12
116 vmul.f32 q3, q3, q14
117 vmla.f32 q0, q4, q9
118 vmla.f32 q2, q6, q11
119 vmla.f32 q1, q5, q13
120 vmla.f32 q3, q7, q15
121 vld1.32 {q4,q5}, [WINDOW], r4
122 vld1.32 {q6,q7}, [WINDOW], r4
123 vld1.32 {q8,q9}, [WINDOW], r4
124 vld1.32 {q10,q11}, [B0, :128], r5
125 vld1.32 {q12,q13}, [B0, :128], r5
126 vld1.32 {q14,q15}, [B0, :128], r5
127 vswp q5, q6
128 vswp q11, q12
129 vmla.f32 q0, q4, q10
130 vmla.f32 q2, q5, q11
131 vmla.f32 q1, q8, q14
132 vld1.32 {q4,q5}, [WINDOW]
133 vld1.32 {q10,q11}, [B0, :128]
134 add WINDOW, WINDOW, #96
135 sub B0, B0, #96
136 vmla.f32 q3, q4, q10
137 vmla.f32 q0, q6, q12
138 vmla.f32 q2, q7, q13
139 vmla.f32 q1, q9, q15
140 vmla.f32 q3, q5, q11
141 vld2.32 {q4,q5}, [SAMPLES]
142 vpadd.f32 d0, d0, d1
143 vpadd.f32 d4, d4, d5
144 vpadd.f32 d2, d2, d3
145 vpadd.f32 d6, d6, d7
146 vpadd.f32 d0, d0, d4
147 vpadd.f32 d1, d2, d6
148
149 vmov.i32 q1, #0x38000000
150 vmul.f32 q4, q0, q1
151 vst2.32 {q4,q5}, [SAMPLES]!
152
153 subs r3, r3, #1
154 bne 1b
155
156 mov r0, #0
157
158 vpop {q4-q7}
159 pop {r4-r5, pc}
160
161 NONEXEC_STACK