Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Filter: finish modefilter test

This commit is contained in:
Pierre Kancir 2021-06-20 17:51:09 +02:00 committed by Peter Barker
parent a39a948c57
commit fd38be843a
1 changed files with 76 additions and 32 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

108
libraries/Filter/tests/test_modefilter.cpp
View File

@ -1,9 +1,3 @@
// given we are in the Math library, you're epected to know what
// you're doing when directly comparing floats:
#pragma GCC diagnostic push
#pragma GCC diagnostic ignored "-Wfloat-equal"
#include <AP_gtest.h>
#include <Filter/Filter.h>
@ -16,34 +10,84 @@ TEST(ModeFilterTest, Int16_Size5)
// 5-entry filter taking the middle element by magnitude of
// the last 5 samples:
ModeFilterInt16_Size5 filt{2};
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(5));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(10));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(10));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(10));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(10));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(10));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(10));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(10));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(10));
EXPECT_FLOAT_EQ(0.0, filt.apply(0));
EXPECT_FLOAT_EQ(0.0, filt.apply(10));
EXPECT_EQ(0, filt.apply(5));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(10));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(10));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(10));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(10));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(10));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(10));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(10));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(10));
EXPECT_EQ(0, filt.apply(0));
EXPECT_EQ(0, filt.apply(10));
}
ModeFilterInt16_Size5 filtf_fail{8};
EXPECT_EQ(1, filtf_fail.apply(1));
EXPECT_EQ(3, filtf_fail.apply(3));
EXPECT_EQ(2, filtf_fail.apply(2));
EXPECT_EQ(3, filtf_fail.apply(4));
EXPECT_EQ(3, filtf_fail.apply(5));
EXPECT_EQ(4, filtf_fail.apply(6));
EXPECT_EQ(4, filtf_fail.apply(7));
EXPECT_EQ(5, filtf_fail.apply(8));
}
TEST(ModeFilterTest, Float_Size5)
{
{
// 5-entry filter taking the middle element by magnitude of
// the last 5 samples:
ModeFilterFloat_Size5 filt{2};
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(5));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(10));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(10));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(10));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(10));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(10));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(10));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(10));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(10));
EXPECT_FLOAT_EQ(0, filt.apply(0));
EXPECT_FLOAT_EQ(0, filt.apply(10));
}
ModeFilterFloat_Size5 filtf_fail{8};
EXPECT_FLOAT_EQ(1, filtf_fail.apply(1));
EXPECT_FLOAT_EQ(3, filtf_fail.apply(3));
EXPECT_FLOAT_EQ(2, filtf_fail.apply(2));
EXPECT_FLOAT_EQ(3, filtf_fail.apply(4));
EXPECT_FLOAT_EQ(3, filtf_fail.apply(5));
EXPECT_FLOAT_EQ(4, filtf_fail.apply(6));
EXPECT_FLOAT_EQ(4, filtf_fail.apply(7));
EXPECT_FLOAT_EQ(5, filtf_fail.apply(8));
}
AP_GTEST_MAIN()
#pragma GCC diagnostic pop