From d3e616e5f0d42089d7fab38a2b98a733f6dac268 Mon Sep 17 00:00:00 2001
From: Jose Medina <jose.medina@franka.de>
Date: Thu, 2 Aug 2018 15:53:44 +0200
Subject: [PATCH] Add lowpass_filter tests

---
 test/lowpass_filter_tests.cpp | 23 +++++++++++++++++++++++
 1 file changed, 23 insertions(+)
 create mode 100644 test/lowpass_filter_tests.cpp

diff --git a/test/lowpass_filter_tests.cpp b/test/lowpass_filter_tests.cpp
new file mode 100644
index 00000000..c2a1dd8b
--- /dev/null
+++ b/test/lowpass_filter_tests.cpp
@@ -0,0 +1,23 @@
+// Copyright (c) 2018 Franka Emika GmbH
+// Use of this source code is governed by the Apache-2.0 license, see LICENSE
+
+#include <gtest/gtest.h>
+#include <Eigen/Dense>
+
+#include <franka/lowpass_filter.h>
+
+using namespace franka;
+
+const double kNoLimit{std::numeric_limits<double>::max()};
+
+TEST(LowpassFilter, KeepsValueIfNoChange) {
+  EXPECT_NEAR(lowpassFilter(0.001, 1.0, 1.0, 100.0), 1.0, 1e-6);
+  EXPECT_NEAR(lowpassFilter(0.001, 1.0, 1.0, 500.0), 1.0, 1e-6);
+  EXPECT_NEAR(lowpassFilter(0.001, 1.0, 1.0, 1000.0), 1.0, 1e-6);
+}
+
+TEST(LowpassFilter, DoesFilter) {
+  EXPECT_NEAR(lowpassFilter(0.001, 1.0, 0.0, 100.0), 0.3859, 1e-4);
+  EXPECT_NEAR(lowpassFilter(0.001, 1.0, 0.0, 500.0), 0.7585, 1e-4);
+  EXPECT_NEAR(lowpassFilter(0.001, 1.0, 0.0, 900.0), 0.8497, 1e-4);
+}