mirror of
https://github.com/modelec/modelec-marcel-ROS.git
synced 2026-01-18 16:47:43 +01:00
test go home
This commit is contained in:
@@ -39,12 +39,12 @@
|
||||
</home>
|
||||
<spawn>
|
||||
<yellow>
|
||||
<top x="375" y="1775" theta="-1.5708" />
|
||||
<top x="375" y="1600" theta="-1.5708" />
|
||||
<side x="2775" y="875" theta="3.1415" />
|
||||
<bottom x="1225" y="200" theta="1.5708" />
|
||||
</yellow>
|
||||
<blue>
|
||||
<top x="2625" y="1775" theta="-1.5708" />
|
||||
<top x="2625" y="1600" theta="-1.5708" />
|
||||
<side x="225" y="875" theta="0" />
|
||||
<bottom x="1775" y="200" theta="1.5708" />
|
||||
</blue>
|
||||
|
||||
@@ -19,7 +19,7 @@ namespace Modelec
|
||||
|
||||
auto t = nav_->GetSpawn();
|
||||
|
||||
nav_->GoTo(t.x, 1200, -M_PI_2, true, Pathfinding::FREE | Pathfinding::WALL | Pathfinding::OBSTACLE);
|
||||
nav_->GoTo(t.x, t.y - 800, -M_PI_2, true, Pathfinding::FREE | Pathfinding::WALL | Pathfinding::OBSTACLE);
|
||||
|
||||
go_home_time_ = node_->now();
|
||||
|
||||
@@ -44,7 +44,7 @@ namespace Modelec
|
||||
{
|
||||
auto t = nav_->GetSpawn();
|
||||
|
||||
nav_->GoTo(t.x, 1700, -M_PI_2, true, Pathfinding::FREE | Pathfinding::WALL | Pathfinding::OBSTACLE);
|
||||
nav_->GoTo(t.x, t.y, -M_PI_2, true, Pathfinding::FREE | Pathfinding::WALL | Pathfinding::OBSTACLE);
|
||||
|
||||
step_ = GO_HOME;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user