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
|
#include "pv.h"
void unconvert(float *C, float *S, int N2, float *lastphase, float fundamental, float factor )
{
int i,
real,
imag,
amp,
freq;
float mag,
phase;
for ( i = 0; i <= N2; i++ ) {
imag = freq = ( real = amp = i<<1 ) + 1;
if ( i == N2 )
real = 1;
mag = C[amp];
lastphase[i] += C[freq] - i*fundamental;
phase = lastphase[i]*factor;
S[real] = mag*cos( phase );
if ( i != N2 )
S[imag] = -mag*sin( phase );
/*
if( i == 10 ) {
fprintf(stderr,"unconvert: amp: %f freq: %f funda %f fac %f\n", C[amp],C[freq],fundamental,factor);
}
*/
}
}
|