205 lines
4.7 KiB
C++
205 lines
4.7 KiB
C++
/*****************************************************************************
|
|
|
|
Upsampler2xFpu.hpp
|
|
Author: Laurent de Soras, 2005
|
|
|
|
--- Legal stuff ---
|
|
|
|
This program is free software. It comes without any warranty, to
|
|
the extent permitted by applicable law. You can redistribute it
|
|
and/or modify it under the terms of the Do What The Fuck You Want
|
|
To Public License, Version 2, as published by Sam Hocevar. See
|
|
http://sam.zoy.org/wtfpl/COPYING for more details.
|
|
|
|
*Tab=3***********************************************************************/
|
|
|
|
|
|
|
|
#if defined (hiir_Upsampler2xFpu_CURRENT_CODEHEADER)
|
|
#error Recursive inclusion of Upsampler2xFpu code header.
|
|
#endif
|
|
#define hiir_Upsampler2xFpu_CURRENT_CODEHEADER
|
|
|
|
#if ! defined (hiir_Upsampler2xFpu_CODEHEADER_INCLUDED)
|
|
#define hiir_Upsampler2xFpu_CODEHEADER_INCLUDED
|
|
|
|
|
|
|
|
/*\\\ INCLUDE FILES \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\*/
|
|
|
|
#include "hiir/StageProcFpu.h"
|
|
|
|
#include <cassert>
|
|
|
|
|
|
|
|
namespace hiir
|
|
{
|
|
|
|
|
|
|
|
/*\\\ PUBLIC \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\*/
|
|
|
|
|
|
|
|
/*
|
|
==============================================================================
|
|
Name: ctor
|
|
Throws: Nothing
|
|
==============================================================================
|
|
*/
|
|
|
|
template <int NC>
|
|
Upsampler2xFpu <NC>::Upsampler2xFpu ()
|
|
: _coef ()
|
|
, _x ()
|
|
, _y ()
|
|
{
|
|
for (int i = 0; i < NBR_COEFS; ++i)
|
|
{
|
|
_coef [i] = 0;
|
|
}
|
|
clear_buffers ();
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
==============================================================================
|
|
Name: set_coefs
|
|
Description:
|
|
Sets filter coefficients. Generate them with the PolyphaseIir2Designer
|
|
class.
|
|
Call this function before doing any processing.
|
|
Input parameters:
|
|
- coef_arr: Array of coefficients. There should be as many coefficients as
|
|
mentioned in the class template parameter.
|
|
Throws: Nothing
|
|
==============================================================================
|
|
*/
|
|
|
|
template <int NC>
|
|
void Upsampler2xFpu <NC>::set_coefs (const double coef_arr [NBR_COEFS])
|
|
{
|
|
assert (coef_arr != 0);
|
|
|
|
for (int i = 0; i < NBR_COEFS; ++i)
|
|
{
|
|
_coef [i] = float (coef_arr [i]);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
==============================================================================
|
|
Name: process_sample
|
|
Description:
|
|
Upsamples (x2) the input sample, generating two output samples.
|
|
Input parameters:
|
|
- input: The input sample.
|
|
Output parameters:
|
|
- out_0: First output sample.
|
|
- out_1: Second output sample.
|
|
Throws: Nothing
|
|
==============================================================================
|
|
*/
|
|
|
|
template <int NC>
|
|
void Upsampler2xFpu <NC>::process_sample (float &out_0, float &out_1, float input)
|
|
{
|
|
float even = input;
|
|
float odd = input;
|
|
StageProcFpu <NBR_COEFS>::process_sample_pos (
|
|
NBR_COEFS,
|
|
even,
|
|
odd,
|
|
&_coef [0],
|
|
&_x [0],
|
|
&_y [0]
|
|
);
|
|
out_0 = even;
|
|
out_1 = odd;
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
==============================================================================
|
|
Name: process_block
|
|
Description:
|
|
Upsamples (x2) the input sample block.
|
|
Input and output blocks may overlap, see assert() for details.
|
|
Input parameters:
|
|
- in_ptr: Input array, containing nbr_spl samples.
|
|
- nbr_spl: Number of input samples to process, > 0
|
|
Output parameters:
|
|
- out_0_ptr: Output sample array, capacity: nbr_spl * 2 samples.
|
|
Throws: Nothing
|
|
==============================================================================
|
|
*/
|
|
|
|
template <int NC>
|
|
void Upsampler2xFpu <NC>::process_block (float out_ptr [], const float in_ptr [], long nbr_spl)
|
|
{
|
|
assert (out_ptr != 0);
|
|
assert (in_ptr != 0);
|
|
assert (out_ptr >= in_ptr + nbr_spl || in_ptr >= out_ptr + nbr_spl);
|
|
assert (nbr_spl > 0);
|
|
|
|
long pos = 0;
|
|
do
|
|
{
|
|
process_sample (
|
|
out_ptr [pos * 2 ],
|
|
out_ptr [pos * 2 + 1],
|
|
in_ptr [pos]
|
|
);
|
|
++ pos;
|
|
}
|
|
while (pos < nbr_spl);
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
==============================================================================
|
|
Name: clear_buffers
|
|
Description:
|
|
Clears filter memory, as if it processed silence since an infinite amount
|
|
of time.
|
|
Throws: Nothing
|
|
==============================================================================
|
|
*/
|
|
|
|
template <int NC>
|
|
void Upsampler2xFpu <NC>::clear_buffers ()
|
|
{
|
|
for (int i = 0; i < NBR_COEFS; ++i)
|
|
{
|
|
_x [i] = 0;
|
|
_y [i] = 0;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
/*\\\ PROTECTED \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\*/
|
|
|
|
|
|
|
|
/*\\\ PRIVATE \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\*/
|
|
|
|
|
|
|
|
} // namespace hiir
|
|
|
|
|
|
|
|
#endif // hiir_Upsampler2xFpu_CODEHEADER_INCLUDED
|
|
|
|
#undef hiir_Upsampler2xFpu_CURRENT_CODEHEADER
|
|
|
|
|
|
|
|
/*\\\ EOF \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\*/
|