////////////////////////////////////////////////////////////////////////
// This file is part of the SndObj library
//
// This program is free software; you can redistribute it and/or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation; either version 2 of the License, or
// (at your option) any later version.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
// GNU General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program; if not, write to the Free Software
// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
//
// Copyright (c)Victor Lazzarini, 1997-2004
// See License.txt for a disclaimer of all warranties
// and licensing information
#include "SinSyn.h"
SinSyn::SinSyn(){
m_factor = m_vecsize/m_sr;
m_facsqr = m_factor*m_factor;
m_ptable = 0;
m_size = 0;
m_LoTWOPI = 0.f;
m_maxtracks = 0;
m_freqs = 0;
m_amps = 0;
m_phases = 0;
m_trackID = 0;
m_scale = 0.f;
m_ratio = 0.f;
m_tracks = 0;
AddMsg("max tracks", 21);
AddMsg("scale", 23);
AddMsg("table", 24);
}
SinSyn::SinSyn(SinAnal* input, int maxtracks, Table* table,
double scale, int vecsize, double sr)
:SndObj(input, vecsize, sr){
m_ptable = table;
m_size = m_ptable->GetLen();
m_LoTWOPI = m_size/TWOPI;
m_factor = m_vecsize/m_sr;
m_facsqr = m_factor*m_factor;
m_maxtracks = maxtracks;
m_tracks = 0;
m_scale = scale;
m_input = input;
m_freqs = new double[m_maxtracks];
m_amps = new double[m_maxtracks];
m_phases = new double[m_maxtracks];
m_trackID = new int[m_maxtracks];
memset(m_freqs, 0, sizeof(double) * m_maxtracks);
memset(m_amps, 0, sizeof(double) * m_maxtracks);
memset(m_phases, 0, sizeof(double) * m_maxtracks);
memset(m_trackID, 0, sizeof(int) * m_maxtracks);
m_incr = 0.f;
m_ratio = m_size/m_sr;
AddMsg("max tracks", 21);
AddMsg("scale", 23);
AddMsg("table", 24);
AddMsg("timescale", 24);
memset(m_trackID, 0, sizeof(int));
}
SinSyn::~SinSyn(){
delete[] m_freqs;
delete[] m_amps;
delete[] m_phases;
delete[] m_trackID;
}
void
SinSyn::SetTable(Table *table){
m_ptable = table;
m_size = m_ptable->GetLen();
m_LoTWOPI = m_size/TWOPI;
m_ratio = m_size/m_sr;
}
int
SinSyn::Connect(char* mess, void* input){
switch (FindMsg(mess)){
case 24:
SetTable((Table *) input);
return 1;
default:
return SndObj::Connect(mess,input);
}
}
int
SinSyn::Set(char* mess, double value){
switch(FindMsg(mess)){
case 21:
SetMaxTracks((int)value);
return 1;
case 23:
SetScale(value);
return 1;
default:
return SndObj::Set(mess, value);
}
}
void
SinSyn::SetMaxTracks(int maxtracks){
if(m_maxtracks){
delete[] m_freqs;
delete[] m_amps;
delete[] m_phases;
delete[] m_trackID;
}
m_maxtracks = maxtracks;
m_freqs = new double[m_maxtracks];
m_amps = new double[m_maxtracks];
m_phases = new double[m_maxtracks];
m_trackID = new int[m_maxtracks];
memset(m_freqs, 0, sizeof(double) * m_maxtracks);
memset(m_amps, 0, sizeof(double) * m_maxtracks);
memset(m_phases, 0, sizeof(double) * m_maxtracks);
memset(m_trackID, 0, sizeof(int) * m_maxtracks);
}
short
SinSyn::DoProcess(){
if(m_input){
double ampnext,amp,freq, freqnext, phase,phasenext;
double a2, a3, phasediff, cph;
int i3, i, j, ID, track;
int notcontin = 0;
bool contin = false;
int oldtracks = m_tracks;
double* tab = m_ptable->GetTable();
if((m_tracks = ((SinAnal *)m_input)->GetTracks()) >
m_maxtracks) m_tracks = m_maxtracks;
memset(m_output, 0, sizeof(double)*m_vecsize);
// for each track
i = j = 0;
while(i < m_tracks*3){
i3 = i/3;
ampnext = m_input->Output(i)*m_scale;
freqnext = m_input->Output(i+1)*TWOPI;
phasenext = m_input->Output(i+2);
ID = ((SinAnal *)m_input)->GetTrackID(i3);
j = i3+notcontin;
if(i3 < oldtracks-notcontin){
if(m_trackID[j]==ID){
// if this is a continuing track
track = j;
contin = true;
freq = m_freqs[track];
phase = m_phases[track];
amp = m_amps[track];
}
else {
// if this is a dead track
contin = false;
track = j;
freqnext = freq = m_freqs[track];
phase = m_phases[track];
phasenext = phase + freq*m_factor;
amp = m_amps[track];
ampnext = 0.f;
}
}
else{
// new tracks
contin = true;
track = -1;
freq = freqnext;
phase = phasenext - freq*m_factor;
amp = 0.f;
}
// phasediff
phasediff = phasenext - phase;
while(phasediff >= PI) phasediff -= TWOPI;
while(phasediff < -PI) phasediff += TWOPI;
// update phasediff to match the freq
cph = ((freq+freqnext)*m_factor/2. - phasediff)/TWOPI;
phasediff += TWOPI * Ftoi(cph + 0.5);
// interpolation coefs
a2 = 3./m_facsqr * (phasediff - m_factor/3.*(2*freq+freqnext));
a3 = 1./(3*m_facsqr) * (freqnext - freq - 2*a2*m_factor);
// interpolation resynthesis loop
double inc1, inc2, a, ph, cnt, frac;
int ndx;
a = amp;
ph = phase;
cnt = 0;
inc1 = (ampnext - amp)/m_vecsize;
inc2 = 1/m_sr;
for(m_vecpos=0; m_vecpos < m_vecsize; m_vecpos++){
if(m_enable) {
// table lookup oscillator
ph *= m_LoTWOPI;
while(ph < 0) ph += m_size;
while(ph >= m_size) ph -= m_size;
ndx = Ftoi(ph);
frac = ph - ndx;
m_output[m_vecpos] += a*(tab[ndx] + (tab[ndx+1] - tab[ndx])*frac);
a += inc1;
cnt += inc2;
ph = phase + cnt*(freq + cnt*(a2 + a3*cnt));
}
else m_output[m_vecpos] = 0.f;
}
// keep amp, freq, and phase values for next time
if(contin){
m_amps[i3] = ampnext;
m_freqs[i3] = freqnext;
while(phasenext < 0) phasenext += TWOPI;
while(phasenext >= TWOPI) phasenext -= TWOPI;
m_phases[i3] = phasenext;
m_trackID[i3] = ID;
i += 3;
} else notcontin++;
}
return 1;
}
else {
m_error = 1;
return 0;
}
}