diff --git a/diff_drive_controller/src/diff_drive_controller.cpp b/diff_drive_controller/src/diff_drive_controller.cpp index 2913838138..6acea74226 100644 --- a/diff_drive_controller/src/diff_drive_controller.cpp +++ b/diff_drive_controller/src/diff_drive_controller.cpp @@ -405,7 +405,16 @@ controller_interface::CallbackReturn DiffDriveController::on_configure( const auto odom_frame_id = controller_namespace + params_.odom_frame_id; const auto base_frame_id = controller_namespace + params_.base_frame_id; - + + for (auto & joint_name : params_.left_wheel_names) + { + joint_name = controller_namespace + joint_name; + } + for (auto & joint_name : params_.right_wheel_names) + { + joint_name = controller_namespace + joint_name; + } + auto & odometry_message = realtime_odometry_publisher_->msg_; odometry_message.header.frame_id = odom_frame_id; odometry_message.child_frame_id = base_frame_id;