nav2_controller: add loop rate log (ros-navigation#4171)

* update smac_planner README Signed-off-by: ARK3r <kermani.areza@gmail.com> * added current controller loop rate logging Signed-off-by: ARK3r <kermani.areza@gmail.com> * linting Signed-off-by: ARK3r <kermani.areza@gmail.com> * uncrustify lint Signed-off-by: ARK3r <kermani.areza@gmail.com> * Update nav2_controller/src/controller_server.cpp Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Update nav2_controller/src/controller_server.cpp Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Update nav2_controller/src/controller_server.cpp Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> --------- Signed-off-by: ARK3r <kermani.areza@gmail.com> Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Marc-Morcos · Jul 4, 2024 · 0a85b49 · 0a85b49
1 parent b914048
commit 0a85b49
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/nav2_controller/src/controller_server.cpp b/nav2_controller/src/controller_server.cpp
@@ -424,6 +424,7 @@ void ControllerServer::computeControl()
 {
  std::lock_guard<std::mutex> lock(dynamic_params_lock_);
 
+ auto start_time = this->now();
  RCLCPP_INFO(get_logger(), "Received a goal, begin computing control effort.");
 
  try {