131 lines
		
	
	
		
			4 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			131 lines
		
	
	
		
			4 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
/**
 | 
						|
 * Furnace Tracker - multi-system chiptune tracker
 | 
						|
 * Copyright (C) 2021-2024 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;
 | 
						|
} |