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>
|
</home>
|
||||||
<spawn>
|
<spawn>
|
||||||
<yellow>
|
<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" />
|
<side x="2775" y="875" theta="3.1415" />
|
||||||
<bottom x="1225" y="200" theta="1.5708" />
|
<bottom x="1225" y="200" theta="1.5708" />
|
||||||
</yellow>
|
</yellow>
|
||||||
<blue>
|
<blue>
|
||||||
<top x="2625" y="1775" theta="-1.5708" />
|
<top x="2625" y="1600" theta="-1.5708" />
|
||||||
<side x="225" y="875" theta="0" />
|
<side x="225" y="875" theta="0" />
|
||||||
<bottom x="1775" y="200" theta="1.5708" />
|
<bottom x="1775" y="200" theta="1.5708" />
|
||||||
</blue>
|
</blue>
|
||||||
|
|||||||
@@ -19,7 +19,7 @@ namespace Modelec
|
|||||||
|
|
||||||
auto t = nav_->GetSpawn();
|
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();
|
go_home_time_ = node_->now();
|
||||||
|
|
||||||
@@ -44,7 +44,7 @@ namespace Modelec
|
|||||||
{
|
{
|
||||||
auto t = nav_->GetSpawn();
|
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;
|
step_ = GO_HOME;
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user