simple_offboard: add global alt to get_telemetry service

clever/src/simple_offboard.py

@@ -348,6 +348,7 @@ def get_telemetry(req):
         'z': float('nan'),
         'lat': float('nan'),
         'lon': float('nan'),
+        'alt': float('nan'),
         'vx': float('nan'),
         'vy': float('nan'),
         'vz': float('nan'),
@@ -389,6 +390,7 @@ def get_telemetry(req):
     if global_position and stamp - global_position.header.stamp < rospy.Duration(5):
         res['lat'] = global_position.latitude
         res['lon'] = global_position.longitude
+        res['alt'] = global_position.altitude
 
     if state:
         res['connected'] = state.connected

clever/srv/GetTelemetry.srv

@@ -7,8 +7,9 @@ string mode
 float32 x
 float32 y
 float32 z
-float32 lat
-float32 lon
+float64 lat
+float64 lon
+float32 alt
 float32 vx
 float32 vy
 float32 vz