fixed some moveit bugs