Setting to safe position with estimated positions works.