First Test for Waypoints calculation