Bspline discretisation is not working for 3 points waypoint.