123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804 |
- //$ 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
|