diff --git a/nav2_bt_navigator/include/nav2_bt_navigator/bt_navigator.hpp b/nav2_bt_navigator/include/nav2_bt_navigator/bt_navigator.hpp index e7a61164d6e..076a4c8f379 100644 --- a/nav2_bt_navigator/include/nav2_bt_navigator/bt_navigator.hpp +++ b/nav2_bt_navigator/include/nav2_bt_navigator/bt_navigator.hpp @@ -95,6 +95,7 @@ class BtNavigator : public nav2_util::LifecycleNode std::string robot_frame_; std::string global_frame_; double transform_tolerance_; + std::string odom_topic_; // Spinning transform that can be used by the BT nodes std::shared_ptr tf_; diff --git a/nav2_bt_navigator/src/bt_navigator.cpp b/nav2_bt_navigator/src/bt_navigator.cpp index b940c7c364a..61423294799 100644 --- a/nav2_bt_navigator/src/bt_navigator.cpp +++ b/nav2_bt_navigator/src/bt_navigator.cpp @@ -93,7 +93,7 @@ BtNavigator::on_configure(const rclcpp_lifecycle::State & /*state*/) global_frame_ = get_parameter("global_frame").as_string(); robot_frame_ = get_parameter("robot_base_frame").as_string(); transform_tolerance_ = get_parameter("transform_tolerance").as_double(); - + odom_topic_ = get_parameter("odom_topic").as_double(); // Libraries to pull plugins (BT Nodes) from auto plugin_lib_names = get_parameter("plugin_lib_names").as_string_array(); @@ -119,7 +119,7 @@ BtNavigator::on_configure(const rclcpp_lifecycle::State & /*state*/) } // Odometry smoother object for getting current speed - odom_smoother_ = std::make_unique(shared_from_this(), 0.3); + odom_smoother_ = std::make_unique(shared_from_this(), 0.3, odom_topic_); return nav2_util::CallbackReturn::SUCCESS; }