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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 通讯/手机编程 > MTK > 查看源码
sp_coef_cal.cpp
资源名称：Maui_META_src_v5.0808.0.zip　[点击查看]
上传用户：gelin96
上传日期：2017-01-08
资源大小：20993k
文件大小：51k
源码类别：

MTK

开发平台：

C++ Builder

sp_coef_cal.cpp：源码内容
  1. /*****************************************************************************
  2. *  Copyright Statement:
  3. *  --------------------
  4. *  This software is protected by Copyright and the information contained
  5. *  herein is confidential. The software may not be copied and the information
  6. *  contained herein may not be used or disclosed except with the written
  7. *  permission of MediaTek Inc. (C) 2005
  8. *
  9. *  BY OPENING THIS FILE, BUYER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  10. *  THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
  11. *  RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO BUYER ON
  12. *  AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
  13. *  EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
  14. *  MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
  15. *  NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
  16. *  SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
  17. *  SUPPLIED WITH THE MEDIATEK SOFTWARE, AND BUYER AGREES TO LOOK ONLY TO SUCH
  18. *  THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. MEDIATEK SHALL ALSO
  19. *  NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE RELEASES MADE TO BUYER'S
  20. *  SPECIFICATION OR TO CONFORM TO A PARTICULAR STANDARD OR OPEN FORUM.
  21. *
  22. *  BUYER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND CUMULATIVE
  23. *  LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
  24. *  AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
  25. *  OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY BUYER TO
  26. *  MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
  27. *
  28. *  THE TRANSACTION CONTEMPLATED HEREUNDER SHALL BE CONSTRUED IN ACCORDANCE
  29. *  WITH THE LAWS OF THE STATE OF CALIFORNIA, USA, EXCLUDING ITS CONFLICT OF
  30. *  LAWS PRINCIPLES.  ANY DISPUTES, CONTROVERSIES OR CLAIMS ARISING THEREOF AND
  31. *  RELATED THERETO SHALL BE SETTLED BY ARBITRATION IN SAN FRANCISCO, CA, UNDER
  32. *  THE RULES OF THE INTERNATIONAL CHAMBER OF COMMERCE (ICC).
  33. *
  34. *****************************************************************************/
  35. /*****************************************************************************
  36.  *
  37.  * Filename:
  38.  * ---------
  39.  *   sp_coef_cal.cpp
  40.  *
  41.  * Project:
  42.  * --------
  43.  *   Maui META APP
  44.  *
  45.  * Description:
  46.  * ------------
  47.  *  Acoustic FIR coefficient calibration source
  48.  *
  49.  * Author:
  50.  * -------
  51.  *  Andy Ueng (mtk00490)
  52.  *
  53.  *============================================================================
  54.  *             HISTORY
  55.  * Below this line, this part is controlled by PVCS VM. DO NOT MODIFY!!
  56.  *------------------------------------------------------------------------------
  57.  * $Revision$
  58.  * $Modtime$
  59.  * $Log$
  60.  * 
  61.  *------------------------------------------------------------------------------
  62.  * Upper this line, this part is controlled by PVCS VM. DO NOT MODIFY!!
  63.  *============================================================================
  64.  ****************************************************************************/
  65. #include <IniFiles.hpp>
  66. #include <stdio.h>
  67. #include <math.h>
  69. #pragma hdrstop
  71. #include "misc.h"
  72. #include "meta_utils.h"
  73. #include "man_active.h"
  74. #include "sp_coef.h"
  75. #include "sp_coef_cal.h"
  77. #include "traceconversion.h"
  79. #define LOG_FLOOR  0.000001
  82. //===========================================================================
  84. static CSPCOEFCAL*  sp_coef_cal_ptr;
  85. static bool g_bIsRunning;
  86. //===========================================================================
  88. //===========================================================================
  89. CSPCOEFCAL::CSPCOEFCAL( void )
  90. {
  91.    g_bIsRunning = false;
  92.    ConfirmCallback = 0;
  94.    CoefCalBufSize = 0;
  95.    CoefCalBuf = 0;
  96. }
  98. //---------------------------------------------------------------------------
  99. CSPCOEFCAL::~CSPCOEFCAL( )
  100. {
  101.    g_bIsRunning = false;
  102.    ConfirmCallback = 0;
  103.    if(CoefCalBuf)
  104.    {
  105.       delete [] CoefCalBuf;
  106.       CoefCalBuf = NULL;
  107.    }
  108.    AFT_close();
  109.    
  110. }
  112. //---------------------------------------------------------------------------
  113. void  CSPCOEFCAL::REQ_Finish( void )
  114. {
  115.    if(!g_bIsRunning)  return;
  117.    Confirm( STATE_COEF_CAL_OK );
  118.    g_bIsRunning = false;
  119. }
  121. //---------------------------------------------------------------------------
  122. void  CSPCOEFCAL::REQ_Stop( void )
  123. {
  124.    if(!g_bIsRunning)  return;
  126.    META_Cancel_r( m_META_HANDLE_Obj.Get_MainHandle(), SPID_COEF_CAL );
  127.    Confirm( STATE_COEF_CAL_STOP );
  128.    g_bIsRunning = false;
  129. }
  131. //---------------------------------------------------------------------------
  132. void  CSPCOEFCAL::REQ_TimeOut( void )
  133. {
  134.    if(!g_bIsRunning)  return;
  136.    META_Cancel_r( m_META_HANDLE_Obj.Get_MainHandle(), SPID_COEF_CAL );
  137.    Confirm( STATE_COEF_CAL_TIMEOUT );
  138.    g_bIsRunning = false;
  139. }
  141. //---------------------------------------------------------------------------
  142. void  CSPCOEFCAL::Confirm( int confirm_state )
  143. {
  144.    if(!g_bIsRunning)  return;
  146.    if(ConfirmCallback==0)  return;
  147.    ConfirmState = confirm_state;
  148.    ActiveMan->SetActiveFunction( ConfirmCallback );
  149. }
  151. //---------------------------------------------------------------------------
  152. bool  CSPCOEFCAL::REQ_Read_TRC_File( char *filename, double* p_TrcScale, sSpCoefCalParameters *p_SpCoefCal )
  153. {
  154.     FILE *fp;
  155.     unsigned int i;
  156.     char str[512];
  157.     AnsiString as_Str;
  158.     bool isMatch = false;
  161.     for( i=0; i<TOTAL_TRC_FREQ_NUM; i++ )
  162.     {
  163.         p_SpCoefCal->Hz[i] = 0;
  164.         p_SpCoefCal->Mag[i] = 0;
  165.         p_SpCoefCal->MagdB[i] = 0;
  166.     }
  168.     fp = fopen(filename, "r");
  170.     if(fp == NULL)
  171.     return false;
  174.     for( i=0; i<TRC_FREQ_POSITION; i++ )
  175.     {
  176.         if( feof(fp) )
  177.             return  false;
  178.         fscanf( fp, "%s", &str);
  179.     }
  180.     as_Str = str;
  181.     p_SpCoefCal->num = as_Str.ToInt();
  183.     while(!feof(fp))
  184.     {
  185.         fscanf( fp, "%s", &str);
  186.         if( strcmpi(str, "#----X-------------Y---------") == 0)
  187.         {
  188.             isMatch = true;
  189.             break;
  190.         }
  191.     }
  193.     if( !isMatch )
  194.     {
  195.         fclose(fp);
  196.         return false;
  197.     }
  199.     for( i=0; i<2*p_SpCoefCal->num; i++ )
  200.     {
  201.         fscanf( fp, "%s", &str);
  202.         if( i % 2 == 0 )
  203.         {
  204.             as_Str = str;
  205.             p_SpCoefCal->Hz[i/2] = as_Str.ToInt();
  206.         }
  207.         else
  208.         {
  209.             as_Str = str;
  210.             p_SpCoefCal->Mag[i/2] = atof(as_Str.c_str());
  211.            // getYfromStr( as_Str, &TrcFreq[i] );
  212.         }
  213.     }
  214.     for( i=0; i<SCALING_FACTOR_POSITION; i++)
  215.     {
  216.         fscanf( fp, "%s", &str);
  217.     }
  218.     as_Str = str;
  219.     *p_TrcScale = atof(as_Str.c_str());
  220.     if( *p_TrcScale == 0.0 ) *p_TrcScale = 1.0;
  222.     if( p_SpCoefCal->Hz[p_SpCoefCal->num-1] > 3960.0 )
  223.     {
  224.         p_SpCoefCal->num--;
  225.     }
  227.     for( i=0; i<p_SpCoefCal->num; i++ )
  228.     {
  229.         p_SpCoefCal->Mag[i] = p_SpCoefCal->Mag[i] / (*p_TrcScale);
  230.         p_SpCoefCal->MagdB[i] = 20.0 * log10(p_SpCoefCal->Mag[i]);
  231.         sprintf(str, "%.3f",  p_SpCoefCal->MagdB[i]);
  232.         as_Str = (AnsiString) str;
  233.         p_SpCoefCal->MagdB[i] = atof(as_Str.c_str());
  234.     }
  236.     fclose(fp);
  237.     return true;
  239. }
  241. //==============================================================================
  242. bool  CSPCOEFCAL::REQ_Read_FIR_File( char *filename, bool b_45TapSupport, sFirCoefParameters *p_FirCoef )
  243. {
  244.     FILE *fp;
  245.     char str[512];
  246.     AnsiString as_Str;
  248.     fp = fopen(filename, "r");
  250.     if(fp == NULL)
  251.         return false;
  253.     // get taps
  254.     fscanf( fp, "%s", &str);
  255.     as_Str = (AnsiString) str;
  256.     p_FirCoef->taps = as_Str.ToInt();
  258.     if( b_45TapSupport )
  259.     {
  260.         if( p_FirCoef->taps > SPEECH_FIR_45_TAPS_NUM )
  261.         {
  262.             p_FirCoef->taps = SPEECH_FIR_45_TAPS_NUM;
  263.         }
  264.     }
  265.     else
  266.     {
  267.         if( p_FirCoef->taps > SPEECH_FIR_30_TAPS_NUM )
  268.         {
  269.             p_FirCoef->taps = SPEECH_FIR_30_TAPS_NUM;
  270.         }
  271.     }
  272.     for (unsigned int i=0; i<p_FirCoef->taps; i++)
  273.     {
  274.          fscanf( fp, "%s", &str);
  275.          as_Str = (AnsiString) str;
  276.          p_FirCoef->FirCoef[i] = atof(as_Str.c_str());
  277.     }
  279.     if( p_FirCoef->taps <= 0 )
  280.     {
  281.         p_FirCoef->taps = 4;
  282.         p_FirCoef->FirCoef[0] = FIR_COEFF_SCALE;
  283.         p_FirCoef->FirCoef[1] =               0;
  284.         p_FirCoef->FirCoef[2] =               0;
  285.         p_FirCoef->FirCoef[3] =               0;
  286.     }
  288.     fclose(fp);
  289.     return true;
  290. }
  292. //------------------------------------------------------------------------------
  293. bool  CSPCOEFCAL::REQ_Write_FIR_File( char *filename, sFirCoefParameters *p_FirCoef )
  294. {
  295.     FILE *fp;
  296.     char str[512];
  297.     AnsiString as_Str;
  299.     fp = fopen(filename, "w");
  301.     if(fp == NULL)
  302.         return false;
  304.     fprintf( fp, "%dn", (int) p_FirCoef->taps);
  305.     for (unsigned int i=0; i<p_FirCoef->taps; i++)
  306.     {
  307.         fprintf( fp, "%dn", (int) p_FirCoef->FirCoef[i]);
  308.     }
  310.     fclose(fp);
  311.     return  true;
  312. }
  314. #if 0
  315. //------------------------------------------------------------------------------
  316. bool  CSPCOEFCAL::CheckLicenseDat( void )
  317. {
  318.     FILE *fp;
  319.     AnsiString asPath, asFileName;
  321.     if ( getPathFromStr(Application->ExeName, asPath) &&
  322.          withPath( asPath) &&
  323.          !withPath( asFileName)
  324.        )
  325.     {
  326.        asFileName = asPath + "license.dat";
  327.     }
  328.     fp = fopen(asFileName.c_str(), "r");
  329.     if( fp == NULL )
  330.     {
  331.         fclose(fp);
  332.         return false;
  333.     }
  334.     fclose(fp);
  335.     return true;
  336. }
  337. #endif
  339. //==============================================================================
  340. void CSPCOEFCAL::ReorderFirCoef(sFirCoefParameters *p_FirCoef)
  341. {
  342.     double temp_old_fir_coeffs[SPEECH_FIR_45_TAPS_NUM];
  344.     for (unsigned int i=0; i<p_FirCoef->taps; i++ )
  345.     {
  346.         temp_old_fir_coeffs[i] = p_FirCoef->FirCoef[i];
  347.     }
  349.     for (unsigned int i=0; i<p_FirCoef->taps; i++)
  350.     {
  351.         p_FirCoef->FirCoef[i] = temp_old_fir_coeffs[p_FirCoef->taps-1-i];
  352.     }
  353. }
  355. //==============================================================================
  356. void  CSPCOEFCAL::getSelHzIndex(int *p_TplHz, int *p_SelHz, int* p_SelHzIndex)
  357. {
  358.     int k=0;
  360.     for( int i=0; i<TOTAL_TRC_FREQ_NUM; i++ )
  361.     {
  362.         for( int j=0; j<TOTAL_SEL_FREQ_NUM; j++)
  363.         {
  364.             if( *(p_TplHz+i) == *(p_SelHz+j) )
  365.             {
  366.                 p_SelHzIndex[k]=i;
  367.                 k++;
  368.                 break;
  369.             }
  370.         }
  371.     }
  373. }
  375. //-----------------------------------------------------------------------------
  376. void  CSPCOEFCAL::getSeldB( double *p_TpldB, double *p_SeldB, int* p_SelHzIndex)
  377. {
  378.     for(int i=0; i<TOTAL_SEL_FREQ_NUM; i++)
  379.     {
  380.         *(p_SeldB+i) =  *(p_TpldB+*(p_SelHzIndex+i));
  381.     }
  382. }
  384. //==============================================================================
  385. #if 0
  386. bool  CSPCOEFCAL::CheckEngineExist( void )
  387. {
  388.     // engine test code
  389.     Engine  *mat;
  391.     mat = engOpen( "" );
  392.     if( mat == NULL )
  393.     {
  394.         return  false;
  395.     }
  396. }
  397. #endif
  398. //--------------------------------------------------------------------------
  399. AFT_RESULT  CSPCOEFCAL::freqz( bool b_45TapSupport, sFirCoefParameters  *p_old_FIR, sSpCoefCalParameters  *p_ProcessSpCoef, double Fs, sSpCoefCalParameters *p_OldFirSpCoef)
  400. {
  401.     AFT_RESULT    ret;
  402.     sSpCoefCalParameters r_OldFirSpCoef, i_OldFirSpCoef;
  403.     double  Process_Hz[TOTAL_TRC_FREQ_NUM];
  404.     double  *p_old_FIR_Coeffs, *p_UnitArray, *p_process_Hz, *p_old_fir_mag, *p_i_old_fir_mag;
  405.     double  pi = 3.1416;
  406.     char  buf[BUFFER_SIZE];
  408.     // output
  409.     int    nResp;
  410.     double *daRespReal = NULL;
  411.     double *daRespImag = NULL;
  414.     // added for taps<30
  415.     if( b_45TapSupport )
  416.     {
  417.         for (unsigned int i=p_old_FIR->taps; i<SPEECH_FIR_45_TAPS_NUM; i++)
  418.         {
  419.             p_old_FIR->FirCoef[i] = 0.0;
  420.         }
  421.     }
  422.     else
  423.     {
  424.         for (unsigned int i=p_old_FIR->taps; i<SPEECH_FIR_30_TAPS_NUM; i++)
  425.         {
  426.             p_old_FIR->FirCoef[i] = 0.0;
  427.         }
  428.     }
  429.     // end of added
  431.     for (unsigned int i=0; i<p_ProcessSpCoef->num; i++)
  432.     {
  433.         Process_Hz[i] = p_ProcessSpCoef->Hz[i]/Fs*(2*pi);
  434.     }
  437.     ret = AFT_freqz(
  438. &nResp,
  439. &daRespReal,
  440. &daRespImag,
  441. p_old_FIR->FirCoef,
  442. p_old_FIR->taps,
  443. p_ProcessSpCoef->Hz,
  444. p_ProcessSpCoef->num,
  445. Fs
  446. );
  448.     if( ret )
  449.         return ret;
  451.     p_OldFirSpCoef->num = p_ProcessSpCoef->num;
  452.     for (unsigned int i=0; i<p_OldFirSpCoef->num; i++)
  453.     {
  454.         r_OldFirSpCoef.Mag[i] = *(daRespReal + i);
  455.         i_OldFirSpCoef.Mag[i] = *(daRespImag + i);
  456.         p_OldFirSpCoef->Mag[i] = sqrt(pow(r_OldFirSpCoef.Mag[i], 2.0) + pow(i_OldFirSpCoef.Mag[i],2.0));
  457.         p_OldFirSpCoef->MagdB[i] = 20.0*log10( p_OldFirSpCoef->Mag[i] );
  458.     }
  459.     return ret;
  460. }
  462. //------------------------------------------------------------------------------
  463. AFT_RESULT  CSPCOEFCAL::firls( int wanted_ord, sSpCoefCalParameters  *p_ProcessOddSpCoef, sSpCoefCalParameters *p_NewFirOddSpCoef, double Fs, sFirCoefParameters *p_NewFirCoeffF1)
  464. {
  465.     AFT_RESULT    ret;
  466.     double  d_wanted_ord[1], ProcessOddHz[TOTAL_TRC_FREQ_NUM+2];
  467.     double  *p_wanted_ord, *p_new_fir_mag_odd, *p_process_Hz_odd, *p_new_fir_coeff_F1;
  468.     sSpCoefCalParameters  process_Hz_odd, new_fir_mag_odd;
  469.     double  *p_weight;
  470.     int taps;
  472.     p_weight = new double[p_ProcessOddSpCoef->num/2];
  474.     for (unsigned int i=0; i<p_ProcessOddSpCoef->num/2; i++)
  475.     {
  476.         *(p_weight + i) = 1.0;
  477.     }
  479.     for (unsigned int i=0; i<p_ProcessOddSpCoef->num; i++)
  480.     {
  481.         ProcessOddHz[i] = p_ProcessOddSpCoef->Hz[i]/(Fs/2.0);
  482.     }
  484.     for (unsigned int i=p_ProcessOddSpCoef->num; i<TOTAL_TRC_FREQ_NUM+2; i++)
  485.     {
  486.         ProcessOddHz[i] = p_ProcessOddSpCoef->Hz[p_ProcessOddSpCoef->num-1]/(Fs/2.0);
  487.     }
  490.     ret = AFT_firls(
  491. &taps,
  492. &p_new_fir_coeff_F1,
  493. wanted_ord,
  494. ProcessOddHz,
  495. p_ProcessOddSpCoef->num,
  496. p_NewFirOddSpCoef->Mag,
  497. p_ProcessOddSpCoef->num,
  498. p_weight,
  499. p_ProcessOddSpCoef->num/2);
  501.     if( ret )
  502.         return ret;
  504.     p_NewFirCoeffF1->taps = wanted_ord + 1;
  505.     for (unsigned int i=0; i<p_NewFirCoeffF1->taps; i++)
  506.     {
  507.         p_NewFirCoeffF1->FirCoef[i] = *(p_new_fir_coeff_F1 + i);
  508.     }
  509.     return ret;
  510. }
  512. //--------------------------------------------------------------------------
  513. const char*  CSPCOEFCAL::Get_ErrorString(AFT_RESULT code)
  514. {
  515.     return AFT_getErrorString(code);
  516. }
  518. #if 0
  519. //--------------------------------------------------------------------------
  520. bool  CSPCOEFCAL::freqz( bool b_45TapSupport, sFirCoefParameters  *p_old_FIR, sSpCoefCalParameters  *p_ProcessSpCoef, double Fs, sSpCoefCalParameters *p_OldFirSpCoef)
  521. {
  522.     sSpCoefCalParameters r_OldFirSpCoef, i_OldFirSpCoef;
  523.     double  Process_Hz[TOTAL_TRC_FREQ_NUM];
  524.     double  *p_old_FIR_Coeffs, *p_UnitArray, *p_process_Hz, *p_old_fir_mag, *p_i_old_fir_mag;
  525.     double  dUnitArray[1] = {1.0};
  526.    // double  Fs = 8000.0,pi = 3.1416;
  527.     double  pi = 3.1416;
  528.     char  buf[BUFFER_SIZE];
  529.     int  nlhs=1, nrhs = 3;
  530.     int  i;
  531.     mxArray  *mx_old_FIR_Coeffs = NULL, *mx_UnitArray, *mx_process_Hz=NULL, *mx_old_fir_mag=NULL, *mx_i_old_fir_mag=NULL;
  532.     mxArray *plhs[1], *prhs[3];
  535.     if( b_45TapSupport )
  536.     {
  537.         // added for taps<45
  538.         for(i=p_old_FIR->taps; i<SPEECH_FIR_45_TAPS_NUM; i++)
  539.         {
  540.             p_old_FIR->FirCoef[i] = 0.0;
  541.         }
  542.     }
  543.     else
  544.     {
  545.         // added for taps<30
  546.         for(i=p_old_FIR->taps; i<SPEECH_FIR_30_TAPS_NUM; i++)
  547.         {
  548.             p_old_FIR->FirCoef[i] = 0.0;
  549.         }
  550.     }
  551.     // end of added
  553.     for(i=0; i<p_ProcessSpCoef->num; i++)
  554.     {
  555.         Process_Hz[i] = p_ProcessSpCoef->Hz[i]/Fs*(2*pi);
  556.     }
  558.     if( b_45TapSupport )
  559.     {
  560.         mx_old_FIR_Coeffs = mxCreateDoubleMatrix(SPEECH_FIR_45_TAPS_NUM, 1, mxREAL);
  561.     }
  562.     else
  563.     {
  564.         mx_old_FIR_Coeffs = mxCreateDoubleMatrix(SPEECH_FIR_30_TAPS_NUM, 1, mxREAL);
  565.     }
  566.    // mx_old_FIR_Coeffs = mxCreateDoubleMatrix(p_old_FIR->taps, 1, mxREAL);
  567.     mx_UnitArray = mxCreateDoubleMatrix(1, 1, mxREAL);
  568.     //mx_process_Hz = mxCreateDoubleMatrix(TOTAL_TRC_FREQ_NUM, 1, mxREAL);
  569.     mx_process_Hz = mxCreateDoubleMatrix(p_ProcessSpCoef->num, 1, mxREAL);
  570.    // mx_old_fir_mag = mxCreateDoubleMatrix(TOTAL_TRC_FREQ_NUM, 1, mxCOMPLEX);  // output
  571.     mx_old_fir_mag = mxCreateDoubleMatrix(TOTAL_TRC_FREQ_NUM, 1, mxCOMPLEX);  // output
  573.     p_old_FIR_Coeffs = mxGetPr( mx_old_FIR_Coeffs );
  574.     p_process_Hz = mxGetPr( mx_process_Hz );
  575.     p_UnitArray = mxGetPr( mx_UnitArray );
  576.    // p_old_fir_mag = mxGetPr( mx_old_fir_mag );
  579.     memcpy( (void *) p_old_FIR_Coeffs, p_old_FIR->FirCoef, sizeof(p_old_FIR->FirCoef) );
  580.    // memcpy( (void *) p_old_FIR_Coeffs, p_old_FIR->FirCoef, p_old_FIR->taps );
  581.     memcpy( (void *) p_UnitArray, dUnitArray, sizeof(dUnitArray) );
  582.    // memcpy( (void *) p_process_Hz, Process_Hz, sizeof(Process_Hz) );
  583.     memcpy( (void *) p_process_Hz, Process_Hz, (p_ProcessSpCoef->num)*sizeof(double) );
  584.     prhs[0] = mx_old_FIR_Coeffs;
  585.     prhs[1] = mx_UnitArray;
  586.     prhs[2] = mx_process_Hz;
  587.     plhs[0] = mx_old_fir_mag;
  588.    // plhs[1] = i_old_fir_mag;
  590.     InitializeModule_freqz();
  591.     InitializeModule_psdoptions();
  592.     mlxFreqz(nlhs, plhs, nrhs, prhs);
  594.     p_old_fir_mag = mxGetPr( plhs[0] );
  595.     p_i_old_fir_mag = mxGetPi( plhs[0] );
  596.     p_OldFirSpCoef->num = p_ProcessSpCoef->num;
  597.     for( i=0; i<p_OldFirSpCoef->num; i++ )
  598.     {
  599.         r_OldFirSpCoef.Mag[i] = *(p_old_fir_mag + i);
  600.         i_OldFirSpCoef.Mag[i] = *(p_i_old_fir_mag + i);
  601.         p_OldFirSpCoef->Mag[i] = sqrt(pow(r_OldFirSpCoef.Mag[i], 2.0) + pow(i_OldFirSpCoef.Mag[i],2.0));
  602.         p_OldFirSpCoef->MagdB[i] = 20.0*log10( p_OldFirSpCoef->Mag[i] );
  603.     }
  604.     TerminateModule_freqz();
  605.     TerminateModule_psdoptions();
  608.     // free mxArray memory
  609.     mxDestroyArray( mx_old_FIR_Coeffs );
  610.     mxDestroyArray( mx_process_Hz );
  611.     mxDestroyArray( mx_UnitArray );
  612.     mxDestroyArray( mx_old_fir_mag );
  613. }
  615. //---------------------------------------------------------------------------
  616. void  CSPCOEFCAL::freqz2out( bool b_45TapSupport, sFirCoefParameters  *p_new_fir_coeff_F_normalized_fixed_point, double N, double freqz_N, double Fs, sFirRespParameters *p_FirResp_freqz_H, sFirRespParameters *p_FirResp_freqz_F  )
  617. {
  618.     int  i;
  619.     int  nlhs, nrhs;
  620.     mxArray *plhs[2], *prhs[4];
  621.     mxArray  *mx_new_fir_coeff_F_normalized_fx_div=NULL, *mx_UnitArray=NULL, *mx_freqz_N=NULL, *mx_Fs=NULL;
  622.     mxArray  *mx_freqz_H=NULL, *mx_freqz_F=NULL;
  623.     double   *p_mx_new_fir_coeff_F_normalized_fx_div, *p_mx_UnitArray, *p_mx_freqz_N, *p_mx_Fs;
  624.     double   *p_r_mx_freqz_H, *p_i_mx_freqz_H, *p_mx_freqz_F;
  625.     double  dUnitArray[1], d_freqz_N_Array[1], d_Fs_Array[1];
  626.     double  freqz_H_real, freqz_H_image;
  628.     double new_fir_coeff_F_normalized_fx_div[SPEECH_FIR_45_TAPS_NUM];
  630. //    new_fir_coeff_F_normalized_fixed_point_div.taps = p_new_fir_coeff_F_normalized_fixed_point->taps;
  631.     for( i=0; i<p_new_fir_coeff_F_normalized_fixed_point->taps; i++ )
  632.     {
  633.          new_fir_coeff_F_normalized_fx_div[i] = p_new_fir_coeff_F_normalized_fixed_point->FirCoef[i]/FIR_COEFF_SCALE;
  634.     }
  636.     if( b_45TapSupport )
  637.     {
  638.         for( i=p_new_fir_coeff_F_normalized_fixed_point->taps; i<=SPEECH_FIR_45_TAPS_NUM; i++ )
  639.         {
  640.             new_fir_coeff_F_normalized_fx_div[i] = 0;
  641.         }
  642.     }
  643.     else
  644.     {
  645.         for( i=p_new_fir_coeff_F_normalized_fixed_point->taps; i<=SPEECH_FIR_30_TAPS_NUM; i++ )
  646.         {
  647.             new_fir_coeff_F_normalized_fx_div[i] = 0;
  648.         }
  649.     }
  650.     dUnitArray[0] = N;
  651.     d_freqz_N_Array[0] = freqz_N;
  652.     d_Fs_Array[0] = Fs;
  654.     // create mx arrary
  655.     if( b_45TapSupport )
  656.     {
  657.         mx_new_fir_coeff_F_normalized_fx_div = mxCreateDoubleMatrix(SPEECH_FIR_45_TAPS_NUM, 1, mxREAL);
  658.     }
  659.     else
  660.     {
  661.         mx_new_fir_coeff_F_normalized_fx_div = mxCreateDoubleMatrix(SPEECH_FIR_30_TAPS_NUM, 1, mxREAL);
  662.     }
  663.     mx_UnitArray = mxCreateDoubleMatrix(1, 1, mxREAL);
  664.     mx_freqz_N = mxCreateDoubleMatrix(1, 1, mxREAL);
  665.     mx_Fs = mxCreateDoubleMatrix(1, 1, mxREAL);
  666.     mx_freqz_H = mxCreateDoubleMatrix(1024, 1, mxCOMPLEX); // output
  667.     mx_freqz_F = mxCreateDoubleMatrix(1024, 1, mxREAL); // output
  669.     // set pointer to input mx array
  670.     p_mx_new_fir_coeff_F_normalized_fx_div = mxGetPr( mx_new_fir_coeff_F_normalized_fx_div );
  671.     p_mx_UnitArray = mxGetPr( mx_UnitArray );
  672.     p_mx_freqz_N = mxGetPr( mx_freqz_N );
  673.     p_mx_Fs = mxGetPr( mx_Fs );
  675.     // copy to input mx array
  676.     memcpy( (void *) p_mx_new_fir_coeff_F_normalized_fx_div, new_fir_coeff_F_normalized_fx_div, sizeof(new_fir_coeff_F_normalized_fx_div) );
  677.     memcpy( (void *) p_mx_UnitArray, dUnitArray, sizeof(dUnitArray) );
  678.     memcpy( (void *) p_mx_freqz_N, d_freqz_N_Array, sizeof(d_freqz_N_Array) );
  679.     memcpy( (void *) p_mx_Fs, d_Fs_Array, sizeof(d_Fs_Array) );
  681.     // set parameter
  682.     prhs[0] = mx_new_fir_coeff_F_normalized_fx_div;
  683.     prhs[1] = mx_UnitArray;
  684.     prhs[2] = mx_freqz_N;
  685.     prhs[3] = mx_Fs;
  686.     plhs[0] = mx_freqz_H;
  687.     plhs[1] = mx_freqz_F;
  688.     nlhs=2, nrhs=4;
  690.     InitializeModule_freqz();
  691.     InitializeModule_psdoptions();
  692.     libmatlbmxInitialize();
  693.     libmmfile_defsInitialize();
  694. //    InitializeModule_libmmfile();
  695.     libmmfileInitialize();
  696.     //InitializeModule_db();
  697.     mlxFreqz(nlhs, plhs, nrhs, prhs);
  699.     // extract output
  700.     p_r_mx_freqz_H = mxGetPr( plhs[0] );
  701.     p_i_mx_freqz_H = mxGetPr( plhs[0] );
  702.     p_mx_freqz_F = mxGetPr( plhs[1] );
  704.     p_FirResp_freqz_H->dimension =freqz_N;
  705.     for( i=0; i<p_FirResp_freqz_H->dimension; i++ )
  706.     {
  707.         freqz_H_real = *(p_r_mx_freqz_H+i);
  708.         freqz_H_image = *(p_i_mx_freqz_H+i);
  709.         p_FirResp_freqz_H->FirResp[i] = sqrt(pow(freqz_H_real, 2.0) + pow(freqz_H_image,2.0));
  710.     }
  712.     p_FirResp_freqz_F->dimension =freqz_N;
  713.     for( i=0; i<p_FirResp_freqz_F->dimension; i++ )
  714.     {
  715.         p_FirResp_freqz_F->FirResp[i] = *(p_mx_freqz_F+i);
  716.     }
  718.     //TerminateModule_db();
  719.   //  TerminateModule_libmmfile();
  720.     libmmfileTerminate();
  721.     libmmfile_defsTerminate();
  722.     libmatlbmxTerminate();
  723.     TerminateModule_freqz();
  724.     TerminateModule_psdoptions();
  727.     // free mxArray memory
  728.     mxDestroyArray( mx_new_fir_coeff_F_normalized_fx_div );
  729.     mxDestroyArray( mx_UnitArray );
  730.     mxDestroyArray( mx_freqz_N );
  731.     mxDestroyArray( mx_Fs );
  732.     mxDestroyArray( mx_freqz_H );
  733.     mxDestroyArray( mx_freqz_F );
  734. }
  736. //------------------------------------------------------------------------------
  737. bool  CSPCOEFCAL::firls( bool b_45TapSupport, int wanted_ord, sSpCoefCalParameters  *p_ProcessOddSpCoef, sSpCoefCalParameters *p_NewFirOddSpCoef, double Fs, sFirCoefParameters *p_NewFirCoeffF1)
  738. {
  739. //    double  Fs = 8000.0;
  740.     double  d_wanted_ord[1], ProcessOddHz[TOTAL_TRC_FREQ_NUM+2];
  741.     double  *p_wanted_ord, *p_new_fir_mag_odd, *p_process_Hz_odd, *p_new_fir_coeff_F1;
  742.     sSpCoefCalParameters  process_Hz_odd, new_fir_mag_odd;
  743.     int  i, nlhs=1, nrhs = 3;
  744.     mxArray  *mx_wanted_ord = NULL, *mx_process_Hz_odd = NULL, *mx_new_fir_mag_odd = NULL, *mx_new_fir_coeff_F1 = NULL;
  745.     mxArray *plhs[1], *prhs[3];
  747.     for( i=0; i<p_ProcessOddSpCoef->num; i++ )
  748.     {
  749.         ProcessOddHz[i] = p_ProcessOddSpCoef->Hz[i]/(Fs/2.0);
  750.     }
  752.     for( i=p_ProcessOddSpCoef->num; i<TOTAL_TRC_FREQ_NUM+2; i++ )
  753.     {
  754.         ProcessOddHz[i] = p_ProcessOddSpCoef->Hz[p_ProcessOddSpCoef->num-1]/(Fs/2.0);
  755.     }
  756.     d_wanted_ord[0]=wanted_ord;
  757.     mx_wanted_ord = mxCreateDoubleMatrix(1, 1, mxREAL);
  758.     //mx_process_Hz_odd = mxCreateDoubleMatrix( TOTAL_TRC_FREQ_NUM+2, 1, mxREAL );
  759.     mx_process_Hz_odd = mxCreateDoubleMatrix( p_ProcessOddSpCoef->num, 1, mxREAL );
  760.     //mx_new_fir_mag_odd = mxCreateDoubleMatrix( TOTAL_TRC_FREQ_NUM+2, 1, mxREAL );
  761.     mx_new_fir_mag_odd = mxCreateDoubleMatrix( p_NewFirOddSpCoef->num, 1, mxREAL );
  762.     if( b_45TapSupport )
  763.     {
  764.         mx_new_fir_coeff_F1 = mxCreateDoubleMatrix( 1, SPEECH_FIR_45_TAPS_NUM, mxREAL );
  765.     }
  766.     else
  767.     {
  768.         mx_new_fir_coeff_F1 = mxCreateDoubleMatrix( 1, SPEECH_FIR_30_TAPS_NUM, mxREAL );
  769.     }
  770.     p_wanted_ord = mxGetPr( mx_wanted_ord );
  771.     p_process_Hz_odd = mxGetPr( mx_process_Hz_odd );
  772.     p_new_fir_mag_odd = mxGetPr( mx_new_fir_mag_odd );
  773.     //memcpy( (void *) p_process_Hz_odd, d_process_Hz_odd, sizeof(d_wanted_ord) );
  774.     memcpy( (void *) p_wanted_ord, d_wanted_ord, sizeof(d_wanted_ord) );
  775.     //int size = p_ProcessOddSpCoef->num* sizeof(double);
  776.     //memcpy( (void *) p_process_Hz_odd, ProcessOddHz, sizeof(ProcessOddHz) );
  777.     memcpy( (void *) p_process_Hz_odd, ProcessOddHz, (p_ProcessOddSpCoef->num)*sizeof(double) );
  778.     //memcpy( (void *) p_new_fir_mag_odd, p_NewFirOddSpCoef->Mag, sizeof(p_NewFirOddSpCoef->Mag) );
  779.     memcpy( (void *) p_new_fir_mag_odd, p_NewFirOddSpCoef->Mag, (p_NewFirOddSpCoef->num)*sizeof(double) );
  780.     prhs[0] = mx_wanted_ord;
  781.     prhs[1] = mx_process_Hz_odd;
  782.     prhs[2] = mx_new_fir_mag_odd;
  783.     plhs[0] = mx_new_fir_coeff_F1;
  785.     InitializeModule_firls();
  786.     InitializeModule_signal_private_firchk();
  787.     InitializeModule_sinc();
  788.     mlxFirls(nlhs, plhs, nrhs, prhs);
  789.     p_new_fir_coeff_F1 =  mxGetPr( plhs[0] );
  790.     p_NewFirCoeffF1->taps = wanted_ord + 1;
  791.     for(int i=0; i<p_NewFirCoeffF1->taps; i++)
  792.     {
  793.         p_NewFirCoeffF1->FirCoef[i] = *(p_new_fir_coeff_F1 + i);
  794.     }
  795.     TerminateModule_sinc();
  796.     TerminateModule_signal_private_firchk();
  797.     TerminateModule_firls();
  799.     // free mxArray memory
  800.     mxDestroyArray( mx_wanted_ord );
  801.     mxDestroyArray( mx_process_Hz_odd );
  802.     mxDestroyArray( mx_new_fir_mag_odd );
  803.     mxDestroyArray( mx_new_fir_coeff_F1 );
  804. }
  807. //------------------------------------------------------------------------------
  808. void  CSPCOEFCAL::firls4input( bool b_45TapSupport, int wanted_ord, sSpCoefCalParameters  *p_ProcessOddSpCoef, sSpCoefCalParameters *p_NewFirOddSpCoef, sWeightParameters *p_Weight, double Fs, sFirCoefParameters *p_NewFirCoeffF1)
  809. {
  810. //    double  Fs = 8000.0;
  811.     double  d_wanted_ord[1], ProcessOddHz[TOTAL_TRC_FREQ_NUM+2];
  812.     double  *p_mx_wanted_ord, *p_mx_new_fir_mag_odd, *p_mx_process_Hz_odd, *p_mx_weight;
  813.     double  *p_mx_new_fir_coeff_F1;  // output
  814.     sSpCoefCalParameters  process_Hz_odd, new_fir_mag_odd;
  815.     int  i, nlhs, nrhs;
  816.     mxArray  *mx_wanted_ord = NULL, *mx_process_Hz_odd = NULL, *mx_new_fir_mag_odd = NULL, *mx_weight=NULL;
  817.     mxArray  *mx_new_fir_coeff_F1 = NULL; //output
  818.     mxArray *plhs[1], *prhs[4];
  820.     for( i=0; i<p_ProcessOddSpCoef->num; i++ )
  821.     {
  822.         ProcessOddHz[i] = p_ProcessOddSpCoef->Hz[i]/(Fs/2.0);
  823.     }
  825.     for( i=p_ProcessOddSpCoef->num; i<TOTAL_TRC_FREQ_NUM+2; i++ )
  826.     {
  827.         ProcessOddHz[i] = p_ProcessOddSpCoef->Hz[p_ProcessOddSpCoef->num-1]/(Fs/2.0);
  828.     }
  829.     d_wanted_ord[0]=wanted_ord;
  831.     mx_wanted_ord = mxCreateDoubleMatrix(1, 1, mxREAL);
  832.     mx_process_Hz_odd = mxCreateDoubleMatrix( p_ProcessOddSpCoef->num, 1, mxREAL );
  833.     mx_new_fir_mag_odd = mxCreateDoubleMatrix( p_NewFirOddSpCoef->num, 1, mxREAL );
  834.     mx_weight = mxCreateDoubleMatrix( p_Weight->num, 1, mxREAL );
  835.     if( b_45TapSupport )
  836.     {
  837.         mx_new_fir_coeff_F1 = mxCreateDoubleMatrix( 1, SPEECH_FIR_45_TAPS_NUM, mxREAL ); // output
  838.     }
  839.     else
  840.     {
  841.         mx_new_fir_coeff_F1 = mxCreateDoubleMatrix( 1, SPEECH_FIR_30_TAPS_NUM, mxREAL ); // output
  842.     }
  844.     p_mx_wanted_ord = mxGetPr( mx_wanted_ord );
  845.     p_mx_process_Hz_odd = mxGetPr( mx_process_Hz_odd );
  846.     p_mx_new_fir_mag_odd = mxGetPr( mx_new_fir_mag_odd );
  847.     p_mx_weight = mxGetPr( mx_weight );
  849.     memcpy( (void *) p_mx_wanted_ord, d_wanted_ord, sizeof(d_wanted_ord) );
  850.     memcpy( (void *) p_mx_process_Hz_odd, ProcessOddHz, (p_ProcessOddSpCoef->num)*sizeof(double) );
  851.     memcpy( (void *) p_mx_new_fir_mag_odd, p_NewFirOddSpCoef->Mag, (p_NewFirOddSpCoef->num)*sizeof(double) );
  852.     memcpy( (void *) p_mx_weight, p_Weight->weight, (p_Weight->num)*sizeof(double) );
  854.     nlhs=1, nrhs = 4;
  855.     prhs[0] = mx_wanted_ord;
  856.     prhs[1] = mx_process_Hz_odd;
  857.     prhs[2] = mx_new_fir_mag_odd;
  858.     prhs[3] = mx_weight;
  859.     plhs[0] = mx_new_fir_coeff_F1;
  861.     InitializeModule_firls();
  862.     InitializeModule_signal_private_firchk();
  863.     InitializeModule_sinc();
  864.     mlxFirls(nlhs, plhs, nrhs, prhs);
  865.     p_mx_new_fir_coeff_F1 =  mxGetPr( plhs[0] );
  866.     p_NewFirCoeffF1->taps = wanted_ord + 1;
  867.     for(int i=0; i<p_NewFirCoeffF1->taps; i++)
  868.     {
  869.         p_NewFirCoeffF1->FirCoef[i] = *(p_mx_new_fir_coeff_F1 + i);
  870.     }
  871.     TerminateModule_sinc();
  872.     TerminateModule_signal_private_firchk();
  873.     TerminateModule_firls();
  875.     // free mxArray memory
  876.     mxDestroyArray( mx_wanted_ord );
  877.     mxDestroyArray( mx_process_Hz_odd );
  878.     mxDestroyArray( mx_new_fir_mag_odd );
  879.     mxDestroyArray( mx_weight );
  880.     mxDestroyArray( mx_new_fir_coeff_F1 );
  881. }
  883. #endif
  885. //===========================================================================
  886. ////////////////////////////         Acqua        ///////////////////////////
  887. //===========================================================================
  888. bool CSPCOEFCAL::AcquaFile_To_UplFile( char *i_filename, bool b_Rx, bool b_LinearFormat, char *o_filename )
  889. {
  890.     const int TX_SEG_NUM = 5;
  891.     const int RX_SEG_NUM = 5;
  892.     double TX_data[][4]=
  893.     {
  894. {300, 0,-12,-6},  /*Hz, upper, lower, mean*/
  895. {1000,0, -6,-3},  /*Hz, upper, lower, mean*/
  896. {2000,4, -6,-1},  /*Hz, upper, lower, mean*/
  897. {3000,4, -6,-1},  /*Hz, upper, lower, mean*/
  898. {3400,4, -9,-2.5},  /*Hz, upper, lower, mean*/
  899.     };
  901.     double RX_data[][4]=
  902.     {
  903. {300, 2,  -7,-2.5},  /*Hz, upper, lower, mean*/
  904. {500, 1.428571428571429,  -5,-1.785714285714286},  /*Hz, upper, lower, mean*/
  905. {1000,0,  -5,-2.5},  /*Hz, upper, lower, mean*/
  906. {3000,2,  -5,-1.5},  /*Hz, upper, lower, mean*/
  907. {3400,2, -10,-4},  /*Hz, upper, lower, mean*/
  908.     };
  910.     FILE *fp_in;
  911.     //char str[512];
  912.     //AnsiString as_Str;
  913.     int len=0;
  914.     int ch;
  915.     int i, j, k;
  916.     double inCoef[4000][2];   // Hz, dB
  917.     double outCoef[4000][2];  // Hz, dB
  918.     char hz[1024];
  919.     char db[1024];
  920.     double d[4000][2];  // Hz, dB
  921.     double x[4000][2];  // Hz, dB
  922.     double *d_fit;
  923.     double d_m;
  924.     double d_A;
  925.     double d_B;
  926.     double d_offset_g;
  927.     int i_fit_seg;
  929.     fp_in = fopen(i_filename, "r");
  930.     if( fp_in == NULL )  return false;
  932.     do
  933.     {
  934.         ch = fscanf(fp_in,"%s  %s", &hz, &db);
  935.        // AnsiString as_hz(hz);
  936.         if( atof(hz)>90.0 )
  937.         {
  938.        if( len >= 0 )
  939.             {
  941.         inCoef[len][0]=atof(hz);
  942.                // inCoef[len][0] = atof(as_hz.c_str());
  943.                 if( b_LinearFormat )
  944.                 {
  945.                inCoef[len][1] = 20*log10( atof(db) + LOG_FLOOR ); // linear
  946.                 }
  947.                 else
  948.                 {
  949.             inCoef[len][1] = atof(db); // log dB
  950.                 }
  951.         if( inCoef[len][0] >= 4000 ) break;
  952.             }
  953.     len++;
  954.     if( len >= 4000 ) break;
  955. }
  956.     }while( ch != EOF );
  958.     fclose(fp_in);
  960.     //Caculate Target Curve using the Hz given by input file
  961.     if( b_Rx )
  962.     {
  963.         d_fit = &RX_data[0][0];
  964. i_fit_seg = RX_SEG_NUM;
  965.     }
  966.     else
  967.     {
  968.         d_fit = &TX_data[0][0];
  969. i_fit_seg = TX_SEG_NUM;
  970.     }
  972.     k=0;
  973.     for( i=0; i<len;i++ )
  974.     {
  975.         for( j=0; j<i_fit_seg-1; j++ )
  976.         {
  977.             if( inCoef[i][0]>=d_fit[j*4+0] && inCoef[i][0]<=d_fit[(j+1)*4+0] )
  978.             {
  979.                 x[k][0] = inCoef[i][0];  //Hz
  980.                 x[k][1] = inCoef[i][1];  //dB
  981.                 d[k][0] = inCoef[i][0];  //Hz
  982.                 d_m     = (d_fit[(j+1)*4+3]-d_fit[j*4+3])/(d_fit[(j+1)*4+0]-d_fit[j*4+0]);
  983.                 d[k][1] = d_m*(inCoef[i][0]-d_fit[j*4+0])+d_fit[j*4+3];
  984.                 k++;
  985.                 break;
  986.             }
  987.         }//end of for(j
  988.     }//end of for(i
  990.     //Compute the Offset
  991.     for( i=0; i<k; i++ ) x[i][1]=pow(10.0,x[i][1]/20);
  992.     for( i=0; i<k; i++ ) d[i][1]=pow(10.0,d[i][1]/20);
  994.     d_A=0; d_B=0;
  995.     for( i=0; i<k; i++ ) d_A += x[i][1]*x[i][1];
  996.     for( i=0; i<k; i++ ) d_B += x[i][1]*d[i][1];
  997.     if( d_A!=0 )
  998.     {
  999.         d_offset_g = fabs(d_B/d_A);
  1000.     }
  1001.     else
  1002.     {
  1003.         d_offset_g=1;
  1004.     }
  1006.     d_offset_g = 20*log10( d_offset_g );
  1008.     //Apply the Offset to input data to obtain output
  1009.     for( i=0; i<len; i++ )
  1010.     {
  1011.        outCoef[i][0] = inCoef[i][0]; //Hz
  1012.        outCoef[i][1] = inCoef[i][1] + d_offset_g; //dB
  1013.        outCoef[i][1] = pow( 10.0,outCoef[i][1]/20 ); //to linear scale in TRC file
  1014.     }
  1016.     //Write output to file
  1017.     AnsiString asPath;
  1018.     AnsiString asStr(i_filename);
  1019.     AnsiString asInputFile;
  1020.     if ( getPathFromStr(Application->ExeName, asPath) && getFilenameFromStr( asStr, asInputFile ) )
  1021.     {
  1022.         AnsiString asOutputFile = asPath + asInputFile + ".trc";
  1023.         strcpy( o_filename, asOutputFile.c_str() );
  1024.     }
  1025.     else
  1026.     {
  1027.         return false;
  1028.     }
  1030.     FILE *fp_out = fopen( o_filename, "w" );
  1031.     if( fp_out == NULL )  return false;
  1033.     fprintf( fp_out, "213n" );
  1034.     fprintf( fp_out, "2n" );
  1035.     fprintf( fp_out, "10n" );
  1036.     fprintf( fp_out, "1n" );
  1037.     fprintf( fp_out, "%dn", len );
  1038.     fprintf( fp_out, "1n" );
  1039.     fprintf( fp_out, "0n" );
  1040.     fprintf( fp_out,"#----X-------------Y---------n" );
  1041.     for( i=0; i<len; i++)
  1042.     {
  1043.         fprintf( fp_out, "%4.0f  %6.2f n", outCoef[i][0], outCoef[i][1] );
  1044.     }
  1045.     fprintf( fp_out, "0n");
  1046.     fprintf( fp_out, "373n");
  1047.     fprintf( fp_out, "0n");
  1048.     fprintf( fp_out, "4n");
  1049.     fprintf( fp_out, "1000n");
  1050.     fprintf( fp_out, "0n");
  1051.     fprintf( fp_out, "3n");
  1052.     fprintf( fp_out, "1n");
  1053.     fprintf( fp_out, "4000n");
  1054.     fprintf( fp_out, "1n");
  1055.     fprintf( fp_out, "4n");
  1056.     fprintf( fp_out, "100n");
  1057.     fprintf( fp_out, "0n");
  1058.     fprintf( fp_out, "4n");
  1059.     fprintf( fp_out, "13n");
  1060.     fprintf( fp_out, "20n");
  1061.     fprintf( fp_out, "1.0n");  // useful
  1063.     fprintf( fp_out, "0n" );
  1064.     fprintf( fp_out, "14n" );
  1065.     fprintf( fp_out, "0n" );
  1066.     fprintf( fp_out, "0.252982n" );
  1067.     fprintf( fp_out, "15n" );
  1068.     fprintf( fp_out, "32n" );
  1069.     fprintf( fp_out, "0.008n" );
  1070.     fprintf( fp_out, "15n" );
  1071.     fprintf( fp_out, "32n" );
  1072.     fprintf( fp_out, "0n" );
  1073.     fprintf( fp_out, "0n" );
  1074.     fprintf( fp_out, "0n" );
  1075.     fprintf( fp_out, "0n" );
  1076.     fprintf( fp_out, "0n" );
  1077.     fprintf( fp_out, "0n" );
  1078.     fprintf( fp_out, "0n" );
  1079.     fprintf( fp_out, "0n" );
  1080.     fprintf( fp_out, "0n" );
  1081.     fprintf( fp_out, "0n" );
  1082.     fprintf( fp_out, "0n" );
  1083.     fprintf( fp_out, "0n" );
  1084.     fprintf( fp_out, "  Hz     GEN FREQ  n" );
  1085.     fprintf( fp_out, "dBr  RMS(FFT) CH2 n" );
  1086.     fprintf( fp_out, "??   Not avail.   n" );
  1087.     fprintf( fp_out, "1n" );
  1088.     fprintf( fp_out, "0n" );
  1090.     fclose(fp_out);
  1092.     return true;
  1093. }
  1095. //===========================================================================
  1096. /////////////////////////////   Microtronix   ///////////////////////////////
  1097. //===========================================================================
  1098. bool CSPCOEFCAL::MicrotronixFile_To_UplFile( char *i_filename, bool b_Rx, bool b_LinearFormat, char *o_filename )
  1099. {
  1100.     const int TX_SEG_NUM = 9;
  1101.     const int RX_SEG_NUM = 9;
  1102.     double SEND_data[][4]=
  1103.     {
  1104. {100, -7,-10,-8.5},  /*Hz, upper, lower, mean*/
  1105. {150,  0, -9.5,-4.75},  /*Hz, upper, lower, mean*/
  1106. {300,  0,-8,-4},  /*Hz, upper, lower, mean*/
  1107. {500,  0, -6,-3},  /*Hz, upper, lower, mean*/
  1108. {1000, 0,-6,-3},  /*Hz, upper, lower, mean*/
  1109. {2000, 5, -6,-0.5},  /*Hz, upper, lower, mean*/
  1110. {3000, 5, -6,-0.5},  /*Hz, upper, lower, mean*/
  1111. {3400, 5, -9,-2},  /*Hz, upper, lower, mean*/
  1112. {4000, 0,-13.5,-6.75},  /*Hz, upper, lower, mean*/
  1114.     };
  1116.     double RX_data[][4]=
  1117.     {
  1118. {100, -7,-9,-8},  /*Hz, upper, lower, mean*/
  1119. {170,  2, -8.3,-3.15},  /*Hz, upper, lower, mean*/
  1120. {300,  2,-7,-2.5},  /*Hz, upper, lower, mean*/
  1121. {500,  1.43, -5,-1.785},  /*Hz, upper, lower, mean*/
  1122. {1000, 0,-5,-2.5},  /*Hz, upper, lower, mean*/
  1123. {3000, 2, -5,-1.5},  /*Hz, upper, lower, mean*/
  1124. {3400, 2, -8,-3},  /*Hz, upper, lower, mean*/
  1125. {4000, 2, -12.5,-5.25},  /*Hz, upper, lower, mean*/
  1126. {8000, -18,-20,-19},  /*Hz, upper, lower, mean*/
  1127.     };
  1129.    // int type;
  1130.    // char typeS[1024];
  1131.     double *fit;
  1132.     int fit_seg;
  1133.     char out_fn[1024];
  1134.     double in[4000][2];   // Hz, dB
  1135.     double out[4000][2];  // Hz, dB
  1136.     double d[4000][2];  // Hz, dB
  1137.     double x[4000][2];  // Hz, dB
  1138.     double A,B,offset_g;
  1139.     char hz[1024];
  1140.     char db[1024];
  1141.     int  L;
  1142.     FILE *fp_in;
  1143.     FILE *fp_out;
  1144.     int c,i,j;
  1145.     double m;
  1146.     char titles[1024];
  1148.    // if(b_Rx)
  1149.    // {
  1150.    //    // type=RX;
  1151.    //     strcpy(typeS,"Receiving Frequency Response");
  1152.    // }
  1153.    // else
  1154.    // {
  1155.    //   // type=SEND;
  1156.    //    strcpy(typeS,"Sending Frequency Response");
  1157.    // }
  1159.     // Read input data
  1160.     fp_in=fopen(i_filename, "r");
  1161.     if( NULL == fp_in )  return false;
  1163.     //Write output to file
  1164.     AnsiString asPath;
  1165.     AnsiString asStr(i_filename);
  1166.     AnsiString asInputFile;
  1167.     if ( getPathFromStr(Application->ExeName, asPath) && getFilenameFromStr( asStr, asInputFile ) )
  1168.     {
  1169.         AnsiString asOutputFile = asPath + asInputFile + ".trc";
  1170.         strcpy( o_filename, asOutputFile.c_str() );
  1171.     }
  1172.     else
  1173.     {
  1174.         return false;
  1175.     }
  1177.     //strcpy(out_fn,args[2]);
  1178.     //strcat(out_fn,".trc");
  1180. //#ifdef LINEAR_INPUT
  1181. // printf("nProcess Gain Compensation of %s with Linear Magnituden",typeS);
  1182. //#else
  1183. // printf("nProcess Gain Compensation of %s with dB Magnituden",typeS);
  1184. //#endif
  1185. // printf("Input: %sn",args[2]);
  1186. // printf("Output: %sn",out_fn);
  1188.    // strcpy(titles,"");
  1189.    // if( fgets( titles, 100, fp_in ) == NULL)
  1190.    // {  return false;
  1191.    // }
  1193.    // if(strcmp(titles,"Microtronix Test Systemn")==0)
  1194.     bool b_match = false;
  1195.     while(!feof(fp_in))
  1196.     {
  1197.         fscanf( fp_in, "%s", &titles);
  1198.         AnsiString as_titles(titles);
  1199.         if( as_titles.AnsiPos( "Microtronix" ) != 0 )
  1200.         {
  1201.             b_match = true;
  1202.             break;
  1203.         }
  1204.     }
  1205.     if( ! b_match )
  1206.     {
  1207.         if(fp_in) fclose(fp_in);
  1208.         return false;
  1209.     }
  1211.     {
  1212.        // for(i=0;i<15;i++)
  1213.        // {
  1214.        //     fgets( titles, 100, fp_in );
  1215.        // }
  1216.         b_match = false;
  1217.         while(!feof(fp_in))
  1218.         {
  1219.             fgets( titles, 100, fp_in );
  1220.             AnsiString as_titles(titles);
  1221.             if( b_Rx )
  1222.             {
  1223.                 if( as_titles.AnsiCompareIC( "Freq      Receiven" ) == 0 )
  1224.                 {
  1225.                     b_match = true;
  1226.                     break;
  1227.                 }
  1228.             }
  1229.             else
  1230.             {
  1231.                 if( as_titles.AnsiCompareIC( "Freq      Sendn" ) == 0 )
  1232.                 {
  1233.                         b_match = true;
  1234.                         break;
  1235.                 }
  1236.             }
  1237.         }
  1239.         if( ! b_match )
  1240.         {
  1241.             if(fp_in) fclose(fp_in);
  1242.             return false;
  1243.         }
  1245.         fgets( titles, 100, fp_in );
  1246.         L=0;
  1247.         do{
  1248. //           fgets( titles, 100, fp_in );
  1249. //    strcpy(titles,"%s %s",&hz,&db);
  1250.             c=fscanf(fp_in,"%s",&hz);
  1251.             c=fscanf(fp_in,"%s",&db);
  1252.             fgets( titles, 100, fp_in );
  1254.             if( atof(hz)>90.0 )
  1255.             {
  1256.                 if(L>=0)
  1257.                 {
  1258.                     in[L][0]=atof(hz);
  1259.                     if (b_LinearFormat)
  1260.                     {
  1261.           in[L][1]=20*log10(atof(db)+LOG_FLOOR); //Linear_INPUT
  1262.                     }
  1263.                     else
  1264.                     {
  1265.        in[L][1]=atof(db); //LOG_DB_INPUT
  1266.                     }
  1267.                     if(in[L][0]>=3971) break;
  1268.                 }
  1269.                 L++;
  1270.                 if(L>=65) break;
  1271.             }
  1272.         }while(c!=EOF);
  1273.     }
  1274.     //else
  1275.     //{
  1276.     //    return false;
  1277.     //}
  1279.     if(fp_in) fclose(fp_in);
  1280.     //Caculate Target Curve using the Hz given by input file
  1281.     if(b_Rx)
  1282.     {
  1283.         fit=&RX_data[0][0];
  1284.         fit_seg=RX_SEG_NUM;
  1285.     }
  1286.     else
  1287.     {
  1288.         fit=&SEND_data[0][0];
  1289. fit_seg=TX_SEG_NUM;
  1290.     }
  1291.     c=0;
  1292.     for(i=0;i<L;i++)
  1293.     {
  1294.         for(j=0;j<fit_seg-1;j++)
  1295.         {
  1296.             if(in[i][0]>=fit[j*4+0] && in[i][0]<=fit[(j+1)*4+0])
  1297.             {
  1298.                 x[c][0]=in[i][0];  //Hz
  1299.                 x[c][1]=in[i][1];  //dB
  1300.                 d[c][0]=in[i][0];  //Hz
  1301.                 m=(fit[(j+1)*4+3]-fit[j*4+3])/(fit[(j+1)*4+0]-fit[j*4+0]);
  1302.                 d[c][1]=m*(in[i][0]-fit[j*4+0])+fit[j*4+3];
  1303.                 c++;
  1304.                 break;
  1305.             }
  1306.         }//end of for(j
  1307.     }//end of for(i
  1309.     //Compute the Offset
  1310.     for(i=0;i<c;i++) x[i][1]=pow(10.0,x[i][1]/20);
  1311.     for(i=0;i<c;i++) d[i][1]=pow(10.0,d[i][1]/20);
  1313.     A=0; B=0;
  1314.     for(i=0;i<c;i++) A+=x[i][1]*x[i][1];
  1315.     for(i=0;i<c;i++) B+=x[i][1]*d[i][1];
  1316.     if(A!=0)
  1317.     {
  1318.         offset_g=fabs(B/A);
  1319.     }
  1320.     else
  1321.     {
  1322.         offset_g=1;
  1323.     }
  1325.     offset_g=20*log10(offset_g);
  1326. //Apply the Offset to input data to obtain output
  1327.     for(i=0;i<L;i++)
  1328.     {
  1329.         out[i][0]=in[i][0]; //Hz
  1330.         out[i][1]=in[i][1]+offset_g; //dB
  1331.         out[i][1]=pow(10.0,out[i][1]/20); //to linear scale in TRC file
  1332.     }
  1333.     //Write output to file
  1334.     fp_out=fopen(o_filename, "w");
  1336.     fprintf(fp_out,"213n");
  1337.     fprintf(fp_out,"2n");
  1338.     fprintf(fp_out,"10n");
  1339.     fprintf(fp_out,"1n");
  1340.     fprintf(fp_out,"%dn",L);
  1341.     fprintf(fp_out,"1n");
  1342.     fprintf(fp_out,"0n");
  1343.     fprintf(fp_out,"#----X-------------Y---------n");
  1344.     for(i=0;i<L;i++)
  1345.     {
  1346.         fprintf(fp_out,"%4.0f  %6.5f n",out[i][0],out[i][1]);
  1347.     }
  1348.     fprintf(fp_out,"0n");
  1349.     fprintf(fp_out,"373n");
  1350.     fprintf(fp_out,"0n");
  1351.     fprintf(fp_out,"4n");
  1352.     fprintf(fp_out,"1000n");
  1353.     fprintf(fp_out,"0n");
  1354.     fprintf(fp_out,"3n");
  1355.     fprintf(fp_out,"1n");
  1356.     fprintf(fp_out,"4000n");
  1357.     fprintf(fp_out,"1n");
  1358.     fprintf(fp_out,"4n");
  1359.     fprintf(fp_out,"100n");
  1360.     fprintf(fp_out,"0n");
  1361.     fprintf(fp_out,"4n");
  1362.     fprintf(fp_out,"13n");
  1363.     fprintf(fp_out,"20n");
  1364.     fprintf(fp_out,"1.0n");  // useful
  1366.     fprintf(fp_out,"0n");
  1367.     fprintf(fp_out,"14n");
  1368.     fprintf(fp_out,"0n");
  1369.     fprintf(fp_out,"0.252982n");
  1370.     fprintf(fp_out,"15n");
  1371.     fprintf(fp_out,"32n");
  1372.     fprintf(fp_out,"0.008n");
  1373.     fprintf(fp_out,"15n");
  1374.     fprintf(fp_out,"32n");
  1375.     fprintf(fp_out,"0n");
  1376.     fprintf(fp_out,"0n");
  1377.     fprintf(fp_out,"0n");
  1378.     fprintf(fp_out,"0n");
  1379.     fprintf(fp_out,"0n");
  1380.     fprintf(fp_out,"0n");
  1381.     fprintf(fp_out,"0n");
  1382.     fprintf(fp_out,"0n");
  1383.     fprintf(fp_out,"0n");
  1384.     fprintf(fp_out,"0n");
  1385.     fprintf(fp_out,"0n");
  1386.     fprintf(fp_out,"0n");
  1387.     fprintf(fp_out,"  Hz     GEN FREQ  n");
  1388.     fprintf(fp_out,"dBr  RMS(FFT) CH2 n");
  1389.     fprintf(fp_out,"??   Not avail.   n");
  1390.     fprintf(fp_out,"1n");
  1391.     fprintf(fp_out,"0n");
  1393.     if (fp_out)
  1394.     {
  1395.         fclose(fp_out);
  1396.     }
  1397.     return true;
  1398. }
  1400. //===========================================================================
  1401. ////////////////////////////////////   UPV   ///////////////////////////////
  1402. //===========================================================================
  1403. bool CSPCOEFCAL::UpvFile_To_UplFile(char *i_filename, char *o_filename)
  1404. {
  1405.     if (!TraceConversion(i_filename, o_filename))
  1406.     {
  1407.         return false;
  1408.     }
  1409.     return true;    
  1410. }
  1412. //===========================================================================
  1413. ////////////////////////////////////   Vita   ///////////////////////////////
  1414. //===========================================================================
  1415. bool CSPCOEFCAL::VitaFile_To_UplFile(char *i_filename, bool b_Rx, bool b_LinearFormat, char *o_filename)
  1416. {
  1417. //#define RX   0
  1418. //#define SEND 1
  1420. const int TX_SEG_NUM = 9;
  1421. const int RX_SEG_NUM = 9;
  1423. double SEND_data[TX_SEG_NUM][4] =
  1424. {
  1425. {100, -10,-40,-25},  /*Hz, upper, lower, mean*/
  1426. {200,  0, -35,-17.5},  /*Hz, upper, lower, mean*/
  1427. {300,  0,-14,-7},  /*Hz, upper, lower, mean*/
  1428. {500,  0, -8,-4},  /*Hz, upper, lower, mean*/
  1429. {1000, 4,-8,-2},  /*Hz, upper, lower, mean*/
  1430. {3000, 4, -8,-2},  /*Hz, upper, lower, mean*/
  1431. {3400, 4, -11,-3.5},  /*Hz, upper, lower, mean*/
  1432. {4000, 0,-15,-7.5},  /*Hz, upper, lower, mean*/
  1434. };
  1436. double RX_data[RX_SEG_NUM][4] =
  1437. {
  1438. {100, -6,-40,-23},  /*Hz, upper, lower, mean*/
  1439. {200,  0, -20,-10},  /*Hz, upper, lower, mean*/
  1440. {300,  2,-9,-3.5},  /*Hz, upper, lower, mean*/
  1441. {500,  2, -7,-2.5},  /*Hz, upper, lower, mean*/
  1442. {1000, 0,-7,-3.5},  /*Hz, upper, lower, mean*/
  1443. {3000, 4, -7,-1.5},  /*Hz, upper, lower, mean*/
  1444. {3400, 4, -12,-4},  /*Hz, upper, lower, mean*/
  1445. {4000, 4, -40,-18},  /*Hz, upper, lower, mean*/
  1446. };
  1450.  //int type;
  1451.  //char typeS[1024];
  1452.  double *fit;
  1453.  int fit_seg;
  1454.  char out_fn[1024];
  1455.  double in[4000][2];   // Hz, dB
  1456.  double out[4000][2];  // Hz, dB
  1457.  double d[4000][2];  // Hz, dB
  1458.  double x[4000][2];  // Hz, dB
  1459.  double A,B,offset_g;
  1460.  char hz[1024];
  1461.  char db[1024],ln[50];
  1462.  float db_f;
  1463.  int ln_f;
  1464.  int  L;
  1466.   FILE *fp_in;
  1467.   FILE *fp_out;
  1468.   int c,i,j;
  1469.   double m;
  1470.   char titles[1024];
  1471.   //if(argc<3) Usage();
  1473.  // if(strcmp(args[1],"RX")==0){
  1474.  //   type=RX;
  1475.  //   strcpy(typeS,"Receiving Frequency Response");
  1476.  // }else  if(strcmp(args[1],"SEND")==0){
  1477.  //   type=SEND;
  1478.  //   strcpy(typeS,"Sending Frequency Response");
  1479.  // }else{
  1480.  //   Usage();
  1481.  // }
  1482. // Read input data
  1483.   //fp_in=FOPEN(args[2], "r");
  1484.   fp_in = fopen(i_filename, "r");
  1485.   if (NULL == fp_in)
  1486.   {
  1487.       return false;
  1488.       //  printf("nCannot open file - %s", fn);
  1489.       //  printf("n Space in filename is incorrect.");
  1490.       //  exit(-1);
  1491.   }
  1492.   //Write output to file
  1493.     AnsiString asPath;
  1494.     AnsiString asStr(i_filename);
  1495.     AnsiString asInputFile;
  1496.     if ( getPathFromStr(Application->ExeName, asPath) && getFilenameFromStr( asStr, asInputFile ) )
  1497.     {
  1498.         AnsiString asOutputFile = asPath + asInputFile + ".trc";
  1499.         strcpy( o_filename, asOutputFile.c_str() );
  1500.     }
  1501.     else
  1502.     {
  1503.         return false;
  1504.     }
  1505.  // strcpy(out_fn,args[2]);
  1506.   //strcat(out_fn,".trc");
  1508. //#ifdef LINEAR_INPUT
  1509. // printf("nProcess Gain Compensation of %s with Linear Magnituden",typeS);
  1510. //#else
  1511. // printf("nProcess Gain Compensation of %s with dB Magnituden",typeS);
  1512. //#endif
  1513. // printf("Input: %sn",args[2]);
  1514. // printf("Output: %sn",out_fn);
  1516. //   strcpy(titles,"");
  1517. //   if( fgets( titles, 100, fp_in ) == NULL)
  1518. //   {  printf( "fgets errorn" );
  1519. //      exit(0);
  1520. //   }
  1521. //   if(1)
  1522. //   {
  1523. //    for(i=0;i<15;i++)
  1524. //    {
  1525. //    fgets( titles, 100, fp_in );
  1526. //    }
  1527.    // bool b_match = false;
  1528.     L=0;
  1529.     do
  1530.     {
  1531. //      fgets( titles, 100, fp_in );
  1532. // strcpy(titles,"%s %s",&hz,&db);
  1533.         c = fscanf(fp_in,"%s",&hz);
  1534.         c = fscanf(fp_in,"%f",&db_f);
  1535. // fgets( titles, 100, fp_in );
  1537.         if (atof(hz) > 23)
  1538.         {
  1539.             if (L >= 0)
  1540.             {
  1541.                 in[L][0] = atof(hz);
  1542. //#ifdef  LINEAR_INPUT
  1543.                 if (b_LinearFormat)
  1544.                 {
  1545.                     in[L][1]=20*log10(db_f+LOG_FLOOR); //Linear_INPUT
  1546.                 }
  1547. //#else
  1548.                 else
  1549.                 {
  1550.                     in[L][1]=db_f; //LOG_DB_INPUT
  1551.                 }
  1552. //#endif
  1553.                 if (in[L][0] >= 4000)
  1554.                 {
  1555.                     break;
  1556.                 }
  1557.             }
  1558.             L++;
  1559.             if (L>=95)
  1560.             {
  1561.                 break;
  1562.             }
  1563.         }
  1564.     }while(c!=EOF);
  1567. //   }
  1568. //   else
  1569. //   {
  1570. //      printf("NOT Microtronix Format!! TRY AGAIN!!n");
  1572. //   }
  1576.     if (fp_in)
  1577.     {
  1578.         fclose(fp_in);
  1579.     }
  1581. //Caculate Target Curve using the Hz given by input file
  1582.     //if(type==RX){
  1583.     if (b_Rx)
  1584.     {
  1585.         fit = &RX_data[0][0];
  1586. fit_seg = RX_SEG_NUM;
  1587.     }
  1588.     else
  1589.     {
  1590.         fit = &SEND_data[0][0];
  1591.         fit_seg = TX_SEG_NUM;
  1592.     }
  1593.     c=0;
  1594.     for (i=0; i<L; i++)
  1595.     {
  1596.         for (j=0;j<fit_seg-1;j++)
  1597.         {
  1598.             if (in[i][0]>=fit[j*4+0] && in[i][0]<=fit[(j+1)*4+0])
  1599.             {
  1600.                 x[c][0]=in[i][0];  //Hz
  1601.                 x[c][1]=in[i][1];  //dB
  1602.                 d[c][0]=in[i][0];  //Hz
  1603.                 m = (fit[(j+1)*4+3]-fit[j*4+3])/(fit[(j+1)*4+0]-fit[j*4+0]);
  1604.                 d[c][1] = m*(in[i][0]-fit[j*4+0])+fit[j*4+3];
  1605.                 c++;
  1606.                 break;
  1607.             }
  1608.         }//end of for(j
  1609.     }//end of for(i
  1611. //Compute the Offset
  1612.     for (i=0;i<c;i++)
  1613.     {
  1614.         x[i][1] = pow(10.0,x[i][1]/20);
  1615.     }
  1616.     for (i=0;i<c;i++)
  1617.     {
  1618.         d[i][1] = pow(10.0,d[i][1]/20);
  1619.     }
  1621.     A=0; B=0;
  1622.     for (i=0;i<c;i++)
  1623.     {
  1624.         A += x[i][1]*x[i][1];
  1625.     }
  1626.     for (i=0;i<c;i++)
  1627.     {
  1628.         B += x[i][1]*d[i][1];
  1629.     }
  1630.     if (A != 0)
  1631.     {
  1632.         offset_g = fabs(B/A);
  1633.     }
  1634.     else
  1635.     {
  1636.         offset_g=1;
  1637.     }
  1639.     offset_g = 20*log10(offset_g);
  1640.     //Apply the Offset to input data to obtain output
  1641.     for (i=0; i<L; i++)
  1642.     {
  1643.         out[i][0] = in[i][0]; //Hz
  1644.         out[i][1] = in[i][1]+offset_g; //dB
  1645.         out[i][1] = pow(10.0,out[i][1]/20); //to linear scale in TRC file
  1646.     }
  1647. //Write output to file
  1648.   //fp_out=FOPEN(out_fn, "wt");
  1649.     fp_out = fopen(o_filename, "w");
  1650.     if (NULL == fp_out)
  1651.     {
  1652. // printf("nCannot open file - %s", fn);
  1653. // printf("n Space in filename is incorrect.");
  1654. // exit(-1);
  1655.         return false;
  1656.     }
  1658.     fprintf(fp_out,"213n");
  1659.     fprintf(fp_out,"2n");
  1660.     fprintf(fp_out,"10n");
  1661.     fprintf(fp_out,"1n");
  1662.     fprintf(fp_out,"%dn",L);
  1663.     fprintf(fp_out,"1n");
  1664.     fprintf(fp_out,"0n");
  1665.     fprintf(fp_out,"#----X-------------Y---------n");
  1666.     for (i=0;i<L;i++)
  1667.     {
  1668.         fprintf(fp_out,"%4.0f  %6.5f n",out[i][0],out[i][1]);
  1669. //   printf("%4.0f  %6.5f n",out[i][0],out[i][1]);
  1670.     }
  1671.     fprintf(fp_out,"0n");
  1672.     fprintf(fp_out,"373n");
  1673.     fprintf(fp_out,"0n");
  1674.     fprintf(fp_out,"4n");
  1675.     fprintf(fp_out,"1000n");
  1676.     fprintf(fp_out,"0n");
  1677.     fprintf(fp_out,"3n");
  1678.     fprintf(fp_out,"1n");
  1679.     fprintf(fp_out,"4000n");
  1680.     fprintf(fp_out,"1n");
  1681.     fprintf(fp_out,"4n");
  1682.     fprintf(fp_out,"100n");
  1683.     fprintf(fp_out,"0n");
  1684.     fprintf(fp_out,"4n");
  1685.     fprintf(fp_out,"13n");
  1686.     fprintf(fp_out,"20n");
  1687.     fprintf(fp_out,"1.0n");  // useful
  1689.     fprintf(fp_out,"0n");
  1690.     fprintf(fp_out,"14n");
  1691.     fprintf(fp_out,"0n");
  1692.     fprintf(fp_out,"0.252982n");
  1693.     fprintf(fp_out,"15n");
  1694.     fprintf(fp_out,"32n");
  1695.     fprintf(fp_out,"0.008n");
  1696.     fprintf(fp_out,"15n");
  1697.     fprintf(fp_out,"32n");
  1698.     fprintf(fp_out,"0n");
  1699.     fprintf(fp_out,"0n");
  1700.     fprintf(fp_out,"0n");
  1701.     fprintf(fp_out,"0n");
  1702.     fprintf(fp_out,"0n");
  1703.     fprintf(fp_out,"0n");
  1704.     fprintf(fp_out,"0n");
  1705.     fprintf(fp_out,"0n");
  1706.     fprintf(fp_out,"0n");
  1707.     fprintf(fp_out,"0n");
  1708.     fprintf(fp_out,"0n");
  1709.     fprintf(fp_out,"0n");
  1710.     fprintf(fp_out,"  Hz     GEN FREQ  n");
  1711.     fprintf(fp_out,"dBr  RMS(FFT) CH2 n");
  1712.     fprintf(fp_out,"??   Not avail.   n");
  1713.     fprintf(fp_out,"1n");
  1714.     fprintf(fp_out,"0n");
  1716.     if (fp_out)
  1717.     {
  1718.         fclose(fp_out);
  1719.     }
  1721.     return true;
  1722. }
  1728. //===========================================================================
  1729. ////////////////////////////  Global information  ///////////////////////////
  1730. //===========================================================================
  1731. int  CSPCOEFCAL::Get_ConfirmState( void )
  1732. {
  1733.     return  ConfirmState;
  1734. }