set_planning_scene is required for constraint aware IK