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

3G开发

开发平台:

Visual C++

  1. //
  2. //  File = mpskidealmod.cpp
  3. //
  4. #include <stdlib.h>
  5. //#include <fstream.>
  6. #include "parmfile.h"
  7. #include "mpskidealmod.h"
  8. #include "model_error.h"
  9. #include "misdefs.h"
  10. #include "model_graph.h"
  11. #include "typedefs.h"
  12. extern ParmFile *ParmInput;
  13. #ifdef _DEBUG
  14.   extern ofstream *DebugFile;
  15. #endif
  16. //======================================================
  17. MpskIdealModulator::MpskIdealModulator( char* instance_name,
  18.                               PracSimModel* outer_model,
  19.                               Signal<byte_t>* in_sig,
  20.                               Signal< std::complex<float> >* cmpx_out_sig,
  21.                               Signal<bit_t>* symb_clock_out,
  22.                               Signal<float>* mag_out_sig,
  23.                               Signal<float>* phase_out_sig )
  24.                 :PracSimModel(instance_name,
  25.                               outer_model)
  26. {
  27.   MODEL_NAME(MpskIdealModulator);
  28.   ENABLE_MULTIRATE;
  29.   //----------------------------------------
  30.   //  Read model config parms
  31.   OPEN_PARM_BLOCK;
  32.   GET_INT_PARM(Bits_Per_Symb);
  33.   GET_INT_PARM(Samps_Per_Symb);
  34.   GET_DOUBLE_PARM(Phase_Unbal);
  35.   GET_DOUBLE_PARM(Amp_Unbal);
  36.   GET_DOUBLE_PARM(Symb_Duration);
  37.   //-------------------------------------
  38.   //  Connect input and output signals
  39.   In_Sig = in_sig;
  40.   Cmpx_Out_Sig = cmpx_out_sig;
  41.   Symb_Clock_Out = symb_clock_out;
  42.   Mag_Out_Sig = mag_out_sig;
  43.   Phase_Out_Sig = phase_out_sig;
  44.   MAKE_OUTPUT( Cmpx_Out_Sig );
  45.   MAKE_OUTPUT( Mag_Out_Sig );
  46.   MAKE_OUTPUT( Phase_Out_Sig );
  47.   MAKE_OUTPUT( Symb_Clock_Out );
  48.   MAKE_INPUT( In_Sig );
  49.   // one sample per symbol from input
  50.   double resamp_rate = double(Samps_Per_Symb);
  51.   SET_SAMP_INTVL( In_Sig, Symb_Duration);
  52.   CHANGE_RATE( In_Sig, Symb_Clock_Out, resamp_rate );
  53.   CHANGE_RATE( In_Sig, Cmpx_Out_Sig, resamp_rate );
  54.   CHANGE_RATE( In_Sig, Mag_Out_Sig, resamp_rate );
  55.   CHANGE_RATE( In_Sig, Phase_Out_Sig, resamp_rate );
  56.   //-----------------------------------------
  57.   // Set up derived parms
  58.   double phase_unbal_rad = PI * Phase_Unbal / 180.0;
  59.   Real_Unbal = float(cos(phase_unbal_rad) * Amp_Unbal);
  60.   Imag_Unbal = float(sin(phase_unbal_rad) * Amp_Unbal);
  61.   Num_Diff_Symbs = 1;
  62.   for(int i=1; i<=Bits_Per_Symb; i++)
  63.     Num_Diff_Symbs *=2;
  64.   //------------------------------------------------------------
  65.   //  generate tables of I & Q values for desired constellation
  66.   //  (someday add capability to read intables from parm file)
  67.   //  (this so we can do Gray coding, etc.)
  68.   double angle;
  69.   double magnitude = 1.0;
  70.   float work;
  71.   I_Compon = new float[Num_Diff_Symbs];
  72.   Q_Compon = new float[Num_Diff_Symbs];
  73.   for(int isymb=0; isymb<Num_Diff_Symbs; isymb++)
  74.     {
  75.     angle = isymb * TWO_PI/double(Num_Diff_Symbs);
  76.     work = float(magnitude * cos(angle));
  77.     I_Compon[isymb] = work;
  78.     work = float(magnitude * sin(angle));
  79.     Q_Compon[isymb] = work;
  80.     }
  81. }
  82. //===========================================
  83. MpskIdealModulator::~MpskIdealModulator( void ){ };
  84. //===========================================
  85. void MpskIdealModulator::Initialize(void)
  86. {
  87.   In_Block_Size = In_Sig->GetBlockSize();
  88.   Out_Block_Size = Cmpx_Out_Sig->GetBlockSize();
  89. }
  90. //============================================
  91. int MpskIdealModulator::Execute(void)
  92. {
  93.   byte_t *in_sig_ptr;
  94.   float i_out, q_out;
  95.   float i_comp, q_comp;
  96.   float phase_out, mag_out;
  97.   float *phase_out_sig_ptr, *mag_out_sig_ptr;
  98.   double real_unbal, imag_unbal;
  99.   std::complex<float> *cmpx_out_sig_ptr;
  100.   std::complex<float> cmpx_out;
  101.   bit_t *symb_clock_out_ptr;
  102.   int is;
  103.   #ifdef _DEBUG
  104.     *DebugFile << "In MpskIdealModulator::Execute" << endl;
  105.   #endif
  106.   cmpx_out_sig_ptr = GET_OUTPUT_PTR( Cmpx_Out_Sig );
  107.   phase_out_sig_ptr = GET_OUTPUT_PTR( Phase_Out_Sig );
  108.   mag_out_sig_ptr = GET_OUTPUT_PTR( Mag_Out_Sig );
  109.   symb_clock_out_ptr = GET_OUTPUT_PTR( Symb_Clock_Out );
  110.   in_sig_ptr = GET_INPUT_PTR( In_Sig );
  111.   real_unbal = Real_Unbal;
  112.   imag_unbal = Imag_Unbal;
  113.   //cout << "real_unbal = " << real_unbal << endl;
  114.   //cout << "imag_unbal = " << imag_unbal << endl;
  115.   for (is=0; is<In_Block_Size; is++)
  116.     {
  117.     //  get input symbol and split into ideal I & Q components
  118.     i_comp = I_Compon[*in_sig_ptr];
  119.     q_comp = Q_Compon[*in_sig_ptr];
  120.     in_sig_ptr++;
  121.     i_out = i_comp - (imag_unbal * q_comp);
  122.     q_out = real_unbal * q_comp;
  123.     cmpx_out = std::complex<float>( i_out, q_out);
  124.     phase_out = 180.0 * std::arg<float>(cmpx_out)/PI;
  125.     mag_out = sqrt(i_out*i_out + q_out*q_out);
  126.     for(int isamp=0; isamp<Samps_Per_Symb; isamp++)
  127.       {
  128.       *cmpx_out_sig_ptr++ = cmpx_out;
  129.       *phase_out_sig_ptr++ = phase_out;
  130.       *mag_out_sig_ptr++ = mag_out;
  131.       if(isamp == (Samps_Per_Symb-1))
  132.         *symb_clock_out_ptr++ = 1;
  133.       else
  134.         *symb_clock_out_ptr++ = 0;
  135.       }
  136.     }
  137.   return(_MES_AOK);
  138. }