Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 14:38:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Math: add tests for circle-segment-intersection

Browse Source
This commit is contained in:
Peter Barker 2021-01-04 12:45:03 +11:00 committed by Peter Barker
parent f534963413
commit c81df7b5ad
1 changed files with 23 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
libraries/AP_Math/tests/test_vector2.cpp
View File

@ -82,4 +82,27 @@ TEST(Vector2Test, closest_point)
(Vector2f::closest_point(Vector2f{0,0}, Vector2f{-1, 1}, Vector2f{1, 1})));
}
TEST(Vector2Test, circle_segment_intersectionx)
{
Vector2f intersection;
EXPECT_EQ(Vector2f::circle_segment_intersection(
Vector2f{0,0}, // seg start
Vector2f{1,1}, // seg end
Vector2f{0,0}, // circle center
0.5, // circle radius
intersection // return value for intersection point
), true);
EXPECT_EQ(intersection, Vector2f(sqrtf(0.5)/2,sqrtf(0.5)/2));
EXPECT_EQ(Vector2f::circle_segment_intersection(
Vector2f{std::numeric_limits<float>::quiet_NaN(),
std::numeric_limits<float>::quiet_NaN()}, // seg start
Vector2f{1,1}, // seg end
Vector2f{0,0}, // circle center
0.5, // circle radius
intersection // return value for intersection point
), false);
}
AP_GTEST_MAIN()