diff --git a/src/modelec_strat/src/navigation_helper.cpp b/src/modelec_strat/src/navigation_helper.cpp index 17886ca..682cfcf 100644 --- a/src/modelec_strat/src/navigation_helper.cpp +++ b/src/modelec_strat/src/navigation_helper.cpp @@ -133,10 +133,10 @@ namespace Modelec { if ((node_->now() - last_odo_get_pos_time_).seconds() > 1) { + last_odo_get_pos_time_ = node_->now(); RCLCPP_INFO(node_->get_logger(), "Requesting current position from odometry"); std_msgs::msg::Empty empty_msg; odo_get_pos_pub_->publish(empty_msg); - last_odo_get_pos_time_ = node_->now(); } }