fsk_genie.cpp
上传用户:jtjnyq9001
上传日期:2014-11-21
资源大小:3974k
文件大小:3k
源码类别:

3G开发

开发平台:

Visual C++

  1. //
  2. //  File = fsk_genie.cpp
  3. //
  4. #include <stdlib.h>
  5. //#include <fstream>
  6. //#include <strstream>
  7. #include "parmfile.h"
  8. #include "misdefs.h"
  9. #include "fsk_genie.h"
  10. #include "model_graph.h"
  11. extern ParmFile *ParmInput;
  12. extern int PassNumber;
  13. //======================================================
  14. FskCarrierGenie::FskCarrierGenie( char* instance_name,
  15.                                 PracSimModel* outer_model,
  16.                                 Signal< std::complex<float> > *lo_ref_sig,
  17.                                 Signal< std::complex<float> > *hi_ref_sig )
  18.               :PracSimModel(instance_name,
  19.                             outer_model)
  20. {
  21.   MODEL_NAME(FskCarrierGenie);
  22.   //-----------------------------------
  23.   // Read configuration parameters
  24.   OPEN_PARM_BLOCK;
  25.   GET_DOUBLE_PARM(Carrier_Freq_Hz);
  26.   GET_DOUBLE_PARM(Freq_Offset_Hz);
  27.   GET_INT_PARM( Lo_Ref_Samp_Shift );
  28.   GET_INT_PARM( Hi_Ref_Samp_Shift );
  29.   //-----------------------------------
  30.   //  Signals
  31.   Lo_Ref_Sig = lo_ref_sig;
  32.   Hi_Ref_Sig = hi_ref_sig;
  33.   MAKE_OUTPUT( Lo_Ref_Sig );
  34.   MAKE_OUTPUT( Hi_Ref_Sig );
  35.   //----------------------------------
  36.   //  Compute derived parameters
  37.   Freq_Hi_Hz = Carrier_Freq_Hz + Freq_Offset_Hz;
  38.   Freq_Lo_Hz = Carrier_Freq_Hz - Freq_Offset_Hz;
  39.   return;
  40.   }
  41. //================================================
  42. FskCarrierGenie::~FskCarrierGenie( void ){ };
  43. //=======================================================
  44. void FskCarrierGenie::Initialize()
  45. {
  46.   //---------------------------------------
  47.   //  Initialize derived parameters
  48.   Block_Size = Lo_Ref_Sig->GetBlockSize();
  49.   Samp_Intvl = Lo_Ref_Sig->GetSampIntvl();
  50.   Cumul_Phase_Lo = Lo_Ref_Samp_Shift * Samp_Intvl * Freq_Lo_Hz;
  51.   Cumul_Phase_Hi = Hi_Ref_Samp_Shift * Samp_Intvl * Freq_Hi_Hz;
  52. }
  53. //=======================================
  54. int FskCarrierGenie::Execute()
  55. {
  56.   std::complex<float> *lo_ref_sig_ptr;
  57.   std::complex<float> *hi_ref_sig_ptr;
  58.   double cumul_phase_lo, cumul_phase_hi;
  59.   double freq_lo_hz, freq_hi_hz;
  60.   double samp_intvl;
  61.   int is;
  62.   lo_ref_sig_ptr = GET_OUTPUT_PTR( Lo_Ref_Sig );
  63.   hi_ref_sig_ptr = GET_OUTPUT_PTR( Hi_Ref_Sig );
  64.   cumul_phase_lo = Cumul_Phase_Lo;
  65.   cumul_phase_hi = Cumul_Phase_Hi;
  66.   freq_lo_hz = Freq_Lo_Hz;
  67.   freq_hi_hz = Freq_Hi_Hz;
  68.   samp_intvl = Samp_Intvl;
  69.   for(is=0; is<Block_Size; is++)
  70.     {
  71.     cumul_phase_lo = fmod(cumul_phase_lo + samp_intvl * freq_lo_hz, 1.0);
  72.     cumul_phase_hi = fmod(cumul_phase_hi + samp_intvl * freq_hi_hz, 1.0);
  73.     *lo_ref_sig_ptr++ = std::complex<float>( float(cos(TWO_PI * cumul_phase_lo)),
  74.                                              float(sin(TWO_PI * cumul_phase_lo)));
  75.     *hi_ref_sig_ptr++ = std::complex<float>( float(cos(TWO_PI * cumul_phase_hi)),
  76.                                              float(sin(TWO_PI * cumul_phase_hi)));
  77.     }
  78.   Cumul_Phase_Lo = cumul_phase_lo;
  79.   Cumul_Phase_Hi = cumul_phase_hi;
  80.   return(_MES_AOK);
  81. }