Moving test_main to test_track because that's what it does
Adding navigator to follow a list of waypoints