simple_offboard: add global alt to get_telemetry service

This commit is contained in:
Oleg Kalachev
2018-07-05 02:50:35 +03:00
parent 43237d8ff4
commit aaa673de92
3 changed files with 8 additions and 4 deletions

View File

@@ -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