antenna.updateYawFromGPS()
antenna.updatePitchFromGPS()
#set the antenna to the correcte angle
# antenna.angleoffsetcalc()
antenna.magneticDeclinationUpdate()
tickyaw=YawServo.Refresh(antenna.wyaw,antenna.yaw)
tickpitch=PitchServo.Refresh(antenna.wpitch,antenna.pitch)
time.sleep(0.2)
os.system("clear")
print "UAV Latitude\t", antenna.uavLat
print "UAV Longitude\t", antenna.uavLon
print "UAV Altitude\t", antenna.uavAlt
print "ant Latitude\t", antenna.antennaLat
print "ant Longitude\t", antenna.antennaLon
print "ant Altitude\t", antenna.antennaAlt
print "wanted yaw \t", antenna.wyaw
print "antenna yaw \t", antenna.yaw
print "wanted pitch \t", antenna.wpitch
print "antenna pitch \t", antenna.pitch
print "yaw tick \t", tickyaw
print "pitch tick \t", tickpitch
except (KeyboardInterrupt, SystemExit):
Accel.kill = True
uav.kill = True
break
