/******************************************/
/*  Algorithm 3 (TX81Z) Subclass of       */ 
/*  4 Operator FM Synth                   */
/*  by Perry R. Cook, 1995-96             */ 
/*                                        */
/*  Alg 3 is :          4--\              */
/*                  3-->2-- + -->1-->Out  */
/*                                        */
/*  Controls: control1 = total mod index  */
/*            control2 = crossfade of two */
/*                          modulators    */
/*            control3 = LFO speed        */
/*            modWheel = LFO amount       */
/*                                        */
/******************************************/

#include "FM4Alg3.h"

FM4Alg3 :: FM4Alg3() : FM4Op()
{
        /*  We still don't make the waves here yet, because */
        /*  we still don't know what they will be.          */
}  

FM4Alg3 :: ~FM4Alg3()
{
}

MY_FLOAT FM4Alg3 :: tick()
{
    MY_FLOAT temp;

    temp = vibWave->tick() * modDepth * (MY_FLOAT) 0.2;    
    waves[0]->setFreq(baseFreq * ((MY_FLOAT) 1.0 + temp) * ratios[0]);
    waves[1]->setFreq(baseFreq * ((MY_FLOAT) 1.0 + temp) * ratios[1]);
    waves[2]->setFreq(baseFreq * ((MY_FLOAT) 1.0 + temp) * ratios[2]);
    waves[3]->setFreq(baseFreq * ((MY_FLOAT) 1.0 + temp) * ratios[3]);
    
    temp = gains[2] * adsr[2]->tick() * waves[2]->tick();
    waves[1]->addPhaseOffset(temp);
    
    waves[3]->addPhaseOffset(twozero->lastOut());
    temp = ((MY_FLOAT) 1.0 - (control2 * (MY_FLOAT) 0.5)) * 
				gains[3] * adsr[3]->tick() * waves[3]->tick();
    twozero->tick(temp);
    
    temp += control2 * (MY_FLOAT) 0.5 * gains[1] * adsr[1]->tick() * waves[1]->tick();
    temp = temp * control1;
    
    waves[0]->addPhaseOffset(temp);
    temp = gains[0] * adsr[0]->tick() * waves[0]->tick();
    
    lastOutput = temp * (MY_FLOAT) 0.5;
    return lastOutput;
}