1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
|
@/*
@ ** Copyright 2003-2010, VisualOn, Inc.
@ **
@ ** Licensed under the Apache License, Version 2.0 (the "License");
@ ** you may not use this file except in compliance with the License.
@ ** You may obtain a copy of the License at
@ **
@ ** http://www.apache.org/licenses/LICENSE-2.0
@ **
@ ** Unless required by applicable law or agreed to in writing, software
@ ** distributed under the License is distributed on an "AS IS" BASIS,
@ ** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
@ ** See the License for the specific language governing permissions and
@ ** limitations under the License.
@ */
@
@**********************************************************************/
@void Filt_6k_7k(
@ Word16 signal[], /* input: signal */
@ Word16 lg, /* input: length of input */
@ Word16 mem[] /* in/out: memory (size=30) */
@)
@***********************************************************************
@ r0 --- signal[]
@ r1 --- lg
@ r2 --- mem[]
.section .text
.global Filt_6k_7k_asm
.extern fir_6k_7k
Filt_6k_7k_asm:
STMFD r13!, {r0 - r12, r14}
SUB r13, r13, #240 @ x[L_SUBFR16k + (L_FIR - 1)]
MOV r8, r0 @ copy signal[] address
MOV r5, r2 @ copy mem[] address
MOV r0, r2
MOV r1, r13
VLD1.S16 {D0, D1, D2, D3}, [r0]!
VLD1.S16 {D4, D5, D6, D7}, [r0]!
VST1.S16 {D0, D1, D2, D3}, [r1]!
VST1.S16 {D4, D5, D6}, [r1]!
VST1.S16 D7[0], [r1]!
VST1.S16 D7[1], [r1]!
ADR r3, Lable1 @ get fir_7k address
LDR r10, [r3]
ADD r10, r3
MOV r3, r8 @ change myMemCopy to Copy, due to Copy will change r3 content
ADD r6, r13, #60 @ get x[L_FIR - 1] address
MOV r7, r3 @ get signal[i]
@for (i = lg - 1@ i >= 0@ i--)
@{
@ x[i + L_FIR - 1] = signal[i] >> 2@
@}
VLD1.S16 {Q0, Q1}, [r7]! @ signal[0] ~ signal[15]
VLD1.S16 {Q2, Q3}, [r7]! @ signal[16] ~ signal[31]
VLD1.S16 {Q4, Q5}, [r7]! @ signal[32] ~ signal[47]
VLD1.S16 {Q6, Q7}, [r7]! @ signal[48] ~ signal[63]
VLD1.S16 {Q8, Q9}, [r7]! @ signal[64] ~ signal[79]
VSHR.S16 Q10, Q0, #2
VSHR.S16 Q11, Q1, #2
VSHR.S16 Q12, Q2, #2
VSHR.S16 Q13, Q3, #2
VST1.S16 {Q10, Q11}, [r6]!
VSHR.S16 Q0, Q4, #2
VSHR.S16 Q1, Q5, #2
VSHR.S16 Q10, Q6, #2
VSHR.S16 Q11, Q7, #2
VSHR.S16 Q2, Q8, #2
VSHR.S16 Q3, Q9, #2
VST1.S16 {Q12, Q13}, [r6]!
VST1.S16 {Q0, Q1}, [r6]!
VST1.S16 {Q10, Q11}, [r6]!
VST1.S16 {Q2, Q3}, [r6]!
MOV r12, r5
@STR r5, [sp, #-4] @ PUSH r5 to stack
@ not use registers: r4, r10, r12, r14, r5
MOV r4, r13
MOV r5, #0 @ i = 0
@ r4 --- x[i], r10 ---- fir_6k_7k
VLD1.S16 {Q0, Q1}, [r10]! @fir_6k_7k[0] ~ fir_6k_7k[15]
VLD1.S16 {Q2, Q3}, [r10]! @fir_6k_7k[16] ~ fir_6k_7k[31]
VMOV.S16 D7[3], r5 @set fir_6k_7K = 0
VLD1.S16 {Q4, Q5}, [r4]! @x[0] ~ x[15]
VLD1.S16 {Q6, Q7}, [r4]! @x[16] ~ X[31]
VLD1.S16 {Q8}, [r4]!
VMOV.S16 Q15, #0
LOOP_6K7K:
VMULL.S16 Q9,D8,D0[0]
VMULL.S16 Q10,D9,D1[0]
VMULL.S16 Q11,D9,D0[0]
VMULL.S16 Q12,D10,D1[0]
VEXT.8 Q4,Q4,Q5,#2
VMLAL.S16 Q9,D10,D2[0]
VMLAL.S16 Q10,D11,D3[0]
VMLAL.S16 Q11,D11,D2[0]
VMLAL.S16 Q12,D12,D3[0]
VEXT.8 Q5,Q5,Q6,#2
VMLAL.S16 Q9,D12,D4[0]
VMLAL.S16 Q10,D13,D5[0]
VMLAL.S16 Q11,D13,D4[0]
VMLAL.S16 Q12,D14,D5[0]
VEXT.8 Q6,Q6,Q7,#2
VMLAL.S16 Q9,D14,D6[0]
VMLAL.S16 Q10,D15,D7[0]
VMLAL.S16 Q11,D15,D6[0]
VMLAL.S16 Q12,D16,D7[0]
VEXT.8 Q7,Q7,Q8,#2
VMLAL.S16 Q9,D8,D0[1]
VMLAL.S16 Q10,D9,D1[1]
VEXT.8 Q8,Q8,Q15,#2
VMLAL.S16 Q11,D9,D0[1]
VMLAL.S16 Q12,D10,D1[1]
VEXT.8 Q4,Q4,Q5,#2
VMLAL.S16 Q9,D10,D2[1]
VMLAL.S16 Q10,D11,D3[1]
VMLAL.S16 Q11,D11,D2[1]
VMLAL.S16 Q12,D12,D3[1]
VEXT.8 Q5,Q5,Q6,#2
VMLAL.S16 Q9,D12,D4[1]
VMLAL.S16 Q10,D13,D5[1]
VMLAL.S16 Q11,D13,D4[1]
VMLAL.S16 Q12,D14,D5[1]
VEXT.8 Q6,Q6,Q7,#2
VMLAL.S16 Q9,D14,D6[1]
VMLAL.S16 Q10,D15,D7[1]
VMLAL.S16 Q11,D15,D6[1]
VMLAL.S16 Q12,D16,D7[1]
VEXT.8 Q7,Q7,Q8,#2
VMLAL.S16 Q9,D8,D0[2]
VMLAL.S16 Q10,D9,D1[2]
VEXT.8 Q8,Q8,Q15,#2
VMLAL.S16 Q11,D9,D0[2]
VMLAL.S16 Q12,D10,D1[2]
VEXT.8 Q4,Q4,Q5,#2
VMLAL.S16 Q9,D10,D2[2]
VMLAL.S16 Q10,D11,D3[2]
VMLAL.S16 Q11,D11,D2[2]
VMLAL.S16 Q12,D12,D3[2]
VEXT.8 Q5,Q5,Q6,#2
VMLAL.S16 Q9,D12,D4[2]
VMLAL.S16 Q10,D13,D5[2]
VMLAL.S16 Q11,D13,D4[2]
VMLAL.S16 Q12,D14,D5[2]
VEXT.8 Q6,Q6,Q7,#2
VMLAL.S16 Q9,D14,D6[2]
VMLAL.S16 Q10,D15,D7[2]
VMLAL.S16 Q11,D15,D6[2]
VMLAL.S16 Q12,D16,D7[2]
VEXT.8 Q7,Q7,Q8,#2
VMLAL.S16 Q9,D8,D0[3]
VMLAL.S16 Q10,D9,D1[3]
VEXT.8 Q8,Q8,Q15,#2
VMLAL.S16 Q11,D9,D0[3]
VMLAL.S16 Q12,D10,D1[3]
VEXT.8 Q4,Q4,Q5,#2
VMLAL.S16 Q9,D10,D2[3]
VMLAL.S16 Q10,D11,D3[3]
VMLAL.S16 Q11,D11,D2[3]
VMLAL.S16 Q12,D12,D3[3]
VEXT.8 Q5,Q5,Q6,#2
VMLAL.S16 Q9,D12,D4[3]
VMLAL.S16 Q10,D13,D5[3]
VMLAL.S16 Q11,D13,D4[3]
VMLAL.S16 Q12,D14,D5[3]
VEXT.8 Q6,Q6,Q7,#2
VMLAL.S16 Q9,D14,D6[3]
VMLAL.S16 Q10,D15,D7[3]
VMLAL.S16 Q11,D15,D6[3]
VMLAL.S16 Q12,D16,D7[3]
VEXT.8 Q7,Q7,Q8,#2
VMOV.S16 D8,D9
VEXT.8 Q8,Q8,Q15,#2
VMOV.S16 D9,D10
VADD.S32 Q9,Q9,Q10
VMOV.S16 D10,D11
VMOV.S16 D11,D12
VADD.S32 Q11,Q11,Q12
VMOV.S16 D12,D13
VQRSHRN.S32 D28,Q9,#15
VMOV.S16 D13,D14
VMOV.S16 D14,D15
VQRSHRN.S32 D29,Q11,#15
VMOV.S16 D15,D16
VLD1.S16 {Q8},[r4]!
ADD r5, r5, #8
CMP r5, #80
VST1.S16 {D28,D29},[r3]!
BLT LOOP_6K7K
ADD r0, r13, #160 @x + lg
MOV r1, r12
@LDR r1, [sp, #-4] @mem address
VLD1.S16 {D0, D1, D2, D3}, [r0]!
VLD1.S16 {D4, D5, D6, D7}, [r0]!
VST1.S16 {D0, D1, D2, D3}, [r1]!
VST1.S16 {D4, D5, D6}, [r1]!
VST1.S16 D7[0], [r1]!
VST1.S16 D7[1], [r1]!
Filt_6k_7k_end:
ADD r13, r13, #240
LDMFD r13!, {r0 - r12, r15}
Lable1:
.word fir_6k_7k-Lable1
@ENDFUNC
.END
|