mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-28 10:46:33 +08:00
fix gimbal driver for mavlink gimbal v2 input and AUX output
The main problem was that during initial negotiation the client would request the gimbal_manager_information from px4 but px4 would never send it because in this configuration the device_compid was set to 0.
This commit is contained in:
committed by
Beat Küng
parent
63495ddac3
commit
18f96c16ce
@@ -211,7 +211,10 @@ static int gimbal_thread_main(int argc, char *argv[])
|
|||||||
// Reset control as no one is active anymore, or yet.
|
// Reset control as no one is active anymore, or yet.
|
||||||
thread_data.control_data.sysid_primary_control = 0;
|
thread_data.control_data.sysid_primary_control = 0;
|
||||||
thread_data.control_data.compid_primary_control = 0;
|
thread_data.control_data.compid_primary_control = 0;
|
||||||
thread_data.control_data.device_compid = 0;
|
// If the output is set to AUX we still want the input to be able to control the gimbal
|
||||||
|
// via mavlink, so we set the device_compid to 1. This follows the mavlink spec which states
|
||||||
|
// that the gimbal_device_id should be between 1 and 6.
|
||||||
|
thread_data.control_data.device_compid = params.mnt_mode_out == 0 ? 1 : 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
InputBase::UpdateResult update_result = InputBase::UpdateResult::NoUpdate;
|
InputBase::UpdateResult update_result = InputBase::UpdateResult::NoUpdate;
|
||||||
|
|||||||
Reference in New Issue
Block a user