Added a second repulsor, using average velocity estimate to eliminate
the drift of waypoints along the trajectory, and initializing all
waypoints to be at the start node (thanks Pascal for the suggestion).