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

3G开发

开发平台:

Visual C++

  1. //
  2. //  File = multi_tone_gen.cpp
  3. //
  4. #include <stdlib.h>
  5. #include <fstream>
  6. #include "multi_tone_gen.h"
  7. #include "misdefs.h"
  8. #include "parmfile.h"
  9. #include "model_graph.h"
  10. #include "sigstuff.h"
  11. #include "syst_graph.h"
  12. #include <iostream>
  13. using namespace std;
  14. extern int PassNumber;
  15. extern ParmFile *ParmInput;
  16. #ifdef _DEBUG
  17.   extern ofstream *DebugFile;
  18. #endif
  19. //======================================================
  20. MultipleToneGener::MultipleToneGener( 
  21.                      char* instance_name,
  22.                      PracSimModel* outer_model,
  23.                      Signal<float>* out_sig )
  24.                   :PracSimModel( instance_name,
  25.                                  outer_model )
  26. {
  27.   MODEL_NAME(MultipleToneGener);
  28.   Out_Sig = out_sig;
  29.   OPEN_PARM_BLOCK;
  30.   GET_INT_PARM(Num_Sines);
  31.   GET_DOUBLE_PARM(Holdoff_Delay);
  32.   Phase_In_Deg = new double[Num_Sines];
  33.   Phase_In_Rad = new double[Num_Sines];
  34.   Arg_Increm = new double[Num_Sines];
  35.   Base_Arg = new double[Num_Sines];
  36.   Freq_In_Hz = new double[Num_Sines];
  37.   Tone_Gain = new double[Num_Sines];
  38.   GET_DOUBLE_PARM_ARRAY(Phase_In_Deg,Num_Sines);
  39.   for(int idx=0; idx<Num_Sines; idx++) {
  40.     Phase_In_Rad[idx] = PI * Phase_In_Deg[idx] /180.0;
  41.   }
  42.   GET_DOUBLE_PARM_ARRAY(Freq_In_Hz, Num_Sines);
  43.   GET_DOUBLE_PARM_ARRAY(Tone_Gain, Num_Sines);
  44.   MAKE_OUTPUT(Out_Sig);
  45. }
  46. //====================================================
  47. MultipleToneGener::~MultipleToneGener( void)
  48. {
  49.   delete[] Phase_In_Deg;
  50.   delete[] Phase_In_Rad;
  51.   delete[] Arg_Increm;
  52.   delete[] Base_Arg;
  53.   delete[] Freq_In_Hz;
  54.   delete[] Tone_Gain;
  55. };
  56. //====================================================
  57. void MultipleToneGener::Initialize(void)
  58. {
  59. #ifdef _DEBUG
  60.   *DebugFile 
  61.       << "Now in MultipleToneGener::Initialize()" 
  62.       << endl;
  63. #endif
  64.   Block_Size = Out_Sig->GetBlockSize();
  65.   Samp_Intvl = Out_Sig->GetSampIntvl();
  66.   for(int isin=0; isin<Num_Sines; isin++) {
  67.     Arg_Increm[isin] = Freq_In_Hz[isin] * Samp_Intvl;
  68.     Base_Arg[isin] = (Phase_In_Deg[isin]/360.0) - 
  69.                      (Holdoff_Delay*Freq_In_Hz[isin]);
  70.   }
  71. }
  72. //====================================================
  73. int MultipleToneGener::Execute()
  74. {
  75.   int is, isin;
  76.   float *out_sig_ptr;
  77.   double out_samp;
  78.   double *base_arg, *arg_increm, *tone_gain;
  79.   //--------------------------------
  80.   //  Get pointer for output buffer
  81.   out_sig_ptr = GET_OUTPUT_PTR(Out_Sig);
  82.   base_arg = Base_Arg;
  83.   arg_increm = Arg_Increm;
  84.   tone_gain = Tone_Gain;
  85.   Out_Sig->SetValidBlockSize(Block_Size);
  86.   for (is=0; is<Block_Size; is++){
  87.     out_samp = 0;
  88.     for(isin=0; isin<Num_Sines; isin++){
  89.       out_samp += tone_gain[isin] * sin(TWO_PI * 
  90.          (base_arg[isin] + (is*arg_increm[isin])) );
  91.     }
  92.     if(is < Block_Size/2){
  93.       *out_sig_ptr++ = float(out_samp);
  94.     }
  95.     else {
  96.       *out_sig_ptr++ = float(out_samp);
  97.     }
  98.   }
  99.   for(isin=0; isin<Num_Sines; isin++){
  100.     Base_Arg[isin] = fmod(Base_Arg[isin] + 
  101.                      Block_Size*Arg_Increm[isin],1.0);
  102.   }
  103.   return(_MES_AOK);
  104. }