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

3G开发

开发平台:

Visual C++

  1. //
  2. //  File = vco_ce.cpp
  3. //
  4. #include <stdlib.h>
  5. //#include <fstream>
  6. #include "parmfile.h"
  7. #include "vco_ce.h"
  8. #include "misdefs.h"
  9. #include "model_graph.h"
  10. #include "typedefs.h"
  11. extern ParmFile *ParmInput;
  12. //using std::complex;
  13. //========================================================================
  14. // constructor
  15. ComplexVco::ComplexVco( char* instance_name,
  16.                               PracSimModel* outer_model,
  17.                               Signal<float>* in_sig,
  18.                               Signal< complex<float> >* out_sig)
  19.                 :PracSimModel(instance_name,
  20.                               outer_model)
  21. {
  22.   MODEL_NAME(ComplexVco);
  23.   //----------------------------------------
  24.   //  Read model config parms
  25.   OPEN_PARM_BLOCK;
  26.   GET_DOUBLE_PARM(Freq_Lo_Hz);
  27.   GET_DOUBLE_PARM(Freq_Hi_Hz);
  28.   GET_FLOAT_PARM(Lo_Control_Val);
  29.   GET_FLOAT_PARM(Hi_Control_Val);
  30.   //-------------------------------------
  31.   //  Connect input and output signals
  32.   In_Sig = in_sig;
  33.   Out_Sig = out_sig;
  34.   MAKE_OUTPUT( Out_Sig );
  35.   MAKE_INPUT( In_Sig );
  36.   //----------------------------------
  37.   //  Compute derived parameters
  38.   Hz_Per_Volt = (Freq_Hi_Hz - Freq_Lo_Hz)/(Hi_Control_Val - Lo_Control_Val);
  39. }
  40. //========================================================
  41. // destructor
  42. ComplexVco::~ComplexVco( void ){ };
  43. //===========================================
  44. void ComplexVco::Initialize(void)
  45. {
  46.   Block_Size = In_Sig->GetBlockSize();
  47.   Samp_Intvl = Out_Sig->GetSampIntvl();
  48.   Time = 0.0;
  49.   Cumul_Phase = 0.0;
  50. }
  51. //============================================
  52. int ComplexVco::Execute(void)
  53. {
  54.   float *in_sig_ptr, in_val;
  55.   complex<float> *out_sig_ptr;
  56.   double inst_freq, freq_lo_hz;
  57.   double cumul_phase;
  58.   double samp_intvl;
  59.   int is;
  60.   out_sig_ptr = GET_OUTPUT_PTR( Out_Sig );
  61.   in_sig_ptr = GET_INPUT_PTR( In_Sig );
  62.   freq_lo_hz = Freq_Lo_Hz;
  63.   samp_intvl = Samp_Intvl;
  64.   cumul_phase = Cumul_Phase;
  65.   for (is=0; is<Block_Size; is++)
  66.     {
  67.     in_val = *in_sig_ptr++;
  68.     inst_freq = freq_lo_hz + Hz_Per_Volt * (in_val - Lo_Control_Val);
  69.     cumul_phase = fmod(cumul_phase + samp_intvl * inst_freq, 1.0);
  70.     *out_sig_ptr++ = complex<float>( float(cos(TWO_PI * cumul_phase)),
  71.                                      float(sin(TWO_PI * cumul_phase)));
  72.     }
  73.   Cumul_Phase = cumul_phase;
  74.   return(_MES_AOK);
  75. }