added new debug variables for guidance module/ground station
commiting after compiling on t1000
merged with updated code on git hub with waypoint navigation