mirror of
https://github.com/modelec/modelec-marcel-ROS.git
synced 2026-01-18 16:47:43 +01:00
some fix :
- position - bug when the robot can't find any depot zone
This commit is contained in:
@@ -83,6 +83,7 @@ namespace Modelec
|
||||
return;
|
||||
}
|
||||
|
||||
// TODO : make the mission finished if the pos is not valid
|
||||
closestDepoZonePoint_ = closestDepoZone_->GetNextPotPos();
|
||||
auto p = closestDepoZonePoint_.GetTakeBasePosition();
|
||||
auto res = nav_->CanGoTo(p, false, Pathfinding::FREE | Pathfinding::WALL);
|
||||
@@ -135,7 +136,7 @@ namespace Modelec
|
||||
}
|
||||
else
|
||||
{
|
||||
status_ = MissionStatus::FAILED;
|
||||
status_ = MissionStatus::FINISH_ALL;
|
||||
return;
|
||||
}
|
||||
|
||||
@@ -144,7 +145,7 @@ namespace Modelec
|
||||
|
||||
if (!canGo)
|
||||
{
|
||||
status_ = MissionStatus::FAILED;
|
||||
status_ = MissionStatus::FINISH_ALL;
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
@@ -24,7 +24,7 @@ namespace Modelec
|
||||
|
||||
Point Point::GetTakeBasePosition() const
|
||||
{
|
||||
return GetTakePosition(300, theta);
|
||||
return GetTakePosition(350, theta);
|
||||
}
|
||||
|
||||
Point Point::GetTakeClosePosition() const
|
||||
|
||||
Reference in New Issue
Block a user