Changeset 9711
- Timestamp:
- 10/04/08 12:31:50
- Files:
Legend:
- Unmodified
- Added
- Removed
- Modified
- Copied
- Moved
gnuradio/branches/developers/n4hy/pfb_fbs/gnuradio-core/src/lib/general/gr_fmdet_cf.cc
r9710 r9711 44 44 gr_make_io_signature (1, 1, sizeof (gr_complex)), 45 45 gr_make_io_signature (1, 1, sizeof (float))), 46 d_S 0(0),d_S1(0),d_S2(0),46 d_S1(0),d_S2(0), 47 47 d_S3(0),d_S4(0),d_twelveDeltaT(12.0/samplerate) 48 48 … … 62 62 int size = noutput_items; 63 63 64 gr_complex Sdot ;64 gr_complex Sdot,S0,S1=d_S1,S2=d_S2,S3=d_S3,S4=d_S4; 65 65 66 66 while (size-- > 0) { 67 d_S0=*iptr++;67 S0=*iptr++; 68 68 69 69 Sdot = gr_complex(d_twelveDeltaT* 70 (- d_S0.real() + 8.0*d_S1.real() - 8.0*d_S3.real() + d_S4.real()),70 (-S0.real() + 8.0*S1.real() - 8.0*S3.real() + S4.real()), 71 71 d_twelveDeltaT* 72 (- d_S0.imag() + 8.0*d_S1.imag() - 8.0*d_S3.imag() + d_S4.imag()));73 d_freq = ( d_S2.real()*Sdot.imag()-d_S2.imag()*Sdot.real())/74 ( d_S2.real()*d_S2.real()+d_S2.imag()*d_S2.imag());72 (-S0.imag() + 8.0*S1.imag() - 8.0*S3.imag() + S4.imag())); 73 d_freq = (S2.real()*Sdot.imag()-S2.imag()*Sdot.real())/ 74 (S2.real()*S2.real()+S2.imag()*S2.imag()); 75 75 76 d_S4=d_S3;77 d_S3=d_S2;78 d_S2=d_S1;79 d_S1=d_S0;76 S4=S3; 77 S3=S2; 78 S2=S1; 79 S1=S0; 80 80 81 81 82 82 *optr++ = d_freq; 83 83 } 84 d_S1=S1; 85 d_S2=S2; 86 d_S3=S3; 87 d_S4=S4; 84 88 return noutput_items; 85 89 } gnuradio/branches/developers/n4hy/pfb_fbs/gnuradio-core/src/lib/general/gr_fmdet_cf.h
r9710 r9711 45 45 friend gr_fmdet_cf_sptr gr_make_fmdet_cf (float samplerate); 46 46 47 gr_complex d_S 0,d_S1,d_S2,d_S3,d_S4;47 gr_complex d_S1,d_S2,d_S3,d_S4; 48 48 float d_freq,d_twelveDeltaT; 49 49 gr_fmdet_cf (float samplerate);
