Fast and accurate clothoid fitting