Added methods to Dubins code