/*
 * Brickworks
 *
 * Copyright (C) 2023 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
 */

#ifndef BWPP_NOTCH_H
#define BWPP_NOTCH_H

#include <bw_notch.h>
#include <array>

namespace Brickworks {

/*! api {{{
 *    ##### Brickworks::Notch
 *  ```>>> */
template<size_t N_CHANNELS>
class Notch {
public:
	Notch();

	void setSampleRate(float sampleRate);
	void reset(float x0 = 0.f);
	void process(
		std::array<const float *, N_CHANNELS> x,
		std::array<float *, N_CHANNELS> y,
		int nSamples);

	void setCutoff(float value);
	void setQ(float value);
/*! <<<...
 *  }
 *  ```
 *  }}} */

/*** 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. */

private:
	bw_notch_coeffs	 coeffs;
	bw_notch_state	 states[N_CHANNELS];
	bw_notch_state	*statesP[N_CHANNELS];
};

template<size_t N_CHANNELS>
inline Notch<N_CHANNELS>::Notch() {
	bw_notch_init(&coeffs);
	for (size_t i = 0; i < N_CHANNELS; i++)
		statesP[i] = states + i;
}

template<size_t N_CHANNELS>
inline void Notch<N_CHANNELS>::setSampleRate(float sampleRate) {
	bw_notch_set_sample_rate(&coeffs, sampleRate);
}

template<size_t N_CHANNELS>
inline void Notch<N_CHANNELS>::reset(float x0) {
	bw_notch_reset_coeffs(&coeffs);
	for (size_t i = 0; i < N_CHANNELS; i++)
		bw_notch_reset_state(&coeffs, states + i, x0);
}

template<size_t N_CHANNELS>
inline void Notch<N_CHANNELS>::process(
		std::array<const float *, N_CHANNELS> x,
		std::array<float *, N_CHANNELS> y,
		int nSamples) {
	bw_notch_process_multi(&coeffs, statesP, x.data(), y.data(), N_CHANNELS, nSamples);
}

template<size_t N_CHANNELS>
inline void Notch<N_CHANNELS>::setCutoff(float value) {
	bw_notch_set_cutoff(&coeffs, value);
}

template<size_t N_CHANNELS>
inline void Notch<N_CHANNELS>::setQ(float value) {
	bw_notch_set_Q(&coeffs, value);
}

}

#endif