Added more test logs and added altitude waypoints
Tried taking test data for accuracy, added a new waypoints file that will be outdated once we move the cones