Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 06:28:27 -04:00
Code Issues Packages Projects Releases Wiki Activity

Blimp: use MAVLink POSITION_TARGET_TYPEMASK

Browse Source
This commit is contained in:
Pierre Kancir 2021-04-21 19:01:23 +02:00 committed by Andrew Tridgell
parent 14d351c2fd
commit bb00340171
1 changed files with 6 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
Blimp/GCS_Mavlink.cpp
View File

@ -94,11 +94,16 @@ void GCS_MAVLINK_Blimp::send_position_target_global_int()
if (!blimp.flightmode->get_wp(target)) { if (!blimp.flightmode->get_wp(target)) {
return; return;
} }
static constexpr uint16_t POSITION_TARGET_TYPEMASK_LAST_BYTE = 0xF000;
static constexpr uint16_t TYPE_MASK = POSITION_TARGET_TYPEMASK_VX_IGNORE | POSITION_TARGET_TYPEMASK_VY_IGNORE | POSITION_TARGET_TYPEMASK_VZ_IGNORE |
POSITION_TARGET_TYPEMASK_AX_IGNORE | POSITION_TARGET_TYPEMASK_AY_IGNORE | POSITION_TARGET_TYPEMASK_AZ_IGNORE |
POSITION_TARGET_TYPEMASK_FORCE_SET | POSITION_TARGET_TYPEMASK_YAW_IGNORE | POSITION_TARGET_TYPEMASK_YAW_RATE_IGNORE | POSITION_TARGET_TYPEMASK_LAST_BYTE;
mavlink_msg_position_target_global_int_send( mavlink_msg_position_target_global_int_send(
chan, chan,
AP_HAL::millis(), // time_boot_ms AP_HAL::millis(), // time_boot_ms
MAV_FRAME_GLOBAL, // targets are always global altitude MAV_FRAME_GLOBAL, // targets are always global altitude
0xFFF8, // ignore everything except the x/y/z components TYPE_MASK, // ignore everything except the x/y/z components
target.lat, // latitude as 1e7 target.lat, // latitude as 1e7
target.lng, // longitude as 1e7 target.lng, // longitude as 1e7
target.alt * 0.01f, // altitude is sent as a float target.alt * 0.01f, // altitude is sent as a float