|
|
|
@ -451,7 +451,6 @@ void InputMavlinkGimbalV2::_stream_gimbal_manager_status()
@@ -451,7 +451,6 @@ void InputMavlinkGimbalV2::_stream_gimbal_manager_status()
|
|
|
|
|
|
|
|
|
|
if (_gimbal_device_attitude_status_sub.updated()) { |
|
|
|
|
_gimbal_device_attitude_status_sub.copy(&gimbal_device_attitude_status); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
gimbal_manager_status_s gimbal_manager_status{}; |
|
|
|
|
gimbal_manager_status.timestamp = hrt_absolute_time(); |
|
|
|
@ -462,6 +461,7 @@ void InputMavlinkGimbalV2::_stream_gimbal_manager_status()
@@ -462,6 +461,7 @@ void InputMavlinkGimbalV2::_stream_gimbal_manager_status()
|
|
|
|
|
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_pub.publish(gimbal_manager_status); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void InputMavlinkGimbalV2::_stream_gimbal_manager_information() |
|
|
|
|