fusion-zauberstab/firmware/include/dc_cancelation.h
Thomas Schmid 6b60c82e3e format documents
Signed-off-by: Thomas Schmid <tom@lfence.de>
2022-06-19 13:05:58 +02:00

20 lines
277 B
C++

#pragma once
template <class T>
struct DcCancelation
{
T x_n1;
T y_n1;
T R;
DcCancelation(T R) : R(R){};
T update(T x)
{
T y = x - this->x_n1 + this->R * this->y_n1;
this->x_n1 = x;
this->y_n1 = y;
return y;
};
};