orastron/brickworks
2
1
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases 10 Wiki Activity
4487ef2176
brickworks/include/bw_iir2.h

836 lines
22 KiB
C++
Raw Blame History

/*
* Brickworks
*
* Copyright (C) 2025 Orastron Srl unipersonale
*
* Brickworks 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, version 3 of the License.
*
* Brickworks 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 Brickworks. If not, see <http://www.gnu.org/licenses/>.
*
* File author: Stefano D'Angelo
*/
/*!
* module_type {{{ utility }}}
* version {{{ 1.0.0 }}}
* requires {{{ bw_common bw_math }}}
* description {{{
* XXX
* }}}
* changelog {{{
* <ul>
* <li>Version <strong>1.0.0</strong>:
* <ul>
* <li>First release.</li>
* </ul>
* </li>
* </ul>
* }}}
*/
#ifndef BW_IIR2_H
#define BW_IIR2_H
#ifdef BW_INCLUDE_WITH_QUOTES
# include "bw_common.h"
#else
# include <bw_common.h>
#endif
#if !defined(BW_CXX_NO_EXTERN_C) && defined(__cplusplus)
extern "C" {
#endif
/*** Public API ***/
/*! api {{{
* #### bw_iir2_reset()
* ```>>> */
static inline void bw_iir2_reset(
float x_0,
float * BW_RESTRICT y_0,
float * BW_RESTRICT s1_0,
float * BW_RESTRICT s2_0,
float b0,
float b1,
float b2,
float a1,
float a2);
/*! <<<```
* XXX.
*
* #### bw_iir2_reset_multi()
* ```>>> */
static inline void bw_iir2_reset_multi(
const float * x_0,
float * y_0,
float * BW_RESTRICT s1_0,
float * s2_0,
float b0,
float b1,
float b2,
float a1,
float a2,
size_t n_channels);
/*! <<<```
* XXX.
*
* #### bw_iir2_process1()
* ```>>> */
static inline void bw_iir2_process1(
float x,
float * BW_RESTRICT y,
float * BW_RESTRICT s1,
float * BW_RESTRICT s2,
float b0,
float b1,
float b2,
float a1,
float a2);
/*! <<<```
* XXX.
*
* #### bw_iir2_process()
* ```>>> */
static inline void bw_iir2_process(
const float * x,
float * y,
float * BW_RESTRICT s1,
float * BW_RESTRICT s2,
float b0,
float b1,
float b2,
float a1,
float a2,
size_t n_samples);
/*! <<<```
* XXX
*
* #### bw_iir2_process_multi()
* ```>>> */
static inline void bw_iir2_process_multi(
const float * const * x,
float * const * y,
float * BW_RESTRICT s1,
float * BW_RESTRICT s2,
float b0,
float b1,
float b2,
float a1,
float a2,
size_t n_channels,
size_t n_samples);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_ap2()
* ```>>> */
static inline void bw_iir2_coeffs_ap2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_bp2()
* ```>>> */
static inline void bw_iir2_coeffs_bp2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_hp2()
* ```>>> */
static inline void bw_iir2_coeffs_hp2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_hs2_lin()
* ```>>> */
static inline void bw_iir2_coeffs_hs2_lin(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float high_gain_lin,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_hs2_dB()
* ```>>> */
static inline void bw_iir2_coeffs_hs2_dB(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float high_gain_dB,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_lp2()
* ```>>> */
static inline void bw_iir2_coeffs_lp2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_ls2_lin()
* ```>>> */
static inline void bw_iir2_coeffs_ls2_lin(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float dc_gain_lin,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_ls2_dB()
* ```>>> */
static inline void bw_iir2_coeffs_ls2_dB(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float dc_gain_dB,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_mm2()
* ```>>> */
static inline void bw_iir2_coeffs_mm2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float coeff_x,
float coeff_lp,
float coeff_bp,
float coeff_hp,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_notch()
* ```>>> */
static inline void bw_iir2_coeffs_notch(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_peak_lin()
* ```>>> */
static inline void bw_iir2_coeffs_peak_lin(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float dc_gain_lin,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_peak_dB()
* ```>>> */
static inline void bw_iir2_coeffs_peak_dB(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float dc_gain_dB,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_peak_lin_bw()
* ```>>> */
static inline void bw_iir2_coeffs_peak_lin_bw(
float sample_rate,
float cutoff,
float bandwidth,
float prewarp_freq,
float dc_gain_lin,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
*
* #### bw_iir2_coeffs_peak_dB_bw()
* ```>>> */
static inline void bw_iir2_coeffs_peak_dB_bw(
float sample_rate,
float cutoff,
float bandwidth,
float prewarp_freq,
float dc_gain_dB,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2);
/*! <<<```
* XXX
* }}} */
#if !defined(BW_CXX_NO_EXTERN_C) && defined(__cplusplus)
}
#endif
/*** Implementation ***/
/* WARNING: This part of the file is not part of the public API. Its content may
* change at any time in future versions. Please, do not use it directly. */
#ifdef BW_INCLUDE_WITH_QUOTES
# include "bw_math.h"
#else
# include <bw_math.h>
#endif
#if !defined(BW_CXX_NO_EXTERN_C) && defined(__cplusplus)
extern "C" {
#endif
static inline void bw_iir2_reset(
float x_0,
float * BW_RESTRICT y_0,
float * BW_RESTRICT s1_0,
float * BW_RESTRICT s2_0,
float b0,
float b1,
float b2,
float a1,
float a2) {
// a1, a2...
const float d = bw_rcpf(1.f + a1 + a2);
const float k = d * x_0;
*y_0 = k * (b0 + b1 + b2);
*s_0 = k * (b1 + b2 - b0 * (a1 + a2));
*s_1 = k * (b2 + b2 * a1 - a2 * (b0 + b1));
}
static inline void bw_iir2_reset_multi(
const float * x_0,
float * y_0,
float * BW_RESTRICT s1_0,
float * s2_0,
float b0,
float b1,
float b2,
float a1,
float a2,
size_t n_channels) {
for (size_t i = 0; i < n_channels; i++)
bw_iir2_reset(x_0[i], s1_0 + i, s2_0 + i, b0, b1, b2, a1, a2);
}
static inline void bw_iir2_process1(
float x,
float * BW_RESTRICT y,
float * BW_RESTRICT s1,
float * BW_RESTRICT s2,
float b0,
float b1,
float b2,
float a1,
float a2) {
*y = b0 * x + *s1;
*s1 = b1 * x - a1 * *y + *s2;
*s2 = b2 * x - a2 * *y;
}
static inline void bw_iir2_process(
const float * x,
float * y,
float * BW_RESTRICT s1,
float * BW_RESTRICT s2,
float b0,
float b1,
float b2,
float a1,
float a2,
size_t n_samples) {
for (size_t i = 0; i < n_samples; i++)
bw_iir2_process1(x[i], y + i, s1, s2, b0, b1, b2, a1, a2);
}
static inline void bw_iir2_process_multi(
const float * const * x,
float * const * y,
float * BW_RESTRICT s1,
float * BW_RESTRICT s2,
float b0,
float b1,
float b2,
float a1,
float a2,
size_t n_channels,
size_t n_samples) {
for (size_t i = 0; i < n_samples; i++)
for (size_t j = 0; j < n_channels; j++)
bw_iir2_process1(x[j][i], y[j] + i, s1 + j, s2 + j, b0, b1, b2, a1, a2);
}
static inline void bw_iir2_coeffs_ap2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
const float t = bw_tanf(3.141592653589793f * prewarp_freq * bw_rcpf(sample_rate));
const float k1 = prewarp_freq * prewarp_freq;
const float k2 = t * cutoff;
const float k3 = k2 * k2;
const float k4 = k2 * prewarp_freq;
const float k5 = Q * (k1 + k3);
const float d = bw_rcpf(k5 + k4);
*a1 = (d + d) * Q * (k3 - k1);
*a2 = d * (k5 - k4);
*b0 = *a2;
*b1 = *a1;
*b2 = 1.f;
}
static inline void bw_iir2_coeffs_bp2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
const float t = bw_tanf(3.141592653589793f * prewarp_freq * bw_rcpf(sample_rate));
const float k1 = prewarp_freq * prewarp_freq;
const float k2 = t * cutoff;
const float k3 = k2 * k2;
const float k4 = k2 * prewarp_freq;
const float k5 = Q * (k1 + k3);
const float d = bw_rcpf(k5 + k4);
*a1 = (d + d) * Q * (k3 - k1);
*a2 = d * (k5 - k4);
*b0 = Q * k4;
*b1 = 0.f;
*b2 = -*b0;
}
static inline void bw_iir2_coeffs_hp2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
const float t = bw_tanf(3.141592653589793f * prewarp_freq * bw_rcpf(sample_rate));
const float k1 = prewarp_freq * prewarp_freq;
const float k2 = t * cutoff;
const float k3 = k2 * k2;
const float k4 = k2 * prewarp_freq;
const float k5 = Q * (k1 + k3);
const float d = bw_rcpf(k5 + k4);
*a1 = (d + d) * Q * (k3 - k1);
*a2 = d * (k5 - k4);
*b0 = Q * k1;
*b1 = -(*b0 + *b0);
*b2 = *b0;
}
static inline void bw_iir2_coeffs_hs2_lin(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float high_gain_lin,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
//XXX
}
static inline void bw_iir2_coeffs_hs2_dB(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float high_gain_dB,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
bw_iir2_coeffs_hs2_lin(sample_rate, cutoff, Q, prewarp_freq, bw_dB2linf(high_gain_dB), b0, b1, b2, a1, a2);
}
static inline void bw_iir2_coeffs_lp2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
const float t = bw_tanf(3.141592653589793f * prewarp_freq * bw_rcpf(sample_rate));
const float k1 = prewarp_freq * prewarp_freq;
const float k2 = t * cutoff;
const float k3 = k2 * k2;
const float k4 = k2 * prewarp_freq;
const float k5 = Q * (k1 + k3);
const float d = bw_rcpf(k5 + k4);
*a1 = (d + d) * Q * (k3 - k1);
*a2 = d * (k5 - k4);
*b0 = Q * k3;
*b1 = *b0 + *b0;
*b2 = *b0;
}
static inline void bw_iir2_coeffs_ls2_lin(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float dc_gain_lin,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
//XXX
}
static inline void bw_iir2_coeffs_ls2_dB(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float dc_gain_dB,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
bw_iir2_coeffs_ls2_lin(sample_rate, cutoff, Q, prewarp_freq, bw_dB2linf(dc_gain_dB), b0, b1, b2, a1, a2);
}
static inline void bw_iir2_coeffs_mm2(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float coeff_x,
float coeff_lp,
float coeff_bp,
float coeff_hp,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
const float t = bw_tanf(3.141592653589793f * prewarp_freq * bw_rcpf(sample_rate));
const float k1 = prewarp_freq * prewarp_freq;
const float k2 = t * cutoff;
const float k3 = k2 * k2;
const float k4 = k2 * prewarp_freq;
const float k5 = Q * (k1 + k3);
const float d = bw_rcpf(k5 + k4);
*a1 = (d + d) * Q * (k3 - k1);
*a2 = d * (k5 - k4);
const float k6 = k3 * (coeff_x + coeff_lp);
const float k7 = k4 * (coeff_x + coeff_bp);
const float k8 = k1 * (coeff_x + coeff_hp);
const float k9 = Q * (k6 + k8);
*b0 = d * (k9 + k7);
*b1 = d * (Q + Q) * (k6 - k8);
*b2 = d * (k9 - k7);
}
static inline void bw_iir2_coeffs_notch(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
const float t = bw_tanf(3.141592653589793f * prewarp_freq * bw_rcpf(sample_rate));
const float k1 = prewarp_freq * prewarp_freq;
const float k2 = t * cutoff;
const float k3 = k2 * k2;
const float k4 = k2 * prewarp_freq;
const float k5 = Q * (k1 + k3);
const float d = bw_rcpf(k5 + k4);
*a1 = (d + d) * Q * (k3 - k1);
*a2 = d * (k5 - k4);
*b0 = d * k5;
*b1 = *a1;
*b2 = *b0;
}
static inline void bw_iir2_coeffs_peak_lin(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float dc_gain_lin,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
//XXX
}
static inline void bw_iir2_coeffs_peak_dB(
float sample_rate,
float cutoff,
float Q,
float prewarp_freq,
float dc_gain_dB,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
bw_iir2_coeffs_peak_lin(sample_rate, cutoff, Q, prewarp_freq, bw_dB2linf(dc_gain_dB), b0, b1, b2, a1, a2);
}
static inline void bw_iir2_coeffs_peak_lin_bw(
float sample_rate,
float cutoff,
float bandwidth,
float prewarp_freq,
float dc_gain_lin,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
//XXX
}
static inline void bw_iir2_coeffs_peak_dB_bw(
float sample_rate,
float cutoff,
float bandwidth,
float prewarp_freq,
float dc_gain_dB,
float * BW_RESTRICT b0,
float * BW_RESTRICT b1,
float * BW_RESTRICT b2,
float * BW_RESTRICT a1,
float * BW_RESTRICT a2) {
bw_iir2_coeffs_peak_lin_bw(sample_rate, cutoff, bandwidth, prewarp_freq, bw_dB2linf(dc_gain_dB), b0, b1, b2, a1, a2);
}
#if !defined(BW_CXX_NO_EXTERN_C) && defined(__cplusplus)
}
#endif
#if !defined(BW_NO_CXX) && defined(__cplusplus)
# ifndef BW_CXX_NO_ARRAY
# include <array>
# endif
namespace Brickworks {
/*** Public C++ API ***/
/*! api_cpp {{{
* ##### Brickworks::iir2Reset
* ```>>> */
template<size_t N_CHANNELS>
void iir2Reset(
const float * BW_RESTRICT x0,
float * BW_RESTRICT const * BW_RESTRICT s0,
float b0,
float b1,
float a1);
# ifndef BW_CXX_NO_ARRAY
template<size_t N_CHANNELS>
void iir2Reset(
std::array<float, N_CHANNELS> x0,
std::array<float * BW_RESTRICT, N_CHANNELS> s0,
float b0,
float b1,
float a1);
# endif
template<size_t N_CHANNELS>
void iir2Process(
const float * const * x,
float * const * y,
float * BW_RESTRICT const * BW_RESTRICT s,
float b0,
float b1,
float a1,
size_t nSamples);
# ifndef BW_CXX_NO_ARRAY
template<size_t N_CHANNELS>
void iir2Process(
std::array<const float *, N_CHANNELS> x,
std::array<float *, N_CHANNELS> y,
std::array<float * BW_RESTRICT, N_CHANNELS> s,
float b0,
float b1,
float a1,
size_t nSamples);
# endif
/*! <<<```
* }}} */
/*** Implementation ***/
/* WARNING: This part of the file is not part of the public API. Its content may
* change at any time in future versions. Please, do not use it directly. */
template<size_t N_CHANNELS>
inline void iir2Reset(
const float * BW_RESTRICT x0,
float * BW_RESTRICT const * BW_RESTRICT s0,
float b0,
float b1,
float a1) {
bw_iir2_reset_multi(x0, s0, b0, b1, a1, N_CHANNELS);
}
# ifndef BW_CXX_NO_ARRAY
template<size_t N_CHANNELS>
inline void iir2Reset(
std::array<float, N_CHANNELS> x0,
std::array<float * BW_RESTRICT, N_CHANNELS> s0,
float b0,
float b1,
float a1) {
iir2Reset<N_CHANNELS>(x0.data(), s0.data(), b0, b1, a1);
}
# endif
template<size_t N_CHANNELS>
inline void iir2Process(
const float * const * x,
float * const * y,
float * BW_RESTRICT const * BW_RESTRICT s,
float b0,
float b1,
float a1,
size_t nSamples) {
bw_iir2_process_multi(x, y, s, b0, b1, a1, N_CHANNELS, nSamples);
}
# ifndef BW_CXX_NO_ARRAY
template<size_t N_CHANNELS>
inline void iir2Process(
std::array<const float *, N_CHANNELS> x,
std::array<float *, N_CHANNELS> y,
std::array<float * BW_RESTRICT, N_CHANNELS> s,
float b0,
float b1,
float a1,
size_t nSamples) {
iir2Process<N_CHANNELS>(x.data(), y.data(), s.data(), b0, b1, a1, nSamples);
}
# endif
}
#endif
#endif
Reference in New Issue View Git Blame Copy Permalink