calcuate dubins paths and dubins lengths