Details | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
2 | mjames | 1 | #include "ref.h" |
2 | |||
3 | void ref_cmplx_mag_squared_f32( |
||
4 | float32_t * pSrc, |
||
5 | float32_t * pDst, |
||
6 | uint32_t numSamples) |
||
7 | { |
||
8 | uint32_t i; |
||
9 | |||
10 | for(i=0;i<numSamples*2;i+=2) |
||
11 | { |
||
12 | *pDst++ = pSrc[i] * pSrc[i] + pSrc[i+1] * pSrc[i+1]; |
||
13 | } |
||
14 | } |
||
15 | |||
16 | void ref_cmplx_mag_squared_q31( |
||
17 | q31_t * pSrc, |
||
18 | q31_t * pDst, |
||
19 | uint32_t numSamples) |
||
20 | { |
||
21 | uint32_t i; |
||
22 | q31_t acc0,acc1; |
||
23 | |||
24 | for(i=0;i<numSamples*2;i+=2) |
||
25 | { |
||
26 | acc0 = (q31_t)(((q63_t)pSrc[i] * pSrc[i]) >> 33); |
||
27 | acc1 = (q31_t)(((q63_t)pSrc[i+1] * pSrc[i+1]) >> 33); |
||
28 | *pDst++ = acc0 + acc1; |
||
29 | } |
||
30 | } |
||
31 | |||
32 | void ref_cmplx_mag_squared_q15( |
||
33 | q15_t * pSrc, |
||
34 | q15_t * pDst, |
||
35 | uint32_t numSamples) |
||
36 | { |
||
37 | uint32_t i; |
||
38 | q31_t acc0,acc1; |
||
39 | |||
40 | for(i=0;i<numSamples*2;i+=2) |
||
41 | { |
||
42 | acc0 = pSrc[i] * pSrc[i]; |
||
43 | acc1 = pSrc[i+1] * pSrc[i+1]; |
||
44 | *pDst++ = (q15_t) (((q63_t) acc0 + acc1) >> 17); |
||
45 | } |
||
46 | } |