Subversion Repositories FuelGauge

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
2 mjames 1 
#include "ref.h"
2 
 
3 
void ref_cmplx_mag_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++ = sqrtf(pSrc[i] * pSrc[i] + pSrc[i+1] * pSrc[i+1]);
13 
        }
14 
}
15 
 
16 
void ref_cmplx_mag_q31(
17 
  q31_t * pSrc,
18 
  q31_t * pDst,
19 
  uint32_t numSamples)
20 
{
21 
        uint32_t i;
22 
        q31_t acc0,acc1,out;
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 
                out = acc0 + acc1;
29 
                *pDst++ = (q31_t)(sqrtf((float)out / 2147483648.0f) * 2147483648.0f);
30 
        }
31 
}
32 
 
33 
void ref_cmplx_mag_q15(
34 
  q15_t * pSrc,
35 
  q15_t * pDst,
36 
  uint32_t numSamples)
37 
{
38 
        uint32_t i;
39 
        q31_t acc0,acc1;
40 
        q15_t out;
41 
 
42 
        for(i=0;i<numSamples*2;i+=2)
43 
        {
44 
                acc0 = pSrc[i] * pSrc[i];
45 
                acc1 = pSrc[i+1] * pSrc[i+1];
46 
                out = (q15_t) (((q63_t) acc0 + acc1) >> 17);
47 
                *pDst++ = (q15_t)(sqrtf((float)out / 32768.0f) * 32768.0f);
48 
        }
49 
}