AP_Math: added test for vector2f rotate

5 years ago · b6a5509409
1 changed files with 6 additions and 0 deletions
--- a/libraries/AP_Math/tests/test_vector2.cpp
+++ b/libraries/AP_Math/tests/test_vector2.cpp
@ -52,6 +52,12 @@ TEST(Vector2Test, reflect)
				@@ -52,6 +52,12 @@ TEST(Vector2Test, reflect)
    Vector2f reflected3 = Vector2f(3, 3);
    reflected3.reflect(Vector2f(1, -1));
    EXPECT_EQ(reflected3, Vector2f(-3, -3));
+
+    // rotation
+    Vector2f base = Vector2f(2, 1);
+    base.rotate(radians(90));
+    EXPECT_FLOAT_EQ(base.x, -1);
+    EXPECT_FLOAT_EQ(base.y, 2);
 }

 TEST(Vector2Test, closest_point)