mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-10 06:39:25 +08:00
fix(gimbal): add YAW_IN_VEHICLE/EARTH_FRAME flags to GIMBAL_DEVICE_SET_ATTITUDE (#27198)
This commit is contained in:
@@ -9,6 +9,8 @@ uint32 GIMBAL_DEVICE_FLAGS_NEUTRAL = 2
|
||||
uint32 GIMBAL_DEVICE_FLAGS_ROLL_LOCK = 4
|
||||
uint32 GIMBAL_DEVICE_FLAGS_PITCH_LOCK = 8
|
||||
uint32 GIMBAL_DEVICE_FLAGS_YAW_LOCK = 16
|
||||
uint32 GIMBAL_DEVICE_FLAGS_YAW_IN_VEHICLE_FRAME = 32
|
||||
uint32 GIMBAL_DEVICE_FLAGS_YAW_IN_EARTH_FRAME = 64
|
||||
|
||||
float32[4] q
|
||||
|
||||
|
||||
@@ -245,6 +245,10 @@ void OutputMavlinkV2::_publish_gimbal_device_set_attitude()
|
||||
|
||||
if (_absolute_angle[2]) {
|
||||
set_attitude.flags |= gimbal_device_set_attitude_s::GIMBAL_DEVICE_FLAGS_YAW_LOCK;
|
||||
set_attitude.flags |= gimbal_device_set_attitude_s::GIMBAL_DEVICE_FLAGS_YAW_IN_EARTH_FRAME;
|
||||
|
||||
} else {
|
||||
set_attitude.flags |= gimbal_device_set_attitude_s::GIMBAL_DEVICE_FLAGS_YAW_IN_VEHICLE_FRAME;
|
||||
}
|
||||
|
||||
_gimbal_device_set_attitude_pub.publish(set_attitude);
|
||||
|
||||
Reference in New Issue
Block a user