diff --git a/src/gazebo_ros_link_attacher.cpp b/src/gazebo_ros_link_attacher.cpp index f9b7dbf..bbec903 100644 --- a/src/gazebo_ros_link_attacher.cpp +++ b/src/gazebo_ros_link_attacher.cpp @@ -54,6 +54,7 @@ namespace gazebo if(this->getJoint(model1, link1, model2, link2, j)){ ROS_INFO_STREAM("Joint already existed, reusing it."); j.joint->Attach(j.l1, j.l2); + j.joint->Load(j.l1, j.l2, ignition::math::Pose3d()); return true; } else{