开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 通讯/手机编程 > 3G开发 > 查看源码
fsk_2tone_bp.cpp
资源名称：simulation_wireless_c++.rar　[点击查看]
上传用户：jtjnyq9001
上传日期：2014-11-21
资源大小：3974k
文件大小：3k
源码类别：

3G开发

开发平台：

Visual C++

fsk_2tone_bp.cpp：源码内容
  1. //
  2. //  File = fsk_2tone_bp.cpp
  3. //
  5. #include <stdlib.h>
  6. //#include <fstream>
  7. #include "parmfile.h"
  8. #include "fsk_2tone_bp.h"
  9. #include "misdefs.h"
  10. #include "model_graph.h"
  11. #include "typedefs.h"
  12. //#include "cmpxsig.h"
  13. extern ParmFile *ParmInput;
  15. //========================================================================
  16. // constructor
  18. FskTwoToneModulator_Bp::FskTwoToneModulator_Bp( char* instance_name,
  19.                               PracSimModel* outer_model,
  20.                               Signal<float>* in_sig,
  21.                               Signal<float>* out_sig)
  22.                 :PracSimModel(instance_name,
  23.                               outer_model)
  24. {
  25.   MODEL_NAME(FskTwoToneModulator_Bp);
  27.   //----------------------------------------
  28.   //  Read model config parms
  30.   OPEN_PARM_BLOCK;
  32.   GET_DOUBLE_PARM(Freq_Lo_Hz);
  33.   GET_DOUBLE_PARM(Freq_Hi_Hz);
  34.   GET_FLOAT_PARM(Lo_Control_Val);
  35.   GET_FLOAT_PARM(Hi_Control_Val);
  36.   GET_DOUBLE_PARM(Full_Scale_Output_Level);
  38.   //-------------------------------------
  39.   //  Connect input and output signals
  41.   In_Sig = in_sig;
  42.   Out_Sig = out_sig;
  44.   MAKE_OUTPUT( Out_Sig );
  45.   MAKE_INPUT( In_Sig );
  47.   //----------------------------------
  48.   //  Compute derived parameters
  50.   Slope_Hi_On = Full_Scale_Output_Level/(Hi_Control_Val - Lo_Control_Val);
  51.   Slope_Lo_On = -Slope_Hi_On;
  53. }
  54. //========================================================
  55. // destructor
  57. FskTwoToneModulator_Bp::~FskTwoToneModulator_Bp( void ){ };
  60. //===========================================
  62. void FskTwoToneModulator_Bp::Initialize(void)
  63. {
  64.   Block_Size = In_Sig->GetBlockSize();
  65.   Samp_Intvl = Out_Sig->GetSampIntvl();
  66.   Time = 0.0;
  67.   Cumul_Phase_Lo = 0.0;
  68.   Cumul_Phase_Hi = 0.0;
  69. }
  71. //============================================
  72. int FskTwoToneModulator_Bp::Execute(void)
  73. {
  74.   float *in_sig_ptr, in_val;
  75.   float *out_sig_ptr;
  76.   double cumul_phase_lo, cumul_phase_hi;
  77.   double freq_hi_hz, freq_lo_hz;
  78.   double lo_control_val, hi_control_val;
  79.   double gain_hi, gain_lo;
  80.   double samp_intvl;
  81.   int is;
  83.   out_sig_ptr = GET_OUTPUT_PTR( Out_Sig );
  85.   in_sig_ptr = GET_INPUT_PTR( In_Sig );
  87.   //omega_hi = Freq_Hi_Rad;
  88.   freq_lo_hz = Freq_Lo_Hz;
  89.   freq_hi_hz = Freq_Hi_Hz;
  90.   samp_intvl = Samp_Intvl;
  91.   cumul_phase_lo = Cumul_Phase_Lo;
  92.   cumul_phase_hi = Cumul_Phase_Hi;
  93.   lo_control_val = Lo_Control_Val;
  94.   hi_control_val = Hi_Control_Val;
  96.   for (is=0; is<Block_Size; is++)
  97.     {
  98.     in_val = *in_sig_ptr++;
  100.     //inst_freq = freq_lo_hz + Hz_Per_Volt * (in_val - Lo_Control_Val);
  101.     gain_hi = Slope_Hi_On * (in_val - Lo_Control_Val);
  102.     gain_lo = Slope_Lo_On * (in_val - Hi_Control_Val);
  104.     cumul_phase_lo = fmod(cumul_phase_lo + samp_intvl * freq_lo_hz, 1.0);
  105.     cumul_phase_hi = fmod(cumul_phase_hi + samp_intvl * freq_hi_hz, 1.0);
  107.     *out_sig_ptr++ = float(gain_lo * sin(TWO_PI * cumul_phase_lo)
  108.                      + gain_hi * sin(TWO_PI * cumul_phase_hi));
  109.     }
  110.   Cumul_Phase_Lo = cumul_phase_lo;
  111.   Cumul_Phase_Hi = cumul_phase_hi;
  112.   return(_MES_AOK);
  113. }