Skip to content

Commit

Permalink
Fix variable names
Browse files Browse the repository at this point in the history
  • Loading branch information
nhatao committed Oct 30, 2023
1 parent 2604942 commit 9b1f07c
Showing 1 changed file with 5 additions and 5 deletions.
10 changes: 5 additions & 5 deletions planner_cspace/test/src/test_planner_3d_cost.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -95,13 +95,13 @@ TEST(GridAstarModel3D, Cost)

// These tests are added to confirm that some bugs are fixed by https://github.com/at-wat/neonavigation/pull/725
const GridAstarModel3D::Vec start2(5, 5, 0);
const GridAstarModel3D::Vec occupied(10, 5, 0);
const GridAstarModel3D::Vec occupied_waypoint(10, 5, 0);
const GridAstarModel3D::Vec goal2(10, 5, 3);
cm[occupied] = 100;
cm[occupied_waypoint] = 100;
// The cost toward the occupied cell should be negative.
EXPECT_LT(model.cost(start2, occupied, {GridAstarModel3D::VecWithCost(start2)}, occupied), 0);
EXPECT_LT(model.cost(start2, occupied_waypoint, {GridAstarModel3D::VecWithCost(start2)}, occupied_waypoint), 0);
// The cost from the occupied cell should be negative.
EXPECT_LT(model.cost(occupied, goal2, {GridAstarModel3D::VecWithCost(occupied)}, goal2), 0);
EXPECT_LT(model.cost(occupied_waypoint, goal2, {GridAstarModel3D::VecWithCost(occupied_waypoint)}, goal2), 0);

const GridAstarModel3D::Vec start3(10, 20, 0);
cm[start3] = 99;
Expand All @@ -110,7 +110,7 @@ TEST(GridAstarModel3D, Cost)
// The cost between start3 and waypoint3 is larger than the cost between waypoint3 and goal3 because start3
// has a penalty.
EXPECT_GT(model.cost(start3, waypoint3, {GridAstarModel3D::VecWithCost(start3)}, waypoint3),
model.cost(waypoint3, waypoint3, {GridAstarModel3D::VecWithCost(goal3)}, goal3));
model.cost(waypoint3, goal3, {GridAstarModel3D::VecWithCost(waypoint3)}, goal3));
}
} // namespace planner_3d
} // namespace planner_cspace
Expand Down

0 comments on commit 9b1f07c

Please sign in to comment.