Waypoint tests made. Credit to Jai.