fmgen.cpp

三种模拟调制与解调的算法

// FMGen.cpp: implementation of the FMGen class.
//
//////////////////////////////////////////////////////////////////////

#include "stdafx.h"
#include "mod_demod.h"
#include "FMGen.h"
#include "head.h"
#include "SourceGenClass.h"


#ifdef _DEBUG
#undef THIS_FILE
static char THIS_FILE[]=__FILE__;
#define new DEBUG_NEW
#endif

//////////////////////////////////////////////////////////////////////
// Construction/Destruction
//////////////////////////////////////////////////////////////////////

FMGen::FMGen(CString pnameModel,    CString ptypeModel,
		long	vmodelSampleFreq,	long	vinputSampleFreq,
		int	    vtimeStep,			CString pnameGetDataFile,
		CString	pnamePutDataFile,	double	vampCarrier,
		long	vfreqCarrier,		double	vphaseCarrier,
		double	vModPara):
ModBaseClass(pnameModel,ptypeModel,
		vmodelSampleFreq,	vinputSampleFreq,
		vtimeStep,		    pnameGetDataFile,
		pnamePutDataFile,	vampCarrier,
		vfreqCarrier,		vphaseCarrier,
		vModPara)
{
}

FMGen::~FMGen()
{

}
void FMGen::run()
{
	double	dt;
	float	*fn;
	long	num_of_scan;
	long    i;
	double	phase_n,phase_n_1,dphase;
	double	const_var;
	
	dt=1.0/inputSampleFreq;
	num_of_scan=(long) timeStep/1000.0*inputSampleFreq;
   
	
    //begin to modulate
    fn=getData(nameGetDataFile,1,num_of_scan);
	if(!fn)
	{
		cout<<"Error occured when read "<<nameGetDataFile<<".\n";
		getch();
		exit(1);
	}
	phase_n_1=ModPara*(*fn)*dt+phaseCarrier;
	*fn=ampCarrier*cos(phase_n_1);
	const_var=2*pi*freqCarrier*dt;
	for (i=1;i<num_of_scan;i++)
	{
		dphase=const_var+ModPara*(*(fn+i))*dt;
		while (dphase>=10000*2*pi) dphase-=2*pi*10000;
		while (dphase<=-2*pi*10000) dphase+=2*pi*10000;
		phase_n=phase_n_1+dphase;
		while (phase_n>=2*pi*10000) phase_n-=2*pi*10000;
		while (phase_n<=-2*pi*10000) phase_n+=2*pi*10000;
		*(fn+i)=ampCarrier*cos(phase_n);
		phase_n_1=phase_n;
	}
	if(putData(fn,namePutDataFile,num_of_scan)==FALSE)
	{
		cout<<"when save modulation data,error occured.\n";
		free(fn);
		getch();
	    exit(1);
	}
	free(fn);
	cout<<"FM modulation complete.\n";
}