cannam@0: /* -*- c-basic-offset: 4 indent-tabs-mode: nil -*-  vi:set ts=8 sts=4 sw=4: */
cannam@0: 
cannam@0: /*
cannam@0:     QM DSP Library
cannam@0: 
cannam@0:     Centre for Digital Music, Queen Mary, University of London.
cannam@0:     This file copyright 2005-2006 Christian Landone.
cannam@0:     All rights reserved.
cannam@0: */
cannam@0: 
cannam@0: #include "TempoTrack.h"
cannam@0: 
cannam@0: #include "dsp/maths/MathAliases.h"
cannam@0: #include "dsp/maths/MathUtilities.h"
cannam@0: 
cannam@6: #include <iostream>
cannam@6: 
cannam@0: 
cannam@0: //////////////////////////////////////////////////////////////////////
cannam@0: // Construction/Destruction
cannam@0: //////////////////////////////////////////////////////////////////////
cannam@0: 
cannam@0: TempoTrack::TempoTrack( TTParams Params )
cannam@0: {
cannam@0:     m_tempoScratch = NULL;
cannam@0:     m_rawDFFrame = NULL;
cannam@0:     m_smoothDFFrame = NULL;
cannam@0:     m_frameACF = NULL;
cannam@0: 
cannam@0:     m_dataLength = 0;
cannam@0:     m_winLength = 0;
cannam@0:     m_lagLength = 0;
cannam@0: 
cannam@0:     m_rayparam = 0;
cannam@0:     m_sigma = 0;
cannam@0:     m_DFWVNnorm = 0;
cannam@0: 
cannam@0:     initialise( Params );
cannam@0: }
cannam@0: 
cannam@0: TempoTrack::~TempoTrack()
cannam@0: {
cannam@0:     deInitialise();
cannam@0: }
cannam@0: 
cannam@0: void TempoTrack::initialise( TTParams Params )
cannam@0: {	
cannam@0:     m_winLength = Params.winLength;
cannam@0:     m_lagLength = Params.lagLength;
cannam@0: 
cannam@0:     m_rayparam	 = 43.0;
cannam@0:     m_sigma = sqrt(3.9017);
cannam@0:     m_DFWVNnorm = exp( ( log( 2.0 ) / m_rayparam ) * ( m_winLength + 2 ) );
cannam@0: 
cannam@0:     m_rawDFFrame = new double[ m_winLength ];
cannam@0:     m_smoothDFFrame = new double[ m_winLength ];
cannam@0:     m_frameACF = new double[ m_winLength ];
cannam@0:     m_tempoScratch = new double[ m_lagLength ];
cannam@0: 
cannam@0:     unsigned int winPre = Params.WinT.pre;
cannam@0:     unsigned int winPost = Params.WinT.post;
cannam@0: 
cannam@0:     m_DFFramer.configure( m_winLength, m_lagLength );
cannam@0: 	
cannam@0:     m_DFPParams.length = m_winLength;
cannam@0:     m_DFPParams.AlphaNormParam = Params.alpha;
cannam@0:     m_DFPParams.LPOrd = Params.LPOrd;
cannam@0:     m_DFPParams.LPACoeffs = Params.LPACoeffs;
cannam@0:     m_DFPParams.LPBCoeffs = Params.LPBCoeffs;
cannam@0:     m_DFPParams.winPre = Params.WinT.pre;
cannam@0:     m_DFPParams.winPost = Params.WinT.post;
cannam@0:     m_DFPParams.isMedianPositive = true;
cannam@0: 	
cannam@0:     m_DFConditioning = new DFProcess( m_DFPParams );
cannam@0: 
cannam@0: }
cannam@0: 
cannam@0: void TempoTrack::deInitialise()
cannam@0: {	
cannam@0:     delete [] m_rawDFFrame;
cannam@0: 	
cannam@0:     delete [] m_smoothDFFrame;
cannam@0: 	
cannam@0:     delete [] m_frameACF;
cannam@0: 
cannam@0:     delete [] m_tempoScratch;
cannam@0: 
cannam@0:     delete m_DFConditioning;
cannam@0: }
cannam@0: 
cannam@0: void TempoTrack::createCombFilter(double* Filter, unsigned int winLength, unsigned int TSig, double beatLag)
cannam@0: {
cannam@0:     unsigned int i;
cannam@0: 
cannam@0:     if( beatLag == 0 )
cannam@0:     {
cannam@0: 	for( i = 0; i < winLength; i++ )
cannam@0: 	{    
cannam@0: 	    Filter[ i ] = ( ( i + 1 ) / pow( m_rayparam, 2.0) ) * exp( ( -pow(( i + 1 ),2.0 ) / ( 2.0 * pow( m_rayparam, 2.0))));
cannam@0: 	}
cannam@0:     }
cannam@0:     else
cannam@0:     {	
cannam@0: 	m_sigma = beatLag/8;
cannam@0: 	for( i = 0; i < winLength; i++ )
cannam@0: 	{
cannam@0: 	    double dlag = (double)(i+1) - beatLag;
cannam@0: 	    Filter[ i ] =  exp(-0.5 * pow(( dlag / m_sigma), 2.0) ) / (sqrt( 2 * PI) * m_sigma);
cannam@0: 	}
cannam@0:     }
cannam@0: }
cannam@0: 
cannam@0: double TempoTrack::tempoMM(double* ACF, double* weight, int tsig)
cannam@0: {
cannam@0: 
cannam@0:     double period = 0;
cannam@0:     double maxValRCF = 0.0;
cannam@0:     unsigned int maxIndexRCF = 0;
cannam@0: 
cannam@0:     double* pdPeaks;
cannam@0: 
cannam@0:     unsigned int maxIndexTemp;
cannam@0:     double	maxValTemp;
cannam@0:     unsigned int count; 
cannam@0: 	
cannam@0:     unsigned int numelem;
cannam@0:     int i, a, b;
cannam@0: 
cannam@0:     for( i = 0; i < m_lagLength; i++ )
cannam@0: 	m_tempoScratch[ i ] = 0.0;
cannam@0: 
cannam@0:     if( tsig == 0 ) 
cannam@0:     {
cannam@0: 	//if time sig is unknown, use metrically unbiased version of Filterbank
cannam@0: 	numelem = 4;
cannam@0:     }
cannam@0:     else
cannam@0:     {
cannam@0: 	numelem = tsig;
cannam@0:     }
cannam@0: 
cannam@0:     for(i=1;i<m_lagLength-1;i++)
cannam@0:     {
cannam@0: 	//first and last output values are left intentionally as zero
cannam@0: 	for (a=1;a<=numelem;a++)
cannam@0: 	{
cannam@0: 	    for(b=(1-a);b<a;b++)
cannam@0: 	    {
cannam@0: 		if( tsig == 0 )
cannam@0: 		{					
cannam@0: 		    m_tempoScratch[i] += ACF[a*(i+1)+b-1] * (1.0 / (2.0 * (double)a-1)) * weight[i];
cannam@0: 		}
cannam@0: 		else
cannam@0: 		{
cannam@0: 		    m_tempoScratch[i] += ACF[a*(i+1)+b-1] * 1 * weight[i];
cannam@0: 		}
cannam@0: 	    }
cannam@0: 	}
cannam@0:     }
cannam@0: 
cannam@0: 
cannam@0:     //NOW FIND MAX INDEX OF ACFOUT
cannam@0:     for( i = 0; i < m_lagLength; i++)
cannam@0:     {
cannam@0: 	if( m_tempoScratch[ i ] > maxValRCF)
cannam@0: 	{
cannam@0: 	    maxValRCF = m_tempoScratch[ i ];
cannam@0: 	    maxIndexRCF = i;
cannam@0: 	}
cannam@0:     }
cannam@6: 
cannam@6:     double locked = 5168.f / maxIndexRCF;
cannam@6:     if (locked >= 30 && locked <= 180) {
cannam@6:         m_lockedTempo = locked;
cannam@6:     }
cannam@6: 
cannam@0:     if( tsig == 0 )
cannam@0: 	tsig = 4;
cannam@0: 
cannam@0: 	
cannam@0:     if( tsig == 4 )
cannam@0:     {
cannam@0: 	pdPeaks = new double[ 4 ];
cannam@0: 	for( i = 0; i < 4; i++ ){ pdPeaks[ i ] = 0.0;}
cannam@0: 
cannam@0: 	pdPeaks[ 0 ] = ( double )maxIndexRCF + 1;
cannam@0: 
cannam@0: 	maxIndexTemp = 0;
cannam@0: 	maxValTemp = 0.0;
cannam@0: 	count = 0;
cannam@0: 
cannam@0: 	for( i = (2 * maxIndexRCF + 1) - 1; i < (2 * maxIndexRCF + 1) + 2; i++ )
cannam@0: 	{
cannam@0: 	    if( ACF[ i ] > maxValTemp )
cannam@0: 	    {
cannam@0: 		maxValTemp = ACF[ i ];
cannam@0: 		maxIndexTemp = count;
cannam@0: 	    }
cannam@0: 	    count++;
cannam@0: 	}
cannam@0: 	pdPeaks[ 1 ] = (double)( maxIndexTemp + 1 + ( (2 * maxIndexRCF + 1 ) - 2 ) + 1 )/2;
cannam@0: 
cannam@0: 	maxIndexTemp = 0;
cannam@0: 	maxValTemp = 0.0;
cannam@0: 	count = 0;
cannam@0: 
cannam@0: 	for( i = (3 * maxIndexRCF + 2 ) - 2; i < (3 * maxIndexRCF + 2 ) + 3; i++ )
cannam@0: 	{
cannam@0: 	    if( ACF[ i ] > maxValTemp )
cannam@0: 	    {
cannam@0: 		maxValTemp = ACF[ i ];
cannam@0: 		maxIndexTemp = count;
cannam@0: 	    }
cannam@0: 	    count++;
cannam@0: 	}
cannam@0: 	pdPeaks[ 2 ] = (double)( maxIndexTemp + 1 + ( (3 * maxIndexRCF + 2) - 4 ) + 1 )/3;
cannam@0: 
cannam@0: 	maxIndexTemp = 0;
cannam@0: 	maxValTemp = 0.0;
cannam@0: 	count = 0;
cannam@0: 
cannam@0: 	for( i = ( 4 * maxIndexRCF + 3) - 3; i < ( 4 * maxIndexRCF + 3) + 4; i++ )
cannam@0: 	{
cannam@0: 	    if( ACF[ i ] > maxValTemp )
cannam@0: 	    {
cannam@0: 		maxValTemp = ACF[ i ];
cannam@0: 		maxIndexTemp = count;
cannam@0: 	    }
cannam@0: 	    count++;
cannam@0: 	}
cannam@0: 	pdPeaks[ 3 ] = (double)( maxIndexTemp + 1 + ( (4 * maxIndexRCF + 3) - 9 ) + 1 )/4 ;
cannam@0: 
cannam@0: 
cannam@0: 	period = MathUtilities::mean( pdPeaks, 4 );
cannam@0:     }
cannam@0:     else
cannam@0:     {
cannam@0: 	pdPeaks = new double[ 3 ];
cannam@0: 	for( i = 0; i < 3; i++ ){ pdPeaks[ i ] = 0.0;}
cannam@0: 
cannam@0: 	pdPeaks[ 0 ] = ( double )maxIndexRCF + 1;
cannam@0: 
cannam@0: 	maxIndexTemp = 0;
cannam@0: 	maxValTemp = 0.0;
cannam@0: 	count = 0;
cannam@0: 
cannam@0: 	for( i = (2 * maxIndexRCF + 1) - 1; i < (2 * maxIndexRCF + 1) + 2; i++ )
cannam@0: 	{
cannam@0: 	    if( ACF[ i ] > maxValTemp )
cannam@0: 	    {
cannam@0: 		maxValTemp = ACF[ i ];
cannam@0: 		maxIndexTemp = count;
cannam@0: 	    }
cannam@0: 	    count++;
cannam@0: 	}
cannam@0: 	pdPeaks[ 1 ] = (double)( maxIndexTemp + 1 + ( (2 * maxIndexRCF + 1 ) - 2 ) + 1 )/2;
cannam@0: 
cannam@0: 	maxIndexTemp = 0;
cannam@0: 	maxValTemp = 0.0;
cannam@0: 	count = 0;
cannam@0: 
cannam@0: 	for( i = (3 * maxIndexRCF + 2 ) - 2; i < (3 * maxIndexRCF + 2 ) + 3; i++ )
cannam@0: 	{
cannam@0: 	    if( ACF[ i ] > maxValTemp )
cannam@0: 	    {
cannam@0: 		maxValTemp = ACF[ i ];
cannam@0: 		maxIndexTemp = count;
cannam@0: 	    }
cannam@0: 	    count++;
cannam@0: 	}
cannam@0: 	pdPeaks[ 2 ] = (double)( maxIndexTemp + 1 + ( (3 * maxIndexRCF + 2) - 4 ) + 1 )/3;
cannam@0: 
cannam@0: 
cannam@0: 	period = MathUtilities::mean( pdPeaks, 3 );
cannam@0:     }
cannam@0: 
cannam@0:     delete [] pdPeaks;
cannam@0: 
cannam@0:     return period;
cannam@0: }
cannam@0: 
cannam@0: void TempoTrack::stepDetect( double* periodP, double* periodG, int currentIdx, int* flag )
cannam@0: {
cannam@0:     double stepthresh = 1 * 3.9017;
cannam@0: 
cannam@0:     if( *flag )
cannam@0:     {
cannam@0: 	if(abs(periodG[ currentIdx ] - periodP[ currentIdx ]) > stepthresh)
cannam@0: 	{
cannam@0: 	    // do nuffin'
cannam@0: 	}
cannam@0:     }
cannam@0:     else
cannam@0:     {
cannam@0: 	if(fabs(periodG[ currentIdx ]-periodP[ currentIdx ]) > stepthresh)
cannam@0: 	{
cannam@0: 	    *flag = 3;
cannam@0: 	}
cannam@0:     }
cannam@0: }
cannam@0: 
cannam@0: void TempoTrack::constDetect( double* periodP, int currentIdx, int* flag )
cannam@0: {
cannam@0:     double constthresh = 2 * 3.9017;
cannam@0: 
cannam@0:     if( fabs( 2 * periodP[ currentIdx ] - periodP[ currentIdx - 1] - periodP[ currentIdx - 2] ) < constthresh)
cannam@0:     {
cannam@0: 	*flag = 1;
cannam@0:     }
cannam@0:     else
cannam@0:     {
cannam@0: 	*flag = 0;
cannam@0:     }
cannam@0: }
cannam@0: 
cannam@0: int TempoTrack::findMeter(double *ACF, unsigned int len, double period)
cannam@0: {
cannam@0:     int i;
cannam@0:     int p = (int)MathUtilities::round( period );
cannam@0:     int tsig;
cannam@0: 
cannam@0:     double Energy_3 = 0.0;
cannam@0:     double Energy_4 = 0.0;
cannam@0: 
cannam@0:     double temp3A = 0.0;
cannam@0:     double temp3B = 0.0;
cannam@0:     double temp4A = 0.0;
cannam@0:     double temp4B = 0.0;
cannam@0: 
cannam@0:     double* dbf = new double[ len ]; int t = 0;
cannam@0:     for( unsigned int u = 0; u < len; u++ ){ dbf[ u ] = 0.0; }
cannam@0: 
cannam@0:     if( (double)len < 6 * p + 2 )
cannam@0:     {
cannam@0: 	for( i = ( 3 * p - 2 ); i < ( 3 * p + 2 ) + 1; i++ )
cannam@0: 	{
cannam@0: 	    temp3A += ACF[ i ];
cannam@0: 	    dbf[ t++ ] = ACF[ i ];
cannam@0: 	}
cannam@0: 	
cannam@0: 	for( i = ( 4 * p - 2 ); i < ( 4 * p + 2 ) + 1; i++ )
cannam@0: 	{
cannam@0: 	    temp4A += ACF[ i ];
cannam@0: 	}
cannam@0: 
cannam@0: 	Energy_3 = temp3A;
cannam@0: 	Energy_4 = temp4A;
cannam@0:     }
cannam@0:     else
cannam@0:     {
cannam@0: 	for( i = ( 3 * p - 2 ); i < ( 3 * p + 2 ) + 1; i++ )
cannam@0: 	{
cannam@0: 	    temp3A += ACF[ i ];
cannam@0: 	}
cannam@0: 	
cannam@0: 	for( i = ( 4 * p - 2 ); i < ( 4 * p + 2 ) + 1; i++ )
cannam@0: 	{
cannam@0: 	    temp4A += ACF[ i ];
cannam@0: 	}
cannam@0: 
cannam@0: 	for( i = ( 6 * p - 2 ); i < ( 6 * p + 2 ) + 1; i++ )
cannam@0: 	{
cannam@0: 	    temp3B += ACF[ i ];
cannam@0: 	}
cannam@0: 	
cannam@0: 	for( i = ( 2 * p - 2 ); i < ( 2 * p + 2 ) + 1; i++ )
cannam@0: 	{
cannam@0: 	    temp4B += ACF[ i ];
cannam@0: 	}
cannam@0: 
cannam@0: 	Energy_3 = temp3A + temp3B;
cannam@0: 	Energy_4 = temp4A + temp4B;
cannam@0:     }
cannam@0: 
cannam@0:     if (Energy_3 > Energy_4)
cannam@0:     {
cannam@0: 	tsig = 3;
cannam@0:     }
cannam@0:     else
cannam@0:     {
cannam@0: 	tsig = 4;
cannam@0:     }
cannam@0: 
cannam@0: 
cannam@0:     return tsig;
cannam@0: }
cannam@0: 
cannam@0: void TempoTrack::createPhaseExtractor(double *Filter, unsigned int winLength, double period, unsigned int fsp, unsigned int lastBeat)
cannam@0: {	
cannam@0:     int p = (int)MathUtilities::round( period );
cannam@0:     int predictedOffset = 0;
cannam@0: 
cannam@0:     double* phaseScratch = new double[ p*2 ];
cannam@0: 
cannam@0: 	
cannam@0:     if( lastBeat != 0 )
cannam@0:     {
cannam@0: 	lastBeat = (int)MathUtilities::round((double)lastBeat );///(double)winLength);
cannam@0: 
cannam@0: 	    predictedOffset = lastBeat + p - fsp;
cannam@0: 
cannam@0: 	    if (predictedOffset < 0) 
cannam@0: 	    {
cannam@0: 		lastBeat = 0;
cannam@0: 	    }
cannam@0:     }
cannam@0: 
cannam@0:     if( lastBeat != 0 )
cannam@0:     {
cannam@0: 	int mu = p;
cannam@0: 	double sigma = (double)p/4;
cannam@0: 	double PhaseMin = 0.0;
cannam@0: 	double PhaseMax = 0.0;
cannam@0: 	unsigned int scratchLength = p*2;
cannam@0: 	double temp = 0.0;
cannam@0: 
cannam@0: 	for(  int i = 0; i < scratchLength; i++ )
cannam@0: 	{
cannam@0: 	    phaseScratch[ i ] = exp( -0.5 * pow( ( i - mu ) / sigma, 2 ) ) / ( sqrt( 2*PI ) *sigma );
cannam@0: 	}
cannam@0: 
cannam@0: 	MathUtilities::getFrameMinMax( phaseScratch, scratchLength, &PhaseMin, &PhaseMax );
cannam@0: 			
cannam@0: 	for(int i = 0; i < scratchLength; i ++)
cannam@0: 	{
cannam@0: 	    temp = phaseScratch[ i ];
cannam@0: 	    phaseScratch[ i ] = (temp - PhaseMin)/PhaseMax;
cannam@0: 	}
cannam@0: 
cannam@0: 	unsigned int index = 0;
cannam@0: 	for(int i = p - ( predictedOffset - 1); i < p + ( p - predictedOffset) + 1; i++)
cannam@0: 	{
cannam@0: 	    Filter[ index++ ] = phaseScratch[ i ];
cannam@0: 	}
cannam@0:     }
cannam@0:     else
cannam@0:     {
cannam@0: 	for( int i = 0; i < p; i ++)
cannam@0: 	{
cannam@0: 	    Filter[ i ] = 1;
cannam@0: 	}
cannam@0:     }
cannam@0: 	
cannam@0:     delete [] phaseScratch;
cannam@0: }
cannam@0: 
cannam@0: int TempoTrack::phaseMM(double *DF, double *weighting, unsigned int winLength, double period)
cannam@0: {
cannam@0:     int alignment = 0;
cannam@0:     int p = (int)MathUtilities::round( period );
cannam@0: 
cannam@0:     double temp = 0.0;
cannam@0: 
cannam@0:     double* y = new double[ winLength ];
cannam@0:     double* align = new double[ p ];
cannam@0: 
cannam@0:     for( int i = 0; i < winLength; i++ )
cannam@0:     {	
cannam@0: 	y[ i ] = (double)( -i + winLength  )/(double)winLength;
cannam@0:     }
cannam@0: 
cannam@0:     for( int o = 0; o < p; o++ )
cannam@0:     { 
cannam@0: 	temp = 0.0;
cannam@0: 	for(int i = 1 + (o - 1); i< winLength; i += (p + 1))
cannam@0: 	{
cannam@0: 	    temp = temp + DF[ i ] * y[ i ]; 
cannam@0: 	}
cannam@0: 	align[ o ] = temp * weighting[ o ];       
cannam@0:     }
cannam@0: 
cannam@0: 
cannam@0:     double valTemp = 0.0;
cannam@0:     for(int i = 0; i < p; i++)
cannam@0:     {
cannam@0: 	if( align[ i ] > valTemp )
cannam@0: 	{
cannam@0: 	    valTemp = align[ i ];
cannam@0: 	    alignment = i;
cannam@0: 	}
cannam@0:     }
cannam@0: 
cannam@0:     delete [] y;
cannam@0:     delete [] align;
cannam@0: 
cannam@0:     return alignment;
cannam@0: }
cannam@0: 
cannam@0: int TempoTrack::beatPredict(unsigned int FSP0, double alignment, double period, unsigned int step )
cannam@0: {
cannam@0:     int beat = 0;
cannam@0: 
cannam@0:     int p = (int)MathUtilities::round( period );
cannam@0:     int align = (int)MathUtilities::round( alignment );
cannam@0:     int FSP = (int)MathUtilities::round( FSP0 );
cannam@0: 
cannam@0:     int FEP = FSP + ( step );
cannam@0: 
cannam@0:     beat = FSP + align;
cannam@0: 
cannam@0:     m_beats.push_back( beat );
cannam@0: 
cannam@0:     while( beat + p < FEP )
cannam@0:     {
cannam@0: 	beat += p;
cannam@0: 		
cannam@0: 	m_beats.push_back( beat );
cannam@0:     }
cannam@0: 
cannam@0:     return beat;
cannam@0: }
cannam@0: 
cannam@0: vector<int> TempoTrack::process(double *DF, unsigned int length)
cannam@0: {
cannam@0:     m_dataLength = length;
cannam@0: 	
cannam@0:     double	period = 0.0;
cannam@0:     int stepFlag = 0;
cannam@0:     int constFlag = 0;
cannam@0:     int FSP = 0;
cannam@0:     int tsig = 0;
cannam@0:     int lastBeat = 0;
cannam@0: 
cannam@0: 	
cannam@0:     double* RW = new double[ m_lagLength ];
cannam@0:     for( unsigned int clear = 0; clear < m_lagLength; clear++){ RW[ clear ] = 0.0;}
cannam@0: 
cannam@0:     double* GW = new double[ m_lagLength ];
cannam@0:     for(unsigned int clear = 0; clear < m_lagLength; clear++){ GW[ clear ] = 0.0;}
cannam@0: 
cannam@0:     double* PW = new double[ m_lagLength ];
cannam@0:     for(unsigned int clear = 0; clear < m_lagLength; clear++){ PW[ clear ] = 0.0;}
cannam@0: 
cannam@0:     m_DFFramer.setSource( DF, m_dataLength );
cannam@0: 
cannam@0:     unsigned int TTFrames = m_DFFramer.getMaxNoFrames();
cannam@0: 	
cannam@0:     double* periodP = new double[ TTFrames ];
cannam@0:     for(unsigned int  clear = 0; clear < TTFrames; clear++){ periodP[ clear ] = 0.0;}
cannam@0: 	
cannam@0:     double* periodG = new double[ TTFrames ];
cannam@0:     for(unsigned int  clear = 0; clear < TTFrames; clear++){ periodG[ clear ] = 0.0;}
cannam@0: 	
cannam@0:     double* alignment = new double[ TTFrames ];
cannam@0:     for(unsigned int  clear = 0; clear < TTFrames; clear++){ alignment[ clear ] = 0.0;}
cannam@0: 
cannam@0:     m_beats.clear();
cannam@0: 
cannam@0:     createCombFilter( RW, m_lagLength, 0, 0 );
cannam@0: 
cannam@0:     int TTLoopIndex = 0;
cannam@0: 
cannam@0:     for( unsigned int i = 0; i < TTFrames; i++ )
cannam@0:     {
cannam@0: 	m_DFFramer.getFrame( m_rawDFFrame );
cannam@0: 
cannam@0: 	m_DFConditioning->process( m_rawDFFrame, m_smoothDFFrame );
cannam@0: 
cannam@0: 	m_correlator.doAutoUnBiased( m_smoothDFFrame, m_frameACF, m_winLength );
cannam@0: 		
cannam@0: 	periodP[ TTLoopIndex ] = tempoMM( m_frameACF, RW, 0 );
cannam@0: 
cannam@0: 	if( GW[ 0 ] != 0 )
cannam@0: 	{
cannam@0: 	    periodG[ TTLoopIndex ] = tempoMM( m_frameACF, GW, tsig );
cannam@0: 	}
cannam@0: 	else
cannam@0: 	{
cannam@0: 	    periodG[ TTLoopIndex ] = 0.0;
cannam@0: 	}
cannam@0: 
cannam@0: 	stepDetect( periodP, periodG, TTLoopIndex, &stepFlag );
cannam@0: 
cannam@0: 	if( stepFlag == 1)
cannam@0: 	{
cannam@0: 	    constDetect( periodP, TTLoopIndex, &constFlag );
cannam@0: 	    stepFlag = 0;
cannam@0: 	}
cannam@0: 	else
cannam@0: 	{
cannam@0: 	    stepFlag -= 1;
cannam@0: 	}
cannam@0: 
cannam@0: 	if( stepFlag < 0 )
cannam@0: 	{
cannam@0: 	    stepFlag = 0;
cannam@0: 	}
cannam@0: 
cannam@0: 	if( constFlag != 0)
cannam@0: 	{
cannam@0: 	    tsig = findMeter( m_frameACF, m_winLength, periodP[ TTLoopIndex ] );
cannam@0: 	
cannam@0: 	    createCombFilter( GW, m_lagLength, tsig, periodP[ TTLoopIndex ] );
cannam@0: 			
cannam@0: 	    periodG[ TTLoopIndex ] = tempoMM( m_frameACF, GW, tsig ); 
cannam@0: 
cannam@0: 	    period = periodG[ TTLoopIndex ];
cannam@0: 
cannam@0: 	    createPhaseExtractor( PW, m_winLength, period, FSP, 0 ); 
cannam@0: 
cannam@0: 	    constFlag = 0;
cannam@0: 
cannam@0: 	}
cannam@0: 	else
cannam@0: 	{
cannam@0: 	    if( GW[ 0 ] != 0 )
cannam@0: 	    {
cannam@0: 		period = periodG[ TTLoopIndex ];
cannam@0: 		createPhaseExtractor( PW, m_winLength, period, FSP, lastBeat ); 
cannam@0: 
cannam@0: 	    }
cannam@0: 	    else
cannam@0: 	    {
cannam@0: 		period = periodP[ TTLoopIndex ];
cannam@0: 		createPhaseExtractor( PW, m_winLength, period, FSP, 0 ); 
cannam@0: 	    }
cannam@0: 	}
cannam@0: 
cannam@0: 	alignment[ TTLoopIndex ] = phaseMM( m_rawDFFrame, PW, m_winLength, period ); 
cannam@0: 
cannam@0: 	lastBeat = beatPredict(FSP, alignment[ TTLoopIndex ], period, m_lagLength );
cannam@0: 
cannam@0: 	FSP += (m_lagLength);
cannam@0: 
cannam@0: 	TTLoopIndex++;
cannam@0:     }
cannam@0: 
cannam@0: 
cannam@0:     delete [] periodP;
cannam@0:     delete [] periodG;
cannam@0:     delete [] alignment;
cannam@0: 
cannam@0:     delete [] RW;
cannam@0:     delete [] GW;
cannam@0:     delete [] PW;
cannam@0: 
cannam@0:     return m_beats;
cannam@0: }
cannam@0: 
cannam@0: 
cannam@0: 
cannam@0: 
cannam@0: 
cannam@6: vector<int> TempoTrack::process( vector <double> DF,
cannam@6:                                  vector <double> *tempoReturn )
cannam@0: {
cannam@0:     m_dataLength = DF.size();
cannam@0: 	
cannam@6:     m_lockedTempo = 0.0;
cannam@6: 
cannam@0:     double	period = 0.0;
cannam@0:     int stepFlag = 0;
cannam@0:     int constFlag = 0;
cannam@0:     int FSP = 0;
cannam@0:     int tsig = 0;
cannam@0:     int lastBeat = 0;
cannam@0: 
cannam@0:     vector <double> causalDF;
cannam@0: 
cannam@0:     causalDF = DF;
cannam@0: 
cannam@0:     //Prepare Causal Extension DFData
cannam@0:     unsigned int DFCLength = m_dataLength + m_winLength;
cannam@0: 	
cannam@0:     for( unsigned int j = 0; j < m_winLength; j++ )
cannam@0:     {
cannam@0: 	causalDF.push_back( 0 );
cannam@0:     }
cannam@0: 	
cannam@0: 	
cannam@0:     double* RW = new double[ m_lagLength ];
cannam@0:     for( unsigned int clear = 0; clear < m_lagLength; clear++){ RW[ clear ] = 0.0;}
cannam@0: 
cannam@0:     double* GW = new double[ m_lagLength ];
cannam@0:     for(unsigned int clear = 0; clear < m_lagLength; clear++){ GW[ clear ] = 0.0;}
cannam@0: 
cannam@0:     double* PW = new double[ m_lagLength ];
cannam@0:     for(unsigned clear = 0; clear < m_lagLength; clear++){ PW[ clear ] = 0.0;}
cannam@0: 
cannam@0:     m_DFFramer.setSource( &causalDF[0], m_dataLength );
cannam@0: 
cannam@0:     unsigned int TTFrames = m_DFFramer.getMaxNoFrames();
cannam@0: 	
cannam@0:     double* periodP = new double[ TTFrames ];
cannam@0:     for(unsigned clear = 0; clear < TTFrames; clear++){ periodP[ clear ] = 0.0;}
cannam@0: 	
cannam@0:     double* periodG = new double[ TTFrames ];
cannam@0:     for(unsigned clear = 0; clear < TTFrames; clear++){ periodG[ clear ] = 0.0;}
cannam@0: 	
cannam@0:     double* alignment = new double[ TTFrames ];
cannam@0:     for(unsigned clear = 0; clear < TTFrames; clear++){ alignment[ clear ] = 0.0;}
cannam@0: 
cannam@0:     m_beats.clear();
cannam@0: 
cannam@0:     createCombFilter( RW, m_lagLength, 0, 0 );
cannam@0: 
cannam@0:     int TTLoopIndex = 0;
cannam@0: 
cannam@0:     for( unsigned int i = 0; i < TTFrames; i++ )
cannam@0:     {
cannam@0: 	m_DFFramer.getFrame( m_rawDFFrame );
cannam@0: 
cannam@0: 	m_DFConditioning->process( m_rawDFFrame, m_smoothDFFrame );
cannam@0: 
cannam@0: 	m_correlator.doAutoUnBiased( m_smoothDFFrame, m_frameACF, m_winLength );
cannam@0: 		
cannam@0: 	periodP[ TTLoopIndex ] = tempoMM( m_frameACF, RW, 0 );
cannam@0: 
cannam@0: 	if( GW[ 0 ] != 0 )
cannam@0: 	{
cannam@0: 	    periodG[ TTLoopIndex ] = tempoMM( m_frameACF, GW, tsig );
cannam@0: 	}
cannam@0: 	else
cannam@0: 	{
cannam@0: 	    periodG[ TTLoopIndex ] = 0.0;
cannam@0: 	}
cannam@0: 
cannam@0: 	stepDetect( periodP, periodG, TTLoopIndex, &stepFlag );
cannam@0: 
cannam@0: 	if( stepFlag == 1)
cannam@0: 	{
cannam@0: 	    constDetect( periodP, TTLoopIndex, &constFlag );
cannam@0: 	    stepFlag = 0;
cannam@0: 	}
cannam@0: 	else
cannam@0: 	{
cannam@0: 	    stepFlag -= 1;
cannam@0: 	}
cannam@0: 
cannam@0: 	if( stepFlag < 0 )
cannam@0: 	{
cannam@0: 	    stepFlag = 0;
cannam@0: 	}
cannam@0: 
cannam@0: 	if( constFlag != 0)
cannam@0: 	{
cannam@0: 	    tsig = findMeter( m_frameACF, m_winLength, periodP[ TTLoopIndex ] );
cannam@0: 	
cannam@0: 	    createCombFilter( GW, m_lagLength, tsig, periodP[ TTLoopIndex ] );
cannam@0: 			
cannam@0: 	    periodG[ TTLoopIndex ] = tempoMM( m_frameACF, GW, tsig ); 
cannam@0: 
cannam@0: 	    period = periodG[ TTLoopIndex ];
cannam@0: 
cannam@0: 	    createPhaseExtractor( PW, m_winLength, period, FSP, 0 ); 
cannam@0: 
cannam@0: 	    constFlag = 0;
cannam@0: 
cannam@0: 	}
cannam@0: 	else
cannam@0: 	{
cannam@0: 	    if( GW[ 0 ] != 0 )
cannam@0: 	    {
cannam@0: 		period = periodG[ TTLoopIndex ];
cannam@0: 		createPhaseExtractor( PW, m_winLength, period, FSP, lastBeat ); 
cannam@0: 
cannam@0: 	    }
cannam@0: 	    else
cannam@0: 	    {
cannam@0: 		period = periodP[ TTLoopIndex ];
cannam@0: 		createPhaseExtractor( PW, m_winLength, period, FSP, 0 ); 
cannam@0: 	    }
cannam@0: 	}
cannam@0: 
cannam@0: 	alignment[ TTLoopIndex ] = phaseMM( m_rawDFFrame, PW, m_winLength, period ); 
cannam@0: 
cannam@0: 	lastBeat = beatPredict(FSP, alignment[ TTLoopIndex ], period, m_lagLength );
cannam@0: 
cannam@0: 	FSP += (m_lagLength);
cannam@0: 
cannam@6:         if (tempoReturn) tempoReturn->push_back(m_lockedTempo);
cannam@6: 
cannam@0: 	TTLoopIndex++;
cannam@0:     }
cannam@0: 
cannam@0: 
cannam@0:     delete [] periodP;
cannam@0:     delete [] periodG;
cannam@0:     delete [] alignment;
cannam@0: 
cannam@0:     delete [] RW;
cannam@0:     delete [] GW;
cannam@0:     delete [] PW;
cannam@0: 
cannam@0:     return m_beats;
cannam@0: }