fix curvature on first spline in findpath()
Merge pull request #321 from tom-de-smedt/master

Fix curvature on first spline in findpath().