Lower the amount of required way points for tension spline interpolation

[bit-pirate]

Currently 5 way points are required, which is probably to high. Let's check, if we can go down to 2 (by inserting pseudo-waypoints)