[sfx1999]

Why don't you try to make an equation in the form y = ax^2 + bx + c of 3 waypoints? It could work. Make sure you check for 0 divides and throw in straight line optimizations.

Please tell me you know how to do this, because it takes a while to explain.