CopterExpress/clover
1
0
Fork 0
mirror of https://github.com/CopterExpress/clover.git synced 2026-05-27 05:29:32 +00:00
Code Issues Packages Projects Releases Wiki Activity

Fix pitch and roll in get_telemetry

Browse Source
This commit is contained in:
Oleg Kalachev
2017-12-22 18:09:57 +03:00
parent deaba007cd
commit a7cdfb4a0f
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
clever/src/simple_offboard.py
View File

@@ -387,7 +387,7 @@ def get_telemetry(req):
_, _, res['yaw'] = euler_from_orientation(p.pose.orientation)
# Calculate pitch and roll as angles between the pose and fcu_horiz
attitude_pose = tf_buffer.transform(pose, 'fcu_horiz', TRANSFORM_TIMEOUT)
res['pitch'], res['roll'], _ = euler_from_orientation(attitude_pose.pose.orientation)
res['roll'], res['pitch'], _ = euler_from_orientation(attitude_pose.pose.orientation)
if velocity:
v = Vector3Stamped()