consolidated & reorganized code

-removed extraneous comments
-redid waypoint iteration
-created compass adjustment variable
-created distance variable which is set to value slightly larger than
GPS accuracy
-added xbee output code
-changed output logfile name (log.csv)
-added log.csv which includes header