mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-23 22:58:10 +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.
|
||||
thread_data.control_data.sysid_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;
|
||||
|
||||
Reference in New Issue
Block a user