aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_Math: more tests for closed-vs-open polygons

Browse Source
This commit is contained in:
Peter Barker 2019-05-29 14:06:18 +10:00 committed by Peter Barker
parent d74e6db12e
commit d3971c18fa
1 changed files with 8 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_Math/tests/test_polygon.cpp
View File

@ -75,6 +75,8 @@ TEST(Polygon, square_boundaries)
memcpy(v, pb.boundary, sizeof(pb.boundary));
v[4] = v[0]; // close it
EXPECT_EQ(pb.outside, Polygon_outside(pb.point, v, 5));
EXPECT_EQ(Polygon_outside(pb.point, v, 4),
Polygon_outside(pb.point, v, 5));
}
}
@ -89,6 +91,8 @@ TEST(Polygon, circle_outside_triangle)
const float x = radius * sin(radians(i)) + 0.5f;
const float y = radius * cos(radians(i)) + 0.5f;
EXPECT_EQ(true, Polygon_outside(Vector2f{x,y}, triangle_closed, 4));
EXPECT_EQ(Polygon_outside(Vector2f{x,y}, triangle_closed, 3),
Polygon_outside(Vector2f{x,y}, triangle_closed, 4));
}
}
@ -103,6 +107,8 @@ TEST(Polygon, circle_inside_triangle)
const float x = radius * sin(radians(i)) + 0.2f;
const float y = radius * cos(radians(i)) + 0.2f;
EXPECT_EQ(false, Polygon_outside(Vector2f{x,y}, triangle_closed, 4));
EXPECT_EQ(Polygon_outside(Vector2f{x,y}, triangle_closed, 3),
Polygon_outside(Vector2f{x,y}, triangle_closed, 4));
}
}
@ -117,6 +123,8 @@ TEST(Polygon, circle_outside_square)
const float x = radius * sin(radians(i)) + 5.0f;
const float y = radius * cos(radians(i)) + 5.0f;
EXPECT_EQ(true, Polygon_outside(Vector2f{x,y}, square_closed, 4));
EXPECT_EQ(Polygon_outside(Vector2f{x,y}, square_closed, 3),
Polygon_outside(Vector2f{x,y}, square_closed, 4));
}
}