From 4d3df8df632d9230389fa2ffec6c4b28fa2985ff Mon Sep 17 00:00:00 2001 From: Stanislaw Halik Date: Mon, 16 Jun 2014 03:00:27 +0200 Subject: Revert "lerp class to simplify filter flow" This reverts commit 5409f26675a444170b3a68fc9750742cc68aaa1d. --- facetracknoir/lerp.hpp | 45 --------------------------------------------- 1 file changed, 45 deletions(-) delete mode 100644 facetracknoir/lerp.hpp diff --git a/facetracknoir/lerp.hpp b/facetracknoir/lerp.hpp deleted file mode 100644 index 70d5995c..00000000 --- a/facetracknoir/lerp.hpp +++ /dev/null @@ -1,45 +0,0 @@ -#pragma once - -#include "facetracknoir/timer.hpp" -#include - -class lerp { -private: - double last[2][6], dt; - Timer t; -public: - lerp() : - last { {0,0,0,0,0,0}, {0,0,0,0,0,0} }, dt(1) - { - } - bool idempotentp(const double* input) - { - for (int i = 0; i < 6; i++) - if (last[0][i] != input[i]) - return false; - return true; - } - - void write(const double* input, double* output) - { - const double q = dt; - dt = std::max(1, t.start()); - - const double c = std::max(std::min(1.0, q/(double)dt), 0.0); - - for (int i = 0; i < 6; i++) - { - last[1][i] = last[0][i]; - last[0][i] = input[i]; - } - - for (int i = 0; i < 6; i++) - output[i] = last[1][i] + (last[0][i] - last[1][i]) * c; - } - - void get_state(double* state) - { - for (int i = 0; i < 6; i++) - state[i] = last[0][i]; - } -}; -- cgit v1.2.3