winamp/Src/external_dependencies/openmpt-trunk/include/r8brain/CDSPHBUpsampler.h

805 lines
27 KiB
C
Raw Normal View History

2024-09-24 12:54:57 +00:00
//$ nobt
//$ nocpp
/**
* @file CDSPHBUpsampler.h
*
* @brief Half-band upsampling class.
*
* This file includes half-band upsampling class.
*
* r8brain-free-src Copyright (c) 2013-2022 Aleksey Vaneev
* See the "LICENSE" file for license.
*/
#ifndef R8B_CDSPHBUPSAMPLER_INCLUDED
#define R8B_CDSPHBUPSAMPLER_INCLUDED
#include "CDSPProcessor.h"
namespace r8b {
/**
* @brief Half-band upsampling class.
*
* Class implements brute-force half-band 2X upsampling that uses small
* sparse symmetric FIR filters. It is very efficient and should be used at
* latter upsampling steps after initial steep 2X upsampling.
*/
class CDSPHBUpsampler : public CDSPProcessor
{
public:
/**
* Function that provides filter data for various steepness indices and
* attenuations.
*
* @param ReqAtten Required half-band filter attentuation.
* @param SteepIndex Steepness index - 0=steepest. Corresponds to general
* upsampling/downsampling ratio, e.g. at 4x 0 is used, at 8x 1 is used,
* etc.
*/
static void getHBFilter( const double ReqAtten, const int SteepIndex,
const double*& flt, int& fltt, double& att )
{
static const double HBKernel_4A[ 4 ] = { // -54.5176 dB, 4
6.1729335650971517e-001, -1.5963945620743250e-001,
5.5073370934086312e-002, -1.4603578989932850e-002,};
static const double HBKernel_5A[ 5 ] = { // -66.3075 dB, 4
6.2068807424902472e-001, -1.6827573634467302e-001,
6.5263016720721170e-002, -2.2483331611592005e-002,
5.2917326684281110e-003,};
static const double HBKernel_6A[ 6 ] = { // -89.5271 dB, 4
6.2187202340480707e-001, -1.7132842113816371e-001,
6.9019169178765674e-002, -2.5799728312695277e-002,
7.4880112525741666e-003, -1.2844465869952567e-003,};
static const double HBKernel_7A[ 7 ] = { // -105.2842 dB, 4
6.2354494135775851e-001, -1.7571220703702045e-001,
7.4529843603968457e-002, -3.0701736822442153e-002,
1.0716755639039573e-002, -2.7833422930759735e-003,
4.1118797093875510e-004,};
static const double HBKernel_8A[ 8 ] = { // -121.0063 dB, 4
6.2488363107953926e-001, -1.7924942606514119e-001,
7.9068155655640557e-002, -3.4907523415495731e-002,
1.3710256799907897e-002, -4.3991142586987933e-003,
1.0259190163889602e-003, -1.3278941979339359e-004,};
static const double HBKernel_9A[ 9 ] = { // -136.6982 dB, 4
6.2597763804021977e-001, -1.8216414325139055e-001,
8.2879104876726728e-002, -3.8563442248249404e-002,
1.6471530499739394e-002, -6.0489108881335227e-003,
1.7805283804140392e-003, -3.7533200112729561e-004,
4.3172840558735476e-005,};
static const double HBKernel_10A[ 10 ] = { // -152.3572 dB, 4
6.2688767582974092e-001, -1.8460766807559420e-001,
8.6128943000481864e-002, -4.1774474147006607e-002,
1.9014801985747346e-002, -7.6870397465866507e-003,
2.6264590175341853e-003, -7.1106660285478562e-004,
1.3645852036179345e-004, -1.4113888783332969e-005,};
static const double HBKernel_11A[ 11 ] = { // -183.7962 dB, 4
6.2667167706948146e-001, -1.8407153342635879e-001,
8.5529995610836046e-002, -4.1346831462361310e-002,
1.8844831691322637e-002, -7.7125170365394992e-003,
2.7268674860562087e-003, -7.9745028501057233e-004,
1.8116344606360795e-004, -2.8569149754241848e-005,
2.3667022010173616e-006,};
static const double HBKernel_12A[ 12 ] = { // -199.4768 dB, 4
6.2747849730367999e-001, -1.8623616784506747e-001,
8.8409755898467945e-002, -4.4207468821462342e-002,
2.1149175945115381e-002, -9.2551508371115209e-003,
3.5871562170822330e-003, -1.1923167653750219e-003,
3.2627812189920129e-004, -6.9106902511490413e-005,
1.0122897863125124e-005, -7.7531878906846174e-007,};
static const double HBKernel_13A[ 13 ] = { // -215.1364 dB, 4
6.2816416252367324e-001, -1.8809076955230414e-001,
9.0918539867353029e-002, -4.6765502683599310e-002,
2.3287520498995663e-002, -1.0760627245014184e-002,
4.4853922948425683e-003, -1.6438775426910800e-003,
5.1441312354764978e-004, -1.3211725685765050e-004,
2.6191319837779187e-005, -3.5802430606313093e-006,
2.5491278270628601e-007,};
static const double HBKernel_14A[ 14 ] = { // -230.7526 dB, 4
6.2875473120929948e-001, -1.8969941936903847e-001,
9.3126094480960403e-002, -4.9067251179869126e-002,
2.5273008851199916e-002, -1.2218646153393291e-002,
5.4048942085580280e-003, -2.1409919546078581e-003,
7.4250292812927973e-004, -2.1924542206832172e-004,
5.3015808983125091e-005, -9.8743034923598196e-006,
1.2650391141650221e-006, -8.4146674637474946e-008,};
static const int FltCountA = 11;
static const int FlttBaseA = 4;
static const double FltAttensA[ FltCountA ] = {
54.5176, 66.3075, 89.5271, 105.2842, 121.0063, 136.6982, 152.3572, 183.7962, 199.4768, 215.1364, 230.7526, };
static const double* const FltPtrsA[ FltCountA ] = {
HBKernel_4A, HBKernel_5A, HBKernel_6A, HBKernel_7A, HBKernel_8A, HBKernel_9A, HBKernel_10A, HBKernel_11A, HBKernel_12A, HBKernel_13A, HBKernel_14A, };
static const double HBKernel_2B[ 2 ] = { // -56.6007 dB, 8
5.7361525854329076e-001, -7.5092074924827903e-002,};
static const double HBKernel_3B[ 3 ] = { // -83.0295 dB, 8
5.9277038608066912e-001, -1.0851340190268854e-001,
1.5813570475513079e-002,};
static const double HBKernel_4B[ 4 ] = { // -123.4724 dB, 8
6.0140277542879617e-001, -1.2564483854574138e-001,
2.7446500598038322e-002, -3.2051079559057435e-003,};
static const double HBKernel_5B[ 5 ] = { // -152.4411 dB, 8
6.0818642429088932e-001, -1.3981140187175697e-001,
3.8489164054503623e-002, -7.6218861797853104e-003,
7.5772358130952392e-004,};
static const double HBKernel_6B[ 6 ] = { // -181.2501 dB, 8
6.1278392271464355e-001, -1.5000053762513338e-001,
4.7575323511364960e-002, -1.2320702802243476e-002,
2.1462442592348487e-003, -1.8425092381892940e-004,};
static const double HBKernel_7B[ 7 ] = { // -209.9472 dB, 8
6.1610372263478952e-001, -1.5767891882524138e-001,
5.5089691170294691e-002, -1.6895755656366061e-002,
3.9416643438213977e-003, -6.0603623791604668e-004,
4.5632602433393365e-005,};
static const double HBKernel_8B[ 8 ] = { // -238.5616 dB, 8
6.1861282914465976e-001, -1.6367179451225150e-001,
6.1369861342939716e-002, -2.1184466539006987e-002,
5.9623357510842061e-003, -1.2483098507454090e-003,
1.7099297537964702e-004, -1.1448313239478885e-005,};
static const int FltCountB = 7;
static const int FlttBaseB = 2;
static const double FltAttensB[ FltCountB ] = {
56.6007, 83.0295, 123.4724, 152.4411, 181.2501, 209.9472, 238.5616, };
static const double* const FltPtrsB[ FltCountB ] = {
HBKernel_2B, HBKernel_3B, HBKernel_4B, HBKernel_5B, HBKernel_6B, HBKernel_7B, HBKernel_8B, };
static const double HBKernel_2C[ 2 ] = { // -89.0473 dB, 16
5.6430278013478008e-001, -6.4338068855763375e-002,};
static const double HBKernel_3C[ 3 ] = { // -130.8951 dB, 16
5.8706402915551448e-001, -9.9362380958670449e-002,
1.2298637065869358e-002,};
static const double HBKernel_4C[ 4 ] = { // -172.3192 dB, 16
5.9896586134984675e-001, -1.2111680603434927e-001,
2.4763118076458895e-002, -2.6121758132212989e-003,};
static const double HBKernel_5C[ 5 ] = { // -213.4984 dB, 16
6.0626808285230716e-001, -1.3588224032740795e-001,
3.5544305238309003e-002, -6.5127022377289654e-003,
5.8255449565950768e-004,};
static const double HBKernel_6C[ 6 ] = { // -254.5186 dB, 16
6.1120171263351242e-001, -1.4654486853757870e-001,
4.4582959299131253e-002, -1.0840543858123995e-002,
1.7343706485509962e-003, -1.3363018567985596e-004,};
static const int FltCountC = 5;
static const int FlttBaseC = 2;
static const double FltAttensC[ FltCountC ] = {
89.0473, 130.8951, 172.3192, 213.4984, 254.5186, };
static const double* const FltPtrsC[ FltCountC ] = {
HBKernel_2C, HBKernel_3C, HBKernel_4C, HBKernel_5C, HBKernel_6C, };
static const double HBKernel_1D[ 1 ] = { // -54.4754 dB, 32
5.0188900022775451e-001,};
static const double HBKernel_2D[ 2 ] = { // -113.2139 dB, 32
5.6295152180538044e-001, -6.2953706070191726e-002,};
static const double HBKernel_3D[ 3 ] = { // -167.1447 dB, 32
5.8621968728755036e-001, -9.8080551656524531e-002,
1.1860868761997080e-002,};
static const double HBKernel_4D[ 4 ] = { // -220.6519 dB, 32
5.9835028657163591e-001, -1.1999986086623511e-001,
2.4132530854004228e-002, -2.4829565686819706e-003,};
static const int FltCountD = 4;
static const int FlttBaseD = 1;
static const double FltAttensD[ FltCountD ] = {
54.4754, 113.2139, 167.1447, 220.6519, };
static const double* const FltPtrsD[ FltCountD ] = {
HBKernel_1D, HBKernel_2D, HBKernel_3D, HBKernel_4D, };
static const double HBKernel_1E[ 1 ] = { // -66.5391 dB, 64
5.0047102586416625e-001,};
static const double HBKernel_2E[ 2 ] = { // -137.3173 dB, 64
5.6261293163933568e-001, -6.2613067826620017e-002,};
static const double HBKernel_3E[ 3 ] = { // -203.2997 dB, 64
5.8600808139396787e-001, -9.7762185880067784e-002,
1.1754104554493029e-002,};
static const double HBKernel_4E[ 4 ] = { // -268.8550 dB, 64
5.9819599352772002e-001, -1.1972157555011861e-001,
2.3977305567947922e-002, -2.4517235455853992e-003,};
static const int FltCountE = 4;
static const int FlttBaseE = 1;
static const double FltAttensE[ FltCountE ] = {
66.5391, 137.3173, 203.2997, 268.8550, };
static const double* const FltPtrsE[ FltCountE ] = {
HBKernel_1E, HBKernel_2E, HBKernel_3E, HBKernel_4E, };
static const double HBKernel_1F[ 1 ] = { // -82.4633 dB, 128
5.0007530666642896e-001,};
static const double HBKernel_2F[ 2 ] = { // -161.4049 dB, 128
5.6252823610146030e-001, -6.2528244608044792e-002,};
static const double HBKernel_3F[ 3 ] = { // -239.4313 dB, 128
5.8595514744674237e-001, -9.7682725156791952e-002,
1.1727577711117231e-002,};
static const int FltCountF = 3;
static const int FlttBaseF = 1;
static const double FltAttensF[ FltCountF ] = {
82.4633, 161.4049, 239.4313, };
static const double* const FltPtrsF[ FltCountF ] = {
HBKernel_1F, HBKernel_2F, HBKernel_3F, };
static const double HBKernel_1G[ 1 ] = { // -94.5052 dB, 256
5.0001882524896712e-001,};
static const double HBKernel_2G[ 2 ] = { // -185.4886 dB, 256
5.6250705922479682e-001, -6.2507059756378394e-002,};
static const double HBKernel_3G[ 3 ] = { // -275.5501 dB, 256
5.8594191201187384e-001, -9.7662868266991207e-002,
1.1720956255134043e-002,};
static const int FltCountG = 3;
static const int FlttBaseG = 1;
static const double FltAttensG[ FltCountG ] = {
94.5052, 185.4886, 275.5501, };
static const double* const FltPtrsG[ FltCountG ] = {
HBKernel_1G, HBKernel_2G, HBKernel_3G, };
int k = 0;
if( SteepIndex <= 0 )
{
while( k != FltCountA - 1 && FltAttensA[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsA[ k ];
fltt = FlttBaseA + k;
att = FltAttensA[ k ];
}
else
if( SteepIndex == 1 )
{
while( k != FltCountB - 1 && FltAttensB[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsB[ k ];
fltt = FlttBaseB + k;
att = FltAttensB[ k ];
}
else
if( SteepIndex == 2 )
{
while( k != FltCountC - 1 && FltAttensC[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsC[ k ];
fltt = FlttBaseC + k;
att = FltAttensC[ k ];
}
else
if( SteepIndex == 3 )
{
while( k != FltCountD - 1 && FltAttensD[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsD[ k ];
fltt = FlttBaseD + k;
att = FltAttensD[ k ];
}
else
if( SteepIndex == 4 )
{
while( k != FltCountE - 1 && FltAttensE[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsE[ k ];
fltt = FlttBaseE + k;
att = FltAttensE[ k ];
}
else
if( SteepIndex == 5 )
{
while( k != FltCountF - 1 && FltAttensF[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsF[ k ];
fltt = FlttBaseF + k;
att = FltAttensF[ k ];
}
else
{
while( k != FltCountG - 1 && FltAttensG[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsG[ k ];
fltt = FlttBaseG + k;
att = FltAttensG[ k ];
}
}
/**
* Function that provides filter data for various steepness indices and
* attenuations. For 1/3 resamplings.
*
* @param ReqAtten Required half-band filter attentuation.
* @param SteepIndex Steepness index - 0=steepest. Corresponds to general
* upsampling/downsampling ratio, e.g. at 4x 0 is used, at 8x 1 is used,
* etc.
*/
static void getHBFilterThird( const double ReqAtten, const int SteepIndex,
const double*& flt, int& fltt, double& att )
{
static const double HBKernel_3A[ 3 ] = { // -66.3726 dB, 6
5.9811355069551475e-001, -1.1793396656733847e-001,
2.0300557211946322e-002,};
static const double HBKernel_4A[ 4 ] = { // -90.2546 dB, 6
6.0645499250612578e-001, -1.3555496505481171e-001,
3.4022804962365975e-002, -4.9535418595798757e-003,};
static const double HBKernel_5A[ 5 ] = { // -126.5507 dB, 6
6.1014115058940210e-001, -1.4393081816629907e-001,
4.1760642892852244e-002, -8.9692183234056175e-003,
9.9871340618342070e-004,};
static const double HBKernel_6A[ 6 ] = { // -150.1839 dB, 6
6.1439563420546972e-001, -1.5360187826905250e-001,
5.0840891345687034e-002, -1.4053648740561121e-002,
2.6771286587305727e-003, -2.5815816044823123e-004,};
static const double HBKernel_7A[ 7 ] = { // -173.7068 dB, 6
6.1747493476329918e-001, -1.6087373733313212e-001,
5.8263075641409430e-002, -1.8872408173431318e-002,
4.7421376543513687e-003, -8.0196529612267474e-004,
6.7964807393798996e-005,};
static const double HBKernel_8A[ 8 ] = { // -197.1454 dB, 6
6.1980610947775050e-001, -1.6654070578314714e-001,
6.4416567441730327e-002, -2.3307744348719822e-002,
6.9909157372312443e-003, -1.5871946293364403e-003,
2.4017727382382763e-004, -1.8125308241541697e-005,};
static const double HBKernel_9A[ 9 ] = { // -220.5199 dB, 6
6.2163188951899306e-001, -1.7108115323810941e-001,
6.9588370095600260e-002, -2.7339625080613838e-002,
9.2954469183791771e-003, -2.5537179959555429e-003,
5.2572290897951021e-004, -7.1813356135154921e-005,
4.8802382808892154e-006,};
static const int FltCountA = 7;
static const int FlttBaseA = 3;
static const double FltAttensA[ FltCountA ] = {
66.3726, 90.2546, 126.5507, 150.1839, 173.7068, 197.1454, 220.5199, };
static const double* const FltPtrsA[ FltCountA ] = {
HBKernel_3A, HBKernel_4A, HBKernel_5A, HBKernel_6A, HBKernel_7A, HBKernel_8A, HBKernel_9A, };
static const double HBKernel_2B[ 2 ] = { // -71.0965 dB, 12
5.6748544264806311e-001, -6.7764090509431732e-002,};
static const double HBKernel_3B[ 3 ] = { // -115.7707 dB, 12
5.8793612182667199e-001, -1.0070583248877293e-001,
1.2771337947163834e-002,};
static const double HBKernel_4B[ 4 ] = { // -152.1535 dB, 12
5.9960155600862808e-001, -1.2228154335199336e-001,
2.5433718917694709e-002, -2.7537562530837154e-003,};
static const double HBKernel_5B[ 5 ] = { // -188.2914 dB, 12
6.0676859170554343e-001, -1.3689667009876413e-001,
3.6288512631926818e-002, -6.7838855305035351e-003,
6.2345167677087547e-004,};
static const double HBKernel_6B[ 6 ] = { // -224.2705 dB, 12
6.1161456341904397e-001, -1.4743901958274458e-001,
4.5344160157313275e-002, -1.1207371780924531e-002,
1.8328497112594935e-003, -1.4518193006359589e-004,};
static const int FltCountB = 5;
static const int FlttBaseB = 2;
static const double FltAttensB[ FltCountB ] = {
71.0965, 115.7707, 152.1535, 188.2914, 224.2705, };
static const double* const FltPtrsB[ FltCountB ] = {
HBKernel_2B, HBKernel_3B, HBKernel_4B, HBKernel_5B, HBKernel_6B, };
static const double HBKernel_1C[ 1 ] = { // -49.4544 dB, 24
5.0336730531430562e-001,};
static const double HBKernel_2C[ 2 ] = { // -103.1970 dB, 24
5.6330232648142819e-001, -6.3309247177420452e-002,};
static const double HBKernel_3C[ 3 ] = { // -152.1195 dB, 24
5.8643891113580415e-001, -9.8411593011583087e-002,
1.1972706651483846e-002,};
static const double HBKernel_4C[ 4 ] = { // -200.6182 dB, 24
5.9851012363917222e-001, -1.2028885239978220e-001,
2.4294521083140615e-002, -2.5157924156609776e-003,};
static const double HBKernel_5C[ 5 ] = { // -248.8730 dB, 24
6.0590922882030196e-001, -1.3515953438018685e-001,
3.5020857107815606e-002, -6.3256196990467053e-003,
5.5506815147598793e-004,};
static const int FltCountC = 5;
static const int FlttBaseC = 1;
static const double FltAttensC[ FltCountC ] = {
49.4544, 103.1970, 152.1195, 200.6182, 248.8730, };
static const double* const FltPtrsC[ FltCountC ] = {
HBKernel_1C, HBKernel_2C, HBKernel_3C, HBKernel_4C, HBKernel_5C, };
static const double HBKernel_1D[ 1 ] = { // -61.5357 dB, 48
5.0083794231068057e-001,};
static const double HBKernel_2D[ 2 ] = { // -127.3167 dB, 48
5.6270074379958690e-001, -6.2701174487726344e-002,};
static const double HBKernel_3D[ 3 ] = { // -188.2990 dB, 48
5.8606296210323228e-001, -9.7844644765123029e-002,
1.1781683046528768e-002,};
static const double HBKernel_4D[ 4 ] = { // -248.8580 dB, 48
5.9823601243162516e-001, -1.1979368994739022e-001,
2.4017458606412575e-002, -2.4597810910081913e-003,};
static const int FltCountD = 4;
static const int FlttBaseD = 1;
static const double FltAttensD[ FltCountD ] = {
61.5357, 127.3167, 188.2990, 248.8580, };
static const double* const FltPtrsD[ FltCountD ] = {
HBKernel_1D, HBKernel_2D, HBKernel_3D, HBKernel_4D, };
static const double HBKernel_1E[ 1 ] = { // -77.4651 dB, 96
5.0013388897382527e-001,};
static const double HBKernel_2E[ 2 ] = { // -151.4084 dB, 96
5.6255019604317880e-001, -6.2550222932381064e-002,};
static const double HBKernel_3E[ 3 ] = { // -224.4365 dB, 96
5.8596887234201078e-001, -9.7703321113080305e-002,
1.1734448777069783e-002,};
static const int FltCountE = 3;
static const int FlttBaseE = 1;
static const double FltAttensE[ FltCountE ] = {
77.4651, 151.4084, 224.4365, };
static const double* const FltPtrsE[ FltCountE ] = {
HBKernel_1E, HBKernel_2E, HBKernel_3E, };
static const double HBKernel_1F[ 1 ] = { // -89.5075 dB, 192
5.0003346776264190e-001,};
static const double HBKernel_2F[ 2 ] = { // -175.4932 dB, 192
5.6251254964097952e-001, -6.2512551321105267e-002,};
static const double HBKernel_3F[ 3 ] = { // -260.5645 dB, 192
5.8594534336747051e-001, -9.7668015838639821e-002,
1.1722672471262996e-002,};
static const int FltCountF = 3;
static const int FlttBaseF = 1;
static const double FltAttensF[ FltCountF ] = {
89.5075, 175.4932, 260.5645, };
static const double* const FltPtrsF[ FltCountF ] = {
HBKernel_1F, HBKernel_2F, HBKernel_3F, };
static const double HBKernel_1G[ 1 ] = { // -101.5490 dB, 384
5.0000836666064941e-001,};
static const double HBKernel_2G[ 2 ] = { // -199.5761 dB, 384
5.6250313744943459e-001, -6.2503137554435345e-002,};
static const double HBKernel_3G[ 3 ] = { // -296.5185 dB, 384
5.8593945786963764e-001, -9.7659186853499613e-002,
1.1719728983863425e-002,};
static const int FltCountG = 3;
static const int FlttBaseG = 1;
static const double FltAttensG[ FltCountG ] = {
101.5490, 199.5761, 296.5185, };
static const double* const FltPtrsG[ FltCountG ] = {
HBKernel_1G, HBKernel_2G, HBKernel_3G, };
int k = 0;
if( SteepIndex <= 0 )
{
while( k != FltCountA - 1 && FltAttensA[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsA[ k ];
fltt = FlttBaseA + k;
att = FltAttensA[ k ];
}
else
if( SteepIndex == 1 )
{
while( k != FltCountB - 1 && FltAttensB[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsB[ k ];
fltt = FlttBaseB + k;
att = FltAttensB[ k ];
}
else
if( SteepIndex == 2 )
{
while( k != FltCountC - 1 && FltAttensC[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsC[ k ];
fltt = FlttBaseC + k;
att = FltAttensC[ k ];
}
else
if( SteepIndex == 3 )
{
while( k != FltCountD - 1 && FltAttensD[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsD[ k ];
fltt = FlttBaseD + k;
att = FltAttensD[ k ];
}
else
if( SteepIndex == 4 )
{
while( k != FltCountE - 1 && FltAttensE[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsE[ k ];
fltt = FlttBaseE + k;
att = FltAttensE[ k ];
}
else
if( SteepIndex == 5 )
{
while( k != FltCountF - 1 && FltAttensF[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsF[ k ];
fltt = FlttBaseF + k;
att = FltAttensF[ k ];
}
else
{
while( k != FltCountG - 1 && FltAttensG[ k ] < ReqAtten )
{
k++;
}
flt = FltPtrsG[ k ];
fltt = FlttBaseG + k;
att = FltAttensG[ k ];
}
}
/**
* Constructor initalizes the half-band upsampler.
*
* @param ReqAtten Required half-band filter attentuation.
* @param SteepIndex Steepness index - 0=steepest. Corresponds to general
* upsampling ratio, e.g. at 4x upsampling 0 is used, at 8x upsampling 1
* is used, etc.
* @param IsThird "True" if 1/3 of frequency response resampling is
* performed.
* @param PrevLatency Latency, in samples (any value >=0), which was left
* in the output signal by a previous process. Whole-number latency will
* be consumed by *this object while remaining fractional latency can be
* obtained via the getLatencyFrac() function.
* @param aDoConsumeLatency "True" if the output latency should be
* consumed. Does not apply to the fractional part of the latency (if such
* part is available).
*/
CDSPHBUpsampler( const double ReqAtten, const int SteepIndex,
const bool IsThird, const double PrevLatency,
const bool aDoConsumeLatency = true )
: DoConsumeLatency( aDoConsumeLatency )
{
static const CConvolveFn FltConvFn[ 14 ] = {
&CDSPHBUpsampler :: convolve1, &CDSPHBUpsampler :: convolve2,
&CDSPHBUpsampler :: convolve3, &CDSPHBUpsampler :: convolve4,
&CDSPHBUpsampler :: convolve5, &CDSPHBUpsampler :: convolve6,
&CDSPHBUpsampler :: convolve7, &CDSPHBUpsampler :: convolve8,
&CDSPHBUpsampler :: convolve9, &CDSPHBUpsampler :: convolve10,
&CDSPHBUpsampler :: convolve11, &CDSPHBUpsampler :: convolve12,
&CDSPHBUpsampler :: convolve13, &CDSPHBUpsampler :: convolve14 };
const double* fltp0;
int fltt;
double att;
if( IsThird )
{
getHBFilterThird( ReqAtten, SteepIndex, fltp0, fltt, att );
}
else
{
getHBFilter( ReqAtten, SteepIndex, fltp0, fltt, att );
}
// Copy obtained filter to address-aligned buffer.
fltp = alignptr( FltBuf, 16 );
memcpy( fltp, fltp0, fltt * sizeof( fltp[ 0 ]));
convfn = FltConvFn[ fltt - 1 ];
fll = fltt - 1;
fl2 = fltt;
flo = fll + fl2;
BufRP = Buf + fll;
LatencyFrac = PrevLatency * 2.0;
Latency = (int) LatencyFrac;
LatencyFrac -= Latency;
R8BASSERT( Latency >= 0 );
if( DoConsumeLatency )
{
flb = BufLen - fll;
}
else
{
Latency += fl2 + fl2;
flb = BufLen - flo;
}
R8BCONSOLE( "CDSPHBUpsampler: sti=%i third=%i taps=%i att=%.1f "
"io=2/1\n", SteepIndex, (int) IsThird, fltt, att );
clear();
}
virtual int getLatency() const
{
return( DoConsumeLatency ? 0 : Latency );
}
virtual double getLatencyFrac() const
{
return( LatencyFrac );
}
virtual int getMaxOutLen( const int MaxInLen ) const
{
R8BASSERT( MaxInLen >= 0 );
return( MaxInLen << 1 );
}
virtual void clear()
{
if( DoConsumeLatency )
{
LatencyLeft = Latency;
BufLeft = 0;
}
else
{
LatencyLeft = 0;
BufLeft = fl2;
}
WritePos = 0;
ReadPos = flb; // Set "read" position to account for filter's latency.
memset( &Buf[ ReadPos ], 0, ( BufLen - flb ) * sizeof( Buf[ 0 ]));
}
virtual int process( double* ip, int l, double*& op0 )
{
R8BASSERT( l >= 0 );
double* op = op0;
while( l > 0 )
{
// Add new input samples to both halves of the ring buffer.
const int b = min( min( l, BufLen - WritePos ), flb - BufLeft );
double* const wp1 = Buf + WritePos;
memcpy( wp1, ip, b * sizeof( wp1[ 0 ]));
if( WritePos < flo )
{
const int c = min( b, flo - WritePos );
memcpy( wp1 + BufLen, wp1, c * sizeof( wp1[ 0 ]));
}
ip += b;
WritePos = ( WritePos + b ) & BufLenMask;
l -= b;
BufLeft += b;
// Produce output.
if( BufLeft > fl2 )
{
const int c = BufLeft - fl2;
double* const opend = op + ( c + c );
( *convfn )( op, opend, fltp, BufRP, ReadPos );
op = opend;
ReadPos = ( ReadPos + c ) & BufLenMask;
BufLeft -= c;
}
}
int ol = (int) ( op - op0 );
if( LatencyLeft != 0 )
{
if( LatencyLeft >= ol )
{
LatencyLeft -= ol;
return( 0 );
}
ol -= LatencyLeft;
op0 += LatencyLeft;
LatencyLeft = 0;
}
return( ol );
}
private:
static const int BufLenBits = 9; ///< The length of the ring buffer,
///< expressed as Nth power of 2. This value can be reduced if it is
///< known that only short input buffers will be passed to the
///< interpolator. The minimum value of this parameter is 5, and
///< 1 << BufLenBits should be at least 3 times larger than the
///< FilterLen.
///<
static const int BufLen = 1 << BufLenBits; ///< The length of the ring
///< buffer. The actual length is twice as long to allow "beyond max
///< position" positioning.
///<
static const int BufLenMask = BufLen - 1; ///< Mask used for quick buffer
///< position wrapping.
///<
double Buf[ BufLen + 27 ]; ///< The ring buffer, including overrun
///< protection for the largest filter.
///<
double FltBuf[ 14 + 2 ]; ///< Holder for half-band filter taps, used with
///< 16-byte address-aligning, for SIMD use.
///<
double* fltp; ///< Half-band filter taps, points to FltBuf.
///<
int fll; ///< Input latency.
///<
int fl2; ///< Right-side filter length.
///<
int flo; ///< Overrrun length.
///<
int flb; ///< Initial read position and maximal buffer write length.
///<
const double* BufRP; ///< Offseted Buf pointer at ReadPos=0.
///<
bool DoConsumeLatency; ///< "True" if the output latency should be
///< consumed. Does not apply to the fractional part of the latency
///< (if such part is available).
///<
int Latency; ///< Initial latency that should be removed from the output.
///<
double LatencyFrac; ///< Fractional latency left on the output.
///<
int BufLeft; ///< The number of samples left in the buffer to process.
///< When this value is below FilterLenD2Plus1, the interpolation
///< cycle ends.
///<
int WritePos; ///< The current buffer write position. Incremented together
///< with the BufLeft variable.
///<
int ReadPos; ///< The current buffer read position.
///<
int LatencyLeft; ///< Latency left to remove.
///<
typedef void( *CConvolveFn )( double* op, double* const opend,
const double* const flt, const double* const rp0, int rpos ); ///<
///< Convolution function type.
///<
CConvolveFn convfn; ///< Convolution function in use.
///<
#define R8BHBC1( fn ) \
static void fn( double* op, double* const opend, const double* const flt, \
const double* const rp0, int rpos ) \
{ \
while( op != opend ) \
{ \
const double* const rp = rp0 + rpos; \
op[ 0 ] = rp[ 0 ];
#define R8BHBC2 \
rpos = ( rpos + 1 ) & BufLenMask; \
op += 2; \
} \
}
#include "CDSPHBUpsampler.inc"
#undef R8BHBC1
#undef R8BHBC2
};
// ---------------------------------------------------------------------------
} // namespace r8b
#endif // R8B_CDSPHBUPSAMPLER_INCLUDED