mirror of
https://github.com/aicodix/dsp.git
synced 2026-04-27 14:30:36 +00:00
56 lines
1.4 KiB
C++
56 lines
1.4 KiB
C++
/*
|
|
Fs/4 Complex down conversion
|
|
|
|
Copyright 2019 Ahmet Inan <inan@aicodix.de>
|
|
*/
|
|
|
|
#pragma once
|
|
|
|
#include "filter.hh"
|
|
#include "window.hh"
|
|
|
|
namespace DSP {
|
|
|
|
template <typename TYPE, int TAPS>
|
|
class CDC
|
|
{
|
|
static_assert((TAPS-1) % 4 == 0, "TAPS-1 not divisible by four");
|
|
typedef TYPE complex_type;
|
|
typedef typename TYPE::value_type value_type;
|
|
value_type real[(TAPS-1)/4];
|
|
value_type imag[(TAPS-1)/2];
|
|
value_type imco[(TAPS-1)/4];
|
|
value_type reco;
|
|
bool sign;
|
|
public:
|
|
CDC(value_type a = value_type(2)) : sign(false)
|
|
{
|
|
Kaiser<value_type> win(a);
|
|
LowPass2<value_type> hbf(1, 4);
|
|
reco = win((TAPS-1)/2, TAPS) * hbf((TAPS-1)/2, TAPS);
|
|
for (int i = 0; i < (TAPS-1)/4; ++i)
|
|
imco[i] = win(2*i+(TAPS-1)/2+1, TAPS) * hbf(2*i+(TAPS-1)/2+1, TAPS);
|
|
for (int i = 0; i < (TAPS-1)/4; ++i)
|
|
real[i] = 0;
|
|
for (int i = 0; i < (TAPS-1)/2; ++i)
|
|
imag[i] = 0;
|
|
}
|
|
complex_type operator()(value_type in0, value_type in1)
|
|
{
|
|
sign = !sign;
|
|
value_type re = reco * real[0];
|
|
for (int i = 0; i < (TAPS-1)/4-1; ++i)
|
|
real[i] = real[i+1];
|
|
real[(TAPS-1)/4-1] = sign ? in1 : -in1;
|
|
for (int i = 0; i < (TAPS-1)/2-1; ++i)
|
|
imag[i] = imag[i+1];
|
|
imag[(TAPS-1)/2-1] = sign ? in0 : -in0;
|
|
value_type im = imco[0] * (imag[(TAPS-1)/4-1] + imag[(TAPS-1)/4]);
|
|
for (int i = 1; i < (TAPS-1)/4; ++i)
|
|
im += imco[i] * (imag[(TAPS-1)/4-1-i] + imag[(TAPS-1)/4+i]);
|
|
return complex_type(re, im);
|
|
}
|
|
};
|
|
|
|
}
|
|
|