furnace/src/engine/filter.cpp
2023-09-08 00:41:47 -05:00

131 lines
No EOL
4 KiB
C++

/**
* Furnace Tracker - multi-system chiptune tracker
* Copyright (C) 2021-2023 tildearrow and contributors
*
* 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.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*/
#define _USE_MATH_DEFINES
#include <math.h>
#include "filter.h"
#include "../ta-log.h"
float* DivFilterTables::cubicTable=NULL;
float* DivFilterTables::sincTable=NULL;
float* DivFilterTables::sincTable8=NULL;
float* DivFilterTables::sincIntegralTable=NULL;
float* DivFilterTables::sincIntegralSmallTable=NULL;
// portions from Schism Tracker (scripts/lutgen.c)
// licensed under same license as this program.
float* DivFilterTables::getCubicTable() {
if (cubicTable==NULL) {
logD("initializing cubic spline table.");
cubicTable=new float[4096];
for (int i=0; i<1024; i++) {
float x=(float)i/1024.0;
cubicTable[(i<<2)]=-0.5*pow(x,3)+1.0*pow(x,2)-0.5*x;
cubicTable[1+(i<<2)]=1.5*pow(x,3)-2.5*pow(x,2)+1.0;
cubicTable[2+(i<<2)]=-1.5*pow(x,3)+2.0*pow(x,2)+0.5*x;
cubicTable[3+(i<<2)]=0.5*pow(x,3)-0.5*pow(x,2);
}
}
return cubicTable;
}
float* DivFilterTables::getSincTable() {
if (sincTable==NULL) {
logD("initializing sinc table.");
sincTable=new float[65536];
sincTable[0]=1.0f;
for (int i=1; i<65536; i++) {
int mapped=((i&8191)<<3)|(i>>13);
double x=(double)i*M_PI/8192.0;
sincTable[mapped]=sin(x)/x;
}
for (int i=0; i<65536; i++) {
int mapped=((i&8191)<<3)|(i>>13);
sincTable[mapped]*=pow(cos(M_PI*(double)i/131072.0),2.0);
}
}
return sincTable;
}
float* DivFilterTables::getSincTable8() {
if (sincTable8==NULL) {
logD("initializing sinc table (8).");
sincTable8=new float[32768];
sincTable8[0]=1.0f;
for (int i=1; i<32768; i++) {
int mapped=((i&8191)<<2)|(i>>13);
double x=(double)i*M_PI/8192.0;
sincTable8[mapped]=sin(x)/x;
}
for (int i=0; i<32768; i++) {
int mapped=((i&8191)<<2)|(i>>13);
sincTable8[mapped]*=pow(cos(M_PI*(double)i/65536.0),2.0);
}
}
return sincTable8;
}
float* DivFilterTables::getSincIntegralTable() {
if (sincIntegralTable==NULL) {
logD("initializing sinc integral table.");
sincIntegralTable=new float[65536];
sincIntegralTable[0]=-0.5f;
for (int i=1; i<65536; i++) {
int mapped=((i&8191)<<3)|(i>>13);
int mappedPrev=(((i-1)&8191)<<3)|((i-1)>>13);
double x=(double)i*M_PI/8192.0;
double sinc=sin(x)/x;
sincIntegralTable[mapped]=sincIntegralTable[mappedPrev]+(sinc/8192.0);
}
for (int i=0; i<65536; i++) {
int mapped=((i&8191)<<3)|(i>>13);
sincIntegralTable[mapped]*=pow(cos(M_PI*(double)i/131072.0),2.0);
}
}
return sincIntegralTable;
}
float* DivFilterTables::getSincIntegralSmallTable() {
if (sincIntegralSmallTable==NULL) {
logD("initializing small sinc integral table.");
sincIntegralSmallTable=new float[512];
sincIntegralSmallTable[0]=-0.5f;
for (int i=1; i<512; i++) {
int mapped=((i&63)<<3)|(i>>6);
int mappedPrev=(((i-1)&63)<<3)|((i-1)>>6);
double x=(double)i*M_PI/64.0;
double sinc=sin(x)/x;
sincIntegralSmallTable[mapped]=sincIntegralSmallTable[mappedPrev]+(sinc/64.0);
}
for (int i=0; i<512; i++) {
int mapped=((i&63)<<3)|(i>>6);
sincIntegralSmallTable[mapped]*=pow(cos(M_PI*(double)i/1024.0),2.0);
}
}
return sincIntegralSmallTable;
}