fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-28 20:33:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

vmount: fix gimbal_manager_status

Browse Source
This commit is contained in:
David Jablonski
2021-11-30 19:35:22 +01:00
committed by Julian Oes
parent 9345f68a93
commit 4f88c200ec
1 changed files with 10 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/vmount/input_mavlink.cpp
+10 -10
View File
@@ -451,17 +451,17 @@ void InputMavlinkGimbalV2::_stream_gimbal_manager_status()
if (_gimbal_device_attitude_status_sub.updated()) { if (_gimbal_device_attitude_status_sub.updated()) {
_gimbal_device_attitude_status_sub.copy(&gimbal_device_attitude_status); _gimbal_device_attitude_status_sub.copy(&gimbal_device_attitude_status);
}
gimbal_manager_status_s gimbal_manager_status{}; gimbal_manager_status_s gimbal_manager_status{};
gimbal_manager_status.timestamp = hrt_absolute_time(); gimbal_manager_status.timestamp = hrt_absolute_time();
gimbal_manager_status.flags = gimbal_device_attitude_status.device_flags; gimbal_manager_status.flags = gimbal_device_attitude_status.device_flags;
gimbal_manager_status.gimbal_device_id = 0; gimbal_manager_status.gimbal_device_id = 0;
gimbal_manager_status.primary_control_sysid = _sys_id_primary_control; gimbal_manager_status.primary_control_sysid = _sys_id_primary_control;
gimbal_manager_status.primary_control_compid = _comp_id_primary_control; gimbal_manager_status.primary_control_compid = _comp_id_primary_control;
gimbal_manager_status.secondary_control_sysid = 0; // TODO: support secondary control gimbal_manager_status.secondary_control_sysid = 0; // TODO: support secondary control
gimbal_manager_status.secondary_control_compid = 0; // TODO: support secondary control gimbal_manager_status.secondary_control_compid = 0; // TODO: support secondary control
_gimbal_manager_status_pub.publish(gimbal_manager_status); _gimbal_manager_status_pub.publish(gimbal_manager_status);
}
} }
void InputMavlinkGimbalV2::_stream_gimbal_manager_information() void InputMavlinkGimbalV2::_stream_gimbal_manager_information()