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

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

3G开发

开发平台：

Visual C++

fsk_demod_coh.cpp：源码内容
  1. //
  2. //  File = fsk_demod_coh.cpp
  3. //
  5. #include <stdlib.h>
  6. //#include <fstream>
  7. #include "parmfile.h"
  8. #include "fsk_demod_coh.h"
  9. #include "misdefs.h"
  10. #include "model_graph.h"
  11. extern ParmFile *ParmInput;
  12. extern int PassNumber;
  13. #ifdef _DEBUG
  14.   extern ofstream *DebugFile;
  15. #endif
  17. //======================================================
  19. FskCoherentDemod::FskCoherentDemod( char* instance_name,
  20.                                   PracSimModel* outer_model,
  21.                                   Signal< std::complex<float> >* in_sig,
  22.                                   Signal< std::complex<float> >* lo_ref_sig,
  23.                                   Signal< std::complex<float> >* hi_ref_sig,
  24.                                   Signal< bit_t >* symb_clock_in,
  25.                                   Signal< bit_t >* decis_out,
  26.                                   Signal< float >* lo_integ_sig,
  27.                                   Signal< float >* hi_integ_sig )
  28.                 :PracSimModel(instance_name,
  29.                               outer_model)
  30. {
  31.   MODEL_NAME(FskCoherentDemod);
  33.   ENABLE_MULTIRATE;
  35.   //-----------------------------------------
  36.   //  Read model config parms
  38.   OPEN_PARM_BLOCK;
  40.   GET_INT_PARM(Samps_Per_Symb);
  41.   GET_DOUBLE_PARM(Dly_To_Start);
  43.   //--------------------------------------
  44.   //  Connect input and output signals
  46.   Decis_Out = decis_out;
  47.   Symb_Clock_In = symb_clock_in;
  48.   In_Sig = in_sig;
  49.   Lo_Ref_Sig = lo_ref_sig;
  50.   Hi_Ref_Sig = hi_ref_sig;
  51.   Lo_Integ_Sig = lo_integ_sig;
  52.   Hi_Integ_Sig = hi_integ_sig;
  54.   MAKE_OUTPUT( Decis_Out );
  55.   MAKE_OUTPUT( Lo_Integ_Sig );
  56.   MAKE_OUTPUT( Hi_Integ_Sig );
  57.   MAKE_INPUT( Symb_Clock_In );
  58.   MAKE_INPUT( In_Sig );
  59.   MAKE_INPUT( Lo_Ref_Sig );
  60.   MAKE_INPUT( Hi_Ref_Sig );
  62.   double resamp_rate = 1.0/double(Samps_Per_Symb);
  63.   CHANGE_RATE( In_Sig, Decis_Out, resamp_rate );
  64.   CHANGE_RATE( Lo_Ref_Sig, Decis_Out, resamp_rate );
  65.   CHANGE_RATE( Hi_Ref_Sig, Decis_Out, resamp_rate );
  66.   CHANGE_RATE( Symb_Clock_In, Decis_Out, resamp_rate );
  67.   SAME_RATE( Lo_Ref_Sig, Lo_Integ_Sig );
  68.   SAME_RATE( Hi_Ref_Sig, Hi_Integ_Sig );
  70. }
  71. //==============================================
  72. FskCoherentDemod::~FskCoherentDemod( void ){ };
  73. //==============================================
  75. void FskCoherentDemod::Initialize(void)
  76. {
  77.   Block_Size = In_Sig->GetBlockSize();
  78.   Out_Samp_Intvl = Decis_Out->GetSampIntvl();
  80.   Lo_Integ_Val = 0.0;
  81.   Hi_Integ_Val = 0.0;
  82. }
  84. //============================================
  85. int FskCoherentDemod::Execute()
  86. {
  87.   bit_t *decis_out_ptr;
  88.   std::complex<float> *in_sig_ptr;
  89.   std::complex<float> *lo_ref_sig_ptr;
  90.   std::complex<float> *hi_ref_sig_ptr;
  91.   float *lo_integ_sig_ptr;
  92.   float *hi_integ_sig_ptr;
  93.   bit_t *symb_clock_in_ptr;
  94.   std::complex<float> in_val;
  95.   float lo_integ_val, hi_integ_val;
  96.   double max_val=0.0;
  97.   int is;
  98.   #ifdef _DEBUG
  99.     *DebugFile << "In FskCoherentDemod::Execute" << endl;
  100.   #endif
  102.   in_sig_ptr = GET_INPUT_PTR( In_Sig );
  103.   lo_ref_sig_ptr = GET_INPUT_PTR( Lo_Ref_Sig );
  104.   hi_ref_sig_ptr = GET_INPUT_PTR( Hi_Ref_Sig );
  105.   symb_clock_in_ptr = GET_INPUT_PTR( Symb_Clock_In );
  106.   decis_out_ptr = GET_OUTPUT_PTR( Decis_Out );
  107.   lo_integ_sig_ptr = GET_OUTPUT_PTR( Lo_Integ_Sig );
  108.   hi_integ_sig_ptr = GET_OUTPUT_PTR( Hi_Integ_Sig );
  110.   lo_integ_val = Lo_Integ_Val;
  111.   hi_integ_val = Hi_Integ_Val;
  113.   for (is=0; is<Block_Size; is++)
  114.     {
  115.     in_val = *in_sig_ptr++;
  117.     // correlate input signal against recovered carrier
  119.     lo_integ_val += std::real(in_val * std::conj(*lo_ref_sig_ptr++));
  120.     hi_integ_val += std::real(in_val * std::conj(*hi_ref_sig_ptr++));
  121.     *lo_integ_sig_ptr++ = lo_integ_val/float(Samps_Per_Symb);
  122.     *hi_integ_sig_ptr++ = hi_integ_val/float(Samps_Per_Symb);
  124.     if(*symb_clock_in_ptr != 0)
  125.       {
  126.       // time to make a decision
  128.       if(hi_integ_val > lo_integ_val )
  129.         {
  130.         *decis_out_ptr++ = 1;
  131.         }
  132.       else
  133.         {
  134.         *decis_out_ptr++ = 0;
  135.         }
  137.       lo_integ_val = 0.0;
  138.       hi_integ_val = 0.0;
  139.       }
  140.     symb_clock_in_ptr++;
  141.     }
  142.   Lo_Integ_Val = lo_integ_val;
  143.   Hi_Integ_Val = hi_integ_val;
  144.   return(_MES_AOK);
  145. }