rqt_moveit) fix to Issue #14