From ce0aaaaf94fbfbf2cb5fb0b19ef6df98a3855c03 Mon Sep 17 00:00:00 2001 From: acki Date: Thu, 29 May 2025 17:04:54 -0400 Subject: [PATCH] obs --- src/modelec_strat/src/missions/test.go_home_mission.cpp | 3 +++ 1 file changed, 3 insertions(+) diff --git a/src/modelec_strat/src/missions/test.go_home_mission.cpp b/src/modelec_strat/src/missions/test.go_home_mission.cpp index 72a18c6..def9a7b 100644 --- a/src/modelec_strat/src/missions/test.go_home_mission.cpp +++ b/src/modelec_strat/src/missions/test.go_home_mission.cpp @@ -17,6 +17,9 @@ namespace Modelec score_pub_ = node_->create_publisher("/strat/score", 10); + auto curr = nav_->GetCurrentPos(); + RCLCPP_INFO(node_->get_logger(), "GoHomeMission: Starting at position (%f, %f)", curr->x, curr->y); + nav_->GoTo(375, 1600, -M_PI_2, true, Pathfinding::FREE | Pathfinding::WALL | Pathfinding::OBSTACLE); go_home_time_ = node_->now();