1 #include "FIRQ15.h"
2 #include <stdio.h>
3 #include "Error.h"
4
5 #define SNR_THRESHOLD 59
6
7 #define ABS_ERROR_Q15 ((q15_t)2)
8
9 #if defined(ARM_MATH_MVEI) && !defined(ARM_MATH_AUTOVECTORIZE)
10 static __ALIGNED(8) q15_t coeffArray[32];
11 #endif
12
checkInnerTail(q15_t * b)13 static void checkInnerTail(q15_t *b)
14 {
15 ASSERT_TRUE(b[0] == 0);
16 ASSERT_TRUE(b[1] == 0);
17 ASSERT_TRUE(b[2] == 0);
18 ASSERT_TRUE(b[3] == 0);
19 }
20
21 // Coef must be padded to a multiple of 8
22 #define FIRCOEFPADDING 3
23
test_fir_q15()24 void FIRQ15::test_fir_q15()
25 {
26
27
28 const int16_t *configp = configs.ptr();
29 q15_t *statep = state.ptr();
30 const q15_t *orgcoefsp = coefs.ptr();
31
32 const q15_t *coefsp;
33 const q15_t *inputp = inputs.ptr();
34 q15_t *outp = output.ptr();
35
36 unsigned long i;
37 #if defined(ARM_MATH_MVEI) && !defined(ARM_MATH_AUTOVECTORIZE)
38 int j;
39 int round;
40 #endif
41 int blockSize;
42 int numTaps;
43
44 /*
45
46 Python script is generating different tests with
47 different blockSize and numTaps.
48
49 We loop on those configs.
50
51 */
52 for(i=0; i < configs.nbSamples(); i += 2)
53 {
54 blockSize = configp[0];
55 numTaps = configp[1];
56
57 #if defined(ARM_MATH_MVEI) && !defined(ARM_MATH_AUTOVECTORIZE)
58 /* Copy coefficients and pad to zero
59 */
60 memset(coeffArray,127,32*sizeof(q15_t));
61 round = numTaps >> FIRCOEFPADDING;
62 if ((round << FIRCOEFPADDING) < numTaps)
63 {
64 round ++;
65 }
66 round = round<<FIRCOEFPADDING;
67 memset(coeffArray,0,round*sizeof(q15_t));
68
69 //printf("blockSize=%d, numTaps=%d, round=%d (%d)\n",blockSize,numTaps,round,round - numTaps);
70
71 for(j=0;j < numTaps; j++)
72 {
73 coeffArray[j] = orgcoefsp[j];
74 }
75
76 coefsp = coeffArray;
77 #else
78 coefsp = orgcoefsp;
79 #endif
80
81
82 /*
83
84 The filter is initialized with the coefs, blockSize and numTaps.
85
86 */
87 arm_fir_init_q15(&this->S,numTaps,coefsp,statep,blockSize);
88
89 /*
90
91 Input pointer is reset since the same input pattern is used
92
93 */
94 inputp = inputs.ptr();
95
96
97 /*
98
99 Python script is filtering a 2*blockSize number of samples.
100 We do the same filtering in two pass to check (indirectly that
101 the state management of the fir is working.)
102
103 */
104 arm_fir_q15(&this->S,inputp,outp,blockSize);
105 outp += blockSize;
106 checkInnerTail(outp);
107
108 inputp += blockSize;
109 arm_fir_q15(&this->S,inputp,outp,blockSize);
110 outp += blockSize;
111 checkInnerTail(outp);
112
113 configp += 2;
114 orgcoefsp += numTaps;
115
116
117 }
118
119 ASSERT_EMPTY_TAIL(output);
120
121 ASSERT_SNR(output,ref,(q15_t)SNR_THRESHOLD);
122
123 ASSERT_NEAR_EQ(output,ref,ABS_ERROR_Q15);
124
125 }
126
127
setUp(Testing::testID_t id,std::vector<Testing::param_t> & params,Client::PatternMgr * mgr)128 void FIRQ15::setUp(Testing::testID_t id,std::vector<Testing::param_t>& params,Client::PatternMgr *mgr)
129 {
130
131 (void)params;
132 switch(id)
133 {
134 case FIRQ15::TEST_FIR_Q15_1:
135
136 break;
137
138 }
139
140
141 inputs.reload(FIRQ15::FIRINPUTS_Q15_ID,mgr);
142 coefs.reload(FIRQ15::FIRCOEFS_Q15_ID,mgr);
143 configs.reload(FIRQ15::FIRCONFIGS_S16_ID,mgr);
144 ref.reload(FIRQ15::FIRREFS_Q15_ID,mgr);
145
146 output.create(ref.nbSamples(),FIRQ15::OUT_Q15_ID,mgr);
147 /* > Max blockSize + numTaps as generated by Python script
148 numTaps may be increased by 1 by Python script to force it to even values
149 */
150 state.create(3 * 41,FIRQ15::OUT_Q15_ID,mgr);
151 }
152
tearDown(Testing::testID_t id,Client::PatternMgr * mgr)153 void FIRQ15::tearDown(Testing::testID_t id,Client::PatternMgr *mgr)
154 {
155 (void)id;
156 output.dump(mgr);
157 }
158
