paulxstretch/Source/PS_Source/BinauralBeats.cpp
2017-11-16 02:48:24 +02:00

118 lines
3.0 KiB
C++

/*
Copyright (C) 2008-2011 Nasca Octavian Paul
Author: Nasca Octavian Paul
This program is free software; you can redistribute it and/or modify
it under the terms of version 2 of the GNU General Public License
as published by the Free Software Foundation.
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 (version 2) for more details.
You should have received a copy of the GNU General Public License (version 2)
along with this program; if not, write to the Free Software Foundation,
Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
#include <math.h>
#include <stdio.h>
#include "BinauralBeats.h"
/*
void BinauralBeatsParameters::add2XML(XMLwrapper *xml){
xml->addpar("stereo_mode",(int) stereo_mode);
xml->addparreal("mono",mono);
xml->beginbranch("FREE_EDIT");
free_edit.add2XML(xml);
xml->endbranch();
};
void BinauralBeatsParameters::getfromXML(XMLwrapper *xml){
stereo_mode=(BB_STEREO_MODE)xml->getpar("stereo_mode",(int) stereo_mode,0,2);
mono=xml->getparreal("mono",mono);
if (xml->enterbranch("FREE_EDIT")){
free_edit.getfromXML(xml);
xml->exitbranch();
};
};
*/
//coefficients of allpass filters are found by Olli Niemitalo
const REALTYPE Hilbert::coefl[]={0.6923877778065f, 0.9360654322959f, 0.9882295226860f, 0.9987488452737f};
const REALTYPE Hilbert::coefr[]={0.4021921162426f, 0.8561710882420f, 0.9722909545651f, 0.9952884791278f};
BinauralBeats::BinauralBeats(int samplerate_){
samplerate=samplerate_;
hilbert_t=0.0f;
};
void BinauralBeats::process(REALTYPE *smpsl,REALTYPE *smpsr,int nsmps,REALTYPE pos_percents){
// for (int i=0;i<nsmps;i++) smpsl[i]=smpsr[i]=sin(30.0*M_PI*i*2.0/nsmps)*0.4;
//printf(" enabled %d\n",pars.free_edit.get_enabled());
if (pars.free_edit.get_enabled()){
float mono=pars.mono*0.5f;
for (int i=0;i<nsmps;i++){
REALTYPE inl=smpsl[i];
REALTYPE inr=smpsr[i];
REALTYPE outl=inl*(1.0f-mono)+inr*mono;
REALTYPE outr=inr*(1.0f-mono)+inl*mono;
smpsl[i]=outl;
smpsr[i]=outr;
};
REALTYPE freq=pars.free_edit.get_value(pos_percents);
// freq=300;//test
freq*=0.5;//half down for left, half up for right
for (int i=0;i<nsmps;i++){
hilbert_t=fmod(hilbert_t+freq/samplerate,1.0f);
REALTYPE h1=0.0f,h2=0.0f;
hl.process(smpsl[i],h1,h2);
REALTYPE x=hilbert_t*2.0f*(float)M_PI;
REALTYPE m1=h1*cos(x);
REALTYPE m2=h2*sin(x);
REALTYPE outl1=m1+m2;
REALTYPE outl2=m1-m2;
h1=0;
h2=0;
hr.process(smpsr[i],h1,h2);
m1=h1*cos(x);
m2=h2*sin(x);
REALTYPE outr1=m1-m2;
REALTYPE outr2=m1+m2;
switch(pars.stereo_mode){
case SM_LEFT_RIGHT:
smpsl[i]=outl2;
smpsr[i]=outr2;
break;
case SM_RIGHT_LEFT:
smpsl[i]=outl1;
smpsr[i]=outr1;
break;
case SM_SYMMETRIC:
smpsl[i]=(outl1+outr1)*0.5f;
smpsr[i]=(outl2+outr2)*0.5f;
break;
};
};
};
};