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
|
#include "filt.h"
//delay filtering
void filt_delay( uint8_t *buf, int buf_len )
{
//delay length
const int n=10;
int i=0;
uint32_t cycle=0;
uint32_t avg_i=0, avg_q=0;
uint32_t cyc_buffer_i[n],delay_i=0;
uint32_t cyc_buffer_q[n],delay_q=0;
uint8_t in1=0,in2=0,out1=0,out2=0;
memset( cyc_buffer_i, 0, n*sizeof(uint32_t) );
memset( cyc_buffer_q, 0, n*sizeof(uint32_t) );
//for (i=0; i<(buf_len-(n*2));i+=2)
for (i=0 ; i<(buf_len-1) ; i+=2 )
//for (i=0; i<1000; i+=2)
{
in1 = buf[i];
in2 = buf[i+1];
//average
avg_i += (uint32_t)in1;
avg_q += (uint32_t)in2;
delay_i = cyc_buffer_i[cycle];
delay_q = cyc_buffer_q[cycle];
cyc_buffer_i[cycle] = avg_i;
cyc_buffer_q[cycle] = avg_q;
cycle = cycle + 1;
if ( cycle >= n )
{
cycle = 0;
}
out1 = (avg_i - delay_i)/n;
out2 = (avg_q - delay_q)/n;
buf[i] = out1;
buf[i+1] = out2;
//printf("%d,avg=[%d,%d],delay=[%d,%d],in=[%d,%d],out=[%d,%d]\n",
// cycle, avg_i,avg_q,delay_i,delay_q,in1,in2,out1,out2);
}
}
|
