Fixing a problem with Dubins paths