zrzk
/
ardupilot
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

AP_Math: add more tests for wrap functions

mission-4.1.18
Peter Barker 5 years ago committed by Peter Barker
parent
cefd30a086
commit
84d999142f
1 changed files with 22 additions and 0 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Split View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 22
      libraries/AP_Math/tests/test_math.cpp

22
libraries/AP_Math/tests/test_math.cpp
Unescape View File

@ -238,6 +238,17 @@ TEST(MathWrapTest, Angle180) @@ -238,6 +238,17 @@ TEST(MathWrapTest, Angle180)
EXPECT_EQ(9000.f, wrap_180_cd(-27000.f));
EXPECT_EQ(0.f, wrap_180_cd(-36000.f));
EXPECT_EQ(0.f, wrap_180_cd(-72000.f));
EXPECT_EQ(45, wrap_180(int16_t(45)));
EXPECT_EQ(90, wrap_180(int16_t(90)));
EXPECT_EQ(180, wrap_180(int16_t(180)));
EXPECT_EQ(-179, wrap_180(int16_t(181)));
EXPECT_EQ(-90, wrap_180(int16_t(270)));
EXPECT_EQ(0, wrap_180(int16_t(360)));
EXPECT_EQ(0, wrap_180(int16_t(720)));
EXPECT_EQ(0, wrap_180(int16_t(3600)));
EXPECT_EQ(0, wrap_180((int16_t(7200))));
EXPECT_EQ(0, wrap_180((int16_t)-3600));
}
TEST(MathWrapTest, Angle360)
@ -277,6 +288,17 @@ TEST(MathWrapTest, Angle360) @@ -277,6 +288,17 @@ TEST(MathWrapTest, Angle360)
EXPECT_EQ(0.f, wrap_360_cd(-36000.f));
EXPECT_EQ(35995.0f,wrap_360_cd(-36005.f));
EXPECT_EQ(0.f, wrap_360_cd(-72000.f));
EXPECT_EQ(45, wrap_360((int16_t)45));
EXPECT_EQ(90, wrap_360((int16_t)90));
EXPECT_EQ(180, wrap_360((int16_t)180));
EXPECT_EQ(270, wrap_360((int16_t)270));
EXPECT_EQ(0, wrap_360((int16_t)360));
EXPECT_EQ(1, wrap_360((int16_t)361));
EXPECT_EQ(0, wrap_360((int16_t)720));
EXPECT_EQ(0, wrap_360((int16_t)3600));
EXPECT_EQ(0, wrap_360((int16_t)7200));
}
TEST(MathWrapTest, AnglePI)

Write Preview
Loading…
Cancel
Save