-
Notifications
You must be signed in to change notification settings - Fork 1.7k
Closed
Description
bool GridCollisionChecker::inCollision(
const float & x,
const float & y,
const float & angle_bin,
const bool & traverse_unknown)
{
// Check to make sure cell is inside the map
if (outsideRange(costmap_->getSizeInCellsX(), x) ||
outsideRange(costmap_->getSizeInCellsY(), y))
{
return false;
}
...
bool NodeHybrid::isNodeValid(
const bool & traverse_unknown,
GridCollisionChecker * collision_checker)
{
if (collision_checker->inCollision(
this->pose.x, this->pose.y, this->pose.theta /*bin number*/, traverse_unknown))
{
return false;
}
_cell_cost = collision_checker->getCost();
return true;
}
Isn't this should return true? When node x or y is outside range, this node is invalid, hence inCollision function should return true, then isNodeValid function should return false.
Metadata
Metadata
Assignees
Labels
No labels